WizziLab / Mbed OS D7A_1x_demo_CodeUpgradeProtocol

Dash7Board Code Upgrade Protocol demonstration code.

Dependencies:   modem_ref_helper CRC

modem_callbacks.cpp@2:49acddddec25, 2018-09-19 (annotated)

Committer:
Jeej
Date:
Wed Sep 19 15:58:35 2018 +0000
Revision:
2:49acddddec25
Parent:
1:dd4e18b267a1
Child:
3:cfe26c2bb78b
Updated libraries and APP for modem 5.2+

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 0:5589104abba0 1 #include "modem_ref_helper.h"
Jeej 0:5589104abba0 2 #include "files.h"
Jeej 0:5589104abba0 3 #include "fast_crc32.h"
Jeej 0:5589104abba0 4
Jeej 0:5589104abba0 5 #define SERIAL_MAX_PACKET_SIZE (255)
Jeej 0:5589104abba0 6
Jeej 0:5589104abba0 7 uint32_t stream_crc = 0;
Jeej 0:5589104abba0 8
Jeej 0:5589104abba0 9 // ============================================================}}}
Jeej 0:5589104abba0 10
Jeej 0:5589104abba0 11 // Callbacks to MODEM's ALP requests
Jeej 0:5589104abba0 12 // ============================================================{{{
Jeej 0:5589104abba0 13 void my_read(u8 fid, u32 offset, u32 length, int id)
Jeej 0:5589104abba0 14 {
Jeej 0:5589104abba0 15 u8 data[SERIAL_MAX_PACKET_SIZE];
Jeej 0:5589104abba0 16
Jeej 0:5589104abba0 17 ASSERT((ALP_ACTION_RSP_TAG_SIZE + ALP_ACTION_RSP_F_DATA_SIZE(offset, length)) <= SERIAL_MAX_PACKET_SIZE,
Jeej 0:5589104abba0 18 "Read response too big for serial protocol (%d/%dmax)\r\n", length, ALP_ACTION_RSP_TAG_SIZE + ALP_ACTION_RSP_F_DATA_SIZE(offset,SERIAL_MAX_PACKET_SIZE));
Jeej 0:5589104abba0 19
Jeej 0:5589104abba0 20 if (ram_fs_read(fid, offset, length, data))
Jeej 0:5589104abba0 21 {
Jeej 0:5589104abba0 22 modem_respond(0, ALP_ERR_FILE_NOT_FOUND, id);
Jeej 0:5589104abba0 23 }
Jeej 0:5589104abba0 24 else
Jeej 0:5589104abba0 25 {
Jeej 0:5589104abba0 26 modem_respond_read(fid, data, offset, length, id);
Jeej 0:5589104abba0 27 }
Jeej 0:5589104abba0 28 }
Jeej 0:5589104abba0 29
Jeej 0:5589104abba0 30 void my_write(u8 fid, void *data, u32 offset, u32 length, int id)
Jeej 0:5589104abba0 31 {
Jeej 0:5589104abba0 32 if (!ram_fs_write(fid, offset, length, (uint8_t*)data) || FID_APP_CUP_CODE == fid)
Jeej 0:5589104abba0 33 {
Jeej 0:5589104abba0 34 touch_t* touch = (touch_t*)MALLOC(sizeof(touch_t));
Jeej 0:5589104abba0 35
Jeej 0:5589104abba0 36 if (FID_APP_CUP_CODE == fid)
Jeej 0:5589104abba0 37 {
Jeej 0:5589104abba0 38 // Calculate crc on chunk
Jeej 0:5589104abba0 39 stream_crc = crc32_fast(data, length, stream_crc);
Jeej 0:5589104abba0 40
Jeej 0:5589104abba0 41 /************************/
Jeej 0:5589104abba0 42 /* Save the chunk data. */
Jeej 0:5589104abba0 43 /************************/
Jeej 0:5589104abba0 44 }
Jeej 0:5589104abba0 45
Jeej 0:5589104abba0 46 touch->fid = fid;
Jeej 0:5589104abba0 47 touch->offset = offset;
Jeej 0:5589104abba0 48 touch->length = length;
Jeej 0:5589104abba0 49
Jeej 0:5589104abba0 50 g_file_modified.put(touch);
Jeej 0:5589104abba0 51
Jeej 0:5589104abba0 52 modem_respond(0, ALP_ERR_NONE, id);
Jeej 0:5589104abba0 53 }
Jeej 0:5589104abba0 54 else
Jeej 0:5589104abba0 55 {
Jeej 0:5589104abba0 56 modem_respond(0, ALP_ERR_FILE_NOT_FOUND, id);
Jeej 0:5589104abba0 57 }
Jeej 0:5589104abba0 58 }
Jeej 0:5589104abba0 59
Jeej 0:5589104abba0 60 void my_read_fprop(u8 fid, int id)
Jeej 0:5589104abba0 61 {
Jeej 0:5589104abba0 62 u8* hdr = (u8*)ram_fs_get_header(fid);
Jeej 0:5589104abba0 63
Jeej 0:5589104abba0 64 if (hdr != NULL)
Jeej 0:5589104abba0 65 {
Jeej 0:5589104abba0 66 modem_respond_fprop(fid, hdr, id);
Jeej 0:5589104abba0 67 }
Jeej 0:5589104abba0 68 else
Jeej 0:5589104abba0 69 {
Jeej 0:5589104abba0 70 modem_respond(0, ALP_ERR_FILE_NOT_FOUND, id);
Jeej 0:5589104abba0 71 }
Jeej 0:5589104abba0 72 }
Jeej 0:5589104abba0 73
Jeej 0:5589104abba0 74 void my_flush(u8 fid, int id)
Jeej 0:5589104abba0 75 {
Jeej 0:5589104abba0 76 // No flush in this file system
Jeej 0:5589104abba0 77 modem_respond(0, ALP_ERR_NONE, id);
Jeej 0:5589104abba0 78 }
Jeej 0:5589104abba0 79
Jeej 0:5589104abba0 80 void my_delete(u8 fid, int id)
Jeej 0:5589104abba0 81 {
Jeej 0:5589104abba0 82 modem_respond(0, ALP_ERR_FILE_NOT_FOUND, id);
Jeej 0:5589104abba0 83 }
Jeej 0:5589104abba0 84
Jeej 2:49acddddec25 85 void my_udata(void *data, u32 length)
Jeej 2:49acddddec25 86 {
Jeej 2:49acddddec25 87 uint8_t* p = (uint8_t*)data;
Jeej 2:49acddddec25 88 int32_t rem = length;
Jeej 2:49acddddec25 89 alp_parsed_chunk_t r;
Jeej 2:49acddddec25 90 d7a_sp_res_t* istat;
Jeej 2:49acddddec25 91
Jeej 2:49acddddec25 92 do {
Jeej 2:49acddddec25 93 uint32_t parsed = alp_parse_chunk(&p, &r);
Jeej 2:49acddddec25 94 if (!parsed)
Jeej 2:49acddddec25 95 {
Jeej 2:49acddddec25 96 // Discard the payload in case of parsing error.
Jeej 2:49acddddec25 97 PRINT("Parsing error!\r\n");
Jeej 2:49acddddec25 98 break;
Jeej 2:49acddddec25 99 }
Jeej 2:49acddddec25 100 rem -= parsed;
Jeej 2:49acddddec25 101
Jeej 2:49acddddec25 102 switch (r.type)
Jeej 2:49acddddec25 103 {
Jeej 2:49acddddec25 104 // Interface status
Jeej 2:49acddddec25 105 case ALP_OPCODE_RSP_ISTATUS:
Jeej 2:49acddddec25 106 // D7A Interface
Jeej 2:49acddddec25 107 if (ALP_ITF_TYPE_D7A == r.meta.itf.type)
Jeej 2:49acddddec25 108 {
Jeej 2:49acddddec25 109 union {
Jeej 2:49acddddec25 110 u8 b[8];
Jeej 2:49acddddec25 111 u32 w[2];
Jeej 2:49acddddec25 112 } uid;
Jeej 2:49acddddec25 113
Jeej 2:49acddddec25 114 // ISTATUS can come either alone or together with ALP_OPCODE_RSP_F_DATA
Jeej 2:49acddddec25 115 // but there should be only one per payload, moreover it will come first
Jeej 2:49acddddec25 116 istat = (d7a_sp_res_t*)r.data;
Jeej 2:49acddddec25 117 memcpy(uid.b,istat->addressee.id,8);
Jeej 2:49acddddec25 118
Jeej 2:49acddddec25 119 PRINT("Got accessed by UID:%08X%08X SNR: %3ddB RXLEV: -%-3ddBm LB: %3ddB\n",
Jeej 2:49acddddec25 120 HAL_U32_BYTE_SWAP(uid.w[0]), HAL_U32_BYTE_SWAP(uid.w[1]),
Jeej 2:49acddddec25 121 istat->snr, istat->rxlev, istat->lb);
Jeej 2:49acddddec25 122 }
Jeej 2:49acddddec25 123 else
Jeej 2:49acddddec25 124 {
Jeej 2:49acddddec25 125 PRINT("Got accessed by unknown Interface 0x%02X\n", r.meta.itf.type);
Jeej 2:49acddddec25 126 }
Jeej 2:49acddddec25 127 break;
Jeej 2:49acddddec25 128 // Data return
Jeej 2:49acddddec25 129 case ALP_OPCODE_RSP_F_DATA:
Jeej 2:49acddddec25 130 // RSP_F_DATA can come either alone or together with ISTATUS
Jeej 2:49acddddec25 131 PRINT("Got UNS File[%3d]@%d %d Bytes\n", r.meta.f_data.fid, r.meta.f_data.offset, r.meta.f_data.length);
Jeej 2:49acddddec25 132 break;
Jeej 2:49acddddec25 133 default:
Jeej 2:49acddddec25 134 PRINT("Untreated OPCODE %d\n", r.type);
Jeej 2:49acddddec25 135 break;
Jeej 2:49acddddec25 136 }
Jeej 2:49acddddec25 137 } while (rem > 0);
Jeej 0:5589104abba0 138 }
Jeej 0:5589104abba0 139
Jeej 0:5589104abba0 140 void my_lqual(u8 ifid, int per)
Jeej 0:5589104abba0 141 {
Jeej 0:5589104abba0 142 PRINT("Interface File [%3d] LQUAL : %d%% PER\r\n", ifid, per);
Jeej 0:5589104abba0 143 }
Jeej 0:5589104abba0 144
Jeej 0:5589104abba0 145 void my_ldown(u8 ifid)
Jeej 0:5589104abba0 146 {
Jeej 0:5589104abba0 147 PRINT("Interface File [%3d] LDOWN\r\n", ifid);
Jeej 0:5589104abba0 148 }
Jeej 0:5589104abba0 149
Jeej 0:5589104abba0 150 void my_reset(void)
Jeej 0:5589104abba0 151 {
Jeej 0:5589104abba0 152 PRINT("Restarting application...\r\n");
Jeej 0:5589104abba0 153 FLUSH();
Jeej 0:5589104abba0 154 NVIC_SystemReset();
Jeej 0:5589104abba0 155 }
Jeej 0:5589104abba0 156
Jeej 0:5589104abba0 157 void my_boot(u8 cause, u16 number)
Jeej 0:5589104abba0 158 {
Jeej 0:5589104abba0 159 PRINT("Modem BOOT[%c] #%d\r\n", cause, number);
Jeej 0:5589104abba0 160
Jeej 0:5589104abba0 161 // Modem re-booted, restart APP
Jeej 0:5589104abba0 162 my_reset();
Jeej 1:dd4e18b267a1 163 }
Jeej 1:dd4e18b267a1 164
Jeej 1:dd4e18b267a1 165 void my_busy(u8 busy)
Jeej 1:dd4e18b267a1 166 {
Jeej 1:dd4e18b267a1 167 if (busy)
Jeej 1:dd4e18b267a1 168 {
Jeej 1:dd4e18b267a1 169 PRINT("Modem Busy\r\n");
Jeej 1:dd4e18b267a1 170
Jeej 2:49acddddec25 171 /* Stop report, do not use modem */
Jeej 1:dd4e18b267a1 172 /* Wait for modem reboot or modem not busy */
Jeej 1:dd4e18b267a1 173 }
Jeej 1:dd4e18b267a1 174 else
Jeej 1:dd4e18b267a1 175 {
Jeej 1:dd4e18b267a1 176 PRINT("Modem not Busy\r\n");
Jeej 1:dd4e18b267a1 177
Jeej 2:49acddddec25 178 /* Resume reports */
Jeej 1:dd4e18b267a1 179 }
Jeej 0:5589104abba0 180 }