Trond Enger / d7a_1x

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of d7a_1x by WizziLab

src/d7a_fs.cpp@43:28202405094d, 2016-08-30 (annotated)

Committer:
Jeej
Date:
Tue Aug 30 16:59:12 2016 +0000
Revision:
43:28202405094d
Parent:
38:c1e7f97ab396
Child:
44:8ebe6b70f932
New version of the API.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 25:aac250164497 1 #include "mbed.h"
Jeej 25:aac250164497 2 #include "rtos.h"
Jeej 25:aac250164497 3 #include "dbg.h"
Jeej 25:aac250164497 4 #include "d7a_com.h"
Jeej 25:aac250164497 5 #include "d7a_common.h"
Jeej 25:aac250164497 6 #include "d7a_fs.h"
Jeej 43:28202405094d 7 #include "d7a.h"
Jeej 25:aac250164497 8
Jeej 25:aac250164497 9
Jeej 25:aac250164497 10 #define FS_MAX_FILE_QTY 256
Jeej 25:aac250164497 11 #define FS_MAX_MIRROR_QTY 32
Jeej 25:aac250164497 12 #define FS_MAX_WATCHERS_QTY 32
Jeej 25:aac250164497 13
Jeej 25:aac250164497 14 #define FS_NULL_MAP 0xFF // XXX: this actually removes usage of file 255
Jeej 25:aac250164497 15
Jeej 25:aac250164497 16 TYPEDEF_STRUCT_PACKED {
Jeej 30:d775c1409849 17 uint8_t id;
Jeej 25:aac250164497 18 uint8_t cmd;
Jeej 25:aac250164497 19 uint8_t fid;
Jeej 25:aac250164497 20 uint32_t offset;
Jeej 25:aac250164497 21 uint32_t length;
Jeej 25:aac250164497 22 } d7a_fs_com_req_t;
Jeej 25:aac250164497 23
Jeej 25:aac250164497 24 TYPEDEF_STRUCT_PACKED {
Jeej 30:d775c1409849 25 uint8_t id;
Jeej 25:aac250164497 26 uint8_t cmd;
Jeej 30:d775c1409849 27 int8_t status;
Jeej 25:aac250164497 28 uint32_t length;
Jeej 25:aac250164497 29 uint8_t data[1];
Jeej 25:aac250164497 30 } d7a_fs_com_resp_t;
Jeej 25:aac250164497 31
Jeej 25:aac250164497 32 typedef struct {
Jeej 25:aac250164497 33 d7a_fs_com_req_t req;
Jeej 34:1311cc53201a 34 int8_t status;
Jeej 25:aac250164497 35 void* data;
Jeej 25:aac250164497 36 } d7a_fs_com_t;
Jeej 25:aac250164497 37
Jeej 25:aac250164497 38 typedef struct {
Jeej 25:aac250164497 39 Thread* thread;
Jeej 26:9f0b9833cac6 40 Queue<void, 8> fs_done;
Jeej 30:d775c1409849 41 const d7a_fs_callbacks_t* callback;
Jeej 25:aac250164497 42 Queue<d7a_com_rx_msg_t, 16> pkt_queue;
Jeej 25:aac250164497 43 uint8_t hdr_map[FS_MAX_FILE_QTY];
Jeej 25:aac250164497 44 uint8_t nb_files;
Jeej 30:d775c1409849 45 d7a_fs_com_t com[FS_MAX_CONCURRENCY];
Jeej 25:aac250164497 46 } d7a_fs_ctx_t;
Jeej 25:aac250164497 47
Jeej 25:aac250164497 48 d7a_fs_ctx_t g_fs_ctx;
Jeej 25:aac250164497 49
Jeej 25:aac250164497 50 void d7a_fs_thread(const void *p);
Jeej 25:aac250164497 51
Jeej 30:d775c1409849 52 void d7a_fs_open(const d7a_fs_callbacks_t* config)
Jeej 25:aac250164497 53 {
Jeej 25:aac250164497 54 FPRINT("\r\n");
Jeej 25:aac250164497 55
Jeej 30:d775c1409849 56 g_fs_ctx.callback = config;
Jeej 31:ab9bfdbc6b44 57 g_fs_ctx.thread = new Thread(d7a_fs_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE);
Jeej 25:aac250164497 58 }
Jeej 25:aac250164497 59
Jeej 30:d775c1409849 60
Jeej 25:aac250164497 61 static void d7a_fs_msg(uint8_t* buf, uint8_t len, uint8_t id)
Jeej 25:aac250164497 62 {
Jeej 25:aac250164497 63 FPRINT("\r\n");
Jeej 25:aac250164497 64 d7a_com_tx_msg_t msg;
Jeej 25:aac250164497 65 msg.id = id;
Jeej 25:aac250164497 66 msg.pbuf = buf;
Jeej 25:aac250164497 67 msg.plen = len;
Jeej 25:aac250164497 68 msg.alen = 0;
Jeej 34:1311cc53201a 69 d7a_com_post_msg(&msg);
Jeej 25:aac250164497 70 }
Jeej 25:aac250164497 71
Jeej 25:aac250164497 72 void d7a_fs_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 73 {
Jeej 25:aac250164497 74 FPRINT("\r\n");
Jeej 25:aac250164497 75 ASSERT(g_fs_ctx.pkt_queue.put(pkt) == osOK, "FS queue full!\r\n");
Jeej 25:aac250164497 76 }
Jeej 25:aac250164497 77
Jeej 25:aac250164497 78 d7a_com_rx_msg_t* d7a_fs_wait_pkt( uint32_t millisec )
Jeej 25:aac250164497 79 {
Jeej 30:d775c1409849 80 FPRINT("(millisec:%d)\r\n", millisec);
Jeej 25:aac250164497 81 osEvent evt = g_fs_ctx.pkt_queue.get(millisec);
Jeej 25:aac250164497 82 return (evt.status == osEventMessage)? (d7a_com_rx_msg_t*)evt.value.p : NULL;
Jeej 25:aac250164497 83 }
Jeej 25:aac250164497 84
Jeej 30:d775c1409849 85 #define OP_SIZE_RD 11
Jeej 30:d775c1409849 86 #define OP_SIZE_WR 11
Jeej 30:d775c1409849 87 #define OP_SIZE_TOUCH 11
Jeej 30:d775c1409849 88 #define OP_SIZE_STAT 3
Jeej 30:d775c1409849 89 #define OP_SIZE_FLUSH 3
Jeej 30:d775c1409849 90 #define OP_SIZE_CREATE 11
Jeej 30:d775c1409849 91 #define OP_SIZE_RETSTAT (3+4)
Jeej 30:d775c1409849 92 #define OP_SIZE_RETDATA (3+4)
Jeej 30:d775c1409849 93 uint8_t k_valid_cmd[] = {FS_OP_RD, FS_OP_WR, FS_OP_TOUCH ,FS_OP_STAT, FS_OP_FLUSH, FS_OP_CREATE};
Jeej 30:d775c1409849 94 uint8_t k_valid_size[]= {OP_SIZE_RD,OP_SIZE_WR,OP_SIZE_TOUCH,OP_SIZE_STAT,OP_SIZE_FLUSH,OP_SIZE_CREATE};
Jeej 30:d775c1409849 95
Jeej 25:aac250164497 96
Jeej 25:aac250164497 97
Jeej 30:d775c1409849 98 /// ------------------------------------------------------------------
Jeej 30:d775c1409849 99 /// |TOKEN|CMD/RESP| PAYLOAD |
Jeej 30:d775c1409849 100 /// --------------------------------------------------------------
Jeej 30:d775c1409849 101 /// | 1B | 1B | PKT.blen - 1 bytes |
Jeej 30:d775c1409849 102 /// --------------------------------------------------------------
Jeej 30:d775c1409849 103 /// | | | 1B | 4B | 4B | PKT.blen - 11 bytes|
Jeej 30:d775c1409849 104 /// --------------------------------------------------------------
Jeej 30:d775c1409849 105 // | | write | FID | offset | length | datas... |
Jeej 30:d775c1409849 106 // | | read | FID | offset | length |
Jeej 30:d775c1409849 107 // | | touch | FID | offset | length |
Jeej 30:d775c1409849 108 // | | exist | FID |
Jeej 30:d775c1409849 109 // | | flush | FID |
Jeej 30:d775c1409849 110 // | | retstat|status| length | <kal_fs_properties_t>
Jeej 30:d775c1409849 111 // | | retdat |status| length | datas... |
Jeej 25:aac250164497 112 void d7a_fs_thread(const void *p)
Jeej 25:aac250164497 113 {
Jeej 25:aac250164497 114 FPRINT("\r\n");
Jeej 25:aac250164497 115 d7a_com_rx_msg_t* pkt;
Jeej 26:9f0b9833cac6 116 int8_t status = FS_STAT_OK;
Jeej 25:aac250164497 117
Jeej 25:aac250164497 118 while (true)
Jeej 25:aac250164497 119 {
Jeej 25:aac250164497 120 status = FS_STAT_OK;
Jeej 25:aac250164497 121 // TODO: For now only one outgoing-request can be pending
Jeej 25:aac250164497 122 // An incoming-request response can be served simultaneously
Jeej 25:aac250164497 123 // TODO: handle segmentation. For now MTU = 255-10 = 245
Jeej 25:aac250164497 124 pkt = d7a_fs_wait_pkt();
Jeej 25:aac250164497 125 ASSERT(pkt != NULL, "FS NULL pkt\r\n");
Jeej 25:aac250164497 126 // ---------------------------------------------------------------------------
Jeej 25:aac250164497 127 // Peer request
Jeej 25:aac250164497 128 // ---------------------------------------------------------------------------
Jeej 25:aac250164497 129 switch (pkt->id)
Jeej 25:aac250164497 130 {
Jeej 25:aac250164497 131 case KAL_COM_FLOW_FS_CMD:
Jeej 25:aac250164497 132 d7a_fs_com_req_t* req = (d7a_fs_com_req_t*)pkt->buffer;
Jeej 34:1311cc53201a 133 DPRINT("Rfs[%d](%d) cmd:%d\n", req->fid, req->id, req->cmd);
Jeej 30:d775c1409849 134 //dbg_print_data("%02X ", (uint8_t*)req, sizeof(d7a_fs_com_req_t));
Jeej 30:d775c1409849 135 //DPRINT("\r\n");
Jeej 30:d775c1409849 136 d7a_fs_com_resp_t buf = (d7a_fs_com_resp_t) {.id = req->id, .cmd = FS_OP_RETSTAT};
Jeej 25:aac250164497 137
Jeej 25:aac250164497 138 // Error management makes sense here as we face peer-requests,
Jeej 25:aac250164497 139 // and we don't want to assert because of the peer.
Jeej 25:aac250164497 140 //status = d7a_fs_check_req(req, pkt->blen);
Jeej 25:aac250164497 141 //buf.status = status;
Jeej 25:aac250164497 142 buf.status = FS_STAT_OK;
Jeej 25:aac250164497 143
Jeej 25:aac250164497 144 // From here we assume that the request is valid
Jeej 25:aac250164497 145 // TODO: for now we consider that COM-FS request are targetting
Jeej 25:aac250164497 146 // FIDs that are "local" to the Host, but we can extend this
Jeej 25:aac250164497 147 // to "distant" files as well.(i.e. access SPI-Flash of an Host)
Jeej 25:aac250164497 148 if (status != FS_STAT_OK)
Jeej 25:aac250164497 149 {
Jeej 25:aac250164497 150 buf.length = 0;
Jeej 25:aac250164497 151 // Here we respond to request errors and OP_STAT
Jeej 25:aac250164497 152 d7a_fs_msg((uint8_t*)&buf,OP_SIZE_RETSTAT, KAL_COM_FLOW_FS_RESP);
Jeej 25:aac250164497 153 }
Jeej 25:aac250164497 154 else if (req->cmd == FS_OP_RD)
Jeej 25:aac250164497 155 {
Jeej 25:aac250164497 156 d7a_fs_com_resp_t* b = (d7a_fs_com_resp_t*)MALLOC(OP_SIZE_RETDATA + req->length);
Jeej 30:d775c1409849 157 uint32_t len = g_fs_ctx.callback->read_file(req->fid, req->offset, req->length, &b->data[0]);
Jeej 30:d775c1409849 158 b->id = req->id;
Jeej 25:aac250164497 159 b->length = len;
Jeej 25:aac250164497 160 b->cmd = FS_OP_RETDATA;
Jeej 25:aac250164497 161 b->status = FS_STAT_OK; // TODO
Jeej 25:aac250164497 162 d7a_fs_msg((uint8_t*)b, OP_SIZE_RETDATA + req->length, KAL_COM_FLOW_FS_RESP);
Jeej 25:aac250164497 163 FREE(b);
Jeej 25:aac250164497 164 }
Jeej 25:aac250164497 165 else if (req->cmd == FS_OP_WR)
Jeej 25:aac250164497 166 {
Jeej 30:d775c1409849 167 buf.length = g_fs_ctx.callback->write_file(req->fid, req->offset, req->length, &pkt->buffer[OP_SIZE_WR]);
Jeej 25:aac250164497 168 d7a_fs_msg((uint8_t*)&buf, OP_SIZE_RETSTAT, KAL_COM_FLOW_FS_RESP);
Jeej 25:aac250164497 169 }
Jeej 26:9f0b9833cac6 170 else
Jeej 26:9f0b9833cac6 171 {
Jeej 43:28202405094d 172 ASSERT(false, "FS: Unsupported cmd %d\r\n", req->cmd);
Jeej 26:9f0b9833cac6 173 }
Jeej 25:aac250164497 174 break;
Jeej 25:aac250164497 175 // ---------------------------------------------------------------------------
Jeej 25:aac250164497 176 // Response to our commands
Jeej 25:aac250164497 177 // ---------------------------------------------------------------------------
Jeej 25:aac250164497 178 case KAL_COM_FLOW_FS_RESP:
Jeej 43:28202405094d 179 ASSERT(false, "FS: Commands are not used\r\n");
Jeej 25:aac250164497 180 break;
Jeej 25:aac250164497 181 default:
Jeej 25:aac250164497 182 EPRINT("FS Unknown Flow ID 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 183 break;
Jeej 25:aac250164497 184 }
Jeej 25:aac250164497 185 FREE(pkt);
Jeej 25:aac250164497 186 }
Jeej 25:aac250164497 187 }