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@37:e04613e021f2, 2016-08-24 (annotated)

Committer:
Jeej
Date:
Wed Aug 24 17:31:51 2016 +0000
Revision:
37:e04613e021f2
Parent:
35:1fe2975c5a63
Child:
39:2101208fafb6
Child:
43:28202405094d
Auto recovery on modem reboot. Risk of error if the user send a command during the recovery.

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 37:e04613e021f2 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 34:1311cc53201a 110 }
Jeej 24:a8433b091764 111 }
Jeej 33:f9a542d3efaa 112
Jeej 37:e04613e021f2 113 //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 34:1311cc53201a 114
Jeej 24:a8433b091764 115 // unlock data parsing thread
Jeej 37:e04613e021f2 116 if (g_com_ctx.state == SEARCH_HEADER && g_com_ctx.data_available >= KAL_COM_HEADER_LEN)
Jeej 37:e04613e021f2 117 {
Jeej 37:e04613e021f2 118 g_com_ctx.state = PARSE_HEADER;
Jeej 37:e04613e021f2 119 g_com_ctx.data_parsing->release();
Jeej 37:e04613e021f2 120 }
Jeej 37:e04613e021f2 121 else if (g_com_ctx.state == SEARCH_BODY && g_com_ctx.data_available >= g_com_ctx.msg.blen)
Jeej 37:e04613e021f2 122 {
Jeej 37:e04613e021f2 123 g_com_ctx.state = PARSE_BODY;
Jeej 37:e04613e021f2 124 g_com_ctx.data_parsing->release();
Jeej 37:e04613e021f2 125 }
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 37:e04613e021f2 232
Jeej 34:1311cc53201a 233 g_com_ctx.data_available = 0;
Jeej 34:1311cc53201a 234 g_com_ctx.skipped_bytes = 0;
Jeej 34:1311cc53201a 235 g_com_ctx.write_idx = 0;
Jeej 34:1311cc53201a 236 g_com_ctx.read_idx = 0;
Jeej 34:1311cc53201a 237 g_com_ctx.tx_seq = 0;
Jeej 34:1311cc53201a 238 g_com_ctx.rx_seq = 0;
Jeej 34:1311cc53201a 239
Jeej 34:1311cc53201a 240 d7a_com_tx_buf_t* msg;
Jeej 34:1311cc53201a 241 d7a_com_rx_msg_t* pkt;
Jeej 34:1311cc53201a 242 osEvent evt;
Jeej 34:1311cc53201a 243
Jeej 34:1311cc53201a 244 // Flush TX queue
Jeej 34:1311cc53201a 245 do
Jeej 34:1311cc53201a 246 {
Jeej 34:1311cc53201a 247 // wait for data
Jeej 34:1311cc53201a 248 evt = g_com_ctx.tx_queue.get(1);
Jeej 34:1311cc53201a 249 msg = (evt.status == osEventMessage)? (d7a_com_tx_buf_t*)evt.value.p : NULL;
Jeej 34:1311cc53201a 250
Jeej 34:1311cc53201a 251 // free message
Jeej 34:1311cc53201a 252 if (msg != NULL)
Jeej 34:1311cc53201a 253 {
Jeej 34:1311cc53201a 254 FREE(msg->buf);
Jeej 34:1311cc53201a 255 FREE(msg);
Jeej 34:1311cc53201a 256 }
Jeej 34:1311cc53201a 257 } while (msg != NULL);
Jeej 34:1311cc53201a 258
Jeej 34:1311cc53201a 259 // Flush RX
Jeej 34:1311cc53201a 260 for (int i = 0 ; i < 3 ; i++)
Jeej 34:1311cc53201a 261 {
Jeej 34:1311cc53201a 262 do
Jeej 34:1311cc53201a 263 {
Jeej 34:1311cc53201a 264 // wait for data
Jeej 34:1311cc53201a 265 if (i == 0)
Jeej 34:1311cc53201a 266 {
Jeej 34:1311cc53201a 267 pkt = d7a_modem_wait_pkt(1);
Jeej 34:1311cc53201a 268 }
Jeej 34:1311cc53201a 269 else if (i == 1)
Jeej 34:1311cc53201a 270 {
Jeej 34:1311cc53201a 271 pkt = d7a_fs_wait_pkt(1);
Jeej 34:1311cc53201a 272 }
Jeej 34:1311cc53201a 273 else
Jeej 34:1311cc53201a 274 {
Jeej 34:1311cc53201a 275 pkt = d7a_sys_wait_pkt(1);
Jeej 34:1311cc53201a 276 }
Jeej 34:1311cc53201a 277
Jeej 34:1311cc53201a 278 // free message
Jeej 34:1311cc53201a 279 if (pkt != NULL)
Jeej 34:1311cc53201a 280 {
Jeej 34:1311cc53201a 281 FREE(pkt);
Jeej 34:1311cc53201a 282 }
Jeej 34:1311cc53201a 283 } while (pkt != NULL);
Jeej 34:1311cc53201a 284 }
Jeej 34:1311cc53201a 285
Jeej 37:e04613e021f2 286 d7a_com_start_rx();
Jeej 37:e04613e021f2 287 d7a_com_start_tx();
Jeej 34:1311cc53201a 288 }
Jeej 34:1311cc53201a 289
Jeej 34:1311cc53201a 290 static void d7a_com_copy_to_linear(uint8_t* linear_buffer, uint16_t read_start, uint16_t length)
Jeej 34:1311cc53201a 291 {
Jeej 34:1311cc53201a 292 uint16_t first_part_size;
Jeej 34:1311cc53201a 293 uint16_t second_part_size;
Jeej 34:1311cc53201a 294
Jeej 34:1311cc53201a 295 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 296
Jeej 34:1311cc53201a 297 read_start %= g_com_ctx.rx_buffer_size;
Jeej 34:1311cc53201a 298 first_part_size = (length > (g_com_ctx.rx_buffer_size - read_start))? g_com_ctx.rx_buffer_size - read_start : length;
Jeej 34:1311cc53201a 299
Jeej 34:1311cc53201a 300 memcpy((void*)&linear_buffer[0], (const void*)&g_com_ctx.rx_buffer[read_start], first_part_size);
Jeej 34:1311cc53201a 301
Jeej 34:1311cc53201a 302 // The circular buffer is wrapping
Jeej 34:1311cc53201a 303 if (length > first_part_size)
Jeej 34:1311cc53201a 304 {
Jeej 34:1311cc53201a 305 second_part_size = length - first_part_size;
Jeej 34:1311cc53201a 306 memcpy((void*)&linear_buffer[first_part_size], (const void*)&g_com_ctx.rx_buffer[0], second_part_size);
Jeej 34:1311cc53201a 307 }
Jeej 34:1311cc53201a 308 }
Jeej 24:a8433b091764 309
Jeej 24:a8433b091764 310 /**
Jeej 24:a8433b091764 311 Wakes-up modem and send data throught Serial.
Jeej 24:a8433b091764 312
Jeej 24:a8433b091764 313 @param const uint8_t* Pointer to data buffer
Jeej 24:a8433b091764 314 @param int Data length
Jeej 24:a8433b091764 315 @return void
Jeej 24:a8433b091764 316 */
Jeej 26:9f0b9833cac6 317 static void d7a_com_send(const uint8_t* buffer, int length)
Jeej 24:a8433b091764 318 {
Jeej 31:ab9bfdbc6b44 319 FPRINT("(len:%d)\r\n", length);
Jeej 34:1311cc53201a 320
Jeej 24:a8433b091764 321 *(g_com_ctx.rts) = 1;
Jeej 24:a8433b091764 322
Jeej 31:ab9bfdbc6b44 323 //dbg_print_data("%02X ", (uint8_t*)buffer, length);
Jeej 31:ab9bfdbc6b44 324 //DPRINT("\r\n");
Jeej 24:a8433b091764 325 Thread::wait(5);
Jeej 24:a8433b091764 326
Jeej 34:1311cc53201a 327 for (uint32_t i=0 ; i<length ; i++)
Jeej 24:a8433b091764 328 {
Jeej 24:a8433b091764 329 g_com_ctx.serial->putc(buffer[i]);
Jeej 24:a8433b091764 330 }
Jeej 24:a8433b091764 331
Jeej 24:a8433b091764 332 *(g_com_ctx.rts) = 0;
Jeej 24:a8433b091764 333 }
Jeej 24:a8433b091764 334
Jeej 31:ab9bfdbc6b44 335
Jeej 31:ab9bfdbc6b44 336 static void d7a_com_post_tx(uint8_t* buffer, uint32_t length)
Jeej 31:ab9bfdbc6b44 337 {
Jeej 31:ab9bfdbc6b44 338 FPRINT("(len:%d)\r\n", length);
Jeej 34:1311cc53201a 339
Jeej 31:ab9bfdbc6b44 340 d7a_com_tx_buf_t* tx_buf = (d7a_com_tx_buf_t*)MALLOC(sizeof(d7a_com_tx_buf_t));
Jeej 31:ab9bfdbc6b44 341
Jeej 31:ab9bfdbc6b44 342 tx_buf->len = length;
Jeej 37:e04613e021f2 343 tx_buf->buf = buffer;
Jeej 31:ab9bfdbc6b44 344
Jeej 31:ab9bfdbc6b44 345 g_com_ctx.tx_queue.put(tx_buf);
Jeej 31:ab9bfdbc6b44 346 }
Jeej 31:ab9bfdbc6b44 347
Jeej 26:9f0b9833cac6 348 // Formats and send packet throught Serial.
Jeej 26:9f0b9833cac6 349 void d7a_com_send_msg(d7a_com_tx_msg_t* msg)
Jeej 34:1311cc53201a 350 {
Jeej 34:1311cc53201a 351 uint8_t* buf;
Jeej 34:1311cc53201a 352 uint16_t len = msg->alen + msg->plen;
Jeej 34:1311cc53201a 353 FPRINT("(len:%d)\r\n", len);
Jeej 34:1311cc53201a 354
Jeej 34:1311cc53201a 355 buf = (uint8_t*)MALLOC(KAL_COM_HEADER_LEN + len);
Jeej 34:1311cc53201a 356
Jeej 34:1311cc53201a 357 // construct serial header
Jeej 34:1311cc53201a 358 // concatenate and update tx_seq ID
Jeej 34:1311cc53201a 359 buf[0] = (uint8_t)KAL_COM_SYNC_BYTE_0;
Jeej 34:1311cc53201a 360 buf[1] = (uint8_t)KAL_COM_SYNC_BYTE_1;
Jeej 34:1311cc53201a 361 buf[2] = (uint8_t)len;
Jeej 34:1311cc53201a 362 buf[3] = (uint8_t)g_com_ctx.tx_seq++;
Jeej 34:1311cc53201a 363 buf[4] = (uint8_t)msg->id;
Jeej 34:1311cc53201a 364 len += KAL_COM_HEADER_LEN;
Jeej 34:1311cc53201a 365
Jeej 34:1311cc53201a 366 // copy payload and parameters
Jeej 34:1311cc53201a 367 memcpy(buf + KAL_COM_HEADER_LEN, msg->pbuf, msg->plen);
Jeej 34:1311cc53201a 368 memcpy(buf + KAL_COM_HEADER_LEN + msg->plen, msg->abuf, msg->alen);
Jeej 34:1311cc53201a 369
Jeej 34:1311cc53201a 370 DPRINT("<-- (0x%02X) %d\r\n", buf[4], (len - KAL_COM_HEADER_LEN));
Jeej 34:1311cc53201a 371
Jeej 34:1311cc53201a 372 d7a_com_send(buf, len);
Jeej 34:1311cc53201a 373 }
Jeej 34:1311cc53201a 374
Jeej 34:1311cc53201a 375 void d7a_com_post_msg(d7a_com_tx_msg_t* msg)
Jeej 34:1311cc53201a 376 {
Jeej 26:9f0b9833cac6 377 uint8_t* buf;
Jeej 26:9f0b9833cac6 378 uint16_t len = msg->alen + msg->plen;
Jeej 30:d775c1409849 379 FPRINT("(len:%d)\r\n", len);
Jeej 26:9f0b9833cac6 380
Jeej 26:9f0b9833cac6 381 buf = (uint8_t*)MALLOC(KAL_COM_HEADER_LEN + len);
Jeej 26:9f0b9833cac6 382
Jeej 26:9f0b9833cac6 383 // construct serial header
Jeej 26:9f0b9833cac6 384 // concatenate and update tx_seq ID
Jeej 26:9f0b9833cac6 385 buf[0] = (uint8_t)KAL_COM_SYNC_BYTE_0;
Jeej 26:9f0b9833cac6 386 buf[1] = (uint8_t)KAL_COM_SYNC_BYTE_1;
Jeej 26:9f0b9833cac6 387 buf[2] = (uint8_t)len;
Jeej 26:9f0b9833cac6 388 buf[3] = (uint8_t)g_com_ctx.tx_seq++;
Jeej 26:9f0b9833cac6 389 buf[4] = (uint8_t)msg->id;
Jeej 26:9f0b9833cac6 390 len += KAL_COM_HEADER_LEN;
Jeej 26:9f0b9833cac6 391
Jeej 26:9f0b9833cac6 392 // copy payload and parameters
Jeej 26:9f0b9833cac6 393 memcpy(buf + KAL_COM_HEADER_LEN, msg->pbuf, msg->plen);
Jeej 26:9f0b9833cac6 394 memcpy(buf + KAL_COM_HEADER_LEN + msg->plen, msg->abuf, msg->alen);
Jeej 26:9f0b9833cac6 395
Jeej 31:ab9bfdbc6b44 396 d7a_com_post_tx(buf, len);
Jeej 26:9f0b9833cac6 397 }
Jeej 26:9f0b9833cac6 398
Jeej 31:ab9bfdbc6b44 399
Jeej 30:d775c1409849 400 void d7a_com_dump(uint8_t* buf, uint8_t len, d7a_com_flow_t flow)
Jeej 30:d775c1409849 401 {
Jeej 30:d775c1409849 402 d7a_com_tx_msg_t msg;
Jeej 30:d775c1409849 403
Jeej 30:d775c1409849 404 msg.id = flow;
Jeej 30:d775c1409849 405 msg.pbuf = buf;
Jeej 30:d775c1409849 406 msg.plen = len;
Jeej 30:d775c1409849 407 msg.alen = 0;
Jeej 34:1311cc53201a 408 d7a_com_post_msg(&msg);
Jeej 30:d775c1409849 409 }
Jeej 30:d775c1409849 410
Jeej 34:1311cc53201a 411 void d7a_com_force_dump(uint8_t* buf, uint8_t len, d7a_com_flow_t flow)
Jeej 33:f9a542d3efaa 412 {
Jeej 34:1311cc53201a 413 d7a_com_tx_msg_t msg;
Jeej 34:1311cc53201a 414
Jeej 34:1311cc53201a 415 msg.id = flow;
Jeej 34:1311cc53201a 416 msg.pbuf = buf;
Jeej 34:1311cc53201a 417 msg.plen = len;
Jeej 34:1311cc53201a 418 msg.alen = 0;
Jeej 34:1311cc53201a 419 d7a_com_send_msg(&msg);
Jeej 33:f9a542d3efaa 420 }
Jeej 26:9f0b9833cac6 421
Jeej 25:aac250164497 422 static void d7a_com_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 423 {
Jeej 26:9f0b9833cac6 424 //FPRINT("\r\n");
Jeej 35:1fe2975c5a63 425
Jeej 35:1fe2975c5a63 426 DPRINT("--> (0x%02X) %d\r\n", pkt->id, pkt->blen);
Jeej 35:1fe2975c5a63 427
Jeej 25:aac250164497 428 // Distribute packet types to processes
Jeej 25:aac250164497 429 switch (KAL_COM_FLOWID(pkt->id))
Jeej 25:aac250164497 430 {
Jeej 25:aac250164497 431 case KAL_COM_FLOWID_FS:
Jeej 25:aac250164497 432 d7a_fs_new_pkt(pkt);
Jeej 25:aac250164497 433 break;
Jeej 25:aac250164497 434 case KAL_COM_FLOWID_CMD:
Jeej 25:aac250164497 435 d7a_modem_new_pkt(pkt);
Jeej 25:aac250164497 436 break;
Jeej 25:aac250164497 437 case KAL_COM_FLOWID_SYS:
Jeej 30:d775c1409849 438 // This has to be here to avoid going to another process
Jeej 30:d775c1409849 439 if (pkt->id == KAL_COM_FLOW_SYS_XON)
Jeej 30:d775c1409849 440 {
Jeej 34:1311cc53201a 441 g_com_ctx.tx_thread->signal_set(XON_SIGNAL);
Jeej 30:d775c1409849 442 FREE(pkt);
Jeej 30:d775c1409849 443 }
Jeej 30:d775c1409849 444 else if (pkt->id == KAL_COM_FLOW_SYS_XOFF)
Jeej 30:d775c1409849 445 {
Jeej 34:1311cc53201a 446 d7a_sys_xack();
Jeej 30:d775c1409849 447 FREE(pkt);
Jeej 30:d775c1409849 448 }
Jeej 30:d775c1409849 449 else
Jeej 30:d775c1409849 450 {
Jeej 34:1311cc53201a 451 if (KAL_COM_FLOW_SYS_PONG == pkt->id)
Jeej 34:1311cc53201a 452 {
Jeej 34:1311cc53201a 453 g_com_ctx.tim.stop();
Jeej 34:1311cc53201a 454 uint32_t time_us = g_com_ctx.tim.read_us();
Jeej 34:1311cc53201a 455 IPRINT("Ping in %d.%03dms\r\n", time_us/1000, time_us%1000);
Jeej 34:1311cc53201a 456 }
Jeej 30:d775c1409849 457 d7a_sys_new_pkt(pkt);
Jeej 30:d775c1409849 458 }
Jeej 30:d775c1409849 459 break;
Jeej 25:aac250164497 460 default:
Jeej 25:aac250164497 461 EPRINT("Untreated pkt type 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 462 FREE(pkt);
Jeej 25:aac250164497 463 break;
Jeej 25:aac250164497 464 }
Jeej 25:aac250164497 465 }
Jeej 24:a8433b091764 466
Jeej 37:e04613e021f2 467 void d7a_com_forward_buffer(uint8_t size)
Jeej 37:e04613e021f2 468 {
Jeej 37:e04613e021f2 469 g_com_ctx.read_idx = (g_com_ctx.read_idx + size) % g_com_ctx.rx_buffer_size;
Jeej 37:e04613e021f2 470 g_com_ctx.data_available -= size;
Jeej 37:e04613e021f2 471 }
Jeej 33:f9a542d3efaa 472
Jeej 24:a8433b091764 473 /**
Jeej 34:1311cc53201a 474 Reads the Rx buffer, parses the packets
Jeej 24:a8433b091764 475
Jeej 24:a8433b091764 476 @param void
Jeej 24:a8433b091764 477 @return void
Jeej 24:a8433b091764 478 */
Jeej 37:e04613e021f2 479 static void parse_packet_header(void)
Jeej 24:a8433b091764 480 {
Jeej 37:e04613e021f2 481 uint8_t header[KAL_COM_HEADER_LEN];
Jeej 37:e04613e021f2 482 uint8_t seqnum;
Jeej 33:f9a542d3efaa 483
Jeej 37:e04613e021f2 484 g_com_ctx.skipped_bytes = 0;
Jeej 33:f9a542d3efaa 485
Jeej 37:e04613e021f2 486 // Lookup fist sync byte
Jeej 37:e04613e021f2 487 while (g_com_ctx.data_available >= KAL_COM_HEADER_LEN)
Jeej 24:a8433b091764 488 {
Jeej 37:e04613e021f2 489 if(KAL_COM_SYNC_BYTE_0 == g_com_ctx.rx_buffer[g_com_ctx.read_idx])
Jeej 24:a8433b091764 490 {
Jeej 37:e04613e021f2 491 // copy following data
Jeej 37:e04613e021f2 492 d7a_com_copy_to_linear(header, g_com_ctx.read_idx, KAL_COM_HEADER_LEN);
Jeej 37:e04613e021f2 493 if (KAL_COM_SYNC_BYTE_1 == header[1])
Jeej 33:f9a542d3efaa 494 {
Jeej 37:e04613e021f2 495 // Fill temp header
Jeej 37:e04613e021f2 496 g_com_ctx.msg.blen = header[2];
Jeej 37:e04613e021f2 497 seqnum = header[3];
Jeej 37:e04613e021f2 498 g_com_ctx.msg.id = header[4];
Jeej 37:e04613e021f2 499
Jeej 37:e04613e021f2 500 // Update seqnum
Jeej 37:e04613e021f2 501 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 502 g_com_ctx.rx_seq = seqnum + 1;
Jeej 37:e04613e021f2 503
Jeej 37:e04613e021f2 504 // search for body
Jeej 37:e04613e021f2 505 d7a_com_forward_buffer(KAL_COM_HEADER_LEN);
Jeej 37:e04613e021f2 506 g_com_ctx.state = SEARCH_BODY;
Jeej 37:e04613e021f2 507 //DPRINT("COM header found (body %d bytes)\r\n", g_com_ctx.data_needed);
Jeej 33:f9a542d3efaa 508 break;
Jeej 33:f9a542d3efaa 509 }
Jeej 24:a8433b091764 510 }
Jeej 37:e04613e021f2 511
Jeej 37:e04613e021f2 512 // byte skipped
Jeej 37:e04613e021f2 513 WARNING(g_com_ctx.skipped_bytes != 1, "COM not sync. Searching for header.\r\n");
Jeej 37:e04613e021f2 514 d7a_com_forward_buffer(1);
Jeej 37:e04613e021f2 515 }
Jeej 37:e04613e021f2 516
Jeej 37:e04613e021f2 517 if (g_com_ctx.skipped_bytes)
Jeej 37:e04613e021f2 518 {
Jeej 37:e04613e021f2 519 WARNING(false, "Skipped %d bytes.\r\n", g_com_ctx.skipped_bytes);
Jeej 37:e04613e021f2 520 #if 0
Jeej 37:e04613e021f2 521 uint8_t* temp = (uint8_t*)MALLOC(g_com_ctx.skipped_bytes);
Jeej 37:e04613e021f2 522 d7a_com_copy_to_linear(temp, g_com_ctx.read_idx - g_com_ctx.skipped_bytes, g_com_ctx.skipped_bytes);
Jeej 37:e04613e021f2 523 PRINT_DATA("", "%02X ", temp, g_com_ctx.skipped_bytes, "\r\n");
Jeej 37:e04613e021f2 524 FREE(temp);
Jeej 34:1311cc53201a 525 #endif
Jeej 37:e04613e021f2 526 g_com_ctx.skipped_bytes = 0;
Jeej 37:e04613e021f2 527 }
Jeej 37:e04613e021f2 528 }
Jeej 37:e04613e021f2 529
Jeej 37:e04613e021f2 530 /**
Jeej 37:e04613e021f2 531 Reads the Rx buffer, parses the packets
Jeej 37:e04613e021f2 532
Jeej 37:e04613e021f2 533 @param void
Jeej 37:e04613e021f2 534 @return void
Jeej 37:e04613e021f2 535 */
Jeej 37:e04613e021f2 536 static void parse_packet_body(void)
Jeej 37:e04613e021f2 537 {
Jeej 37:e04613e021f2 538 if (KAL_COM_FLOWID(g_com_ctx.msg.id) != KAL_COM_FLOWID_TRC)
Jeej 37:e04613e021f2 539 {
Jeej 37:e04613e021f2 540 //DPRINT("Got packet id 0x%02X len %d\r\n", id, len);
Jeej 37:e04613e021f2 541
Jeej 37:e04613e021f2 542 d7a_com_rx_msg_t* pkt = NULL;
Jeej 37:e04613e021f2 543 pkt = (d7a_com_rx_msg_t*)MALLOC(sizeof(d7a_com_rx_msg_t) - 1 + g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 544
Jeej 37:e04613e021f2 545 // copy data to buffer
Jeej 37:e04613e021f2 546 pkt->blen = g_com_ctx.msg.blen;
Jeej 37:e04613e021f2 547 pkt->id = g_com_ctx.msg.id;
Jeej 37:e04613e021f2 548 d7a_com_copy_to_linear(pkt->buffer, g_com_ctx.read_idx, g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 549
Jeej 37:e04613e021f2 550 // add packet to queue
Jeej 37:e04613e021f2 551 d7a_com_new_pkt(pkt);
Jeej 37:e04613e021f2 552 }
Jeej 37:e04613e021f2 553 else
Jeej 37:e04613e021f2 554 {
Jeej 37:e04613e021f2 555 // Ignore packet
Jeej 24:a8433b091764 556 }
Jeej 33:f9a542d3efaa 557
Jeej 33:f9a542d3efaa 558 // update buffer indexes
Jeej 37:e04613e021f2 559 d7a_com_forward_buffer(g_com_ctx.msg.blen);
Jeej 37:e04613e021f2 560 g_com_ctx.state = SEARCH_HEADER;
Jeej 24:a8433b091764 561 }
Jeej 24:a8433b091764 562
Jeej 24:a8433b091764 563
Jeej 24:a8433b091764 564 // Thread for parsing packets from RX buffer.
Jeej 31:ab9bfdbc6b44 565 void d7a_com_rx_thread( void const *p )
Jeej 24:a8433b091764 566 {
Jeej 25:aac250164497 567 FPRINT("\r\n");
Jeej 24:a8433b091764 568 while (true)
Jeej 24:a8433b091764 569 {
Jeej 37:e04613e021f2 570 if (!g_com_ctx.rx_started)
Jeej 37:e04613e021f2 571 {
Jeej 37:e04613e021f2 572 g_com_ctx.rx_thread->signal_wait(START_SIGNAL);
Jeej 37:e04613e021f2 573 }
Jeej 37:e04613e021f2 574
Jeej 24:a8433b091764 575 // wait for data available
Jeej 24:a8433b091764 576 g_com_ctx.data_parsing->wait();
Jeej 37:e04613e021f2 577
Jeej 37:e04613e021f2 578 if (g_com_ctx.state == PARSE_HEADER)
Jeej 33:f9a542d3efaa 579 {
Jeej 37:e04613e021f2 580 parse_packet_header();
Jeej 37:e04613e021f2 581 }
Jeej 37:e04613e021f2 582 else if (g_com_ctx.state == PARSE_BODY)
Jeej 37:e04613e021f2 583 {
Jeej 37:e04613e021f2 584 parse_packet_body();
Jeej 33:f9a542d3efaa 585 }
Jeej 24:a8433b091764 586 }
Jeej 24:a8433b091764 587 }
Jeej 31:ab9bfdbc6b44 588
Jeej 31:ab9bfdbc6b44 589 void d7a_com_tx_thread( void const *p )
Jeej 31:ab9bfdbc6b44 590 {
Jeej 31:ab9bfdbc6b44 591 FPRINT("\r\n");
Jeej 31:ab9bfdbc6b44 592
Jeej 31:ab9bfdbc6b44 593 d7a_com_tx_buf_t* msg;
Jeej 31:ab9bfdbc6b44 594 osEvent evt;
Jeej 34:1311cc53201a 595 uint8_t flow_id;
Jeej 34:1311cc53201a 596
Jeej 31:ab9bfdbc6b44 597 while (true)
Jeej 31:ab9bfdbc6b44 598 {
Jeej 37:e04613e021f2 599 if (!g_com_ctx.tx_started)
Jeej 37:e04613e021f2 600 {
Jeej 37:e04613e021f2 601 g_com_ctx.tx_thread->signal_wait(START_SIGNAL);
Jeej 37:e04613e021f2 602 }
Jeej 37:e04613e021f2 603
Jeej 31:ab9bfdbc6b44 604 // wait for data to send
Jeej 31:ab9bfdbc6b44 605 evt = g_com_ctx.tx_queue.get();
Jeej 31:ab9bfdbc6b44 606 msg = (evt.status == osEventMessage)? (d7a_com_tx_buf_t*)evt.value.p : NULL;
Jeej 37:e04613e021f2 607
Jeej 31:ab9bfdbc6b44 608
Jeej 31:ab9bfdbc6b44 609 // send message
Jeej 31:ab9bfdbc6b44 610 if (msg != NULL)
Jeej 31:ab9bfdbc6b44 611 {
Jeej 34:1311cc53201a 612 flow_id = msg->buf[4];
Jeej 34:1311cc53201a 613 DPRINT("<-- (0x%02X) %d\r\n", flow_id, (msg->len - KAL_COM_HEADER_LEN));
Jeej 34:1311cc53201a 614
Jeej 31:ab9bfdbc6b44 615 d7a_com_send(msg->buf, msg->len);
Jeej 31:ab9bfdbc6b44 616 FREE(msg->buf);
Jeej 31:ab9bfdbc6b44 617 FREE(msg);
Jeej 34:1311cc53201a 618
Jeej 34:1311cc53201a 619 if (KAL_COM_FLOW_SYS_PING == flow_id)
Jeej 34:1311cc53201a 620 {
Jeej 34:1311cc53201a 621 g_com_ctx.tim.reset();
Jeej 34:1311cc53201a 622 g_com_ctx.tim.start();
Jeej 34:1311cc53201a 623 }
Jeej 34:1311cc53201a 624
Jeej 34:1311cc53201a 625 if (KAL_COM_FLOW_SYS_XACK == flow_id)
Jeej 34:1311cc53201a 626 {
Jeej 34:1311cc53201a 627 DPRINT("XOFF\r\n");
Jeej 34:1311cc53201a 628 g_com_ctx.tx_thread->signal_wait(XON_SIGNAL);
Jeej 34:1311cc53201a 629 DPRINT("XON\r\n");
Jeej 34:1311cc53201a 630 }
Jeej 31:ab9bfdbc6b44 631 }
Jeej 31:ab9bfdbc6b44 632 }
Jeej 31:ab9bfdbc6b44 633 }