Complete sensor demo.
Dependencies: modem_ref_helper CRC X_NUCLEO_IKS01A1 DebouncedInterrupt
main.cpp@18:51b15d8bf2fe, 2021-10-29 (annotated)
- Committer:
- marin_wizzi
- Date:
- Fri Oct 29 12:55:52 2021 +0000
- Revision:
- 18:51b15d8bf2fe
- Parent:
- 17:3e6083d76bc6
Compatible with 6.2 modem version
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 | 1:4d3968b2941b | 5 | #include "DebouncedInterrupt.h" |
Jeej | 0:87c57e1b1e1c | 6 | #include "sensors.h" |
Jeej | 1:4d3968b2941b | 7 | #include "sensors_cfg.h" |
Jeej | 1:4d3968b2941b | 8 | #include "simul.h" |
marin_wizzi | 18:51b15d8bf2fe | 9 | #include "modem_d7a.h" |
Jeej | 1:4d3968b2941b | 10 | #include "modem_callbacks.h" |
Jeej | 0:87c57e1b1e1c | 11 | #include "files.h" |
marin_wizzi | 18:51b15d8bf2fe | 12 | #include "crc.h" |
Jeej | 0:87c57e1b1e1c | 13 | |
Jeej | 7:b94971f119a5 | 14 | #define MIN_REPORT_PERIOD (10) // Seconds |
Jeej | 0:87c57e1b1e1c | 15 | |
Jeej | 6:c17f7cbdeb1a | 16 | enum { |
Jeej | 6:c17f7cbdeb1a | 17 | MODEM_RESP_NO, |
Jeej | 6:c17f7cbdeb1a | 18 | MODEM_RESP_TERMINAL, |
Jeej | 6:c17f7cbdeb1a | 19 | MODEM_RESP_DONE, |
Jeej | 6:c17f7cbdeb1a | 20 | }; |
Jeej | 6:c17f7cbdeb1a | 21 | |
Jeej | 6:c17f7cbdeb1a | 22 | Semaphore button_user(1); |
Jeej | 0:87c57e1b1e1c | 23 | Semaphore thread_ready(0); |
Jeej | 0:87c57e1b1e1c | 24 | sensor_config_t g_light_config; |
marin_wizzi | 18:51b15d8bf2fe | 25 | int sensor_id = 0; |
marin_wizzi | 18:51b15d8bf2fe | 26 | Queue<touch_t, 8> g_file_modified; |
Jeej | 0:87c57e1b1e1c | 27 | |
Jeej | 7:b94971f119a5 | 28 | static bool report_ok(uint32_t last_report_time) |
Jeej | 7:b94971f119a5 | 29 | { |
Jeej | 7:b94971f119a5 | 30 | // Do not send a report if it's been less than MIN_REPORT_PERIOD since the last report |
Jeej | 7:b94971f119a5 | 31 | if ((last_report_time/1000) < MIN_REPORT_PERIOD) |
Jeej | 7:b94971f119a5 | 32 | { |
Jeej | 11:9683d014dece | 33 | PRINT("Report Skipped. (Locked for %ds)\n", MIN_REPORT_PERIOD - (last_report_time/1000)); |
Jeej | 7:b94971f119a5 | 34 | return false; |
Jeej | 7:b94971f119a5 | 35 | } |
Jeej | 7:b94971f119a5 | 36 | |
Jeej | 7:b94971f119a5 | 37 | return true; |
Jeej | 7:b94971f119a5 | 38 | } |
Jeej | 7:b94971f119a5 | 39 | |
Jeej | 0:87c57e1b1e1c | 40 | // Check parameters to see if data should be send |
marin_wizzi | 18:51b15d8bf2fe | 41 | static bool report_needed(sensor_config_t* config, int32_t value, int32_t last_value, uint32_t last_report_time, uint8_t thread_id) |
Jeej | 0:87c57e1b1e1c | 42 | { |
marin_wizzi | 18:51b15d8bf2fe | 43 | char thread_name[10]; |
marin_wizzi | 18:51b15d8bf2fe | 44 | switch (thread_id) |
marin_wizzi | 18:51b15d8bf2fe | 45 | { |
marin_wizzi | 18:51b15d8bf2fe | 46 | case 0: strcpy(thread_name,"Magnetometer"); break; |
marin_wizzi | 18:51b15d8bf2fe | 47 | case 1: strcpy(thread_name,"Accelerometer"); break; |
marin_wizzi | 18:51b15d8bf2fe | 48 | case 2: strcpy(thread_name,"Pressure"); break; |
marin_wizzi | 18:51b15d8bf2fe | 49 | case 3: strcpy(thread_name,"Humidity"); break; |
marin_wizzi | 18:51b15d8bf2fe | 50 | case 4: strcpy(thread_name,"Temperature sensor 1"); break; |
marin_wizzi | 18:51b15d8bf2fe | 51 | case 5: strcpy(thread_name,"Temperature sensor 2"); break; |
marin_wizzi | 18:51b15d8bf2fe | 52 | case 6: strcpy(thread_name,"Light sensor"); break; |
marin_wizzi | 18:51b15d8bf2fe | 53 | default: strcpy(thread_name,"Unknown"); break; |
marin_wizzi | 18:51b15d8bf2fe | 54 | } |
marin_wizzi | 18:51b15d8bf2fe | 55 | |
Jeej | 0:87c57e1b1e1c | 56 | switch (config->report_type) |
Jeej | 0:87c57e1b1e1c | 57 | { |
Jeej | 0:87c57e1b1e1c | 58 | case REPORT_ALWAYS: |
Jeej | 0:87c57e1b1e1c | 59 | // Send a report at each measure |
marin_wizzi | 18:51b15d8bf2fe | 60 | PRINT("Report[%d] : %s always\r\n", thread_id, thread_name); |
Jeej | 7:b94971f119a5 | 61 | return report_ok(last_report_time); |
Jeej | 0:87c57e1b1e1c | 62 | case REPORT_ON_DIFFERENCE: |
Jeej | 0:87c57e1b1e1c | 63 | // Send a report when the difference between the last reported measure and the current mesure is greater than max_diff |
Jeej | 0:87c57e1b1e1c | 64 | if (abs(last_value - value) >= config->max_diff && config->max_diff) |
Jeej | 0:87c57e1b1e1c | 65 | { |
marin_wizzi | 18:51b15d8bf2fe | 66 | PRINT("Report[%d] : %s on difference (last:%d new:%d max_diff:%d)\r\n", thread_id, thread_name, last_value, value, config->max_diff); |
Jeej | 7:b94971f119a5 | 67 | return report_ok(last_report_time); |
Jeej | 0:87c57e1b1e1c | 68 | } |
Jeej | 0:87c57e1b1e1c | 69 | break; |
Jeej | 0:87c57e1b1e1c | 70 | case REPORT_ON_THRESHOLD: |
Jeej | 0:87c57e1b1e1c | 71 | // Send a report when crossing a threshold |
Jeej | 0:87c57e1b1e1c | 72 | if ( (value >= config->threshold_high && last_value < config->threshold_high) |
Jeej | 0:87c57e1b1e1c | 73 | || (value <= config->threshold_low && last_value > config->threshold_low) |
Jeej | 0:87c57e1b1e1c | 74 | || (value < config->threshold_high && last_value >= config->threshold_high) |
Jeej | 0:87c57e1b1e1c | 75 | || (value > config->threshold_low && last_value <= config->threshold_low)) |
Jeej | 0:87c57e1b1e1c | 76 | { |
marin_wizzi | 18:51b15d8bf2fe | 77 | PRINT("Report[%d] : %s on threshold (last:%d new:%d th:%d tl:%d)\r\n", thread_id, thread_name, last_value, value, config->threshold_high, config->threshold_low); |
Jeej | 7:b94971f119a5 | 78 | return report_ok(last_report_time); |
Jeej | 0:87c57e1b1e1c | 79 | } |
Jeej | 0:87c57e1b1e1c | 80 | break; |
Jeej | 0:87c57e1b1e1c | 81 | default: |
Jeej | 0:87c57e1b1e1c | 82 | break; |
Jeej | 0:87c57e1b1e1c | 83 | } |
Jeej | 0:87c57e1b1e1c | 84 | |
Jeej | 0:87c57e1b1e1c | 85 | // Send a report if it's been more than max_period since the last report |
Jeej | 0:87c57e1b1e1c | 86 | if (((last_report_time/1000) >= config->max_period) && config->max_period) |
Jeej | 0:87c57e1b1e1c | 87 | { |
marin_wizzi | 18:51b15d8bf2fe | 88 | PRINT("Report[%d] : %s on period (max_period:%d time:%d)\r\n", thread_id, thread_name, config->max_period, last_report_time); |
Jeej | 7:b94971f119a5 | 89 | return report_ok(last_report_time); |
Jeej | 0:87c57e1b1e1c | 90 | } |
Jeej | 0:87c57e1b1e1c | 91 | return false; |
Jeej | 0:87c57e1b1e1c | 92 | } |
Jeej | 0:87c57e1b1e1c | 93 | |
Jeej | 0:87c57e1b1e1c | 94 | // Interrupt Service Routine on button press. |
Jeej | 0:87c57e1b1e1c | 95 | void button_push_isr( void ) |
Jeej | 0:87c57e1b1e1c | 96 | { |
Jeej | 0:87c57e1b1e1c | 97 | button_user.release(); |
Jeej | 0:87c57e1b1e1c | 98 | } |
Jeej | 0:87c57e1b1e1c | 99 | |
marin_wizzi | 18:51b15d8bf2fe | 100 | modem_ref_callbacks_t callbacks = { |
Jeej | 0:87c57e1b1e1c | 101 | .read = my_read, |
Jeej | 0:87c57e1b1e1c | 102 | .write = my_write, |
Jeej | 0:87c57e1b1e1c | 103 | .read_fprop = my_read_fprop, |
Jeej | 0:87c57e1b1e1c | 104 | .flush = my_flush, |
Jeej | 0:87c57e1b1e1c | 105 | .remove = my_delete, |
Jeej | 1:4d3968b2941b | 106 | .udata = my_udata, |
Jeej | 0:87c57e1b1e1c | 107 | .lqual = my_lqual, |
Jeej | 0:87c57e1b1e1c | 108 | .ldown = my_ldown, |
Jeej | 0:87c57e1b1e1c | 109 | .reset = my_reset, |
Jeej | 11:9683d014dece | 110 | .boot = my_boot, |
Jeej | 11:9683d014dece | 111 | .busy = my_busy, |
Jeej | 0:87c57e1b1e1c | 112 | }; |
Jeej | 0:87c57e1b1e1c | 113 | |
Jeej | 0:87c57e1b1e1c | 114 | |
Jeej | 0:87c57e1b1e1c | 115 | // ----------------------------------------------- |
Jeej | 0:87c57e1b1e1c | 116 | // Sensor Threads |
Jeej | 0:87c57e1b1e1c | 117 | // ----------------------------------------------- |
Jeej | 0:87c57e1b1e1c | 118 | typedef struct |
Jeej | 0:87c57e1b1e1c | 119 | { |
Jeej | 0:87c57e1b1e1c | 120 | // Number of data fields |
Jeej | 0:87c57e1b1e1c | 121 | uint32_t nb_values; |
Jeej | 0:87c57e1b1e1c | 122 | // Total size of data |
Jeej | 0:87c57e1b1e1c | 123 | uint32_t data_size; |
Jeej | 0:87c57e1b1e1c | 124 | // Read value function |
Jeej | 0:87c57e1b1e1c | 125 | bool (*read_value)(int32_t*); |
Jeej | 0:87c57e1b1e1c | 126 | // Last reported value |
Jeej | 0:87c57e1b1e1c | 127 | int32_t* last_report_value; |
Jeej | 0:87c57e1b1e1c | 128 | // Current measured value |
Jeej | 0:87c57e1b1e1c | 129 | int32_t* current_value; |
Jeej | 0:87c57e1b1e1c | 130 | |
Jeej | 0:87c57e1b1e1c | 131 | // File ID of the sensor value file |
Jeej | 0:87c57e1b1e1c | 132 | uint8_t value_file_id; |
Jeej | 0:87c57e1b1e1c | 133 | // Sensor configuration file ID |
Jeej | 0:87c57e1b1e1c | 134 | uint8_t config_file_id; |
Jeej | 0:87c57e1b1e1c | 135 | // Sensor configuration context |
Jeej | 0:87c57e1b1e1c | 136 | sensor_config_t config; |
Jeej | 0:87c57e1b1e1c | 137 | |
Jeej | 0:87c57e1b1e1c | 138 | } sensor_thread_ctx_t; |
Jeej | 0:87c57e1b1e1c | 139 | |
Jeej | 0:87c57e1b1e1c | 140 | sensor_thread_ctx_t* g_thread_ctx; |
Jeej | 0:87c57e1b1e1c | 141 | |
Jeej | 0:87c57e1b1e1c | 142 | // Initialisation of the sensor thread's context |
Jeej | 0:87c57e1b1e1c | 143 | #define SENSOR_THREAD_CTX(name,NAME,_nb_values) \ |
Jeej | 0:87c57e1b1e1c | 144 | int32_t name##_last_report[_nb_values];\ |
Jeej | 0:87c57e1b1e1c | 145 | int32_t name##_current_value[_nb_values];\ |
Jeej | 0:87c57e1b1e1c | 146 | sensor_thread_ctx_t name##_thread_ctx = {\ |
Jeej | 0:87c57e1b1e1c | 147 | .nb_values = _nb_values,\ |
Jeej | 0:87c57e1b1e1c | 148 | .data_size = _nb_values * sizeof(int32_t),\ |
Jeej | 0:87c57e1b1e1c | 149 | .read_value = name##_get_value,\ |
Jeej | 0:87c57e1b1e1c | 150 | .last_report_value = (int32_t*)&name##_last_report,\ |
Jeej | 0:87c57e1b1e1c | 151 | .current_value = (int32_t*)&name##_current_value,\ |
Jeej | 0:87c57e1b1e1c | 152 | .value_file_id = FID_SENSOR_VALUE_##NAME,\ |
Jeej | 0:87c57e1b1e1c | 153 | .config_file_id = FID_SENSOR_CONFIG_##NAME\ |
Jeej | 0:87c57e1b1e1c | 154 | } |
Jeej | 0:87c57e1b1e1c | 155 | |
Jeej | 0:87c57e1b1e1c | 156 | SENSOR_THREAD_CTX(mag, MAG, 3); |
Jeej | 0:87c57e1b1e1c | 157 | SENSOR_THREAD_CTX(acc, ACC, 3); |
Jeej | 0:87c57e1b1e1c | 158 | SENSOR_THREAD_CTX(gyr, GYR, 3); |
Jeej | 0:87c57e1b1e1c | 159 | SENSOR_THREAD_CTX(pre, PRE, 1); |
Jeej | 0:87c57e1b1e1c | 160 | SENSOR_THREAD_CTX(hum, HUM, 1); |
Jeej | 0:87c57e1b1e1c | 161 | SENSOR_THREAD_CTX(tem1, TEM1, 1); |
Jeej | 0:87c57e1b1e1c | 162 | SENSOR_THREAD_CTX(tem2, TEM2, 1); |
Jeej | 0:87c57e1b1e1c | 163 | SENSOR_THREAD_CTX(light, LIGHT, 1); |
Jeej | 0:87c57e1b1e1c | 164 | |
Jeej | 0:87c57e1b1e1c | 165 | void thread_sensor() |
Jeej | 0:87c57e1b1e1c | 166 | { |
marin_wizzi | 18:51b15d8bf2fe | 167 | int thread_id = sensor_id++; |
marin_wizzi | 18:51b15d8bf2fe | 168 | |
Jeej | 0:87c57e1b1e1c | 169 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:87c57e1b1e1c | 170 | |
Jeej | 0:87c57e1b1e1c | 171 | // To force a first report |
Jeej | 0:87c57e1b1e1c | 172 | uint32_t last_report_time = 0xFFFFFFFF; |
Jeej | 0:87c57e1b1e1c | 173 | sensor_thread_ctx_t* ctx = g_thread_ctx; |
Jeej | 0:87c57e1b1e1c | 174 | |
Jeej | 0:87c57e1b1e1c | 175 | // Get the sensor configuration |
marin_wizzi | 18:51b15d8bf2fe | 176 | ram_fs_read(ctx->config_file_id, (uint8_t*)&(ctx->config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 177 | |
Jeej | 0:87c57e1b1e1c | 178 | thread_ready.release(); |
Jeej | 0:87c57e1b1e1c | 179 | |
Jeej | 0:87c57e1b1e1c | 180 | while (true) |
Jeej | 0:87c57e1b1e1c | 181 | { |
Jeej | 0:87c57e1b1e1c | 182 | bool err = ctx->read_value(ctx->current_value); |
Jeej | 0:87c57e1b1e1c | 183 | |
Jeej | 0:87c57e1b1e1c | 184 | ASSERT(err == 0, "Failed to read sensor\n"); |
Jeej | 0:87c57e1b1e1c | 185 | |
Jeej | 1:4d3968b2941b | 186 | //PRINT("Got %3d: ", ctx->value_file_id); |
Jeej | 1:4d3968b2941b | 187 | //for (uint8_t i = 0; i < ctx->nb_values; i++) |
Jeej | 1:4d3968b2941b | 188 | //{ |
Jeej | 1:4d3968b2941b | 189 | // PRINT("%9ld ", (int32_t)ctx->current_value[i]); |
Jeej | 1:4d3968b2941b | 190 | //} |
Jeej | 1:4d3968b2941b | 191 | //PRINT("\r\n"); |
Jeej | 0:87c57e1b1e1c | 192 | |
Jeej | 0:87c57e1b1e1c | 193 | for (uint8_t i = 0; i < ctx->nb_values; i++) |
Jeej | 0:87c57e1b1e1c | 194 | { |
marin_wizzi | 18:51b15d8bf2fe | 195 | if (report_needed(&(ctx->config), ctx->current_value[i], ctx->last_report_value[i], last_report_time, thread_id)) |
Jeej | 0:87c57e1b1e1c | 196 | { |
Jeej | 0:87c57e1b1e1c | 197 | // Send notification |
marin_wizzi | 18:51b15d8bf2fe | 198 | modem_write_file(ctx->value_file_id, ctx->current_value, 0, ctx->data_size); |
Jeej | 0:87c57e1b1e1c | 199 | |
Jeej | 0:87c57e1b1e1c | 200 | // Update last report value |
Jeej | 0:87c57e1b1e1c | 201 | memcpy(ctx->last_report_value, ctx->current_value, ctx->data_size); |
Jeej | 0:87c57e1b1e1c | 202 | // Reset last report time |
Jeej | 0:87c57e1b1e1c | 203 | last_report_time = 0; |
Jeej | 0:87c57e1b1e1c | 204 | } |
Jeej | 0:87c57e1b1e1c | 205 | } |
Jeej | 0:87c57e1b1e1c | 206 | |
Jeej | 0:87c57e1b1e1c | 207 | // Update last report time |
Jeej | 0:87c57e1b1e1c | 208 | last_report_time += ctx->config.read_period; |
Jeej | 0:87c57e1b1e1c | 209 | |
Jeej | 15:1271f3566b98 | 210 | ThisThread::sleep_for(ctx->config.read_period); |
Jeej | 0:87c57e1b1e1c | 211 | } |
Jeej | 0:87c57e1b1e1c | 212 | } |
Jeej | 0:87c57e1b1e1c | 213 | |
Jeej | 0:87c57e1b1e1c | 214 | void thread_file_modified() |
Jeej | 0:87c57e1b1e1c | 215 | { |
Jeej | 0:87c57e1b1e1c | 216 | uint8_t fid; |
Jeej | 0:87c57e1b1e1c | 217 | osEvent evt; |
Jeej | 0:87c57e1b1e1c | 218 | |
Jeej | 0:87c57e1b1e1c | 219 | while (true) |
Jeej | 0:87c57e1b1e1c | 220 | { |
Jeej | 0:87c57e1b1e1c | 221 | evt = g_file_modified.get(); |
Jeej | 0:87c57e1b1e1c | 222 | fid = (evt.status == osEventMessage)? (uint8_t)(uint32_t)evt.value.p : NULL; |
Jeej | 0:87c57e1b1e1c | 223 | |
Jeej | 0:87c57e1b1e1c | 224 | switch (fid) |
Jeej | 0:87c57e1b1e1c | 225 | { |
Jeej | 0:87c57e1b1e1c | 226 | // If a configuration file has been modified, update the context |
Jeej | 0:87c57e1b1e1c | 227 | case FID_SENSOR_CONFIG_MAG: |
marin_wizzi | 18:51b15d8bf2fe | 228 | ram_fs_read(fid, (uint8_t*)&(mag_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 229 | break; |
Jeej | 0:87c57e1b1e1c | 230 | case FID_SENSOR_CONFIG_ACC: |
marin_wizzi | 18:51b15d8bf2fe | 231 | ram_fs_read(fid, (uint8_t*)&(mag_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 232 | break; |
Jeej | 0:87c57e1b1e1c | 233 | case FID_SENSOR_CONFIG_GYR: |
marin_wizzi | 18:51b15d8bf2fe | 234 | ram_fs_read(fid, (uint8_t*)&(gyr_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 235 | break; |
Jeej | 0:87c57e1b1e1c | 236 | case FID_SENSOR_CONFIG_PRE: |
marin_wizzi | 18:51b15d8bf2fe | 237 | ram_fs_read(fid, (uint8_t*)&(gyr_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 238 | break; |
Jeej | 0:87c57e1b1e1c | 239 | case FID_SENSOR_CONFIG_HUM: |
marin_wizzi | 18:51b15d8bf2fe | 240 | ram_fs_read(fid, (uint8_t*)&(gyr_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 241 | break; |
Jeej | 0:87c57e1b1e1c | 242 | case FID_SENSOR_CONFIG_TEM1: |
marin_wizzi | 18:51b15d8bf2fe | 243 | ram_fs_read(fid, (uint8_t*)&(gyr_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 244 | break; |
Jeej | 0:87c57e1b1e1c | 245 | case FID_SENSOR_CONFIG_TEM2: |
marin_wizzi | 18:51b15d8bf2fe | 246 | ram_fs_read(fid, (uint8_t*)&(gyr_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 247 | break; |
Jeej | 0:87c57e1b1e1c | 248 | case FID_SENSOR_CONFIG_LIGHT: |
marin_wizzi | 18:51b15d8bf2fe | 249 | ram_fs_read(fid, (uint8_t*)&(gyr_thread_ctx.config), 0, sizeof(sensor_config_t)); |
Jeej | 0:87c57e1b1e1c | 250 | break; |
Jeej | 0:87c57e1b1e1c | 251 | default: |
Jeej | 0:87c57e1b1e1c | 252 | break; |
Jeej | 0:87c57e1b1e1c | 253 | } |
Jeej | 0:87c57e1b1e1c | 254 | } |
Jeej | 0:87c57e1b1e1c | 255 | } |
Jeej | 0:87c57e1b1e1c | 256 | |
Jeej | 6:c17f7cbdeb1a | 257 | // Callback for button |
Jeej | 6:c17f7cbdeb1a | 258 | void my_response_callback(uint8_t terminal, int8_t err, uint8_t id) |
Jeej | 6:c17f7cbdeb1a | 259 | { |
Jeej | 14:8fd5405f7ab2 | 260 | UNUSED(id); |
Jeej | 14:8fd5405f7ab2 | 261 | |
Jeej | 14:8fd5405f7ab2 | 262 | if (ALP_ERR_NONE != err) |
Jeej | 14:8fd5405f7ab2 | 263 | { |
Jeej | 14:8fd5405f7ab2 | 264 | modem_print_error(ALP_ITF_TYPE_D7A, err); |
Jeej | 14:8fd5405f7ab2 | 265 | } |
Jeej | 6:c17f7cbdeb1a | 266 | |
Jeej | 6:c17f7cbdeb1a | 267 | if (terminal) |
Jeej | 6:c17f7cbdeb1a | 268 | { |
marin_wizzi | 18:51b15d8bf2fe | 269 | g_file_modified.put((touch_t*)MODEM_RESP_TERMINAL); |
Jeej | 6:c17f7cbdeb1a | 270 | } |
Jeej | 6:c17f7cbdeb1a | 271 | else |
Jeej | 6:c17f7cbdeb1a | 272 | { |
Jeej | 6:c17f7cbdeb1a | 273 | if (ALP_ERR_NONE == err) |
Jeej | 6:c17f7cbdeb1a | 274 | { |
marin_wizzi | 18:51b15d8bf2fe | 275 | g_file_modified.put((touch_t*)MODEM_RESP_DONE); |
Jeej | 6:c17f7cbdeb1a | 276 | } |
Jeej | 6:c17f7cbdeb1a | 277 | } |
Jeej | 6:c17f7cbdeb1a | 278 | } |
Jeej | 6:c17f7cbdeb1a | 279 | |
Jeej | 0:87c57e1b1e1c | 280 | void thread_user_button() |
Jeej | 0:87c57e1b1e1c | 281 | { |
Jeej | 0:87c57e1b1e1c | 282 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:87c57e1b1e1c | 283 | |
Jeej | 6:c17f7cbdeb1a | 284 | osEvent evt; |
Jeej | 6:c17f7cbdeb1a | 285 | uint32_t resp; |
Jeej | 0:87c57e1b1e1c | 286 | uint8_t alarm; |
Jeej | 0:87c57e1b1e1c | 287 | d7a_sp_res_t istat; |
marin_wizzi | 18:51b15d8bf2fe | 288 | alp_payload_t* alp; |
marin_wizzi | 18:51b15d8bf2fe | 289 | alp_payload_t* alp_rsp; |
Jeej | 6:c17f7cbdeb1a | 290 | uint8_t nb = 0; |
marin_wizzi | 18:51b15d8bf2fe | 291 | int err; |
Jeej | 0:87c57e1b1e1c | 292 | |
Jeej | 0:87c57e1b1e1c | 293 | alp_d7a_itf_t alarm_itf = { |
Jeej | 0:87c57e1b1e1c | 294 | .type = ALP_ITF_TYPE_D7A, |
Jeej | 17:3e6083d76bc6 | 295 | .cfg.to.byte = D7A_CTF_ENCODE(0), |
Jeej | 17:3e6083d76bc6 | 296 | .cfg.te.byte = D7A_CTF_ENCODE(0), |
Jeej | 0:87c57e1b1e1c | 297 | .cfg.qos.bf.resp = D7A_RESP_PREFERRED, |
Jeej | 17:3e6083d76bc6 | 298 | .cfg.qos.bf.retry = ALP_RPOL_ONESHOT_RETRY, |
Jeej | 0:87c57e1b1e1c | 299 | .cfg.addressee.ctrl.bf.nls = D7A_NLS_AES_CCM_64, |
Jeej | 0:87c57e1b1e1c | 300 | .cfg.addressee.ctrl.bf.idf = D7A_ID_NBID, |
Jeej | 14:8fd5405f7ab2 | 301 | .cfg.addressee.xcl.bf = {.s = 2, .m = 0x1},// XXX D7A_XCL_GW, |
Jeej | 14:8fd5405f7ab2 | 302 | .cfg.addressee.id[0] = D7A_CTF_ENCODE(4), |
Jeej | 0:87c57e1b1e1c | 303 | }; |
Jeej | 0:87c57e1b1e1c | 304 | |
Jeej | 0:87c57e1b1e1c | 305 | // Load alarm value |
marin_wizzi | 18:51b15d8bf2fe | 306 | ram_fs_read(FID_ALARM, &alarm, 0, 1); |
Jeej | 0:87c57e1b1e1c | 307 | |
Jeej | 0:87c57e1b1e1c | 308 | while (true) |
Jeej | 0:87c57e1b1e1c | 309 | { |
Jeej | 0:87c57e1b1e1c | 310 | // Wait for button press |
Jeej | 15:1271f3566b98 | 311 | button_user.acquire(); |
Jeej | 0:87c57e1b1e1c | 312 | |
Jeej | 6:c17f7cbdeb1a | 313 | // load/save value to keep coherence in case of remote access... |
marin_wizzi | 18:51b15d8bf2fe | 314 | ram_fs_read(FID_ALARM, &alarm, 0, 1); |
Jeej | 0:87c57e1b1e1c | 315 | |
Jeej | 6:c17f7cbdeb1a | 316 | // Initial value |
Jeej | 6:c17f7cbdeb1a | 317 | if (alarm != 255) |
Jeej | 6:c17f7cbdeb1a | 318 | { |
Jeej | 6:c17f7cbdeb1a | 319 | // Toggle alarm state |
Jeej | 6:c17f7cbdeb1a | 320 | alarm = !alarm; |
marin_wizzi | 18:51b15d8bf2fe | 321 | ram_fs_write(FID_ALARM, &alarm, 0, 1); |
Jeej | 6:c17f7cbdeb1a | 322 | } |
Jeej | 0:87c57e1b1e1c | 323 | |
Jeej | 0:87c57e1b1e1c | 324 | PRINT("BUTTON ALARM %d\r\n", alarm); |
Jeej | 6:c17f7cbdeb1a | 325 | |
Jeej | 6:c17f7cbdeb1a | 326 | nb = 0; |
marin_wizzi | 18:51b15d8bf2fe | 327 | alp = NULL; |
marin_wizzi | 18:51b15d8bf2fe | 328 | alp = alp_payload_rsp_f_data(alp, FID_ALARM, &alarm, 0, 1); |
marin_wizzi | 18:51b15d8bf2fe | 329 | |
marin_wizzi | 18:51b15d8bf2fe | 330 | err = modem_remote_raw_alp((void*)&alarm_itf, alp, &alp_rsp, (uint32_t)15000); |
Jeej | 6:c17f7cbdeb1a | 331 | |
Jeej | 6:c17f7cbdeb1a | 332 | do |
Jeej | 6:c17f7cbdeb1a | 333 | { |
marin_wizzi | 18:51b15d8bf2fe | 334 | evt = g_file_modified.get(); |
Jeej | 6:c17f7cbdeb1a | 335 | resp = (evt.status == osEventMessage)? (uint32_t)evt.value.p : MODEM_RESP_NO; |
Jeej | 6:c17f7cbdeb1a | 336 | |
Jeej | 6:c17f7cbdeb1a | 337 | if (MODEM_RESP_DONE == resp) |
Jeej | 6:c17f7cbdeb1a | 338 | { |
Jeej | 6:c17f7cbdeb1a | 339 | nb++; |
Jeej | 17:3e6083d76bc6 | 340 | PRINT("%d: ", nb); |
Jeej | 6:c17f7cbdeb1a | 341 | PRINT_DATA("UID:", "%02X", istat.addressee.id, 8, " "); |
Jeej | 11:9683d014dece | 342 | PRINT("SNR: %3ddB RXLEV: -%-3ddBm LB: %3ddB\n", istat.snr, istat.rxlev, istat.lb); |
Jeej | 6:c17f7cbdeb1a | 343 | |
Jeej | 6:c17f7cbdeb1a | 344 | // Reset variable |
Jeej | 6:c17f7cbdeb1a | 345 | memset(&istat, 0, sizeof(d7a_sp_res_t)); |
Jeej | 6:c17f7cbdeb1a | 346 | } |
Jeej | 6:c17f7cbdeb1a | 347 | |
Jeej | 6:c17f7cbdeb1a | 348 | } while (MODEM_RESP_TERMINAL != resp); |
Jeej | 6:c17f7cbdeb1a | 349 | |
Jeej | 6:c17f7cbdeb1a | 350 | if (alarm == 255) |
Jeej | 6:c17f7cbdeb1a | 351 | { |
Jeej | 6:c17f7cbdeb1a | 352 | // Toggle alarm state |
Jeej | 6:c17f7cbdeb1a | 353 | alarm = !!alarm; |
marin_wizzi | 18:51b15d8bf2fe | 354 | ram_fs_write(FID_ALARM, &alarm, 0, 1); |
Jeej | 6:c17f7cbdeb1a | 355 | } |
Jeej | 0:87c57e1b1e1c | 356 | } |
Jeej | 0:87c57e1b1e1c | 357 | } |
Jeej | 0:87c57e1b1e1c | 358 | |
Jeej | 0:87c57e1b1e1c | 359 | // Todo for each sensor |
marin_wizzi | 18:51b15d8bf2fe | 360 | #define SENSOR_SETUP(NAME,name) ram_fs_new(FID_SENSOR_VALUE_##NAME, (uint8_t*)&h_sensor_value_##name, (uint8_t*)f_sensor_value_##name); modem_declare_file(FID_SENSOR_VALUE_##NAME, (alp_file_header_t*)&h_sensor_value_##name);\ |
marin_wizzi | 18:51b15d8bf2fe | 361 | ram_fs_new(FID_SENSOR_CONFIG_##NAME, (uint8_t*)&h_sensor_config_##name, (uint8_t*)&f_sensor_config_##name);\ |
marin_wizzi | 18:51b15d8bf2fe | 362 | modem_declare_file(FID_SENSOR_CONFIG_##NAME, (alp_file_header_t*)&h_sensor_config_##name);\ |
Jeej | 0:87c57e1b1e1c | 363 | g_thread_ctx = &name##_thread_ctx;\ |
Jeej | 0:87c57e1b1e1c | 364 | Thread th_##name(osPriorityNormal, 1024, NULL);\ |
Jeej | 0:87c57e1b1e1c | 365 | status = th_##name.start(thread_sensor);\ |
Jeej | 0:87c57e1b1e1c | 366 | ASSERT(status == osOK, "Failed to start thread (err: %d)\r\n", status);\ |
Jeej | 15:1271f3566b98 | 367 | thread_ready.acquire() |
Jeej | 0:87c57e1b1e1c | 368 | |
Jeej | 0:87c57e1b1e1c | 369 | /*** Main function ------------------------------------------------------------- ***/ |
Jeej | 0:87c57e1b1e1c | 370 | int main() |
Jeej | 0:87c57e1b1e1c | 371 | { |
Jeej | 0:87c57e1b1e1c | 372 | // Start & initialize |
Jeej | 1:4d3968b2941b | 373 | #ifdef DEBUG_LED |
Jeej | 0:87c57e1b1e1c | 374 | DBG_OPEN(DEBUG_LED); |
Jeej | 1:4d3968b2941b | 375 | #else |
Jeej | 1:4d3968b2941b | 376 | DBG_OPEN(NC); |
Jeej | 1:4d3968b2941b | 377 | #endif |
Jeej | 7:b94971f119a5 | 378 | PRINT("\n" |
Jeej | 7:b94971f119a5 | 379 | "-----------------------------------------\n" |
Jeej | 7:b94971f119a5 | 380 | "------------- Demo Sensors --------------\n" |
Jeej | 7:b94971f119a5 | 381 | "-----------------------------------------\n"); |
Jeej | 7:b94971f119a5 | 382 | |
Jeej | 7:b94971f119a5 | 383 | |
Jeej | 0:87c57e1b1e1c | 384 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:87c57e1b1e1c | 385 | |
marin_wizzi | 18:51b15d8bf2fe | 386 | modem_open(&callbacks); |
Jeej | 0:87c57e1b1e1c | 387 | |
Jeej | 0:87c57e1b1e1c | 388 | PRINT("Register Files\n"); |
marin_wizzi | 18:51b15d8bf2fe | 389 | ram_fs_new(FID_ALARM, (uint8_t*)&h_alarm, (uint8_t*)&f_alarm); |
marin_wizzi | 18:51b15d8bf2fe | 390 | modem_declare_file(FID_ALARM, (alp_file_header_t*)&h_alarm); |
Jeej | 0:87c57e1b1e1c | 391 | |
marin_wizzi | 18:51b15d8bf2fe | 392 | PRINT("Enable D7A interface\n"); |
marin_wizzi | 18:51b15d8bf2fe | 393 | modem_d7a_enable_itf(); |
Jeej | 10:c01db64b9e68 | 394 | |
marin_wizzi | 18:51b15d8bf2fe | 395 | // Host revision file is in the modem. Update it. |
marin_wizzi | 18:51b15d8bf2fe | 396 | PRINT("Update host revision\n"); |
marin_wizzi | 18:51b15d8bf2fe | 397 | modem_write_file(FID_HOST_REV, (void*)&f_rev, 0, sizeof(revision_t)); |
Jeej | 10:c01db64b9e68 | 398 | |
Jeej | 0:87c57e1b1e1c | 399 | |
marin_wizzi | 18:51b15d8bf2fe | 400 | // Retrieve modem revision |
marin_wizzi | 18:51b15d8bf2fe | 401 | PRINT("Send revision\n"); |
Jeej | 0:87c57e1b1e1c | 402 | |
marin_wizzi | 18:51b15d8bf2fe | 403 | revision_t rev; |
marin_wizzi | 18:51b15d8bf2fe | 404 | |
marin_wizzi | 18:51b15d8bf2fe | 405 | modem_read_file(FID_WM_REV, &rev, 0, sizeof(revision_t)); |
Jeej | 0:87c57e1b1e1c | 406 | |
Jeej | 0:87c57e1b1e1c | 407 | // Start file modified thread |
Jeej | 0:87c57e1b1e1c | 408 | Thread th_file_modified(osPriorityNormal, 1024, NULL); |
Jeej | 0:87c57e1b1e1c | 409 | osStatus status = th_file_modified.start(thread_file_modified); |
Jeej | 0:87c57e1b1e1c | 410 | ASSERT(status == osOK, "Failed to start thread_file_modified (err: %d)\r\n", status); |
Jeej | 0:87c57e1b1e1c | 411 | |
Jeej | 0:87c57e1b1e1c | 412 | #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 | 413 | // Open I2C and initialise the sensors |
Jeej | 0:87c57e1b1e1c | 414 | DevI2C ext_i2c(SENSOR_I2C_SDA, SENSOR_I2C_SCL); |
Jeej | 0:87c57e1b1e1c | 415 | #endif |
Jeej | 0:87c57e1b1e1c | 416 | |
Jeej | 0:87c57e1b1e1c | 417 | #if (_HUM_EN_ > 0 || _TEM1_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 418 | humidity_sensor = new HTS221(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 419 | ASSERT(Init_HTS221(humidity_sensor), "Failed to init HTS221\r\n"); |
Jeej | 0:87c57e1b1e1c | 420 | temp_sensor1 = humidity_sensor; |
Jeej | 0:87c57e1b1e1c | 421 | #endif // _TEM_EN_ |
Jeej | 0:87c57e1b1e1c | 422 | #if (_PRE_EN_ > 0 || _TEM2_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 423 | pressure_sensor = new LPS25H(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 424 | ASSERT(Init_LPS25H(pressure_sensor), "Failed to init LPS25H\r\n"); |
Jeej | 0:87c57e1b1e1c | 425 | temp_sensor2 = pressure_sensor; |
Jeej | 0:87c57e1b1e1c | 426 | #endif // _PRE_EN_ |
Jeej | 0:87c57e1b1e1c | 427 | |
Jeej | 0:87c57e1b1e1c | 428 | #if defined(TARGET_STM32L152RE) |
Jeej | 0:87c57e1b1e1c | 429 | #if (_MAG_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 430 | magnetometer = new LIS3MDL(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 431 | ASSERT(Init_LIS3MDL(magnetometer), "Failed to init LIS3MDL\r\n"); |
Jeej | 0:87c57e1b1e1c | 432 | #endif // _MAG_EN_ |
Jeej | 0:87c57e1b1e1c | 433 | #if (_ACC_EN_ > 0 || _GYR_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 434 | accelerometer = new LSM6DS0(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 435 | ASSERT(Init_LSM6DS0(accelerometer), "Failed to init LSM6DS0\r\n"); |
Jeej | 0:87c57e1b1e1c | 436 | gyroscope = accelerometer; |
Jeej | 0:87c57e1b1e1c | 437 | #endif // _ACC_EN_ || _GYR_EN_ |
Jeej | 0:87c57e1b1e1c | 438 | #elif defined(TARGET_STM32L432KC) |
Jeej | 0:87c57e1b1e1c | 439 | #if (_ACC_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 440 | accelerometer = new LSM303C_ACC_Sensor(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 441 | ASSERT(Init_LSM303C_ACC(accelerometer), "Failed to init LSM303C_ACC\r\n"); |
Jeej | 0:87c57e1b1e1c | 442 | #endif // _ACC_EN_ |
Jeej | 0:87c57e1b1e1c | 443 | #if (_MAG_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 444 | magnetometer = new LSM303C_MAG_Sensor(ext_i2c); |
Jeej | 0:87c57e1b1e1c | 445 | ASSERT(Init_LSM303C_MAG(magnetometer), "Failed to init LSM303C_MAG\r\n"); |
Jeej | 0:87c57e1b1e1c | 446 | #endif // _MAG_EN_ |
Jeej | 0:87c57e1b1e1c | 447 | #endif |
Jeej | 0:87c57e1b1e1c | 448 | |
Jeej | 0:87c57e1b1e1c | 449 | #if (_MAG_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 450 | SENSOR_SETUP(MAG,mag); |
Jeej | 0:87c57e1b1e1c | 451 | #endif |
Jeej | 0:87c57e1b1e1c | 452 | #if (_ACC_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 453 | SENSOR_SETUP(ACC,acc); |
Jeej | 0:87c57e1b1e1c | 454 | #endif |
Jeej | 0:87c57e1b1e1c | 455 | #if (_GYR_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 456 | SENSOR_SETUP(GYR,gyr); |
Jeej | 0:87c57e1b1e1c | 457 | #endif |
Jeej | 0:87c57e1b1e1c | 458 | #if (_PRE_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 459 | SENSOR_SETUP(PRE,pre); |
Jeej | 0:87c57e1b1e1c | 460 | #endif |
Jeej | 0:87c57e1b1e1c | 461 | #if (_HUM_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 462 | SENSOR_SETUP(HUM,hum); |
Jeej | 0:87c57e1b1e1c | 463 | #endif |
Jeej | 0:87c57e1b1e1c | 464 | #if (_TEM1_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 465 | SENSOR_SETUP(TEM1,tem1); |
Jeej | 0:87c57e1b1e1c | 466 | #endif |
Jeej | 0:87c57e1b1e1c | 467 | #if (_TEM2_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 468 | SENSOR_SETUP(TEM2,tem2); |
Jeej | 0:87c57e1b1e1c | 469 | #endif |
Jeej | 0:87c57e1b1e1c | 470 | #if (_LIGHT_EN_ > 0) |
Jeej | 0:87c57e1b1e1c | 471 | SENSOR_SETUP(LIGHT,light); |
Jeej | 0:87c57e1b1e1c | 472 | #endif |
Jeej | 0:87c57e1b1e1c | 473 | |
Jeej | 0:87c57e1b1e1c | 474 | |
Jeej | 0:87c57e1b1e1c | 475 | // For button |
Jeej | 0:87c57e1b1e1c | 476 | #ifdef DEBUG_BUTTON |
Jeej | 0:87c57e1b1e1c | 477 | DebouncedInterrupt user_interrupt(DEBUG_BUTTON); |
Jeej | 0:87c57e1b1e1c | 478 | user_interrupt.attach(button_push_isr, IRQ_FALL, 500, true); |
Jeej | 0:87c57e1b1e1c | 479 | |
Jeej | 0:87c57e1b1e1c | 480 | Thread but_th(osPriorityNormal, 1024, NULL); |
Jeej | 0:87c57e1b1e1c | 481 | status = but_th.start(thread_user_button); |
Jeej | 0:87c57e1b1e1c | 482 | ASSERT(status == osOK, "Failed to start but thread (err: %d)\r\n", status); |
Jeej | 0:87c57e1b1e1c | 483 | #endif |
Jeej | 0:87c57e1b1e1c | 484 | |
Jeej | 1:4d3968b2941b | 485 | #ifdef DEBUG_LED |
Jeej | 0:87c57e1b1e1c | 486 | DigitalOut my_led(DEBUG_LED); |
Jeej | 0:87c57e1b1e1c | 487 | #endif |
Jeej | 0:87c57e1b1e1c | 488 | |
Jeej | 0:87c57e1b1e1c | 489 | // Set main task to lowest priority |
Jeej | 15:1271f3566b98 | 490 | osThreadSetPriority(osThreadGetId(), osPriorityLow); |
Jeej | 0:87c57e1b1e1c | 491 | while(true) |
Jeej | 0:87c57e1b1e1c | 492 | { |
Jeej | 0:87c57e1b1e1c | 493 | // Wait to avoid beeing stuck in loop |
Jeej | 15:1271f3566b98 | 494 | ThisThread::sleep_for(500); |
Jeej | 1:4d3968b2941b | 495 | #ifdef DEBUG_LED |
Jeej | 0:87c57e1b1e1c | 496 | my_led = !my_led; |
Jeej | 0:87c57e1b1e1c | 497 | #endif |
Jeej | 0:87c57e1b1e1c | 498 | } |
Jeej | 0:87c57e1b1e1c | 499 | } |