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@82:5d1b101b6d11, 2017-01-05 (annotated)

Committer:
Jeej
Date:
Thu Jan 05 12:37:44 2017 +0000
Revision:
82:5d1b101b6d11
Parent:
80:30265d5dd20a
Child:
83:f4054d0b29ba
Fixed root request + some cleanup.

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