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@25:aac250164497, 2016-03-25 (annotated)

Committer:
Jeej
Date:
Fri Mar 25 16:48:02 2016 +0000
Revision:
25:aac250164497
Parent:
24:a8433b091764
Child:
26:9f0b9833cac6
D7A_1x compatibility. TODO Register file add check if file exists.

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 24:a8433b091764 4 #include "d7a_com.h"
Jeej 25:aac250164497 5 #include "d7a_common.h"
Jeej 25:aac250164497 6 #include "d7a_fs.h"
Jeej 25:aac250164497 7 #include "d7a_modem.h"
Jeej 25:aac250164497 8 #include "d7a_sys.h"
Jeej 24:a8433b091764 9
Jeej 25:aac250164497 10 typedef struct {
Jeej 25:aac250164497 11 DigitalOut* rts;
Jeej 25:aac250164497 12 InterruptIn* cts;
Jeej 25:aac250164497 13
Jeej 25:aac250164497 14 // RX buffer address
Jeej 25:aac250164497 15 uint8_t* rx_buffer;
Jeej 25:aac250164497 16 // RX buffer size
Jeej 25:aac250164497 17 uint16_t rx_buffer_size;
Jeej 25:aac250164497 18 // Write index in RX buffer
Jeej 25:aac250164497 19 volatile uint16_t write_idx;
Jeej 25:aac250164497 20 // Read index in RX buffer
Jeej 25:aac250164497 21 uint16_t read_idx;
Jeej 25:aac250164497 22 // Number of bytes available in RX buffer
Jeej 25:aac250164497 23 volatile uint16_t data_available;
Jeej 25:aac250164497 24 // Port TX sequence number
Jeej 25:aac250164497 25 uint8_t tx_seq;
Jeej 25:aac250164497 26 // Port RX sequence number
Jeej 25:aac250164497 27 uint8_t rx_seq;
Jeej 25:aac250164497 28 // Response to command maximum time
Jeej 25:aac250164497 29 uint32_t timeout;
Jeej 25:aac250164497 30
Jeej 25:aac250164497 31 // Packet reception queue
Jeej 25:aac250164497 32 Queue<d7a_com_rx_msg_t, 32> pkt_queue;
Jeej 25:aac250164497 33
Jeej 25:aac250164497 34 // Waiting for data available in RX buffer
Jeej 25:aac250164497 35 Semaphore* data_parsing;
Jeej 25:aac250164497 36 // CTS management
Jeej 25:aac250164497 37 Semaphore* cts_int;
Jeej 25:aac250164497 38
Jeej 25:aac250164497 39 // Data treatment threads
Jeej 25:aac250164497 40 Thread* thread;
Jeej 25:aac250164497 41 Serial* serial;
Jeej 25:aac250164497 42
Jeej 25:aac250164497 43 uint32_t rx_pkt_count;
Jeej 25:aac250164497 44 uint32_t rx_byte_count;
Jeej 25:aac250164497 45 uint32_t tx_pkt_count;
Jeej 25:aac250164497 46 uint32_t tx_byte_count;
Jeej 25:aac250164497 47 } d7a_com_ctx_t;
Jeej 24:a8433b091764 48
Jeej 24:a8433b091764 49 static d7a_com_ctx_t g_com_ctx;
Jeej 24:a8433b091764 50
Jeej 24:a8433b091764 51 /**
Jeej 24:a8433b091764 52 Thread for parsing packets from RX buffer.
Jeej 24:a8433b091764 53
Jeej 24:a8433b091764 54 @param void
Jeej 24:a8433b091764 55 @return void
Jeej 24:a8433b091764 56 */
Jeej 25:aac250164497 57 void d7a_com_thread( void const *p );
Jeej 24:a8433b091764 58
Jeej 24:a8433b091764 59
Jeej 24:a8433b091764 60 /**
Jeej 24:a8433b091764 61 Serial Rx Interrupt Service Routine.
Jeej 24:a8433b091764 62 Add recevied bytes to the RX buffer.
Jeej 24:a8433b091764 63
Jeej 24:a8433b091764 64 @param void
Jeej 24:a8433b091764 65 @return void
Jeej 24:a8433b091764 66 */
Jeej 24:a8433b091764 67 void rx_isr()
Jeej 24:a8433b091764 68 {
Jeej 24:a8433b091764 69 // Loop just in case more than one character is in UART's receive FIFO buffer
Jeej 24:a8433b091764 70 // Stop if buffer full
Jeej 24:a8433b091764 71 while ((g_com_ctx.serial->readable()) && (((g_com_ctx.write_idx + 1) % g_com_ctx.rx_buffer_size) != g_com_ctx.read_idx)) {
Jeej 24:a8433b091764 72 g_com_ctx.rx_buffer[g_com_ctx.write_idx] = g_com_ctx.serial->getc();
Jeej 24:a8433b091764 73 g_com_ctx.data_available++;
Jeej 24:a8433b091764 74 //DPRINT(".");
Jeej 24:a8433b091764 75
Jeej 24:a8433b091764 76 g_com_ctx.write_idx = (g_com_ctx.write_idx + 1) % g_com_ctx.rx_buffer_size;
Jeej 24:a8433b091764 77 }
Jeej 24:a8433b091764 78
Jeej 24:a8433b091764 79 // unlock data parsing thread
Jeej 25:aac250164497 80 // do not parse if minimum packet size is not available
Jeej 25:aac250164497 81 if (g_com_ctx.data_available > KAL_COM_HEADER_LEN)
Jeej 25:aac250164497 82 {
Jeej 25:aac250164497 83 g_com_ctx.data_parsing->release();
Jeej 25:aac250164497 84 }
Jeej 24:a8433b091764 85
Jeej 24:a8433b091764 86 return;
Jeej 24:a8433b091764 87 }
Jeej 24:a8433b091764 88
Jeej 24:a8433b091764 89 /**
Jeej 24:a8433b091764 90 CTS pin Interrupt Service Routine.
Jeej 24:a8433b091764 91 For flow control (not yet inplemented)
Jeej 24:a8433b091764 92
Jeej 24:a8433b091764 93 @param void
Jeej 24:a8433b091764 94 @return void
Jeej 24:a8433b091764 95 */
Jeej 24:a8433b091764 96 void cts_isr()
Jeej 24:a8433b091764 97 {
Jeej 24:a8433b091764 98 g_com_ctx.cts_int->release();
Jeej 24:a8433b091764 99 return;
Jeej 24:a8433b091764 100 }
Jeej 24:a8433b091764 101
Jeej 24:a8433b091764 102
Jeej 24:a8433b091764 103 /**
Jeej 24:a8433b091764 104 Wakes-up modem and send data throught Serial.
Jeej 24:a8433b091764 105
Jeej 24:a8433b091764 106 @param const uint8_t* Pointer to data buffer
Jeej 24:a8433b091764 107 @param int Data length
Jeej 24:a8433b091764 108 @return void
Jeej 24:a8433b091764 109 */
Jeej 24:a8433b091764 110 static void send(const uint8_t* buffer, int length)
Jeej 24:a8433b091764 111 {
Jeej 24:a8433b091764 112 int i;
Jeej 24:a8433b091764 113
Jeej 24:a8433b091764 114 *(g_com_ctx.rts) = 1;
Jeej 24:a8433b091764 115
Jeej 24:a8433b091764 116 Thread::wait(5);
Jeej 24:a8433b091764 117
Jeej 24:a8433b091764 118 for (i=0 ; i<length ; i++)
Jeej 24:a8433b091764 119 {
Jeej 24:a8433b091764 120 g_com_ctx.serial->putc(buffer[i]);
Jeej 24:a8433b091764 121 }
Jeej 24:a8433b091764 122
Jeej 24:a8433b091764 123 *(g_com_ctx.rts) = 0;
Jeej 24:a8433b091764 124 }
Jeej 24:a8433b091764 125
Jeej 25:aac250164497 126 static void d7a_com_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 127 {
Jeej 25:aac250164497 128 FPRINT("\r\n");
Jeej 25:aac250164497 129 // Distribute packet types to processes
Jeej 25:aac250164497 130 switch (KAL_COM_FLOWID(pkt->id))
Jeej 25:aac250164497 131 {
Jeej 25:aac250164497 132 case KAL_COM_FLOWID_FS:
Jeej 25:aac250164497 133 d7a_fs_new_pkt(pkt);
Jeej 25:aac250164497 134 break;
Jeej 25:aac250164497 135 case KAL_COM_FLOWID_CMD:
Jeej 25:aac250164497 136 d7a_modem_new_pkt(pkt);
Jeej 25:aac250164497 137 break;
Jeej 25:aac250164497 138 case KAL_COM_FLOWID_SYS:
Jeej 25:aac250164497 139 d7a_sys_new_pkt(pkt);
Jeej 25:aac250164497 140 break;
Jeej 25:aac250164497 141 default:
Jeej 25:aac250164497 142 EPRINT("Untreated pkt type 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 143 FREE(pkt);
Jeej 25:aac250164497 144 break;
Jeej 25:aac250164497 145 }
Jeej 25:aac250164497 146 }
Jeej 24:a8433b091764 147
Jeej 24:a8433b091764 148 /**
Jeej 24:a8433b091764 149 Reads the Rx buffer, parses the packets and adds them to _pkt_queue
Jeej 24:a8433b091764 150
Jeej 24:a8433b091764 151 @param void
Jeej 24:a8433b091764 152 @return void
Jeej 24:a8433b091764 153 */
Jeej 24:a8433b091764 154 static bool parse_packet(const uint16_t start_idx, const uint16_t data_available)
Jeej 24:a8433b091764 155 {
Jeej 24:a8433b091764 156 uint16_t data_read = 0;
Jeej 24:a8433b091764 157 uint8_t data = 0;
Jeej 24:a8433b091764 158 uint8_t state = 0;
Jeej 24:a8433b091764 159 uint8_t seqnum = 0;
Jeej 24:a8433b091764 160 uint8_t len = 0;
Jeej 24:a8433b091764 161 uint8_t id = 0;
Jeej 24:a8433b091764 162 uint8_t i = 0;
Jeej 24:a8433b091764 163 bool pkt_found = false;
Jeej 24:a8433b091764 164
Jeej 24:a8433b091764 165 while (data_read < data_available)
Jeej 24:a8433b091764 166 {
Jeej 24:a8433b091764 167 // do not parse if minimum packet size is not available
Jeej 24:a8433b091764 168 if (0 == state && (data_available - data_read) <= KAL_COM_HEADER_LEN)
Jeej 24:a8433b091764 169 {
Jeej 24:a8433b091764 170 break;
Jeej 24:a8433b091764 171 }
Jeej 24:a8433b091764 172
Jeej 24:a8433b091764 173 // Pop data
Jeej 24:a8433b091764 174 data = g_com_ctx.rx_buffer[(g_com_ctx.read_idx + data_read) % g_com_ctx.rx_buffer_size];
Jeej 24:a8433b091764 175 data_read++;
Jeej 24:a8433b091764 176 //DPRINT("Read %d of %d bytes: 0x%02X\r\n", data_read, data_available, data);
Jeej 24:a8433b091764 177
Jeej 24:a8433b091764 178 // search first sync byte
Jeej 24:a8433b091764 179 if (0 == state && KAL_COM_SYNC_BYTE_0 == data)
Jeej 24:a8433b091764 180 {
Jeej 24:a8433b091764 181 state++;
Jeej 24:a8433b091764 182 }
Jeej 24:a8433b091764 183 // look up second sync byte
Jeej 24:a8433b091764 184 else if (1 == state && KAL_COM_SYNC_BYTE_1 == data)
Jeej 24:a8433b091764 185 {
Jeej 24:a8433b091764 186 state++;
Jeej 24:a8433b091764 187 }
Jeej 24:a8433b091764 188 // look up packet size
Jeej 24:a8433b091764 189 else if (2 == state && 0 != data)
Jeej 24:a8433b091764 190 {
Jeej 24:a8433b091764 191 len = data;
Jeej 24:a8433b091764 192 // if not enough data is available
Jeej 24:a8433b091764 193 if (data_available < data_read + 1 + 1 + len) // data read + seqnum + id + data length
Jeej 24:a8433b091764 194 {
Jeej 24:a8433b091764 195 // go back to begining of packet
Jeej 24:a8433b091764 196 data_read -= 3;
Jeej 24:a8433b091764 197 break;
Jeej 24:a8433b091764 198 }
Jeej 24:a8433b091764 199 else
Jeej 24:a8433b091764 200 {
Jeej 24:a8433b091764 201 state++;
Jeej 24:a8433b091764 202 }
Jeej 24:a8433b091764 203 }
Jeej 24:a8433b091764 204 // get seqnum
Jeej 24:a8433b091764 205 else if (3 == state)
Jeej 24:a8433b091764 206 {
Jeej 24:a8433b091764 207 seqnum = data;
Jeej 24:a8433b091764 208 if (g_com_ctx.rx_seq != seqnum)
Jeej 24:a8433b091764 209 {
Jeej 25:aac250164497 210 WARNING(false, "COM Missing %d seqnum\r\n", seqnum - g_com_ctx.rx_seq);
Jeej 24:a8433b091764 211 g_com_ctx.rx_seq = seqnum;
Jeej 24:a8433b091764 212 }
Jeej 24:a8433b091764 213
Jeej 24:a8433b091764 214 g_com_ctx.rx_seq++;
Jeej 24:a8433b091764 215 state++;
Jeej 24:a8433b091764 216 }
Jeej 24:a8433b091764 217 // get id
Jeej 24:a8433b091764 218 else if (4 == state)
Jeej 24:a8433b091764 219 {
Jeej 24:a8433b091764 220 id = data;
Jeej 24:a8433b091764 221 state++;
Jeej 24:a8433b091764 222 }
Jeej 24:a8433b091764 223 // we got a full packet
Jeej 24:a8433b091764 224 else if (5 == state)
Jeej 24:a8433b091764 225 {
Jeej 25:aac250164497 226 d7a_com_rx_msg_t* pkt = NULL;
Jeej 25:aac250164497 227 pkt = (d7a_com_rx_msg_t*)MALLOC(sizeof(d7a_com_rx_msg_t) - 1 + len);
Jeej 24:a8433b091764 228
Jeej 24:a8433b091764 229 //DPRINT("Got packet fid %d len %d\r\n", fid, len);
Jeej 24:a8433b091764 230
Jeej 24:a8433b091764 231 // copy data to buffer
Jeej 25:aac250164497 232 pkt->blen = len;
Jeej 24:a8433b091764 233 pkt->id = id;
Jeej 24:a8433b091764 234 for (i=0 ; i<len ; i++)
Jeej 24:a8433b091764 235 {
Jeej 25:aac250164497 236 pkt->buffer[i] = g_com_ctx.rx_buffer[(g_com_ctx.read_idx + data_read + i - 1) % g_com_ctx.rx_buffer_size];
Jeej 24:a8433b091764 237 }
Jeej 24:a8433b091764 238 data_read += i - 1;
Jeej 24:a8433b091764 239
Jeej 24:a8433b091764 240 // add packet to queue
Jeej 25:aac250164497 241 DPRINT("New packet SIZE:%d\r\n", pkt->blen);
Jeej 25:aac250164497 242 d7a_com_new_pkt(pkt);
Jeej 24:a8433b091764 243
Jeej 24:a8433b091764 244 pkt_found = true;
Jeej 24:a8433b091764 245
Jeej 24:a8433b091764 246 // Stats
Jeej 24:a8433b091764 247 g_com_ctx.rx_pkt_count++;
Jeej 24:a8433b091764 248 g_com_ctx.rx_byte_count += (len + KAL_COM_HEADER_LEN);
Jeej 24:a8433b091764 249
Jeej 24:a8433b091764 250 break;
Jeej 24:a8433b091764 251 }
Jeej 24:a8433b091764 252 else
Jeej 24:a8433b091764 253 {
Jeej 24:a8433b091764 254 // Restart search
Jeej 24:a8433b091764 255 state = 0;
Jeej 24:a8433b091764 256 }
Jeej 24:a8433b091764 257 }
Jeej 24:a8433b091764 258
Jeej 24:a8433b091764 259 if (data_read)
Jeej 24:a8433b091764 260 {
Jeej 24:a8433b091764 261 uint16_t discarded_bytes;
Jeej 24:a8433b091764 262 if (pkt_found)
Jeej 24:a8433b091764 263 {
Jeej 24:a8433b091764 264 // If packet is found, bytes before the packet are discarded
Jeej 24:a8433b091764 265 discarded_bytes = data_read - len - KAL_COM_HEADER_LEN;
Jeej 24:a8433b091764 266 }
Jeej 24:a8433b091764 267 else
Jeej 24:a8433b091764 268 {
Jeej 24:a8433b091764 269 // Discard all bytes
Jeej 24:a8433b091764 270 discarded_bytes = data_read;
Jeej 24:a8433b091764 271 }
Jeej 24:a8433b091764 272
Jeej 24:a8433b091764 273 if (discarded_bytes)
Jeej 24:a8433b091764 274 {
Jeej 24:a8433b091764 275 EPRINT("Discarding %d bytes\r\n", discarded_bytes);
Jeej 24:a8433b091764 276 for (i=0 ; i<discarded_bytes ; i++)
Jeej 24:a8433b091764 277 {
Jeej 24:a8433b091764 278 DPRINT("%02X ", g_com_ctx.rx_buffer[(g_com_ctx.read_idx + i) % g_com_ctx.rx_buffer_size]);
Jeej 24:a8433b091764 279 }
Jeej 24:a8433b091764 280 DPRINT("\r\n");
Jeej 24:a8433b091764 281 }
Jeej 24:a8433b091764 282
Jeej 24:a8433b091764 283 // update buffer indexes
Jeej 24:a8433b091764 284 g_com_ctx.read_idx = (g_com_ctx.read_idx + data_read) % g_com_ctx.rx_buffer_size;
Jeej 24:a8433b091764 285 g_com_ctx.data_available -= data_read;
Jeej 24:a8433b091764 286 }
Jeej 24:a8433b091764 287
Jeej 24:a8433b091764 288 return pkt_found;
Jeej 24:a8433b091764 289 }
Jeej 24:a8433b091764 290
Jeej 24:a8433b091764 291
Jeej 24:a8433b091764 292
Jeej 24:a8433b091764 293 // D7a_com constructor.
Jeej 24:a8433b091764 294 // Opens a serial port and monitors the input for ALP packets.
Jeej 24:a8433b091764 295 // Pins are those of the host, not the modem:
Jeej 24:a8433b091764 296 // TX-host -> RX-modem
Jeej 24:a8433b091764 297 // RX-host <- TX-modem
Jeej 24:a8433b091764 298 // RTS-host -> CTS-modem
Jeej 24:a8433b091764 299 // CTS-host <- RTS-modem
Jeej 24:a8433b091764 300 void d7a_com_open( const d7a_com_config_t* config )
Jeej 24:a8433b091764 301 {
Jeej 25:aac250164497 302 FPRINT("\r\n");
Jeej 24:a8433b091764 303
Jeej 24:a8433b091764 304 g_com_ctx.rx_buffer_size = config->rx_buffer_size;
Jeej 24:a8433b091764 305 g_com_ctx.rx_buffer = (uint8_t*)MALLOC(g_com_ctx.rx_buffer_size);
Jeej 24:a8433b091764 306 g_com_ctx.cts->rise(&cts_isr);
Jeej 24:a8433b091764 307 g_com_ctx.data_available = 0;
Jeej 24:a8433b091764 308 g_com_ctx.write_idx = 0;
Jeej 24:a8433b091764 309 g_com_ctx.read_idx = 0;
Jeej 24:a8433b091764 310 g_com_ctx.tx_seq = 0;
Jeej 24:a8433b091764 311 g_com_ctx.rx_seq = 0;
Jeej 24:a8433b091764 312
Jeej 24:a8433b091764 313 g_com_ctx.serial = new Serial(config->tx, config->rx);
Jeej 24:a8433b091764 314 g_com_ctx.rts = new DigitalOut(config->rts);
Jeej 24:a8433b091764 315 g_com_ctx.cts = new InterruptIn(config->cts);
Jeej 24:a8433b091764 316 g_com_ctx.data_parsing = new Semaphore(1);
Jeej 24:a8433b091764 317 g_com_ctx.cts_int = new Semaphore(1);
Jeej 25:aac250164497 318 g_com_ctx.thread = new Thread(d7a_com_thread, NULL, osPriorityBelowNormal, DEFAULT_STACK_SIZE*2);
Jeej 24:a8433b091764 319
Jeej 24:a8433b091764 320 /* XXX: Unknown bug:
Jeej 24:a8433b091764 321 Baud rate can be found with high error rate (> 4%).
Jeej 24:a8433b091764 322 It is here manualy corrected after an oscilloscope measure.
Jeej 24:a8433b091764 323 Normal Baudrate should be 115200.
Jeej 24:a8433b091764 324 */
Jeej 24:a8433b091764 325 g_com_ctx.serial->baud(117000); // XXX
Jeej 24:a8433b091764 326 g_com_ctx.serial->format(8, SerialBase::None, 1);
Jeej 24:a8433b091764 327 g_com_ctx.serial->attach(&rx_isr, Serial::RxIrq);
Jeej 24:a8433b091764 328 }
Jeej 24:a8433b091764 329
Jeej 24:a8433b091764 330 // Destructor
Jeej 24:a8433b091764 331 void d7a_com_close()
Jeej 24:a8433b091764 332 {
Jeej 25:aac250164497 333 FPRINT("\r\n");
Jeej 25:aac250164497 334 g_com_ctx.thread->terminate();
Jeej 24:a8433b091764 335 delete g_com_ctx.data_parsing;
Jeej 24:a8433b091764 336 delete g_com_ctx.cts_int;
Jeej 24:a8433b091764 337 delete g_com_ctx.serial;
Jeej 24:a8433b091764 338 delete g_com_ctx.rts;
Jeej 24:a8433b091764 339 delete g_com_ctx.cts;
Jeej 24:a8433b091764 340 FREE(g_com_ctx.rx_buffer);
Jeej 24:a8433b091764 341 }
Jeej 24:a8433b091764 342
Jeej 24:a8433b091764 343
Jeej 25:aac250164497 344
Jeej 24:a8433b091764 345
Jeej 24:a8433b091764 346 // Formats and send packet throught Serial.
Jeej 25:aac250164497 347 void d7a_com_send_msg(d7a_com_tx_msg_t* msg)
Jeej 24:a8433b091764 348 {
Jeej 25:aac250164497 349 FPRINT("\r\n");
Jeej 24:a8433b091764 350 uint8_t* buf;
Jeej 24:a8433b091764 351 uint16_t len = msg->alen + msg->plen;
Jeej 24:a8433b091764 352
Jeej 24:a8433b091764 353 buf = (uint8_t*)MALLOC(KAL_COM_HEADER_LEN + len);
Jeej 24:a8433b091764 354
Jeej 24:a8433b091764 355 // construct serial header
Jeej 24:a8433b091764 356 // concatenate and update tx_seq ID
Jeej 24:a8433b091764 357 buf[0] = (uint8_t)KAL_COM_SYNC_BYTE_0;
Jeej 24:a8433b091764 358 buf[1] = (uint8_t)KAL_COM_SYNC_BYTE_1;
Jeej 24:a8433b091764 359 buf[2] = (uint8_t)len;
Jeej 24:a8433b091764 360 buf[3] = (uint8_t)g_com_ctx.tx_seq++;
Jeej 24:a8433b091764 361 buf[4] = (uint8_t)msg->id;
Jeej 24:a8433b091764 362 len += KAL_COM_HEADER_LEN;
Jeej 24:a8433b091764 363
Jeej 24:a8433b091764 364 // copy payload and parameters
Jeej 24:a8433b091764 365 memcpy(buf + KAL_COM_HEADER_LEN, msg->pbuf, msg->plen);
Jeej 24:a8433b091764 366 memcpy(buf + KAL_COM_HEADER_LEN + msg->plen, msg->abuf, msg->alen);
Jeej 24:a8433b091764 367
Jeej 24:a8433b091764 368 //DPRINT("Sending %d bytes\r\n", len);
Jeej 24:a8433b091764 369
Jeej 24:a8433b091764 370 send(buf, len);
Jeej 24:a8433b091764 371
Jeej 24:a8433b091764 372 // Stats
Jeej 24:a8433b091764 373 g_com_ctx.tx_pkt_count++;
Jeej 24:a8433b091764 374 g_com_ctx.tx_byte_count += len;
Jeej 24:a8433b091764 375
Jeej 24:a8433b091764 376 FREE(buf);
Jeej 24:a8433b091764 377 }
Jeej 24:a8433b091764 378
Jeej 24:a8433b091764 379
Jeej 24:a8433b091764 380 // Thread for parsing packets from RX buffer.
Jeej 25:aac250164497 381 void d7a_com_thread( void const *p )
Jeej 24:a8433b091764 382 {
Jeej 25:aac250164497 383 FPRINT("\r\n");
Jeej 24:a8433b091764 384 while (true)
Jeej 24:a8433b091764 385 {
Jeej 24:a8433b091764 386 // wait for data available
Jeej 24:a8433b091764 387 g_com_ctx.data_parsing->wait();
Jeej 24:a8433b091764 388 // search for packets
Jeej 24:a8433b091764 389 parse_packet(g_com_ctx.read_idx, g_com_ctx.data_available);
Jeej 24:a8433b091764 390 FLUSH();
Jeej 24:a8433b091764 391 }
Jeej 24:a8433b091764 392 }