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@43:28202405094d, 2016-08-30 (annotated)

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

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 34:1311cc53201a 10
Jeej 37:e04613e021f2 11 #define XON_SIGNAL (0x0001 << 0)
Jeej 37:e04613e021f2 12 #define START_SIGNAL (0x0001 << 1)
Jeej 31:ab9bfdbc6b44 13
Jeej 31:ab9bfdbc6b44 14 typedef struct {
Jeej 31:ab9bfdbc6b44 15 uint32_t len;
Jeej 31:ab9bfdbc6b44 16 uint8_t* buf;
Jeej 31:ab9bfdbc6b44 17 } d7a_com_tx_buf_t;
Jeej 30:d775c1409849 18
Jeej 37:e04613e021f2 19 enum {
Jeej 37:e04613e021f2 20 SEARCH_HEADER,
Jeej 37:e04613e021f2 21 PARSE_HEADER,
Jeej 37:e04613e021f2 22 SEARCH_BODY,
Jeej 37:e04613e021f2 23 PARSE_BODY,
Jeej 37:e04613e021f2 24 };
Jeej 30:d775c1409849 25
Jeej 25:aac250164497 26 typedef struct {
Jeej 37:e04613e021f2 27 bool rx_started;
Jeej 37:e04613e021f2 28 bool tx_started;
Jeej 37:e04613e021f2 29
Jeej 37:e04613e021f2 30 uint8_t state;
Jeej 34:1311cc53201a 31
Jeej 25:aac250164497 32 DigitalOut* rts;
Jeej 25:aac250164497 33 InterruptIn* cts;
Jeej 25:aac250164497 34
Jeej 25:aac250164497 35 // RX buffer address
Jeej 25:aac250164497 36 uint8_t* rx_buffer;
Jeej 25:aac250164497 37 // RX buffer size
Jeej 25:aac250164497 38 uint16_t rx_buffer_size;
Jeej 25:aac250164497 39 // Write index in RX buffer
Jeej 25:aac250164497 40 volatile uint16_t write_idx;
Jeej 25:aac250164497 41 // Read index in RX buffer
Jeej 25:aac250164497 42 uint16_t read_idx;
Jeej 25:aac250164497 43 // Number of bytes available in RX buffer
Jeej 25:aac250164497 44 volatile uint16_t data_available;
Jeej 37:e04613e021f2 45 // min data in buffer before parsing body
Jeej 37:e04613e021f2 46 d7a_com_rx_msg_t msg;
Jeej 33:f9a542d3efaa 47 // Number of skipped bytes while parsing
Jeej 33:f9a542d3efaa 48 uint16_t skipped_bytes;
Jeej 33:f9a542d3efaa 49
Jeej 25:aac250164497 50 // Port TX sequence number
Jeej 25:aac250164497 51 uint8_t tx_seq;
Jeej 25:aac250164497 52 // Port RX sequence number
Jeej 25:aac250164497 53 uint8_t rx_seq;
Jeej 25:aac250164497 54 // Response to command maximum time
Jeej 25:aac250164497 55 uint32_t timeout;
Jeej 25:aac250164497 56
Jeej 25:aac250164497 57 // Waiting for data available in RX buffer
Jeej 25:aac250164497 58 Semaphore* data_parsing;
Jeej 25:aac250164497 59 // CTS management
Jeej 25:aac250164497 60 Semaphore* cts_int;
Jeej 25:aac250164497 61
Jeej 25:aac250164497 62 // Data treatment threads
Jeej 31:ab9bfdbc6b44 63 Thread* rx_thread;
Jeej 25:aac250164497 64 Serial* serial;
Jeej 25:aac250164497 65
Jeej 31:ab9bfdbc6b44 66 // Tx Thread
Jeej 31:ab9bfdbc6b44 67 Thread* tx_thread;
Jeej 31:ab9bfdbc6b44 68 Queue<d7a_com_tx_buf_t, 32> tx_queue;
Jeej 31:ab9bfdbc6b44 69
Jeej 34:1311cc53201a 70 Timer tim;
Jeej 34:1311cc53201a 71
Jeej 25:aac250164497 72 } d7a_com_ctx_t;
Jeej 24:a8433b091764 73
Jeej 31:ab9bfdbc6b44 74
Jeej 24:a8433b091764 75 static d7a_com_ctx_t g_com_ctx;
Jeej 24:a8433b091764 76
Jeej 24:a8433b091764 77 /**
Jeej 24:a8433b091764 78 Thread for parsing packets from RX buffer.
Jeej 24:a8433b091764 79
Jeej 24:a8433b091764 80 @param void
Jeej 24:a8433b091764 81 @return void
Jeej 24:a8433b091764 82 */
Jeej 31:ab9bfdbc6b44 83 void d7a_com_rx_thread( void const *p );
Jeej 31:ab9bfdbc6b44 84 void d7a_com_tx_thread( void const *p );
Jeej 31:ab9bfdbc6b44 85
Jeej 24:a8433b091764 86
Jeej 24:a8433b091764 87 /**
Jeej 24:a8433b091764 88 Serial Rx Interrupt Service Routine.
Jeej 24:a8433b091764 89 Add recevied bytes to the RX buffer.
Jeej 24:a8433b091764 90
Jeej 24:a8433b091764 91 @param void
Jeej 24:a8433b091764 92 @return void
Jeej 24:a8433b091764 93 */
Jeej 24:a8433b091764 94 void rx_isr()
Jeej 24:a8433b091764 95 {
Jeej 24:a8433b091764 96 // Loop just in case more than one character is in UART's receive FIFO buffer
Jeej 24:a8433b091764 97 // Stop if buffer full
Jeej 34:1311cc53201a 98 while (g_com_ctx.serial->readable())
Jeej 34:1311cc53201a 99 {
Jeej 34:1311cc53201a 100
Jeej 24:a8433b091764 101 g_com_ctx.rx_buffer[g_com_ctx.write_idx] = g_com_ctx.serial->getc();
Jeej 34:1311cc53201a 102 //PRINT("-");
Jeej 34:1311cc53201a 103
Jeej 43:28202405094d 104 //if (g_com_ctx.rx_started)
Jeej 34:1311cc53201a 105 {
Jeej 34:1311cc53201a 106 g_com_ctx.data_available++;
Jeej 34:1311cc53201a 107
Jeej 34:1311cc53201a 108 g_com_ctx.write_idx = (g_com_ctx.write_idx >= (g_com_ctx.rx_buffer_size-1))? 0 : g_com_ctx.write_idx+1;
Jeej 34:1311cc53201a 109 //g_com_ctx.write_idx = (g_com_ctx.write_idx + 1) % g_com_ctx.rx_buffer_size;
Jeej 43:28202405094d 110
Jeej 43:28202405094d 111 // unlock data parsing thread
Jeej 43:28202405094d 112 if (g_com_ctx.state == SEARCH_HEADER && g_com_ctx.data_available >= KAL_COM_HEADER_LEN)
Jeej 43:28202405094d 113 {
Jeej 43:28202405094d 114 g_com_ctx.state = PARSE_HEADER;
Jeej 43:28202405094d 115 g_com_ctx.data_parsing->release();
Jeej 43:28202405094d 116 }
Jeej 43:28202405094d 117 else if (g_com_ctx.state == SEARCH_BODY && g_com_ctx.data_available >= g_com_ctx.msg.blen)
Jeej 43:28202405094d 118 {
Jeej 43:28202405094d 119 g_com_ctx.state = PARSE_BODY;
Jeej 43:28202405094d 120 g_com_ctx.data_parsing->release();
Jeej 43:28202405094d 121 }
Jeej 34:1311cc53201a 122 }
Jeej 24:a8433b091764 123 }
Jeej 33:f9a542d3efaa 124
Jeej 43:28202405094d 125 ASSERT(g_com_ctx.data_available <= g_com_ctx.rx_buffer_size, "RX Buffer overflow! (%d/%d)\r\n", g_com_ctx.data_available, g_com_ctx.rx_buffer_size);
Jeej 24:a8433b091764 126 }
Jeej 24:a8433b091764 127
Jeej 24:a8433b091764 128 /**
Jeej 24:a8433b091764 129 CTS pin Interrupt Service Routine.
Jeej 24:a8433b091764 130 For flow control (not yet inplemented)
Jeej 24:a8433b091764 131
Jeej 24:a8433b091764 132 @param void
Jeej 24:a8433b091764 133 @return void
Jeej 24:a8433b091764 134 */
Jeej 24:a8433b091764 135 void cts_isr()
Jeej 24:a8433b091764 136 {
Jeej 34:1311cc53201a 137 //PRINT("CTS_INT\r\n");
Jeej 34:1311cc53201a 138 //g_com_ctx.cts_int->release();
Jeej 24:a8433b091764 139 }
Jeej 24:a8433b091764 140
Jeej 26:9f0b9833cac6 141 // D7a_com constructor.
Jeej 26:9f0b9833cac6 142 // Opens a serial port and monitors the input for ALP packets.
Jeej 26:9f0b9833cac6 143 // Pins are those of the host, not the modem:
Jeej 26:9f0b9833cac6 144 // TX-host -> RX-modem
Jeej 26:9f0b9833cac6 145 // RX-host <- TX-modem
Jeej 26:9f0b9833cac6 146 // RTS-host -> CTS-modem
Jeej 26:9f0b9833cac6 147 // CTS-host <- RTS-modem
Jeej 26:9f0b9833cac6 148 void d7a_com_open( const d7a_com_config_t* config )
Jeej 26:9f0b9833cac6 149 {
Jeej 26:9f0b9833cac6 150 FPRINT("\r\n");
Jeej 26:9f0b9833cac6 151
Jeej 37:e04613e021f2 152 g_com_ctx.rx_started = false;
Jeej 37:e04613e021f2 153 g_com_ctx.tx_started = false;
Jeej 37:e04613e021f2 154 g_com_ctx.state = SEARCH_HEADER;
Jeej 26:9f0b9833cac6 155 g_com_ctx.rx_buffer_size = config->rx_buffer_size;
Jeej 26:9f0b9833cac6 156 g_com_ctx.rx_buffer = (uint8_t*)MALLOC(g_com_ctx.rx_buffer_size);
Jeej 26:9f0b9833cac6 157 g_com_ctx.data_available = 0;
Jeej 33:f9a542d3efaa 158 g_com_ctx.skipped_bytes = 0;
Jeej 26:9f0b9833cac6 159 g_com_ctx.write_idx = 0;
Jeej 26:9f0b9833cac6 160 g_com_ctx.read_idx = 0;
Jeej 26:9f0b9833cac6 161 g_com_ctx.tx_seq = 0;
Jeej 26:9f0b9833cac6 162 g_com_ctx.rx_seq = 0;
Jeej 26:9f0b9833cac6 163
Jeej 26:9f0b9833cac6 164 g_com_ctx.serial = new Serial(config->tx, config->rx);
Jeej 26:9f0b9833cac6 165 g_com_ctx.rts = new DigitalOut(config->rts);
Jeej 26:9f0b9833cac6 166 g_com_ctx.cts = new InterruptIn(config->cts);
Jeej 34:1311cc53201a 167 g_com_ctx.data_parsing = new Semaphore(0);
Jeej 34:1311cc53201a 168 g_com_ctx.cts_int = new Semaphore(0);
Jeej 31:ab9bfdbc6b44 169
Jeej 34:1311cc53201a 170 g_com_ctx.cts->rise(&cts_isr);
Jeej 34:1311cc53201a 171
Jeej 26:9f0b9833cac6 172 /* XXX: Unknown bug:
Jeej 26:9f0b9833cac6 173 Baud rate can be found with high error rate (> 4%).
Jeej 26:9f0b9833cac6 174 It is here manualy corrected after an oscilloscope measure.
Jeej 26:9f0b9833cac6 175 Normal Baudrate should be 115200.
Jeej 26:9f0b9833cac6 176 */
Jeej 33:f9a542d3efaa 177 //g_com_ctx.serial->baud(117000); // XXX
Jeej 33:f9a542d3efaa 178 g_com_ctx.serial->baud(115200); // XXX
Jeej 34:1311cc53201a 179 //g_com_ctx.serial->baud(57600); // XXX
Jeej 26:9f0b9833cac6 180 g_com_ctx.serial->format(8, SerialBase::None, 1);
Jeej 26:9f0b9833cac6 181 g_com_ctx.serial->attach(&rx_isr, Serial::RxIrq);
Jeej 30:d775c1409849 182
Jeej 31:ab9bfdbc6b44 183 g_com_ctx.tx_thread = new Thread(d7a_com_tx_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE);
Jeej 31:ab9bfdbc6b44 184 g_com_ctx.rx_thread = new Thread(d7a_com_rx_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE);
Jeej 26:9f0b9833cac6 185 }
Jeej 26:9f0b9833cac6 186
Jeej 26:9f0b9833cac6 187 // Destructor
Jeej 26:9f0b9833cac6 188 void d7a_com_close()
Jeej 26:9f0b9833cac6 189 {
Jeej 26:9f0b9833cac6 190 FPRINT("\r\n");
Jeej 31:ab9bfdbc6b44 191 g_com_ctx.rx_thread->terminate();
Jeej 31:ab9bfdbc6b44 192 g_com_ctx.tx_thread->terminate();
Jeej 26:9f0b9833cac6 193 delete g_com_ctx.data_parsing;
Jeej 26:9f0b9833cac6 194 delete g_com_ctx.cts_int;
Jeej 26:9f0b9833cac6 195 delete g_com_ctx.serial;
Jeej 26:9f0b9833cac6 196 delete g_com_ctx.rts;
Jeej 26:9f0b9833cac6 197 delete g_com_ctx.cts;
Jeej 26:9f0b9833cac6 198 FREE(g_com_ctx.rx_buffer);
Jeej 26:9f0b9833cac6 199 }
Jeej 26:9f0b9833cac6 200
Jeej 37:e04613e021f2 201 void d7a_com_start_rx(void)
Jeej 37:e04613e021f2 202 {
Jeej 37:e04613e021f2 203 FPRINT("\r\n");
Jeej 37:e04613e021f2 204 g_com_ctx.rx_started = true;
Jeej 37:e04613e021f2 205 g_com_ctx.rx_thread->signal_set(START_SIGNAL);
Jeej 37:e04613e021f2 206 }
Jeej 37:e04613e021f2 207
Jeej 37:e04613e021f2 208 void d7a_com_stop_rx(void)
Jeej 34:1311cc53201a 209 {
Jeej 34:1311cc53201a 210 FPRINT("\r\n");
Jeej 37:e04613e021f2 211 g_com_ctx.rx_started = false;
Jeej 37:e04613e021f2 212 }
Jeej 37:e04613e021f2 213
Jeej 37:e04613e021f2 214 void d7a_com_start_tx(void)
Jeej 37:e04613e021f2 215 {
Jeej 37:e04613e021f2 216 FPRINT("\r\n");
Jeej 37:e04613e021f2 217 g_com_ctx.tx_started = true;
Jeej 37:e04613e021f2 218 g_com_ctx.tx_thread->signal_set(START_SIGNAL);
Jeej 37:e04613e021f2 219 }
Jeej 37:e04613e021f2 220
Jeej 37:e04613e021f2 221 void d7a_com_stop_tx(void)
Jeej 37:e04613e021f2 222 {
Jeej 37:e04613e021f2 223 FPRINT("\r\n");
Jeej 37:e04613e021f2 224 g_com_ctx.tx_started = false;
Jeej 34:1311cc53201a 225 }
Jeej 34:1311cc53201a 226
Jeej 34:1311cc53201a 227 void d7a_com_restart(void)
Jeej 34:1311cc53201a 228 {
Jeej 34:1311cc53201a 229 FPRINT("\r\n");
Jeej 37:e04613e021f2 230 d7a_com_stop_rx();
Jeej 37:e04613e021f2 231 d7a_com_stop_tx();
Jeej 43:28202405094d 232
Jeej 43:28202405094d 233 g_com_ctx.state = SEARCH_HEADER;
Jeej 34:1311cc53201a 234 g_com_ctx.data_available = 0;
Jeej 34:1311cc53201a 235 g_com_ctx.skipped_bytes = 0;
Jeej 34:1311cc53201a 236 g_com_ctx.write_idx = 0;
Jeej 34:1311cc53201a 237 g_com_ctx.read_idx = 0;
Jeej 34:1311cc53201a 238 g_com_ctx.tx_seq = 0;
Jeej 34:1311cc53201a 239 g_com_ctx.rx_seq = 0;
Jeej 34:1311cc53201a 240
Jeej 34:1311cc53201a 241 d7a_com_tx_buf_t* msg;
Jeej 34:1311cc53201a 242 d7a_com_rx_msg_t* pkt;
Jeej 34:1311cc53201a 243 osEvent evt;
Jeej 34:1311cc53201a 244
Jeej 34:1311cc53201a 245 // Flush TX queue
Jeej 34:1311cc53201a 246 do
Jeej 34:1311cc53201a 247 {
Jeej 34:1311cc53201a 248 // wait for data
Jeej 34:1311cc53201a 249 evt = g_com_ctx.tx_queue.get(1);
Jeej 34:1311cc53201a 250 msg = (evt.status == osEventMessage)? (d7a_com_tx_buf_t*)evt.value.p : NULL;
Jeej 34:1311cc53201a 251
Jeej 34:1311cc53201a 252 // free message
Jeej 34:1311cc53201a 253 if (msg != NULL)
Jeej 34:1311cc53201a 254 {
Jeej 34:1311cc53201a 255 FREE(msg->buf);
Jeej 34:1311cc53201a 256 FREE(msg);
Jeej 34:1311cc53201a 257 }
Jeej 34:1311cc53201a 258 } while (msg != NULL);
Jeej 34:1311cc53201a 259
Jeej 34:1311cc53201a 260 // Flush RX
Jeej 34:1311cc53201a 261 for (int i = 0 ; i < 3 ; i++)
Jeej 34:1311cc53201a 262 {
Jeej 34:1311cc53201a 263 do
Jeej 34:1311cc53201a 264 {
Jeej 34:1311cc53201a 265 // wait for data
Jeej 34:1311cc53201a 266 if (i == 0)
Jeej 34:1311cc53201a 267 {
Jeej 34:1311cc53201a 268 pkt = d7a_modem_wait_pkt(1);
Jeej 34:1311cc53201a 269 }
Jeej 34:1311cc53201a 270 else if (i == 1)
Jeej 34:1311cc53201a 271 {
Jeej 34:1311cc53201a 272 pkt = d7a_fs_wait_pkt(1);
Jeej 34:1311cc53201a 273 }
Jeej 34:1311cc53201a 274 else
Jeej 34:1311cc53201a 275 {
Jeej 34:1311cc53201a 276 pkt = d7a_sys_wait_pkt(1);
Jeej 34:1311cc53201a 277 }
Jeej 34:1311cc53201a 278
Jeej 34:1311cc53201a 279 // free message
Jeej 34:1311cc53201a 280 if (pkt != NULL)
Jeej 34:1311cc53201a 281 {
Jeej 34:1311cc53201a 282 FREE(pkt);
Jeej 34:1311cc53201a 283 }
Jeej 34:1311cc53201a 284 } while (pkt != NULL);
Jeej 34:1311cc53201a 285 }
Jeej 34:1311cc53201a 286
Jeej 37:e04613e021f2 287 d7a_com_start_rx();
Jeej 37:e04613e021f2 288 d7a_com_start_tx();
Jeej 34:1311cc53201a 289 }
Jeej 34:1311cc53201a 290
Jeej 43:28202405094d 291
Jeej 34:1311cc53201a 292 static void d7a_com_copy_to_linear(uint8_t* linear_buffer, uint16_t read_start, uint16_t length)
Jeej 34:1311cc53201a 293 {
Jeej 34:1311cc53201a 294 uint16_t first_part_size;
Jeej 34:1311cc53201a 295 uint16_t second_part_size;
Jeej 34:1311cc53201a 296
Jeej 34:1311cc53201a 297 ASSERT(length <= g_com_ctx.rx_buffer_size, "Length too long (%d) for buffer size (%d)\r\n", length, g_com_ctx.rx_buffer_size);
Jeej 34:1311cc53201a 298
Jeej 34:1311cc53201a 299 read_start %= g_com_ctx.rx_buffer_size;
Jeej 34:1311cc53201a 300 first_part_size = (length > (g_com_ctx.rx_buffer_size - read_start))? g_com_ctx.rx_buffer_size - read_start : length;
Jeej 34:1311cc53201a 301
Jeej 34:1311cc53201a 302 memcpy((void*)&linear_buffer[0], (const void*)&g_com_ctx.rx_buffer[read_start], first_part_size);
Jeej 34:1311cc53201a 303
Jeej 34:1311cc53201a 304 // The circular buffer is wrapping
Jeej 34:1311cc53201a 305 if (length > first_part_size)
Jeej 34:1311cc53201a 306 {
Jeej 34:1311cc53201a 307 second_part_size = length - first_part_size;
Jeej 34:1311cc53201a 308 memcpy((void*)&linear_buffer[first_part_size], (const void*)&g_com_ctx.rx_buffer[0], second_part_size);
Jeej 34:1311cc53201a 309 }
Jeej 34:1311cc53201a 310 }
Jeej 24:a8433b091764 311
Jeej 24:a8433b091764 312 /**
Jeej 24:a8433b091764 313 Wakes-up modem and send data throught Serial.
Jeej 24:a8433b091764 314
Jeej 24:a8433b091764 315 @param const uint8_t* Pointer to data buffer
Jeej 24:a8433b091764 316 @param int Data length
Jeej 24:a8433b091764 317 @return void
Jeej 24:a8433b091764 318 */
Jeej 26:9f0b9833cac6 319 static void d7a_com_send(const uint8_t* buffer, int length)
Jeej 24:a8433b091764 320 {
Jeej 31:ab9bfdbc6b44 321 FPRINT("(len:%d)\r\n", length);
Jeej 34:1311cc53201a 322
Jeej 24:a8433b091764 323 *(g_com_ctx.rts) = 1;
Jeej 24:a8433b091764 324
Jeej 31:ab9bfdbc6b44 325 //dbg_print_data("%02X ", (uint8_t*)buffer, length);
Jeej 31:ab9bfdbc6b44 326 //DPRINT("\r\n");
Jeej 43:28202405094d 327 Thread::wait(2);
Jeej 24:a8433b091764 328
Jeej 34:1311cc53201a 329 for (uint32_t i=0 ; i<length ; i++)
Jeej 24:a8433b091764 330 {
Jeej 24:a8433b091764 331 g_com_ctx.serial->putc(buffer[i]);
Jeej 24:a8433b091764 332 }
Jeej 24:a8433b091764 333
Jeej 43:28202405094d 334 //Thread::wait(2);
Jeej 43:28202405094d 335
Jeej 24:a8433b091764 336 *(g_com_ctx.rts) = 0;
Jeej 24:a8433b091764 337 }
Jeej 24:a8433b091764 338
Jeej 31:ab9bfdbc6b44 339
Jeej 31:ab9bfdbc6b44 340 static void d7a_com_post_tx(uint8_t* buffer, uint32_t length)
Jeej 31:ab9bfdbc6b44 341 {
Jeej 31:ab9bfdbc6b44 342 FPRINT("(len:%d)\r\n", length);
Jeej 34:1311cc53201a 343
Jeej 31:ab9bfdbc6b44 344 d7a_com_tx_buf_t* tx_buf = (d7a_com_tx_buf_t*)MALLOC(sizeof(d7a_com_tx_buf_t));
Jeej 31:ab9bfdbc6b44 345
Jeej 31:ab9bfdbc6b44 346 tx_buf->len = length;
Jeej 37:e04613e021f2 347 tx_buf->buf = buffer;
Jeej 31:ab9bfdbc6b44 348
Jeej 31:ab9bfdbc6b44 349 g_com_ctx.tx_queue.put(tx_buf);
Jeej 31:ab9bfdbc6b44 350 }
Jeej 31:ab9bfdbc6b44 351
Jeej 26:9f0b9833cac6 352 // Formats and send packet throught Serial.
Jeej 26:9f0b9833cac6 353 void d7a_com_send_msg(d7a_com_tx_msg_t* msg)
Jeej 34:1311cc53201a 354 {
Jeej 34:1311cc53201a 355 uint8_t* buf;
Jeej 34:1311cc53201a 356 uint16_t len = msg->alen + msg->plen;
Jeej 34:1311cc53201a 357 FPRINT("(len:%d)\r\n", len);
Jeej 34:1311cc53201a 358
Jeej 34:1311cc53201a 359 buf = (uint8_t*)MALLOC(KAL_COM_HEADER_LEN + len);
Jeej 34:1311cc53201a 360
Jeej 34:1311cc53201a 361 // construct serial header
Jeej 34:1311cc53201a 362 // concatenate and update tx_seq ID
Jeej 34:1311cc53201a 363 buf[0] = (uint8_t)KAL_COM_SYNC_BYTE_0;
Jeej 34:1311cc53201a 364 buf[1] = (uint8_t)KAL_COM_SYNC_BYTE_1;
Jeej 34:1311cc53201a 365 buf[2] = (uint8_t)len;
Jeej 34:1311cc53201a 366 buf[3] = (uint8_t)g_com_ctx.tx_seq++;
Jeej 34:1311cc53201a 367 buf[4] = (uint8_t)msg->id;
Jeej 34:1311cc53201a 368 len += KAL_COM_HEADER_LEN;
Jeej 34:1311cc53201a 369
Jeej 34:1311cc53201a 370 // copy payload and parameters
Jeej 34:1311cc53201a 371 memcpy(buf + KAL_COM_HEADER_LEN, msg->pbuf, msg->plen);
Jeej 34:1311cc53201a 372 memcpy(buf + KAL_COM_HEADER_LEN + msg->plen, msg->abuf, msg->alen);
Jeej 34:1311cc53201a 373
Jeej 34:1311cc53201a 374 DPRINT("<-- (0x%02X) %d\r\n", buf[4], (len - KAL_COM_HEADER_LEN));
Jeej 34:1311cc53201a 375
Jeej 34:1311cc53201a 376 d7a_com_send(buf, len);
Jeej 34:1311cc53201a 377 }
Jeej 34:1311cc53201a 378
Jeej 34:1311cc53201a 379 void d7a_com_post_msg(d7a_com_tx_msg_t* msg)
Jeej 34:1311cc53201a 380 {
Jeej 26:9f0b9833cac6 381 uint8_t* buf;
Jeej 26:9f0b9833cac6 382 uint16_t len = msg->alen + msg->plen;
Jeej 30:d775c1409849 383 FPRINT("(len:%d)\r\n", len);
Jeej 26:9f0b9833cac6 384
Jeej 26:9f0b9833cac6 385 buf = (uint8_t*)MALLOC(KAL_COM_HEADER_LEN + len);
Jeej 26:9f0b9833cac6 386
Jeej 26:9f0b9833cac6 387 // construct serial header
Jeej 26:9f0b9833cac6 388 // concatenate and update tx_seq ID
Jeej 26:9f0b9833cac6 389 buf[0] = (uint8_t)KAL_COM_SYNC_BYTE_0;
Jeej 26:9f0b9833cac6 390 buf[1] = (uint8_t)KAL_COM_SYNC_BYTE_1;
Jeej 26:9f0b9833cac6 391 buf[2] = (uint8_t)len;
Jeej 26:9f0b9833cac6 392 buf[3] = (uint8_t)g_com_ctx.tx_seq++;
Jeej 26:9f0b9833cac6 393 buf[4] = (uint8_t)msg->id;
Jeej 26:9f0b9833cac6 394 len += KAL_COM_HEADER_LEN;
Jeej 26:9f0b9833cac6 395
Jeej 26:9f0b9833cac6 396 // copy payload and parameters
Jeej 26:9f0b9833cac6 397 memcpy(buf + KAL_COM_HEADER_LEN, msg->pbuf, msg->plen);
Jeej 26:9f0b9833cac6 398 memcpy(buf + KAL_COM_HEADER_LEN + msg->plen, msg->abuf, msg->alen);
Jeej 26:9f0b9833cac6 399
Jeej 31:ab9bfdbc6b44 400 d7a_com_post_tx(buf, len);
Jeej 26:9f0b9833cac6 401 }
Jeej 26:9f0b9833cac6 402
Jeej 31:ab9bfdbc6b44 403
Jeej 30:d775c1409849 404 void d7a_com_dump(uint8_t* buf, uint8_t len, d7a_com_flow_t flow)
Jeej 30:d775c1409849 405 {
Jeej 30:d775c1409849 406 d7a_com_tx_msg_t msg;
Jeej 30:d775c1409849 407
Jeej 30:d775c1409849 408 msg.id = flow;
Jeej 30:d775c1409849 409 msg.pbuf = buf;
Jeej 30:d775c1409849 410 msg.plen = len;
Jeej 30:d775c1409849 411 msg.alen = 0;
Jeej 34:1311cc53201a 412 d7a_com_post_msg(&msg);
Jeej 30:d775c1409849 413 }
Jeej 30:d775c1409849 414
Jeej 34:1311cc53201a 415 void d7a_com_force_dump(uint8_t* buf, uint8_t len, d7a_com_flow_t flow)
Jeej 33:f9a542d3efaa 416 {
Jeej 34:1311cc53201a 417 d7a_com_tx_msg_t msg;
Jeej 34:1311cc53201a 418
Jeej 34:1311cc53201a 419 msg.id = flow;
Jeej 34:1311cc53201a 420 msg.pbuf = buf;
Jeej 34:1311cc53201a 421 msg.plen = len;
Jeej 34:1311cc53201a 422 msg.alen = 0;
Jeej 34:1311cc53201a 423 d7a_com_send_msg(&msg);
Jeej 33:f9a542d3efaa 424 }
Jeej 26:9f0b9833cac6 425
Jeej 25:aac250164497 426 static void d7a_com_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 427 {
Jeej 26:9f0b9833cac6 428 //FPRINT("\r\n");
Jeej 35:1fe2975c5a63 429
Jeej 35:1fe2975c5a63 430 DPRINT("--> (0x%02X) %d\r\n", pkt->id, pkt->blen);
Jeej 35:1fe2975c5a63 431
Jeej 25:aac250164497 432 // Distribute packet types to processes
Jeej 25:aac250164497 433 switch (KAL_COM_FLOWID(pkt->id))
Jeej 25:aac250164497 434 {
Jeej 25:aac250164497 435 case KAL_COM_FLOWID_FS:
Jeej 25:aac250164497 436 d7a_fs_new_pkt(pkt);
Jeej 25:aac250164497 437 break;
Jeej 25:aac250164497 438 case KAL_COM_FLOWID_CMD:
Jeej 25:aac250164497 439 d7a_modem_new_pkt(pkt);
Jeej 25:aac250164497 440 break;
Jeej 25:aac250164497 441 case KAL_COM_FLOWID_SYS:
Jeej 30:d775c1409849 442 // This has to be here to avoid going to another process
Jeej 30:d775c1409849 443 if (pkt->id == KAL_COM_FLOW_SYS_XON)
Jeej 30:d775c1409849 444 {
Jeej 43:28202405094d 445 DPRINT("XON\r\n");
Jeej 34:1311cc53201a 446 g_com_ctx.tx_thread->signal_set(XON_SIGNAL);
Jeej 30:d775c1409849 447 FREE(pkt);
Jeej 30:d775c1409849 448 }
Jeej 30:d775c1409849 449 else if (pkt->id == KAL_COM_FLOW_SYS_XOFF)
Jeej 30:d775c1409849 450 {
Jeej 43:28202405094d 451 DPRINT("XOFF\r\n");
Jeej 34:1311cc53201a 452 d7a_sys_xack();
Jeej 30:d775c1409849 453 FREE(pkt);
Jeej 30:d775c1409849 454 }
Jeej 30:d775c1409849 455 else
Jeej 30:d775c1409849 456 {
Jeej 34:1311cc53201a 457 if (KAL_COM_FLOW_SYS_PONG == pkt->id)
Jeej 34:1311cc53201a 458 {
Jeej 34:1311cc53201a 459 g_com_ctx.tim.stop();
Jeej 34:1311cc53201a 460 uint32_t time_us = g_com_ctx.tim.read_us();
Jeej 34:1311cc53201a 461 IPRINT("Ping in %d.%03dms\r\n", time_us/1000, time_us%1000);
Jeej 34:1311cc53201a 462 }
Jeej 30:d775c1409849 463 d7a_sys_new_pkt(pkt);
Jeej 30:d775c1409849 464 }
Jeej 30:d775c1409849 465 break;
Jeej 25:aac250164497 466 default:
Jeej 25:aac250164497 467 EPRINT("Untreated pkt type 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 468 FREE(pkt);
Jeej 25:aac250164497 469 break;
Jeej 25:aac250164497 470 }
Jeej 25:aac250164497 471 }
Jeej 24:a8433b091764 472
Jeej 37:e04613e021f2 473 void d7a_com_forward_buffer(uint8_t size)
Jeej 37:e04613e021f2 474 {
Jeej 37:e04613e021f2 475 g_com_ctx.read_idx = (g_com_ctx.read_idx + size) % g_com_ctx.rx_buffer_size;
Jeej 37:e04613e021f2 476 g_com_ctx.data_available -= size;
Jeej 37:e04613e021f2 477 }
Jeej 33:f9a542d3efaa 478
Jeej 24:a8433b091764 479 /**
Jeej 34:1311cc53201a 480 Reads the Rx buffer, parses the packets
Jeej 24:a8433b091764 481
Jeej 24:a8433b091764 482 @param void
Jeej 24:a8433b091764 483 @return void
Jeej 24:a8433b091764 484 */
Jeej 37:e04613e021f2 485 static void parse_packet_header(void)
Jeej 24:a8433b091764 486 {
Jeej 37:e04613e021f2 487 uint8_t header[KAL_COM_HEADER_LEN];
Jeej 37:e04613e021f2 488 uint8_t seqnum;
Jeej 33:f9a542d3efaa 489
Jeej 43:28202405094d 490 ASSERT(g_com_ctx.data_available >= KAL_COM_HEADER_LEN, "Not enough data for header\r\n");
Jeej 43:28202405094d 491
Jeej 37:e04613e021f2 492 g_com_ctx.skipped_bytes = 0;
Jeej 33:f9a542d3efaa 493
Jeej 37:e04613e021f2 494 // Lookup fist sync byte
Jeej 37:e04613e021f2 495 while (g_com_ctx.data_available >= KAL_COM_HEADER_LEN)
Jeej 24:a8433b091764 496 {
Jeej 37:e04613e021f2 497 if(KAL_COM_SYNC_BYTE_0 == g_com_ctx.rx_buffer[g_com_ctx.read_idx])
Jeej 24:a8433b091764 498 {
Jeej 37:e04613e021f2 499 // copy following data
Jeej 37:e04613e021f2 500 d7a_com_copy_to_linear(header, g_com_ctx.read_idx, KAL_COM_HEADER_LEN);
Jeej 37:e04613e021f2 501 if (KAL_COM_SYNC_BYTE_1 == header[1])
Jeej 33:f9a542d3efaa 502 {
Jeej 37:e04613e021f2 503 // Fill temp header
Jeej 37:e04613e021f2 504 g_com_ctx.msg.blen = header[2];
Jeej 37:e04613e021f2 505 seqnum = header[3];
Jeej 37:e04613e021f2 506 g_com_ctx.msg.id = header[4];
Jeej 37:e04613e021f2 507
Jeej 37:e04613e021f2 508 // Update seqnum
Jeej 37:e04613e021f2 509 WARNING(g_com_ctx.rx_seq == seqnum, "COM Bad seqnum expected:%d got:%d\r\n", g_com_ctx.rx_seq, seqnum);
Jeej 37:e04613e021f2 510 g_com_ctx.rx_seq = seqnum + 1;
Jeej 37:e04613e021f2 511
Jeej 37:e04613e021f2 512 // search for body
Jeej 37:e04613e021f2 513 d7a_com_forward_buffer(KAL_COM_HEADER_LEN);
Jeej 37:e04613e021f2 514 g_com_ctx.state = SEARCH_BODY;
Jeej 43:28202405094d 515
Jeej 43:28202405094d 516 // Start parsing if data is already available
Jeej 43:28202405094d 517 if (g_com_ctx.data_available >= g_com_ctx.msg.blen)
Jeej 43:28202405094d 518 {
Jeej 43:28202405094d 519 g_com_ctx.state = PARSE_BODY;
Jeej 43:28202405094d 520 g_com_ctx.data_parsing->release();
Jeej 43:28202405094d 521 }
Jeej 43:28202405094d 522
Jeej 43:28202405094d 523 DPRINT("COM header found (body %d/%d bytes)\r\n", g_com_ctx.data_available, g_com_ctx.msg.blen);
Jeej 33:f9a542d3efaa 524 break;
Jeej 33:f9a542d3efaa 525 }
Jeej 24:a8433b091764 526 }
Jeej 37:e04613e021f2 527
Jeej 37:e04613e021f2 528 // byte skipped
Jeej 37:e04613e021f2 529 WARNING(g_com_ctx.skipped_bytes != 1, "COM not sync. Searching for header.\r\n");
Jeej 37:e04613e021f2 530 d7a_com_forward_buffer(1);
Jeej 37:e04613e021f2 531 }
Jeej 37:e04613e021f2 532
Jeej 37:e04613e021f2 533 if (g_com_ctx.skipped_bytes)
Jeej 37:e04613e021f2 534 {
Jeej 37:e04613e021f2 535 WARNING(false, "Skipped %d bytes.\r\n", g_com_ctx.skipped_bytes);
Jeej 37:e04613e021f2 536 #if 0
Jeej 37:e04613e021f2 537 uint8_t* temp = (uint8_t*)MALLOC(g_com_ctx.skipped_bytes);
Jeej 37:e04613e021f2 538 d7a_com_copy_to_linear(temp, g_com_ctx.read_idx - g_com_ctx.skipped_bytes, g_com_ctx.skipped_bytes);
Jeej 37:e04613e021f2 539 PRINT_DATA("", "%02X ", temp, g_com_ctx.skipped_bytes, "\r\n");
Jeej 37:e04613e021f2 540 FREE(temp);
Jeej 34:1311cc53201a 541 #endif
Jeej 37:e04613e021f2 542 g_com_ctx.skipped_bytes = 0;
Jeej 37:e04613e021f2 543 }
Jeej 37:e04613e021f2 544 }
Jeej 37:e04613e021f2 545
Jeej 37:e04613e021f2 546 /**
Jeej 37:e04613e021f2 547 Reads the Rx buffer, parses the packets
Jeej 37:e04613e021f2 548
Jeej 37:e04613e021f2 549 @param void
Jeej 37:e04613e021f2 550 @return void
Jeej 37:e04613e021f2 551 */
Jeej 37:e04613e021f2 552 static void parse_packet_body(void)
Jeej 37:e04613e021f2 553 {
Jeej 43:28202405094d 554 ASSERT(g_com_ctx.data_available >= g_com_ctx.msg.blen, "Not enough data for body\r\n");
Jeej 43:28202405094d 555
Jeej 37:e04613e021f2 556 if (KAL_COM_FLOWID(g_com_ctx.msg.id) != KAL_COM_FLOWID_TRC)
Jeej 37:e04613e021f2 557 {
Jeej 37:e04613e021f2 558 //DPRINT("Got packet id 0x%02X len %d\r\n", id, len);
Jeej 37:e04613e021f2 559
Jeej 37:e04613e021f2 560 d7a_com_rx_msg_t* pkt = NULL;
Jeej 37:e04613e021f2 561 pkt = (d7a_com_rx_msg_t*)MALLOC(sizeof(d7a_com_rx_msg_t) - 1 + g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 562
Jeej 37:e04613e021f2 563 // copy data to buffer
Jeej 37:e04613e021f2 564 pkt->blen = g_com_ctx.msg.blen;
Jeej 37:e04613e021f2 565 pkt->id = g_com_ctx.msg.id;
Jeej 37:e04613e021f2 566 d7a_com_copy_to_linear(pkt->buffer, g_com_ctx.read_idx, g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 567
Jeej 37:e04613e021f2 568 // add packet to queue
Jeej 37:e04613e021f2 569 d7a_com_new_pkt(pkt);
Jeej 37:e04613e021f2 570 }
Jeej 37:e04613e021f2 571 else
Jeej 37:e04613e021f2 572 {
Jeej 37:e04613e021f2 573 // Ignore packet
Jeej 24:a8433b091764 574 }
Jeej 33:f9a542d3efaa 575
Jeej 33:f9a542d3efaa 576 // update buffer indexes
Jeej 37:e04613e021f2 577 d7a_com_forward_buffer(g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 578 g_com_ctx.state = SEARCH_HEADER;
Jeej 43:28202405094d 579
Jeej 43:28202405094d 580 // Start parsing if data is already available
Jeej 43:28202405094d 581 if (g_com_ctx.data_available >= KAL_COM_HEADER_LEN)
Jeej 43:28202405094d 582 {
Jeej 43:28202405094d 583 g_com_ctx.state = PARSE_HEADER;
Jeej 43:28202405094d 584 g_com_ctx.data_parsing->release();
Jeej 43:28202405094d 585 }
Jeej 24:a8433b091764 586 }
Jeej 24:a8433b091764 587
Jeej 24:a8433b091764 588
Jeej 24:a8433b091764 589 // Thread for parsing packets from RX buffer.
Jeej 31:ab9bfdbc6b44 590 void d7a_com_rx_thread( void const *p )
Jeej 24:a8433b091764 591 {
Jeej 25:aac250164497 592 FPRINT("\r\n");
Jeej 24:a8433b091764 593 while (true)
Jeej 24:a8433b091764 594 {
Jeej 37:e04613e021f2 595 if (!g_com_ctx.rx_started)
Jeej 37:e04613e021f2 596 {
Jeej 37:e04613e021f2 597 g_com_ctx.rx_thread->signal_wait(START_SIGNAL);
Jeej 37:e04613e021f2 598 }
Jeej 37:e04613e021f2 599
Jeej 24:a8433b091764 600 // wait for data available
Jeej 24:a8433b091764 601 g_com_ctx.data_parsing->wait();
Jeej 37:e04613e021f2 602
Jeej 37:e04613e021f2 603 if (g_com_ctx.state == PARSE_HEADER)
Jeej 33:f9a542d3efaa 604 {
Jeej 37:e04613e021f2 605 parse_packet_header();
Jeej 37:e04613e021f2 606 }
Jeej 37:e04613e021f2 607 else if (g_com_ctx.state == PARSE_BODY)
Jeej 37:e04613e021f2 608 {
Jeej 37:e04613e021f2 609 parse_packet_body();
Jeej 33:f9a542d3efaa 610 }
Jeej 24:a8433b091764 611 }
Jeej 24:a8433b091764 612 }
Jeej 31:ab9bfdbc6b44 613
Jeej 31:ab9bfdbc6b44 614 void d7a_com_tx_thread( void const *p )
Jeej 31:ab9bfdbc6b44 615 {
Jeej 31:ab9bfdbc6b44 616 FPRINT("\r\n");
Jeej 31:ab9bfdbc6b44 617
Jeej 31:ab9bfdbc6b44 618 d7a_com_tx_buf_t* msg;
Jeej 31:ab9bfdbc6b44 619 osEvent evt;
Jeej 34:1311cc53201a 620 uint8_t flow_id;
Jeej 34:1311cc53201a 621
Jeej 31:ab9bfdbc6b44 622 while (true)
Jeej 31:ab9bfdbc6b44 623 {
Jeej 37:e04613e021f2 624 if (!g_com_ctx.tx_started)
Jeej 37:e04613e021f2 625 {
Jeej 37:e04613e021f2 626 g_com_ctx.tx_thread->signal_wait(START_SIGNAL);
Jeej 37:e04613e021f2 627 }
Jeej 37:e04613e021f2 628
Jeej 31:ab9bfdbc6b44 629 // wait for data to send
Jeej 31:ab9bfdbc6b44 630 evt = g_com_ctx.tx_queue.get();
Jeej 31:ab9bfdbc6b44 631 msg = (evt.status == osEventMessage)? (d7a_com_tx_buf_t*)evt.value.p : NULL;
Jeej 37:e04613e021f2 632
Jeej 31:ab9bfdbc6b44 633
Jeej 31:ab9bfdbc6b44 634 // send message
Jeej 31:ab9bfdbc6b44 635 if (msg != NULL)
Jeej 31:ab9bfdbc6b44 636 {
Jeej 34:1311cc53201a 637 flow_id = msg->buf[4];
Jeej 34:1311cc53201a 638 DPRINT("<-- (0x%02X) %d\r\n", flow_id, (msg->len - KAL_COM_HEADER_LEN));
Jeej 34:1311cc53201a 639
Jeej 31:ab9bfdbc6b44 640 d7a_com_send(msg->buf, msg->len);
Jeej 31:ab9bfdbc6b44 641 FREE(msg->buf);
Jeej 31:ab9bfdbc6b44 642 FREE(msg);
Jeej 34:1311cc53201a 643
Jeej 34:1311cc53201a 644 if (KAL_COM_FLOW_SYS_PING == flow_id)
Jeej 34:1311cc53201a 645 {
Jeej 34:1311cc53201a 646 g_com_ctx.tim.reset();
Jeej 34:1311cc53201a 647 g_com_ctx.tim.start();
Jeej 34:1311cc53201a 648 }
Jeej 34:1311cc53201a 649
Jeej 34:1311cc53201a 650 if (KAL_COM_FLOW_SYS_XACK == flow_id)
Jeej 34:1311cc53201a 651 {
Jeej 43:28202405094d 652 DPRINT("XACK\r\n");
Jeej 34:1311cc53201a 653 g_com_ctx.tx_thread->signal_wait(XON_SIGNAL);
Jeej 34:1311cc53201a 654 }
Jeej 31:ab9bfdbc6b44 655 }
Jeej 31:ab9bfdbc6b44 656 }
Jeej 31:ab9bfdbc6b44 657 }