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