Broadcast read demo.
Dependencies: modem_ref_helper DebouncedInterrupt
main.cpp@3:a240b300fae9, 2017-05-17 (annotated)
- Committer:
- Jeej
- Date:
- Wed May 17 14:42:28 2017 +0000
- Revision:
- 3:a240b300fae9
- Parent:
- 2:4629eacf9851
- Child:
- 4:94bfd123f8e6
Added modem version check.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Jeej | 0:cc947267028b | 1 | // @autor: jeremie@wizzilab.com |
Jeej | 0:cc947267028b | 2 | // @date: 2017-05-02 |
Jeej | 0:cc947267028b | 3 | |
Jeej | 0:cc947267028b | 4 | #include "mbed.h" |
Jeej | 0:cc947267028b | 5 | #include "rtos.h" |
Jeej | 0:cc947267028b | 6 | #include "DebouncedInterrupt.h" |
Jeej | 0:cc947267028b | 7 | #include "WizziDebug.h" |
Jeej | 0:cc947267028b | 8 | #include "WizziCom.h" |
Jeej | 0:cc947267028b | 9 | |
Jeej | 0:cc947267028b | 10 | #include "hwcfg.h" |
Jeej | 0:cc947267028b | 11 | #include "modem_callbacks.h" |
Jeej | 0:cc947267028b | 12 | |
Jeej | 0:cc947267028b | 13 | #include "revision.h" |
Jeej | 0:cc947267028b | 14 | #include "alp_spec.h" |
Jeej | 0:cc947267028b | 15 | #include "alp_helpers.h" |
Jeej | 0:cc947267028b | 16 | #include "modem_ref.h" |
Jeej | 0:cc947267028b | 17 | #include "kal_fs.h" |
Jeej | 0:cc947267028b | 18 | #include "d7a_1x.h" |
Jeej | 2:4629eacf9851 | 19 | #include "d7a_1x_fs.h" |
Jeej | 0:cc947267028b | 20 | #include "alp.h" |
Jeej | 0:cc947267028b | 21 | |
Jeej | 3:a240b300fae9 | 22 | #define MODEM_VERSION_MAJOR 4 |
Jeej | 3:a240b300fae9 | 23 | #define MODEM_VERSION_MINOR 8 |
Jeej | 0:cc947267028b | 24 | |
Jeej | 0:cc947267028b | 25 | WizziCom* g_modem_com; |
Jeej | 0:cc947267028b | 26 | Semaphore button_user(0); |
Jeej | 2:4629eacf9851 | 27 | Semaphore modem_ready[MAX_USER_NB]; |
Jeej | 0:cc947267028b | 28 | Queue<void, 8> modem_resp; |
Jeej | 0:cc947267028b | 29 | |
Jeej | 0:cc947267028b | 30 | enum { |
Jeej | 0:cc947267028b | 31 | MODEM_RESP_NO, |
Jeej | 0:cc947267028b | 32 | MODEM_RESP_TERMINAL, |
Jeej | 0:cc947267028b | 33 | MODEM_RESP_DONE, |
Jeej | 0:cc947267028b | 34 | }; |
Jeej | 0:cc947267028b | 35 | |
Jeej | 0:cc947267028b | 36 | uint8_t g_main_id; |
Jeej | 0:cc947267028b | 37 | |
Jeej | 0:cc947267028b | 38 | TYPEDEF_STRUCT_PACKED { |
Jeej | 0:cc947267028b | 39 | uint8_t type; |
Jeej | 0:cc947267028b | 40 | d7a_sp_cfg_t cfg; |
Jeej | 0:cc947267028b | 41 | } alp_d7a_itf_t; |
Jeej | 0:cc947267028b | 42 | |
Jeej | 0:cc947267028b | 43 | #define WM_FID_ALP_CFG 50 |
Jeej | 0:cc947267028b | 44 | #define MY_POLICY_IDX 0 |
Jeej | 0:cc947267028b | 45 | |
Jeej | 0:cc947267028b | 46 | alp_retry_policy_t my_policy = { |
Jeej | 0:cc947267028b | 47 | .meta.procedure = 0, |
Jeej | 0:cc947267028b | 48 | .meta.respond = true, |
Jeej | 0:cc947267028b | 49 | .meta.persistant = false, |
Jeej | 0:cc947267028b | 50 | .meta.bulk = false, |
Jeej | 0:cc947267028b | 51 | .depth = 1, |
Jeej | 0:cc947267028b | 52 | .retries = 0, |
Jeej | 0:cc947267028b | 53 | .slot_time = 0 |
Jeej | 0:cc947267028b | 54 | }; |
Jeej | 0:cc947267028b | 55 | |
Jeej | 0:cc947267028b | 56 | #define D7A_CTF_VAL(mant,exp) ((uint8_t)(mant|(exp<<5))) |
Jeej | 0:cc947267028b | 57 | #define ALP_ITF_TYPE_D7A 0xD7 |
Jeej | 0:cc947267028b | 58 | alp_d7a_itf_t my_itf = { |
Jeej | 0:cc947267028b | 59 | .type = ALP_ITF_TYPE_D7A, |
Jeej | 0:cc947267028b | 60 | .cfg.to = 0, |
Jeej | 0:cc947267028b | 61 | .cfg.te = 0, |
Jeej | 0:cc947267028b | 62 | .cfg.qos.bf.resp = D7A_RESP_ALL, |
Jeej | 0:cc947267028b | 63 | .cfg.qos.bf.retry = MY_POLICY_IDX, |
Jeej | 0:cc947267028b | 64 | .cfg.qos.bf.record = 0, |
Jeej | 0:cc947267028b | 65 | .cfg.qos.bf.stop_on_err = 0, |
Jeej | 0:cc947267028b | 66 | .cfg.addressee.ctrl.bf.nls = D7A_NLS_AES_CCM_64, |
Jeej | 0:cc947267028b | 67 | .cfg.addressee.ctrl.bf.idf = D7A_ID_NBID, |
Jeej | 0:cc947267028b | 68 | .cfg.addressee.xcl.bf = {.s = 0x2, .m = 0x1},// XXX D7A_XCL_GW, |
Jeej | 1:5ddd7f4db10d | 69 | .cfg.addressee.id[0] = D7A_CTF_VAL(8,0), |
Jeej | 0:cc947267028b | 70 | }; |
Jeej | 0:cc947267028b | 71 | |
Jeej | 0:cc947267028b | 72 | #define MY_D7_ITF_SIZE(_itf) (1+my_alp_itf_d7a_cfg_size(&(_itf)->cfg)) |
Jeej | 0:cc947267028b | 73 | int my_alp_itf_d7a_cfg_size(d7a_sp_cfg_t* cfg) |
Jeej | 0:cc947267028b | 74 | { |
Jeej | 0:cc947267028b | 75 | int size = sizeof(d7a_sp_cfg_t) - sizeof(d7a_addressee_t); |
Jeej | 0:cc947267028b | 76 | size += D7A_ADDR_LEN(cfg->addressee.ctrl); |
Jeej | 0:cc947267028b | 77 | return size; |
Jeej | 0:cc947267028b | 78 | } |
Jeej | 0:cc947267028b | 79 | |
Jeej | 0:cc947267028b | 80 | void print_status(int status) |
Jeej | 0:cc947267028b | 81 | { |
Jeej | 0:cc947267028b | 82 | switch (status) |
Jeej | 0:cc947267028b | 83 | { |
Jeej | 0:cc947267028b | 84 | case ALP_ERR_NONE: |
Jeej | 0:cc947267028b | 85 | PRINT("Status: OK\n"); |
Jeej | 0:cc947267028b | 86 | break; |
Jeej | 0:cc947267028b | 87 | case ALP_ERR_FILE_EXIST: |
Jeej | 0:cc947267028b | 88 | PRINT("Status: Already registered\n"); |
Jeej | 0:cc947267028b | 89 | break; |
Jeej | 0:cc947267028b | 90 | default: |
Jeej | 0:cc947267028b | 91 | PRINT("Status: error %d\n", status); |
Jeej | 0:cc947267028b | 92 | break; |
Jeej | 0:cc947267028b | 93 | } |
Jeej | 0:cc947267028b | 94 | } |
Jeej | 0:cc947267028b | 95 | |
Jeej | 0:cc947267028b | 96 | void print_resp(int status) |
Jeej | 0:cc947267028b | 97 | { |
Jeej | 0:cc947267028b | 98 | switch (status) |
Jeej | 0:cc947267028b | 99 | { |
Jeej | 0:cc947267028b | 100 | case ALP_ERR_NONE: |
Jeej | 0:cc947267028b | 101 | PRINT("Resp: OK\n"); |
Jeej | 0:cc947267028b | 102 | break; |
Jeej | 0:cc947267028b | 103 | case ALP_ERR_FILE_EXIST: |
Jeej | 0:cc947267028b | 104 | PRINT("Resp: Already registered\n"); |
Jeej | 0:cc947267028b | 105 | break; |
Jeej | 0:cc947267028b | 106 | default: |
Jeej | 0:cc947267028b | 107 | PRINT("Resp: error %d\n", status); |
Jeej | 0:cc947267028b | 108 | break; |
Jeej | 0:cc947267028b | 109 | } |
Jeej | 0:cc947267028b | 110 | } |
Jeej | 0:cc947267028b | 111 | |
Jeej | 0:cc947267028b | 112 | // Callback for broadcast read |
Jeej | 0:cc947267028b | 113 | void my_read_response_callback(uint8_t terminal, int8_t err, uint8_t id) |
Jeej | 0:cc947267028b | 114 | { |
Jeej | 0:cc947267028b | 115 | (void)id; |
Jeej | 0:cc947267028b | 116 | |
Jeej | 0:cc947267028b | 117 | if (terminal) |
Jeej | 0:cc947267028b | 118 | { |
Jeej | 1:5ddd7f4db10d | 119 | //print_status(err); |
Jeej | 0:cc947267028b | 120 | modem_resp.put((void*)MODEM_RESP_TERMINAL); |
Jeej | 0:cc947267028b | 121 | } |
Jeej | 0:cc947267028b | 122 | else |
Jeej | 0:cc947267028b | 123 | { |
Jeej | 0:cc947267028b | 124 | //print_resp(err); |
Jeej | 0:cc947267028b | 125 | if (ALP_ERR_NONE == err) |
Jeej | 0:cc947267028b | 126 | { |
Jeej | 0:cc947267028b | 127 | modem_resp.put((void*)MODEM_RESP_DONE); |
Jeej | 0:cc947267028b | 128 | } |
Jeej | 0:cc947267028b | 129 | } |
Jeej | 0:cc947267028b | 130 | } |
Jeej | 0:cc947267028b | 131 | |
Jeej | 0:cc947267028b | 132 | // Interrupt Service Routine on button press. |
Jeej | 0:cc947267028b | 133 | void button_push_isr( void ) |
Jeej | 0:cc947267028b | 134 | { |
Jeej | 0:cc947267028b | 135 | button_user.release(); |
Jeej | 0:cc947267028b | 136 | } |
Jeej | 0:cc947267028b | 137 | |
Jeej | 0:cc947267028b | 138 | void button_user_thread() |
Jeej | 0:cc947267028b | 139 | { |
Jeej | 0:cc947267028b | 140 | osEvent evt; |
Jeej | 0:cc947267028b | 141 | uint32_t resp; |
Jeej | 0:cc947267028b | 142 | d7a_sp_res_t istat; |
Jeej | 0:cc947267028b | 143 | fw_version_t fw_ver; |
Jeej | 1:5ddd7f4db10d | 144 | uint8_t nb = 0; |
Jeej | 0:cc947267028b | 145 | |
Jeej | 0:cc947267028b | 146 | uint8_t my_user_id = modem_get_id(my_read_response_callback); |
Jeej | 0:cc947267028b | 147 | |
Jeej | 0:cc947267028b | 148 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:cc947267028b | 149 | |
Jeej | 1:5ddd7f4db10d | 150 | uint8_t scan_xcl[] = { 0x0F, 0x2F }; |
Jeej | 0:cc947267028b | 151 | |
Jeej | 2:4629eacf9851 | 152 | memset(&istat, 0, sizeof(d7a_sp_res_t)); |
Jeej | 2:4629eacf9851 | 153 | memset(&fw_ver, 0, sizeof(fw_version_t)); |
Jeej | 2:4629eacf9851 | 154 | |
Jeej | 0:cc947267028b | 155 | // Set custom retry policy |
Jeej | 0:cc947267028b | 156 | //modem_write_file(WM_FID_ALP_CFG, &my_policy, MY_POLICY_IDX * sizeof(alp_retry_policy_t), sizeof(alp_retry_policy_t), g_main_id); |
Jeej | 0:cc947267028b | 157 | //modem_ready.wait(); |
Jeej | 0:cc947267028b | 158 | |
Jeej | 0:cc947267028b | 159 | while (true) |
Jeej | 0:cc947267028b | 160 | { |
Jeej | 0:cc947267028b | 161 | // Wait for button press |
Jeej | 0:cc947267028b | 162 | button_user.wait(); |
Jeej | 0:cc947267028b | 163 | |
Jeej | 0:cc947267028b | 164 | for (uint8_t i = 0; i < sizeof(scan_xcl); i++) |
Jeej | 0:cc947267028b | 165 | { |
Jeej | 1:5ddd7f4db10d | 166 | nb = 0; |
Jeej | 0:cc947267028b | 167 | my_itf.cfg.addressee.xcl.byte = scan_xcl[i]; |
Jeej | 0:cc947267028b | 168 | |
Jeej | 1:5ddd7f4db10d | 169 | PRINT("Scanning XCL 0x%02X...\n", my_itf.cfg.addressee.xcl.byte); |
Jeej | 1:5ddd7f4db10d | 170 | |
Jeej | 2:4629eacf9851 | 171 | modem_remote_read_file((uint8_t*)&my_itf, MY_D7_ITF_SIZE(&my_itf), (void*)&istat, D7A_FID_FIRMWARE_VERSION, (void*)&fw_ver, 12, sizeof(fw_version_t), my_user_id); |
Jeej | 0:cc947267028b | 172 | |
Jeej | 0:cc947267028b | 173 | do |
Jeej | 0:cc947267028b | 174 | { |
Jeej | 0:cc947267028b | 175 | evt = modem_resp.get(); |
Jeej | 2:4629eacf9851 | 176 | resp = (evt.status == osEventMessage)? (uint32_t)evt.value.p : MODEM_RESP_NO; |
Jeej | 0:cc947267028b | 177 | |
Jeej | 0:cc947267028b | 178 | if (MODEM_RESP_DONE == resp) |
Jeej | 0:cc947267028b | 179 | { |
Jeej | 1:5ddd7f4db10d | 180 | nb++; |
Jeej | 1:5ddd7f4db10d | 181 | PRINT("%d: XCL:%02X ", nb, istat.addressee.xcl.byte); |
Jeej | 1:5ddd7f4db10d | 182 | PRINT_DATA("UID:", "%02X", istat.addressee.id, 8, " "); |
Jeej | 1:5ddd7f4db10d | 183 | PRINT("rxlev:%d lb:%d ", istat.rxlev, istat.lb); |
Jeej | 1:5ddd7f4db10d | 184 | PRINT("v%d.%d.%d\n", fw_ver.major, fw_ver.minor, fw_ver.patch); |
Jeej | 2:4629eacf9851 | 185 | |
Jeej | 2:4629eacf9851 | 186 | // Reset variables |
Jeej | 2:4629eacf9851 | 187 | memset(&istat, 0, sizeof(d7a_sp_res_t)); |
Jeej | 2:4629eacf9851 | 188 | memset(&fw_ver, 0, sizeof(fw_version_t)); |
Jeej | 2:4629eacf9851 | 189 | } |
Jeej | 1:5ddd7f4db10d | 190 | |
Jeej | 0:cc947267028b | 191 | } while (MODEM_RESP_TERMINAL != resp); |
Jeej | 0:cc947267028b | 192 | } |
Jeej | 0:cc947267028b | 193 | |
Jeej | 1:5ddd7f4db10d | 194 | PRINT("Done.\n"); |
Jeej | 0:cc947267028b | 195 | } |
Jeej | 0:cc947267028b | 196 | } |
Jeej | 0:cc947267028b | 197 | |
Jeej | 0:cc947267028b | 198 | // Serial adapters to WizziLab's own architecture |
Jeej | 0:cc947267028b | 199 | // ============================================================{{{ |
Jeej | 0:cc947267028b | 200 | |
Jeej | 0:cc947267028b | 201 | void my_serial_input(WizziCom* com, WizziComPacket_t* pkt) |
Jeej | 0:cc947267028b | 202 | { |
Jeej | 0:cc947267028b | 203 | modem_input(wizzicom_type_to_flow(pkt->type), pkt->data, pkt->length); |
Jeej | 0:cc947267028b | 204 | FREE(pkt); |
Jeej | 0:cc947267028b | 205 | } |
Jeej | 0:cc947267028b | 206 | |
Jeej | 0:cc947267028b | 207 | int my_serial_send(uint8_t* data1, uint8_t size1, uint8_t* data2, uint8_t size2) |
Jeej | 0:cc947267028b | 208 | { |
Jeej | 0:cc947267028b | 209 | (void)size1; |
Jeej | 0:cc947267028b | 210 | |
Jeej | 0:cc947267028b | 211 | g_modem_com->send((WizziComPacketType)wizzicom_flow_to_type(data1[4]), size2, data2); |
Jeej | 0:cc947267028b | 212 | |
Jeej | 0:cc947267028b | 213 | return (size1 + size2); |
Jeej | 0:cc947267028b | 214 | } |
Jeej | 0:cc947267028b | 215 | |
Jeej | 0:cc947267028b | 216 | modem_callbacks_t callbacks = { |
Jeej | 0:cc947267028b | 217 | .read = my_read, |
Jeej | 0:cc947267028b | 218 | .write = my_write, |
Jeej | 0:cc947267028b | 219 | .read_fprop = my_read_fprop, |
Jeej | 0:cc947267028b | 220 | .flush = my_flush, |
Jeej | 0:cc947267028b | 221 | .remove = my_delete, |
Jeej | 0:cc947267028b | 222 | .lqual = my_lqual, |
Jeej | 0:cc947267028b | 223 | .ldown = my_ldown, |
Jeej | 0:cc947267028b | 224 | .reset = my_reset, |
Jeej | 0:cc947267028b | 225 | .boot = my_boot |
Jeej | 0:cc947267028b | 226 | }; |
Jeej | 0:cc947267028b | 227 | |
Jeej | 0:cc947267028b | 228 | // Callback for g_main_id User |
Jeej | 0:cc947267028b | 229 | void my_main_callback(uint8_t terminal, int8_t err, uint8_t id) |
Jeej | 0:cc947267028b | 230 | { |
Jeej | 0:cc947267028b | 231 | (void)id; |
Jeej | 0:cc947267028b | 232 | |
Jeej | 0:cc947267028b | 233 | if (terminal) |
Jeej | 0:cc947267028b | 234 | { |
Jeej | 0:cc947267028b | 235 | print_status(err); |
Jeej | 2:4629eacf9851 | 236 | modem_ready[id].release(); |
Jeej | 0:cc947267028b | 237 | } |
Jeej | 0:cc947267028b | 238 | else |
Jeej | 0:cc947267028b | 239 | { |
Jeej | 0:cc947267028b | 240 | print_resp(err); |
Jeej | 0:cc947267028b | 241 | } |
Jeej | 0:cc947267028b | 242 | } |
Jeej | 0:cc947267028b | 243 | |
Jeej | 0:cc947267028b | 244 | /*** Main function ------------------------------------------------------------- ***/ |
Jeej | 0:cc947267028b | 245 | int main() |
Jeej | 0:cc947267028b | 246 | { |
Jeej | 0:cc947267028b | 247 | // Start & initialize |
Jeej | 0:cc947267028b | 248 | DBG_OPEN(DEBUG_LED); |
Jeej | 0:cc947267028b | 249 | PRINT("\r\n--- Starting new run ---\r\n"); |
Jeej | 0:cc947267028b | 250 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:cc947267028b | 251 | |
Jeej | 0:cc947267028b | 252 | static union { |
Jeej | 0:cc947267028b | 253 | uint8_t b[8]; |
Jeej | 0:cc947267028b | 254 | uint32_t w[2]; |
Jeej | 0:cc947267028b | 255 | } uid; |
Jeej | 0:cc947267028b | 256 | revision_t rev; |
Jeej | 1:5ddd7f4db10d | 257 | |
Jeej | 1:5ddd7f4db10d | 258 | // Hardware reset |
Jeej | 1:5ddd7f4db10d | 259 | DigitalOut reset_low(MODEM_PIN_RESET, 0); |
Jeej | 1:5ddd7f4db10d | 260 | Thread::wait(100); |
Jeej | 1:5ddd7f4db10d | 261 | |
Jeej | 1:5ddd7f4db10d | 262 | // Release reset |
Jeej | 1:5ddd7f4db10d | 263 | DigitalIn reset_release(MODEM_PIN_RESET); |
Jeej | 2:4629eacf9851 | 264 | Thread::wait(2000); |
Jeej | 0:cc947267028b | 265 | |
Jeej | 0:cc947267028b | 266 | // Open modem Com port |
Jeej | 0:cc947267028b | 267 | g_modem_com = new WizziCom(MODEM_PIN_TX, MODEM_PIN_RX, MODEM_PIN_IRQ_OUT, MODEM_PIN_IRQ_IN); |
Jeej | 0:cc947267028b | 268 | |
Jeej | 0:cc947267028b | 269 | // Redirect All Port traffic to my_serial_input |
Jeej | 0:cc947267028b | 270 | g_modem_com->attach(my_serial_input, WizziComPacketOther); |
Jeej | 0:cc947267028b | 271 | |
Jeej | 0:cc947267028b | 272 | modem_open(my_serial_send, &callbacks); |
Jeej | 0:cc947267028b | 273 | |
Jeej | 0:cc947267028b | 274 | g_main_id = modem_get_id(my_main_callback); |
Jeej | 0:cc947267028b | 275 | |
Jeej | 0:cc947267028b | 276 | PRINT("Start Modem Process (id=%d)\n", g_main_id); |
Jeej | 0:cc947267028b | 277 | Thread::wait(1000); |
Jeej | 0:cc947267028b | 278 | |
Jeej | 2:4629eacf9851 | 279 | modem_read_file(D7A_FID_UID, uid.b, 0, 8, g_main_id); |
Jeej | 2:4629eacf9851 | 280 | modem_ready[g_main_id].wait(); |
Jeej | 0:cc947267028b | 281 | |
Jeej | 2:4629eacf9851 | 282 | modem_read_file(D7A_FID_FIRMWARE_VERSION, &rev, 0, sizeof(revision_t), g_main_id); |
Jeej | 2:4629eacf9851 | 283 | modem_ready[g_main_id].wait(); |
Jeej | 0:cc947267028b | 284 | |
Jeej | 0:cc947267028b | 285 | PRINT("------------ D7A Modem infos ------------\r\n"); |
Jeej | 0:cc947267028b | 286 | PRINT_DATA(" - UID: ", "%02X", uid.b, 8, "\r\n"); |
Jeej | 0:cc947267028b | 287 | PRINT(" - Manufacturer ID: %08X\r\n", rev.manufacturer_id); |
Jeej | 0:cc947267028b | 288 | PRINT(" - Device ID: %08X\r\n", rev.device_id); |
Jeej | 0:cc947267028b | 289 | PRINT(" - Hardware version: %08X\r\n", rev.hw_version); |
Jeej | 0:cc947267028b | 290 | PRINT(" - Firmware version: v%d.%d.%d\r\n", rev.fw_version.major, rev.fw_version.minor, rev.fw_version.patch); |
Jeej | 0:cc947267028b | 291 | PRINT(" - File system CRC: 0x%08x\r\n", rev.fs_crc); |
Jeej | 0:cc947267028b | 292 | PRINT("-----------------------------------------\r\n"); |
Jeej | 0:cc947267028b | 293 | |
Jeej | 3:a240b300fae9 | 294 | // Check version |
Jeej | 3:a240b300fae9 | 295 | if (rev.fw_version.major != MODEM_VERSION_MAJOR || rev.fw_version.minor != MODEM_VERSION_MINOR) |
Jeej | 3:a240b300fae9 | 296 | { |
Jeej | 3:a240b300fae9 | 297 | PRINT("You need a modem at version %d.%d.x to use this APP.\n" |
Jeej | 3:a240b300fae9 | 298 | "Please check updates by importing:\n" |
Jeej | 3:a240b300fae9 | 299 | "https://developer.mbed.org/teams/WizziLab/code/D7A_WM_Updater\n" |
Jeej | 3:a240b300fae9 | 300 | , MODEM_VERSION_MAJOR, MODEM_VERSION_MINOR); |
Jeej | 3:a240b300fae9 | 301 | Thread::wait(osWaitForever); |
Jeej | 3:a240b300fae9 | 302 | } |
Jeej | 3:a240b300fae9 | 303 | |
Jeej | 0:cc947267028b | 304 | // Configure URC: LQUAL on report file notification every 10 reports |
Jeej | 0:cc947267028b | 305 | PRINT("Setup URCs\n"); |
Jeej | 0:cc947267028b | 306 | modem_enable_urc(ALP_URC_TYPE_LQUAL, IFID_REPORT, 10, true, g_main_id); |
Jeej | 2:4629eacf9851 | 307 | modem_ready[g_main_id].wait(); |
Jeej | 0:cc947267028b | 308 | |
Jeej | 0:cc947267028b | 309 | PRINT("Start D7A Stack\n"); |
Jeej | 0:cc947267028b | 310 | modem_activate_itf(ALP_ITF_TYPE_D7A, 24, 0, ALP_D7A_ISTAT_RESP , true, g_main_id); |
Jeej | 2:4629eacf9851 | 311 | modem_ready[g_main_id].wait(); |
Jeej | 0:cc947267028b | 312 | |
Jeej | 0:cc947267028b | 313 | #ifdef DEBUG_BUTTON |
Jeej | 0:cc947267028b | 314 | DebouncedInterrupt user_interrupt(DEBUG_BUTTON); |
Jeej | 0:cc947267028b | 315 | user_interrupt.attach(button_push_isr, IRQ_FALL, 500, true); |
Jeej | 0:cc947267028b | 316 | |
Jeej | 0:cc947267028b | 317 | Thread but_th(osPriorityNormal, 2048, NULL); |
Jeej | 0:cc947267028b | 318 | osStatus status = but_th.start(button_user_thread); |
Jeej | 0:cc947267028b | 319 | ASSERT(status == osOK, "Failed to start but thread (err: %d)\r\n", status); |
Jeej | 0:cc947267028b | 320 | #endif |
Jeej | 0:cc947267028b | 321 | |
Jeej | 2:4629eacf9851 | 322 | #if (DEBUG_LED != NC) |
Jeej | 0:cc947267028b | 323 | DigitalOut my_led(DEBUG_LED); |
Jeej | 0:cc947267028b | 324 | #endif |
Jeej | 0:cc947267028b | 325 | |
Jeej | 0:cc947267028b | 326 | // Set main task to lowest priority |
Jeej | 0:cc947267028b | 327 | osThreadSetPriority(osThreadGetId(), osPriorityIdle); |
Jeej | 0:cc947267028b | 328 | while(true) |
Jeej | 0:cc947267028b | 329 | { |
Jeej | 0:cc947267028b | 330 | Thread::wait(500); |
Jeej | 2:4629eacf9851 | 331 | #if (DEBUG_LED != NC) |
Jeej | 0:cc947267028b | 332 | my_led = !my_led; |
Jeej | 0:cc947267028b | 333 | #endif |
Jeej | 0:cc947267028b | 334 | } |
Jeej | 0:cc947267028b | 335 | } |