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_com.cpp@69:18852c154df9, 2016-11-03 (annotated)

Committer:
Jeej
Date:
Thu Nov 03 09:45:18 2016 +0000
Revision:
69:18852c154df9
Parent:
66:492b1d7ba370
Child:
70:07b378285c95
Optimized data parsing.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 24:a8433b091764 1 #include "mbed.h"
Jeej 24:a8433b091764 2 #include "rtos.h"
Jeej 24:a8433b091764 3 #include "dbg.h"
Jeej 49:81d5bddb02f0 4 #include "d7a.h"
Jeej 24:a8433b091764 5 #include "d7a_com.h"
Jeej 45:b85384e7d825 6 #include "d7a_alp.h"
Jeej 25:aac250164497 7 #include "d7a_common.h"
Jeej 25:aac250164497 8 #include "d7a_fs.h"
Jeej 25:aac250164497 9 #include "d7a_modem.h"
Jeej 25:aac250164497 10 #include "d7a_sys.h"
Jeej 69:18852c154df9 11 #include "circular.h"
Jeej 24:a8433b091764 12
Jeej 34:1311cc53201a 13
Jeej 37:e04613e021f2 14 #define XON_SIGNAL (0x0001 << 0)
Jeej 37:e04613e021f2 15 #define START_SIGNAL (0x0001 << 1)
Jeej 31:ab9bfdbc6b44 16
Jeej 31:ab9bfdbc6b44 17 typedef struct {
Jeej 31:ab9bfdbc6b44 18 uint32_t len;
Jeej 45:b85384e7d825 19 uint8_t buf[1];
Jeej 31:ab9bfdbc6b44 20 } d7a_com_tx_buf_t;
Jeej 30:d775c1409849 21
Jeej 37:e04613e021f2 22 enum {
Jeej 37:e04613e021f2 23 SEARCH_HEADER,
Jeej 37:e04613e021f2 24 PARSE_HEADER,
Jeej 37:e04613e021f2 25 SEARCH_BODY,
Jeej 37:e04613e021f2 26 PARSE_BODY,
Jeej 37:e04613e021f2 27 };
Jeej 30:d775c1409849 28
Jeej 25:aac250164497 29 typedef struct {
Jeej 37:e04613e021f2 30 bool rx_started;
Jeej 37:e04613e021f2 31 bool tx_started;
Jeej 37:e04613e021f2 32
Jeej 37:e04613e021f2 33 uint8_t state;
Jeej 34:1311cc53201a 34
Jeej 25:aac250164497 35 DigitalOut* rts;
Jeej 25:aac250164497 36 InterruptIn* cts;
Jeej 69:18852c154df9 37
Jeej 69:18852c154df9 38 CircularBuffer* rx_buf;
Jeej 69:18852c154df9 39
Jeej 37:e04613e021f2 40 // min data in buffer before parsing body
Jeej 37:e04613e021f2 41 d7a_com_rx_msg_t msg;
Jeej 33:f9a542d3efaa 42 // Number of skipped bytes while parsing
Jeej 33:f9a542d3efaa 43 uint16_t skipped_bytes;
Jeej 33:f9a542d3efaa 44
Jeej 25:aac250164497 45 // Port TX sequence number
Jeej 25:aac250164497 46 uint8_t tx_seq;
Jeej 25:aac250164497 47 // Port RX sequence number
Jeej 25:aac250164497 48 uint8_t rx_seq;
Jeej 25:aac250164497 49 // Response to command maximum time
Jeej 25:aac250164497 50 uint32_t timeout;
Jeej 25:aac250164497 51
Jeej 25:aac250164497 52 // Waiting for data available in RX buffer
Jeej 25:aac250164497 53 Semaphore* data_parsing;
Jeej 25:aac250164497 54 // CTS management
Jeej 25:aac250164497 55 Semaphore* cts_int;
Jeej 25:aac250164497 56
Jeej 25:aac250164497 57 // Data treatment threads
Jeej 31:ab9bfdbc6b44 58 Thread* rx_thread;
Jeej 25:aac250164497 59 Serial* serial;
Jeej 25:aac250164497 60
Jeej 31:ab9bfdbc6b44 61 // Tx Thread
Jeej 31:ab9bfdbc6b44 62 Thread* tx_thread;
Jeej 31:ab9bfdbc6b44 63 Queue<d7a_com_tx_buf_t, 32> tx_queue;
Jeej 31:ab9bfdbc6b44 64
Jeej 34:1311cc53201a 65 Timer tim;
Jeej 34:1311cc53201a 66
Jeej 25:aac250164497 67 } d7a_com_ctx_t;
Jeej 24:a8433b091764 68
Jeej 31:ab9bfdbc6b44 69
Jeej 24:a8433b091764 70 static d7a_com_ctx_t g_com_ctx;
Jeej 24:a8433b091764 71
Jeej 24:a8433b091764 72 /**
Jeej 24:a8433b091764 73 Thread for parsing packets from RX buffer.
Jeej 24:a8433b091764 74
Jeej 24:a8433b091764 75 @param void
Jeej 24:a8433b091764 76 @return void
Jeej 24:a8433b091764 77 */
Jeej 31:ab9bfdbc6b44 78 void d7a_com_rx_thread( void const *p );
Jeej 31:ab9bfdbc6b44 79 void d7a_com_tx_thread( void const *p );
Jeej 31:ab9bfdbc6b44 80
Jeej 24:a8433b091764 81
Jeej 24:a8433b091764 82 /**
Jeej 24:a8433b091764 83 Serial Rx Interrupt Service Routine.
Jeej 24:a8433b091764 84 Add recevied bytes to the RX buffer.
Jeej 24:a8433b091764 85
Jeej 24:a8433b091764 86 @param void
Jeej 24:a8433b091764 87 @return void
Jeej 24:a8433b091764 88 */
Jeej 24:a8433b091764 89 void rx_isr()
Jeej 24:a8433b091764 90 {
Jeej 24:a8433b091764 91 // Loop just in case more than one character is in UART's receive FIFO buffer
Jeej 24:a8433b091764 92 // Stop if buffer full
Jeej 34:1311cc53201a 93 while (g_com_ctx.serial->readable())
Jeej 34:1311cc53201a 94 {
Jeej 34:1311cc53201a 95
Jeej 69:18852c154df9 96 g_com_ctx.rx_buf->push(g_com_ctx.serial->getc());
Jeej 34:1311cc53201a 97 //PRINT("-");
Jeej 34:1311cc53201a 98
Jeej 42:1578f0480dcb 99 //if (g_com_ctx.rx_started)
Jeej 34:1311cc53201a 100 {
Jeej 42:1578f0480dcb 101 // unlock data parsing thread
Jeej 69:18852c154df9 102 if (g_com_ctx.state == SEARCH_HEADER && g_com_ctx.rx_buf->available() >= KAL_COM_HEADER_LEN)
Jeej 42:1578f0480dcb 103 {
Jeej 42:1578f0480dcb 104 g_com_ctx.state = PARSE_HEADER;
Jeej 42:1578f0480dcb 105 g_com_ctx.data_parsing->release();
Jeej 42:1578f0480dcb 106 }
Jeej 69:18852c154df9 107 else if (g_com_ctx.state == SEARCH_BODY && g_com_ctx.rx_buf->available() >= g_com_ctx.msg.blen)
Jeej 42:1578f0480dcb 108 {
Jeej 42:1578f0480dcb 109 g_com_ctx.state = PARSE_BODY;
Jeej 42:1578f0480dcb 110 g_com_ctx.data_parsing->release();
Jeej 42:1578f0480dcb 111 }
Jeej 34:1311cc53201a 112 }
Jeej 24:a8433b091764 113 }
Jeej 24:a8433b091764 114 }
Jeej 24:a8433b091764 115
Jeej 24:a8433b091764 116 /**
Jeej 24:a8433b091764 117 CTS pin Interrupt Service Routine.
Jeej 24:a8433b091764 118 For flow control (not yet inplemented)
Jeej 24:a8433b091764 119
Jeej 24:a8433b091764 120 @param void
Jeej 24:a8433b091764 121 @return void
Jeej 24:a8433b091764 122 */
Jeej 24:a8433b091764 123 void cts_isr()
Jeej 24:a8433b091764 124 {
Jeej 34:1311cc53201a 125 //PRINT("CTS_INT\r\n");
Jeej 34:1311cc53201a 126 //g_com_ctx.cts_int->release();
Jeej 24:a8433b091764 127 }
Jeej 24:a8433b091764 128
Jeej 26:9f0b9833cac6 129 // D7a_com constructor.
Jeej 26:9f0b9833cac6 130 // Opens a serial port and monitors the input for ALP packets.
Jeej 26:9f0b9833cac6 131 // Pins are those of the host, not the modem:
Jeej 26:9f0b9833cac6 132 // TX-host -> RX-modem
Jeej 26:9f0b9833cac6 133 // RX-host <- TX-modem
Jeej 26:9f0b9833cac6 134 // RTS-host -> CTS-modem
Jeej 26:9f0b9833cac6 135 // CTS-host <- RTS-modem
Jeej 49:81d5bddb02f0 136 d7a_errors_t d7a_com_open( const d7a_com_config_t* config )
Jeej 26:9f0b9833cac6 137 {
Jeej 26:9f0b9833cac6 138 FPRINT("\r\n");
Jeej 26:9f0b9833cac6 139
Jeej 37:e04613e021f2 140 g_com_ctx.state = SEARCH_HEADER;
Jeej 33:f9a542d3efaa 141 g_com_ctx.skipped_bytes = 0;
Jeej 26:9f0b9833cac6 142 g_com_ctx.tx_seq = 0;
Jeej 26:9f0b9833cac6 143 g_com_ctx.rx_seq = 0;
Jeej 26:9f0b9833cac6 144
Jeej 26:9f0b9833cac6 145 g_com_ctx.serial = new Serial(config->tx, config->rx);
Jeej 26:9f0b9833cac6 146 g_com_ctx.rts = new DigitalOut(config->rts);
Jeej 26:9f0b9833cac6 147 g_com_ctx.cts = new InterruptIn(config->cts);
Jeej 34:1311cc53201a 148 g_com_ctx.data_parsing = new Semaphore(0);
Jeej 34:1311cc53201a 149 g_com_ctx.cts_int = new Semaphore(0);
Jeej 31:ab9bfdbc6b44 150
Jeej 34:1311cc53201a 151 g_com_ctx.cts->rise(&cts_isr);
Jeej 69:18852c154df9 152
Jeej 69:18852c154df9 153 g_com_ctx.rx_buf = new CircularBuffer(1024);
Jeej 34:1311cc53201a 154
Jeej 26:9f0b9833cac6 155 /* XXX: Unknown bug:
Jeej 26:9f0b9833cac6 156 Baud rate can be found with high error rate (> 4%).
Jeej 26:9f0b9833cac6 157 It is here manualy corrected after an oscilloscope measure.
Jeej 26:9f0b9833cac6 158 Normal Baudrate should be 115200.
Jeej 26:9f0b9833cac6 159 */
Jeej 33:f9a542d3efaa 160 //g_com_ctx.serial->baud(117000); // XXX
Jeej 33:f9a542d3efaa 161 g_com_ctx.serial->baud(115200); // XXX
Jeej 34:1311cc53201a 162 //g_com_ctx.serial->baud(57600); // XXX
Jeej 26:9f0b9833cac6 163 g_com_ctx.serial->format(8, SerialBase::None, 1);
Jeej 26:9f0b9833cac6 164 g_com_ctx.serial->attach(&rx_isr, Serial::RxIrq);
Jeej 30:d775c1409849 165
Jeej 65:ac3844adfe49 166 g_com_ctx.tx_thread = new Thread(d7a_com_tx_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE*3);
Jeej 65:ac3844adfe49 167 g_com_ctx.rx_thread = new Thread(d7a_com_rx_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE*3);
Jeej 49:81d5bddb02f0 168
Jeej 49:81d5bddb02f0 169 return D7A_ERR_NONE;
Jeej 26:9f0b9833cac6 170 }
Jeej 26:9f0b9833cac6 171
Jeej 26:9f0b9833cac6 172 // Destructor
Jeej 56:da34fc11e760 173 d7a_errors_t d7a_com_close(void)
Jeej 26:9f0b9833cac6 174 {
Jeej 26:9f0b9833cac6 175 FPRINT("\r\n");
Jeej 31:ab9bfdbc6b44 176 g_com_ctx.rx_thread->terminate();
Jeej 31:ab9bfdbc6b44 177 g_com_ctx.tx_thread->terminate();
Jeej 26:9f0b9833cac6 178 delete g_com_ctx.data_parsing;
Jeej 26:9f0b9833cac6 179 delete g_com_ctx.cts_int;
Jeej 26:9f0b9833cac6 180 delete g_com_ctx.serial;
Jeej 26:9f0b9833cac6 181 delete g_com_ctx.rts;
Jeej 26:9f0b9833cac6 182 delete g_com_ctx.cts;
Jeej 69:18852c154df9 183 delete g_com_ctx.rx_buf;
Jeej 49:81d5bddb02f0 184
Jeej 49:81d5bddb02f0 185 return D7A_ERR_NONE;
Jeej 26:9f0b9833cac6 186 }
Jeej 26:9f0b9833cac6 187
Jeej 37:e04613e021f2 188 void d7a_com_start_rx(void)
Jeej 37:e04613e021f2 189 {
Jeej 37:e04613e021f2 190 FPRINT("\r\n");
Jeej 37:e04613e021f2 191 g_com_ctx.rx_started = true;
Jeej 37:e04613e021f2 192 g_com_ctx.rx_thread->signal_set(START_SIGNAL);
Jeej 37:e04613e021f2 193 }
Jeej 37:e04613e021f2 194
Jeej 37:e04613e021f2 195 void d7a_com_stop_rx(void)
Jeej 34:1311cc53201a 196 {
Jeej 34:1311cc53201a 197 FPRINT("\r\n");
Jeej 37:e04613e021f2 198 g_com_ctx.rx_started = false;
Jeej 37:e04613e021f2 199 }
Jeej 37:e04613e021f2 200
Jeej 37:e04613e021f2 201 void d7a_com_start_tx(void)
Jeej 37:e04613e021f2 202 {
Jeej 37:e04613e021f2 203 FPRINT("\r\n");
Jeej 37:e04613e021f2 204 g_com_ctx.tx_started = true;
Jeej 37:e04613e021f2 205 g_com_ctx.tx_thread->signal_set(START_SIGNAL);
Jeej 37:e04613e021f2 206 }
Jeej 37:e04613e021f2 207
Jeej 37:e04613e021f2 208 void d7a_com_stop_tx(void)
Jeej 37:e04613e021f2 209 {
Jeej 37:e04613e021f2 210 FPRINT("\r\n");
Jeej 37:e04613e021f2 211 g_com_ctx.tx_started = false;
Jeej 34:1311cc53201a 212 }
Jeej 34:1311cc53201a 213
Jeej 34:1311cc53201a 214 void d7a_com_restart(void)
Jeej 34:1311cc53201a 215 {
Jeej 34:1311cc53201a 216 FPRINT("\r\n");
Jeej 69:18852c154df9 217
Jeej 69:18852c154df9 218 g_com_ctx.serial->attach(NULL, Serial::RxIrq);
Jeej 42:1578f0480dcb 219
Jeej 42:1578f0480dcb 220 g_com_ctx.state = SEARCH_HEADER;
Jeej 34:1311cc53201a 221 g_com_ctx.skipped_bytes = 0;
Jeej 34:1311cc53201a 222 g_com_ctx.tx_seq = 0;
Jeej 34:1311cc53201a 223 g_com_ctx.rx_seq = 0;
Jeej 34:1311cc53201a 224
Jeej 69:18852c154df9 225 g_com_ctx.rx_buf->reset();
Jeej 34:1311cc53201a 226
Jeej 69:18852c154df9 227 g_com_ctx.serial->attach(&rx_isr, Serial::RxIrq);
Jeej 34:1311cc53201a 228 }
Jeej 34:1311cc53201a 229
Jeej 42:1578f0480dcb 230
Jeej 24:a8433b091764 231 /**
Jeej 24:a8433b091764 232 Wakes-up modem and send data throught Serial.
Jeej 24:a8433b091764 233
Jeej 24:a8433b091764 234 @param const uint8_t* Pointer to data buffer
Jeej 24:a8433b091764 235 @param int Data length
Jeej 24:a8433b091764 236 @return void
Jeej 24:a8433b091764 237 */
Jeej 45:b85384e7d825 238 static void d7a_com_send(d7a_com_tx_buf_t* tx_buf)
Jeej 69:18852c154df9 239 {
Jeej 45:b85384e7d825 240 FPRINT("\r\n");
Jeej 45:b85384e7d825 241
Jeej 45:b85384e7d825 242 DPRINT("<-- (0x%02X) %d\r\n", tx_buf->buf[4], (tx_buf->len - KAL_COM_HEADER_LEN));
Jeej 34:1311cc53201a 243
Jeej 24:a8433b091764 244 *(g_com_ctx.rts) = 1;
Jeej 24:a8433b091764 245
Jeej 47:19f22e1a448a 246 //dbg_print_data("", "%02X ", (uint8_t*)tx_buf->buf, tx_buf->len, "\r\n");
Jeej 45:b85384e7d825 247
Jeej 39:2101208fafb6 248 Thread::wait(2);
Jeej 24:a8433b091764 249
Jeej 45:b85384e7d825 250 for (uint32_t i=0 ; i<tx_buf->len ; i++)
Jeej 24:a8433b091764 251 {
Jeej 45:b85384e7d825 252 g_com_ctx.serial->putc(tx_buf->buf[i]);
Jeej 24:a8433b091764 253 }
Jeej 24:a8433b091764 254
Jeej 66:492b1d7ba370 255 // Important to not release the ressource too soon
Jeej 66:492b1d7ba370 256 Thread::wait(1);
Jeej 42:1578f0480dcb 257
Jeej 24:a8433b091764 258 *(g_com_ctx.rts) = 0;
Jeej 24:a8433b091764 259 }
Jeej 24:a8433b091764 260
Jeej 26:9f0b9833cac6 261 // Formats and send packet throught Serial.
Jeej 45:b85384e7d825 262 d7a_com_tx_buf_t* d7a_com_new_msg(d7a_com_tx_msg_t* msg)
Jeej 34:1311cc53201a 263 {
Jeej 45:b85384e7d825 264 uint8_t len = KAL_COM_HEADER_LEN + msg->alen + msg->plen;
Jeej 34:1311cc53201a 265 FPRINT("(len:%d)\r\n", len);
Jeej 34:1311cc53201a 266
Jeej 45:b85384e7d825 267 d7a_com_tx_buf_t* tx_buf = (d7a_com_tx_buf_t*)MALLOC(sizeof(d7a_com_tx_buf_t) - 1 + len);
Jeej 34:1311cc53201a 268
Jeej 34:1311cc53201a 269 // construct serial header
Jeej 34:1311cc53201a 270 // concatenate and update tx_seq ID
Jeej 45:b85384e7d825 271 uint8_t* p = tx_buf->buf;
Jeej 45:b85384e7d825 272 uint8_t* t = p;
Jeej 45:b85384e7d825 273 *p++ = (uint8_t)KAL_COM_SYNC_BYTE_0;
Jeej 45:b85384e7d825 274 *p++ = (uint8_t)KAL_COM_SYNC_BYTE_1;
Jeej 45:b85384e7d825 275 *p++ = (uint8_t)msg->alen + msg->plen;
Jeej 45:b85384e7d825 276 *p++ = (uint8_t)g_com_ctx.tx_seq++;
Jeej 45:b85384e7d825 277 *p++ = (uint8_t)msg->id;
Jeej 34:1311cc53201a 278
Jeej 34:1311cc53201a 279 // copy payload and parameters
Jeej 45:b85384e7d825 280 memcpy(p, msg->pbuf, msg->plen);
Jeej 45:b85384e7d825 281 p += msg->plen;
Jeej 45:b85384e7d825 282 memcpy(p, msg->abuf, msg->alen);
Jeej 45:b85384e7d825 283 p += msg->alen;
Jeej 34:1311cc53201a 284
Jeej 45:b85384e7d825 285 tx_buf->len = (uint32_t)(p - t);
Jeej 34:1311cc53201a 286
Jeej 45:b85384e7d825 287 ASSERT(tx_buf->len == len, "New msg wrong length %d expected %d\r\n", tx_buf->len, len);
Jeej 45:b85384e7d825 288
Jeej 45:b85384e7d825 289 return tx_buf;
Jeej 34:1311cc53201a 290 }
Jeej 34:1311cc53201a 291
Jeej 34:1311cc53201a 292 void d7a_com_post_msg(d7a_com_tx_msg_t* msg)
Jeej 45:b85384e7d825 293 {
Jeej 45:b85384e7d825 294 FPRINT("\r\n");
Jeej 26:9f0b9833cac6 295
Jeej 45:b85384e7d825 296 g_com_ctx.tx_queue.put(d7a_com_new_msg(msg));
Jeej 26:9f0b9833cac6 297 }
Jeej 26:9f0b9833cac6 298
Jeej 30:d775c1409849 299 void d7a_com_dump(uint8_t* buf, uint8_t len, d7a_com_flow_t flow)
Jeej 30:d775c1409849 300 {
Jeej 30:d775c1409849 301 d7a_com_tx_msg_t msg;
Jeej 30:d775c1409849 302
Jeej 30:d775c1409849 303 msg.id = flow;
Jeej 30:d775c1409849 304 msg.pbuf = buf;
Jeej 30:d775c1409849 305 msg.plen = len;
Jeej 30:d775c1409849 306 msg.alen = 0;
Jeej 34:1311cc53201a 307 d7a_com_post_msg(&msg);
Jeej 30:d775c1409849 308 }
Jeej 30:d775c1409849 309
Jeej 25:aac250164497 310 static void d7a_com_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 311 {
Jeej 26:9f0b9833cac6 312 //FPRINT("\r\n");
Jeej 35:1fe2975c5a63 313
Jeej 35:1fe2975c5a63 314 DPRINT("--> (0x%02X) %d\r\n", pkt->id, pkt->blen);
Jeej 35:1fe2975c5a63 315
Jeej 25:aac250164497 316 // Distribute packet types to processes
Jeej 25:aac250164497 317 switch (KAL_COM_FLOWID(pkt->id))
Jeej 25:aac250164497 318 {
Jeej 25:aac250164497 319 case KAL_COM_FLOWID_FS:
Jeej 25:aac250164497 320 d7a_fs_new_pkt(pkt);
Jeej 25:aac250164497 321 break;
Jeej 25:aac250164497 322 case KAL_COM_FLOWID_CMD:
Jeej 25:aac250164497 323 d7a_modem_new_pkt(pkt);
Jeej 25:aac250164497 324 break;
Jeej 45:b85384e7d825 325 case KAL_COM_FLOWID_ALP:
Jeej 45:b85384e7d825 326 d7a_alp_new_pkt(pkt);
Jeej 45:b85384e7d825 327 break;
Jeej 25:aac250164497 328 case KAL_COM_FLOWID_SYS:
Jeej 30:d775c1409849 329 // This has to be here to avoid going to another process
Jeej 30:d775c1409849 330 if (pkt->id == KAL_COM_FLOW_SYS_XON)
Jeej 30:d775c1409849 331 {
Jeej 65:ac3844adfe49 332 FREE(pkt);
Jeej 42:1578f0480dcb 333 DPRINT("XON\r\n");
Jeej 34:1311cc53201a 334 g_com_ctx.tx_thread->signal_set(XON_SIGNAL);
Jeej 30:d775c1409849 335 }
Jeej 30:d775c1409849 336 else if (pkt->id == KAL_COM_FLOW_SYS_XOFF)
Jeej 30:d775c1409849 337 {
Jeej 65:ac3844adfe49 338 FREE(pkt);
Jeej 42:1578f0480dcb 339 DPRINT("XOFF\r\n");
Jeej 34:1311cc53201a 340 d7a_sys_xack();
Jeej 30:d775c1409849 341 }
Jeej 30:d775c1409849 342 else
Jeej 30:d775c1409849 343 {
Jeej 30:d775c1409849 344 d7a_sys_new_pkt(pkt);
Jeej 30:d775c1409849 345 }
Jeej 30:d775c1409849 346 break;
Jeej 25:aac250164497 347 default:
Jeej 25:aac250164497 348 EPRINT("Untreated pkt type 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 349 FREE(pkt);
Jeej 25:aac250164497 350 break;
Jeej 25:aac250164497 351 }
Jeej 25:aac250164497 352 }
Jeej 24:a8433b091764 353
Jeej 33:f9a542d3efaa 354
Jeej 24:a8433b091764 355 /**
Jeej 34:1311cc53201a 356 Reads the Rx buffer, parses the packets
Jeej 24:a8433b091764 357
Jeej 24:a8433b091764 358 @param void
Jeej 24:a8433b091764 359 @return void
Jeej 24:a8433b091764 360 */
Jeej 37:e04613e021f2 361 static void parse_packet_header(void)
Jeej 24:a8433b091764 362 {
Jeej 37:e04613e021f2 363 uint8_t header[KAL_COM_HEADER_LEN];
Jeej 37:e04613e021f2 364 uint8_t seqnum;
Jeej 33:f9a542d3efaa 365
Jeej 69:18852c154df9 366 ASSERT(g_com_ctx.rx_buf->available() >= KAL_COM_HEADER_LEN, "Not enough data for header\r\n");
Jeej 42:1578f0480dcb 367
Jeej 37:e04613e021f2 368 g_com_ctx.skipped_bytes = 0;
Jeej 33:f9a542d3efaa 369
Jeej 69:18852c154df9 370 header[0] = g_com_ctx.rx_buf->pop();
Jeej 69:18852c154df9 371
Jeej 69:18852c154df9 372 while (g_com_ctx.rx_buf->available() >= KAL_COM_HEADER_LEN - 1)
Jeej 24:a8433b091764 373 {
Jeej 69:18852c154df9 374 header[1] = g_com_ctx.rx_buf->pop();
Jeej 69:18852c154df9 375
Jeej 69:18852c154df9 376 // Check sync bytes
Jeej 69:18852c154df9 377 if(KAL_COM_SYNC_BYTE_0 == header[0] && KAL_COM_SYNC_BYTE_1 == header[1])
Jeej 24:a8433b091764 378 {
Jeej 69:18852c154df9 379 // Copy header
Jeej 69:18852c154df9 380 g_com_ctx.rx_buf->get(&header[2], KAL_COM_HEADER_LEN - 2);
Jeej 69:18852c154df9 381
Jeej 69:18852c154df9 382 // Fill temp header
Jeej 69:18852c154df9 383 g_com_ctx.msg.blen = header[2];
Jeej 69:18852c154df9 384 seqnum = header[3];
Jeej 69:18852c154df9 385 g_com_ctx.msg.id = header[4];
Jeej 69:18852c154df9 386
Jeej 69:18852c154df9 387 // Update seqnum
Jeej 69:18852c154df9 388 WARNING(g_com_ctx.rx_seq == seqnum, "COM Bad seqnum expected:%d got:%d\r\n", g_com_ctx.rx_seq, seqnum);
Jeej 69:18852c154df9 389 g_com_ctx.rx_seq = seqnum + 1;
Jeej 69:18852c154df9 390
Jeej 69:18852c154df9 391 // search for body
Jeej 69:18852c154df9 392 g_com_ctx.state = SEARCH_BODY;
Jeej 69:18852c154df9 393
Jeej 69:18852c154df9 394 // Start parsing if data is already available
Jeej 69:18852c154df9 395 if (g_com_ctx.rx_buf->available() >= g_com_ctx.msg.blen)
Jeej 33:f9a542d3efaa 396 {
Jeej 69:18852c154df9 397 g_com_ctx.state = PARSE_BODY;
Jeej 69:18852c154df9 398 g_com_ctx.data_parsing->release();
Jeej 33:f9a542d3efaa 399 }
Jeej 69:18852c154df9 400
Jeej 69:18852c154df9 401 //DPRINT("COM header found (id: %02X seq: %d body: %d/%d bytes)\r\n", g_com_ctx.msg.id, seqnum, g_com_ctx.rx_buf->available(), g_com_ctx.msg.blen);
Jeej 69:18852c154df9 402 break;
Jeej 24:a8433b091764 403 }
Jeej 69:18852c154df9 404 else
Jeej 69:18852c154df9 405 {
Jeej 69:18852c154df9 406 // Shift by 1 byte
Jeej 69:18852c154df9 407 WARNING(false, "COM Skipped byte 0x%02X.\r\n", header[0]);
Jeej 69:18852c154df9 408 header[0] = header[1];
Jeej 69:18852c154df9 409 }
Jeej 37:e04613e021f2 410 }
Jeej 37:e04613e021f2 411 }
Jeej 37:e04613e021f2 412
Jeej 37:e04613e021f2 413 /**
Jeej 37:e04613e021f2 414 Reads the Rx buffer, parses the packets
Jeej 37:e04613e021f2 415
Jeej 37:e04613e021f2 416 @param void
Jeej 37:e04613e021f2 417 @return void
Jeej 37:e04613e021f2 418 */
Jeej 37:e04613e021f2 419 static void parse_packet_body(void)
Jeej 37:e04613e021f2 420 {
Jeej 69:18852c154df9 421 ASSERT(g_com_ctx.rx_buf->available() >= g_com_ctx.msg.blen, "Not enough data for body\r\n");
Jeej 42:1578f0480dcb 422
Jeej 37:e04613e021f2 423 if (KAL_COM_FLOWID(g_com_ctx.msg.id) != KAL_COM_FLOWID_TRC)
Jeej 37:e04613e021f2 424 {
Jeej 65:ac3844adfe49 425 //DPRINT("COM body found (%d bytes)\r\n", g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 426
Jeej 65:ac3844adfe49 427 d7a_com_rx_msg_t* pkt = (d7a_com_rx_msg_t*)MALLOC(sizeof(d7a_com_rx_msg_t) - 1 + g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 428
Jeej 37:e04613e021f2 429 // copy data to buffer
Jeej 37:e04613e021f2 430 pkt->blen = g_com_ctx.msg.blen;
Jeej 37:e04613e021f2 431 pkt->id = g_com_ctx.msg.id;
Jeej 69:18852c154df9 432 g_com_ctx.rx_buf->get(pkt->buffer, g_com_ctx.msg.blen);
Jeej 65:ac3844adfe49 433
Jeej 37:e04613e021f2 434 // add packet to queue
Jeej 37:e04613e021f2 435 d7a_com_new_pkt(pkt);
Jeej 37:e04613e021f2 436 }
Jeej 37:e04613e021f2 437 else
Jeej 37:e04613e021f2 438 {
Jeej 37:e04613e021f2 439 // Ignore packet
Jeej 65:ac3844adfe49 440 //DPRINT("Ignore pkt id %02X\r\n", g_com_ctx.msg.id);
Jeej 69:18852c154df9 441 g_com_ctx.rx_buf->get(NULL, g_com_ctx.msg.blen);
Jeej 24:a8433b091764 442 }
Jeej 33:f9a542d3efaa 443
Jeej 69:18852c154df9 444 // Seach for next header
Jeej 37:e04613e021f2 445 g_com_ctx.state = SEARCH_HEADER;
Jeej 42:1578f0480dcb 446
Jeej 42:1578f0480dcb 447 // Start parsing if data is already available
Jeej 69:18852c154df9 448 if (g_com_ctx.rx_buf->available() >= KAL_COM_HEADER_LEN)
Jeej 42:1578f0480dcb 449 {
Jeej 42:1578f0480dcb 450 g_com_ctx.state = PARSE_HEADER;
Jeej 42:1578f0480dcb 451 g_com_ctx.data_parsing->release();
Jeej 42:1578f0480dcb 452 }
Jeej 24:a8433b091764 453 }
Jeej 24:a8433b091764 454
Jeej 24:a8433b091764 455
Jeej 24:a8433b091764 456 // Thread for parsing packets from RX buffer.
Jeej 31:ab9bfdbc6b44 457 void d7a_com_rx_thread( void const *p )
Jeej 24:a8433b091764 458 {
Jeej 58:38a366236bda 459 FPRINT("(id:0x%08x)\r\n", osThreadGetId());
Jeej 24:a8433b091764 460 while (true)
Jeej 24:a8433b091764 461 {
Jeej 24:a8433b091764 462 // wait for data available
Jeej 24:a8433b091764 463 g_com_ctx.data_parsing->wait();
Jeej 37:e04613e021f2 464
Jeej 37:e04613e021f2 465 if (g_com_ctx.state == PARSE_HEADER)
Jeej 33:f9a542d3efaa 466 {
Jeej 37:e04613e021f2 467 parse_packet_header();
Jeej 37:e04613e021f2 468 }
Jeej 37:e04613e021f2 469 else if (g_com_ctx.state == PARSE_BODY)
Jeej 37:e04613e021f2 470 {
Jeej 37:e04613e021f2 471 parse_packet_body();
Jeej 33:f9a542d3efaa 472 }
Jeej 24:a8433b091764 473 }
Jeej 24:a8433b091764 474 }
Jeej 31:ab9bfdbc6b44 475
Jeej 31:ab9bfdbc6b44 476 void d7a_com_tx_thread( void const *p )
Jeej 31:ab9bfdbc6b44 477 {
Jeej 58:38a366236bda 478 FPRINT("(id:0x%08x)\r\n", osThreadGetId());
Jeej 31:ab9bfdbc6b44 479
Jeej 31:ab9bfdbc6b44 480 d7a_com_tx_buf_t* msg;
Jeej 31:ab9bfdbc6b44 481 osEvent evt;
Jeej 34:1311cc53201a 482 uint8_t flow_id;
Jeej 34:1311cc53201a 483
Jeej 31:ab9bfdbc6b44 484 while (true)
Jeej 31:ab9bfdbc6b44 485 {
Jeej 31:ab9bfdbc6b44 486 // wait for data to send
Jeej 31:ab9bfdbc6b44 487 evt = g_com_ctx.tx_queue.get();
Jeej 31:ab9bfdbc6b44 488 msg = (evt.status == osEventMessage)? (d7a_com_tx_buf_t*)evt.value.p : NULL;
Jeej 37:e04613e021f2 489
Jeej 31:ab9bfdbc6b44 490
Jeej 31:ab9bfdbc6b44 491 // send message
Jeej 31:ab9bfdbc6b44 492 if (msg != NULL)
Jeej 31:ab9bfdbc6b44 493 {
Jeej 34:1311cc53201a 494 flow_id = msg->buf[4];
Jeej 34:1311cc53201a 495
Jeej 45:b85384e7d825 496 d7a_com_send(msg);
Jeej 31:ab9bfdbc6b44 497 FREE(msg);
Jeej 34:1311cc53201a 498
Jeej 34:1311cc53201a 499 if (KAL_COM_FLOW_SYS_XACK == flow_id)
Jeej 34:1311cc53201a 500 {
Jeej 42:1578f0480dcb 501 DPRINT("XACK\r\n");
Jeej 34:1311cc53201a 502 g_com_ctx.tx_thread->signal_wait(XON_SIGNAL);
Jeej 34:1311cc53201a 503 }
Jeej 31:ab9bfdbc6b44 504 }
Jeej 31:ab9bfdbc6b44 505 }
Jeej 31:ab9bfdbc6b44 506 }