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_alp.cpp@62:f1e4da5162c2, 2016-10-04 (annotated)

Committer:
Jeej
Date:
Tue Oct 04 08:55:52 2016 +0000
Revision:
62:f1e4da5162c2
Parent:
61:87be16080640
Child:
63:afd046faedb0
Fixed memory leak in alp.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 43:28202405094d 1 #include "mbed.h"
Jeej 43:28202405094d 2 #include "rtos.h"
Jeej 43:28202405094d 3 #include "dbg.h"
Jeej 43:28202405094d 4 #include "d7a.h"
Jeej 43:28202405094d 5 #include "d7a_com.h"
Jeej 43:28202405094d 6 #include "d7a_common.h"
Jeej 43:28202405094d 7 #include "d7a_fs.h"
Jeej 43:28202405094d 8 #include "d7a_modem.h"
Jeej 43:28202405094d 9 #include "d7a_sys.h"
Jeej 43:28202405094d 10 #include "d7a_alp.h"
Jeej 43:28202405094d 11
Jeej 43:28202405094d 12 typedef struct {
Jeej 43:28202405094d 13 uint8_t tag;
Jeej 43:28202405094d 14 uint8_t buffer[100];
Jeej 43:28202405094d 15 Queue<d7a_com_rx_msg_t, 16> pkt_queue;
Jeej 45:b85384e7d825 16 Queue<d7a_com_rx_msg_t, 8> pl_queue;
Jeej 47:19f22e1a448a 17
Jeej 59:b42eae56b51b 18 UnsolicitedMsgFunction uns_msg;
Jeej 43:28202405094d 19 Thread* thread;
Jeej 43:28202405094d 20 } d7a_alp_ctx_t;
Jeej 43:28202405094d 21
Jeej 43:28202405094d 22 static d7a_alp_ctx_t g_alp_ctx;
Jeej 43:28202405094d 23
Jeej 43:28202405094d 24 void d7a_alp_thread(const void *p);
Jeej 43:28202405094d 25
Jeej 59:b42eae56b51b 26 d7a_errors_t d7a_alp_open(UnsolicitedMsgFunction uns_msg)
Jeej 43:28202405094d 27 {
Jeej 43:28202405094d 28 FPRINT("\r\n");
Jeej 43:28202405094d 29
Jeej 59:b42eae56b51b 30 g_alp_ctx.uns_msg = uns_msg;
Jeej 43:28202405094d 31 g_alp_ctx.thread = new Thread(d7a_alp_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE);
Jeej 49:81d5bddb02f0 32
Jeej 49:81d5bddb02f0 33 return D7A_ERR_NONE;
Jeej 43:28202405094d 34 }
Jeej 43:28202405094d 35
Jeej 56:da34fc11e760 36 d7a_errors_t d7a_alp_close(void)
Jeej 56:da34fc11e760 37 {
Jeej 56:da34fc11e760 38 FPRINT("\r\n");
Jeej 56:da34fc11e760 39
Jeej 56:da34fc11e760 40 g_alp_ctx.thread->terminate();
Jeej 56:da34fc11e760 41
Jeej 56:da34fc11e760 42 return D7A_ERR_NONE;
Jeej 56:da34fc11e760 43 }
Jeej 56:da34fc11e760 44
Jeej 43:28202405094d 45 void d7a_alp_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 43:28202405094d 46 {
Jeej 43:28202405094d 47 FPRINT("\r\n");
Jeej 43:28202405094d 48 ASSERT(g_alp_ctx.pkt_queue.put(pkt) == osOK, "ALP queue full!\r\n");
Jeej 43:28202405094d 49 }
Jeej 43:28202405094d 50
Jeej 45:b85384e7d825 51 void d7a_alp_new_pl(d7a_com_rx_msg_t* pl)
Jeej 45:b85384e7d825 52 {
Jeej 45:b85384e7d825 53 FPRINT("\r\n");
Jeej 45:b85384e7d825 54 ASSERT(g_alp_ctx.pl_queue.put(pl) == osOK, "ALP OP queue full!\r\n");
Jeej 45:b85384e7d825 55 }
Jeej 45:b85384e7d825 56
Jeej 45:b85384e7d825 57 d7a_com_rx_msg_t* d7a_alp_wait_pkt(uint32_t millisec)
Jeej 43:28202405094d 58 {
Jeej 43:28202405094d 59 FPRINT("\r\n");
Jeej 43:28202405094d 60 osEvent evt = g_alp_ctx.pkt_queue.get(millisec);
Jeej 43:28202405094d 61 return (evt.status == osEventMessage)? (d7a_com_rx_msg_t*)evt.value.p : NULL;
Jeej 43:28202405094d 62 }
Jeej 43:28202405094d 63
Jeej 45:b85384e7d825 64 d7a_com_rx_msg_t* d7a_alp_wait_pl(uint32_t millisec)
Jeej 43:28202405094d 65 {
Jeej 43:28202405094d 66 FPRINT("\r\n");
Jeej 45:b85384e7d825 67 osEvent evt = g_alp_ctx.pl_queue.get(millisec);
Jeej 45:b85384e7d825 68 return (evt.status == osEventMessage)? (d7a_com_rx_msg_t*)evt.value.p : NULL;
Jeej 43:28202405094d 69 }
Jeej 43:28202405094d 70
Jeej 58:38a366236bda 71 static uint32_t d7a_ctf_to_ti(d7a_ctf_t ctf)
Jeej 58:38a366236bda 72 {
Jeej 58:38a366236bda 73 return ((1 << (2*ctf.bf.exp)) * ctf.bf.mant);
Jeej 58:38a366236bda 74 }
Jeej 58:38a366236bda 75
Jeej 45:b85384e7d825 76 uint32_t d7a_alp_encode_length(uint8_t* p, uint32_t len)
Jeej 43:28202405094d 77 {
Jeej 43:28202405094d 78 if (len <= 0x3F)
Jeej 43:28202405094d 79 {
Jeej 43:28202405094d 80 *p++ = len;
Jeej 43:28202405094d 81 return 1;
Jeej 43:28202405094d 82 }
Jeej 43:28202405094d 83 else if (len <= 0x3FFF)
Jeej 43:28202405094d 84 {
Jeej 43:28202405094d 85 *p++ = 0x40 + (uint8_t)(len >> 8);
Jeej 43:28202405094d 86 *p++ = (uint8_t)(len & 0xFF);
Jeej 43:28202405094d 87 return 2;
Jeej 43:28202405094d 88 }
Jeej 43:28202405094d 89 else if (len <= 0x3FFFFF)
Jeej 43:28202405094d 90 {
Jeej 43:28202405094d 91 *p++ = 0x80 + (uint8_t) (len >> 16);
Jeej 43:28202405094d 92 *p++ = (uint8_t)((len >> 8) & 0xFF);
Jeej 43:28202405094d 93 *p++ = (uint8_t) (len & 0xFF);
Jeej 43:28202405094d 94 return 3;
Jeej 43:28202405094d 95 }
Jeej 43:28202405094d 96 else
Jeej 43:28202405094d 97 {
Jeej 43:28202405094d 98 *p++ = 0xC0 + (uint8_t) (len >> 24);
Jeej 43:28202405094d 99 *p++ = (uint8_t)((len >> 16) & 0xFF);
Jeej 43:28202405094d 100 *p++ = (uint8_t)((len >> 8) & 0xFF);
Jeej 43:28202405094d 101 *p++ = (uint8_t) (len & 0xFF);
Jeej 43:28202405094d 102 return 4;
Jeej 43:28202405094d 103 }
Jeej 43:28202405094d 104 }
Jeej 43:28202405094d 105
Jeej 45:b85384e7d825 106 uint32_t alp_decode_length(uint8_t* p, uint32_t* len)
Jeej 45:b85384e7d825 107 {
Jeej 45:b85384e7d825 108 uint32_t tmp = 0;
Jeej 45:b85384e7d825 109 switch ((*p) & 0xC0)
Jeej 45:b85384e7d825 110 {
Jeej 45:b85384e7d825 111 case 0xC0: // 0xCx xx xx xx
Jeej 45:b85384e7d825 112 tmp = (*p++ & 0x3F) << 24;
Jeej 45:b85384e7d825 113 tmp += *p++ << 16;
Jeej 45:b85384e7d825 114 tmp += *p++ << 8;
Jeej 45:b85384e7d825 115 tmp += *p++ << 0;
Jeej 45:b85384e7d825 116 *len = tmp;
Jeej 45:b85384e7d825 117 return 4;
Jeej 45:b85384e7d825 118 case 0x80: // 0x8x xx xx : 16384 <= Len <4194303
Jeej 45:b85384e7d825 119 tmp = (*p++ & 0x3F) << 16;
Jeej 45:b85384e7d825 120 tmp += *p++ << 8;
Jeej 45:b85384e7d825 121 if (tmp == 0) {
Jeej 45:b85384e7d825 122 // 0x8000 ActP special ActP code
Jeej 45:b85384e7d825 123 // Do not fetch the extra byte
Jeej 45:b85384e7d825 124 tmp = 2;
Jeej 45:b85384e7d825 125 }
Jeej 45:b85384e7d825 126 else
Jeej 45:b85384e7d825 127 {
Jeej 45:b85384e7d825 128 tmp += *p++ << 0;
Jeej 45:b85384e7d825 129 }
Jeej 45:b85384e7d825 130 *len = tmp;
Jeej 45:b85384e7d825 131 return 3;
Jeej 45:b85384e7d825 132 case 0x40: // 0x4x xx : 64 <= Len < 16383
Jeej 45:b85384e7d825 133 tmp = (*p++ & 0x3F) << 8;
Jeej 45:b85384e7d825 134 tmp += *p++ << 0;
Jeej 45:b85384e7d825 135 if (tmp == 0)
Jeej 45:b85384e7d825 136 {
Jeej 45:b85384e7d825 137 // 0x4000 ActP special ActP code
Jeej 45:b85384e7d825 138 tmp = 1;
Jeej 45:b85384e7d825 139 }
Jeej 45:b85384e7d825 140 *len = tmp;
Jeej 45:b85384e7d825 141 return 2;
Jeej 45:b85384e7d825 142 case 0: // Len <63
Jeej 45:b85384e7d825 143 tmp = (*p++ & 0x3F) << 0;
Jeej 45:b85384e7d825 144 *len = tmp;
Jeej 45:b85384e7d825 145 return 1;
Jeej 45:b85384e7d825 146 }
Jeej 45:b85384e7d825 147
Jeej 45:b85384e7d825 148 return 0;
Jeej 45:b85384e7d825 149 }
Jeej 43:28202405094d 150
Jeej 45:b85384e7d825 151 uint32_t d7a_alp_add(uint8_t* p, const uint8_t* data, uint32_t len)
Jeej 43:28202405094d 152 {
Jeej 45:b85384e7d825 153 memcpy(p, data, len);
Jeej 43:28202405094d 154
Jeej 43:28202405094d 155 return len;
Jeej 43:28202405094d 156 }
Jeej 43:28202405094d 157
Jeej 59:b42eae56b51b 158 void d7a_alp_free_msg(d7a_msg_t* msg)
Jeej 59:b42eae56b51b 159 {
Jeej 59:b42eae56b51b 160 if (msg->data)
Jeej 59:b42eae56b51b 161 {
Jeej 59:b42eae56b51b 162 FREE(msg->data);
Jeej 59:b42eae56b51b 163 }
Jeej 59:b42eae56b51b 164 FREE(msg);
Jeej 59:b42eae56b51b 165 }
Jeej 59:b42eae56b51b 166
Jeej 59:b42eae56b51b 167 d7a_msg_t* d7a_alp_new_msg(void)
Jeej 59:b42eae56b51b 168 {
Jeej 59:b42eae56b51b 169 d7a_msg_t* msg = (d7a_msg_t*)MALLOC(sizeof(d7a_msg_t));
Jeej 59:b42eae56b51b 170 memset(msg, 0, sizeof(d7a_msg_t));
Jeej 59:b42eae56b51b 171 msg->err = D7A_ERR_NONE;
Jeej 59:b42eae56b51b 172
Jeej 59:b42eae56b51b 173 return msg;
Jeej 59:b42eae56b51b 174 }
Jeej 58:38a366236bda 175
Jeej 45:b85384e7d825 176 d7a_alp_rsp_t* d7a_alp_parse_pl(d7a_com_rx_msg_t* pkt)
Jeej 46:665391110051 177 {
Jeej 46:665391110051 178 if (pkt == NULL)
Jeej 46:665391110051 179 {
Jeej 46:665391110051 180 return NULL;
Jeej 46:665391110051 181 }
Jeej 46:665391110051 182
Jeej 45:b85384e7d825 183 uint8_t* p = pkt->buffer;
Jeej 45:b85384e7d825 184 uint8_t* t = p;
Jeej 45:b85384e7d825 185 uint8_t len = pkt->blen;
Jeej 45:b85384e7d825 186
Jeej 45:b85384e7d825 187 d7a_alp_rsp_t* rsp = (d7a_alp_rsp_t*)MALLOC(sizeof(d7a_alp_rsp_t));
Jeej 59:b42eae56b51b 188 rsp->tag = NO_TAG;
Jeej 59:b42eae56b51b 189 rsp->eop = false;
Jeej 59:b42eae56b51b 190 rsp->msg = d7a_alp_new_msg();
Jeej 45:b85384e7d825 191
Jeej 45:b85384e7d825 192 while ((p - t) < len)
Jeej 45:b85384e7d825 193 {
Jeej 45:b85384e7d825 194 uint8_t ctrl = *p++;
Jeej 45:b85384e7d825 195 switch (ctrl & 0x3F)
Jeej 45:b85384e7d825 196 {
Jeej 45:b85384e7d825 197 case ALP_OPCODE_RSP_STATUS:
Jeej 46:665391110051 198 if (ctrl & ALP_OPCODE_INDIRECT)
Jeej 46:665391110051 199 {
Jeej 58:38a366236bda 200 // ITF Type
Jeej 58:38a366236bda 201 uint8_t type = *p++;
Jeej 58:38a366236bda 202 // Length
Jeej 46:665391110051 203 uint32_t length;
Jeej 58:38a366236bda 204 p += alp_decode_length(p, &length);
Jeej 58:38a366236bda 205 // Data
Jeej 58:38a366236bda 206 d7a_sp_res_t* res = (d7a_sp_res_t*)p;
Jeej 58:38a366236bda 207 p += length;
Jeej 58:38a366236bda 208
Jeej 58:38a366236bda 209 // Fill corresponding fields
Jeej 59:b42eae56b51b 210 rsp->msg->lb = res->lb; // Get Link Budget
Jeej 61:87be16080640 211 rsp->msg->rxlev = res->rxlev; // Get RXLEV
Jeej 59:b42eae56b51b 212 memcpy(rsp->msg->id, res->addressee.id, D7A_UID_LEN); // Get UID
Jeej 58:38a366236bda 213
Jeej 59:b42eae56b51b 214 DPRINT("ALP RSP ISTATUS type:%02X lb: %3d ", type, rsp->msg->lb);
Jeej 59:b42eae56b51b 215 DPRINT_DATA("UID:", "%02X", rsp->msg->id, D7A_UID_LEN, "\r\n");
Jeej 46:665391110051 216 }
Jeej 46:665391110051 217 else
Jeej 46:665391110051 218 {
Jeej 59:b42eae56b51b 219 uint8_t aid = *p++; // Action ID
Jeej 59:b42eae56b51b 220 rsp->msg->err = *p++; // Status
Jeej 59:b42eae56b51b 221 DPRINT("ALP RSP STATUS aid:%d Status:%d\r\n", aid, rsp->msg->err);
Jeej 46:665391110051 222 }
Jeej 45:b85384e7d825 223 break;
Jeej 45:b85384e7d825 224 case ALP_OPCODE_RSP_TAG:
Jeej 59:b42eae56b51b 225 rsp->eop = !!(ctrl & ALP_CTRL_EOP);
Jeej 45:b85384e7d825 226 rsp->tag = *p++; // TAG
Jeej 59:b42eae56b51b 227 DPRINT("ALP RSP TAG %d EOP %d\r\n", rsp->tag, rsp->eop);
Jeej 45:b85384e7d825 228 break;
Jeej 45:b85384e7d825 229 case ALP_OPCODE_RSP_F_DATA:
Jeej 59:b42eae56b51b 230 uint8_t fid;
Jeej 45:b85384e7d825 231 uint32_t offset;
Jeej 59:b42eae56b51b 232 uint32_t length;
Jeej 59:b42eae56b51b 233 fid = *p++; // File ID
Jeej 45:b85384e7d825 234 p += alp_decode_length(p, &offset); // offset
Jeej 59:b42eae56b51b 235 p += alp_decode_length(p, &length); // length
Jeej 59:b42eae56b51b 236 rsp->msg->data = (d7a_data_t*)MALLOC(sizeof(d7a_data_t) - 1 + length);
Jeej 59:b42eae56b51b 237 rsp->msg->data->fid = fid;
Jeej 59:b42eae56b51b 238 rsp->msg->data->offset = offset;
Jeej 59:b42eae56b51b 239 rsp->msg->data->length = length;
Jeej 59:b42eae56b51b 240 p += d7a_alp_add(rsp->msg->data->buf, p, length);
Jeej 59:b42eae56b51b 241 DPRINT("ALP RSP F_DATA f:%d o:%d s:%d\r\n", fid, offset, length);
Jeej 59:b42eae56b51b 242 //DPRINT_DATA("DATA: ", "%02X ", (uint8_t*)rsp->data, rsp->data_len, "\r\n");
Jeej 45:b85384e7d825 243 break;
Jeej 45:b85384e7d825 244 default:
Jeej 45:b85384e7d825 245 WARNING(false, "ALP Untreated OP %d\r\n", ctrl);
Jeej 45:b85384e7d825 246 break;
Jeej 45:b85384e7d825 247 }
Jeej 45:b85384e7d825 248 }
Jeej 45:b85384e7d825 249
Jeej 45:b85384e7d825 250 ASSERT((p - t) == len, "Payload wrong size: %d expected %d\r\n", (p - t), len);
Jeej 45:b85384e7d825 251
Jeej 45:b85384e7d825 252 return rsp;
Jeej 45:b85384e7d825 253 }
Jeej 45:b85384e7d825 254
Jeej 45:b85384e7d825 255
Jeej 45:b85384e7d825 256 uint32_t d7a_alp_tag(uint8_t* p, bool eop)
Jeej 43:28202405094d 257 {
Jeej 43:28202405094d 258 uint8_t* t = p;
Jeej 43:28202405094d 259
Jeej 45:b85384e7d825 260 *p++ = ALP_OPCODE_TAG + ((eop)? ALP_CTRL_EOP : 0);
Jeej 43:28202405094d 261 *p++ = ++g_alp_ctx.tag;
Jeej 43:28202405094d 262
Jeej 43:28202405094d 263 return (uint32_t)(p - t);
Jeej 43:28202405094d 264 }
Jeej 43:28202405094d 265
Jeej 46:665391110051 266 uint32_t d7a_alp_forward_action(uint8_t* p, alp_d7a_itf_t* itf, bool resp)
Jeej 43:28202405094d 267 {
Jeej 43:28202405094d 268 uint8_t* t = p;
Jeej 43:28202405094d 269
Jeej 58:38a366236bda 270 uint32_t itf_size = sizeof(alp_d7a_itf_t);
Jeej 58:38a366236bda 271 switch (itf->cfg.addressee.ctrl.bf.idf)
Jeej 58:38a366236bda 272 {
Jeej 58:38a366236bda 273 case D7A_ID_NBID:
Jeej 58:38a366236bda 274 itf_size -= 7;
Jeej 58:38a366236bda 275 break;
Jeej 58:38a366236bda 276 case D7A_ID_NOID:
Jeej 58:38a366236bda 277 itf_size -= 8;
Jeej 58:38a366236bda 278 break;
Jeej 58:38a366236bda 279 case D7A_ID_UID:
Jeej 58:38a366236bda 280 break;
Jeej 58:38a366236bda 281 case D7A_ID_VID:
Jeej 58:38a366236bda 282 itf_size -= 4;
Jeej 58:38a366236bda 283 break;
Jeej 58:38a366236bda 284 default:
Jeej 58:38a366236bda 285 break;
Jeej 58:38a366236bda 286 }
Jeej 58:38a366236bda 287
Jeej 45:b85384e7d825 288 *p++ = ALP_OPCODE_FORWARD + ((resp)? ALP_CTRL_RESP : 0);
Jeej 58:38a366236bda 289 p += d7a_alp_add(p, (uint8_t*)itf, itf_size);
Jeej 43:28202405094d 290
Jeej 43:28202405094d 291 return (uint32_t)(p - t);
Jeej 43:28202405094d 292 }
Jeej 43:28202405094d 293
Jeej 45:b85384e7d825 294 uint32_t d7a_alp_write_action(uint8_t* p, const uint8_t file_id, const uint32_t offset, const uint32_t size, const uint8_t* const buf, bool resp)
Jeej 43:28202405094d 295 {
Jeej 43:28202405094d 296 uint8_t* t = p;
Jeej 43:28202405094d 297
Jeej 45:b85384e7d825 298 *p++ = ALP_OPCODE_F_WR_DATA + ((resp)? ALP_CTRL_RESP : 0);
Jeej 43:28202405094d 299 *p++ = file_id;
Jeej 43:28202405094d 300 p += d7a_alp_encode_length(p, offset);
Jeej 43:28202405094d 301 p += d7a_alp_encode_length(p, size);
Jeej 43:28202405094d 302 p += d7a_alp_add(p, buf, size);
Jeej 43:28202405094d 303
Jeej 43:28202405094d 304 return (uint32_t)(p - t);
Jeej 43:28202405094d 305 }
Jeej 43:28202405094d 306
Jeej 58:38a366236bda 307 uint32_t d7a_alp_read_action(uint8_t* p, const uint8_t file_id, const uint32_t offset, const uint32_t size, bool resp)
Jeej 43:28202405094d 308 {
Jeej 43:28202405094d 309 uint8_t* t = p;
Jeej 43:28202405094d 310
Jeej 45:b85384e7d825 311 *p++ = ALP_OPCODE_F_RD_DATA + ((resp)? ALP_CTRL_RESP : 0);
Jeej 43:28202405094d 312 *p++ = file_id;
Jeej 43:28202405094d 313 p += d7a_alp_encode_length(p, offset);
Jeej 43:28202405094d 314 p += d7a_alp_encode_length(p, size);
Jeej 43:28202405094d 315
Jeej 43:28202405094d 316 return (uint32_t)(p - t);
Jeej 43:28202405094d 317 }
Jeej 43:28202405094d 318
Jeej 59:b42eae56b51b 319 void d7a_alp_construct_resp(d7a_msg_t** ret, uint8_t current_tag, uint32_t max_responses)
Jeej 43:28202405094d 320 {
Jeej 59:b42eae56b51b 321 int i = 0;
Jeej 59:b42eae56b51b 322 d7a_alp_rsp_t* pl = NULL;
Jeej 59:b42eae56b51b 323 d7a_com_rx_msg_t* pkt = NULL;
Jeej 59:b42eae56b51b 324
Jeej 59:b42eae56b51b 325 // Parse responses
Jeej 59:b42eae56b51b 326 do
Jeej 43:28202405094d 327 {
Jeej 59:b42eae56b51b 328 pkt = d7a_alp_wait_pl(60000);
Jeej 59:b42eae56b51b 329
Jeej 59:b42eae56b51b 330 if (pkt == NULL)
Jeej 59:b42eae56b51b 331 {
Jeej 59:b42eae56b51b 332 ret[i] = d7a_alp_new_msg();
Jeej 59:b42eae56b51b 333 ret[i]->err = D7A_ERR_CMD_TO;
Jeej 59:b42eae56b51b 334 break;
Jeej 59:b42eae56b51b 335 }
Jeej 59:b42eae56b51b 336
Jeej 59:b42eae56b51b 337 pl = d7a_alp_parse_pl(pkt);
Jeej 59:b42eae56b51b 338
Jeej 59:b42eae56b51b 339 // Check TAG
Jeej 59:b42eae56b51b 340 if (pl->tag == NO_TAG)
Jeej 59:b42eae56b51b 341 {
Jeej 59:b42eae56b51b 342 WARNING(false, "No tag in payload expected %d\r\n", current_tag);
Jeej 59:b42eae56b51b 343 FREE(pkt);
Jeej 59:b42eae56b51b 344 d7a_alp_free_msg(pl->msg);
Jeej 59:b42eae56b51b 345 FREE(pl);
Jeej 59:b42eae56b51b 346 ret[i] = d7a_alp_new_msg();
Jeej 59:b42eae56b51b 347 ret[i]->err = D7A_ERR_UNKNOWN;
Jeej 59:b42eae56b51b 348 break;
Jeej 59:b42eae56b51b 349 }
Jeej 59:b42eae56b51b 350
Jeej 59:b42eae56b51b 351 if (pl->tag != current_tag)
Jeej 59:b42eae56b51b 352 {
Jeej 59:b42eae56b51b 353 WARNING(false, "Ingnoring tag %d expecting %d\r\n", pl->tag, current_tag);
Jeej 59:b42eae56b51b 354 d7a_alp_free_msg(pl->msg);
Jeej 59:b42eae56b51b 355 FREE(pl);
Jeej 59:b42eae56b51b 356 d7a_alp_new_pl(pkt);
Jeej 59:b42eae56b51b 357 continue;
Jeej 59:b42eae56b51b 358 }
Jeej 59:b42eae56b51b 359
Jeej 59:b42eae56b51b 360 FREE(pkt);
Jeej 59:b42eae56b51b 361
Jeej 59:b42eae56b51b 362 // Check for END OF PAYLOAD
Jeej 59:b42eae56b51b 363 if (pl->eop)
Jeej 59:b42eae56b51b 364 {
Jeej 59:b42eae56b51b 365 DPRINT("EOP\r\n");
Jeej 59:b42eae56b51b 366
Jeej 59:b42eae56b51b 367 // If tag only
Jeej 62:f1e4da5162c2 368 if (!pl->msg->data && !pl->msg->lb && i != 0)
Jeej 59:b42eae56b51b 369 {
Jeej 59:b42eae56b51b 370 // Ignore response
Jeej 59:b42eae56b51b 371 d7a_alp_free_msg(pl->msg);
Jeej 59:b42eae56b51b 372 }
Jeej 59:b42eae56b51b 373 else
Jeej 59:b42eae56b51b 374 {
Jeej 59:b42eae56b51b 375 DPRINT("last response (err %d)\r\n", pl->msg->err);
Jeej 59:b42eae56b51b 376 ret[i] = pl->msg;
Jeej 59:b42eae56b51b 377 }
Jeej 59:b42eae56b51b 378
Jeej 59:b42eae56b51b 379 FREE(pl);
Jeej 59:b42eae56b51b 380 break;
Jeej 59:b42eae56b51b 381 }
Jeej 59:b42eae56b51b 382 // Wait for new msg
Jeej 59:b42eae56b51b 383 else
Jeej 59:b42eae56b51b 384 {
Jeej 59:b42eae56b51b 385 DPRINT("next response (err %d)\r\n", pl->msg->err);
Jeej 59:b42eae56b51b 386 ret[i] = pl->msg;
Jeej 59:b42eae56b51b 387 FREE(pl);
Jeej 59:b42eae56b51b 388 i++;
Jeej 59:b42eae56b51b 389 ASSERT(i <= max_responses, "Too much responses! max: %d\r\n", max_responses);
Jeej 59:b42eae56b51b 390 }
Jeej 59:b42eae56b51b 391
Jeej 59:b42eae56b51b 392 } while (1);
Jeej 58:38a366236bda 393 }
Jeej 45:b85384e7d825 394
Jeej 58:38a366236bda 395 d7a_msg_t** d7a_alp_write_file(const uint8_t file_id, const uint32_t offset, const uint32_t size, const uint8_t* const buf, d7a_addressee_t* addressee, uint8_t retry, bool resp)
Jeej 43:28202405094d 396 {
Jeej 58:38a366236bda 397 // Get command buffer
Jeej 43:28202405094d 398 uint8_t* p = &g_alp_ctx.buffer[0];
Jeej 58:38a366236bda 399 // Save initial position of the command buffer
Jeej 43:28202405094d 400 uint8_t* t = p;
Jeej 43:28202405094d 401
Jeej 58:38a366236bda 402 bool broadcast = false;
Jeej 58:38a366236bda 403 uint8_t current_tag;
Jeej 58:38a366236bda 404 d7a_msg_t** ret = NULL;
Jeej 60:8d4133fbc060 405 uint32_t max_responses = 2;
Jeej 58:38a366236bda 406 uint8_t i;
Jeej 58:38a366236bda 407
Jeej 58:38a366236bda 408 if (addressee)
Jeej 58:38a366236bda 409 {
Jeej 58:38a366236bda 410 if (addressee->ctrl.bf.idf == D7A_ID_NBID)
Jeej 58:38a366236bda 411 {
Jeej 58:38a366236bda 412 broadcast = true;
Jeej 58:38a366236bda 413 d7a_ctf_t ctf;
Jeej 58:38a366236bda 414 ctf.byte = addressee->id[0];
Jeej 60:8d4133fbc060 415 max_responses = ((1 << (2*ctf.bf.exp)) * ctf.bf.mant) + 1;
Jeej 58:38a366236bda 416 }
Jeej 58:38a366236bda 417 else if (addressee->ctrl.bf.idf == D7A_ID_NOID)
Jeej 58:38a366236bda 418 {
Jeej 58:38a366236bda 419 broadcast = true;
Jeej 60:8d4133fbc060 420 max_responses = 33;
Jeej 58:38a366236bda 421 }
Jeej 58:38a366236bda 422 }
Jeej 58:38a366236bda 423
Jeej 58:38a366236bda 424 // malloc and init pointer array
Jeej 58:38a366236bda 425 ret = (d7a_msg_t**)MALLOC(sizeof(d7a_msg_t*) * (max_responses + 1));
Jeej 58:38a366236bda 426 for (i = 0; i < (max_responses + 1); i++)
Jeej 58:38a366236bda 427 {
Jeej 58:38a366236bda 428 ret[i] = NULL;
Jeej 58:38a366236bda 429 }
Jeej 60:8d4133fbc060 430
Jeej 58:38a366236bda 431 // Construct command
Jeej 58:38a366236bda 432
Jeej 43:28202405094d 433 // Tag action
Jeej 45:b85384e7d825 434 p += d7a_alp_tag(p, true);
Jeej 58:38a366236bda 435
Jeej 58:38a366236bda 436 // get tag
Jeej 58:38a366236bda 437 current_tag = g_alp_ctx.tag;
Jeej 58:38a366236bda 438
Jeej 45:b85384e7d825 439 if (addressee)
Jeej 45:b85384e7d825 440 {
Jeej 46:665391110051 441 // Construct interface
Jeej 46:665391110051 442 alp_d7a_itf_t itf = {
Jeej 58:38a366236bda 443 // Dash7 interface
Jeej 58:38a366236bda 444 .type = 0xD7,
Jeej 58:38a366236bda 445 // Switch response type if broadcast
Jeej 58:38a366236bda 446 .cfg.qos.bf.resp = (broadcast)? D7A_RESP_ALL : D7A_RESP_ANY,
Jeej 46:665391110051 447 .cfg.qos.bf.retry = retry,
Jeej 46:665391110051 448 .cfg.qos.bf.record = 0,
Jeej 46:665391110051 449 .cfg.qos.bf.stop_on_err = 0,
Jeej 46:665391110051 450 .cfg.dorm_to.byte = 0,
Jeej 46:665391110051 451 };
Jeej 46:665391110051 452 memcpy(&itf.cfg.addressee, addressee, sizeof(d7a_addressee_t));
Jeej 58:38a366236bda 453
Jeej 58:38a366236bda 454 // Forward action
Jeej 46:665391110051 455 p += d7a_alp_forward_action(p, &itf, true);
Jeej 45:b85384e7d825 456 }
Jeej 45:b85384e7d825 457
Jeej 45:b85384e7d825 458 // Write action
Jeej 45:b85384e7d825 459 p += d7a_alp_write_action(p, file_id, offset, size, buf, resp);
Jeej 45:b85384e7d825 460
Jeej 58:38a366236bda 461 // Send command
Jeej 45:b85384e7d825 462 d7a_com_dump(&g_alp_ctx.buffer[0], (uint8_t)(p - t), KAL_COM_FLOW_AT_CMD);
Jeej 58:38a366236bda 463
Jeej 58:38a366236bda 464 i = 0; // start with msg 0
Jeej 59:b42eae56b51b 465
Jeej 58:38a366236bda 466 // Parse responses
Jeej 59:b42eae56b51b 467 d7a_alp_construct_resp(ret, current_tag, max_responses);
Jeej 45:b85384e7d825 468
Jeej 58:38a366236bda 469 return ret;
Jeej 45:b85384e7d825 470 }
Jeej 45:b85384e7d825 471
Jeej 58:38a366236bda 472 d7a_msg_t** d7a_alp_read_file(const uint8_t file_id, const uint32_t offset, const uint32_t size, d7a_addressee_t* addressee, uint8_t retry)
Jeej 45:b85384e7d825 473 {
Jeej 58:38a366236bda 474 // Get command buffer
Jeej 45:b85384e7d825 475 uint8_t* p = &g_alp_ctx.buffer[0];
Jeej 58:38a366236bda 476 // Save initial position of the command buffer
Jeej 45:b85384e7d825 477 uint8_t* t = p;
Jeej 45:b85384e7d825 478
Jeej 58:38a366236bda 479 bool broadcast = false;
Jeej 58:38a366236bda 480 uint8_t current_tag;
Jeej 58:38a366236bda 481 d7a_msg_t** ret = NULL;
Jeej 60:8d4133fbc060 482 uint32_t max_responses = 2;
Jeej 58:38a366236bda 483 uint8_t i;
Jeej 58:38a366236bda 484
Jeej 58:38a366236bda 485 if (addressee)
Jeej 58:38a366236bda 486 {
Jeej 58:38a366236bda 487 if (addressee->ctrl.bf.idf == D7A_ID_NBID)
Jeej 58:38a366236bda 488 {
Jeej 58:38a366236bda 489 broadcast = true;
Jeej 58:38a366236bda 490 d7a_ctf_t ctf;
Jeej 58:38a366236bda 491 ctf.byte = addressee->id[0];
Jeej 60:8d4133fbc060 492 max_responses = ((1 << (2*ctf.bf.exp)) * ctf.bf.mant) + 1;
Jeej 58:38a366236bda 493 }
Jeej 58:38a366236bda 494 else if (addressee->ctrl.bf.idf == D7A_ID_NOID)
Jeej 58:38a366236bda 495 {
Jeej 58:38a366236bda 496 broadcast = true;
Jeej 60:8d4133fbc060 497 max_responses = 33;
Jeej 58:38a366236bda 498 }
Jeej 58:38a366236bda 499 }
Jeej 58:38a366236bda 500
Jeej 58:38a366236bda 501 // malloc and init pointer array
Jeej 58:38a366236bda 502 ret = (d7a_msg_t**)MALLOC(sizeof(d7a_msg_t*) * (max_responses + 1));
Jeej 58:38a366236bda 503 for (i = 0; i < (max_responses + 1); i++)
Jeej 58:38a366236bda 504 {
Jeej 58:38a366236bda 505 ret[i] = NULL;
Jeej 58:38a366236bda 506 }
Jeej 58:38a366236bda 507
Jeej 58:38a366236bda 508 // Construct command
Jeej 58:38a366236bda 509
Jeej 45:b85384e7d825 510 // Tag action
Jeej 45:b85384e7d825 511 p += d7a_alp_tag(p, true);
Jeej 43:28202405094d 512
Jeej 58:38a366236bda 513 // get tag
Jeej 58:38a366236bda 514 current_tag = g_alp_ctx.tag;
Jeej 58:38a366236bda 515
Jeej 43:28202405094d 516 if (addressee)
Jeej 43:28202405094d 517 {
Jeej 46:665391110051 518 // Construct interface
Jeej 46:665391110051 519 alp_d7a_itf_t itf = {
Jeej 58:38a366236bda 520 // Dash7 interface
Jeej 58:38a366236bda 521 .type = 0xD7,
Jeej 58:38a366236bda 522 // Switch response type if broadcast
Jeej 58:38a366236bda 523 //.cfg.qos.bf.resp = (broadcast)? D7A_RESP_ALL : D7A_RESP_ANY,
Jeej 58:38a366236bda 524 .cfg.qos.bf.resp = D7A_RESP_ALL,
Jeej 46:665391110051 525 .cfg.qos.bf.retry = retry,
Jeej 46:665391110051 526 .cfg.qos.bf.record = 0,
Jeej 46:665391110051 527 .cfg.qos.bf.stop_on_err = 0,
Jeej 46:665391110051 528 .cfg.dorm_to.byte = 0,
Jeej 46:665391110051 529 };
Jeej 46:665391110051 530 memcpy(&itf.cfg.addressee, addressee, sizeof(d7a_addressee_t));
Jeej 58:38a366236bda 531
Jeej 58:38a366236bda 532 // Forward action
Jeej 46:665391110051 533 p += d7a_alp_forward_action(p, &itf, true);
Jeej 43:28202405094d 534 }
Jeej 43:28202405094d 535
Jeej 43:28202405094d 536 // Read action
Jeej 58:38a366236bda 537 p += d7a_alp_read_action(p, file_id, offset, size, true);
Jeej 45:b85384e7d825 538
Jeej 58:38a366236bda 539 // Send command
Jeej 58:38a366236bda 540 d7a_com_dump(&g_alp_ctx.buffer[0], (uint8_t)(p - t), KAL_COM_FLOW_AT_CMD);
Jeej 58:38a366236bda 541
Jeej 58:38a366236bda 542 i = 0; // start with msg 0
Jeej 59:b42eae56b51b 543
Jeej 58:38a366236bda 544 // Parse responses
Jeej 59:b42eae56b51b 545 d7a_alp_construct_resp(ret, current_tag, max_responses);
Jeej 45:b85384e7d825 546
Jeej 58:38a366236bda 547 return ret;
Jeej 43:28202405094d 548 }
Jeej 43:28202405094d 549
Jeej 43:28202405094d 550 void d7a_alp_thread(const void *p)
Jeej 43:28202405094d 551 {
Jeej 58:38a366236bda 552 FPRINT("(id:0x%08x)\r\n", osThreadGetId());
Jeej 43:28202405094d 553 d7a_com_rx_msg_t* pkt;
Jeej 43:28202405094d 554
Jeej 43:28202405094d 555 while (true)
Jeej 43:28202405094d 556 {
Jeej 43:28202405094d 557 pkt = d7a_alp_wait_pkt();
Jeej 43:28202405094d 558 ASSERT(pkt != NULL, "ALP NULL pkt\r\n");
Jeej 43:28202405094d 559
Jeej 43:28202405094d 560 switch(pkt->id)
Jeej 43:28202405094d 561 {
Jeej 43:28202405094d 562 case KAL_COM_FLOW_AT_RESP:
Jeej 50:30440c9aeb7c 563 DPRINT("KAL_COM_FLOW_AT_RESP\r\n");
Jeej 45:b85384e7d825 564
Jeej 45:b85384e7d825 565 d7a_alp_new_pl(pkt);
Jeej 43:28202405094d 566
Jeej 43:28202405094d 567 break;
Jeej 59:b42eae56b51b 568 case KAL_COM_FLOW_AT_UNS:
Jeej 59:b42eae56b51b 569 DPRINT("KAL_COM_FLOW_AT_UNS\r\n");
Jeej 59:b42eae56b51b 570 d7a_msg_t** ret = (d7a_msg_t**)MALLOC(sizeof(d7a_msg_t*) * 2);
Jeej 59:b42eae56b51b 571
Jeej 59:b42eae56b51b 572 d7a_alp_rsp_t* pl = d7a_alp_parse_pl(pkt);
Jeej 59:b42eae56b51b 573
Jeej 59:b42eae56b51b 574 ret[0] = pl->msg;
Jeej 59:b42eae56b51b 575 ret[1] = NULL;
Jeej 59:b42eae56b51b 576
Jeej 59:b42eae56b51b 577 FREE(pkt);
Jeej 59:b42eae56b51b 578 FREE(pl);
Jeej 59:b42eae56b51b 579
Jeej 59:b42eae56b51b 580 // Callback
Jeej 59:b42eae56b51b 581 g_alp_ctx.uns_msg(ret);
Jeej 59:b42eae56b51b 582
Jeej 59:b42eae56b51b 583 break;
Jeej 43:28202405094d 584 default:
Jeej 43:28202405094d 585 EPRINT("ALP Unknown Flow ID 0x%02X\r\n", pkt->id);
Jeej 45:b85384e7d825 586 FREE(pkt);
Jeej 43:28202405094d 587 break;
Jeej 43:28202405094d 588 }
Jeej 43:28202405094d 589 }
Jeej 43:28202405094d 590 }