Trond Enger / d7a_1x

Fork of d7a_1x by WizziLab

Committer:
Jeej
Date:
Mon Oct 10 13:31:44 2016 +0000
Revision:
63:afd046faedb0
Parent:
60:8d4133fbc060
Child:
66:492b1d7ba370
Reduced command timeout

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 55:5ea18a3a01b9 12 #define FIRST_IFT_FILE (108)
Jeej 55:5ea18a3a01b9 13
Jeej 49:81d5bddb02f0 14 bool g_open = false;
Jeej 49:81d5bddb02f0 15 bool g_local_fs = false;
Jeej 43:28202405094d 16
Jeej 53:3e4aa4b57090 17
Jeej 49:81d5bddb02f0 18 d7a_errors_t d7a_open(const d7a_com_config_t* com_config, PinName reset_pin, const d7a_callbacks_t* callbacks)
Jeej 43:28202405094d 19 {
Jeej 45:b85384e7d825 20 FPRINT("\r\n");
Jeej 45:b85384e7d825 21
Jeej 49:81d5bddb02f0 22 d7a_errors_t err;
Jeej 49:81d5bddb02f0 23
Jeej 49:81d5bddb02f0 24 if (g_open)
Jeej 49:81d5bddb02f0 25 {
Jeej 51:644de6fe1ee7 26 WARNING(false, "D7A Already open\r\n");
Jeej 49:81d5bddb02f0 27 return D7A_ERR_NONE;
Jeej 49:81d5bddb02f0 28 }
Jeej 49:81d5bddb02f0 29
Jeej 55:5ea18a3a01b9 30 do
Jeej 55:5ea18a3a01b9 31 {
Jeej 55:5ea18a3a01b9 32
Jeej 55:5ea18a3a01b9 33 err = d7a_com_open(com_config);
Jeej 56:da34fc11e760 34 if (err < D7A_ERR_NONE) break;
Jeej 55:5ea18a3a01b9 35
Jeej 55:5ea18a3a01b9 36 err = d7a_sys_open();
Jeej 56:da34fc11e760 37 if (err < D7A_ERR_NONE) break;
Jeej 55:5ea18a3a01b9 38
Jeej 55:5ea18a3a01b9 39 err = d7a_fs_open(callbacks->write_file, callbacks->read_file);
Jeej 56:da34fc11e760 40 if (err < D7A_ERR_NONE) break;
Jeej 55:5ea18a3a01b9 41
Jeej 59:b42eae56b51b 42 err = d7a_alp_open(callbacks->unsolicited_msg);
Jeej 56:da34fc11e760 43 if (err < D7A_ERR_NONE) break;
Jeej 55:5ea18a3a01b9 44
Jeej 55:5ea18a3a01b9 45 err = d7a_modem_open(reset_pin, callbacks->notif_done);
Jeej 56:da34fc11e760 46 if (err < D7A_ERR_NONE) break;
Jeej 55:5ea18a3a01b9 47
Jeej 55:5ea18a3a01b9 48 if (callbacks->write_file != NULL && callbacks->read_file != NULL)
Jeej 55:5ea18a3a01b9 49 {
Jeej 55:5ea18a3a01b9 50 g_local_fs = true;
Jeej 55:5ea18a3a01b9 51 }
Jeej 55:5ea18a3a01b9 52
Jeej 55:5ea18a3a01b9 53 g_open = true;
Jeej 55:5ea18a3a01b9 54
Jeej 55:5ea18a3a01b9 55 } while (0);
Jeej 49:81d5bddb02f0 56
Jeej 63:afd046faedb0 57 WARNING(err == D7A_ERR_NONE, "%s err %d\r\n", __FUNCTION__, err);
Jeej 49:81d5bddb02f0 58
Jeej 49:81d5bddb02f0 59 return err;
Jeej 43:28202405094d 60 }
Jeej 43:28202405094d 61
Jeej 53:3e4aa4b57090 62
Jeej 45:b85384e7d825 63 d7a_errors_t d7a_close(void)
Jeej 43:28202405094d 64 {
Jeej 45:b85384e7d825 65 FPRINT("\r\n");
Jeej 45:b85384e7d825 66
Jeej 49:81d5bddb02f0 67 d7a_errors_t err;
Jeej 49:81d5bddb02f0 68
Jeej 56:da34fc11e760 69 do
Jeej 56:da34fc11e760 70 {
Jeej 56:da34fc11e760 71 err = d7a_com_close();
Jeej 56:da34fc11e760 72 if (err < D7A_ERR_NONE) break;
Jeej 56:da34fc11e760 73
Jeej 56:da34fc11e760 74 err = d7a_modem_close();
Jeej 56:da34fc11e760 75 if (err < D7A_ERR_NONE) break;
Jeej 56:da34fc11e760 76
Jeej 56:da34fc11e760 77 err = d7a_fs_close();
Jeej 56:da34fc11e760 78 if (err < D7A_ERR_NONE) break;
Jeej 56:da34fc11e760 79
Jeej 56:da34fc11e760 80 err = d7a_sys_close();
Jeej 56:da34fc11e760 81 } while (0);
Jeej 45:b85384e7d825 82
Jeej 63:afd046faedb0 83 WARNING(err == D7A_ERR_NONE, "%s err %d\r\n", __FUNCTION__, err);
Jeej 55:5ea18a3a01b9 84
Jeej 50:30440c9aeb7c 85 return err;
Jeej 43:28202405094d 86 }
Jeej 43:28202405094d 87
Jeej 43:28202405094d 88
Jeej 45:b85384e7d825 89 d7a_errors_t d7a_start(void)
Jeej 43:28202405094d 90 {
Jeej 45:b85384e7d825 91 FPRINT("\r\n");
Jeej 45:b85384e7d825 92
Jeej 49:81d5bddb02f0 93 d7a_errors_t err;
Jeej 49:81d5bddb02f0 94
Jeej 50:30440c9aeb7c 95 err = d7a_modem_start();
Jeej 45:b85384e7d825 96
Jeej 63:afd046faedb0 97 WARNING(err == D7A_ERR_NONE, "%s err %d\r\n", __FUNCTION__, err);
Jeej 55:5ea18a3a01b9 98
Jeej 50:30440c9aeb7c 99 return err;
Jeej 43:28202405094d 100 }
Jeej 43:28202405094d 101
Jeej 53:3e4aa4b57090 102
Jeej 45:b85384e7d825 103 d7a_errors_t d7a_stop(void)
Jeej 43:28202405094d 104 {
Jeej 45:b85384e7d825 105 FPRINT("\r\n");
Jeej 45:b85384e7d825 106
Jeej 49:81d5bddb02f0 107 d7a_errors_t err;
Jeej 49:81d5bddb02f0 108
Jeej 50:30440c9aeb7c 109 err = d7a_modem_stop();
Jeej 45:b85384e7d825 110
Jeej 63:afd046faedb0 111 WARNING(err == D7A_ERR_NONE, "%s err %d\r\n", __FUNCTION__, err);
Jeej 55:5ea18a3a01b9 112
Jeej 50:30440c9aeb7c 113 return err;
Jeej 43:28202405094d 114 }
Jeej 43:28202405094d 115
Jeej 53:3e4aa4b57090 116
Jeej 55:5ea18a3a01b9 117 d7a_errors_t d7a_create(const uint8_t file_id, d7a_fs_storage_t prop, d7a_fs_perm_t perm, uint32_t size, uint32_t alloc, d7a_action_t action, alp_rpol_t retry)
Jeej 43:28202405094d 118 {
Jeej 45:b85384e7d825 119 FPRINT("\r\n");
Jeej 45:b85384e7d825 120
Jeej 45:b85384e7d825 121 d7a_errors_t err;
Jeej 45:b85384e7d825 122
Jeej 45:b85384e7d825 123 DPRINT("Create %d.\r\n", file_id);
Jeej 45:b85384e7d825 124
Jeej 43:28202405094d 125 register_file_param_t file_infos = {
Jeej 43:28202405094d 126 .fid = file_id,
Jeej 45:b85384e7d825 127 .type = RAM,
Jeej 55:5ea18a3a01b9 128 .afid = action,
Jeej 55:5ea18a3a01b9 129 .ifid = FIRST_IFT_FILE + retry, // The interface files match the retry policies
Jeej 55:5ea18a3a01b9 130 .prop = (uint8_t)prop | ((action)? FS_ACT_EN : 0),
Jeej 43:28202405094d 131 .perm = (uint8_t)perm,
Jeej 43:28202405094d 132 .size = size,
Jeej 43:28202405094d 133 .alloc = alloc,
Jeej 43:28202405094d 134 };
Jeej 43:28202405094d 135
Jeej 45:b85384e7d825 136 err = d7a_modem_register(&file_infos);
Jeej 45:b85384e7d825 137
Jeej 45:b85384e7d825 138 DPRINT("Create %d Done. err %d\r\n", file_id, err);
Jeej 45:b85384e7d825 139
Jeej 63:afd046faedb0 140 WARNING(err == D7A_ERR_NONE, "%s FID %d err %d\r\n", __FUNCTION__, file_id, err);
Jeej 55:5ea18a3a01b9 141
Jeej 45:b85384e7d825 142 return err;
Jeej 43:28202405094d 143 }
Jeej 43:28202405094d 144
Jeej 53:3e4aa4b57090 145
Jeej 55:5ea18a3a01b9 146 d7a_errors_t d7a_declare(const uint8_t file_id, d7a_fs_storage_t prop, d7a_fs_perm_t perm, uint32_t length, uint32_t alloc, d7a_action_t action, alp_rpol_t retry)
Jeej 43:28202405094d 147 {
Jeej 45:b85384e7d825 148 FPRINT("\r\n");
Jeej 49:81d5bddb02f0 149
Jeej 46:665391110051 150 d7a_errors_t err;
Jeej 46:665391110051 151
Jeej 45:b85384e7d825 152 DPRINT("Declare %d.\r\n", file_id);
Jeej 45:b85384e7d825 153
Jeej 55:5ea18a3a01b9 154 ASSERT(g_local_fs, "You cannot delare a file if the write_file/read_file callbacks are not specified\r\n");
Jeej 49:81d5bddb02f0 155
Jeej 43:28202405094d 156 register_file_param_t file_infos = {
Jeej 43:28202405094d 157 .fid = file_id,
Jeej 45:b85384e7d825 158 .type = HOST+RAM,
Jeej 55:5ea18a3a01b9 159 .afid = action,
Jeej 55:5ea18a3a01b9 160 .ifid = FIRST_IFT_FILE + retry, // The interface files match the retry policies
Jeej 55:5ea18a3a01b9 161 .prop = (uint8_t)prop | ((action)? FS_ACT_EN : 0),
Jeej 43:28202405094d 162 .perm = (uint8_t)perm,
Jeej 43:28202405094d 163 .size = length,
Jeej 43:28202405094d 164 .alloc = alloc,
Jeej 43:28202405094d 165 };
Jeej 43:28202405094d 166
Jeej 46:665391110051 167 err = d7a_modem_register(&file_infos);
Jeej 45:b85384e7d825 168
Jeej 45:b85384e7d825 169 DPRINT("Declare %d Done\r\n", file_id);
Jeej 45:b85384e7d825 170
Jeej 63:afd046faedb0 171 WARNING(err == D7A_ERR_NONE, "%s FID %d err %d\r\n", __FUNCTION__, file_id, err);
Jeej 55:5ea18a3a01b9 172
Jeej 46:665391110051 173 return err;
Jeej 43:28202405094d 174 }
Jeej 43:28202405094d 175
Jeej 53:3e4aa4b57090 176
Jeej 58:38a366236bda 177 d7a_msg_t** d7a_read(const uint8_t file_id, const uint32_t offset, const uint32_t size, d7a_addressee_t* addressee, alp_rpol_t retry)
Jeej 43:28202405094d 178 {
Jeej 45:b85384e7d825 179 FPRINT("\r\n");
Jeej 45:b85384e7d825 180
Jeej 58:38a366236bda 181 d7a_msg_t** ret;
Jeej 46:665391110051 182
Jeej 63:afd046faedb0 183 DPRINT("Read %d @%d %d bytes.\r\n", file_id, offset, size);
Jeej 46:665391110051 184
Jeej 58:38a366236bda 185 ret = d7a_alp_read_file(file_id, offset, size, addressee, retry);
Jeej 46:665391110051 186
Jeej 58:38a366236bda 187 DPRINT("Read %d Done.\r\n", file_id);
Jeej 45:b85384e7d825 188
Jeej 63:afd046faedb0 189 WARNING(ret[0]->err == D7A_ERR_NONE, "%s FID: %d OFF: %d LEN: %d err %d\r\n", __FUNCTION__, file_id, offset, size, ret[0]->err);
Jeej 55:5ea18a3a01b9 190
Jeej 58:38a366236bda 191 return ret;
Jeej 46:665391110051 192 }
Jeej 46:665391110051 193
Jeej 53:3e4aa4b57090 194
Jeej 58:38a366236bda 195 d7a_msg_t** d7a_write(const uint8_t file_id, const uint32_t offset, const uint32_t size, const uint8_t* const buf, d7a_addressee_t* addressee, alp_rpol_t retry, bool resp)
Jeej 46:665391110051 196 {
Jeej 46:665391110051 197 FPRINT("\r\n");
Jeej 46:665391110051 198
Jeej 58:38a366236bda 199 d7a_msg_t** ret;
Jeej 46:665391110051 200
Jeej 63:afd046faedb0 201 DPRINT("Write %d @%d %d bytes.\r\n", file_id, offset, size);
Jeej 46:665391110051 202
Jeej 58:38a366236bda 203 ret = d7a_alp_write_file(file_id, offset, size, buf, addressee, retry, resp);
Jeej 46:665391110051 204
Jeej 58:38a366236bda 205 DPRINT("Write %d Done.\r\n", file_id);
Jeej 46:665391110051 206
Jeej 63:afd046faedb0 207 WARNING(ret[0]->err == D7A_ERR_NONE, "%s FID: %d OFF: %d LEN: %d err %d\r\n", __FUNCTION__, file_id, offset, size, ret[0]->err);
Jeej 55:5ea18a3a01b9 208
Jeej 58:38a366236bda 209 return ret;
Jeej 43:28202405094d 210 }
Jeej 43:28202405094d 211
Jeej 53:3e4aa4b57090 212
Jeej 46:665391110051 213 d7a_errors_t d7a_notify(const uint8_t file_id, const uint32_t offset, const uint32_t size)
Jeej 43:28202405094d 214 {
Jeej 45:b85384e7d825 215 FPRINT("\r\n");
Jeej 45:b85384e7d825 216
Jeej 46:665391110051 217 d7a_errors_t err;
Jeej 46:665391110051 218
Jeej 63:afd046faedb0 219 DPRINT("Notify %d @%d %d bytes.\r\n", file_id, offset, size);
Jeej 45:b85384e7d825 220
Jeej 46:665391110051 221 notify_file_param_t notif = {
Jeej 46:665391110051 222 .bf.fid = file_id,
Jeej 46:665391110051 223 .bf.offset = offset,
Jeej 46:665391110051 224 .bf.size = size
Jeej 46:665391110051 225 };
Jeej 46:665391110051 226
Jeej 46:665391110051 227 err = d7a_modem_notify(&notif);
Jeej 46:665391110051 228
Jeej 46:665391110051 229 DPRINT("Notify %d Done. err %d\r\n", file_id, err);
Jeej 46:665391110051 230
Jeej 63:afd046faedb0 231 WARNING(err == D7A_ERR_NONE, "%s FID: %d OFF: %d LEN: %d err %d\r\n", __FUNCTION__, file_id, offset, size, err);
Jeej 55:5ea18a3a01b9 232
Jeej 46:665391110051 233 return err;
Jeej 50:30440c9aeb7c 234 }
Jeej 50:30440c9aeb7c 235
Jeej 50:30440c9aeb7c 236
Jeej 58:38a366236bda 237 void d7a_free_msg(d7a_msg_t** msg)
Jeej 58:38a366236bda 238 {
Jeej 58:38a366236bda 239 int i = 0;
Jeej 58:38a366236bda 240 while (msg[i] != NULL)
Jeej 58:38a366236bda 241 {
Jeej 59:b42eae56b51b 242 d7a_alp_free_msg(msg[i]);
Jeej 58:38a366236bda 243 i++;
Jeej 58:38a366236bda 244 }
Jeej 58:38a366236bda 245
Jeej 58:38a366236bda 246 FREE(msg);
Jeej 58:38a366236bda 247 }
Jeej 58:38a366236bda 248
Jeej 60:8d4133fbc060 249 void d7a_print_msg(d7a_msg_t** msg)
Jeej 60:8d4133fbc060 250 {
Jeej 60:8d4133fbc060 251 uint8_t i = 0;
Jeej 60:8d4133fbc060 252 while (msg[i] != NULL)
Jeej 60:8d4133fbc060 253 {
Jeej 60:8d4133fbc060 254 PRINT("MSG %2d ERR:%4d", i, msg[i]->err);
Jeej 60:8d4133fbc060 255 if (msg[i]->lb)
Jeej 60:8d4133fbc060 256 {
Jeej 60:8d4133fbc060 257 PRINT_DATA(" UID:", "%02X", msg[i]->id, 8, " ");
Jeej 60:8d4133fbc060 258 PRINT("LB:%3d", msg[i]->lb);
Jeej 60:8d4133fbc060 259 }
Jeej 60:8d4133fbc060 260 if (msg[i]->data)
Jeej 60:8d4133fbc060 261 {
Jeej 60:8d4133fbc060 262 PRINT(" FID: %3d OFF: %3d LEN: %3d", msg[i]->data->fid, msg[i]->data->offset, msg[i]->data->length);
Jeej 60:8d4133fbc060 263 PRINT_DATA(" DATA:", " %02X", msg[i]->data->buf, msg[i]->data->length, "");
Jeej 60:8d4133fbc060 264 }
Jeej 60:8d4133fbc060 265 PRINT("\r\n");
Jeej 60:8d4133fbc060 266 i++;
Jeej 60:8d4133fbc060 267 }
Jeej 60:8d4133fbc060 268 }
Jeej 58:38a366236bda 269
Jeej 50:30440c9aeb7c 270 void d7a_modem_print_infos(void)
Jeej 50:30440c9aeb7c 271 {
Jeej 50:30440c9aeb7c 272 uint8_t uid[8];
Jeej 50:30440c9aeb7c 273 d7a_revision_t rev;
Jeej 50:30440c9aeb7c 274
Jeej 58:38a366236bda 275 d7a_msg_t** msg;
Jeej 58:38a366236bda 276
Jeej 60:8d4133fbc060 277 msg = d7a_read(0, 0, D7A_UID_LEN);
Jeej 60:8d4133fbc060 278 ASSERT(msg[0]->err >= D7A_ERR_NONE, "Failed to read UID file. err %d\r\n", msg[0]->err);
Jeej 60:8d4133fbc060 279 ASSERT(msg[0]->data, "No data in response\r\n");
Jeej 60:8d4133fbc060 280 memcpy(uid, msg[0]->data->buf, D7A_UID_LEN);
Jeej 58:38a366236bda 281 d7a_free_msg(msg);
Jeej 58:38a366236bda 282
Jeej 58:38a366236bda 283 msg = d7a_read(2, 0, sizeof(d7a_revision_t));
Jeej 63:afd046faedb0 284 ASSERT(msg[0]->err >= D7A_ERR_NONE, "Failed to read Revision file. err %d\r\n", msg[0]->err);
Jeej 60:8d4133fbc060 285 ASSERT(msg[0]->data, "No data in response\r\n");
Jeej 59:b42eae56b51b 286 memcpy(&rev, msg[0]->data->buf, sizeof(d7a_revision_t));
Jeej 58:38a366236bda 287 d7a_free_msg(msg);
Jeej 50:30440c9aeb7c 288
Jeej 50:30440c9aeb7c 289 PRINT("------------ D7A Modem infos ------------\r\n");
Jeej 50:30440c9aeb7c 290 PRINT_DATA("| UID: ", "%02X", uid, 8, " |\r\n");
Jeej 50:30440c9aeb7c 291 PRINT("| Manufacturer ID: %08X |\r\n", rev.manufacturer_id);
Jeej 50:30440c9aeb7c 292 PRINT("| Device ID: %08X |\r\n", rev.device_id);
Jeej 50:30440c9aeb7c 293 PRINT("| Hardware version: %08X |\r\n", rev.hw_version);
Jeej 50:30440c9aeb7c 294 PRINT("| Firmware version: %d-%d.%d.%d-%08x \t|\r\n", rev.fw_version.id, rev.fw_version.major, rev.fw_version.minor, rev.fw_version.patch, rev.fw_version.hash);
Jeej 50:30440c9aeb7c 295 PRINT("| File system CRC: 0x%08x |\r\n", rev.fs_crc);
Jeej 50:30440c9aeb7c 296 PRINT("-----------------------------------------\r\n");
Jeej 50:30440c9aeb7c 297
Jeej 43:28202405094d 298 }