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