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@77:8c792719a1fc, 2016-12-21 (annotated)

Committer:
Jeej
Date:
Wed Dec 21 10:47:29 2016 +0000
Revision:
77:8c792719a1fc
Parent:
76:fda2e34ff19d
Child:
78:f1c0affd99e7
Minimized use of new statement.

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