Pathfindr / Mbed OS mbed-os-PF-UWBBEACON_v1_dev

init

Dependencies:   aconno_I2C Lis2dh12 WatchdogTimer

main.cpp@36:8e359069192b, 2019-01-15 (annotated)

Committer:
pathfindr
Date:
Tue Jan 15 11:19:41 2019 +0000
Revision:
36:8e359069192b
Parent:
35:d9421d57d116
Child:
37:505ef618f06c
update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
pathfindr 0:94b743e06998 1 #include "main.h"
pathfindr 21:e0b866630c27 2
pathfindr 21:e0b866630c27 3 //------------------------------------------------------------------------------
pathfindr 24:c161db07557f 4 //DEFINES
pathfindr 21:e0b866630c27 5 //------------------------------------------------------------------------------
pathfindr 36:8e359069192b 6 #define FW_VERSION 2
pathfindr 26:fa3579737329 7
pathfindr 34:4493c9f6d707 8 //MODES
pathfindr 34:4493c9f6d707 9 #define USE_NRF_TEMP_SENSOR 1
pathfindr 34:4493c9f6d707 10
pathfindr 34:4493c9f6d707 11 //DEFAULT SETTINGS
pathfindr 34:4493c9f6d707 12 #define DEFAULT_SLEEP_FRAME 60000
pathfindr 26:fa3579737329 13 #define DEFAULT_LOCATION_MODE 2
pathfindr 26:fa3579737329 14 #define DEFAULT_LOCATION_ACCURACY 2 // 0 = no location, 1 = cl only, 2 = gps then cl
pathfindr 26:fa3579737329 15 #define DEFAULT_LOCATION_TX_INTERVAL_MINS 1440
pathfindr 26:fa3579737329 16 #define DEFAULT_LOCATION_TX_FAILSAFE_HRS 168
pathfindr 26:fa3579737329 17 #define DEFAULT_LOCATION_TIMEOUT 180
pathfindr 26:fa3579737329 18 #define DEFAULT_MOTION_G 11
pathfindr 26:fa3579737329 19 #define DEFAULT_MOTION_START_SECONDS 120
pathfindr 26:fa3579737329 20 #define DEFAULT_MOTION_STOP_SECONDS 120
pathfindr 26:fa3579737329 21 #define DEFAULT_IMPACT_G 127
pathfindr 28:24b02608fa5f 22 #define DEFAULT_CONNECTION_ATTEMPTS 1
pathfindr 26:fa3579737329 23 #define DEFAULT_CONNECTION_TIMEOUT 180
pathfindr 26:fa3579737329 24 #define DEFAULT_BEACON_INTERVAL_SECONDS 10
pathfindr 26:fa3579737329 25
pathfindr 0:94b743e06998 26 //------------------------------------------------------------------------------
pathfindr 7:e9a19750700d 27 //FUNCTION PROTOTYPES
pathfindr 0:94b743e06998 28 //------------------------------------------------------------------------------
pathfindr 36:8e359069192b 29 void mainStateEngine(void);
pathfindr 36:8e359069192b 30 void selftest(void);
pathfindr 36:8e359069192b 31 void buttonPress(void);
pathfindr 36:8e359069192b 32 void buttonRelease(void);
pathfindr 36:8e359069192b 33 void dumpSettings(void);
pathfindr 36:8e359069192b 34 void saveEventTimes(void);
pathfindr 0:94b743e06998 35
pathfindr 0:94b743e06998 36 //------------------------------------------------------------------------------
pathfindr 36:8e359069192b 37 // GLOBALS
pathfindr 0:94b743e06998 38 //------------------------------------------------------------------------------
pathfindr 36:8e359069192b 39 char* GLOBAL_defaultApi = "b:gps2";
pathfindr 36:8e359069192b 40 bool GLOBAL_accel_healthy = false;
pathfindr 36:8e359069192b 41 bool GLOBAL_motionStopFlagTriggered = false;
pathfindr 36:8e359069192b 42 bool GLOBAL_debugLED = true;
pathfindr 36:8e359069192b 43 bool GLOBAL_needToConfigureLis3dh = false;
pathfindr 36:8e359069192b 44 bool GLOBAL_registeredOnNetwork = false;
pathfindr 36:8e359069192b 45 bool GLOBAL_modemOn = false;
pathfindr 36:8e359069192b 46 bool GLOBAL_LEDSequenceinProgress = false;
pathfindr 36:8e359069192b 47 time_t GLOBAL_wakeTime = 0;
pathfindr 36:8e359069192b 48 char GLOBAL_exceptionString[15];
pathfindr 36:8e359069192b 49 char GLOBAL_debug_buffer[200];
pathfindr 34:4493c9f6d707 50
pathfindr 0:94b743e06998 51
pathfindr 36:8e359069192b 52 int RET_setting_firmware;
pathfindr 36:8e359069192b 53 uint32_t RET_setting_minimumupdate_hrs;
pathfindr 36:8e359069192b 54 uint8_t RET_setting_location_mode;
pathfindr 36:8e359069192b 55 uint8_t RET_setting_location_accuracy;
pathfindr 36:8e359069192b 56 uint32_t RET_setting_location_tx_interval_mins;
pathfindr 36:8e359069192b 57 uint32_t RET_setting_location_tx_failsafe_hrs;
pathfindr 36:8e359069192b 58 uint16_t RET_setting_location_timeout;
pathfindr 36:8e359069192b 59 uint32_t RET_setting_activity_tx_interval_hrs;
pathfindr 36:8e359069192b 60 uint32_t RET_setting_environmental_tx_interval_mins;
pathfindr 36:8e359069192b 61 uint16_t RET_setting_motion_g;
pathfindr 36:8e359069192b 62 time_t RET_setting_motion_start_seconds;
pathfindr 36:8e359069192b 63 time_t RET_setting_motion_stop_seconds;
pathfindr 36:8e359069192b 64 uint16_t RET_setting_impact_g;
pathfindr 36:8e359069192b 65 uint8_t RET_setting_impact_alert;
pathfindr 36:8e359069192b 66 uint16_t RET_setting_connection_timeout;
pathfindr 36:8e359069192b 67 uint16_t RET_setting_beacon_interval_seconds;
pathfindr 36:8e359069192b 68 uint16_t RET_setting_beacon_scan;
pathfindr 13:29f67f256709 69 //STATE
pathfindr 36:8e359069192b 70 uint8_t RET_coldBoot = 1;
pathfindr 36:8e359069192b 71 time_t RET_RTCunixtime;
pathfindr 36:8e359069192b 72 bool RET_haveSettings;
pathfindr 36:8e359069192b 73 uint8_t RET_state;
pathfindr 36:8e359069192b 74 uint8_t RET_state_prev;
pathfindr 36:8e359069192b 75 uint8_t RET_buttonPressCount;
pathfindr 36:8e359069192b 76 time_t RET_buttonPressTime;
pathfindr 36:8e359069192b 77 time_t RET_buttonHoldTime;
pathfindr 36:8e359069192b 78 time_t RET_SetupRunAt;
pathfindr 36:8e359069192b 79 time_t RET_SettingsGotAt;
pathfindr 16:3bf5f1a5f869 80 //MOTION STATE
pathfindr 36:8e359069192b 81 bool RET_motionTriggered;
pathfindr 36:8e359069192b 82 bool RET_motionTriggeredInTXInterval;
pathfindr 36:8e359069192b 83 time_t RET_motionStartTime;
pathfindr 36:8e359069192b 84 time_t RET_motionStopTime;
pathfindr 36:8e359069192b 85 bool RET_motionPendingOnState;
pathfindr 36:8e359069192b 86 bool RET_motionPendingOffState;
pathfindr 36:8e359069192b 87 bool RET_motionState;
pathfindr 36:8e359069192b 88 float RET_motionTotalActivityHours;
pathfindr 36:8e359069192b 89 time_t RET_motionFrameStart;
pathfindr 36:8e359069192b 90 char RET_activityData[140];
pathfindr 16:3bf5f1a5f869 91 //IMPACT
pathfindr 36:8e359069192b 92 bool RET_impactTriggered;
pathfindr 19:22261767c87a 93 //EVENTS LOGGING
pathfindr 36:8e359069192b 94 time_t RET_eventTime_location_log;
pathfindr 36:8e359069192b 95 time_t RET_eventTime_environmental_log;
pathfindr 19:22261767c87a 96 //EVENTS TX
pathfindr 36:8e359069192b 97 time_t RET_eventTime_location_tx;
pathfindr 36:8e359069192b 98 time_t RET_eventTime_location_failsafe_tx;
pathfindr 36:8e359069192b 99 time_t RET_eventTime_environmental_tx;
pathfindr 36:8e359069192b 100 time_t RET_eventTime_activity_tx;
pathfindr 36:8e359069192b 101 time_t RET_eventTime_wakeFromDormant;
pathfindr 4:8d8e9bfa82e4 102
pathfindr 0:94b743e06998 103 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 104 //GPIO
pathfindr 9:b0a1535b8ef2 105 //------------------------------------------------------------------------------
pathfindr 34:4493c9f6d707 106 InterruptIn button(PN_IN_BUTTON);
pathfindr 9:b0a1535b8ef2 107
pathfindr 9:b0a1535b8ef2 108 //------------------------------------------------------------------------------
pathfindr 7:e9a19750700d 109 //PERIPHERALS
pathfindr 0:94b743e06998 110 //------------------------------------------------------------------------------
pathfindr 4:8d8e9bfa82e4 111 //BLE myble;
pathfindr 20:5404841fdd2b 112 WatchdogTimer watchdog(300.0); //Do not set to less than 4500ms or can cause issues with softdevice
pathfindr 20:5404841fdd2b 113 void watchdogKick() {watchdog.kick();}
pathfindr 34:4493c9f6d707 114 SI7060 si7060(PN_I2C_SDA, PN_I2C_SCL);
pathfindr 34:4493c9f6d707 115 LIS3DH lis3dh(PN_SPI_MOSI, PN_SPI_MISO, PN_SPI_CS0, PN_SPI_CLK);
pathfindr 34:4493c9f6d707 116 Modem modem(PN_GSM_PWR_KEY, PN_VREG_EN, PN_GSM_WAKE_DISABLE);
pathfindr 9:b0a1535b8ef2 117 LowPowerTicker RTCticker; //no impact on power consumption
pathfindr 9:b0a1535b8ef2 118
pathfindr 9:b0a1535b8ef2 119 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 120 //THREAD SEMAPHORES
pathfindr 9:b0a1535b8ef2 121 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 122 Semaphore mainthread;
pathfindr 9:b0a1535b8ef2 123
pathfindr 9:b0a1535b8ef2 124 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 125 // LOW LEVEL FUNCS
pathfindr 34:4493c9f6d707 126 //------------------------------------------------------------------------------
pathfindr 34:4493c9f6d707 127 void nrf_configureGPIOForSleep(){
pathfindr 34:4493c9f6d707 128 nrf_gpio_cfg_input(PN_SPI_MOSI, NRF_GPIO_PIN_NOPULL);
pathfindr 34:4493c9f6d707 129 nrf_gpio_cfg_input(PN_SPI_MISO, NRF_GPIO_PIN_NOPULL);
pathfindr 6:388d3c7efdd9 130 }
pathfindr 19:22261767c87a 131 void setState(uint8_t state) {
pathfindr 19:22261767c87a 132 RET_state_prev = RET_state;
pathfindr 19:22261767c87a 133 RET_state = state;
pathfindr 22:810425eb76e1 134 }
pathfindr 34:4493c9f6d707 135
pathfindr 34:4493c9f6d707 136 void dumpSettings() {
pathfindr 34:4493c9f6d707 137 if(DEBUG_ON){
pathfindr 34:4493c9f6d707 138 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_RTCunixtime:%u", RET_RTCunixtime);debug_exe();
pathfindr 34:4493c9f6d707 139 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_firmware:%d", RET_setting_firmware);debug_exe();
pathfindr 34:4493c9f6d707 140 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_minimumupdate_hrs:%d", RET_setting_minimumupdate_hrs);debug_exe();
pathfindr 34:4493c9f6d707 141 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_state:%d", RET_state);debug_exe();
pathfindr 34:4493c9f6d707 142 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_mode:%d", RET_setting_location_mode);debug_exe();
pathfindr 34:4493c9f6d707 143 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_accuracy:%d", RET_setting_location_accuracy);debug_exe();
pathfindr 34:4493c9f6d707 144 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_tx_interval_mins:%d", RET_setting_location_tx_interval_mins);debug_exe();
pathfindr 34:4493c9f6d707 145 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_tx_failsafe_hrs:%d", RET_setting_location_tx_failsafe_hrs);debug_exe();
pathfindr 34:4493c9f6d707 146 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_timeout:%d", RET_setting_location_timeout);debug_exe();
pathfindr 34:4493c9f6d707 147 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_activity_tx_interval_hrs:%d", RET_setting_activity_tx_interval_hrs);debug_exe();
pathfindr 34:4493c9f6d707 148 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_environmental_tx_interval_mins:%d", RET_setting_environmental_tx_interval_mins);debug_exe();
pathfindr 34:4493c9f6d707 149 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_motion_g:%d", RET_setting_motion_g);debug_exe();
pathfindr 34:4493c9f6d707 150 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_motion_start_seconds:%d", RET_setting_motion_start_seconds);debug_exe();
pathfindr 34:4493c9f6d707 151 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_motion_stop_seconds:%d", RET_setting_motion_stop_seconds);debug_exe();
pathfindr 34:4493c9f6d707 152 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_impact_g:%d", RET_setting_impact_g);debug_exe();
pathfindr 34:4493c9f6d707 153 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_impact_alert:%d", RET_setting_impact_alert);debug_exe();
pathfindr 34:4493c9f6d707 154 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_connection_timeout:%d", RET_setting_connection_timeout);debug_exe();
pathfindr 34:4493c9f6d707 155 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_beacon_interval_seconds:%d", RET_setting_beacon_interval_seconds);debug_exe();
pathfindr 34:4493c9f6d707 156 debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_beacon_scan:%d", RET_setting_beacon_scan);debug_exe();
pathfindr 34:4493c9f6d707 157 }
pathfindr 34:4493c9f6d707 158
pathfindr 34:4493c9f6d707 159 DEBUG("RET_RTCunixtime:%u",RET_RTCunixtime);
pathfindr 34:4493c9f6d707 160 DEBUG("RET_setting_firmware:%d",RET_setting_firmware);
pathfindr 34:4493c9f6d707 161 DEBUG("RET_setting_minimumupdate_hrs:%d",RET_setting_minimumupdate_hrs);
pathfindr 34:4493c9f6d707 162 DEBUG("RET_state:%d",RET_state);
pathfindr 34:4493c9f6d707 163 DEBUG("RET_setting_location_mode:%d",RET_setting_location_mode);
pathfindr 34:4493c9f6d707 164 DEBUG("RET_setting_location_accuracy:%d",RET_setting_location_accuracy);
pathfindr 34:4493c9f6d707 165 DEBUG("RET_setting_location_tx_interval_mins:%d",RET_setting_location_tx_interval_mins);
pathfindr 34:4493c9f6d707 166 DEBUG("RET_setting_location_tx_failsafe_hrs:%d",RET_setting_location_tx_failsafe_hrs);
pathfindr 34:4493c9f6d707 167 DEBUG("RET_setting_location_timeout:%d",RET_setting_location_timeout);
pathfindr 34:4493c9f6d707 168 DEBUG("RET_setting_activity_tx_interval_hrs:%d",RET_setting_activity_tx_interval_hrs);
pathfindr 34:4493c9f6d707 169 DEBUG("RET_setting_environmental_tx_interval_mins:%d",RET_setting_environmental_tx_interval_mins);
pathfindr 34:4493c9f6d707 170 DEBUG("RET_setting_motion_g:%d",RET_setting_motion_g);
pathfindr 34:4493c9f6d707 171 DEBUG("RET_setting_motion_start_seconds:%d",RET_setting_motion_start_seconds);
pathfindr 34:4493c9f6d707 172 DEBUG("RET_setting_motion_stop_seconds:%d",RET_setting_motion_stop_seconds);
pathfindr 34:4493c9f6d707 173 DEBUG("RET_setting_impact_g:%d",RET_setting_impact_g);
pathfindr 34:4493c9f6d707 174 DEBUG("RET_setting_impact_alert:%d",RET_setting_impact_alert);
pathfindr 34:4493c9f6d707 175 DEBUG("RET_setting_connection_timeout:%d",RET_setting_connection_timeout);
pathfindr 34:4493c9f6d707 176 DEBUG("RET_setting_beacon_interval_seconds:%d",RET_setting_beacon_interval_seconds);
pathfindr 34:4493c9f6d707 177 DEBUG("RET_setting_beacon_scan:%d",RET_setting_beacon_scan);
pathfindr 24:c161db07557f 178 }
pathfindr 34:4493c9f6d707 179 float getBatteryV() {
pathfindr 19:22261767c87a 180 NRF52_SAADC batteryIn;
pathfindr 19:22261767c87a 181 batteryIn.addChannel(9); // vdd for battery
pathfindr 19:22261767c87a 182 batteryIn.calibrate();
pathfindr 25:7adeb1a53360 183 float voltage = 0.0;
pathfindr 25:7adeb1a53360 184 for (uint8_t i = 1; i <= 2; i++) { // need to get it 2 times to get accurate data, first one is always low for some reason
pathfindr 19:22261767c87a 185 batteryIn.updateData();
pathfindr 25:7adeb1a53360 186 voltage = (batteryIn.getData()[0])*(1.0/1024.0)*3.65;
pathfindr 19:22261767c87a 187 }
pathfindr 25:7adeb1a53360 188 return voltage;
pathfindr 22:810425eb76e1 189 }
pathfindr 36:8e359069192b 190 float nrfTemperature() {
pathfindr 36:8e359069192b 191 //INTERNAL NRF52 TEMP SENSOR
pathfindr 36:8e359069192b 192 uint32_t safetycounter = 0;
pathfindr 36:8e359069192b 193 float temperature = 0.0;
pathfindr 36:8e359069192b 194 NRF_TEMP->TASKS_START=1;
pathfindr 36:8e359069192b 195 while (NRF_TEMP->EVENTS_DATARDY==0 && safetycounter < 10000) {
pathfindr 36:8e359069192b 196 safetycounter ++;
pathfindr 36:8e359069192b 197 };
pathfindr 36:8e359069192b 198 NRF_TEMP->EVENTS_DATARDY=0;
pathfindr 36:8e359069192b 199 temperature = nrf_temp_read()/4.0;
pathfindr 36:8e359069192b 200 NRF_TEMP->TASKS_STOP=1;
pathfindr 36:8e359069192b 201 return temperature;
pathfindr 36:8e359069192b 202 }
pathfindr 22:810425eb76e1 203 float getTemperature() {
pathfindr 34:4493c9f6d707 204 float temperature;
pathfindr 36:8e359069192b 205
pathfindr 34:4493c9f6d707 206 if (USE_NRF_TEMP_SENSOR) {
pathfindr 34:4493c9f6d707 207 //INTERNAL NRF52 TEMP SENSOR
pathfindr 36:8e359069192b 208 temperature = nrfTemperature();
pathfindr 34:4493c9f6d707 209 } else {
pathfindr 34:4493c9f6d707 210 temperature = si7060.getTemperature(); //currently disabled because its causing a high current 450ua sleep, most likely due to sensor not sleeping correctly, or i2c sleep issue
pathfindr 34:4493c9f6d707 211 }
pathfindr 34:4493c9f6d707 212
pathfindr 22:810425eb76e1 213 return temperature;
pathfindr 19:22261767c87a 214 }
pathfindr 27:fa76f5a08195 215 void addToExceptionString(char* value) {
pathfindr 27:fa76f5a08195 216 snprintf(GLOBAL_exceptionString+strlen(GLOBAL_exceptionString),sizeof(GLOBAL_exceptionString),"%s.",value);
pathfindr 27:fa76f5a08195 217 }
pathfindr 19:22261767c87a 218 //------------------------------------------------------------------------------
pathfindr 19:22261767c87a 219 // USER BUTTON HANDLING
pathfindr 19:22261767c87a 220 //------------------------------------------------------------------------------
pathfindr 19:22261767c87a 221 void buttonPress() {
pathfindr 19:22261767c87a 222 RET_buttonPressTime = RET_RTCunixtime;
pathfindr 19:22261767c87a 223 }
pathfindr 19:22261767c87a 224 void buttonRelease() {
pathfindr 19:22261767c87a 225 RET_buttonHoldTime = (RET_RTCunixtime - RET_buttonPressTime);
pathfindr 19:22261767c87a 226 RET_buttonPressCount ++;
pathfindr 19:22261767c87a 227 }
pathfindr 19:22261767c87a 228 //------------------------------------------------------------------------------
pathfindr 19:22261767c87a 229 // RTC TICKER
pathfindr 19:22261767c87a 230 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 231 void RTCtick() {
pathfindr 19:22261767c87a 232 //YOU MUST NOT CALL ANY OTHER FUNCTIONS OR DEBUG FROM INSIDE HERE!!! OR IT LOCKS UP THE DEVICE, just change vars
pathfindr 19:22261767c87a 233 RET_RTCunixtime += 1;
pathfindr 19:22261767c87a 234
pathfindr 9:b0a1535b8ef2 235 //button logic - check for hold
pathfindr 19:22261767c87a 236 if (RET_buttonHoldTime > 4) {
pathfindr 9:b0a1535b8ef2 237 RET_buttonHoldTime = 0;
pathfindr 9:b0a1535b8ef2 238 RET_buttonPressCount = 0;
pathfindr 16:3bf5f1a5f869 239 RET_state_prev = RET_state;
pathfindr 16:3bf5f1a5f869 240 RET_state = STATE_BUTTONHOLD;
pathfindr 9:b0a1535b8ef2 241 mainthread.release();
pathfindr 9:b0a1535b8ef2 242 } else {
pathfindr 19:22261767c87a 243 if((RET_RTCunixtime - RET_buttonPressTime) > 1) {
pathfindr 9:b0a1535b8ef2 244 switch (RET_buttonPressCount) {
pathfindr 9:b0a1535b8ef2 245 case 1 :
pathfindr 19:22261767c87a 246 if (RET_state == STATE_NORMAL) {
pathfindr 19:22261767c87a 247 RET_state = STATE_BUTTONPRESS1;
pathfindr 19:22261767c87a 248 mainthread.release();
pathfindr 19:22261767c87a 249 }
pathfindr 9:b0a1535b8ef2 250 break;
pathfindr 29:059fc7324328 251 case 3 :
pathfindr 28:24b02608fa5f 252 if (RET_state == STATE_NORMAL) {
pathfindr 28:24b02608fa5f 253 RET_state = STATE_BUTTONPRESS2;
pathfindr 28:24b02608fa5f 254 mainthread.release();
pathfindr 28:24b02608fa5f 255 }
pathfindr 28:24b02608fa5f 256 break;
pathfindr 29:059fc7324328 257 case 5 :
pathfindr 19:22261767c87a 258 if (RET_state == STATE_NORMAL) {
pathfindr 28:24b02608fa5f 259 RET_state = STATE_BUTTONPRESS3;
pathfindr 19:22261767c87a 260 mainthread.release();
pathfindr 19:22261767c87a 261 }
pathfindr 9:b0a1535b8ef2 262 break;
pathfindr 9:b0a1535b8ef2 263 default :
pathfindr 9:b0a1535b8ef2 264 //do nothing
pathfindr 9:b0a1535b8ef2 265 break;
pathfindr 9:b0a1535b8ef2 266 }
pathfindr 9:b0a1535b8ef2 267 RET_buttonPressCount = 0;
pathfindr 9:b0a1535b8ef2 268 }
pathfindr 9:b0a1535b8ef2 269 }
pathfindr 19:22261767c87a 270 //SETUP STATE VISUALISE
pathfindr 33:760005331b4c 271 if (!GLOBAL_LEDSequenceinProgress && RET_state == STATE_SETUP) {
pathfindr 34:4493c9f6d707 272 led1 = !led1;
pathfindr 19:22261767c87a 273 }
pathfindr 9:b0a1535b8ef2 274 }
pathfindr 34:4493c9f6d707 275 void resetGlobals() {
pathfindr 34:4493c9f6d707 276 GLOBAL_accel_healthy = false;
pathfindr 34:4493c9f6d707 277 GLOBAL_motionStopFlagTriggered = false;
pathfindr 34:4493c9f6d707 278 memset(GLOBAL_exceptionString,0x00,sizeof(GLOBAL_exceptionString));
pathfindr 34:4493c9f6d707 279 if (DEBUG_ON) {memset(GLOBAL_debug_buffer,0x00,sizeof(GLOBAL_debug_buffer));}
pathfindr 34:4493c9f6d707 280 }
pathfindr 36:8e359069192b 281 void setDefaults() {
pathfindr 35:d9421d57d116 282 //IDENTITY
pathfindr 35:d9421d57d116 283 //RET_imei = 0;
pathfindr 35:d9421d57d116 284 //STATE
pathfindr 35:d9421d57d116 285 RET_haveSettings = 0;
pathfindr 35:d9421d57d116 286 RET_state = STATE_SETUP;
pathfindr 35:d9421d57d116 287 RET_state_prev = RET_state;
pathfindr 35:d9421d57d116 288 RET_RTCunixtime = 0;
pathfindr 35:d9421d57d116 289 RET_SetupRunAt = 0;
pathfindr 35:d9421d57d116 290 RET_SettingsGotAt = 0;
pathfindr 35:d9421d57d116 291 //SETTINGS
pathfindr 35:d9421d57d116 292 RET_setting_firmware = 0;
pathfindr 35:d9421d57d116 293 RET_setting_minimumupdate_hrs = 0;
pathfindr 35:d9421d57d116 294 RET_setting_location_mode = DEFAULT_LOCATION_MODE;
pathfindr 35:d9421d57d116 295 RET_setting_location_accuracy = DEFAULT_LOCATION_ACCURACY;
pathfindr 35:d9421d57d116 296 RET_setting_location_tx_interval_mins = DEFAULT_LOCATION_TX_INTERVAL_MINS;
pathfindr 35:d9421d57d116 297 RET_setting_location_tx_failsafe_hrs = DEFAULT_LOCATION_TX_FAILSAFE_HRS;
pathfindr 35:d9421d57d116 298 RET_setting_location_timeout = DEFAULT_LOCATION_TIMEOUT;
pathfindr 35:d9421d57d116 299 RET_setting_activity_tx_interval_hrs = 0;
pathfindr 35:d9421d57d116 300 RET_setting_environmental_tx_interval_mins = 0;
pathfindr 35:d9421d57d116 301 RET_setting_motion_g = DEFAULT_MOTION_G;
pathfindr 35:d9421d57d116 302 RET_setting_motion_start_seconds = DEFAULT_MOTION_START_SECONDS;
pathfindr 35:d9421d57d116 303 RET_setting_motion_stop_seconds = DEFAULT_MOTION_STOP_SECONDS;
pathfindr 35:d9421d57d116 304 RET_setting_impact_g = 0;
pathfindr 35:d9421d57d116 305 RET_setting_impact_alert = 0;
pathfindr 35:d9421d57d116 306 RET_setting_connection_timeout = DEFAULT_CONNECTION_TIMEOUT;
pathfindr 35:d9421d57d116 307 RET_setting_beacon_interval_seconds = DEFAULT_BEACON_INTERVAL_SECONDS;
pathfindr 35:d9421d57d116 308 RET_setting_beacon_scan = 0;
pathfindr 35:d9421d57d116 309 RET_buttonPressCount = 0;
pathfindr 35:d9421d57d116 310 RET_buttonPressTime = 0;
pathfindr 35:d9421d57d116 311 RET_buttonHoldTime = 0;
pathfindr 35:d9421d57d116 312 //MOTION STATE
pathfindr 35:d9421d57d116 313 RET_motionTriggered = 0;
pathfindr 35:d9421d57d116 314 RET_motionTriggeredInTXInterval = 0;
pathfindr 35:d9421d57d116 315 RET_motionStartTime = 0;
pathfindr 35:d9421d57d116 316 RET_motionStopTime = 0;
pathfindr 35:d9421d57d116 317 RET_motionPendingOnState = 0;
pathfindr 35:d9421d57d116 318 RET_motionPendingOffState = 0;
pathfindr 35:d9421d57d116 319 RET_motionState = 0;
pathfindr 35:d9421d57d116 320 RET_motionTotalActivityHours = 0.0;
pathfindr 35:d9421d57d116 321 RET_motionFrameStart = 0;
pathfindr 35:d9421d57d116 322 memset(RET_activityData,0x00,sizeof(RET_activityData));
pathfindr 35:d9421d57d116 323 //IMPACT
pathfindr 35:d9421d57d116 324 RET_impactTriggered = 0;
pathfindr 35:d9421d57d116 325 //EVENT HANDLING
pathfindr 35:d9421d57d116 326 RET_eventTime_location_log = 0;
pathfindr 35:d9421d57d116 327 RET_eventTime_location_tx = 0;
pathfindr 35:d9421d57d116 328 RET_eventTime_location_failsafe_tx = 0;
pathfindr 35:d9421d57d116 329 RET_eventTime_environmental_log = 0;
pathfindr 35:d9421d57d116 330 RET_eventTime_environmental_tx = 0;
pathfindr 35:d9421d57d116 331 RET_eventTime_activity_tx = 0;
pathfindr 35:d9421d57d116 332 RET_eventTime_wakeFromDormant = 0;
pathfindr 35:d9421d57d116 333
pathfindr 35:d9421d57d116 334 //PERIPHERAL RESET
pathfindr 35:d9421d57d116 335 lis3dh_configureForSleep(DEFAULT_MOTION_G,DEFAULT_IMPACT_G);
pathfindr 35:d9421d57d116 336 }
pathfindr 24:c161db07557f 337
pathfindr 22:810425eb76e1 338 bool selfTest() {
pathfindr 22:810425eb76e1 339 int test_count = 0;
pathfindr 22:810425eb76e1 340 int test_pass = 0;
pathfindr 22:810425eb76e1 341
pathfindr 8:7351f8c4cd60 342 //Accelerometer
pathfindr 22:810425eb76e1 343 test_count ++;
pathfindr 8:7351f8c4cd60 344 uint8_t lis3dh_id;
pathfindr 8:7351f8c4cd60 345 lis3dh.LIS3DH_GetWHO_AM_I(&lis3dh_id);
pathfindr 27:fa76f5a08195 346 if (lis3dh_id == 51) {
pathfindr 27:fa76f5a08195 347 test_pass ++;
pathfindr 27:fa76f5a08195 348 } else {
pathfindr 27:fa76f5a08195 349 addToExceptionString("A.");
pathfindr 27:fa76f5a08195 350 }
pathfindr 22:810425eb76e1 351
pathfindr 22:810425eb76e1 352 //Temperature
pathfindr 22:810425eb76e1 353 test_count ++;
pathfindr 22:810425eb76e1 354 float temperature;
pathfindr 34:4493c9f6d707 355 if (USE_NRF_TEMP_SENSOR) {
pathfindr 34:4493c9f6d707 356 //INTERNAL NRF52 TEMP SENSOR
pathfindr 36:8e359069192b 357 temperature = nrfTemperature();
pathfindr 34:4493c9f6d707 358 } else {
pathfindr 34:4493c9f6d707 359 temperature = si7060.getTemperature();
pathfindr 34:4493c9f6d707 360 }
pathfindr 27:fa76f5a08195 361 if (temperature > -40 && temperature < 60) {
pathfindr 27:fa76f5a08195 362 test_pass ++;
pathfindr 27:fa76f5a08195 363 } else {
pathfindr 27:fa76f5a08195 364 addToExceptionString("T.");
pathfindr 27:fa76f5a08195 365 }
pathfindr 22:810425eb76e1 366
pathfindr 22:810425eb76e1 367 //Result
pathfindr 22:810425eb76e1 368 if (test_count == test_pass) {
pathfindr 29:059fc7324328 369 addToExceptionString("OK.");
pathfindr 22:810425eb76e1 370 return true;
pathfindr 22:810425eb76e1 371 } else {
pathfindr 29:059fc7324328 372 addToExceptionString("FAIL.");
pathfindr 22:810425eb76e1 373 return false;
pathfindr 9:b0a1535b8ef2 374 }
pathfindr 9:b0a1535b8ef2 375 }
pathfindr 9:b0a1535b8ef2 376
pathfindr 9:b0a1535b8ef2 377 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 378 // MOTION FUNCS
pathfindr 9:b0a1535b8ef2 379 //------------------------------------------------------------------------------
pathfindr 9:b0a1535b8ef2 380 void checkMotion() {
pathfindr 9:b0a1535b8ef2 381 if (lis3dh_int2) {
pathfindr 29:059fc7324328 382 //if (GLOBAL_debugLED) LED1blink(1,50);
pathfindr 9:b0a1535b8ef2 383 RET_motionTriggered = true;
pathfindr 13:29f67f256709 384 GLOBAL_needToConfigureLis3dh = true; //interrupt has fire so need to clear it
pathfindr 9:b0a1535b8ef2 385 if (!RET_motionPendingOnState) {
pathfindr 9:b0a1535b8ef2 386 RET_motionPendingOnState = true;
pathfindr 9:b0a1535b8ef2 387 RET_motionPendingOffState = false;
pathfindr 9:b0a1535b8ef2 388 // Log start motion time
pathfindr 13:29f67f256709 389 RET_motionStartTime = RET_RTCunixtime;
pathfindr 9:b0a1535b8ef2 390 }
pathfindr 9:b0a1535b8ef2 391 } else {
pathfindr 9:b0a1535b8ef2 392 RET_motionTriggered = false;
pathfindr 9:b0a1535b8ef2 393 RET_motionPendingOnState = false;
pathfindr 9:b0a1535b8ef2 394 if (!RET_motionPendingOffState) {
pathfindr 9:b0a1535b8ef2 395 RET_motionPendingOffState = true;
pathfindr 9:b0a1535b8ef2 396 //log stop motion time
pathfindr 13:29f67f256709 397 RET_motionStopTime = RET_RTCunixtime;
pathfindr 9:b0a1535b8ef2 398 }
pathfindr 9:b0a1535b8ef2 399 }
pathfindr 9:b0a1535b8ef2 400 //calculate motion state
pathfindr 9:b0a1535b8ef2 401 if (RET_motionPendingOnState) {
pathfindr 9:b0a1535b8ef2 402 //check if above threshold
pathfindr 24:c161db07557f 403 time_t inMotionForSeconds = (RET_RTCunixtime - RET_motionStartTime) + 2; //Plus 2 to account for rounding and non exact clocks
pathfindr 24:c161db07557f 404 if (inMotionForSeconds >= RET_setting_motion_start_seconds && RET_motionState == false) {
pathfindr 9:b0a1535b8ef2 405 RET_motionState = true;
pathfindr 20:5404841fdd2b 406 RET_motionTriggeredInTXInterval = true;
pathfindr 29:059fc7324328 407 if (GLOBAL_debugLED) LED1blink(1,50);
pathfindr 24:c161db07557f 408 if (RET_setting_location_tx_failsafe_hrs > 0) {
pathfindr 24:c161db07557f 409 time_t epochOffsetMins = ((RET_RTCunixtime - RET_motionFrameStart) / 60);
pathfindr 24:c161db07557f 410 sprintf(RET_activityData+strlen(RET_activityData),"1.%u!",epochOffsetMins);
pathfindr 23:a3b0ccf75ca5 411 }
pathfindr 9:b0a1535b8ef2 412 }
pathfindr 9:b0a1535b8ef2 413 }
pathfindr 9:b0a1535b8ef2 414 if (RET_motionPendingOffState) {
pathfindr 24:c161db07557f 415 time_t noMotionForSeconds = (RET_RTCunixtime - RET_motionStopTime) + 2; //Plus 2 to account for rounding and non exact clocks
pathfindr 24:c161db07557f 416 if (noMotionForSeconds >= RET_setting_motion_stop_seconds && RET_motionState == true) {
pathfindr 24:c161db07557f 417 RET_motionPendingOffState = false;
pathfindr 9:b0a1535b8ef2 418 RET_motionState = false;
pathfindr 20:5404841fdd2b 419 GLOBAL_motionStopFlagTriggered = true;
pathfindr 9:b0a1535b8ef2 420 RET_motionTotalActivityHours += (float(RET_motionStopTime - RET_motionStartTime) / 3600.0);
pathfindr 29:059fc7324328 421 if (GLOBAL_debugLED) LED1blink(2,50);
pathfindr 24:c161db07557f 422 if (RET_setting_location_tx_failsafe_hrs > 0) {
pathfindr 24:c161db07557f 423 time_t epochOffsetMins = ((RET_RTCunixtime - RET_motionFrameStart) / 60);
pathfindr 24:c161db07557f 424 sprintf(RET_activityData+strlen(RET_activityData),"0.%u!",epochOffsetMins);
pathfindr 23:a3b0ccf75ca5 425 }
pathfindr 9:b0a1535b8ef2 426 }
pathfindr 9:b0a1535b8ef2 427 }
pathfindr 8:7351f8c4cd60 428 }
pathfindr 8:7351f8c4cd60 429
pathfindr 14:9a54b1b65bc8 430 //------------------------------------------------------------------------------
pathfindr 14:9a54b1b65bc8 431 // UPDATE OPERATING SETTINGS
pathfindr 14:9a54b1b65bc8 432 //------------------------------------------------------------------------------
pathfindr 14:9a54b1b65bc8 433 bool saveSettings(char* settingsBuffer) {
pathfindr 18:22edaa7e74b1 434 int matchCount = 0;
pathfindr 19:22261767c87a 435 int critical_fail_count = 0;
pathfindr 32:dff4858bdf37 436 int TEMP_a = -1; time_t TEMP_b = 0; int TEMP_c = -1; int TEMP_d = -1; int TEMP_e = -1; int TEMP_f = -1; int TEMP_g = -1; int TEMP_h = -1; int TEMP_i = -1; int TEMP_j = -1;
pathfindr 19:22261767c87a 437 int TEMP_k = -1; int TEMP_l = -1; int TEMP_m = -1; int TEMP_n = -1; int TEMP_o = -1; int TEMP_p = -1; int TEMP_q = -1; int TEMP_r = -1; int TEMP_s = -1;
pathfindr 32:dff4858bdf37 438 if ( (matchCount = sscanf(settingsBuffer,"a:%d,b:%u,c:%d,d:%d,e:%d,f:%d,g:%d,h:%d,i:%d,j:%d,k:%d,l:%d,m:%d,n:%d,o:%d,p:%d,q:%d,r:%d,s:%d",
pathfindr 32:dff4858bdf37 439 &TEMP_a,&TEMP_b,&TEMP_c,&TEMP_d,&TEMP_e,&TEMP_f,&TEMP_g,&TEMP_h,&TEMP_i,&TEMP_j,&TEMP_k,&TEMP_l,&TEMP_m,&TEMP_n,&TEMP_o,&TEMP_p,&TEMP_q,&TEMP_r,&TEMP_s) ) > 0 ) {
pathfindr 32:dff4858bdf37 440 DEBUG("FROMSERVER: a:%d,b:%u,c:%d,d:%d,e:%d,f:%d,g:%d,h:%d,i:%d,j:%d,k:%d,l:%d,m:%d,n:%d,o:%d,p:%d,q:%d,r:%d,s:%d\n",
pathfindr 32:dff4858bdf37 441 TEMP_a,TEMP_b,TEMP_c,TEMP_d,TEMP_e,TEMP_f,TEMP_g,TEMP_h,TEMP_i,TEMP_j,TEMP_k,TEMP_l,TEMP_m,TEMP_n,TEMP_o,TEMP_p,TEMP_q,TEMP_r,TEMP_s);
pathfindr 18:22edaa7e74b1 442
pathfindr 34:4493c9f6d707 443 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "FROMSERVER: a:%d,b:%u,c:%d,d:%d,e:%d,f:%d,g:%d,h:%d,i:%d,j:%d,k:%d,l:%d,m:%d,n:%d,o:%d,p:%d,q:%d,r:%d,s:%d\n",
pathfindr 34:4493c9f6d707 444 TEMP_a,TEMP_b,TEMP_c,TEMP_d,TEMP_e,TEMP_f,TEMP_g,TEMP_h,TEMP_i,TEMP_j,TEMP_k,TEMP_l,TEMP_m,TEMP_n,TEMP_o,TEMP_p,TEMP_q,TEMP_r,TEMP_s);debug_exe();}
pathfindr 34:4493c9f6d707 445
pathfindr 27:fa76f5a08195 446 //FAILUREMODE need to be checking these against checksums
pathfindr 18:22edaa7e74b1 447 char changed;
pathfindr 32:dff4858bdf37 448
pathfindr 32:dff4858bdf37 449 if(TEMP_a != -1) { RET_setting_minimumupdate_hrs = TEMP_a; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_minimumupdate_hrs:%u..%c\n",RET_setting_minimumupdate_hrs,changed);
pathfindr 34:4493c9f6d707 450 if(TEMP_b != 0) { RET_RTCunixtime = TEMP_b; changed = 'Y'; } else { changed = 'N'; critical_fail_count++; }; DEBUG("RET_RTCunixtime:%u..%c\n",RET_RTCunixtime,changed);
pathfindr 21:e0b866630c27 451 if(TEMP_c != -1) { RET_setting_firmware = TEMP_c; changed = 'Y'; } else { changed = 'N'; RET_setting_firmware = -1;}; DEBUG("RET_setting_firmware:%d..%c\n",RET_setting_firmware,changed);
pathfindr 19:22261767c87a 452 if(TEMP_d != -1) { setState(TEMP_d); changed = 'Y'; } else { changed = 'N'; critical_fail_count++; }; DEBUG("RET_state:%d..%c\n",RET_state,changed);
pathfindr 22:810425eb76e1 453 if(TEMP_e != -1) { RET_setting_location_mode = TEMP_e; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_location_mode:%d..%c\n",RET_setting_location_mode,changed);
pathfindr 34:4493c9f6d707 454 if(RET_setting_location_mode > 3) {RET_setting_location_mode = DEFAULT_LOCATION_MODE;}
pathfindr 19:22261767c87a 455 if(TEMP_f != -1) { RET_setting_location_accuracy = TEMP_f; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_location_accuracy:%d..%c\n",RET_setting_location_accuracy,changed);
pathfindr 34:4493c9f6d707 456 if(RET_setting_location_accuracy > 3) {RET_setting_location_accuracy = DEFAULT_LOCATION_ACCURACY;}
pathfindr 19:22261767c87a 457 if(TEMP_g != -1) { RET_setting_location_tx_interval_mins = TEMP_g; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_location_tx_interval_mins:%d..%c\n",RET_setting_location_tx_interval_mins,changed);
pathfindr 21:e0b866630c27 458 if(TEMP_h != -1) { RET_setting_location_tx_failsafe_hrs = TEMP_h; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_location_tx_failsafe_hrs:%d..%c\n",RET_setting_location_tx_failsafe_hrs,changed);
pathfindr 34:4493c9f6d707 459 if(RET_setting_location_tx_failsafe_hrs > 504) {RET_setting_location_tx_failsafe_hrs = DEFAULT_LOCATION_TX_FAILSAFE_HRS;}
pathfindr 21:e0b866630c27 460 if(TEMP_i != -1) { RET_setting_location_timeout = TEMP_i; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_location_timeout:%d..%c\n",RET_setting_location_timeout,changed);
pathfindr 27:fa76f5a08195 461 if(RET_setting_location_timeout < 60 || RET_setting_location_timeout > 300) {RET_setting_location_timeout = DEFAULT_LOCATION_TIMEOUT;}
pathfindr 22:810425eb76e1 462 if(TEMP_j != -1) { RET_setting_activity_tx_interval_hrs = TEMP_j; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_activity_tx_interval_hrs:%d..%c\n",RET_setting_activity_tx_interval_hrs,changed);
pathfindr 21:e0b866630c27 463 if(TEMP_k != -1) { RET_setting_environmental_tx_interval_mins = TEMP_k; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_environmental_tx_interval_mins:%d..%c\n",RET_setting_environmental_tx_interval_mins,changed);
pathfindr 21:e0b866630c27 464 if(TEMP_l != -1) { RET_setting_motion_g = TEMP_l; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_motion_g:%d..%c\n",RET_setting_motion_g,changed);
pathfindr 27:fa76f5a08195 465 if(RET_setting_motion_g < 6 || RET_setting_motion_g > 127) {RET_setting_motion_g = DEFAULT_MOTION_G;}
pathfindr 21:e0b866630c27 466 if(TEMP_m != -1) { RET_setting_motion_start_seconds = TEMP_m; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_motion_start_seconds:%d..%c\n",RET_setting_motion_start_seconds,changed);
pathfindr 21:e0b866630c27 467 if(TEMP_n != -1) { RET_setting_motion_stop_seconds = TEMP_n; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_motion_stop_seconds:%d..%c\n",RET_setting_motion_stop_seconds,changed);
pathfindr 21:e0b866630c27 468 if(TEMP_o != -1) { RET_setting_impact_g = TEMP_o; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_impact_g:%d..%c\n",RET_setting_impact_g,changed);
pathfindr 21:e0b866630c27 469 if(TEMP_p != -1) { RET_setting_impact_alert = TEMP_p; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_impact_alert:%d..%c\n",RET_setting_impact_alert,changed);
pathfindr 21:e0b866630c27 470 if(TEMP_q != -1) { RET_setting_connection_timeout = TEMP_q; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_connection_timeout:%d..%c\n",RET_setting_connection_timeout,changed);
pathfindr 27:fa76f5a08195 471 if(RET_setting_connection_timeout < 60 || RET_setting_connection_timeout > 240) { RET_setting_connection_timeout = DEFAULT_CONNECTION_TIMEOUT; }
pathfindr 21:e0b866630c27 472 if(TEMP_r != -1) { RET_setting_beacon_interval_seconds = TEMP_r; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_beacon_interval_seconds:%d..%c\n",RET_setting_beacon_interval_seconds,changed);
pathfindr 21:e0b866630c27 473 if(TEMP_s != -1) { RET_setting_beacon_scan = TEMP_s; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_beacon_scan:%d..%c\n",RET_setting_beacon_scan,changed);
pathfindr 18:22edaa7e74b1 474
pathfindr 19:22261767c87a 475 if (critical_fail_count == 0) {
pathfindr 34:4493c9f6d707 476 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "GOT SETTINGS OK");debug_exe();}
pathfindr 34:4493c9f6d707 477 DEBUG("GOT SETTINGS OK",false);
pathfindr 34:4493c9f6d707 478 dumpSettings();
pathfindr 20:5404841fdd2b 479 saveEventTimes();
pathfindr 32:dff4858bdf37 480 RET_haveSettings = true;
pathfindr 34:4493c9f6d707 481 GLOBAL_needToConfigureLis3dh = true;
pathfindr 32:dff4858bdf37 482 RET_SettingsGotAt = RET_RTCunixtime;
pathfindr 19:22261767c87a 483 return true;
pathfindr 19:22261767c87a 484 } else {
pathfindr 34:4493c9f6d707 485 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "CRITICAL FAILS:%d",critical_fail_count);debug_exe();}
pathfindr 34:4493c9f6d707 486 DEBUG("CRITICAL FAILS:%d",critical_fail_count);
pathfindr 34:4493c9f6d707 487 dumpSettings();
pathfindr 19:22261767c87a 488 RET_haveSettings = false;
pathfindr 19:22261767c87a 489 return false;
pathfindr 19:22261767c87a 490 }
pathfindr 14:9a54b1b65bc8 491 } else {
pathfindr 15:7aad9a7f970c 492 RET_haveSettings = false;
pathfindr 15:7aad9a7f970c 493 return false;
pathfindr 14:9a54b1b65bc8 494 }
pathfindr 14:9a54b1b65bc8 495 }
pathfindr 24:c161db07557f 496
pathfindr 20:5404841fdd2b 497 void saveEventTimes() {
pathfindr 20:5404841fdd2b 498 //SET EVENT TIMES
pathfindr 20:5404841fdd2b 499 if(RET_setting_location_tx_interval_mins > 0) {
pathfindr 20:5404841fdd2b 500 RET_eventTime_location_tx = (RET_RTCunixtime + (RET_setting_location_tx_interval_mins * 60));
pathfindr 34:4493c9f6d707 501 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVENTSET - LOCATION TX at %u, MODE %d\n",RET_eventTime_location_tx, RET_setting_location_mode);debug_exe();}
pathfindr 20:5404841fdd2b 502 DEBUG("EVENTSET - LOCATION TX at %u, MODE %d\n",RET_eventTime_location_tx, RET_setting_location_mode);
pathfindr 20:5404841fdd2b 503 }
pathfindr 20:5404841fdd2b 504 if(RET_setting_location_tx_failsafe_hrs > 0) {
pathfindr 20:5404841fdd2b 505 RET_eventTime_location_failsafe_tx = (RET_RTCunixtime + (RET_setting_location_tx_failsafe_hrs * 3600));
pathfindr 34:4493c9f6d707 506 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVENTSET - LOCATION FAILSAFE TX at %u\n",RET_eventTime_location_failsafe_tx);debug_exe();}
pathfindr 20:5404841fdd2b 507 DEBUG("EVENTSET - LOCATION FAILSAFE TX at %u\n",RET_eventTime_location_failsafe_tx);
pathfindr 20:5404841fdd2b 508 }
pathfindr 22:810425eb76e1 509 if(RET_setting_activity_tx_interval_hrs > 0) {
pathfindr 24:c161db07557f 510 RET_motionFrameStart = RET_RTCunixtime; //SET START FRAME INITAL
pathfindr 22:810425eb76e1 511 RET_eventTime_activity_tx = (RET_RTCunixtime + (RET_setting_activity_tx_interval_hrs * 3600));
pathfindr 34:4493c9f6d707 512 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVENTSET - ACTIVITY TX at %u\n",RET_eventTime_activity_tx);debug_exe();}
pathfindr 20:5404841fdd2b 513 DEBUG("EVENTSET - ACTIVITY TX at %u\n",RET_eventTime_activity_tx);
pathfindr 20:5404841fdd2b 514 }
pathfindr 20:5404841fdd2b 515 if(RET_eventTime_environmental_tx > 0) {
pathfindr 20:5404841fdd2b 516 RET_eventTime_environmental_tx = (RET_RTCunixtime + (RET_setting_environmental_tx_interval_mins * 60));
pathfindr 34:4493c9f6d707 517 if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVENTSET - ENVIRONMENTAL TX at %u\n",RET_eventTime_environmental_tx);debug_exe();}
pathfindr 20:5404841fdd2b 518 DEBUG("EVENTSET - ENVIRONMENTAL TX at %u\n",RET_eventTime_environmental_tx);
pathfindr 34:4493c9f6d707 519 }
pathfindr 20:5404841fdd2b 520 }
pathfindr 13:29f67f256709 521
pathfindr 13:29f67f256709 522 //------------------------------------------------------------------------------
pathfindr 13:29f67f256709 523 // SETUP
pathfindr 13:29f67f256709 524 //------------------------------------------------------------------------------
pathfindr 13:29f67f256709 525 bool setup() {
pathfindr 13:29f67f256709 526 bool pass = true;
pathfindr 34:4493c9f6d707 527 float temperature = getTemperature();
pathfindr 25:7adeb1a53360 528 float voltage = getBatteryV();
pathfindr 25:7adeb1a53360 529 bool selftestresult = selfTest();
pathfindr 33:760005331b4c 530 if (selftestresult == false) { LED1errorCode(4,20); } //ERROR 4
pathfindr 13:29f67f256709 531 if (modem.on()) {
pathfindr 25:7adeb1a53360 532 //RET_imei = modem.getIMEI();
pathfindr 25:7adeb1a53360 533 //DEBUG("imei: %lld \n",RET_imei);
pathfindr 23:a3b0ccf75ca5 534 //char* modemModel = modem.getModemModel();
pathfindr 28:24b02608fa5f 535 char locString[70];
pathfindr 28:24b02608fa5f 536 memcpy(locString, modem.getLocation(1, RET_setting_location_timeout), 70);
pathfindr 28:24b02608fa5f 537 if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,(RET_setting_connection_timeout*1000))) {
pathfindr 33:760005331b4c 538 int timetaken = (RET_RTCunixtime - GLOBAL_wakeTime) + 10; //add 10 for ussd response time.
pathfindr 17:ba55c026b1d6 539 char bytestosend[160];
pathfindr 32:dff4858bdf37 540 snprintf(bytestosend,sizeof(bytestosend),"(%s,a:setup,f:%d,v:%.2f,t:%.1f,e:%d,z:SETUP-%s,c:1,s:1%s)\0",GLOBAL_defaultApi,FW_VERSION,voltage,temperature,timetaken,GLOBAL_exceptionString,locString);
pathfindr 34:4493c9f6d707 541 char result[200];
pathfindr 17:ba55c026b1d6 542 snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytestosend, true, 2, GLOBAL_defaultApi));
pathfindr 34:4493c9f6d707 543 if (strcmp(result, "err") != 0) {
pathfindr 29:059fc7324328 544 //DEBUG("\nfromserver: %s \n",result);
pathfindr 34:4493c9f6d707 545 if (!saveSettings(result)) {
pathfindr 19:22261767c87a 546 //something went critically wrong getting settings
pathfindr 19:22261767c87a 547 pass = false;
pathfindr 34:4493c9f6d707 548 modem.off(false);
pathfindr 34:4493c9f6d707 549 if(GLOBAL_debugLED) LED1errorCode(5,10); //ERROR 5
pathfindr 36:8e359069192b 550 }
pathfindr 34:4493c9f6d707 551 } else {
pathfindr 34:4493c9f6d707 552 //Response error
pathfindr 16:3bf5f1a5f869 553 }
pathfindr 13:29f67f256709 554 } else {
pathfindr 16:3bf5f1a5f869 555 //FAILUREMODE modem failed to register on network
pathfindr 34:4493c9f6d707 556 DEBUG("NET REGISTER FAIL",false);
pathfindr 34:4493c9f6d707 557 modem.off(false);
pathfindr 34:4493c9f6d707 558 if(GLOBAL_debugLED) LED1errorCode(3,10); //ERROR 3
pathfindr 19:22261767c87a 559 pass = false;
pathfindr 13:29f67f256709 560 }
pathfindr 13:29f67f256709 561 } else {
pathfindr 19:22261767c87a 562 //FAILUREMODE Modem failed to turn on
pathfindr 34:4493c9f6d707 563 DEBUG("MODEM ON FAIL",false);
pathfindr 34:4493c9f6d707 564 modem.off(false);
pathfindr 34:4493c9f6d707 565 if(GLOBAL_debugLED) LED1errorCode(2,10); //ERROR 2
pathfindr 13:29f67f256709 566 pass = false;
pathfindr 13:29f67f256709 567 }
pathfindr 34:4493c9f6d707 568 modem.off(false);
pathfindr 13:29f67f256709 569
pathfindr 21:e0b866630c27 570 //LOG RUN TIME - THIS MUST GO AT END AFTER WE HAVE GOT SERVER TIMESTAMP
pathfindr 21:e0b866630c27 571 RET_SetupRunAt = RET_RTCunixtime;
pathfindr 21:e0b866630c27 572
pathfindr 13:29f67f256709 573 //RESULT
pathfindr 19:22261767c87a 574 return pass;
pathfindr 13:29f67f256709 575 }
pathfindr 13:29f67f256709 576
pathfindr 19:22261767c87a 577 //------------------------------------------------------------------------------
pathfindr 19:22261767c87a 578 // EVENTS
pathfindr 19:22261767c87a 579 //------------------------------------------------------------------------------
pathfindr 28:24b02608fa5f 580 void event_connectiontest_tx(int location_accuracy) {
pathfindr 34:4493c9f6d707 581 DEBUG("TEST EVENT\n",false);
pathfindr 22:810425eb76e1 582 float temperature = getTemperature();
pathfindr 34:4493c9f6d707 583 float voltage = getBatteryV();
pathfindr 27:fa76f5a08195 584 int selftestresult = selfTest();
pathfindr 20:5404841fdd2b 585 if (modem.on()) {
pathfindr 28:24b02608fa5f 586 char locString[70];
pathfindr 28:24b02608fa5f 587 memcpy(locString, modem.getLocation(location_accuracy, RET_setting_location_timeout), 70);
pathfindr 28:24b02608fa5f 588 if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,(RET_setting_connection_timeout*1000))) {
pathfindr 33:760005331b4c 589 int timetaken = (RET_RTCunixtime - GLOBAL_wakeTime) + 10; //add 10 for ussd response time.;
pathfindr 22:810425eb76e1 590 char bytestosend[160];
pathfindr 32:dff4858bdf37 591 snprintf(bytestosend,sizeof(bytestosend),"(%s,a:loc,f:%d,t:%.1f,v:%.2f,z:TEST-%s,e:%d,c:1,s:1%s)\0",GLOBAL_defaultApi,FW_VERSION,temperature,voltage,GLOBAL_exceptionString,timetaken,locString);
pathfindr 22:810425eb76e1 592 char result[180];
pathfindr 22:810425eb76e1 593 bool getSettings = true;
pathfindr 22:810425eb76e1 594 snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytestosend, getSettings, 2, GLOBAL_defaultApi));
pathfindr 22:810425eb76e1 595 if (result != "err") {
pathfindr 28:24b02608fa5f 596 //DEBUG("\nfromserver: %s \n",result);
pathfindr 22:810425eb76e1 597 if (getSettings) {
pathfindr 22:810425eb76e1 598 saveSettings(result);
pathfindr 34:4493c9f6d707 599 if(GLOBAL_debugLED) LED1blink(5,250);
pathfindr 22:810425eb76e1 600 }
pathfindr 22:810425eb76e1 601 }
pathfindr 33:760005331b4c 602 } else {
pathfindr 34:4493c9f6d707 603 modem.off(false);
pathfindr 34:4493c9f6d707 604 if(GLOBAL_debugLED) LED1errorCode(3,20); //ERROR 3
pathfindr 22:810425eb76e1 605 }
pathfindr 31:c84fc6d8eaa3 606 } else {
pathfindr 34:4493c9f6d707 607 modem.off(false);
pathfindr 34:4493c9f6d707 608 if(GLOBAL_debugLED) LED1errorCode(2,20); //ERROR 2
pathfindr 22:810425eb76e1 609 }
pathfindr 34:4493c9f6d707 610 modem.off(false);
pathfindr 22:810425eb76e1 611 //RESETS
pathfindr 22:810425eb76e1 612 RET_motionTriggeredInTXInterval = 0;
pathfindr 22:810425eb76e1 613 saveEventTimes();
pathfindr 22:810425eb76e1 614 }
pathfindr 22:810425eb76e1 615
pathfindr 22:810425eb76e1 616 void event_location_tx() {
pathfindr 34:4493c9f6d707 617 DEBUG("LOCATION TX\n",false);
pathfindr 22:810425eb76e1 618 float temperature = getTemperature();
pathfindr 34:4493c9f6d707 619 float voltage = getBatteryV();
pathfindr 27:fa76f5a08195 620 int selfTestResult = selfTest();
pathfindr 22:810425eb76e1 621 if (modem.on()) {
pathfindr 23:a3b0ccf75ca5 622 char locString[70];
pathfindr 31:c84fc6d8eaa3 623 memcpy(locString, modem.getLocation(RET_setting_location_accuracy, RET_setting_location_timeout), 70);
pathfindr 31:c84fc6d8eaa3 624 //DEBUG("locString:%s-\n",locString);
pathfindr 22:810425eb76e1 625 //SEND DATA
pathfindr 28:24b02608fa5f 626 if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,(RET_setting_connection_timeout*1000))) {
pathfindr 33:760005331b4c 627 int timetaken = (RET_RTCunixtime - GLOBAL_wakeTime) + 10; //add 10 for ussd response time
pathfindr 32:dff4858bdf37 628
pathfindr 32:dff4858bdf37 629 //Check if we should wait for settings back
pathfindr 32:dff4858bdf37 630 bool getSettings = true;
pathfindr 33:760005331b4c 631 if ( ((RET_RTCunixtime - RET_SettingsGotAt)/3600) < RET_setting_minimumupdate_hrs ) { getSettings = false; timetaken -= 10;} //remove the extra 10 seconds from times
pathfindr 32:dff4858bdf37 632
pathfindr 23:a3b0ccf75ca5 633 char bytesToSend[160];
pathfindr 32:dff4858bdf37 634 snprintf(bytesToSend,sizeof(bytesToSend),"(%s,a:loc,f:%d,t:%.1f,v:%.2f,z:LOC-%s,e:%d,c:1,s:%d%s)\0",GLOBAL_defaultApi,FW_VERSION,temperature,voltage,GLOBAL_exceptionString,timetaken,getSettings,locString);
pathfindr 22:810425eb76e1 635 char result[180];
pathfindr 23:a3b0ccf75ca5 636 snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytesToSend, getSettings, 2, GLOBAL_defaultApi));
pathfindr 22:810425eb76e1 637 if (result != "err") {
pathfindr 23:a3b0ccf75ca5 638 //DEBUG("\nfromserver: %s \n",result);
pathfindr 22:810425eb76e1 639 if (getSettings) {
pathfindr 22:810425eb76e1 640 saveSettings(result);
pathfindr 22:810425eb76e1 641 }
pathfindr 22:810425eb76e1 642 }
pathfindr 33:760005331b4c 643 } else {
pathfindr 34:4493c9f6d707 644 modem.off(false);
pathfindr 34:4493c9f6d707 645 if(GLOBAL_debugLED) LED1errorCode(3,20); //ERROR 3
pathfindr 22:810425eb76e1 646 }
pathfindr 31:c84fc6d8eaa3 647 } else {
pathfindr 34:4493c9f6d707 648 modem.off(false);
pathfindr 34:4493c9f6d707 649 if(GLOBAL_debugLED) LED1errorCode(2,20); //ERROR 2
pathfindr 20:5404841fdd2b 650 }
pathfindr 34:4493c9f6d707 651 modem.off(false);
pathfindr 20:5404841fdd2b 652 //RESETS
pathfindr 20:5404841fdd2b 653 RET_motionTriggeredInTXInterval = 0;
pathfindr 20:5404841fdd2b 654 saveEventTimes();
pathfindr 19:22261767c87a 655 }
pathfindr 24:c161db07557f 656
pathfindr 24:c161db07557f 657 void event_activity_tx() {
pathfindr 34:4493c9f6d707 658 DEBUG("ACTIVITY TX\n",false);
pathfindr 24:c161db07557f 659 float temperature = getTemperature();
pathfindr 24:c161db07557f 660 if (modem.on()) {
pathfindr 24:c161db07557f 661 //SEND DATA
pathfindr 28:24b02608fa5f 662 if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,(RET_setting_connection_timeout*1000))) {
pathfindr 24:c161db07557f 663 char bytesToSend[160];
pathfindr 24:c161db07557f 664 snprintf(bytesToSend,sizeof(bytesToSend),"(%s,a:act,e:%s,t:%u,r:%.2f,c:1)\0",GLOBAL_defaultApi,RET_activityData,RET_motionFrameStart,RET_motionTotalActivityHours);
pathfindr 24:c161db07557f 665 char result[180];
pathfindr 24:c161db07557f 666 bool getResponse = false;
pathfindr 24:c161db07557f 667 snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytesToSend, getResponse, 2, GLOBAL_defaultApi));
pathfindr 24:c161db07557f 668 if (result != "err") {
pathfindr 24:c161db07557f 669 //RESET ACTIVITY FRAME
pathfindr 24:c161db07557f 670 memset(RET_activityData,0,sizeof(RET_activityData));
pathfindr 29:059fc7324328 671 if (RET_haveSettings) { RET_motionFrameStart = RET_RTCunixtime; }
pathfindr 24:c161db07557f 672 }
pathfindr 33:760005331b4c 673 } else {
pathfindr 34:4493c9f6d707 674 modem.off(false);
pathfindr 34:4493c9f6d707 675 if(GLOBAL_debugLED) LED1errorCode(3,20); //ERROR 3
pathfindr 24:c161db07557f 676 }
pathfindr 31:c84fc6d8eaa3 677 } else {
pathfindr 34:4493c9f6d707 678 modem.off(false);
pathfindr 34:4493c9f6d707 679 if(GLOBAL_debugLED) LED1errorCode(2,20); //ERROR 3
pathfindr 24:c161db07557f 680 }
pathfindr 34:4493c9f6d707 681 modem.off(false);
pathfindr 24:c161db07557f 682 //RESETS
pathfindr 24:c161db07557f 683 RET_motionTriggeredInTXInterval = 0;
pathfindr 24:c161db07557f 684 saveEventTimes();
pathfindr 24:c161db07557f 685 }
pathfindr 24:c161db07557f 686
pathfindr 7:e9a19750700d 687 //------------------------------------------------------------------------------
pathfindr 7:e9a19750700d 688 // STATE ENGINE
pathfindr 7:e9a19750700d 689 //------------------------------------------------------------------------------
pathfindr 6:388d3c7efdd9 690 void mainStateEngine() {
pathfindr 34:4493c9f6d707 691
pathfindr 16:3bf5f1a5f869 692 switch(RET_state) {
pathfindr 16:3bf5f1a5f869 693 case STATE_SETUP :
pathfindr 34:4493c9f6d707 694 { //need the curlies to avoid "transfer of control bypass init error warning"
pathfindr 34:4493c9f6d707 695 DEBUG("STATE:SETUP\n",false);
pathfindr 13:29f67f256709 696 if (setup()) {
pathfindr 25:7adeb1a53360 697 // All good
pathfindr 19:22261767c87a 698 } else {
pathfindr 22:810425eb76e1 699 RET_eventTime_wakeFromDormant = (RET_RTCunixtime + (24*3600)); //24hrs
pathfindr 19:22261767c87a 700 setState(STATE_DORMANT);
pathfindr 31:c84fc6d8eaa3 701 DEBUG("SETUP FAILED:DORMANT until %u\n",RET_eventTime_wakeFromDormant);
pathfindr 13:29f67f256709 702 }
pathfindr 6:388d3c7efdd9 703 break;
pathfindr 34:4493c9f6d707 704 }
pathfindr 16:3bf5f1a5f869 705 case STATE_NORMAL :
pathfindr 34:4493c9f6d707 706 {
pathfindr 34:4493c9f6d707 707 DEBUG("STATE:NORMAL\n",false);
pathfindr 34:4493c9f6d707 708
pathfindr 7:e9a19750700d 709 //check and log motion
pathfindr 9:b0a1535b8ef2 710 checkMotion();
pathfindr 9:b0a1535b8ef2 711
pathfindr 24:c161db07557f 712 //LOCATION EVENT
pathfindr 19:22261767c87a 713 bool run_location_tx = false;
pathfindr 27:fa76f5a08195 714 switch (RET_setting_location_mode) {
pathfindr 27:fa76f5a08195 715 case 1: //INTERVAL POST
pathfindr 27:fa76f5a08195 716 if(RET_RTCunixtime >= RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { run_location_tx = true; }
pathfindr 27:fa76f5a08195 717 break;
pathfindr 27:fa76f5a08195 718 case 2: //INTERVAL POST WITH MOTION CHECK
pathfindr 27:fa76f5a08195 719 if(RET_motionTriggeredInTXInterval && RET_RTCunixtime >= RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { run_location_tx = true; }
pathfindr 27:fa76f5a08195 720 break;
pathfindr 27:fa76f5a08195 721 case 3: //POST ON STOP MOTION
pathfindr 27:fa76f5a08195 722 if (GLOBAL_motionStopFlagTriggered) { run_location_tx = true; GLOBAL_motionStopFlagTriggered = false; }
pathfindr 27:fa76f5a08195 723 break;
pathfindr 27:fa76f5a08195 724 }
pathfindr 22:810425eb76e1 725 if(RET_RTCunixtime >= RET_eventTime_location_failsafe_tx && RET_eventTime_location_failsafe_tx > 0) { run_location_tx = true; }
pathfindr 34:4493c9f6d707 726 if (run_location_tx) { DEBUG("INTERVAL LOC TX...\n",false); event_location_tx(); }
pathfindr 19:22261767c87a 727
pathfindr 27:fa76f5a08195 728 //if(RET_RTCunixtime >= RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { run_location_tx = true; }
pathfindr 27:fa76f5a08195 729 //Location Failsafe timer catchall
pathfindr 27:fa76f5a08195 730 //if(RET_RTCunixtime >= RET_eventTime_location_failsafe_tx && RET_eventTime_location_failsafe_tx > 0) { run_location_tx = true; }
pathfindr 27:fa76f5a08195 731 //if (run_location_tx) { DEBUG("INTERVAL LOC TX...\n"); event_location_tx(); }
pathfindr 27:fa76f5a08195 732
pathfindr 24:c161db07557f 733 //ACTIVITY EVENT
pathfindr 24:c161db07557f 734 bool run_activity_tx = false;
pathfindr 25:7adeb1a53360 735 if(RET_RTCunixtime >= RET_eventTime_activity_tx && RET_eventTime_activity_tx > 0 && strlen(RET_activityData) > 1) {
pathfindr 29:059fc7324328 736 run_activity_tx = true;
pathfindr 9:b0a1535b8ef2 737 }
pathfindr 24:c161db07557f 738 if (strlen(RET_activityData) > 130) { run_activity_tx = true; }
pathfindr 34:4493c9f6d707 739 if (run_activity_tx) { DEBUG("ACTIVITY TX...\n",false); event_activity_tx();}
pathfindr 34:4493c9f6d707 740
pathfindr 9:b0a1535b8ef2 741 break;
pathfindr 34:4493c9f6d707 742 }
pathfindr 16:3bf5f1a5f869 743 case STATE_DORMANT :
pathfindr 34:4493c9f6d707 744 {
pathfindr 22:810425eb76e1 745 if (RET_RTCunixtime >= RET_eventTime_wakeFromDormant) {
pathfindr 22:810425eb76e1 746 if (RET_haveSettings) {
pathfindr 22:810425eb76e1 747 setState(STATE_NORMAL);
pathfindr 22:810425eb76e1 748 } else {
pathfindr 22:810425eb76e1 749 setState(STATE_SETUP);
pathfindr 22:810425eb76e1 750 }
pathfindr 34:4493c9f6d707 751 DEBUG("WAKING UP FROM DORMANT\n",false);
pathfindr 7:e9a19750700d 752 }
pathfindr 19:22261767c87a 753 DEBUG("STATE:DORMANT until %u\n",RET_eventTime_wakeFromDormant);
pathfindr 12:8345612bf867 754 break;
pathfindr 34:4493c9f6d707 755 }
pathfindr 16:3bf5f1a5f869 756 case STATE_BUTTONPRESS1 :
pathfindr 34:4493c9f6d707 757 {
pathfindr 19:22261767c87a 758 setState(STATE_NORMAL);
pathfindr 34:4493c9f6d707 759 DEBUG("STATE:BUTTONPRESS1\n",false);
pathfindr 12:8345612bf867 760 LED1blink(1,300);
pathfindr 34:4493c9f6d707 761 break;
pathfindr 34:4493c9f6d707 762 }
pathfindr 16:3bf5f1a5f869 763 case STATE_BUTTONPRESS2 :
pathfindr 34:4493c9f6d707 764 {
pathfindr 19:22261767c87a 765 setState(STATE_NORMAL);
pathfindr 34:4493c9f6d707 766 DEBUG("STATE:BUTTONPRESS2\n",false);
pathfindr 19:22261767c87a 767 LED1blink(2,300);
pathfindr 27:fa76f5a08195 768 LED1on(0);
pathfindr 28:24b02608fa5f 769 event_connectiontest_tx(1);
pathfindr 28:24b02608fa5f 770 LED1off();
pathfindr 28:24b02608fa5f 771 break;
pathfindr 34:4493c9f6d707 772 }
pathfindr 28:24b02608fa5f 773 case STATE_BUTTONPRESS3 :
pathfindr 34:4493c9f6d707 774 {
pathfindr 28:24b02608fa5f 775 setState(STATE_NORMAL);
pathfindr 34:4493c9f6d707 776 DEBUG("STATE:BUTTONPRESS3\n",false);
pathfindr 28:24b02608fa5f 777 LED1blink(3,300);
pathfindr 28:24b02608fa5f 778 LED1on(0);
pathfindr 28:24b02608fa5f 779 event_connectiontest_tx(2);
pathfindr 27:fa76f5a08195 780 LED1off();
pathfindr 9:b0a1535b8ef2 781 break;
pathfindr 34:4493c9f6d707 782 }
pathfindr 16:3bf5f1a5f869 783 case STATE_BUTTONHOLD :
pathfindr 34:4493c9f6d707 784 {
pathfindr 34:4493c9f6d707 785 DEBUG("STATE:BUTTONHOLD\n",false);
pathfindr 19:22261767c87a 786 if (RET_state_prev == STATE_NORMAL) {
pathfindr 19:22261767c87a 787 setState(STATE_DORMANT);
pathfindr 19:22261767c87a 788 RET_eventTime_wakeFromDormant = (RET_RTCunixtime + (48*3600)); //48hrs
pathfindr 34:4493c9f6d707 789 DEBUG("TURNING OFF\n",false);
pathfindr 19:22261767c87a 790 DEBUG("STATE:DORMANT until %u\n",RET_eventTime_wakeFromDormant);
pathfindr 19:22261767c87a 791 LED1on(5000);
pathfindr 19:22261767c87a 792 } else {
pathfindr 19:22261767c87a 793 if (RET_haveSettings) {
pathfindr 19:22261767c87a 794 setState(STATE_NORMAL);
pathfindr 19:22261767c87a 795 } else {
pathfindr 19:22261767c87a 796 setState(STATE_SETUP);
pathfindr 19:22261767c87a 797 }
pathfindr 34:4493c9f6d707 798 DEBUG("TURNING ON\n",false);
pathfindr 19:22261767c87a 799 LED1blink(20,100);
pathfindr 19:22261767c87a 800 }
pathfindr 6:388d3c7efdd9 801 break;
pathfindr 34:4493c9f6d707 802 }
pathfindr 6:388d3c7efdd9 803 default :
pathfindr 34:4493c9f6d707 804 {
pathfindr 19:22261767c87a 805 setState(STATE_SETUP);
pathfindr 34:4493c9f6d707 806 DEBUG("DEFAULT STATE\n",false);
pathfindr 34:4493c9f6d707 807 }
pathfindr 6:388d3c7efdd9 808 }
pathfindr 6:388d3c7efdd9 809 }
pathfindr 6:388d3c7efdd9 810
pathfindr 7:e9a19750700d 811 //------------------------------------------------------------------------------
pathfindr 7:e9a19750700d 812 // MAIN
pathfindr 7:e9a19750700d 813 //------------------------------------------------------------------------------
pathfindr 0:94b743e06998 814 int main() {
pathfindr 34:4493c9f6d707 815 LED1on(500);
pathfindr 34:4493c9f6d707 816
pathfindr 24:c161db07557f 817 //INIT
pathfindr 34:4493c9f6d707 818 LED1off();
pathfindr 24:c161db07557f 819 RTCticker.attach(&RTCtick, 1.0);
pathfindr 34:4493c9f6d707 820 button.fall(&buttonPress);
pathfindr 24:c161db07557f 821 button.rise(&buttonRelease);
pathfindr 34:4493c9f6d707 822
pathfindr 34:4493c9f6d707 823 dumpSettings();
pathfindr 4:8d8e9bfa82e4 824
pathfindr 4:8d8e9bfa82e4 825 //CHECK IF THIS IS RESET
pathfindr 4:8d8e9bfa82e4 826 //0x00000004 == soft reset //0x00000002 == watchdog //0x00000001 == button/hardreset
pathfindr 4:8d8e9bfa82e4 827 if (NRF_POWER->RESETREAS != 0xffffffff) {
pathfindr 4:8d8e9bfa82e4 828 switch(NRF_POWER->RESETREAS) {
pathfindr 4:8d8e9bfa82e4 829 case 0x00000001 :
pathfindr 29:059fc7324328 830 DEBUG("0x%08x. Hard Reset ST:%d\n",NRF_POWER->RESETREAS, RET_state);
pathfindr 13:29f67f256709 831 RET_coldBoot = 1;
pathfindr 31:c84fc6d8eaa3 832 dumpSettings();
pathfindr 4:8d8e9bfa82e4 833 break;
pathfindr 4:8d8e9bfa82e4 834 case 0x00000002 :
pathfindr 29:059fc7324328 835 DEBUG("Watchdog ST:%d\n",RET_state);
pathfindr 4:8d8e9bfa82e4 836 break;
pathfindr 4:8d8e9bfa82e4 837 case 0x00000004 :
pathfindr 34:4493c9f6d707 838 DEBUG("Soft ST:%d\n",RET_state);
pathfindr 4:8d8e9bfa82e4 839 break;
pathfindr 4:8d8e9bfa82e4 840 }
pathfindr 36:8e359069192b 841 NRF_POWER->RESETREAS = 0xffffffff;
pathfindr 4:8d8e9bfa82e4 842 }
pathfindr 24:c161db07557f 843
pathfindr 9:b0a1535b8ef2 844 //CHECK FOR FIRST BOOT
pathfindr 34:4493c9f6d707 845 if (RET_coldBoot == 1) {
pathfindr 36:8e359069192b 846 setDefaults();
pathfindr 36:8e359069192b 847 //check battery
pathfindr 36:8e359069192b 848 float voltage = getBatteryV();
pathfindr 36:8e359069192b 849 if (voltage > 2.5) {
pathfindr 36:8e359069192b 850 //battery ok
pathfindr 36:8e359069192b 851 LED1errorCode(6,2);
pathfindr 36:8e359069192b 852 } else {
pathfindr 36:8e359069192b 853 //battery low
pathfindr 36:8e359069192b 854 LED1errorCode(10,2);
pathfindr 36:8e359069192b 855 }
pathfindr 36:8e359069192b 856 mainthread.wait(2000);
pathfindr 24:c161db07557f 857 }
pathfindr 13:29f67f256709 858
pathfindr 34:4493c9f6d707 859 //MAIN LOOP
pathfindr 34:4493c9f6d707 860 while(true) {
pathfindr 34:4493c9f6d707 861 //WATCHDOG
pathfindr 34:4493c9f6d707 862 watchdogKick(); //only need this if we're in while loop
pathfindr 34:4493c9f6d707 863
pathfindr 34:4493c9f6d707 864 //INIT
pathfindr 34:4493c9f6d707 865 resetGlobals(); // could move this into state engine switches to save actions on each loop
pathfindr 13:29f67f256709 866 GLOBAL_wakeTime = RET_RTCunixtime;
pathfindr 11:60eb0ff945f2 867
pathfindr 9:b0a1535b8ef2 868 //MAIN LOGIC
pathfindr 24:c161db07557f 869 DEBUG("STATE:%d, HAVESETTINGS:%d, MOTION: %d, RTC:%u, BOOTAT:%u, LOC:%u, LOCFS:%u, ACT:%u \n", RET_state, RET_haveSettings, RET_motionState, RET_RTCunixtime,RET_SetupRunAt,RET_eventTime_location_tx,RET_eventTime_location_failsafe_tx,RET_eventTime_activity_tx);
pathfindr 24:c161db07557f 870 DEBUG("ACTIVITY:%s\n",RET_activityData);
pathfindr 9:b0a1535b8ef2 871 mainStateEngine();
pathfindr 34:4493c9f6d707 872
pathfindr 34:4493c9f6d707 873 //LOG FIRST RUN - BOOTLOADER COMMS
pathfindr 34:4493c9f6d707 874 if (RET_coldBoot) {
pathfindr 34:4493c9f6d707 875 read_app_data_from_flash(&app_data);
pathfindr 34:4493c9f6d707 876 bool write_app_data_to_flash_execute = false;
pathfindr 34:4493c9f6d707 877 if(get_flag(&app_data, app_execution_flag) == true) {
pathfindr 34:4493c9f6d707 878 clr_flag(&app_data, app_execution_flag);
pathfindr 34:4493c9f6d707 879 write_app_data_to_flash_execute = true;
pathfindr 34:4493c9f6d707 880 }
pathfindr 34:4493c9f6d707 881 if(app_data.current_firmware_version != FW_VERSION) {
pathfindr 34:4493c9f6d707 882 app_data.current_firmware_version = FW_VERSION;
pathfindr 34:4493c9f6d707 883 app_data.target_firmware_version = FW_VERSION;
pathfindr 34:4493c9f6d707 884 write_app_data_to_flash_execute = true;
pathfindr 34:4493c9f6d707 885 }
pathfindr 34:4493c9f6d707 886 if (write_app_data_to_flash_execute) {
pathfindr 34:4493c9f6d707 887 write_app_data_to_flash(&app_data);
pathfindr 34:4493c9f6d707 888 }
pathfindr 34:4493c9f6d707 889 RET_coldBoot = 0;
pathfindr 34:4493c9f6d707 890 }
pathfindr 9:b0a1535b8ef2 891
pathfindr 9:b0a1535b8ef2 892 //PRE-SLEEP ACTIONS
pathfindr 34:4493c9f6d707 893 LED1off();
pathfindr 34:4493c9f6d707 894 if (GLOBAL_needToConfigureLis3dh) { lis3dh_configureForSleep(RET_setting_motion_g,RET_setting_impact_g); }
pathfindr 34:4493c9f6d707 895 modem.off(false);
pathfindr 34:4493c9f6d707 896 NRFuart_uninit();
pathfindr 34:4493c9f6d707 897 nrf_configureGPIOForSleep();
pathfindr 34:4493c9f6d707 898 watchdogKick();
pathfindr 22:810425eb76e1 899
pathfindr 34:4493c9f6d707 900 //SLEEP
pathfindr 26:fa3579737329 901 mainthread.wait(DEFAULT_SLEEP_FRAME);
pathfindr 34:4493c9f6d707 902 }
pathfindr 7:e9a19750700d 903 }