init
Dependencies: aconno_I2C Lis2dh12 WatchdogTimer
main.cpp@20:5404841fdd2b, 2018-12-19 (annotated)
- Committer:
- pathfindr
- Date:
- Wed Dec 19 09:02:20 2018 +0000
- Revision:
- 20:5404841fdd2b
- Parent:
- 19:22261767c87a
- Child:
- 21:e0b866630c27
10
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
pathfindr | 0:94b743e06998 | 1 | #include "main.h" |
pathfindr | 5:8f8951127724 | 2 | //include "nrf_soc.h" |
pathfindr | 4:8d8e9bfa82e4 | 3 | |
pathfindr | 0:94b743e06998 | 4 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 5 | //FUNCTION PROTOTYPES |
pathfindr | 0:94b743e06998 | 6 | //------------------------------------------------------------------------------ |
pathfindr | 4:8d8e9bfa82e4 | 7 | static void mainStateEngine(void); |
pathfindr | 4:8d8e9bfa82e4 | 8 | static void selftest(void); |
pathfindr | 7:e9a19750700d | 9 | static void buttonPress(void); |
pathfindr | 7:e9a19750700d | 10 | static void buttonRelease(void); |
pathfindr | 20:5404841fdd2b | 11 | static void saveEventTimes(void); |
pathfindr | 0:94b743e06998 | 12 | |
pathfindr | 0:94b743e06998 | 13 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 14 | //GLOBAL VARS / CLEARED ON SLEEP (IF USING SOFT REBOOT HACK) |
pathfindr | 0:94b743e06998 | 15 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 16 | char* GLOBAL_defaultApi = "b:gps2"; |
pathfindr | 13:29f67f256709 | 17 | bool GLOBAL_accel_healthy = false; |
pathfindr | 13:29f67f256709 | 18 | bool GLOBAL_requireSoftReset = false; |
pathfindr | 20:5404841fdd2b | 19 | bool GLOBAL_motionStopFlagTriggered = false; |
pathfindr | 13:29f67f256709 | 20 | bool GLOBAL_debugLED = false; |
pathfindr | 13:29f67f256709 | 21 | bool GLOBAL_needToConfigureLis3dh = false; |
pathfindr | 13:29f67f256709 | 22 | bool GLOBAL_registeredOnNetwork = false; |
pathfindr | 13:29f67f256709 | 23 | long long GLOBAL_imei = 0; |
pathfindr | 13:29f67f256709 | 24 | float GLOBAL_voltage = 0.0; |
pathfindr | 13:29f67f256709 | 25 | time_t GLOBAL_RTCunixtime = 0; |
pathfindr | 13:29f67f256709 | 26 | time_t GLOBAL_wakeTime = 0; |
pathfindr | 0:94b743e06998 | 27 | |
pathfindr | 0:94b743e06998 | 28 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 29 | //RETAINED NOINIT RAM VARS |
pathfindr | 0:94b743e06998 | 30 | //------------------------------------------------------------------------------ |
pathfindr | 13:29f67f256709 | 31 | #if defined ( __CC_ARM ) /** THIS IS THE MBED ONLINE COMPILER TOOLCHAIN*/ //MUST BE STATICS |
pathfindr | 13:29f67f256709 | 32 | //IDENTITY |
pathfindr | 16:3bf5f1a5f869 | 33 | static long long RET_imei __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 34 | static char RET_pf_identifier[7] __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 35 | //SETTINGS |
pathfindr | 16:3bf5f1a5f869 | 36 | static int RET_setting_firmware __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 37 | static uint8_t RET_setting_location_mode __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 38 | static uint8_t RET_setting_location_accuracy __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 39 | static uint32_t RET_setting_location_tx_interval_mins __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 40 | static uint32_t RET_setting_location_tx_failsafe_hrs __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 41 | static uint16_t RET_setting_location_timeout __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 42 | static uint8_t RET_setting_activity_mode __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 43 | static uint32_t RET_setting_activity_tx_interval_mins __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 44 | static uint32_t RET_setting_environmental_tx_interval_mins __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 45 | static uint16_t RET_setting_motion_g __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 46 | static time_t RET_setting_motion_start_seconds __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 47 | static time_t RET_setting_motion_stop_seconds __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 48 | static uint16_t RET_setting_impact_g __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 49 | static uint8_t RET_setting_impact_alert __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 50 | static uint16_t RET_setting_connection_timeout __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 51 | static uint16_t RET_setting_beacon_interval_seconds __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 52 | static uint16_t RET_setting_beacon_scan __attribute__((section("noinit"),zero_init)); |
pathfindr | 13:29f67f256709 | 53 | //STATE |
pathfindr | 16:3bf5f1a5f869 | 54 | static uint8_t RET_coldBoot __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 55 | static bool RET_haveSettings __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 56 | static uint8_t RET_state __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 57 | static uint8_t RET_state_prev __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 58 | static uint8_t RET_buttonPressCount __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 59 | static time_t RET_buttonPressTime __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 60 | static time_t RET_buttonReleaseTime __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 61 | static time_t RET_buttonHoldTime __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 62 | static time_t RET_RTCunixtime __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 63 | //MOTION STATE |
pathfindr | 16:3bf5f1a5f869 | 64 | static bool RET_motionTriggered __attribute__((section("noinit"),zero_init)); |
pathfindr | 20:5404841fdd2b | 65 | static bool RET_motionTriggeredInTXInterval __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 66 | static time_t RET_motionStartTime __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 67 | static time_t RET_motionStopTime __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 68 | static bool RET_motionPendingOnState __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 69 | static bool RET_motionPendingOffState __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 70 | static bool RET_motionState __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 71 | static float RET_motionTotalActivityHours __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 72 | static char RET_activityData[130] __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 73 | //TO MAKE THE ABOVE BIGGER YOU NEED TO ALLOCATE MORE NOINIT MEMORY!!!!! |
pathfindr | 19:22261767c87a | 74 | |
pathfindr | 16:3bf5f1a5f869 | 75 | //IMPACT |
pathfindr | 16:3bf5f1a5f869 | 76 | static bool RET_impactTriggered __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 77 | //EVENTS LOGGING |
pathfindr | 16:3bf5f1a5f869 | 78 | static time_t RET_eventTime_location_log __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 79 | static time_t RET_eventTime_environmental_log __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 80 | //EVENTS TX |
pathfindr | 16:3bf5f1a5f869 | 81 | static time_t RET_eventTime_location_tx __attribute__((section("noinit"),zero_init)); |
pathfindr | 19:22261767c87a | 82 | static time_t RET_eventTime_location_failsafe_tx __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 83 | static time_t RET_eventTime_environmental_tx __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 84 | static time_t RET_eventTime_activity_tx __attribute__((section("noinit"),zero_init)); |
pathfindr | 16:3bf5f1a5f869 | 85 | static time_t RET_eventTime_wakeFromDormant __attribute__((section("noinit"),zero_init)); |
pathfindr | 4:8d8e9bfa82e4 | 86 | #elif defined ( __GNUC__ ) |
pathfindr | 4:8d8e9bfa82e4 | 87 | #elif defined ( __ICCARM__ ) |
pathfindr | 4:8d8e9bfa82e4 | 88 | #endif |
pathfindr | 4:8d8e9bfa82e4 | 89 | |
pathfindr | 0:94b743e06998 | 90 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 91 | //GPIO |
pathfindr | 9:b0a1535b8ef2 | 92 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 93 | InterruptIn button(PN_IN_BUTTON); //This causes wake from sleep |
pathfindr | 15:7aad9a7f970c | 94 | DigitalOut vreg_en(PN_VREG_EN); |
pathfindr | 9:b0a1535b8ef2 | 95 | |
pathfindr | 9:b0a1535b8ef2 | 96 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 97 | //PERIPHERALS |
pathfindr | 0:94b743e06998 | 98 | //------------------------------------------------------------------------------ |
pathfindr | 4:8d8e9bfa82e4 | 99 | //BLE myble; |
pathfindr | 20:5404841fdd2b | 100 | WatchdogTimer watchdog(300.0); //Do not set to less than 4500ms or can cause issues with softdevice |
pathfindr | 20:5404841fdd2b | 101 | void watchdogKick() {watchdog.kick();} |
pathfindr | 11:60eb0ff945f2 | 102 | //SERIAL DEBUG? |
pathfindr | 11:60eb0ff945f2 | 103 | #if CONSOLE_DEBUG |
pathfindr | 11:60eb0ff945f2 | 104 | Serial uart(PN_UART_TX, PN_UART_RX, 115200); |
pathfindr | 4:8d8e9bfa82e4 | 105 | #endif |
pathfindr | 11:60eb0ff945f2 | 106 | |
pathfindr | 6:388d3c7efdd9 | 107 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 108 | //TIMERS |
pathfindr | 18:22edaa7e74b1 | 109 | //-----------------------------------------------mi------------------------------- |
pathfindr | 9:b0a1535b8ef2 | 110 | LowPowerTicker RTCticker; //no impact on power consumption |
pathfindr | 9:b0a1535b8ef2 | 111 | |
pathfindr | 9:b0a1535b8ef2 | 112 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 113 | //THREAD SEMAPHORES |
pathfindr | 9:b0a1535b8ef2 | 114 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 115 | Semaphore mainthread; |
pathfindr | 9:b0a1535b8ef2 | 116 | |
pathfindr | 9:b0a1535b8ef2 | 117 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 118 | //SINGLETONS |
pathfindr | 6:388d3c7efdd9 | 119 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 120 | //NVStore &nvstore = NVStore::get_instance(); |
pathfindr | 6:388d3c7efdd9 | 121 | |
pathfindr | 7:e9a19750700d | 122 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 123 | // LOW LEVEL FUNCS |
pathfindr | 7:e9a19750700d | 124 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 125 | void turnOffEverything() { |
pathfindr | 15:7aad9a7f970c | 126 | vreg_en = 0; |
pathfindr | 9:b0a1535b8ef2 | 127 | LED1off(); |
pathfindr | 9:b0a1535b8ef2 | 128 | } |
pathfindr | 4:8d8e9bfa82e4 | 129 | void gotoSleep(long sleep_milliseconds) { |
pathfindr | 9:b0a1535b8ef2 | 130 | turnOffEverything(); |
pathfindr | 20:5404841fdd2b | 131 | watchdogKick(); |
pathfindr | 13:29f67f256709 | 132 | if (GLOBAL_requireSoftReset) { //dont need to clear this var as reset changes it back to false |
pathfindr | 4:8d8e9bfa82e4 | 133 | system_reset(); |
pathfindr | 4:8d8e9bfa82e4 | 134 | } |
pathfindr | 9:b0a1535b8ef2 | 135 | mainthread.wait(sleep_milliseconds); |
pathfindr | 6:388d3c7efdd9 | 136 | } |
pathfindr | 19:22261767c87a | 137 | void setState(uint8_t state) { |
pathfindr | 19:22261767c87a | 138 | RET_state_prev = RET_state; |
pathfindr | 19:22261767c87a | 139 | RET_state = state; |
pathfindr | 19:22261767c87a | 140 | DEBUG("STATEREADBACK %d\n",RET_state) |
pathfindr | 19:22261767c87a | 141 | } |
pathfindr | 19:22261767c87a | 142 | void getBatteryV() { |
pathfindr | 19:22261767c87a | 143 | NRF52_SAADC batteryIn; |
pathfindr | 19:22261767c87a | 144 | batteryIn.addChannel(9); // vdd for battery |
pathfindr | 19:22261767c87a | 145 | batteryIn.calibrate(); |
pathfindr | 19:22261767c87a | 146 | for (uint8_t i = 1; i < 3; i++) { // need to get it 3 times to get accurate data, first one is always low for some reason |
pathfindr | 19:22261767c87a | 147 | batteryIn.updateData(); |
pathfindr | 19:22261767c87a | 148 | GLOBAL_voltage = (batteryIn.getData()[0])*(1.0/1024.0)*3.65; |
pathfindr | 19:22261767c87a | 149 | } |
pathfindr | 19:22261767c87a | 150 | } |
pathfindr | 19:22261767c87a | 151 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 152 | // USER BUTTON HANDLING |
pathfindr | 19:22261767c87a | 153 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 154 | void buttonPress() { |
pathfindr | 19:22261767c87a | 155 | RET_buttonPressTime = RET_RTCunixtime; |
pathfindr | 19:22261767c87a | 156 | } |
pathfindr | 19:22261767c87a | 157 | void buttonRelease() { |
pathfindr | 19:22261767c87a | 158 | RET_buttonHoldTime = (RET_RTCunixtime - RET_buttonPressTime); |
pathfindr | 19:22261767c87a | 159 | RET_buttonPressCount ++; |
pathfindr | 19:22261767c87a | 160 | } |
pathfindr | 19:22261767c87a | 161 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 162 | // RTC TICKER |
pathfindr | 19:22261767c87a | 163 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 164 | void RTCtick() { |
pathfindr | 19:22261767c87a | 165 | //YOU MUST NOT CALL ANY OTHER FUNCTIONS OR DEBUG FROM INSIDE HERE!!! OR IT LOCKS UP THE DEVICE, just change vars |
pathfindr | 19:22261767c87a | 166 | RET_RTCunixtime += 1; |
pathfindr | 13:29f67f256709 | 167 | GLOBAL_RTCunixtime = RET_RTCunixtime; |
pathfindr | 19:22261767c87a | 168 | |
pathfindr | 9:b0a1535b8ef2 | 169 | //button logic - check for hold |
pathfindr | 19:22261767c87a | 170 | if (RET_buttonHoldTime > 4) { |
pathfindr | 9:b0a1535b8ef2 | 171 | RET_buttonHoldTime = 0; |
pathfindr | 9:b0a1535b8ef2 | 172 | RET_buttonPressCount = 0; |
pathfindr | 16:3bf5f1a5f869 | 173 | RET_state_prev = RET_state; |
pathfindr | 16:3bf5f1a5f869 | 174 | RET_state = STATE_BUTTONHOLD; |
pathfindr | 9:b0a1535b8ef2 | 175 | mainthread.release(); |
pathfindr | 9:b0a1535b8ef2 | 176 | } else { |
pathfindr | 19:22261767c87a | 177 | if((RET_RTCunixtime - RET_buttonPressTime) > 1) { |
pathfindr | 9:b0a1535b8ef2 | 178 | switch (RET_buttonPressCount) { |
pathfindr | 9:b0a1535b8ef2 | 179 | case 1 : |
pathfindr | 19:22261767c87a | 180 | if (RET_state == STATE_NORMAL) { |
pathfindr | 19:22261767c87a | 181 | RET_state = STATE_BUTTONPRESS1; |
pathfindr | 19:22261767c87a | 182 | mainthread.release(); |
pathfindr | 19:22261767c87a | 183 | } |
pathfindr | 9:b0a1535b8ef2 | 184 | break; |
pathfindr | 9:b0a1535b8ef2 | 185 | case 2 : |
pathfindr | 19:22261767c87a | 186 | if (RET_state == STATE_NORMAL) { |
pathfindr | 19:22261767c87a | 187 | RET_state = STATE_BUTTONPRESS2; |
pathfindr | 19:22261767c87a | 188 | mainthread.release(); |
pathfindr | 19:22261767c87a | 189 | } |
pathfindr | 9:b0a1535b8ef2 | 190 | break; |
pathfindr | 9:b0a1535b8ef2 | 191 | default : |
pathfindr | 9:b0a1535b8ef2 | 192 | //do nothing |
pathfindr | 9:b0a1535b8ef2 | 193 | break; |
pathfindr | 9:b0a1535b8ef2 | 194 | } |
pathfindr | 9:b0a1535b8ef2 | 195 | RET_buttonPressCount = 0; |
pathfindr | 9:b0a1535b8ef2 | 196 | } |
pathfindr | 9:b0a1535b8ef2 | 197 | } |
pathfindr | 19:22261767c87a | 198 | //SETUP STATE VISUALISE |
pathfindr | 19:22261767c87a | 199 | if (RET_state == STATE_SETUP) { |
pathfindr | 19:22261767c87a | 200 | led1 = !led1; |
pathfindr | 19:22261767c87a | 201 | } |
pathfindr | 9:b0a1535b8ef2 | 202 | } |
pathfindr | 7:e9a19750700d | 203 | void factoryReset() { |
pathfindr | 13:29f67f256709 | 204 | DEBUG("Factory Reset \n"); |
pathfindr | 15:7aad9a7f970c | 205 | Thread::wait(500); //wait to ensure that devices are turned off |
pathfindr | 16:3bf5f1a5f869 | 206 | //IDENTITY |
pathfindr | 13:29f67f256709 | 207 | RET_imei = 0; |
pathfindr | 16:3bf5f1a5f869 | 208 | memset(RET_pf_identifier,0,sizeof(RET_pf_identifier)); |
pathfindr | 19:22261767c87a | 209 | //STATE |
pathfindr | 19:22261767c87a | 210 | RET_coldBoot = 1; |
pathfindr | 19:22261767c87a | 211 | RET_haveSettings = 0; |
pathfindr | 19:22261767c87a | 212 | RET_state = STATE_SETUP; |
pathfindr | 19:22261767c87a | 213 | RET_state_prev = RET_state; |
pathfindr | 19:22261767c87a | 214 | RET_RTCunixtime = 0; |
pathfindr | 16:3bf5f1a5f869 | 215 | //SETTINGS |
pathfindr | 16:3bf5f1a5f869 | 216 | RET_setting_firmware = 0; |
pathfindr | 19:22261767c87a | 217 | RET_setting_location_mode = 2; |
pathfindr | 16:3bf5f1a5f869 | 218 | RET_setting_location_accuracy = 1; |
pathfindr | 16:3bf5f1a5f869 | 219 | RET_setting_location_tx_interval_mins = 1440; |
pathfindr | 16:3bf5f1a5f869 | 220 | RET_setting_location_tx_failsafe_hrs = (7*24); //7 days |
pathfindr | 16:3bf5f1a5f869 | 221 | RET_setting_location_timeout = 180; |
pathfindr | 16:3bf5f1a5f869 | 222 | RET_setting_activity_tx_interval_mins = 0; |
pathfindr | 16:3bf5f1a5f869 | 223 | RET_setting_environmental_tx_interval_mins = 0; |
pathfindr | 16:3bf5f1a5f869 | 224 | RET_setting_motion_g = 11; |
pathfindr | 16:3bf5f1a5f869 | 225 | RET_setting_motion_start_seconds = 120; |
pathfindr | 16:3bf5f1a5f869 | 226 | RET_setting_motion_stop_seconds = 120; |
pathfindr | 16:3bf5f1a5f869 | 227 | RET_setting_impact_g = 0; |
pathfindr | 16:3bf5f1a5f869 | 228 | RET_setting_impact_alert = 0; |
pathfindr | 16:3bf5f1a5f869 | 229 | RET_setting_connection_timeout = 180; |
pathfindr | 16:3bf5f1a5f869 | 230 | RET_setting_beacon_interval_seconds = 10; |
pathfindr | 16:3bf5f1a5f869 | 231 | RET_setting_beacon_scan = 0; |
pathfindr | 19:22261767c87a | 232 | //RET_RTCmillis = 0; |
pathfindr | 16:3bf5f1a5f869 | 233 | RET_buttonPressCount = 0; |
pathfindr | 16:3bf5f1a5f869 | 234 | RET_buttonPressTime = 0; |
pathfindr | 16:3bf5f1a5f869 | 235 | RET_buttonReleaseTime = 0; |
pathfindr | 16:3bf5f1a5f869 | 236 | RET_buttonHoldTime = 0; |
pathfindr | 16:3bf5f1a5f869 | 237 | //MOTION STATE |
pathfindr | 10:c8798fd9773b | 238 | RET_motionTriggered = 0; |
pathfindr | 20:5404841fdd2b | 239 | RET_motionTriggeredInTXInterval = 0; |
pathfindr | 7:e9a19750700d | 240 | RET_motionStartTime = 0; |
pathfindr | 7:e9a19750700d | 241 | RET_motionStopTime = 0; |
pathfindr | 16:3bf5f1a5f869 | 242 | RET_motionPendingOnState = 0; |
pathfindr | 16:3bf5f1a5f869 | 243 | RET_motionPendingOffState = 0; |
pathfindr | 16:3bf5f1a5f869 | 244 | RET_motionState = 0; |
pathfindr | 9:b0a1535b8ef2 | 245 | RET_motionTotalActivityHours = 0.0; |
pathfindr | 16:3bf5f1a5f869 | 246 | memset(RET_activityData,0,sizeof(RET_activityData)); |
pathfindr | 16:3bf5f1a5f869 | 247 | //IMPACT |
pathfindr | 16:3bf5f1a5f869 | 248 | RET_impactTriggered = 0; |
pathfindr | 16:3bf5f1a5f869 | 249 | //EVENT HANDLING |
pathfindr | 16:3bf5f1a5f869 | 250 | RET_eventTime_location_log = 0; |
pathfindr | 16:3bf5f1a5f869 | 251 | RET_eventTime_location_tx = 0; |
pathfindr | 16:3bf5f1a5f869 | 252 | RET_eventTime_environmental_log = 0; |
pathfindr | 16:3bf5f1a5f869 | 253 | RET_eventTime_environmental_tx = 0; |
pathfindr | 16:3bf5f1a5f869 | 254 | RET_eventTime_activity_tx = 0; |
pathfindr | 16:3bf5f1a5f869 | 255 | RET_eventTime_wakeFromDormant = 0; |
pathfindr | 16:3bf5f1a5f869 | 256 | //OTHER LOCAL GLOBALS |
pathfindr | 16:3bf5f1a5f869 | 257 | GLOBAL_requireSoftReset = false; |
pathfindr | 16:3bf5f1a5f869 | 258 | //PERIPHERAL RESET |
pathfindr | 10:c8798fd9773b | 259 | lis3dh_configureForSleep(10,127); |
pathfindr | 13:29f67f256709 | 260 | } |
pathfindr | 13:29f67f256709 | 261 | void copyRETtoGLOBAL() { |
pathfindr | 15:7aad9a7f970c | 262 | GLOBAL_imei = RET_imei; |
pathfindr | 7:e9a19750700d | 263 | } |
pathfindr | 9:b0a1535b8ef2 | 264 | void selfTest() { |
pathfindr | 8:7351f8c4cd60 | 265 | //Accelerometer |
pathfindr | 8:7351f8c4cd60 | 266 | LIS3DH lis3dh(PN_SPI_MOSI, PN_SPI_MISO, PN_SPI_CS0, PN_SPI_CLK); |
pathfindr | 8:7351f8c4cd60 | 267 | uint8_t lis3dh_id; |
pathfindr | 8:7351f8c4cd60 | 268 | lis3dh.LIS3DH_GetWHO_AM_I(&lis3dh_id); |
pathfindr | 9:b0a1535b8ef2 | 269 | if (lis3dh_id == 51) { |
pathfindr | 9:b0a1535b8ef2 | 270 | LED1blink(10,50); |
pathfindr | 9:b0a1535b8ef2 | 271 | } |
pathfindr | 9:b0a1535b8ef2 | 272 | } |
pathfindr | 9:b0a1535b8ef2 | 273 | |
pathfindr | 9:b0a1535b8ef2 | 274 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 275 | // MOTION FUNCS |
pathfindr | 9:b0a1535b8ef2 | 276 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 277 | void checkMotion() { |
pathfindr | 9:b0a1535b8ef2 | 278 | if (lis3dh_int2) { |
pathfindr | 13:29f67f256709 | 279 | if (GLOBAL_debugLED) LED1blink(2,100); |
pathfindr | 9:b0a1535b8ef2 | 280 | RET_motionTriggered = true; |
pathfindr | 13:29f67f256709 | 281 | GLOBAL_needToConfigureLis3dh = true; //interrupt has fire so need to clear it |
pathfindr | 9:b0a1535b8ef2 | 282 | if (!RET_motionPendingOnState) { |
pathfindr | 9:b0a1535b8ef2 | 283 | RET_motionPendingOnState = true; |
pathfindr | 9:b0a1535b8ef2 | 284 | RET_motionPendingOffState = false; |
pathfindr | 9:b0a1535b8ef2 | 285 | // Log start motion time |
pathfindr | 13:29f67f256709 | 286 | RET_motionStartTime = RET_RTCunixtime; |
pathfindr | 9:b0a1535b8ef2 | 287 | } |
pathfindr | 9:b0a1535b8ef2 | 288 | } else { |
pathfindr | 13:29f67f256709 | 289 | if (GLOBAL_debugLED) LED1blink(2,500); |
pathfindr | 9:b0a1535b8ef2 | 290 | RET_motionTriggered = false; |
pathfindr | 9:b0a1535b8ef2 | 291 | RET_motionPendingOnState = false; |
pathfindr | 9:b0a1535b8ef2 | 292 | if (!RET_motionPendingOffState) { |
pathfindr | 9:b0a1535b8ef2 | 293 | RET_motionPendingOffState = true; |
pathfindr | 9:b0a1535b8ef2 | 294 | //log stop motion time |
pathfindr | 13:29f67f256709 | 295 | RET_motionStopTime = RET_RTCunixtime; |
pathfindr | 9:b0a1535b8ef2 | 296 | } |
pathfindr | 9:b0a1535b8ef2 | 297 | } |
pathfindr | 9:b0a1535b8ef2 | 298 | //calculate motion state |
pathfindr | 9:b0a1535b8ef2 | 299 | if (RET_motionPendingOnState) { |
pathfindr | 9:b0a1535b8ef2 | 300 | //check if above threshold |
pathfindr | 13:29f67f256709 | 301 | time_t inMotionForSeconds = (RET_RTCunixtime - RET_motionStartTime); |
pathfindr | 16:3bf5f1a5f869 | 302 | if (inMotionForSeconds >= RET_setting_motion_start_seconds) { |
pathfindr | 9:b0a1535b8ef2 | 303 | RET_motionState = true; |
pathfindr | 20:5404841fdd2b | 304 | RET_motionTriggeredInTXInterval = true; |
pathfindr | 13:29f67f256709 | 305 | if (GLOBAL_debugLED) LED1blink(10,100); |
pathfindr | 9:b0a1535b8ef2 | 306 | } |
pathfindr | 9:b0a1535b8ef2 | 307 | } |
pathfindr | 9:b0a1535b8ef2 | 308 | if (RET_motionPendingOffState) { |
pathfindr | 13:29f67f256709 | 309 | time_t noMotionForSeconds = (RET_RTCunixtime - RET_motionStopTime); |
pathfindr | 16:3bf5f1a5f869 | 310 | if (noMotionForSeconds >= RET_setting_motion_stop_seconds) { |
pathfindr | 9:b0a1535b8ef2 | 311 | RET_motionState = false; |
pathfindr | 20:5404841fdd2b | 312 | GLOBAL_motionStopFlagTriggered = true; |
pathfindr | 9:b0a1535b8ef2 | 313 | RET_motionTotalActivityHours += (float(RET_motionStopTime - RET_motionStartTime) / 3600.0); |
pathfindr | 13:29f67f256709 | 314 | if (GLOBAL_debugLED) LED1blink(5,500); |
pathfindr | 9:b0a1535b8ef2 | 315 | } |
pathfindr | 9:b0a1535b8ef2 | 316 | } |
pathfindr | 8:7351f8c4cd60 | 317 | } |
pathfindr | 8:7351f8c4cd60 | 318 | |
pathfindr | 14:9a54b1b65bc8 | 319 | //------------------------------------------------------------------------------ |
pathfindr | 14:9a54b1b65bc8 | 320 | // UPDATE OPERATING SETTINGS |
pathfindr | 14:9a54b1b65bc8 | 321 | //------------------------------------------------------------------------------ |
pathfindr | 14:9a54b1b65bc8 | 322 | bool saveSettings(char* settingsBuffer) { |
pathfindr | 14:9a54b1b65bc8 | 323 | //process result |
pathfindr | 18:22edaa7e74b1 | 324 | int matchCount = 0; |
pathfindr | 19:22261767c87a | 325 | int critical_fail_count = 0; |
pathfindr | 19:22261767c87a | 326 | char TEMP_a[7]; 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 | 327 | 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 | 17:ba55c026b1d6 | 328 | if ( (matchCount = sscanf(settingsBuffer,"a:%c%c%c%c%c%c,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 | 17:ba55c026b1d6 | 329 | &TEMP_a[0],&TEMP_a[1],&TEMP_a[2],&TEMP_a[3],&TEMP_a[4],&TEMP_a[5],&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 | 17:ba55c026b1d6 | 330 | DEBUG("VALUES: a:%s,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 | 17:ba55c026b1d6 | 331 | 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 | 332 | |
pathfindr | 18:22edaa7e74b1 | 333 | //FAILUREMODE need to be checking thse against checksums |
pathfindr | 18:22edaa7e74b1 | 334 | char changed; |
pathfindr | 18:22edaa7e74b1 | 335 | //FAILUREMODE need to verify the identifier against a reg exp or similar |
pathfindr | 19:22261767c87a | 336 | if(1==1) { memcpy(RET_pf_identifier, TEMP_a, sizeof(TEMP_a)); changed = 'Y'; } else { changed = 'N'; critical_fail_count++; }; DEBUG("RET_pf_identifier:%s..%c\n",RET_pf_identifier,changed); |
pathfindr | 19:22261767c87a | 337 | 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 | 18:22edaa7e74b1 | 338 | if(TEMP_c != -1) { RET_setting_firmware = TEMP_c; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_firmware:%d..%c\n",RET_setting_firmware,changed); |
pathfindr | 19:22261767c87a | 339 | 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 | 19:22261767c87a | 340 | if(TEMP_e != -1) { RET_setting_location_mode = TEMP_e; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_location_accuracy:%d..%c\n",RET_setting_location_accuracy,changed); |
pathfindr | 19:22261767c87a | 341 | 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 | 19:22261767c87a | 342 | 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 | 19:22261767c87a | 343 | 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 | 19:22261767c87a | 344 | 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 | 19:22261767c87a | 345 | if(TEMP_j != -1) { RET_setting_activity_tx_interval_mins = TEMP_j; changed = 'Y'; } else { changed = 'N'; }; DEBUG("RET_setting_activity_tx_interval_mins:%d..%c\n",RET_setting_activity_tx_interval_mins,changed) |
pathfindr | 19:22261767c87a | 346 | 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 | 19:22261767c87a | 347 | 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 | 19:22261767c87a | 348 | 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 | 19:22261767c87a | 349 | 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 | 19:22261767c87a | 350 | 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 | 19:22261767c87a | 351 | 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 | 19:22261767c87a | 352 | 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 | 19:22261767c87a | 353 | 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 | 19:22261767c87a | 354 | 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 | 355 | |
pathfindr | 19:22261767c87a | 356 | if (critical_fail_count == 0) { |
pathfindr | 19:22261767c87a | 357 | DEBUG("GOT SETTINGS OK\n"); |
pathfindr | 20:5404841fdd2b | 358 | saveEventTimes(); |
pathfindr | 19:22261767c87a | 359 | RET_haveSettings = true; |
pathfindr | 19:22261767c87a | 360 | return true; |
pathfindr | 19:22261767c87a | 361 | } else { |
pathfindr | 19:22261767c87a | 362 | DEBUG("CRITICAL FAILS:%d\n",critical_fail_count); |
pathfindr | 19:22261767c87a | 363 | RET_haveSettings = false; |
pathfindr | 19:22261767c87a | 364 | return false; |
pathfindr | 19:22261767c87a | 365 | } |
pathfindr | 14:9a54b1b65bc8 | 366 | } else { |
pathfindr | 15:7aad9a7f970c | 367 | RET_haveSettings = false; |
pathfindr | 15:7aad9a7f970c | 368 | return false; |
pathfindr | 14:9a54b1b65bc8 | 369 | } |
pathfindr | 14:9a54b1b65bc8 | 370 | } |
pathfindr | 20:5404841fdd2b | 371 | void saveEventTimes() { |
pathfindr | 20:5404841fdd2b | 372 | //SET EVENT TIMES |
pathfindr | 20:5404841fdd2b | 373 | if(RET_setting_location_tx_interval_mins > 0) { |
pathfindr | 20:5404841fdd2b | 374 | RET_eventTime_location_tx = (RET_RTCunixtime + (RET_setting_location_tx_interval_mins * 60)); |
pathfindr | 20:5404841fdd2b | 375 | DEBUG("EVENTSET - LOCATION TX at %u, MODE %d\n",RET_eventTime_location_tx, RET_setting_location_mode); |
pathfindr | 20:5404841fdd2b | 376 | } |
pathfindr | 20:5404841fdd2b | 377 | if(RET_setting_location_tx_failsafe_hrs > 0) { |
pathfindr | 20:5404841fdd2b | 378 | RET_eventTime_location_failsafe_tx = (RET_RTCunixtime + (RET_setting_location_tx_failsafe_hrs * 3600)); |
pathfindr | 20:5404841fdd2b | 379 | DEBUG("EVENTSET - LOCATION FAILSAFE TX at %u\n",RET_eventTime_location_failsafe_tx); |
pathfindr | 20:5404841fdd2b | 380 | } |
pathfindr | 20:5404841fdd2b | 381 | if(RET_setting_activity_tx_interval_mins > 0) { |
pathfindr | 20:5404841fdd2b | 382 | RET_eventTime_activity_tx = (RET_RTCunixtime + (RET_setting_activity_tx_interval_mins * 60)); |
pathfindr | 20:5404841fdd2b | 383 | DEBUG("EVENTSET - ACTIVITY TX at %u\n",RET_eventTime_activity_tx); |
pathfindr | 20:5404841fdd2b | 384 | } |
pathfindr | 20:5404841fdd2b | 385 | if(RET_eventTime_environmental_tx > 0) { |
pathfindr | 20:5404841fdd2b | 386 | RET_eventTime_environmental_tx = (RET_RTCunixtime + (RET_setting_environmental_tx_interval_mins * 60)); |
pathfindr | 20:5404841fdd2b | 387 | DEBUG("EVENTSET - ENVIRONMENTAL TX at %u\n",RET_eventTime_environmental_tx); |
pathfindr | 20:5404841fdd2b | 388 | } |
pathfindr | 20:5404841fdd2b | 389 | } |
pathfindr | 13:29f67f256709 | 390 | |
pathfindr | 13:29f67f256709 | 391 | //------------------------------------------------------------------------------ |
pathfindr | 13:29f67f256709 | 392 | // SETUP |
pathfindr | 13:29f67f256709 | 393 | //------------------------------------------------------------------------------ |
pathfindr | 13:29f67f256709 | 394 | bool setup() { |
pathfindr | 13:29f67f256709 | 395 | bool pass = true; |
pathfindr | 13:29f67f256709 | 396 | Modem modem(PN_UART_TX, PN_UART_RX, PN_UART_CTS, PN_UART_RTS, PN_GSM_PWR_KEY, PN_VREG_EN); |
pathfindr | 13:29f67f256709 | 397 | if (modem.on()) { |
pathfindr | 13:29f67f256709 | 398 | RET_imei = modem.getIMEI(); |
pathfindr | 14:9a54b1b65bc8 | 399 | GLOBAL_imei = RET_imei; |
pathfindr | 13:29f67f256709 | 400 | DEBUG("imei: %lld \n",RET_imei); |
pathfindr | 20:5404841fdd2b | 401 | if (modem.registerOnNetwork(2,180000)) { |
pathfindr | 17:ba55c026b1d6 | 402 | char bytestosend[160]; |
pathfindr | 17:ba55c026b1d6 | 403 | snprintf(bytestosend,sizeof(bytestosend),"(%s,im:%lld,v:%.2f,fr:1,z:SETUP,c:1)\0",GLOBAL_defaultApi,GLOBAL_imei,GLOBAL_voltage); |
pathfindr | 17:ba55c026b1d6 | 404 | char result[180]; |
pathfindr | 17:ba55c026b1d6 | 405 | snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytestosend, true, 2, GLOBAL_defaultApi)); |
pathfindr | 16:3bf5f1a5f869 | 406 | if (result != "err") { |
pathfindr | 19:22261767c87a | 407 | DEBUG("fromserver: %s \n",result); |
pathfindr | 19:22261767c87a | 408 | if (!saveSettings(result)) { |
pathfindr | 19:22261767c87a | 409 | //something went critically wrong getting settings |
pathfindr | 19:22261767c87a | 410 | pass = false; |
pathfindr | 19:22261767c87a | 411 | } |
pathfindr | 16:3bf5f1a5f869 | 412 | } |
pathfindr | 13:29f67f256709 | 413 | } else { |
pathfindr | 16:3bf5f1a5f869 | 414 | //FAILUREMODE modem failed to register on network |
pathfindr | 19:22261767c87a | 415 | pass = false; |
pathfindr | 13:29f67f256709 | 416 | } |
pathfindr | 13:29f67f256709 | 417 | } else { |
pathfindr | 19:22261767c87a | 418 | //FAILUREMODE Modem failed to turn on |
pathfindr | 13:29f67f256709 | 419 | pass = false; |
pathfindr | 13:29f67f256709 | 420 | } |
pathfindr | 13:29f67f256709 | 421 | |
pathfindr | 13:29f67f256709 | 422 | //RESULT |
pathfindr | 19:22261767c87a | 423 | return pass; |
pathfindr | 13:29f67f256709 | 424 | } |
pathfindr | 13:29f67f256709 | 425 | |
pathfindr | 19:22261767c87a | 426 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 427 | // EVENTS |
pathfindr | 19:22261767c87a | 428 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 429 | void event_location_tx() { |
pathfindr | 20:5404841fdd2b | 430 | DEBUG("PERFORM LOCATION TX\n"); |
pathfindr | 20:5404841fdd2b | 431 | getBatteryV(); |
pathfindr | 20:5404841fdd2b | 432 | |
pathfindr | 20:5404841fdd2b | 433 | Modem modem(PN_UART_TX, PN_UART_RX, PN_UART_CTS, PN_UART_RTS, PN_GSM_PWR_KEY, PN_VREG_EN); |
pathfindr | 20:5404841fdd2b | 434 | if (modem.on()) { |
pathfindr | 19:22261767c87a | 435 | |
pathfindr | 20:5404841fdd2b | 436 | //RET_setting_location_accuracy |
pathfindr | 20:5404841fdd2b | 437 | modem.getLocation(true, 3, true, RET_setting_location_timeout); |
pathfindr | 20:5404841fdd2b | 438 | |
pathfindr | 20:5404841fdd2b | 439 | } |
pathfindr | 20:5404841fdd2b | 440 | |
pathfindr | 20:5404841fdd2b | 441 | |
pathfindr | 20:5404841fdd2b | 442 | //RESETS |
pathfindr | 20:5404841fdd2b | 443 | RET_motionTriggeredInTXInterval = 0; |
pathfindr | 20:5404841fdd2b | 444 | saveEventTimes(); |
pathfindr | 19:22261767c87a | 445 | } |
pathfindr | 7:e9a19750700d | 446 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 447 | // STATE ENGINE |
pathfindr | 7:e9a19750700d | 448 | //------------------------------------------------------------------------------ |
pathfindr | 6:388d3c7efdd9 | 449 | void mainStateEngine() { |
pathfindr | 16:3bf5f1a5f869 | 450 | switch(RET_state) { |
pathfindr | 16:3bf5f1a5f869 | 451 | case STATE_SETUP : |
pathfindr | 19:22261767c87a | 452 | DEBUG("STATE:SETUP\n"); |
pathfindr | 19:22261767c87a | 453 | getBatteryV(); |
pathfindr | 13:29f67f256709 | 454 | if (setup()) { |
pathfindr | 14:9a54b1b65bc8 | 455 | copyRETtoGLOBAL(); |
pathfindr | 19:22261767c87a | 456 | } else { |
pathfindr | 19:22261767c87a | 457 | RET_eventTime_wakeFromDormant = (RET_RTCunixtime + (72*3600)); //72hrs |
pathfindr | 19:22261767c87a | 458 | setState(STATE_DORMANT); |
pathfindr | 19:22261767c87a | 459 | DEBUG("SETSTATE:DORMANT until %u\n",RET_eventTime_wakeFromDormant); |
pathfindr | 13:29f67f256709 | 460 | } |
pathfindr | 6:388d3c7efdd9 | 461 | break; |
pathfindr | 16:3bf5f1a5f869 | 462 | case STATE_NORMAL : |
pathfindr | 19:22261767c87a | 463 | DEBUG("STATE:NORMAL\n"); |
pathfindr | 7:e9a19750700d | 464 | //check and log motion |
pathfindr | 9:b0a1535b8ef2 | 465 | checkMotion(); |
pathfindr | 9:b0a1535b8ef2 | 466 | |
pathfindr | 9:b0a1535b8ef2 | 467 | //EVENTS |
pathfindr | 19:22261767c87a | 468 | |
pathfindr | 19:22261767c87a | 469 | //LOCATION |
pathfindr | 19:22261767c87a | 470 | //Location Log |
pathfindr | 19:22261767c87a | 471 | //if(RET_RTCunixtime > RET_eventTime_location_log && RET_eventTime_location_log > 0) { } |
pathfindr | 19:22261767c87a | 472 | bool run_location_tx = false; |
pathfindr | 19:22261767c87a | 473 | switch (RET_setting_location_mode) { |
pathfindr | 19:22261767c87a | 474 | case 1: //INTERVAL POST |
pathfindr | 20:5404841fdd2b | 475 | if(RET_RTCunixtime > RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { |
pathfindr | 20:5404841fdd2b | 476 | DEBUG("INTERVAL LOC TX...\n"); |
pathfindr | 20:5404841fdd2b | 477 | run_location_tx = true; |
pathfindr | 20:5404841fdd2b | 478 | } |
pathfindr | 19:22261767c87a | 479 | break; |
pathfindr | 19:22261767c87a | 480 | case 2: //INTERVAL POST WITH MOTION CHECK |
pathfindr | 20:5404841fdd2b | 481 | if(RET_motionTriggeredInTXInterval && RET_RTCunixtime > RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { |
pathfindr | 20:5404841fdd2b | 482 | DEBUG("INTERVAL LOC TX WMC...\n"); |
pathfindr | 20:5404841fdd2b | 483 | run_location_tx = true; |
pathfindr | 20:5404841fdd2b | 484 | } |
pathfindr | 19:22261767c87a | 485 | break; |
pathfindr | 19:22261767c87a | 486 | case 3: //POST ON STOP MOTION |
pathfindr | 20:5404841fdd2b | 487 | if (GLOBAL_motionStopFlagTriggered) { |
pathfindr | 20:5404841fdd2b | 488 | DEBUG("MOTION STOP LOC TX...\n"); |
pathfindr | 20:5404841fdd2b | 489 | run_location_tx = true; |
pathfindr | 20:5404841fdd2b | 490 | GLOBAL_motionStopFlagTriggered = false; |
pathfindr | 20:5404841fdd2b | 491 | } |
pathfindr | 19:22261767c87a | 492 | break; |
pathfindr | 9:b0a1535b8ef2 | 493 | } |
pathfindr | 20:5404841fdd2b | 494 | //Failsafe timer catchall |
pathfindr | 20:5404841fdd2b | 495 | if(RET_RTCunixtime > RET_eventTime_location_failsafe_tx && RET_eventTime_location_failsafe_tx > 0) { |
pathfindr | 20:5404841fdd2b | 496 | run_location_tx = true; |
pathfindr | 20:5404841fdd2b | 497 | } |
pathfindr | 19:22261767c87a | 498 | if (run_location_tx) { |
pathfindr | 19:22261767c87a | 499 | event_location_tx(); |
pathfindr | 9:b0a1535b8ef2 | 500 | } |
pathfindr | 19:22261767c87a | 501 | |
pathfindr | 19:22261767c87a | 502 | |
pathfindr | 19:22261767c87a | 503 | |
pathfindr | 19:22261767c87a | 504 | //Environmental Log |
pathfindr | 12:8345612bf867 | 505 | if(RET_RTCunixtime > RET_eventTime_environmental_log && RET_eventTime_environmental_log > 0) { |
pathfindr | 19:22261767c87a | 506 | /* |
pathfindr | 14:9a54b1b65bc8 | 507 | Filesystem filesystem(BD_PAGE_ADDRESS,BD_TOTAL_SIZE); |
pathfindr | 12:8345612bf867 | 508 | SI7060 temperature(PN_I2C_SDA,PN_I2C_SCL); |
pathfindr | 12:8345612bf867 | 509 | float temperature_c = temperature.getTemperature(); |
pathfindr | 19:22261767c87a | 510 | DEBUG("Temperature log: %u,%f \n", RET_RTCunixtime,temperature_c); |
pathfindr | 12:8345612bf867 | 511 | filesystem.addLogEntry_temperature(RET_RTCunixtime,temperature_c); |
pathfindr | 19:22261767c87a | 512 | */ |
pathfindr | 9:b0a1535b8ef2 | 513 | } |
pathfindr | 19:22261767c87a | 514 | //Environmental TX |
pathfindr | 16:3bf5f1a5f869 | 515 | if(RET_RTCunixtime > RET_eventTime_environmental_tx && RET_eventTime_environmental_tx > 0) { |
pathfindr | 20:5404841fdd2b | 516 | //getBatteryV(); |
pathfindr | 9:b0a1535b8ef2 | 517 | //event_environmental_bc(); |
pathfindr | 12:8345612bf867 | 518 | //Filesystem filesystem(PN_SPI_MOSI,PN_SPI_MISO,PN_SPI_CLK,PN_SPI_CS1); |
pathfindr | 7:e9a19750700d | 519 | } |
pathfindr | 19:22261767c87a | 520 | //Activity TX |
pathfindr | 16:3bf5f1a5f869 | 521 | if(RET_RTCunixtime > RET_eventTime_activity_tx && RET_eventTime_activity_tx > 0) { |
pathfindr | 20:5404841fdd2b | 522 | //event_activity_tx(); |
pathfindr | 9:b0a1535b8ef2 | 523 | } |
pathfindr | 9:b0a1535b8ef2 | 524 | break; |
pathfindr | 16:3bf5f1a5f869 | 525 | case STATE_DORMANT : |
pathfindr | 12:8345612bf867 | 526 | if (RET_RTCunixtime > RET_eventTime_wakeFromDormant) { |
pathfindr | 19:22261767c87a | 527 | setState(STATE_NORMAL); |
pathfindr | 19:22261767c87a | 528 | DEBUG("WAKING UP FROM DORMANT\n"); |
pathfindr | 7:e9a19750700d | 529 | } |
pathfindr | 19:22261767c87a | 530 | DEBUG("STATE:DORMANT until %u\n",RET_eventTime_wakeFromDormant); |
pathfindr | 12:8345612bf867 | 531 | break; |
pathfindr | 16:3bf5f1a5f869 | 532 | case STATE_BUTTONPRESS1 : |
pathfindr | 19:22261767c87a | 533 | setState(STATE_NORMAL); |
pathfindr | 19:22261767c87a | 534 | DEBUG("STATE:BUTTONPRESS1\n"); |
pathfindr | 12:8345612bf867 | 535 | LED1blink(1,300); |
pathfindr | 9:b0a1535b8ef2 | 536 | break; |
pathfindr | 16:3bf5f1a5f869 | 537 | case STATE_BUTTONPRESS2 : |
pathfindr | 19:22261767c87a | 538 | setState(STATE_NORMAL); |
pathfindr | 19:22261767c87a | 539 | DEBUG("STATE:BUTTONPRESS2\n"); |
pathfindr | 19:22261767c87a | 540 | LED1blink(2,300); |
pathfindr | 9:b0a1535b8ef2 | 541 | break; |
pathfindr | 16:3bf5f1a5f869 | 542 | case STATE_BUTTONHOLD : |
pathfindr | 19:22261767c87a | 543 | DEBUG("STATE:BUTTONHOLD\n"); |
pathfindr | 19:22261767c87a | 544 | if (RET_state_prev == STATE_NORMAL) { |
pathfindr | 19:22261767c87a | 545 | setState(STATE_DORMANT); |
pathfindr | 19:22261767c87a | 546 | RET_eventTime_wakeFromDormant = (RET_RTCunixtime + (48*3600)); //48hrs |
pathfindr | 19:22261767c87a | 547 | DEBUG("TURNING OFF\n"); |
pathfindr | 19:22261767c87a | 548 | DEBUG("STATE:DORMANT until %u\n",RET_eventTime_wakeFromDormant); |
pathfindr | 19:22261767c87a | 549 | LED1on(5000); |
pathfindr | 19:22261767c87a | 550 | } else { |
pathfindr | 19:22261767c87a | 551 | if (RET_haveSettings) { |
pathfindr | 19:22261767c87a | 552 | setState(STATE_NORMAL); |
pathfindr | 19:22261767c87a | 553 | } else { |
pathfindr | 19:22261767c87a | 554 | setState(STATE_SETUP); |
pathfindr | 19:22261767c87a | 555 | } |
pathfindr | 19:22261767c87a | 556 | DEBUG("TURNING ON\n"); |
pathfindr | 19:22261767c87a | 557 | LED1blink(20,100); |
pathfindr | 19:22261767c87a | 558 | } |
pathfindr | 6:388d3c7efdd9 | 559 | break; |
pathfindr | 6:388d3c7efdd9 | 560 | default : |
pathfindr | 19:22261767c87a | 561 | setState(STATE_SETUP); |
pathfindr | 19:22261767c87a | 562 | DEBUG("DEFAULT STATE\n"); |
pathfindr | 6:388d3c7efdd9 | 563 | } |
pathfindr | 6:388d3c7efdd9 | 564 | } |
pathfindr | 6:388d3c7efdd9 | 565 | |
pathfindr | 6:388d3c7efdd9 | 566 | |
pathfindr | 7:e9a19750700d | 567 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 568 | // MAIN |
pathfindr | 7:e9a19750700d | 569 | //------------------------------------------------------------------------------ |
pathfindr | 0:94b743e06998 | 570 | int main() { |
pathfindr | 9:b0a1535b8ef2 | 571 | turnOffEverything(); |
pathfindr | 4:8d8e9bfa82e4 | 572 | |
pathfindr | 4:8d8e9bfa82e4 | 573 | //CHECK IF THIS IS RESET |
pathfindr | 4:8d8e9bfa82e4 | 574 | //0x00000004 == soft reset //0x00000002 == watchdog //0x00000001 == button/hardreset |
pathfindr | 4:8d8e9bfa82e4 | 575 | if (NRF_POWER->RESETREAS != 0xffffffff) { |
pathfindr | 4:8d8e9bfa82e4 | 576 | switch(NRF_POWER->RESETREAS) { |
pathfindr | 4:8d8e9bfa82e4 | 577 | case 0x00000001 : |
pathfindr | 19:22261767c87a | 578 | DEBUG("reset_reason: 0x%08x. - Hard Reset - CSTATE:%d\n",NRF_POWER->RESETREAS, RET_state); |
pathfindr | 13:29f67f256709 | 579 | RET_coldBoot = 1; |
pathfindr | 4:8d8e9bfa82e4 | 580 | break; |
pathfindr | 4:8d8e9bfa82e4 | 581 | case 0x00000002 : |
pathfindr | 19:22261767c87a | 582 | DEBUG("reset_reason: 0x%08x. - Watchdog - CSTATE:%d\n",NRF_POWER->RESETREAS, RET_state); |
pathfindr | 4:8d8e9bfa82e4 | 583 | break; |
pathfindr | 4:8d8e9bfa82e4 | 584 | case 0x00000004 : |
pathfindr | 19:22261767c87a | 585 | DEBUG("reset_reason: 0x%08x. - Soft reset - CSTATE:%d\n",NRF_POWER->RESETREAS, RET_state); |
pathfindr | 4:8d8e9bfa82e4 | 586 | break; |
pathfindr | 4:8d8e9bfa82e4 | 587 | } |
pathfindr | 4:8d8e9bfa82e4 | 588 | NRF_POWER->RESETREAS = 0xffffffff; |
pathfindr | 4:8d8e9bfa82e4 | 589 | } |
pathfindr | 9:b0a1535b8ef2 | 590 | //CHECK FOR FIRST BOOT |
pathfindr | 20:5404841fdd2b | 591 | if (RET_coldBoot == 1) { factoryReset(); } |
pathfindr | 9:b0a1535b8ef2 | 592 | |
pathfindr | 20:5404841fdd2b | 593 | //INIT |
pathfindr | 20:5404841fdd2b | 594 | RTCticker.attach(&RTCtick, 1.0); |
pathfindr | 20:5404841fdd2b | 595 | button.fall(&buttonPress); //does this affect power? |
pathfindr | 20:5404841fdd2b | 596 | button.rise(&buttonRelease); |
pathfindr | 13:29f67f256709 | 597 | copyRETtoGLOBAL(); |
pathfindr | 13:29f67f256709 | 598 | |
pathfindr | 0:94b743e06998 | 599 | while(true) { |
pathfindr | 9:b0a1535b8ef2 | 600 | //SLEEP |
pathfindr | 13:29f67f256709 | 601 | if (RET_coldBoot != 1) gotoSleep(10000); //THIS HAS TO BE THE FIRST ITEM IN THE MAIN LOOP |
pathfindr | 20:5404841fdd2b | 602 | watchdogKick(); |
pathfindr | 9:b0a1535b8ef2 | 603 | |
pathfindr | 13:29f67f256709 | 604 | //LOG START TIME |
pathfindr | 13:29f67f256709 | 605 | GLOBAL_wakeTime = RET_RTCunixtime; |
pathfindr | 11:60eb0ff945f2 | 606 | |
pathfindr | 9:b0a1535b8ef2 | 607 | //MAIN LOGIC |
pathfindr | 19:22261767c87a | 608 | //DEBUG("STATE: %d, RTC_MILLIS: %lld, RTC_SECONDS:%lld, BUTT_T:%d, BUTT_C,%d \n", RET_state, RET_RTCmillis, RET_RTCunixtime, RET_buttonHoldTime, RET_buttonPressCount); |
pathfindr | 19:22261767c87a | 609 | DEBUG("STATE: %d, RTC_SECONDS:%u\n", RET_state, RET_RTCunixtime); |
pathfindr | 19:22261767c87a | 610 | |
pathfindr | 20:5404841fdd2b | 611 | |
pathfindr | 20:5404841fdd2b | 612 | event_location_tx(); |
pathfindr | 20:5404841fdd2b | 613 | while(1) { |
pathfindr | 20:5404841fdd2b | 614 | } |
pathfindr | 20:5404841fdd2b | 615 | |
pathfindr | 9:b0a1535b8ef2 | 616 | mainStateEngine(); |
pathfindr | 9:b0a1535b8ef2 | 617 | |
pathfindr | 9:b0a1535b8ef2 | 618 | //PRE-SLEEP ACTIONS |
pathfindr | 18:22edaa7e74b1 | 619 | if (GLOBAL_needToConfigureLis3dh) { lis3dh_configureForSleep(10,127); } |
pathfindr | 9:b0a1535b8ef2 | 620 | RET_coldBoot = 0; |
pathfindr | 0:94b743e06998 | 621 | } |
pathfindr | 7:e9a19750700d | 622 | } |