WizziLab / modem_ref_helper

Helper library to use modem_ref driver.

Dependencies:   WizziCom WizziDebug ram_fs modem_ref

Dependents:   D7A_Localisation D7A_1x_demo_send_file_data_and_forget D7A_1x_demo_CodeUpgradeProtocol D7A_1x_demo_LoRaWAN ... more

modem_d7a.cpp@75:dad2f09cb870, 2021-09-07 (annotated)

Committer:
Jeej
Date:
Tue Sep 07 15:59:23 2021 +0000
Revision:
75:dad2f09cb870
Parent:
72:15bf99fcfed9
Child:
76:cbe558f136a4
Added Modem updater directly in driver.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 69:8f2fe2426ef9 1
Jeej 69:8f2fe2426ef9 2 #include "mbed.h"
Jeej 68:b2dd7309da44 3 #include "modem_d7a.h"
Jeej 75:dad2f09cb870 4 #include "modem_cup.h"
Jeej 68:b2dd7309da44 5
Jeej 68:b2dd7309da44 6 #if 0
Jeej 69:8f2fe2426ef9 7 #define HELPER_PRINT(...) PRINT(__VA_ARGS__)
Jeej 68:b2dd7309da44 8 #else
Jeej 69:8f2fe2426ef9 9 #define HELPER_PRINT(...);
Jeej 68:b2dd7309da44 10 #endif
Jeej 68:b2dd7309da44 11
Jeej 68:b2dd7309da44 12 #define MODEM_VERSION_MAJOR 5
Jeej 68:b2dd7309da44 13 #define MODEM_VERSION_MINOR 6
Jeej 68:b2dd7309da44 14 #define MODEM_VERSION_PATCH 0
Jeej 68:b2dd7309da44 15 #define MODEM_DEVICE_ID 0x00001001
Jeej 68:b2dd7309da44 16
Jeej 69:8f2fe2426ef9 17 Semaphore g_s[MAX_USER_NB];
Jeej 68:b2dd7309da44 18
Jeej 68:b2dd7309da44 19 static WizziCom* g_modem_com;
Jeej 68:b2dd7309da44 20
Jeej 68:b2dd7309da44 21 // Callback for id User
Jeej 68:b2dd7309da44 22 static void modem_cb(uint8_t terminal, int8_t err, uint8_t id)
Jeej 68:b2dd7309da44 23 {
Jeej 68:b2dd7309da44 24 (void)id;
Jeej 68:b2dd7309da44 25
Jeej 70:753b602bd7bd 26 //PRINT("CB EOP:%d ERR:%d ID:%d\n", terminal, err, id);
Jeej 69:8f2fe2426ef9 27
Jeej 68:b2dd7309da44 28 if (terminal)
Jeej 68:b2dd7309da44 29 {
Jeej 69:8f2fe2426ef9 30 g_s[id].release();
Jeej 68:b2dd7309da44 31 }
Jeej 68:b2dd7309da44 32 }
Jeej 68:b2dd7309da44 33
Jeej 68:b2dd7309da44 34 static int g_boot_nb;
Jeej 68:b2dd7309da44 35 static int g_read_nb;
Jeej 68:b2dd7309da44 36 static int g_swr_nb;
Jeej 68:b2dd7309da44 37 static int g_hwr_nb;
Jeej 68:b2dd7309da44 38 static int g_pwc_nb;
Jeej 68:b2dd7309da44 39 static int g_fail_nb;
Jeej 68:b2dd7309da44 40
Jeej 68:b2dd7309da44 41 int modem_wait_resp(Semaphore* s, uint32_t timeout, char* function, uint32_t line)
Jeej 68:b2dd7309da44 42 {
Jeej 68:b2dd7309da44 43 if (!s->try_acquire_for(timeout))
Jeej 68:b2dd7309da44 44 {
Jeej 68:b2dd7309da44 45 PRINT("%s:%d: Modem resp timeout after %d ms\n", function, line, timeout);
Jeej 68:b2dd7309da44 46 return -1;
Jeej 68:b2dd7309da44 47 }
Jeej 69:8f2fe2426ef9 48
Jeej 68:b2dd7309da44 49 return 0;
Jeej 68:b2dd7309da44 50 }
Jeej 68:b2dd7309da44 51
Jeej 68:b2dd7309da44 52 int my_alp_itf_d7a_cfg_size(d7a_sp_cfg_t* cfg)
Jeej 68:b2dd7309da44 53 {
Jeej 68:b2dd7309da44 54 int size = sizeof(d7a_sp_cfg_t) - sizeof(d7a_addressee_t);
Jeej 68:b2dd7309da44 55 size += D7A_ADDR_LEN(cfg->addressee.ctrl);
Jeej 68:b2dd7309da44 56 return size;
Jeej 68:b2dd7309da44 57 }
Jeej 68:b2dd7309da44 58
Jeej 68:b2dd7309da44 59 // ============================================================}}}
Jeej 68:b2dd7309da44 60
Jeej 68:b2dd7309da44 61 // Serial adapters to WizziLab's own architecture
Jeej 68:b2dd7309da44 62 // ============================================================{{{
Jeej 68:b2dd7309da44 63
Jeej 68:b2dd7309da44 64 static void modem_serial_input(WizziCom* com, WizziComPacket_t* pkt)
Jeej 68:b2dd7309da44 65 {
Jeej 68:b2dd7309da44 66 modem_ref_input(wizzicom_type_to_flow(pkt->type), pkt->data, pkt->length);
Jeej 68:b2dd7309da44 67 }
Jeej 68:b2dd7309da44 68
Jeej 69:8f2fe2426ef9 69 static int modem_serial_send(uint8_t type, uint8_t* data, uint8_t size)
Jeej 68:b2dd7309da44 70 {
Jeej 69:8f2fe2426ef9 71 // Retrieve Flow ID from header and send packet
Jeej 69:8f2fe2426ef9 72 g_modem_com->send((WizziComPacketType)type, size, data);
Jeej 68:b2dd7309da44 73
Jeej 69:8f2fe2426ef9 74 return size;
Jeej 68:b2dd7309da44 75 }
Jeej 68:b2dd7309da44 76
Jeej 75:dad2f09cb870 77 static Semaphore boot(0);
Jeej 68:b2dd7309da44 78 void my_startup_boot(u8 cause, u16 number)
Jeej 68:b2dd7309da44 79 {
Jeej 68:b2dd7309da44 80 HELPER_PRINT("Modem BOOT[%c] #%d\r\n", cause, number);
Jeej 68:b2dd7309da44 81 boot.release();
Jeej 68:b2dd7309da44 82 }
Jeej 68:b2dd7309da44 83
Jeej 68:b2dd7309da44 84 int modem_open(modem_ref_callbacks_t* callbacks)
Jeej 68:b2dd7309da44 85 {
Jeej 68:b2dd7309da44 86 static union {
Jeej 68:b2dd7309da44 87 uint8_t b[8];
Jeej 68:b2dd7309da44 88 uint32_t w[2];
Jeej 68:b2dd7309da44 89 } uid;
Jeej 68:b2dd7309da44 90 revision_t rev;
Jeej 68:b2dd7309da44 91 int err;
Jeej 68:b2dd7309da44 92
Jeej 69:8f2fe2426ef9 93 //for (int i = 0; i < MAX_USER_NB; i++)
Jeej 69:8f2fe2426ef9 94 //{
Jeej 69:8f2fe2426ef9 95 //g_s[i] = Semaphore(0);
Jeej 69:8f2fe2426ef9 96 //}
Jeej 69:8f2fe2426ef9 97
Jeej 68:b2dd7309da44 98 g_boot_nb++;
Jeej 69:8f2fe2426ef9 99
Jeej 68:b2dd7309da44 100 // Override boot callback to catch the first boot message
Jeej 68:b2dd7309da44 101 modem_ref_callbacks_t boot_callbacks = {
Jeej 68:b2dd7309da44 102 .read = NULL,
Jeej 68:b2dd7309da44 103 .write = NULL,
Jeej 68:b2dd7309da44 104 .read_fprop = NULL,
Jeej 68:b2dd7309da44 105 .flush = NULL,
Jeej 68:b2dd7309da44 106 .remove = NULL,
Jeej 68:b2dd7309da44 107 .udata = NULL,
Jeej 68:b2dd7309da44 108 .lqual = NULL,
Jeej 68:b2dd7309da44 109 .ldown = NULL,
Jeej 68:b2dd7309da44 110 .reset = NULL,
Jeej 68:b2dd7309da44 111 .boot = my_startup_boot,
Jeej 68:b2dd7309da44 112 .busy = NULL,
Jeej 68:b2dd7309da44 113 .itf_busy = NULL,
Jeej 68:b2dd7309da44 114 };
Jeej 69:8f2fe2426ef9 115
Jeej 68:b2dd7309da44 116 // Open modem Com port
Jeej 68:b2dd7309da44 117 g_modem_com = new WizziCom(MODEM_PIN_RX, MODEM_PIN_TX, MODEM_PIN_IRQ_IN, MODEM_PIN_IRQ_OUT);
Jeej 69:8f2fe2426ef9 118
Jeej 68:b2dd7309da44 119 // open with user callbacks
Jeej 68:b2dd7309da44 120 modem_ref_open(modem_serial_send, callbacks);
Jeej 69:8f2fe2426ef9 121
Jeej 68:b2dd7309da44 122 // Redirect All Port traffic to modem_serial_input
Jeej 68:b2dd7309da44 123 g_modem_com->attach(modem_serial_input, WizziComPacketUntreated);
Jeej 68:b2dd7309da44 124
Jeej 68:b2dd7309da44 125 // Wait for modem power up
Jeej 68:b2dd7309da44 126 ThisThread::sleep_for(100);
Jeej 69:8f2fe2426ef9 127
Jeej 68:b2dd7309da44 128 // Try reading UID
Jeej 68:b2dd7309da44 129 err = modem_read_file(D7A_FID_UID, uid.b, 0, 8);
Jeej 69:8f2fe2426ef9 130
Jeej 68:b2dd7309da44 131 if (ALP_ERR_NONE > err)
Jeej 68:b2dd7309da44 132 {
Jeej 68:b2dd7309da44 133 PRINT("Trying software reset...\n");
Jeej 69:8f2fe2426ef9 134
Jeej 68:b2dd7309da44 135 // Open driver to catch boot packet
Jeej 68:b2dd7309da44 136 modem_ref_close();
Jeej 68:b2dd7309da44 137 modem_ref_open(NULL, &boot_callbacks);
Jeej 69:8f2fe2426ef9 138
Jeej 68:b2dd7309da44 139 // Try software reset
Jeej 68:b2dd7309da44 140 g_modem_com->send(WizziComPacketSysReset, 0, NULL);
Jeej 69:8f2fe2426ef9 141
Jeej 68:b2dd7309da44 142 if (!boot.try_acquire_for(1000))
Jeej 68:b2dd7309da44 143 {
Jeej 68:b2dd7309da44 144 PRINT("Trying hardware reset...\n");
Jeej 69:8f2fe2426ef9 145
Jeej 68:b2dd7309da44 146 // Assert reset pin
Jeej 68:b2dd7309da44 147 DigitalOut reset_low(MODEM_PIN_RESET, 0);
Jeej 68:b2dd7309da44 148 ThisThread::sleep_for(100);
Jeej 69:8f2fe2426ef9 149
Jeej 68:b2dd7309da44 150 // Release reset pin
Jeej 68:b2dd7309da44 151 DigitalIn reset_release(MODEM_PIN_RESET);
Jeej 69:8f2fe2426ef9 152
Jeej 68:b2dd7309da44 153 if (!boot.try_acquire_for(1000))
Jeej 68:b2dd7309da44 154 {
Jeej 72:15bf99fcfed9 155 #if 0
Jeej 68:b2dd7309da44 156 // Modem not responding!
Jeej 68:b2dd7309da44 157 PRINT("Trying power cycle.\n");
Jeej 69:8f2fe2426ef9 158
Jeej 68:b2dd7309da44 159 // Assert power pin
Jeej 68:b2dd7309da44 160 DigitalOut power_high(D12, 1);
Jeej 68:b2dd7309da44 161 ThisThread::sleep_for(1000);
Jeej 69:8f2fe2426ef9 162
Jeej 68:b2dd7309da44 163 // Release reset pin
Jeej 68:b2dd7309da44 164 DigitalIn power_release(D12);
Jeej 69:8f2fe2426ef9 165
Jeej 72:15bf99fcfed9 166 if (boot.try_acquire_for(1000))
Jeej 72:15bf99fcfed9 167 {
Jeej 72:15bf99fcfed9 168 g_pwc_nb++;
Jeej 72:15bf99fcfed9 169 PRINT("Modem is up after power cycle.\n");
Jeej 72:15bf99fcfed9 170 }
Jeej 72:15bf99fcfed9 171 else
Jeej 72:15bf99fcfed9 172 #endif
Jeej 68:b2dd7309da44 173 {
Jeej 68:b2dd7309da44 174 // Modem not responding!
Jeej 68:b2dd7309da44 175 g_fail_nb++;
Jeej 68:b2dd7309da44 176 PRINT("Failed to open modem.\n");
Jeej 68:b2dd7309da44 177 return -1;
Jeej 68:b2dd7309da44 178 }
Jeej 68:b2dd7309da44 179 }
Jeej 68:b2dd7309da44 180 else
Jeej 68:b2dd7309da44 181 {
Jeej 68:b2dd7309da44 182 g_hwr_nb++;
Jeej 68:b2dd7309da44 183 PRINT("Modem is up after hardware reset.\n");
Jeej 68:b2dd7309da44 184 }
Jeej 68:b2dd7309da44 185 }
Jeej 68:b2dd7309da44 186 else
Jeej 68:b2dd7309da44 187 {
Jeej 68:b2dd7309da44 188 g_swr_nb++;
Jeej 68:b2dd7309da44 189 PRINT("Modem is up after software reset.\n");
Jeej 68:b2dd7309da44 190 }
Jeej 69:8f2fe2426ef9 191
Jeej 69:8f2fe2426ef9 192 // Re-open with user callbacks
Jeej 69:8f2fe2426ef9 193 modem_ref_close();
Jeej 69:8f2fe2426ef9 194 modem_ref_open(modem_serial_send, callbacks);
Jeej 68:b2dd7309da44 195 }
Jeej 68:b2dd7309da44 196 else
Jeej 68:b2dd7309da44 197 {
Jeej 68:b2dd7309da44 198 g_read_nb++;
Jeej 68:b2dd7309da44 199 PRINT("Modem is up.\n");
Jeej 68:b2dd7309da44 200 }
Jeej 69:8f2fe2426ef9 201
Jeej 68:b2dd7309da44 202 PRINT("Boot stats: boot:%d read:%d swr:%d hwr:%d pwc:%d fail:%d\n", g_boot_nb, g_read_nb, g_swr_nb, g_hwr_nb, g_pwc_nb, g_fail_nb);
Jeej 69:8f2fe2426ef9 203
Jeej 69:8f2fe2426ef9 204 ThisThread::sleep_for(100);
Jeej 69:8f2fe2426ef9 205
Jeej 68:b2dd7309da44 206 modem_read_file(D7A_FID_UID, uid.b, 0, 8);
Jeej 68:b2dd7309da44 207 modem_read_file(D7A_FID_FIRMWARE_VERSION, (uint8_t*)&rev, 0, sizeof(revision_t));
Jeej 69:8f2fe2426ef9 208
Jeej 68:b2dd7309da44 209 PRINT("------------ D7A Modem infos ------------\r\n");
Jeej 68:b2dd7309da44 210 PRINT_DATA(" - UID: ", "%02X", uid.b, 8, "\r\n");
Jeej 68:b2dd7309da44 211 PRINT(" - Manufacturer ID: %08X\r\n", rev.manufacturer_id);
Jeej 68:b2dd7309da44 212 PRINT(" - Device ID: %08X\r\n", rev.device_id);
Jeej 68:b2dd7309da44 213 PRINT(" - Hardware version: %08X\r\n", rev.hw_version);
Jeej 68:b2dd7309da44 214 PRINT(" - Firmware version: v%d.%d.%d [%02X]\r\n", rev.fw_version.major, rev.fw_version.minor, rev.fw_version.patch, rev.fw_version.id);
Jeej 68:b2dd7309da44 215 PRINT(" - CUP max size: %d\r\n", rev.cup_max_size);
Jeej 68:b2dd7309da44 216 PRINT("-----------------------------------------\r\n");
Jeej 69:8f2fe2426ef9 217 FLUSH();
Jeej 69:8f2fe2426ef9 218
Jeej 75:dad2f09cb870 219 modem_cup_update(&rev);
Jeej 69:8f2fe2426ef9 220
Jeej 68:b2dd7309da44 221 return 0;
Jeej 68:b2dd7309da44 222 }
Jeej 68:b2dd7309da44 223
Jeej 68:b2dd7309da44 224 int modem_close(void)
Jeej 68:b2dd7309da44 225 {
Jeej 68:b2dd7309da44 226 modem_ref_close();
Jeej 68:b2dd7309da44 227 delete g_modem_com;
Jeej 69:8f2fe2426ef9 228
Jeej 68:b2dd7309da44 229 return 0;
Jeej 68:b2dd7309da44 230 }
Jeej 68:b2dd7309da44 231
Jeej 69:8f2fe2426ef9 232 static int _modem_d7a_send(void* itf, alp_payload_t* alp, alp_payload_t** alp_rsp, uint32_t timeout)
Jeej 68:b2dd7309da44 233 {
Jeej 69:8f2fe2426ef9 234 u8 id = modem_ref_get_id(modem_cb);
Jeej 68:b2dd7309da44 235 int err = ALP_ERR_UNKNOWN;
Jeej 70:753b602bd7bd 236
Jeej 70:753b602bd7bd 237 // Make sure Semaphore is taken
Jeej 70:753b602bd7bd 238 g_s[id].try_acquire();
Jeej 69:8f2fe2426ef9 239
Jeej 69:8f2fe2426ef9 240 modem_ref_alp(itf, alp, alp_rsp, id);
Jeej 69:8f2fe2426ef9 241 if (!g_s[id].try_acquire_for(timeout))
Jeej 69:8f2fe2426ef9 242 {
Jeej 69:8f2fe2426ef9 243 err = ALP_ERR_UNKNOWN;
Jeej 69:8f2fe2426ef9 244 }
Jeej 69:8f2fe2426ef9 245 else
Jeej 69:8f2fe2426ef9 246 {
Jeej 69:8f2fe2426ef9 247 err = ALP_ERR_NONE;
Jeej 69:8f2fe2426ef9 248 }
Jeej 69:8f2fe2426ef9 249
Jeej 68:b2dd7309da44 250 modem_ref_free_id(id);
Jeej 69:8f2fe2426ef9 251
Jeej 68:b2dd7309da44 252 return err;
Jeej 68:b2dd7309da44 253 }
Jeej 68:b2dd7309da44 254
Jeej 69:8f2fe2426ef9 255 static int _modem_get_istatus(alp_payload_t* alp, void* istatus)
Jeej 69:8f2fe2426ef9 256 {
Jeej 69:8f2fe2426ef9 257 alp_payload_t* alp_tmp = alp_payload_get(alp, ALP_OPCODE_RSP_ISTATUS);
Jeej 69:8f2fe2426ef9 258
Jeej 69:8f2fe2426ef9 259 if (alp_tmp)
Jeej 69:8f2fe2426ef9 260 {
Jeej 69:8f2fe2426ef9 261 alp_parsed_chunk_t r;
Jeej 69:8f2fe2426ef9 262 u8* p = alp_tmp->d;
Jeej 69:8f2fe2426ef9 263
Jeej 69:8f2fe2426ef9 264 alp_parse_chunk(&p, &r);
Jeej 69:8f2fe2426ef9 265 memcpy(istatus, r.data, r.meta.itf.length);
Jeej 69:8f2fe2426ef9 266
Jeej 69:8f2fe2426ef9 267 return ALP_ERR_NONE;
Jeej 69:8f2fe2426ef9 268 }
Jeej 69:8f2fe2426ef9 269 else
Jeej 69:8f2fe2426ef9 270 {
Jeej 69:8f2fe2426ef9 271 PRINT("No metadata\n");
Jeej 69:8f2fe2426ef9 272 }
Jeej 69:8f2fe2426ef9 273
Jeej 69:8f2fe2426ef9 274 return ALP_ERR_UNKNOWN;
Jeej 69:8f2fe2426ef9 275 }
Jeej 69:8f2fe2426ef9 276
Jeej 69:8f2fe2426ef9 277 int modem_raw_alp(alp_payload_t* alp, alp_payload_t** alp_rsp, uint32_t timeout)
Jeej 68:b2dd7309da44 278 {
Jeej 69:8f2fe2426ef9 279 return _modem_d7a_send(NULL, alp, alp_rsp, timeout);
Jeej 69:8f2fe2426ef9 280 }
Jeej 69:8f2fe2426ef9 281
Jeej 69:8f2fe2426ef9 282 int modem_remote_raw_alp(void* itf, alp_payload_t* alp, alp_payload_t** alp_rsp, uint32_t timeout)
Jeej 69:8f2fe2426ef9 283 {
Jeej 69:8f2fe2426ef9 284 return _modem_d7a_send(itf, alp, alp_rsp, timeout);
Jeej 69:8f2fe2426ef9 285 }
Jeej 69:8f2fe2426ef9 286
Jeej 69:8f2fe2426ef9 287 int modem_send_alp(void* itf, void *istatus, alp_payload_t* alp, uint32_t timeout)
Jeej 69:8f2fe2426ef9 288 {
Jeej 68:b2dd7309da44 289 int err = ALP_ERR_UNKNOWN;
Jeej 69:8f2fe2426ef9 290 alp_payload_t* alp_rsp = NULL;
Jeej 69:8f2fe2426ef9 291
Jeej 75:dad2f09cb870 292 err = _modem_d7a_send(itf, alp, &alp_rsp, timeout);
Jeej 69:8f2fe2426ef9 293
Jeej 69:8f2fe2426ef9 294 do {
Jeej 69:8f2fe2426ef9 295 if (ALP_ERR_NONE > err) { PRINT("Send ALP timeout\n"); break; }
Jeej 69:8f2fe2426ef9 296
Jeej 69:8f2fe2426ef9 297 err = alp_payload_get_err(alp_rsp);
Jeej 69:8f2fe2426ef9 298
Jeej 69:8f2fe2426ef9 299 if (ALP_ERR_NONE > err) { PRINT("Send ALP err %d\n", err); break; }
Jeej 69:8f2fe2426ef9 300
Jeej 69:8f2fe2426ef9 301 if (istatus)
Jeej 69:8f2fe2426ef9 302 {
Jeej 69:8f2fe2426ef9 303 _modem_get_istatus(alp_rsp, istatus);
Jeej 69:8f2fe2426ef9 304 }
Jeej 68:b2dd7309da44 305
Jeej 69:8f2fe2426ef9 306 } while (0);
Jeej 69:8f2fe2426ef9 307
Jeej 69:8f2fe2426ef9 308 alp_payload_free(alp_rsp);
Jeej 69:8f2fe2426ef9 309
Jeej 69:8f2fe2426ef9 310 return err;
Jeej 69:8f2fe2426ef9 311 }
Jeej 69:8f2fe2426ef9 312
Jeej 69:8f2fe2426ef9 313 static int _modem_read_file(uint8_t* itf, void *istatus, uint8_t fid, void *data, uint32_t offset, uint32_t length, uint32_t timeout)
Jeej 69:8f2fe2426ef9 314 {
Jeej 69:8f2fe2426ef9 315 int err = ALP_ERR_UNKNOWN;
Jeej 69:8f2fe2426ef9 316 alp_payload_t* alp = NULL;
Jeej 69:8f2fe2426ef9 317 alp_payload_t* alp_rsp = NULL;
Jeej 69:8f2fe2426ef9 318
Jeej 69:8f2fe2426ef9 319 alp = alp_payload_f_rd_data(NULL, fid, offset, length, false);
Jeej 69:8f2fe2426ef9 320
Jeej 69:8f2fe2426ef9 321 err = _modem_d7a_send(NULL, alp, &alp_rsp, timeout);
Jeej 68:b2dd7309da44 322
Jeej 69:8f2fe2426ef9 323 do {
Jeej 69:8f2fe2426ef9 324 if (ALP_ERR_NONE > err) { PRINT("Read file timeout\n"); break; }
Jeej 69:8f2fe2426ef9 325
Jeej 69:8f2fe2426ef9 326 err = alp_payload_get_err(alp_rsp);
Jeej 69:8f2fe2426ef9 327
Jeej 69:8f2fe2426ef9 328 if (ALP_ERR_NONE > err) { PRINT("Read file err %d\n", err); break; }
Jeej 69:8f2fe2426ef9 329
Jeej 75:dad2f09cb870 330 alp = alp_payload_get(alp_rsp, ALP_OPCODE_RSP_F_DATA);
Jeej 75:dad2f09cb870 331 if (alp)
Jeej 69:8f2fe2426ef9 332 {
Jeej 69:8f2fe2426ef9 333 alp_parsed_chunk_t r;
Jeej 75:dad2f09cb870 334 u8* p = alp->d;
Jeej 69:8f2fe2426ef9 335
Jeej 69:8f2fe2426ef9 336 alp_parse_chunk(&p, &r);
Jeej 69:8f2fe2426ef9 337 memcpy(data, r.data, r.meta.f_data.length);
Jeej 69:8f2fe2426ef9 338 }
Jeej 69:8f2fe2426ef9 339 else
Jeej 69:8f2fe2426ef9 340 {
Jeej 69:8f2fe2426ef9 341 PRINT("Read file no payload\n");
Jeej 69:8f2fe2426ef9 342 err = ALP_ERR_UNKNOWN;
Jeej 69:8f2fe2426ef9 343 break;
Jeej 69:8f2fe2426ef9 344 }
Jeej 69:8f2fe2426ef9 345
Jeej 69:8f2fe2426ef9 346 if (istatus)
Jeej 69:8f2fe2426ef9 347 {
Jeej 69:8f2fe2426ef9 348 _modem_get_istatus(alp_rsp, istatus);
Jeej 69:8f2fe2426ef9 349 }
Jeej 68:b2dd7309da44 350
Jeej 69:8f2fe2426ef9 351 } while (0);
Jeej 69:8f2fe2426ef9 352
Jeej 69:8f2fe2426ef9 353 alp_payload_free(alp_rsp);
Jeej 69:8f2fe2426ef9 354
Jeej 69:8f2fe2426ef9 355 return err;
Jeej 69:8f2fe2426ef9 356 }
Jeej 69:8f2fe2426ef9 357
Jeej 75:dad2f09cb870 358 int modem_read_file(uint8_t fid, void *data, uint32_t offset, uint32_t length)
Jeej 69:8f2fe2426ef9 359 {
Jeej 75:dad2f09cb870 360 return _modem_read_file(NULL, NULL, fid, data, offset, length, MODEM_TIMEOUT_LOCAL);
Jeej 68:b2dd7309da44 361 }
Jeej 68:b2dd7309da44 362
Jeej 75:dad2f09cb870 363 int modem_remote_read_file(uint8_t* itf, void *istatus, uint8_t fid, void *data, uint32_t offset, uint32_t length)
Jeej 68:b2dd7309da44 364 {
Jeej 75:dad2f09cb870 365 return _modem_read_file(itf, istatus, fid, data, offset, length, MODEM_TIMEOUT_DISTANT);
Jeej 68:b2dd7309da44 366 }
Jeej 68:b2dd7309da44 367
Jeej 68:b2dd7309da44 368 int modem_write_file(uint8_t fid, void *data, uint32_t offset, uint32_t length)
Jeej 68:b2dd7309da44 369 {
Jeej 75:dad2f09cb870 370 alp_payload_t* alp = alp_payload_f_wr_data(NULL, fid, data, offset, length, false);
Jeej 75:dad2f09cb870 371 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 68:b2dd7309da44 372 }
Jeej 68:b2dd7309da44 373
Jeej 75:dad2f09cb870 374 int modem_remote_write_file(uint8_t* itf, void *istatus , uint8_t fid, void *data, uint32_t offset, uint32_t length)
Jeej 68:b2dd7309da44 375 {
Jeej 75:dad2f09cb870 376 alp_payload_t* alp = alp_payload_f_wr_data(NULL, fid, data, offset, length, false);
Jeej 75:dad2f09cb870 377 return modem_send_alp(itf, istatus, alp, MODEM_TIMEOUT_DISTANT);
Jeej 75:dad2f09cb870 378 }
Jeej 75:dad2f09cb870 379
Jeej 75:dad2f09cb870 380 int modem_flush_file(uint8_t fid)
Jeej 75:dad2f09cb870 381 {
Jeej 75:dad2f09cb870 382 alp_payload_t* alp = alp_payload_f_flush(NULL, fid, false);
Jeej 75:dad2f09cb870 383 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 68:b2dd7309da44 384 }
Jeej 68:b2dd7309da44 385
Jeej 68:b2dd7309da44 386 int modem_declare_file(uint8_t fid, alp_file_header_t* header)
Jeej 68:b2dd7309da44 387 {
Jeej 75:dad2f09cb870 388 alp_payload_t* alp = alp_payload_f_declare(NULL, fid, header);
Jeej 75:dad2f09cb870 389 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 69:8f2fe2426ef9 390 }
Jeej 69:8f2fe2426ef9 391
Jeej 72:15bf99fcfed9 392 int modem_notify_file(uint8_t fid, uint32_t offset, uint32_t length)
Jeej 72:15bf99fcfed9 393 {
Jeej 75:dad2f09cb870 394 alp_payload_t* alp = alp_payload_f_touch(NULL, fid, offset, length, false);
Jeej 75:dad2f09cb870 395 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 72:15bf99fcfed9 396 }
Jeej 72:15bf99fcfed9 397
Jeej 69:8f2fe2426ef9 398 static int _modem_d7a_itf_enable(u8 enable)
Jeej 69:8f2fe2426ef9 399 {
Jeej 75:dad2f09cb870 400 alp_payload_t* alp = alp_payload_activate_itf(NULL, ALP_ITF_TYPE_D7A, 24, 0, ALP_D7A_ISTAT_RESP | ALP_D7A_ISTAT_UNS | ALP_D7A_ISTAT_EOP, enable);
Jeej 75:dad2f09cb870 401 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 68:b2dd7309da44 402 }
Jeej 68:b2dd7309da44 403
Jeej 68:b2dd7309da44 404 int modem_d7a_enable_itf(void)
Jeej 68:b2dd7309da44 405 {
Jeej 69:8f2fe2426ef9 406 return _modem_d7a_itf_enable(true);
Jeej 68:b2dd7309da44 407 }
Jeej 68:b2dd7309da44 408
Jeej 68:b2dd7309da44 409 int modem_d7a_disable_itf(void)
Jeej 68:b2dd7309da44 410 {
Jeej 69:8f2fe2426ef9 411 return _modem_d7a_itf_enable(false);
Jeej 69:8f2fe2426ef9 412 }
Jeej 69:8f2fe2426ef9 413
Jeej 69:8f2fe2426ef9 414 static int modem_lwan_set_urc(void)
Jeej 69:8f2fe2426ef9 415 {
Jeej 75:dad2f09cb870 416 alp_payload_t* alp = alp_payload_urcc_en(NULL, ALP_URC_TYPE_ITF_BUSY, FID_LWAN_ITF, 1);
Jeej 75:dad2f09cb870 417 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 69:8f2fe2426ef9 418 }
Jeej 69:8f2fe2426ef9 419
Jeej 69:8f2fe2426ef9 420 static int modem_lwan_enable_itf(void)
Jeej 69:8f2fe2426ef9 421 {
Jeej 75:dad2f09cb870 422 alp_payload_t* alp = alp_payload_activate_itf(NULL, ALP_ITF_TYPE_LWAN, 1, FID_LWAN_ITF, 0, true);
Jeej 75:dad2f09cb870 423 return modem_send_alp(NULL, NULL, alp, MODEM_TIMEOUT_LOCAL);
Jeej 69:8f2fe2426ef9 424 }
Jeej 69:8f2fe2426ef9 425
Jeej 69:8f2fe2426ef9 426 int modem_lwan_open(modem_lwan_callbacks_t* callbacks)
Jeej 69:8f2fe2426ef9 427 {
Jeej 68:b2dd7309da44 428 int err = ALP_ERR_UNKNOWN;
Jeej 68:b2dd7309da44 429
Jeej 69:8f2fe2426ef9 430 modem_ref_set_lwan_cb(callbacks);
Jeej 68:b2dd7309da44 431
Jeej 69:8f2fe2426ef9 432 err = modem_lwan_set_urc();
Jeej 69:8f2fe2426ef9 433 if (ALP_ERR_NONE > err) { return err; }
Jeej 69:8f2fe2426ef9 434
Jeej 69:8f2fe2426ef9 435 err = modem_lwan_enable_itf();
Jeej 68:b2dd7309da44 436
Jeej 68:b2dd7309da44 437 return err;
Jeej 68:b2dd7309da44 438 }
Jeej 68:b2dd7309da44 439
Jeej 69:8f2fe2426ef9 440 int modem_lwan_set_cfg(lwan_cfg_t* cfg)
Jeej 69:8f2fe2426ef9 441 {
Jeej 69:8f2fe2426ef9 442 return modem_write_file(FID_LWAN_CFG, cfg, 0, sizeof(lwan_cfg_t));
Jeej 69:8f2fe2426ef9 443 }
Jeej 69:8f2fe2426ef9 444
Jeej 69:8f2fe2426ef9 445 int modem_lwan_set_nls(lwan_nls_t* nls)
Jeej 69:8f2fe2426ef9 446 {
Jeej 69:8f2fe2426ef9 447 return modem_write_file(FID_LWAN_NLS, nls, 0, sizeof(lwan_nls_t));
Jeej 69:8f2fe2426ef9 448 }
Jeej 69:8f2fe2426ef9 449
Jeej 69:8f2fe2426ef9 450 int modem_lwan_send(alp_payload_t* alp)
Jeej 69:8f2fe2426ef9 451 {
Jeej 69:8f2fe2426ef9 452 alp_itf_lwan_cfg_t itf = { .type = ALP_ITF_TYPE_LWAN };
Jeej 69:8f2fe2426ef9 453
Jeej 75:dad2f09cb870 454 return modem_remote_raw_alp((void*)&itf, alp, NULL, MODEM_TIMEOUT_DISTANT);
Jeej 69:8f2fe2426ef9 455 }
Jeej 69:8f2fe2426ef9 456
Jeej 69:8f2fe2426ef9 457 int modem_lwan_get_status(lwan_status_t* status)
Jeej 69:8f2fe2426ef9 458 {
Jeej 69:8f2fe2426ef9 459 return modem_read_file(FID_LWAN_STATUS, status, 0, sizeof(lwan_status_t));
Jeej 69:8f2fe2426ef9 460 }
Jeej 69:8f2fe2426ef9 461
Jeej 69:8f2fe2426ef9 462 void modem_print_error(uint8_t itf, int error)
Jeej 68:b2dd7309da44 463 {
Jeej 68:b2dd7309da44 464 if (ALP_ERR_ITF_START >= error && ALP_ERR_ITF_END < error)
Jeej 68:b2dd7309da44 465 {
Jeej 68:b2dd7309da44 466 error -= ALP_ERR_ITF_START;
Jeej 68:b2dd7309da44 467 // Interface specific error
Jeej 68:b2dd7309da44 468 if (ALP_ITF_TYPE_HOST == itf)
Jeej 68:b2dd7309da44 469 {
Jeej 69:8f2fe2426ef9 470 PRINT("ITF[%02X] Error %d\r\n", itf, error);
Jeej 68:b2dd7309da44 471 }
Jeej 68:b2dd7309da44 472 else if (ALP_ITF_TYPE_COM == itf)
Jeej 68:b2dd7309da44 473 {
Jeej 69:8f2fe2426ef9 474 PRINT("ITF[%02X] Error %d\r\n", itf, error);
Jeej 68:b2dd7309da44 475 }
Jeej 68:b2dd7309da44 476 else if (ALP_ITF_TYPE_D7A == itf)
Jeej 68:b2dd7309da44 477 {
Jeej 68:b2dd7309da44 478 PRINT("ITF[%02X] ", itf);
Jeej 68:b2dd7309da44 479 switch (error)
Jeej 68:b2dd7309da44 480 {
Jeej 68:b2dd7309da44 481 /// No error
Jeej 68:b2dd7309da44 482 case D7A_ERROR_NO: // = 0,
Jeej 68:b2dd7309da44 483 PRINT("D7A_ERROR_NO\r\n");
Jeej 68:b2dd7309da44 484 break;
Jeej 69:8f2fe2426ef9 485 /// Resource busy
Jeej 68:b2dd7309da44 486 case D7A_ERROR_BUSY: // = -1,
Jeej 68:b2dd7309da44 487 PRINT("D7A_ERROR_BUSY\r\n");
Jeej 68:b2dd7309da44 488 break;
Jeej 69:8f2fe2426ef9 489 /// Bad parameter
Jeej 68:b2dd7309da44 490 case D7A_ERROR_BAD_PARAM: // = -2,
Jeej 68:b2dd7309da44 491 PRINT("D7A_ERROR_BAD_PARAM\r\n");
Jeej 68:b2dd7309da44 492 break;
Jeej 69:8f2fe2426ef9 493 /// Duty cycle limit overflow
Jeej 68:b2dd7309da44 494 case D7A_ERROR_DUTY_CYCLE: // = -3,
Jeej 68:b2dd7309da44 495 PRINT("D7A_ERROR_DUTY_CYCLE\r\n");
Jeej 68:b2dd7309da44 496 break;
Jeej 69:8f2fe2426ef9 497 /// CCA timeout
Jeej 68:b2dd7309da44 498 case D7A_ERROR_CCA_TO: // = -4,
Jeej 68:b2dd7309da44 499 PRINT("D7A_ERROR_CCA_TO\r\n");
Jeej 68:b2dd7309da44 500 break;
Jeej 69:8f2fe2426ef9 501 /// Security frame counter overflow
Jeej 68:b2dd7309da44 502 case D7A_ERROR_NLS_KEY: // = -5,
Jeej 68:b2dd7309da44 503 PRINT("D7A_ERROR_NLS_KEY\r\n");
Jeej 68:b2dd7309da44 504 break;
Jeej 69:8f2fe2426ef9 505 /// TX stream underflow
Jeej 68:b2dd7309da44 506 case D7A_ERROR_TX_UDF: // = -6,
Jeej 68:b2dd7309da44 507 PRINT("D7A_ERROR_TX_UDF\r\n");
Jeej 68:b2dd7309da44 508 break;
Jeej 69:8f2fe2426ef9 509 /// RX stream overflow
Jeej 68:b2dd7309da44 510 case D7A_ERROR_RX_OVF: // = -7,
Jeej 68:b2dd7309da44 511 PRINT("D7A_ERROR_RX_OVF\r\n");
Jeej 68:b2dd7309da44 512 break;
Jeej 69:8f2fe2426ef9 513 /// RX checksum
Jeej 68:b2dd7309da44 514 case D7A_ERROR_RX_CRC: // = -8,
Jeej 68:b2dd7309da44 515 PRINT("D7A_ERROR_RX_CRC\r\n");
Jeej 68:b2dd7309da44 516 break;
Jeej 69:8f2fe2426ef9 517 /// Abort
Jeej 68:b2dd7309da44 518 case D7A_ERROR_ABORT: // = -9,
Jeej 68:b2dd7309da44 519 PRINT("D7A_ERROR_ABORT\r\n");
Jeej 68:b2dd7309da44 520 break;
Jeej 69:8f2fe2426ef9 521 /// No ACK received
Jeej 68:b2dd7309da44 522 case D7A_ERROR_NO_ACK: // = -10,
Jeej 68:b2dd7309da44 523 PRINT("D7A_ERROR_NO_ACK\r\n");
Jeej 68:b2dd7309da44 524 break;
Jeej 69:8f2fe2426ef9 525 /// RX timeout
Jeej 69:8f2fe2426ef9 526 case D7A_ERROR_RX_TO: // = -11,
Jeej 68:b2dd7309da44 527 PRINT("D7A_ERROR_RX_TO\r\n");
Jeej 68:b2dd7309da44 528 break;
Jeej 68:b2dd7309da44 529 default:
Jeej 68:b2dd7309da44 530 PRINT("Unknown Error %d\r\n", error);
Jeej 68:b2dd7309da44 531 break;
Jeej 68:b2dd7309da44 532 }
Jeej 68:b2dd7309da44 533 }
Jeej 68:b2dd7309da44 534 else if (ALP_ITF_TYPE_LWAN == itf)
Jeej 68:b2dd7309da44 535 {
Jeej 69:8f2fe2426ef9 536 PRINT("ITF[%02X] Error %d\r\n", itf, error);
Jeej 68:b2dd7309da44 537 }
Jeej 68:b2dd7309da44 538 else
Jeej 68:b2dd7309da44 539 {
Jeej 69:8f2fe2426ef9 540 PRINT("ITF[%02X] Error %d\r\n", itf, error);
Jeej 68:b2dd7309da44 541 }
Jeej 68:b2dd7309da44 542 }
Jeej 68:b2dd7309da44 543 else
Jeej 68:b2dd7309da44 544 {
Jeej 69:8f2fe2426ef9 545 PRINT("ITF[%02X] ALP: ", itf);
Jeej 68:b2dd7309da44 546 switch (error)
Jeej 68:b2dd7309da44 547 {
Jeej 68:b2dd7309da44 548 // Not really errors, more like status
Jeej 69:8f2fe2426ef9 549 case ALP_ERR_ITF_FULL: // 0x02: For interfaces supporting buffering, indicates buffer reached maximum capacity (no data loss)
Jeej 68:b2dd7309da44 550 PRINT("ALP_ERR_ITF_FULL\r\n");
Jeej 68:b2dd7309da44 551 break;
Jeej 68:b2dd7309da44 552 case ALP_ERR_PARTIAL_COMPLETION: // 0x01: Action received and partially completed at response. To be completed after response
Jeej 68:b2dd7309da44 553 PRINT("ALP_ERR_PARTIAL_COMPLETION\r\n");
Jeej 68:b2dd7309da44 554 break;
Jeej 69:8f2fe2426ef9 555
Jeej 69:8f2fe2426ef9 556 // ALP Errors
Jeej 68:b2dd7309da44 557 case ALP_ERR_NONE: // 0x00: Action completed (OK)
Jeej 68:b2dd7309da44 558 PRINT("ALP_ERR_NONE\r\n");
Jeej 68:b2dd7309da44 559 break;
Jeej 68:b2dd7309da44 560 case ALP_ERR_FILE_NOT_FOUND: // 0xFF: Error access file: File ID does not exist
Jeej 68:b2dd7309da44 561 PRINT("ALP_ERR_FILE_NOT_FOUND\r\n");
Jeej 68:b2dd7309da44 562 break;
Jeej 68:b2dd7309da44 563 case ALP_ERR_FILE_EXIST: // 0xFE: Error create file: File ID already exists
Jeej 68:b2dd7309da44 564 PRINT("ALP_ERR_FILE_EXIST\r\n");
Jeej 68:b2dd7309da44 565 break;
Jeej 68:b2dd7309da44 566 case ALP_ERR_FILE_NOT_RESTORABLE: // 0xFD: Error restore file: File is not restorable
Jeej 68:b2dd7309da44 567 PRINT("ALP_ERR_FILE_NOT_RESTORABLEr\n");
Jeej 68:b2dd7309da44 568 break;
Jeej 68:b2dd7309da44 569 case ALP_ERR_PERMISSION_DENIED: // 0xFC: Error access file: Insufficient permissions
Jeej 68:b2dd7309da44 570 PRINT("ALP_ERR_PERMISSION_DENIED\r\n");
Jeej 68:b2dd7309da44 571 break;
Jeej 68:b2dd7309da44 572 case ALP_ERR_LENGTH_OVERFLOW: // 0xFB: Error create file: Supplied length (in header) is beyond file limits
Jeej 68:b2dd7309da44 573 PRINT("ALP_ERR_LENGTH_OVERFLOW\r\n");
Jeej 68:b2dd7309da44 574 break;
Jeej 68:b2dd7309da44 575 case ALP_ERR_ALLOC_OVERFLOW: // 0xFA: Error create file: Supplied allocation (in header) is beyond file limits
Jeej 68:b2dd7309da44 576 PRINT("ALP_ERR_ALLOC_OVERFLOW\r\n");
Jeej 68:b2dd7309da44 577 break;
Jeej 68:b2dd7309da44 578 case ALP_ERR_OFFSET_OVERFLOW: // 0xF9: Error write: Supplied start offset is out of bounds of file allocation
Jeej 68:b2dd7309da44 579 PRINT("ALP_ERR_OFFSET_OVERFLOW\r\n");
Jeej 68:b2dd7309da44 580 break;
Jeej 68:b2dd7309da44 581 case ALP_ERR_WRITE_OVERFLOW: // 0xF8: Error complete write: Supplied data goes beyond file allocation
Jeej 68:b2dd7309da44 582 PRINT("ALP_ERR_WRITE_OVERFLOW\r\n");
Jeej 68:b2dd7309da44 583 break;
Jeej 68:b2dd7309da44 584 case ALP_ERR_WRITE_ERROR: // 0xF7: Error write: impossible to write in storage location
Jeej 68:b2dd7309da44 585 PRINT("ALP_ERR_WRITE_ERROR\r\n");
Jeej 68:b2dd7309da44 586 break;
Jeej 68:b2dd7309da44 587 case ALP_ERR_OPERATION_UNKNOWN: // 0xF6: Error unknown Operation
Jeej 68:b2dd7309da44 588 PRINT("ALP_ERR_OPERATION_UNKNOWN\r\n");
Jeej 68:b2dd7309da44 589 break;
Jeej 68:b2dd7309da44 590 case ALP_ERR_OPERAND_INCOMPLETE: // 0xF5: Error incomplete Operand
Jeej 68:b2dd7309da44 591 PRINT("ALP_ERR_OPERAND_INCOMPLETE\r\n");
Jeej 68:b2dd7309da44 592 break;
Jeej 68:b2dd7309da44 593 case ALP_ERR_OPERAND_WRONG_FORMAT: // 0xF4: Error wrong Operand format
Jeej 68:b2dd7309da44 594 PRINT("ALP_ERR_OPERAND_WRONG_FORMAT\r\n");
Jeej 68:b2dd7309da44 595 break;
Jeej 68:b2dd7309da44 596 case ALP_ERR_ITF_INVALID: // 0xF3: Error invalid interface
Jeej 68:b2dd7309da44 597 PRINT("ALP_ERR_ITF_INVALID\r\n");
Jeej 68:b2dd7309da44 598 break;
Jeej 68:b2dd7309da44 599 case ALP_ERR_ITF_OVERFLOW: // 0xF2: Error interface overflown (i.e. resources exhausted, buffer full with data discarded)
Jeej 68:b2dd7309da44 600 PRINT("ALP_ERR_ITF_OVERFLOW\r\n");
Jeej 68:b2dd7309da44 601 break;
Jeej 68:b2dd7309da44 602 case ALP_ERR_QUERY_FAIL: // 0xF1: (Group of) Query result was false (Informative error code).
Jeej 68:b2dd7309da44 603 PRINT("ALP_ERR_QUERY_FAIL\r\n");
Jeej 68:b2dd7309da44 604 break;
Jeej 68:b2dd7309da44 605 case ALP_ERR_ITF_NOT_SPECIFIED:
Jeej 68:b2dd7309da44 606 PRINT("ALP_ERR_ITF_NOT_SPECIFIED\r\n");
Jeej 68:b2dd7309da44 607 break;
Jeej 69:8f2fe2426ef9 608
Jeej 69:8f2fe2426ef9 609 // Other Errors
Jeej 68:b2dd7309da44 610 case ALP_ERR_UNKNOWN: // 0x80: Unknown error
Jeej 68:b2dd7309da44 611 PRINT("ALP_ERR_UNKNOWN\r\n");
Jeej 68:b2dd7309da44 612 break;
Jeej 68:b2dd7309da44 613 case ALP_ERR_FS_TIMEOUT: // 0x81: Internal FS Error
Jeej 68:b2dd7309da44 614 PRINT("ALP_ERR_FS_TIMEOUT\r\n");
Jeej 68:b2dd7309da44 615 break;
Jeej 68:b2dd7309da44 616 case ALP_ERR_ITF_UNKNOWN: // 0x82: Unknown Interface
Jeej 68:b2dd7309da44 617 PRINT("ALP_ERR_ITF_UNKNOWN\r\n");
Jeej 68:b2dd7309da44 618 break;
Jeej 68:b2dd7309da44 619 case ALP_ERR_ITF_TIMEOUT: // 0x83: Internal ITF Error
Jeej 68:b2dd7309da44 620 PRINT("ALP_ERR_ITF_TIMEOUT\r\n");
Jeej 68:b2dd7309da44 621 break;
Jeej 68:b2dd7309da44 622 default:
Jeej 68:b2dd7309da44 623 PRINT("Unknown Error %d\r\n", error);
Jeej 68:b2dd7309da44 624 break;
Jeej 68:b2dd7309da44 625 }
Jeej 68:b2dd7309da44 626 }
Jeej 69:8f2fe2426ef9 627 }