Complete sensor demo.
Dependencies: modem_ref_helper CRC X_NUCLEO_IKS01A1 DebouncedInterrupt
main.cpp@0:87c57e1b1e1c, 2017-05-15 (annotated)
- Committer:
- Jeej
- Date:
- Mon May 15 16:00:25 2017 +0000
- Revision:
- 0:87c57e1b1e1c
- Child:
- 1:4d3968b2941b
First working version of V3 demo.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Jeej | 0:87c57e1b1e1c | 1 | // This project is a demo of the DASH7 1.x stack |
Jeej | 0:87c57e1b1e1c | 2 | // @autor: jeremie@wizzilab.com |
Jeej | 0:87c57e1b1e1c | 3 | // @date: 2016-12-20 |
Jeej | 0:87c57e1b1e1c | 4 | |
Jeej | 0:87c57e1b1e1c | 5 | #include "mbed.h" |
Jeej | 0:87c57e1b1e1c | 6 | #include "rtos.h" |
Jeej | 0:87c57e1b1e1c | 7 | #include "sensors.h" |
Jeej | 0:87c57e1b1e1c | 8 | #include "WizziDebug.h" |
Jeej | 0:87c57e1b1e1c | 9 | #include "WizziCom.h" |
Jeej | 0:87c57e1b1e1c | 10 | #include "DebouncedInterrupt.h" |
Jeej | 0:87c57e1b1e1c | 11 | |
Jeej | 0:87c57e1b1e1c | 12 | #include "files.h" |
Jeej | 0:87c57e1b1e1c | 13 | #include "ram_fs.h" |
Jeej | 0:87c57e1b1e1c | 14 | #include "hwcfg.h" |
Jeej | 0:87c57e1b1e1c | 15 | #include "modem_callbacks.h" |
Jeej | 0:87c57e1b1e1c | 16 | #include "simul.h" |
Jeej | 0:87c57e1b1e1c | 17 | |
Jeej | 0:87c57e1b1e1c | 18 | #include "revision.h" |
Jeej | 0:87c57e1b1e1c | 19 | #include "alp_spec.h" |
Jeej | 0:87c57e1b1e1c | 20 | #include "alp_helpers.h" |
Jeej | 0:87c57e1b1e1c | 21 | #include "modem_ref.h" |
Jeej | 0:87c57e1b1e1c | 22 | #include "d7a_1x.h" |
Jeej | 0:87c57e1b1e1c | 23 | #include "d7a_1x_fs.h" |
Jeej | 0:87c57e1b1e1c | 24 | #include "alp.h" |
Jeej | 0:87c57e1b1e1c | 25 | |
Jeej | 0:87c57e1b1e1c | 26 | |
Jeej | 0:87c57e1b1e1c | 27 | WizziCom* g_modem_com; |
Jeej | 0:87c57e1b1e1c | 28 | Semaphore button_user(0); |
Jeej | 0:87c57e1b1e1c | 29 | Semaphore modem_ready[MAX_USER_NB]; |
Jeej | 0:87c57e1b1e1c | 30 | Semaphore thread_ready(0); |
Jeej | 0:87c57e1b1e1c | 31 | sensor_config_t g_light_config; |
Jeej | 0:87c57e1b1e1c | 32 | Queue<void, 8> g_file_modified; |
Jeej | 0:87c57e1b1e1c | 33 | |
Jeej | 0:87c57e1b1e1c | 34 | TYPEDEF_STRUCT_PACKED { |
Jeej | 0:87c57e1b1e1c | 35 | uint8_t type; |
Jeej | 0:87c57e1b1e1c | 36 | d7a_sp_cfg_t cfg; |
Jeej | 0:87c57e1b1e1c | 37 | } alp_d7a_itf_t; |
Jeej | 0:87c57e1b1e1c | 38 | |
Jeej | 0:87c57e1b1e1c | 39 | #define D7A_CTF_VAL(mant,exp) ((uint8_t)(mant|(exp<<5))) |
Jeej | 0:87c57e1b1e1c | 40 | #define ALP_ITF_TYPE_D7A 0xD7 |
Jeej | 0:87c57e1b1e1c | 41 | #define MY_D7_ITF_SIZE(_itf) (1+my_alp_itf_d7a_cfg_size(&(_itf)->cfg)) |
Jeej | 0:87c57e1b1e1c | 42 | int my_alp_itf_d7a_cfg_size(d7a_sp_cfg_t* cfg) |
Jeej | 0:87c57e1b1e1c | 43 | { |
Jeej | 0:87c57e1b1e1c | 44 | int size = sizeof(d7a_sp_cfg_t) - sizeof(d7a_addressee_t); |
Jeej | 0:87c57e1b1e1c | 45 | size += D7A_ADDR_LEN(cfg->addressee.ctrl); |
Jeej | 0:87c57e1b1e1c | 46 | return size; |
Jeej | 0:87c57e1b1e1c | 47 | } |
Jeej | 0:87c57e1b1e1c | 48 | |
Jeej | 0:87c57e1b1e1c | 49 | // Check parameters to see if data should be send |
Jeej | 0:87c57e1b1e1c | 50 | static bool report_needed(sensor_config_t* config, int32_t value, int32_t last_value, uint32_t last_report_time) |
Jeej | 0:87c57e1b1e1c | 51 | { |
Jeej | 0:87c57e1b1e1c | 52 | switch (config->report_type) |
Jeej | 0:87c57e1b1e1c | 53 | { |
Jeej | 0:87c57e1b1e1c | 54 | case REPORT_ALWAYS: |
Jeej | 0:87c57e1b1e1c | 55 | // Send a report at each measure |
Jeej | 0:87c57e1b1e1c | 56 | IPRINT("Report always\r\n"); |
Jeej | 0:87c57e1b1e1c | 57 | return true; |
Jeej | 0:87c57e1b1e1c | 58 | case REPORT_ON_DIFFERENCE: |
Jeej | 0:87c57e1b1e1c | 59 | // Send a report when the difference between the last reported measure and the current mesure is greater than max_diff |
Jeej | 0:87c57e1b1e1c | 60 | if (abs(last_value - value) >= config->max_diff && config->max_diff) |
Jeej | 0:87c57e1b1e1c | 61 | { |
Jeej | 0:87c57e1b1e1c | 62 | IPRINT("Report on difference (last:%d new:%d max_diff:%d)\r\n", last_value, value, config->max_diff); |
Jeej | 0:87c57e1b1e1c | 63 | return true; |
Jeej | 0:87c57e1b1e1c | 64 | } |
Jeej | 0:87c57e1b1e1c | 65 | break; |
Jeej | 0:87c57e1b1e1c | 66 | case REPORT_ON_THRESHOLD: |
Jeej | 0:87c57e1b1e1c | 67 | // Send a report when crossing a threshold |
Jeej | 0:87c57e1b1e1c | 68 | if ( (value >= config->threshold_high && last_value < config->threshold_high) |
Jeej | 0:87c57e1b1e1c | 69 | || (value <= config->threshold_low && last_value > config->threshold_low) |
Jeej | 0:87c57e1b1e1c | 70 | || (value < config->threshold_high && last_value >= config->threshold_high) |
Jeej | 0:87c57e1b1e1c | 71 | || (value > config->threshold_low && last_value <= config->threshold_low)) |
Jeej | 0:87c57e1b1e1c | 72 | { |
Jeej | 0:87c57e1b1e1c | 73 | IPRINT("Rerport on threshold (last:%d new:%d th:%d tl:%d)\r\n", last_value, value, config->threshold_high, config->threshold_low); |
Jeej | 0:87c57e1b1e1c | 74 | return true; |
Jeej | 0:87c57e1b1e1c | 75 | } |
Jeej | 0:87c57e1b1e1c | 76 | break; |
Jeej | 0:87c57e1b1e1c | 77 | default: |
Jeej | 0:87c57e1b1e1c | 78 | break; |
Jeej | 0:87c57e1b1e1c | 79 | } |
Jeej | 0:87c57e1b1e1c | 80 | |
Jeej | 0:87c57e1b1e1c | 81 | // Send a report if it's been more than max_period since the last report |
Jeej | 0:87c57e1b1e1c | 82 | if (((last_report_time/1000) >= config->max_period) && config->max_period) |
Jeej | 0:87c57e1b1e1c | 83 | { |
Jeej | 0:87c57e1b1e1c | 84 | IPRINT("Report on period (max_period:%d time:%d)\r\n", config->max_period, last_report_time); |
Jeej | 0:87c57e1b1e1c | 85 | return true; |
Jeej | 0:87c57e1b1e1c | 86 | } |
Jeej | 0:87c57e1b1e1c | 87 | |
Jeej | 0:87c57e1b1e1c | 88 | return false; |
Jeej | 0:87c57e1b1e1c | 89 | } |
Jeej | 0:87c57e1b1e1c | 90 | |
Jeej | 0:87c57e1b1e1c | 91 | // Interrupt Service Routine on button press. |
Jeej | 0:87c57e1b1e1c | 92 | void button_push_isr( void ) |
Jeej | 0:87c57e1b1e1c | 93 | { |
Jeej | 0:87c57e1b1e1c | 94 | button_user.release(); |
Jeej | 0:87c57e1b1e1c | 95 | } |
Jeej | 0:87c57e1b1e1c | 96 | |
Jeej | 0:87c57e1b1e1c | 97 | void my_get_alp_file_props(uint8_t fid, alp_file_header_t* hdr) |
Jeej | 0:87c57e1b1e1c | 98 | { |
Jeej | 0:87c57e1b1e1c | 99 | memcpy(hdr, ram_fs_get_header(fid), sizeof(alp_file_header_t)); |
Jeej | 0:87c57e1b1e1c | 100 | } |
Jeej | 0:87c57e1b1e1c | 101 | |
Jeej | 0:87c57e1b1e1c | 102 | void print_status(int status) |
Jeej | 0:87c57e1b1e1c | 103 | { |
Jeej | 0:87c57e1b1e1c | 104 | switch (status) |
Jeej | 0:87c57e1b1e1c | 105 | { |
Jeej | 0:87c57e1b1e1c | 106 | case ALP_ERR_NONE: |
Jeej | 0:87c57e1b1e1c | 107 | PRINT("Status: OK\n"); |
Jeej | 0:87c57e1b1e1c | 108 | break; |
Jeej | 0:87c57e1b1e1c | 109 | case ALP_ERR_FILE_EXIST: |
Jeej | 0:87c57e1b1e1c | 110 | PRINT("Status: Already registered\n"); |
Jeej | 0:87c57e1b1e1c | 111 | break; |
Jeej | 0:87c57e1b1e1c | 112 | default: |
Jeej | 0:87c57e1b1e1c | 113 | PRINT("Status: error %d\n", status); |
Jeej | 0:87c57e1b1e1c | 114 | break; |
Jeej | 0:87c57e1b1e1c | 115 | } |
Jeej | 0:87c57e1b1e1c | 116 | } |
Jeej | 0:87c57e1b1e1c | 117 | |
Jeej | 0:87c57e1b1e1c | 118 | void print_resp(int status) |
Jeej | 0:87c57e1b1e1c | 119 | { |
Jeej | 0:87c57e1b1e1c | 120 | switch (status) |
Jeej | 0:87c57e1b1e1c | 121 | { |
Jeej | 0:87c57e1b1e1c | 122 | case ALP_ERR_NONE: |
Jeej | 0:87c57e1b1e1c | 123 | PRINT("Resp: OK\n"); |
Jeej | 0:87c57e1b1e1c | 124 | break; |
Jeej | 0:87c57e1b1e1c | 125 | case ALP_ERR_FILE_EXIST: |
Jeej | 0:87c57e1b1e1c | 126 | PRINT("Resp: Already registered\n"); |
Jeej | 0:87c57e1b1e1c | 127 | break; |
Jeej | 0:87c57e1b1e1c | 128 | default: |
Jeej | 0:87c57e1b1e1c | 129 | PRINT("Resp: error %d\n", status); |
Jeej | 0:87c57e1b1e1c | 130 | break; |
Jeej | 0:87c57e1b1e1c | 131 | } |
Jeej | 0:87c57e1b1e1c | 132 | } |
Jeej | 0:87c57e1b1e1c | 133 | |
Jeej | 0:87c57e1b1e1c | 134 | // ============================================================}}} |
Jeej | 0:87c57e1b1e1c | 135 | |
Jeej | 0:87c57e1b1e1c | 136 | // Serial adapters to WizziLab's own architecture |
Jeej | 0:87c57e1b1e1c | 137 | // ============================================================{{{ |
Jeej | 0:87c57e1b1e1c | 138 | |
Jeej | 0:87c57e1b1e1c | 139 | void my_serial_input(WizziCom* com, WizziComPacket_t* pkt) |
Jeej | 0:87c57e1b1e1c | 140 | { |
Jeej | 0:87c57e1b1e1c | 141 | modem_input(wizzicom_type_to_flow(pkt->type), pkt->data, pkt->length); |
Jeej | 0:87c57e1b1e1c | 142 | FREE(pkt); |
Jeej | 0:87c57e1b1e1c | 143 | } |
Jeej | 0:87c57e1b1e1c | 144 | |
Jeej | 0:87c57e1b1e1c | 145 | int my_serial_send(uint8_t* data1, uint8_t size1, uint8_t* data2, uint8_t size2) |
Jeej | 0:87c57e1b1e1c | 146 | { |
Jeej | 0:87c57e1b1e1c | 147 | (void)size1; |
Jeej | 0:87c57e1b1e1c | 148 | |
Jeej | 0:87c57e1b1e1c | 149 | // Retrieve Flow ID from header and send packet |
Jeej | 0:87c57e1b1e1c | 150 | g_modem_com->send((WizziComPacketType)wizzicom_flow_to_type(data1[4]), size2, data2); |
Jeej | 0:87c57e1b1e1c | 151 | |
Jeej | 0:87c57e1b1e1c | 152 | return (size1 + size2); |
Jeej | 0:87c57e1b1e1c | 153 | } |
Jeej | 0:87c57e1b1e1c | 154 | |
Jeej | 0:87c57e1b1e1c | 155 | modem_callbacks_t callbacks = { |
Jeej | 0:87c57e1b1e1c | 156 | .read = my_read, |
Jeej | 0:87c57e1b1e1c | 157 | .write = my_write, |
Jeej | 0:87c57e1b1e1c | 158 | .read_fprop = my_read_fprop, |
Jeej | 0:87c57e1b1e1c | 159 | .flush = my_flush, |
Jeej | 0:87c57e1b1e1c | 160 | .remove = my_delete, |
Jeej | 0:87c57e1b1e1c | 161 | .lqual = my_lqual, |
Jeej | 0:87c57e1b1e1c | 162 | .ldown = my_ldown, |
Jeej | 0:87c57e1b1e1c | 163 | .reset = my_reset, |
Jeej | 0:87c57e1b1e1c | 164 | .boot = my_boot |
Jeej | 0:87c57e1b1e1c | 165 | }; |
Jeej | 0:87c57e1b1e1c | 166 | |
Jeej | 0:87c57e1b1e1c | 167 | // Callback for main_id User |
Jeej | 0:87c57e1b1e1c | 168 | void my_main_callback(uint8_t terminal, int8_t err, uint8_t id) |
Jeej | 0:87c57e1b1e1c | 169 | { |
Jeej | 0:87c57e1b1e1c | 170 | if (terminal) |
Jeej | 0:87c57e1b1e1c | 171 | { |
Jeej | 0:87c57e1b1e1c | 172 | print_status(err); |
Jeej | 0:87c57e1b1e1c | 173 | modem_ready[id].release(); |
Jeej | 0:87c57e1b1e1c | 174 | } |
Jeej | 0:87c57e1b1e1c | 175 | else |
Jeej | 0:87c57e1b1e1c | 176 | { |
Jeej | 0:87c57e1b1e1c | 177 | print_resp(err); |
Jeej | 0:87c57e1b1e1c | 178 | } |
Jeej | 0:87c57e1b1e1c | 179 | } |
Jeej | 0:87c57e1b1e1c | 180 | |
Jeej | 0:87c57e1b1e1c | 181 | // ----------------------------------------------- |
Jeej | 0:87c57e1b1e1c | 182 | // Sensor Threads |
Jeej | 0:87c57e1b1e1c | 183 | // ----------------------------------------------- |
Jeej | 0:87c57e1b1e1c | 184 | typedef struct |
Jeej | 0:87c57e1b1e1c | 185 | { |
Jeej | 0:87c57e1b1e1c | 186 | // Number of data fields |
Jeej | 0:87c57e1b1e1c | 187 | uint32_t nb_values; |
Jeej | 0:87c57e1b1e1c | 188 | // Total size of data |
Jeej | 0:87c57e1b1e1c | 189 | uint32_t data_size; |
Jeej | 0:87c57e1b1e1c | 190 | // Read value function |
Jeej | 0:87c57e1b1e1c | 191 | bool (*read_value)(int32_t*); |
Jeej | 0:87c57e1b1e1c | 192 | // Last reported value |
Jeej | 0:87c57e1b1e1c | 193 | int32_t* last_report_value; |
Jeej | 0:87c57e1b1e1c | 194 | // Current measured value |
Jeej | 0:87c57e1b1e1c | 195 | int32_t* current_value; |
Jeej | 0:87c57e1b1e1c | 196 | |
Jeej | 0:87c57e1b1e1c | 197 | // File ID of the sensor value file |
Jeej | 0:87c57e1b1e1c | 198 | uint8_t value_file_id; |
Jeej | 0:87c57e1b1e1c | 199 | // Sensor configuration file ID |
Jeej | 0:87c57e1b1e1c | 200 | uint8_t config_file_id; |
Jeej | 0:87c57e1b1e1c | 201 | // Sensor configuration context |
Jeej | 0:87c57e1b1e1c | 202 | sensor_config_t config; |
Jeej | 0:87c57e1b1e1c | 203 | |
Jeej | 0:87c57e1b1e1c | 204 | } sensor_thread_ctx_t; |
Jeej | 0:87c57e1b1e1c | 205 | |
Jeej | 0:87c57e1b1e1c | 206 | sensor_thread_ctx_t* g_thread_ctx; |
Jeej | 0:87c57e1b1e1c | 207 | |
Jeej | 0:87c57e1b1e1c | 208 | // Initialisation of the sensor thread's context |
Jeej | 0:87c57e1b1e1c | 209 | #define SENSOR_THREAD_CTX(name,NAME,_nb_values) \ |
Jeej | 0:87c57e1b1e1c | 210 | int32_t name##_last_report[_nb_values];\ |
Jeej | 0:87c57e1b1e1c | 211 | int32_t name##_current_value[_nb_values];\ |
Jeej | 0:87c57e1b1e1c | 212 | sensor_thread_ctx_t name##_thread_ctx = {\ |
Jeej | 0:87c57e1b1e1c | 213 | .nb_values = _nb_values,\ |
Jeej | 0:87c57e1b1e1c | 214 | .data_size = _nb_values * sizeof(int32_t),\ |
Jeej | 0:87c57e1b1e1c | 215 | .read_value = name##_get_value,\ |
Jeej | 0:87c57e1b1e1c | 216 | .last_report_value = (int32_t*)&name##_last_report,\ |
Jeej | 0:87c57e1b1e1c | 217 | .current_value = (int32_t*)&name##_current_value,\ |
Jeej | 0:87c57e1b1e1c | 218 | .value_file_id = FID_SENSOR_VALUE_##NAME,\ |
Jeej | 0:87c57e1b1e1c | 219 | .config_file_id = FID_SENSOR_CONFIG_##NAME\ |
Jeej | 0:87c57e1b1e1c | 220 | } |
Jeej | 0:87c57e1b1e1c | 221 | |
Jeej | 0:87c57e1b1e1c | 222 | |
Jeej | 0:87c57e1b1e1c | 223 | SENSOR_THREAD_CTX(mag, MAG, 3); |
Jeej | 0:87c57e1b1e1c | 224 | SENSOR_THREAD_CTX(acc, ACC, 3); |
Jeej | 0:87c57e1b1e1c | 225 | SENSOR_THREAD_CTX(gyr, GYR, 3); |
Jeej | 0:87c57e1b1e1c | 226 | SENSOR_THREAD_CTX(pre, PRE, 1); |
Jeej | 0:87c57e1b1e1c | 227 | SENSOR_THREAD_CTX(hum, HUM, 1); |
Jeej | 0:87c57e1b1e1c | 228 | SENSOR_THREAD_CTX(tem1, TEM1, 1); |
Jeej | 0:87c57e1b1e1c | 229 | SENSOR_THREAD_CTX(tem2, TEM2, 1); |
Jeej | 0:87c57e1b1e1c | 230 | SENSOR_THREAD_CTX(light, LIGHT, 1); |
Jeej | 0:87c57e1b1e1c | 231 | |
Jeej | 0:87c57e1b1e1c | 232 | sensor_thread_ctx_t* ctx = g_thread_ctx; |
Jeej | 0:87c57e1b1e1c | 233 | |
Jeej | 0:87c57e1b1e1c | 234 | |
Jeej | 0:87c57e1b1e1c | 235 | void thread_sensor() |
Jeej | 0:87c57e1b1e1c | 236 | { |
Jeej | 0:87c57e1b1e1c | 237 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:87c57e1b1e1c | 238 | |
Jeej | 0:87c57e1b1e1c | 239 | // To force a first report |
Jeej | 0:87c57e1b1e1c | 240 | uint32_t last_report_time = 0xFFFFFFFF; |
Jeej | 0:87c57e1b1e1c | 241 | sensor_thread_ctx_t* ctx = g_thread_ctx; |
Jeej | 0:87c57e1b1e1c | 242 | uint8_t user_id = modem_get_id(my_main_callback); |
Jeej | 0:87c57e1b1e1c | 243 | |
Jeej | 0:87c57e1b1e1c | 244 | // Get the sensor configuration |
Jeej | 0:87c57e1b1e1c | 245 | ram_fs_read(ctx->config_file_id, 0, sizeof(sensor_config_t), (uint8_t*)&(ctx->config)); |
Jeej | 0:87c57e1b1e1c | 246 | |
Jeej | 0:87c57e1b1e1c | 247 | PRINT("Start sensor thread %d\n", user_id); |
Jeej | 0:87c57e1b1e1c | 248 | |
Jeej | 0:87c57e1b1e1c | 249 | thread_ready.release(); |
Jeej | 0:87c57e1b1e1c | 250 | |
Jeej | 0:87c57e1b1e1c | 251 | while (true) |
Jeej | 0:87c57e1b1e1c | 252 | { |
Jeej | 0:87c57e1b1e1c | 253 | bool err = ctx->read_value(ctx->current_value); |
Jeej | 0:87c57e1b1e1c | 254 | |
Jeej | 0:87c57e1b1e1c | 255 | ASSERT(err == 0, "Failed to read sensor\n"); |
Jeej | 0:87c57e1b1e1c | 256 | |
Jeej | 0:87c57e1b1e1c | 257 | PRINT("Got %3d: ", ctx->value_file_id); |
Jeej | 0:87c57e1b1e1c | 258 | for (uint8_t i = 0; i < ctx->nb_values; i++) |
Jeej | 0:87c57e1b1e1c | 259 | { |
Jeej | 0:87c57e1b1e1c | 260 | PRINT("%9ld ", (int32_t)ctx->current_value[i]); |
Jeej | 0:87c57e1b1e1c | 261 | } |
Jeej | 0:87c57e1b1e1c | 262 | PRINT("\r\n"); |
Jeej | 0:87c57e1b1e1c | 263 | |
Jeej | 0:87c57e1b1e1c | 264 | for (uint8_t i = 0; i < ctx->nb_values; i++) |
Jeej | 0:87c57e1b1e1c | 265 | { |
Jeej | 0:87c57e1b1e1c | 266 | if (report_needed(&(ctx->config), |
Jeej | 0:87c57e1b1e1c | 267 | ctx->current_value[i], |
Jeej | 0:87c57e1b1e1c | 268 | ctx->last_report_value[i], |
Jeej | 0:87c57e1b1e1c | 269 | last_report_time)) |
Jeej | 0:87c57e1b1e1c | 270 | { |
Jeej | 0:87c57e1b1e1c | 271 | // Send notification |
Jeej | 0:87c57e1b1e1c | 272 | modem_write_file(ctx->value_file_id, ctx->current_value, 0, ctx->data_size, user_id); |
Jeej | 0:87c57e1b1e1c | 273 | modem_ready[user_id].wait(); |
Jeej | 0:87c57e1b1e1c | 274 | |
Jeej | 0:87c57e1b1e1c | 275 | // Update last report value |
Jeej | 0:87c57e1b1e1c | 276 | memcpy(ctx->last_report_value, ctx->current_value, ctx->data_size); |
Jeej | 0:87c57e1b1e1c | 277 | // Reset last report time |
Jeej | 0:87c57e1b1e1c | 278 | last_report_time = 0; |
Jeej | 0:87c57e1b1e1c | 279 | } |
Jeej | 0:87c57e1b1e1c | 280 | } |
Jeej | 0:87c57e1b1e1c | 281 | |
Jeej | 0:87c57e1b1e1c | 282 | // Update last report time |
Jeej | 0:87c57e1b1e1c | 283 | last_report_time += ctx->config.read_period; |
Jeej | 0:87c57e1b1e1c | 284 | |
Jeej | 0:87c57e1b1e1c | 285 | Thread::wait(ctx->config.read_period); |
Jeej | 0:87c57e1b1e1c | 286 | } |
Jeej | 0:87c57e1b1e1c | 287 | } |
Jeej | 0:87c57e1b1e1c | 288 | |
Jeej | 0:87c57e1b1e1c | 289 | void thread_file_modified() |
Jeej | 0:87c57e1b1e1c | 290 | { |
Jeej | 0:87c57e1b1e1c | 291 | uint8_t fid; |
Jeej | 0:87c57e1b1e1c | 292 | osEvent evt; |
Jeej | 0:87c57e1b1e1c | 293 | |
Jeej | 0:87c57e1b1e1c | 294 | while (true) |
Jeej | 0:87c57e1b1e1c | 295 | { |
Jeej | 0:87c57e1b1e1c | 296 | evt = g_file_modified.get(); |
Jeej | 0:87c57e1b1e1c | 297 | fid = (evt.status == osEventMessage)? (uint8_t)(uint32_t)evt.value.p : NULL; |
Jeej | 0:87c57e1b1e1c | 298 | |
Jeej | 0:87c57e1b1e1c | 299 | switch (fid) |
Jeej | 0:87c57e1b1e1c | 300 | { |
Jeej | 0:87c57e1b1e1c | 301 | // If a configuration file has been modified, update the context |
Jeej | 0:87c57e1b1e1c | 302 | case FID_SENSOR_CONFIG_MAG: |
Jeej | 0:87c57e1b1e1c | 303 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(mag_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 304 | break; |
Jeej | 0:87c57e1b1e1c | 305 | case FID_SENSOR_CONFIG_ACC: |
Jeej | 0:87c57e1b1e1c | 306 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(acc_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 307 | break; |
Jeej | 0:87c57e1b1e1c | 308 | case FID_SENSOR_CONFIG_GYR: |
Jeej | 0:87c57e1b1e1c | 309 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(gyr_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 310 | break; |
Jeej | 0:87c57e1b1e1c | 311 | case FID_SENSOR_CONFIG_PRE: |
Jeej | 0:87c57e1b1e1c | 312 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(pre_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 313 | break; |
Jeej | 0:87c57e1b1e1c | 314 | case FID_SENSOR_CONFIG_HUM: |
Jeej | 0:87c57e1b1e1c | 315 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(hum_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 316 | break; |
Jeej | 0:87c57e1b1e1c | 317 | case FID_SENSOR_CONFIG_TEM1: |
Jeej | 0:87c57e1b1e1c | 318 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(tem1_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 319 | break; |
Jeej | 0:87c57e1b1e1c | 320 | case FID_SENSOR_CONFIG_TEM2: |
Jeej | 0:87c57e1b1e1c | 321 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(tem2_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 322 | break; |
Jeej | 0:87c57e1b1e1c | 323 | case FID_SENSOR_CONFIG_LIGHT: |
Jeej | 0:87c57e1b1e1c | 324 | ram_fs_read(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(light_thread_ctx.config)); |
Jeej | 0:87c57e1b1e1c | 325 | break; |
Jeej | 0:87c57e1b1e1c | 326 | default: |
Jeej | 0:87c57e1b1e1c | 327 | break; |
Jeej | 0:87c57e1b1e1c | 328 | } |
Jeej | 0:87c57e1b1e1c | 329 | } |
Jeej | 0:87c57e1b1e1c | 330 | } |
Jeej | 0:87c57e1b1e1c | 331 | |
Jeej | 0:87c57e1b1e1c | 332 | void thread_user_button() |
Jeej | 0:87c57e1b1e1c | 333 | { |
Jeej | 0:87c57e1b1e1c | 334 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:87c57e1b1e1c | 335 | |
Jeej | 0:87c57e1b1e1c | 336 | uint8_t alarm; |
Jeej | 0:87c57e1b1e1c | 337 | d7a_sp_res_t istat; |
Jeej | 0:87c57e1b1e1c | 338 | uint8_t user_id = modem_get_id(my_main_callback); |
Jeej | 0:87c57e1b1e1c | 339 | |
Jeej | 0:87c57e1b1e1c | 340 | |
Jeej | 0:87c57e1b1e1c | 341 | alp_d7a_itf_t alarm_itf = { |
Jeej | 0:87c57e1b1e1c | 342 | .type = ALP_ITF_TYPE_D7A, |
Jeej | 0:87c57e1b1e1c | 343 | .cfg.to = 0, |
Jeej | 0:87c57e1b1e1c | 344 | .cfg.te = 0, |
Jeej | 0:87c57e1b1e1c | 345 | .cfg.qos.bf.record = 0, |
Jeej | 0:87c57e1b1e1c | 346 | .cfg.qos.bf.stop_on_err = 0, |
Jeej | 0:87c57e1b1e1c | 347 | .cfg.qos.bf.resp = D7A_RESP_PREFERRED, |
Jeej | 0:87c57e1b1e1c | 348 | .cfg.qos.bf.retry = 1, // XXX WM_RPOL_RARE_SINGLE_CHECK, |
Jeej | 0:87c57e1b1e1c | 349 | .cfg.addressee.ctrl.bf.nls = D7A_NLS_AES_CCM_64, |
Jeej | 0:87c57e1b1e1c | 350 | .cfg.addressee.ctrl.bf.idf = D7A_ID_NBID, |
Jeej | 0:87c57e1b1e1c | 351 | .cfg.addressee.xcl.bf = {.s = 0x2, .m = 0x1},// XXX D7A_XCL_GW, |
Jeej | 0:87c57e1b1e1c | 352 | .cfg.addressee.id[0] = D7A_CTF_VAL(1,1) |
Jeej | 0:87c57e1b1e1c | 353 | }; |
Jeej | 0:87c57e1b1e1c | 354 | |
Jeej | 0:87c57e1b1e1c | 355 | // Load alarm value |
Jeej | 0:87c57e1b1e1c | 356 | ram_fs_read(FID_ALARM, 0, 1, &alarm); |
Jeej | 0:87c57e1b1e1c | 357 | |
Jeej | 0:87c57e1b1e1c | 358 | // Send initial value |
Jeej | 0:87c57e1b1e1c | 359 | modem_send_file_content((uint8_t*)&alarm_itf, MY_D7_ITF_SIZE(&alarm_itf), (void*)&istat, FID_ALARM, &alarm, 0, 1, user_id); |
Jeej | 0:87c57e1b1e1c | 360 | modem_ready[user_id].wait(); |
Jeej | 0:87c57e1b1e1c | 361 | |
Jeej | 0:87c57e1b1e1c | 362 | while (true) |
Jeej | 0:87c57e1b1e1c | 363 | { |
Jeej | 0:87c57e1b1e1c | 364 | // Wait for button press |
Jeej | 0:87c57e1b1e1c | 365 | button_user.wait(); |
Jeej | 0:87c57e1b1e1c | 366 | |
Jeej | 0:87c57e1b1e1c | 367 | // load/save value to keep choerency in case of remote access... |
Jeej | 0:87c57e1b1e1c | 368 | ram_fs_read(FID_ALARM, 0, 1, &alarm); |
Jeej | 0:87c57e1b1e1c | 369 | |
Jeej | 0:87c57e1b1e1c | 370 | // Toggle alarm state |
Jeej | 0:87c57e1b1e1c | 371 | alarm = !alarm; |
Jeej | 0:87c57e1b1e1c | 372 | |
Jeej | 0:87c57e1b1e1c | 373 | ram_fs_write(FID_ALARM, 0, 1, &alarm); |
Jeej | 0:87c57e1b1e1c | 374 | |
Jeej | 0:87c57e1b1e1c | 375 | PRINT("BUTTON ALARM %d\r\n", alarm); |
Jeej | 0:87c57e1b1e1c | 376 | |
Jeej | 0:87c57e1b1e1c | 377 | modem_send_file_content((uint8_t*)&alarm_itf, MY_D7_ITF_SIZE(&alarm_itf), (void*)&istat, FID_ALARM, &alarm, 0, 1, user_id); |
Jeej | 0:87c57e1b1e1c | 378 | modem_ready[user_id].wait(); |
Jeej | 0:87c57e1b1e1c | 379 | } |
Jeej | 0:87c57e1b1e1c | 380 | } |
Jeej | 0:87c57e1b1e1c | 381 | |
Jeej | 0:87c57e1b1e1c | 382 | void modem_update_file(uint8_t fid, alp_file_header_t* header, uint8_t* data, uint8_t id) |
Jeej | 0:87c57e1b1e1c | 383 | { |
Jeej | 0:87c57e1b1e1c | 384 | alp_file_header_t remote_header; |
Jeej | 0:87c57e1b1e1c | 385 | |
Jeej | 0:87c57e1b1e1c | 386 | memset(&remote_header, 0, sizeof(alp_file_header_t)); |
Jeej | 0:87c57e1b1e1c | 387 | |
Jeej | 0:87c57e1b1e1c | 388 | // Read remote header |
Jeej | 0:87c57e1b1e1c | 389 | modem_read_fprop(fid, &remote_header, id); |
Jeej | 0:87c57e1b1e1c | 390 | modem_ready[id].wait(); |
Jeej | 0:87c57e1b1e1c | 391 | |
Jeej | 0:87c57e1b1e1c | 392 | // Add file in local file system |
Jeej | 0:87c57e1b1e1c | 393 | ram_fs_new(fid, (uint8_t*)header, data); |
Jeej | 0:87c57e1b1e1c | 394 | |
Jeej | 0:87c57e1b1e1c | 395 | // Update file |
Jeej | 0:87c57e1b1e1c | 396 | if (memcmp(&remote_header, header, sizeof(alp_file_header_t))) |
Jeej | 0:87c57e1b1e1c | 397 | { |
Jeej | 0:87c57e1b1e1c | 398 | PRINT("Updating file %d\n", fid); |
Jeej | 0:87c57e1b1e1c | 399 | // Delete |
Jeej | 0:87c57e1b1e1c | 400 | modem_delete_file(fid, id); |
Jeej | 0:87c57e1b1e1c | 401 | modem_ready[id].wait(); |
Jeej | 0:87c57e1b1e1c | 402 | // Restore in local file system |
Jeej | 0:87c57e1b1e1c | 403 | ram_fs_new(fid, (uint8_t*)header, data); |
Jeej | 0:87c57e1b1e1c | 404 | // Re-create |
Jeej | 0:87c57e1b1e1c | 405 | if (data) |
Jeej | 0:87c57e1b1e1c | 406 | { |
Jeej | 0:87c57e1b1e1c | 407 | modem_declare_file(fid, header, id); |
Jeej | 0:87c57e1b1e1c | 408 | } |
Jeej | 0:87c57e1b1e1c | 409 | else |
Jeej | 0:87c57e1b1e1c | 410 | { |
Jeej | 0:87c57e1b1e1c | 411 | modem_create_file(fid, header, id); |
Jeej | 0:87c57e1b1e1c | 412 | } |
Jeej | 0:87c57e1b1e1c | 413 | modem_ready[id].wait(); |
Jeej | 0:87c57e1b1e1c | 414 | } |
Jeej | 0:87c57e1b1e1c | 415 | else |
Jeej | 0:87c57e1b1e1c | 416 | { |
Jeej | 0:87c57e1b1e1c | 417 | PRINT("File %d up to date\n", fid); |
Jeej | 0:87c57e1b1e1c | 418 | } |
Jeej | 0:87c57e1b1e1c | 419 | } |
Jeej | 0:87c57e1b1e1c | 420 | |
Jeej | 0:87c57e1b1e1c | 421 | // Todo for each sensor |
Jeej | 0:87c57e1b1e1c | 422 | #define SENSOR_SETUP(NAME,name) modem_update_file(FID_SENSOR_VALUE_##NAME, (alp_file_header_t*)&h_sensor_value_##name, NULL, main_id);\ |
Jeej | 0:87c57e1b1e1c | 423 | modem_update_file(FID_SENSOR_CONFIG_##NAME, (alp_file_header_t*)&h_sensor_config_##name, (uint8_t*)&f_sensor_config_##name, main_id);\ |
Jeej | 0:87c57e1b1e1c | 424 | g_thread_ctx = &name##_thread_ctx;\ |
Jeej | 0:87c57e1b1e1c | 425 | Thread th_##name(osPriorityNormal, 1024, NULL);\ |
Jeej | 0:87c57e1b1e1c | 426 | status = th_##name.start(thread_sensor);\ |
Jeej | 0:87c57e1b1e1c | 427 | ASSERT(status == osOK, "Failed to start thread (err: %d)\r\n", status);\ |
Jeej | 0:87c57e1b1e1c | 428 | thread_ready.wait() |
Jeej | 0:87c57e1b1e1c | 429 | |
Jeej | 0:87c57e1b1e1c | 430 | /*** Main function ------------------------------------------------------------- ***/ |
Jeej | 0:87c57e1b1e1c | 431 | int main() |
Jeej | 0:87c57e1b1e1c | 432 | { |
Jeej | 0:87c57e1b1e1c | 433 | // Start & initialize |
Jeej | 0:87c57e1b1e1c | 434 | DBG_OPEN(DEBUG_LED); |
Jeej | 0:87c57e1b1e1c | 435 | PRINT("\r\n--- Starting new run ---\r\n"); |
Jeej | 0:87c57e1b1e1c | 436 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:87c57e1b1e1c | 437 | |
Jeej | 0:87c57e1b1e1c | 438 | static union { |
Jeej | 0:87c57e1b1e1c | 439 | uint8_t b[8]; |
Jeej | 0:87c57e1b1e1c | 440 | uint32_t w[2]; |
Jeej | 0:87c57e1b1e1c | 441 | } uid; |
Jeej | 0:87c57e1b1e1c | 442 | revision_t rev; |
Jeej | 0:87c57e1b1e1c | 443 | uint8_t main_id; |
Jeej | 0:87c57e1b1e1c | 444 | |
Jeej | 0:87c57e1b1e1c | 445 | // Hardware reset |
Jeej | 0:87c57e1b1e1c | 446 | DigitalOut reset_low(MODEM_PIN_RESET, 0); |
Jeej | 0:87c57e1b1e1c | 447 | Thread::wait(100); |
Jeej | 0:87c57e1b1e1c | 448 | |
Jeej | 0:87c57e1b1e1c | 449 | // Release reset |
Jeej | 0:87c57e1b1e1c | 450 | DigitalIn reset_release(MODEM_PIN_RESET); |
Jeej | 0:87c57e1b1e1c | 451 | Thread::wait(2000); |
Jeej | 0:87c57e1b1e1c | 452 | |
Jeej | 0:87c57e1b1e1c | 453 | // Open modem Com port |
Jeej | 0:87c57e1b1e1c | 454 | g_modem_com = new WizziCom(MODEM_PIN_TX, MODEM_PIN_RX, MODEM_PIN_IRQ_OUT, MODEM_PIN_IRQ_IN); |
Jeej | 0:87c57e1b1e1c | 455 | |
Jeej | 0:87c57e1b1e1c | 456 | // Redirect All Port traffic to my_serial_input |
Jeej | 0:87c57e1b1e1c | 457 | g_modem_com->attach(my_serial_input, WizziComPacketOther); |
Jeej | 0:87c57e1b1e1c | 458 | |
Jeej | 0:87c57e1b1e1c | 459 | // Open driver |
Jeej | 0:87c57e1b1e1c | 460 | modem_open(my_serial_send, &callbacks); |
Jeej | 0:87c57e1b1e1c | 461 | |
Jeej | 0:87c57e1b1e1c | 462 | main_id = modem_get_id(my_main_callback); |
Jeej | 0:87c57e1b1e1c | 463 | |
Jeej | 0:87c57e1b1e1c | 464 | PRINT("Start Modem Process (id=%d)\n", main_id); |
Jeej | 0:87c57e1b1e1c | 465 | Thread::wait(1000); |
Jeej | 0:87c57e1b1e1c | 466 | |
Jeej | 0:87c57e1b1e1c | 467 | modem_read_file(D7A_FID_UID, uid.b, 0, 8, main_id); |
Jeej | 0:87c57e1b1e1c | 468 | modem_ready[main_id].wait(); |
Jeej | 0:87c57e1b1e1c | 469 | |
Jeej | 0:87c57e1b1e1c | 470 | modem_read_file(D7A_FID_FIRMWARE_VERSION, &rev, 0, sizeof(revision_t), main_id); |
Jeej | 0:87c57e1b1e1c | 471 | modem_ready[main_id].wait(); |
Jeej | 0:87c57e1b1e1c | 472 | |
Jeej | 0:87c57e1b1e1c | 473 | PRINT("------------ D7A Modem infos ------------\r\n"); |
Jeej | 0:87c57e1b1e1c | 474 | PRINT_DATA(" - UID: ", "%02X", uid.b, 8, "\r\n"); |
Jeej | 0:87c57e1b1e1c | 475 | PRINT(" - Manufacturer ID: %08X\r\n", rev.manufacturer_id); |
Jeej | 0:87c57e1b1e1c | 476 | PRINT(" - Device ID: %08X\r\n", rev.device_id); |
Jeej | 0:87c57e1b1e1c | 477 | PRINT(" - Hardware version: %08X\r\n", rev.hw_version); |
Jeej | 0:87c57e1b1e1c | 478 | PRINT(" - Firmware version: v%d.%d.%d\r\n", rev.fw_version.major, rev.fw_version.minor, rev.fw_version.patch); |
Jeej | 0:87c57e1b1e1c | 479 | PRINT(" - File system CRC: 0x%08x\r\n", rev.fs_crc); |
Jeej | 0:87c57e1b1e1c | 480 | PRINT("-----------------------------------------\r\n"); |
Jeej | 0:87c57e1b1e1c | 481 | |
Jeej | 0:87c57e1b1e1c | 482 | PRINT("Register Files\n"); |
Jeej | 0:87c57e1b1e1c | 483 | modem_update_file(FID_HOST_REV, &h_rev, (uint8_t*)&f_rev, main_id); |
Jeej | 0:87c57e1b1e1c | 484 | modem_update_file(FID_ALARM, &h_alarm, (uint8_t*)&f_alarm, main_id); |
Jeej | 0:87c57e1b1e1c | 485 | |
Jeej | 0:87c57e1b1e1c | 486 | // Configure URC: LQUAL on report file notification every 10 reports |
Jeej | 0:87c57e1b1e1c | 487 | PRINT("Setup URCs\n"); |
Jeej | 0:87c57e1b1e1c | 488 | modem_enable_urc(ALP_URC_TYPE_LQUAL, IFID_REPORT, 10, true, main_id); |
Jeej | 0:87c57e1b1e1c | 489 | modem_ready[main_id].wait(); |
Jeej | 0:87c57e1b1e1c | 490 | |
Jeej | 0:87c57e1b1e1c | 491 | PRINT("Start D7A Stack\n"); |
Jeej | 0:87c57e1b1e1c | 492 | modem_activate_itf(ALP_ITF_TYPE_D7A, 24, 0, ALP_D7A_ISTAT_RESP , true, main_id); |
Jeej | 0:87c57e1b1e1c | 493 | modem_ready[main_id].wait(); |
Jeej | 0:87c57e1b1e1c | 494 | |
Jeej | 0:87c57e1b1e1c | 495 | PRINT("Notify Modem Version\n"); |
Jeej | 0:87c57e1b1e1c | 496 | modem_notify_file(D7A_FID_FIRMWARE_VERSION, 0, SIZE_HOST_REV, main_id); |
Jeej | 0:87c57e1b1e1c | 497 | modem_ready[main_id].wait(); |
Jeej | 0:87c57e1b1e1c | 498 | |
Jeej | 0:87c57e1b1e1c | 499 | PRINT("Notify FW Version\n"); |
Jeej | 0:87c57e1b1e1c | 500 | modem_notify_file(FID_HOST_REV, 0, SIZE_HOST_REV, main_id); |
Jeej | 0:87c57e1b1e1c | 501 | modem_ready[main_id].wait(); |
Jeej | 0:87c57e1b1e1c | 502 | |
Jeej | 0:87c57e1b1e1c | 503 | // Start file modified thread |
Jeej | 0:87c57e1b1e1c | 504 | Thread th_file_modified(osPriorityNormal, 1024, NULL); |
Jeej | 0:87c57e1b1e1c | 505 | osStatus status = th_file_modified.start(thread_file_modified); |
Jeej | 0:87c57e1b1e1c | 506 | ASSERT(status == osOK, "Failed to start thread_file_modified (err: %d)\r\n", status); |
Jeej | 0:87c57e1b1e1c | 507 | |
Jeej | 0:87c57e1b1e1c | 508 | #if (_HUM_EN_ > 0 || _TEM1_EN_ > 0 || _MAG_EN_ > 0 || _ACC_EN_ > 0 || _GYR_EN_ > 0 || _PRE_EN_ > 0 || _TEM2_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 509 | // Open I2C and initialise the sensors |
Jeej | 0:87c57e1b1e1c | 510 | DevI2C ext_i2c(SENSOR_I2C_SDA, SENSOR_I2C_SCL); |
Jeej | 0:87c57e1b1e1c | 511 | #endif |
Jeej | 0:87c57e1b1e1c | 512 | |
Jeej | 0:87c57e1b1e1c | 513 | #if (_HUM_EN_ > 0 || _TEM1_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 514 | humidity_sensor = new HTS221(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 515 | ASSERT(Init_HTS221(humidity_sensor), "Failed to init HTS221\r\n"); |
Jeej | 0:87c57e1b1e1c | 516 | temp_sensor1 = humidity_sensor; |
Jeej | 0:87c57e1b1e1c | 517 | #endif // _TEM_EN_ |
Jeej | 0:87c57e1b1e1c | 518 | #if (_PRE_EN_ > 0 || _TEM2_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 519 | pressure_sensor = new LPS25H(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 520 | ASSERT(Init_LPS25H(pressure_sensor), "Failed to init LPS25H\r\n"); |
Jeej | 0:87c57e1b1e1c | 521 | temp_sensor2 = pressure_sensor; |
Jeej | 0:87c57e1b1e1c | 522 | #endif // _PRE_EN_ |
Jeej | 0:87c57e1b1e1c | 523 | |
Jeej | 0:87c57e1b1e1c | 524 | #if defined(TARGET_STM32L152RE) |
Jeej | 0:87c57e1b1e1c | 525 | #if (_MAG_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 526 | magnetometer = new LIS3MDL(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 527 | ASSERT(Init_LIS3MDL(magnetometer), "Failed to init LIS3MDL\r\n"); |
Jeej | 0:87c57e1b1e1c | 528 | #endif // _MAG_EN_ |
Jeej | 0:87c57e1b1e1c | 529 | #if (_ACC_EN_ > 0 || _GYR_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 530 | accelerometer = new LSM6DS0(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 531 | ASSERT(Init_LSM6DS0(accelerometer), "Failed to init LSM6DS0\r\n"); |
Jeej | 0:87c57e1b1e1c | 532 | gyroscope = accelerometer; |
Jeej | 0:87c57e1b1e1c | 533 | #endif // _ACC_EN_ || _GYR_EN_ |
Jeej | 0:87c57e1b1e1c | 534 | #elif defined(TARGET_STM32L432KC) |
Jeej | 0:87c57e1b1e1c | 535 | #if (_ACC_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 536 | accelerometer = new LSM303C_ACC_Sensor(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 537 | ASSERT(Init_LSM303C_ACC(accelerometer), "Failed to init LSM303C_ACC\r\n"); |
Jeej | 0:87c57e1b1e1c | 538 | #endif // _ACC_EN_ |
Jeej | 0:87c57e1b1e1c | 539 | #if (_MAG_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 540 | magnetometer = new LSM303C_MAG_Sensor(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 541 | ASSERT(Init_LSM303C_MAG(magnetometer), "Failed to init LSM303C_MAG\r\n"); |
Jeej | 0:87c57e1b1e1c | 542 | #endif // _MAG_EN_ |
Jeej | 0:87c57e1b1e1c | 543 | #endif |
Jeej | 0:87c57e1b1e1c | 544 | |
Jeej | 0:87c57e1b1e1c | 545 | #if (_MAG_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 546 | SENSOR_SETUP(MAG,mag); |
Jeej | 0:87c57e1b1e1c | 547 | #endif |
Jeej | 0:87c57e1b1e1c | 548 | #if (_ACC_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 549 | SENSOR_SETUP(ACC,acc); |
Jeej | 0:87c57e1b1e1c | 550 | #endif |
Jeej | 0:87c57e1b1e1c | 551 | #if (_GYR_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 552 | SENSOR_SETUP(GYR,gyr); |
Jeej | 0:87c57e1b1e1c | 553 | #endif |
Jeej | 0:87c57e1b1e1c | 554 | #if (_PRE_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 555 | SENSOR_SETUP(PRE,pre); |
Jeej | 0:87c57e1b1e1c | 556 | #endif |
Jeej | 0:87c57e1b1e1c | 557 | #if (_HUM_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 558 | SENSOR_SETUP(HUM,hum); |
Jeej | 0:87c57e1b1e1c | 559 | #endif |
Jeej | 0:87c57e1b1e1c | 560 | #if (_TEM1_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 561 | SENSOR_SETUP(TEM1,tem1); |
Jeej | 0:87c57e1b1e1c | 562 | #endif |
Jeej | 0:87c57e1b1e1c | 563 | #if (_TEM2_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 564 | SENSOR_SETUP(TEM2,tem2); |
Jeej | 0:87c57e1b1e1c | 565 | #endif |
Jeej | 0:87c57e1b1e1c | 566 | #if (_LIGHT_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 567 | SENSOR_SETUP(LIGHT,light); |
Jeej | 0:87c57e1b1e1c | 568 | #endif |
Jeej | 0:87c57e1b1e1c | 569 | |
Jeej | 0:87c57e1b1e1c | 570 | modem_free_id(main_id); |
Jeej | 0:87c57e1b1e1c | 571 | |
Jeej | 0:87c57e1b1e1c | 572 | // For button |
Jeej | 0:87c57e1b1e1c | 573 | #ifdef DEBUG_BUTTON |
Jeej | 0:87c57e1b1e1c | 574 | DebouncedInterrupt user_interrupt(DEBUG_BUTTON); |
Jeej | 0:87c57e1b1e1c | 575 | user_interrupt.attach(button_push_isr, IRQ_FALL, 500, true); |
Jeej | 0:87c57e1b1e1c | 576 | |
Jeej | 0:87c57e1b1e1c | 577 | Thread but_th(osPriorityNormal, 1024, NULL); |
Jeej | 0:87c57e1b1e1c | 578 | status = but_th.start(thread_user_button); |
Jeej | 0:87c57e1b1e1c | 579 | ASSERT(status == osOK, "Failed to start but thread (err: %d)\r\n", status); |
Jeej | 0:87c57e1b1e1c | 580 | #endif |
Jeej | 0:87c57e1b1e1c | 581 | |
Jeej | 0:87c57e1b1e1c | 582 | #if (DEBUG_LED != NC) |
Jeej | 0:87c57e1b1e1c | 583 | DigitalOut my_led(DEBUG_LED); |
Jeej | 0:87c57e1b1e1c | 584 | #endif |
Jeej | 0:87c57e1b1e1c | 585 | |
Jeej | 0:87c57e1b1e1c | 586 | // Set main task to lowest priority |
Jeej | 0:87c57e1b1e1c | 587 | osThreadSetPriority(osThreadGetId(), osPriorityIdle); |
Jeej | 0:87c57e1b1e1c | 588 | while(true) |
Jeej | 0:87c57e1b1e1c | 589 | { |
Jeej | 0:87c57e1b1e1c | 590 | // Wait to avoid beeing stuck in loop |
Jeej | 0:87c57e1b1e1c | 591 | Thread::wait(500); |
Jeej | 0:87c57e1b1e1c | 592 | #if (DEBUG_LED != NC) |
Jeej | 0:87c57e1b1e1c | 593 | my_led = !my_led; |
Jeej | 0:87c57e1b1e1c | 594 | #endif |
Jeej | 0:87c57e1b1e1c | 595 | } |
Jeej | 0:87c57e1b1e1c | 596 | } |