Send file data through D7A Action Protocol demo.

Dependencies:   modem_ref_helper

Committer:
Jeej
Date:
Thu Sep 21 10:29:37 2017 +0000
Revision:
6:d4512d8f5dff
Parent:
5:4da1ea72e7b4
Child:
7:612f4cb8d8bf
Updated for v4.10.x

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 0:3058da317f01 1 // @autor: jeremie@wizzilab.com
Jeej 0:3058da317f01 2 // @date: 2017-05-02
Jeej 0:3058da317f01 3
Jeej 5:4da1ea72e7b4 4 #include "modem_ref_helper.h"
Jeej 0:3058da317f01 5 #include "modem_callbacks.h"
Jeej 5:4da1ea72e7b4 6 #include "files.h"
Jeej 0:3058da317f01 7 #include "sensor.h"
Jeej 0:3058da317f01 8
Jeej 0:3058da317f01 9 Semaphore modem_ready(0);
Jeej 0:3058da317f01 10 sensor_config_t g_light_config;
Jeej 0:3058da317f01 11 Queue<void, 8> g_file_modified;
Jeej 0:3058da317f01 12
Jeej 4:45576db9f66c 13 uint8_t g_main_id;
Jeej 0:3058da317f01 14
Jeej 0:3058da317f01 15 // Check parameters to see if data should be send
Jeej 0:3058da317f01 16 static bool report_needed(sensor_config_t* cfg, int32_t value, int32_t last_value, uint32_t last_report_time)
Jeej 0:3058da317f01 17 {
Jeej 0:3058da317f01 18 switch (cfg->report_type)
Jeej 0:3058da317f01 19 {
Jeej 0:3058da317f01 20 case REPORT_ALWAYS:
Jeej 0:3058da317f01 21 // Send a report at each measure
Jeej 0:3058da317f01 22 IPRINT("Report always\r\n");
Jeej 0:3058da317f01 23 return true;
Jeej 0:3058da317f01 24 case REPORT_ON_DIFFERENCE:
Jeej 0:3058da317f01 25 // Send a report when the difference between the last reported measure and the current mesure is greater than max_diff
Jeej 0:3058da317f01 26 if (abs(last_value - value) >= cfg->max_diff && cfg->max_diff)
Jeej 0:3058da317f01 27 {
Jeej 0:3058da317f01 28 IPRINT("Report on difference (last:%d new:%d max_diff:%d)\r\n", last_value, value, cfg->max_diff);
Jeej 0:3058da317f01 29 return true;
Jeej 0:3058da317f01 30 }
Jeej 0:3058da317f01 31 break;
Jeej 0:3058da317f01 32 case REPORT_ON_THRESHOLD:
Jeej 0:3058da317f01 33 // Send a report when crossing a threshold
Jeej 0:3058da317f01 34 if ( (value >= cfg->threshold_high && last_value < cfg->threshold_high)
Jeej 0:3058da317f01 35 || (value <= cfg->threshold_low && last_value > cfg->threshold_low)
Jeej 0:3058da317f01 36 || (value < cfg->threshold_high && last_value >= cfg->threshold_high)
Jeej 0:3058da317f01 37 || (value > cfg->threshold_low && last_value <= cfg->threshold_low))
Jeej 0:3058da317f01 38 {
Jeej 0:3058da317f01 39 IPRINT("Rerport on threshold (last:%d new:%d th:%d tl:%d)\r\n", last_value, value, cfg->threshold_high, cfg->threshold_low);
Jeej 0:3058da317f01 40 return true;
Jeej 0:3058da317f01 41 }
Jeej 0:3058da317f01 42 break;
Jeej 0:3058da317f01 43 default:
Jeej 0:3058da317f01 44 break;
Jeej 0:3058da317f01 45 }
Jeej 0:3058da317f01 46
Jeej 0:3058da317f01 47 // Send a report if it's been more than max_period since the last report
Jeej 0:3058da317f01 48 if (((last_report_time/1000) >= cfg->max_period) && cfg->max_period)
Jeej 0:3058da317f01 49 {
Jeej 0:3058da317f01 50 IPRINT("Report on period (max_period:%d time:%d)\r\n", cfg->max_period, last_report_time);
Jeej 0:3058da317f01 51 return true;
Jeej 0:3058da317f01 52 }
Jeej 0:3058da317f01 53
Jeej 0:3058da317f01 54 return false;
Jeej 0:3058da317f01 55 }
Jeej 0:3058da317f01 56
Jeej 0:3058da317f01 57 void thread_sensor_light()
Jeej 0:3058da317f01 58 {
Jeej 6:d4512d8f5dff 59 light_value_t light_level;
Jeej 6:d4512d8f5dff 60 light_value_t light_level_old = 0;
Jeej 0:3058da317f01 61
Jeej 0:3058da317f01 62 // To force a first report
Jeej 0:3058da317f01 63 uint32_t last_report_time = 0xFFFFFFFF;
Jeej 0:3058da317f01 64
Jeej 0:3058da317f01 65 FPRINT("(id:0x%08x)\r\n", osThreadGetId());
Jeej 0:3058da317f01 66
Jeej 0:3058da317f01 67 // Get the sensor configuration
Jeej 0:3058da317f01 68 ram_fs_read(FID_SENSOR_CONFIG, 0, SIZE_SENSOR_CONFIG, (uint8_t*)&g_light_config);
Jeej 0:3058da317f01 69
Jeej 0:3058da317f01 70 while (true)
Jeej 0:3058da317f01 71 {
Jeej 0:3058da317f01 72 light_level = sensor_get_light();
Jeej 0:3058da317f01 73
Jeej 0:3058da317f01 74 PRINT("Light %d\r\n", light_level);
Jeej 0:3058da317f01 75
Jeej 0:3058da317f01 76 if (report_needed(&g_light_config, light_level, light_level_old, last_report_time))
Jeej 0:3058da317f01 77 {
Jeej 0:3058da317f01 78 PRINT("Light report %d\r\n", light_level);
Jeej 0:3058da317f01 79
Jeej 0:3058da317f01 80 // Send notification
Jeej 0:3058da317f01 81 modem_write_file(FID_SENSOR_LIGHT, &light_level, 0, SIZE_SENSOR_LIGHT, g_main_id);
Jeej 0:3058da317f01 82 modem_ready.wait();
Jeej 0:3058da317f01 83
Jeej 0:3058da317f01 84 // Update
Jeej 0:3058da317f01 85 light_level_old = light_level;
Jeej 0:3058da317f01 86 last_report_time = 0;
Jeej 0:3058da317f01 87 }
Jeej 0:3058da317f01 88
Jeej 0:3058da317f01 89 // Update last report time
Jeej 0:3058da317f01 90 last_report_time += g_light_config.read_period;
Jeej 0:3058da317f01 91
Jeej 0:3058da317f01 92 Thread::wait(g_light_config.read_period);
Jeej 0:3058da317f01 93 }
Jeej 0:3058da317f01 94 }
Jeej 0:3058da317f01 95
Jeej 0:3058da317f01 96 void thread_file_modified()
Jeej 0:3058da317f01 97 {
Jeej 0:3058da317f01 98 uint8_t fid;
Jeej 0:3058da317f01 99 osEvent evt;
Jeej 0:3058da317f01 100
Jeej 0:3058da317f01 101 while (true)
Jeej 0:3058da317f01 102 {
Jeej 0:3058da317f01 103 evt = g_file_modified.get();
Jeej 0:3058da317f01 104 fid = (evt.status == osEventMessage)? (uint8_t)(uint32_t)evt.value.p : NULL;
Jeej 0:3058da317f01 105
Jeej 0:3058da317f01 106 switch (fid)
Jeej 0:3058da317f01 107 {
Jeej 0:3058da317f01 108 case FID_SENSOR_CONFIG:
Jeej 0:3058da317f01 109 // Update sensor configuration
Jeej 0:3058da317f01 110 ram_fs_read(FID_SENSOR_CONFIG, 0, SIZE_SENSOR_CONFIG, (uint8_t*)&g_light_config);
Jeej 0:3058da317f01 111 PRINT("Sensor configuration updated\r\n");
Jeej 0:3058da317f01 112 break;
Jeej 0:3058da317f01 113 default:
Jeej 0:3058da317f01 114 break;
Jeej 0:3058da317f01 115 }
Jeej 0:3058da317f01 116 }
Jeej 0:3058da317f01 117 }
Jeej 0:3058da317f01 118
Jeej 0:3058da317f01 119 // Misc
Jeej 0:3058da317f01 120 // ============================================================{{{
Jeej 0:3058da317f01 121
Jeej 0:3058da317f01 122 void my_get_alp_file_props(uint8_t fid, alp_file_header_t* hdr)
Jeej 0:3058da317f01 123 {
Jeej 0:3058da317f01 124 memcpy(hdr, ram_fs_get_header(fid), sizeof(alp_file_header_t));
Jeej 0:3058da317f01 125 }
Jeej 0:3058da317f01 126
Jeej 0:3058da317f01 127 void print_status(int status)
Jeej 0:3058da317f01 128 {
Jeej 0:3058da317f01 129 switch (status)
Jeej 0:3058da317f01 130 {
Jeej 0:3058da317f01 131 case ALP_ERR_NONE:
Jeej 0:3058da317f01 132 PRINT("Status: OK\n");
Jeej 0:3058da317f01 133 break;
Jeej 0:3058da317f01 134 case ALP_ERR_FILE_EXIST:
Jeej 0:3058da317f01 135 PRINT("Status: Already registered\n");
Jeej 0:3058da317f01 136 break;
Jeej 0:3058da317f01 137 default:
Jeej 0:3058da317f01 138 PRINT("Status: error %d\n", status);
Jeej 0:3058da317f01 139 break;
Jeej 0:3058da317f01 140 }
Jeej 0:3058da317f01 141 }
Jeej 0:3058da317f01 142
Jeej 0:3058da317f01 143 void print_resp(int status)
Jeej 0:3058da317f01 144 {
Jeej 0:3058da317f01 145 switch (status)
Jeej 0:3058da317f01 146 {
Jeej 0:3058da317f01 147 case ALP_ERR_NONE:
Jeej 0:3058da317f01 148 PRINT("Resp: OK\n");
Jeej 0:3058da317f01 149 break;
Jeej 0:3058da317f01 150 case ALP_ERR_FILE_EXIST:
Jeej 0:3058da317f01 151 PRINT("Resp: Already registered\n");
Jeej 0:3058da317f01 152 break;
Jeej 0:3058da317f01 153 default:
Jeej 0:3058da317f01 154 PRINT("Resp: error %d\n", status);
Jeej 0:3058da317f01 155 break;
Jeej 0:3058da317f01 156 }
Jeej 0:3058da317f01 157 }
Jeej 0:3058da317f01 158
Jeej 0:3058da317f01 159 modem_callbacks_t callbacks = {
Jeej 0:3058da317f01 160 .read = my_read,
Jeej 0:3058da317f01 161 .write = my_write,
Jeej 0:3058da317f01 162 .read_fprop = my_read_fprop,
Jeej 0:3058da317f01 163 .flush = my_flush,
Jeej 0:3058da317f01 164 .remove = my_delete,
Jeej 5:4da1ea72e7b4 165 .udata = my_udata,
Jeej 0:3058da317f01 166 .lqual = my_lqual,
Jeej 0:3058da317f01 167 .ldown = my_ldown,
Jeej 0:3058da317f01 168 .reset = my_reset,
Jeej 0:3058da317f01 169 .boot = my_boot
Jeej 0:3058da317f01 170 };
Jeej 0:3058da317f01 171
Jeej 0:3058da317f01 172 // Callback for g_main_id User
Jeej 0:3058da317f01 173 void my_main_callback(uint8_t terminal, int8_t err, uint8_t id)
Jeej 0:3058da317f01 174 {
Jeej 0:3058da317f01 175 (void)id;
Jeej 0:3058da317f01 176
Jeej 0:3058da317f01 177 if (terminal)
Jeej 0:3058da317f01 178 {
Jeej 0:3058da317f01 179 print_status(err);
Jeej 0:3058da317f01 180 modem_ready.release();
Jeej 0:3058da317f01 181 }
Jeej 0:3058da317f01 182 else
Jeej 0:3058da317f01 183 {
Jeej 0:3058da317f01 184 print_resp(err);
Jeej 0:3058da317f01 185 }
Jeej 0:3058da317f01 186 }
Jeej 0:3058da317f01 187
Jeej 0:3058da317f01 188 /*** Main function ------------------------------------------------------------- ***/
Jeej 0:3058da317f01 189 int main()
Jeej 0:3058da317f01 190 {
Jeej 0:3058da317f01 191 // Start & initialize
Jeej 5:4da1ea72e7b4 192 #ifdef DEBUG_LED
Jeej 0:3058da317f01 193 DBG_OPEN(DEBUG_LED);
Jeej 5:4da1ea72e7b4 194 #else
Jeej 5:4da1ea72e7b4 195 DBG_OPEN(NC);
Jeej 5:4da1ea72e7b4 196 #endif
Jeej 0:3058da317f01 197 PRINT("\r\n--- Starting new run ---\r\n");
Jeej 0:3058da317f01 198 FPRINT("(id:0x%08x)\r\n", osThreadGetId());
Jeej 0:3058da317f01 199
Jeej 5:4da1ea72e7b4 200 modem_helper_open(&callbacks);
Jeej 0:3058da317f01 201
Jeej 0:3058da317f01 202 g_main_id = modem_get_id(my_main_callback);
Jeej 0:3058da317f01 203
Jeej 0:3058da317f01 204 DPRINT("Register Files\n");
Jeej 3:e905bf88e8a9 205
Jeej 0:3058da317f01 206 // HOST Revision is a local file. Uses D7AActP Notification.
Jeej 3:e905bf88e8a9 207 modem_update_file(FID_HOST_REV, (alp_file_header_t*)&h_rev, (uint8_t*)&f_rev);
Jeej 3:e905bf88e8a9 208
Jeej 0:3058da317f01 209 // Create report file on modem.
Jeej 3:e905bf88e8a9 210 modem_update_file(FID_SENSOR_LIGHT, (alp_file_header_t*)&h_sensor_light, NULL);
Jeej 3:e905bf88e8a9 211
Jeej 0:3058da317f01 212 // Allow remote access.
Jeej 3:e905bf88e8a9 213 modem_update_file(FID_SENSOR_CONFIG, (alp_file_header_t*)&h_sensor_config, (uint8_t*)&f_sensor_config);
Jeej 0:3058da317f01 214
Jeej 0:3058da317f01 215 // Configure URC: LQUAL on report file notification every 10 reports
Jeej 0:3058da317f01 216 PRINT("Setup URCs\n");
Jeej 0:3058da317f01 217 modem_enable_urc(ALP_URC_TYPE_LQUAL, IFID_REPORT, 10, true, g_main_id);
Jeej 0:3058da317f01 218 modem_ready.wait();
Jeej 0:3058da317f01 219
Jeej 0:3058da317f01 220 PRINT("Start D7A Stack\n");
Jeej 0:3058da317f01 221 modem_activate_itf(ALP_ITF_TYPE_D7A, 24, 0, ALP_D7A_ISTAT_RESP , true, g_main_id);
Jeej 0:3058da317f01 222 modem_ready.wait();
Jeej 0:3058da317f01 223
Jeej 0:3058da317f01 224 PRINT("Notify Modem Version\n");
Jeej 4:45576db9f66c 225 modem_notify_file(D7A_FID_FIRMWARE_VERSION, 0, SIZE_HOST_REV, g_main_id);
Jeej 0:3058da317f01 226 modem_ready.wait();
Jeej 0:3058da317f01 227
Jeej 0:3058da317f01 228 PRINT("Notify FW Version\n");
Jeej 0:3058da317f01 229 modem_notify_file(FID_HOST_REV, 0, SIZE_HOST_REV, g_main_id);
Jeej 0:3058da317f01 230 modem_ready.wait();
Jeej 0:3058da317f01 231
Jeej 0:3058da317f01 232 // Start file modified thread
Jeej 0:3058da317f01 233 Thread th_file_modified(osPriorityNormal, 1024, NULL);
Jeej 0:3058da317f01 234 osStatus status = th_file_modified.start(thread_file_modified);
Jeej 0:3058da317f01 235 ASSERT(status == osOK, "Failed to start thread_file_modified (err: %d)\r\n", status);
Jeej 0:3058da317f01 236
Jeej 0:3058da317f01 237 // Start light measure thread
Jeej 0:3058da317f01 238 Thread th_sensor_light(osPriorityNormal, 1024, NULL);
Jeej 0:3058da317f01 239 status = th_sensor_light.start(thread_sensor_light);
Jeej 0:3058da317f01 240 ASSERT(status == osOK, "Failed to start thread_sensor_light (err: %d)\r\n", status);
Jeej 0:3058da317f01 241
Jeej 5:4da1ea72e7b4 242 #ifdef DEBUG_LED
Jeej 0:3058da317f01 243 DigitalOut my_led(DEBUG_LED);
Jeej 0:3058da317f01 244 #endif
Jeej 0:3058da317f01 245
Jeej 0:3058da317f01 246 // Set main task to lowest priority
Jeej 0:3058da317f01 247 osThreadSetPriority(osThreadGetId(), osPriorityIdle);
Jeej 0:3058da317f01 248 while(true)
Jeej 0:3058da317f01 249 {
Jeej 0:3058da317f01 250 Thread::wait(500);
Jeej 5:4da1ea72e7b4 251 #ifdef DEBUG_LED
Jeej 0:3058da317f01 252 my_led = !my_led;
Jeej 0:3058da317f01 253 #endif
Jeej 0:3058da317f01 254 }
Jeej 0:3058da317f01 255 }