init
Dependencies: aconno_I2C Lis2dh12 WatchdogTimer
main.cpp@55:0914bfcedcf8, 2019-06-26 (annotated)
- Committer:
- pathfindr
- Date:
- Wed Jun 26 14:52:02 2019 +0000
- Revision:
- 55:0914bfcedcf8
- Parent:
- 54:2840f2d50734
- Child:
- 56:efd9f5613549
test
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
pathfindr | 54:2840f2d50734 | 1 | #include "main.h" |
pathfindr | 51:9078e6928412 | 2 | // MUST USE MBED 5.10.4 2fd0c5cfbd |
pathfindr | 51:9078e6928412 | 3 | |
pathfindr | 51:9078e6928412 | 4 | /* |
pathfindr | 51:9078e6928412 | 5 | PRE DEPLOYMENT CHECKS!! |
pathfindr | 51:9078e6928412 | 6 | • Ensure APP DATA address is correct |
pathfindr | 51:9078e6928412 | 7 | */ |
pathfindr | 51:9078e6928412 | 8 | |
pathfindr | 51:9078e6928412 | 9 | /* |
pathfindr | 51:9078e6928412 | 10 | TO DO |
pathfindr | 51:9078e6928412 | 11 | STOP FRASH WRITE FROM CRASHING IF THERE IS A PROBLEM |
pathfindr | 51:9078e6928412 | 12 | */ |
pathfindr | 51:9078e6928412 | 13 | |
pathfindr | 21:e0b866630c27 | 14 | //------------------------------------------------------------------------------ |
pathfindr | 37:505ef618f06c | 15 | //FUNCTION PROTOTYPES - NEED TO ADD ALL OF THE MISSING ONES |
pathfindr | 0:94b743e06998 | 16 | //------------------------------------------------------------------------------ |
pathfindr | 45:6c7f5b556d74 | 17 | //should really add these - will just add as and when needed for now |
pathfindr | 48:64b1613941d5 | 18 | void event_activity_tx(); |
pathfindr | 51:9078e6928412 | 19 | void event_location_tx(bool failsafe); |
pathfindr | 52:bd7678eade77 | 20 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 21 | void bleShutdown(); |
pathfindr | 52:bd7678eade77 | 22 | #endif |
pathfindr | 0:94b743e06998 | 23 | |
pathfindr | 0:94b743e06998 | 24 | //------------------------------------------------------------------------------ |
pathfindr | 36:8e359069192b | 25 | // GLOBALS |
pathfindr | 51:9078e6928412 | 26 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 27 | char* GLOBAL_defaultApi = "b:gps2"; |
pathfindr | 52:bd7678eade77 | 28 | bool GLOBAL_accel_healthy = false; |
pathfindr | 52:bd7678eade77 | 29 | bool GLOBAL_motionStopFlagTriggered = false; |
pathfindr | 52:bd7678eade77 | 30 | bool GLOBAL_needToConfigureLis3dh = false; |
pathfindr | 52:bd7678eade77 | 31 | bool GLOBAL_registeredOnNetwork = false; |
pathfindr | 52:bd7678eade77 | 32 | bool GLOBAL_modemOn = false; |
pathfindr | 52:bd7678eade77 | 33 | bool GLOBAL_LEDSequenceinProgress = false; |
pathfindr | 52:bd7678eade77 | 34 | time_t GLOBAL_wakeTime = 0; |
pathfindr | 44:061509d1b38c | 35 | char GLOBAL_exceptionString[30]; |
pathfindr | 54:2840f2d50734 | 36 | char GLOBAL_exceptionStringRetainedUntilSuccess[10]; |
pathfindr | 52:bd7678eade77 | 37 | char GLOBAL_debug_buffer[DEBUG_BUFFERSIZE]; |
pathfindr | 55:0914bfcedcf8 | 38 | char GLOBAL_failed_broadcasts[5][160]; |
pathfindr | 55:0914bfcedcf8 | 39 | bool GLOBAL_failed_broadcast_slots[5]; |
pathfindr | 52:bd7678eade77 | 40 | char GLOBAL_GPSlocString_prev[70]; |
pathfindr | 52:bd7678eade77 | 41 | bool GLOBAL_have_GPSlocString_prev = false; |
pathfindr | 34:4493c9f6d707 | 42 | |
pathfindr | 48:64b1613941d5 | 43 | //SETTINGS |
pathfindr | 52:bd7678eade77 | 44 | int RET_setting_firmware = 0; |
pathfindr | 52:bd7678eade77 | 45 | uint32_t RET_setting_minimumupdate_hrs = 0; |
pathfindr | 52:bd7678eade77 | 46 | uint8_t RET_setting_location_mode = DEFAULT_LOCATION_MODE; |
pathfindr | 52:bd7678eade77 | 47 | uint8_t RET_setting_location_accuracy = DEFAULT_LOCATION_ACCURACY; |
pathfindr | 52:bd7678eade77 | 48 | uint32_t RET_setting_location_tx_interval_mins = DEFAULT_LOCATION_TX_INTERVAL_MINS; |
pathfindr | 52:bd7678eade77 | 49 | uint32_t RET_setting_location_tx_failsafe_hrs = DEFAULT_LOCATION_TX_FAILSAFE_HRS; |
pathfindr | 54:2840f2d50734 | 50 | uint32_t RET_location_failsafe_seconds_max = (DEFAULT_LOCATION_TX_FAILSAFE_HRS * 3600); |
pathfindr | 52:bd7678eade77 | 51 | uint16_t RET_setting_location_timeout = DEFAULT_LOCATION_TIMEOUT; |
pathfindr | 52:bd7678eade77 | 52 | uint32_t RET_setting_activity_tx_interval_hrs = 0; |
pathfindr | 52:bd7678eade77 | 53 | uint8_t RET_setting_activity_mode = 1; |
pathfindr | 52:bd7678eade77 | 54 | uint32_t RET_setting_environmental_tx_interval_mins = 0; |
pathfindr | 52:bd7678eade77 | 55 | uint16_t RET_setting_motion_g = DEFAULT_MOTION_G; |
pathfindr | 52:bd7678eade77 | 56 | time_t RET_setting_motion_start_seconds = DEFAULT_MOTION_START_SECONDS; |
pathfindr | 52:bd7678eade77 | 57 | time_t RET_setting_motion_stop_seconds = DEFAULT_MOTION_STOP_SECONDS; |
pathfindr | 52:bd7678eade77 | 58 | uint16_t RET_setting_impact_g = 0; |
pathfindr | 52:bd7678eade77 | 59 | uint8_t RET_setting_impact_alert = 0; |
pathfindr | 52:bd7678eade77 | 60 | uint16_t RET_setting_connection_timeout = DEFAULT_CONNECTION_TIMEOUT; |
pathfindr | 52:bd7678eade77 | 61 | uint16_t RET_setting_beacon_interval_seconds = 0; |
pathfindr | 52:bd7678eade77 | 62 | uint8_t RET_setting_beacon_scan = 0; |
pathfindr | 13:29f67f256709 | 63 | //STATE |
pathfindr | 51:9078e6928412 | 64 | char RET_pf_identifier[7]; |
pathfindr | 52:bd7678eade77 | 65 | uint8_t RET_coldBoot = 1; |
pathfindr | 52:bd7678eade77 | 66 | bool RET_asleep = false; |
pathfindr | 52:bd7678eade77 | 67 | bool RET_busy = false; |
pathfindr | 52:bd7678eade77 | 68 | time_t RET_RTCunixtime = 0; |
pathfindr | 52:bd7678eade77 | 69 | bool RET_haveSettings = false; |
pathfindr | 52:bd7678eade77 | 70 | uint8_t RET_state = STATE_SETUP; |
pathfindr | 52:bd7678eade77 | 71 | uint8_t RET_state_prev = RET_state; |
pathfindr | 52:bd7678eade77 | 72 | uint8_t RET_buttonPressCount = 0; |
pathfindr | 52:bd7678eade77 | 73 | time_t RET_buttonPressTime = 0; |
pathfindr | 52:bd7678eade77 | 74 | time_t RET_buttonReleaseTime = 0; |
pathfindr | 52:bd7678eade77 | 75 | time_t RET_buttonReleaseTime_prev = 0; |
pathfindr | 52:bd7678eade77 | 76 | time_t RET_buttonHoldTime = 0; |
pathfindr | 52:bd7678eade77 | 77 | time_t RET_SetupRunAt = 0; |
pathfindr | 52:bd7678eade77 | 78 | time_t RET_SettingsGotAt = 0; |
pathfindr | 52:bd7678eade77 | 79 | bool RET_setupInProgress = false; |
pathfindr | 52:bd7678eade77 | 80 | bool RET_force2G = DEFAULT_FORCE2G; |
pathfindr | 52:bd7678eade77 | 81 | bool RET_watchdogfired = false; |
pathfindr | 52:bd7678eade77 | 82 | bool RET_receivedNewSettings = false; |
pathfindr | 52:bd7678eade77 | 83 | uint32_t RET_GPSFailCount = 0; |
pathfindr | 52:bd7678eade77 | 84 | uint32_t RET_NetworkFailCount = 0; |
pathfindr | 54:2840f2d50734 | 85 | bool RET_NetworkFailFlag = false; |
pathfindr | 52:bd7678eade77 | 86 | bool RET_debug = true; |
pathfindr | 52:bd7678eade77 | 87 | time_t RET_debug_offat = 0; |
pathfindr | 52:bd7678eade77 | 88 | float RET_voltage = 0.0; |
pathfindr | 52:bd7678eade77 | 89 | float RET_temperature = 0.0; |
pathfindr | 53:c6942af186d7 | 90 | float RET_humidity = 0.0; |
pathfindr | 52:bd7678eade77 | 91 | float RET_temperature_max = -999.0; //Within broadcast frame. Set inital value to low |
pathfindr | 52:bd7678eade77 | 92 | float RET_temperature_min = 999.0; //Within broadcase frame. Set inital value to high |
pathfindr | 52:bd7678eade77 | 93 | uint32_t RET_modemBrownOutCountInSession = 0; |
pathfindr | 54:2840f2d50734 | 94 | time_t RET_lastTxTime = 0; |
pathfindr | 16:3bf5f1a5f869 | 95 | //MOTION STATE |
pathfindr | 52:bd7678eade77 | 96 | bool RET_motionTriggeredinFrame = false; |
pathfindr | 52:bd7678eade77 | 97 | bool RET_motionStateOnInLocTXInterval = false; |
pathfindr | 52:bd7678eade77 | 98 | time_t RET_motionStartTime = 0; |
pathfindr | 52:bd7678eade77 | 99 | time_t RET_motionStopTime = 0; |
pathfindr | 52:bd7678eade77 | 100 | bool RET_motionPendingOnState = false; |
pathfindr | 52:bd7678eade77 | 101 | bool RET_motionPendingOffState = false; |
pathfindr | 52:bd7678eade77 | 102 | bool RET_motionState = false; |
pathfindr | 52:bd7678eade77 | 103 | float RET_motionTotalActivityHours = 0.0f; |
pathfindr | 52:bd7678eade77 | 104 | float RET_motionTotalActivityHoursSincePost = 0.0f; |
pathfindr | 52:bd7678eade77 | 105 | time_t RET_motionFrameStart = 0; |
pathfindr | 45:6c7f5b556d74 | 106 | char RET_activityData[ACTIVITY_BUFFERSIZE]; |
pathfindr | 16:3bf5f1a5f869 | 107 | //IMPACT |
pathfindr | 52:bd7678eade77 | 108 | bool RET_impactTriggered = 0; |
pathfindr | 19:22261767c87a | 109 | //EVENTS LOGGING |
pathfindr | 52:bd7678eade77 | 110 | time_t RET_eventTime_location_log = 0; |
pathfindr | 52:bd7678eade77 | 111 | time_t RET_eventTime_environmental_log = 0; |
pathfindr | 19:22261767c87a | 112 | //EVENTS TX |
pathfindr | 52:bd7678eade77 | 113 | time_t RET_eventTime_location_tx = 0; |
pathfindr | 52:bd7678eade77 | 114 | time_t RET_eventTime_location_failsafe_tx = 0; |
pathfindr | 54:2840f2d50734 | 115 | time_t RET_location_failsafe_seconds_count = 0; |
pathfindr | 52:bd7678eade77 | 116 | time_t RET_eventTime_environmental_tx = 0; |
pathfindr | 52:bd7678eade77 | 117 | time_t RET_eventTime_activity_tx = 0; |
pathfindr | 52:bd7678eade77 | 118 | time_t RET_eventTime_wakeFromDormant = 0; |
pathfindr | 52:bd7678eade77 | 119 | //BLE |
pathfindr | 54:2840f2d50734 | 120 | bool RET_bleBroadcasting = false; |
pathfindr | 54:2840f2d50734 | 121 | uint8_t RET_bleAdv_flags = 0; |
pathfindr | 54:2840f2d50734 | 122 | char RET_closestLocationTag_id[17]; |
pathfindr | 54:2840f2d50734 | 123 | int RET_closestLocationTag_rssi = 999; |
pathfindr | 54:2840f2d50734 | 124 | int RET_closestBT04Tag_rssi = 999; |
pathfindr | 54:2840f2d50734 | 125 | bool RET_locationTag_present = false; |
pathfindr | 54:2840f2d50734 | 126 | bool RET_detector_present = false; |
pathfindr | 54:2840f2d50734 | 127 | const uint8_t bleAdv_motionTriggeredinFrame_flag = 0b01000000; |
pathfindr | 54:2840f2d50734 | 128 | const uint8_t bleAdv_motionState_flag = 0b00100000; |
pathfindr | 54:2840f2d50734 | 129 | const uint8_t bleAdv_impact_flag = 0b00010000; |
pathfindr | 54:2840f2d50734 | 130 | #pragma pack(1) |
pathfindr | 54:2840f2d50734 | 131 | struct bleData_t { |
pathfindr | 54:2840f2d50734 | 132 | uint16_t applicationSpecificId; |
pathfindr | 54:2840f2d50734 | 133 | uint8_t firmware; |
pathfindr | 54:2840f2d50734 | 134 | uint8_t flags; |
pathfindr | 54:2840f2d50734 | 135 | uint16_t voltage; |
pathfindr | 54:2840f2d50734 | 136 | uint8_t buttonpresses; |
pathfindr | 54:2840f2d50734 | 137 | int16_t temperature; |
pathfindr | 54:2840f2d50734 | 138 | uint8_t humidity; |
pathfindr | 54:2840f2d50734 | 139 | uint8_t lux; |
pathfindr | 54:2840f2d50734 | 140 | int8_t accel_x; |
pathfindr | 54:2840f2d50734 | 141 | int8_t accel_y; |
pathfindr | 54:2840f2d50734 | 142 | int8_t accel_z; |
pathfindr | 54:2840f2d50734 | 143 | /*char id_1; //cant use this and local name as it pushes us over size limit |
pathfindr | 54:2840f2d50734 | 144 | char id_2; |
pathfindr | 54:2840f2d50734 | 145 | char id_3; |
pathfindr | 54:2840f2d50734 | 146 | char id_4; |
pathfindr | 54:2840f2d50734 | 147 | char id_5; |
pathfindr | 54:2840f2d50734 | 148 | char id_6;*/ |
pathfindr | 54:2840f2d50734 | 149 | }; |
pathfindr | 54:2840f2d50734 | 150 | #pragma pack() |
pathfindr | 0:94b743e06998 | 151 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 152 | //GPIO |
pathfindr | 9:b0a1535b8ef2 | 153 | //------------------------------------------------------------------------------ |
pathfindr | 34:4493c9f6d707 | 154 | InterruptIn button(PN_IN_BUTTON); |
pathfindr | 9:b0a1535b8ef2 | 155 | |
pathfindr | 9:b0a1535b8ef2 | 156 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 157 | //PERIPHERALS |
pathfindr | 0:94b743e06998 | 158 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 159 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 160 | BLE myble; |
pathfindr | 52:bd7678eade77 | 161 | #endif |
pathfindr | 52:bd7678eade77 | 162 | WatchdogTimer watchdog; |
pathfindr | 34:4493c9f6d707 | 163 | LIS3DH lis3dh(PN_SPI_MOSI, PN_SPI_MISO, PN_SPI_CS0, PN_SPI_CLK); |
pathfindr | 52:bd7678eade77 | 164 | SI7060 si7060(PN_I2C_SDA, PN_I2C_SCL); |
pathfindr | 34:4493c9f6d707 | 165 | Modem modem(PN_GSM_PWR_KEY, PN_VREG_EN, PN_GSM_WAKE_DISABLE); |
pathfindr | 37:505ef618f06c | 166 | LowPowerTicker RTCticker; |
pathfindr | 51:9078e6928412 | 167 | LowPowerTimer LPtimer; |
pathfindr | 9:b0a1535b8ef2 | 168 | |
pathfindr | 9:b0a1535b8ef2 | 169 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 170 | //SEMAPHORES |
pathfindr | 9:b0a1535b8ef2 | 171 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 172 | Semaphore mainthread; |
pathfindr | 9:b0a1535b8ef2 | 173 | |
pathfindr | 9:b0a1535b8ef2 | 174 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 175 | // LOW LEVEL FUNCS |
pathfindr | 34:4493c9f6d707 | 176 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 177 | void watchdogKick() { |
pathfindr | 52:bd7678eade77 | 178 | watchdog.kick(); |
pathfindr | 52:bd7678eade77 | 179 | } |
pathfindr | 51:9078e6928412 | 180 | void set_8bit_flag(uint8_t& flags, uint8_t flag) { |
pathfindr | 51:9078e6928412 | 181 | flags |= flag; |
pathfindr | 51:9078e6928412 | 182 | } |
pathfindr | 51:9078e6928412 | 183 | bool get_8bit_flag(uint8_t& flags, uint8_t flag) { |
pathfindr | 51:9078e6928412 | 184 | bool result = (flags & flag); |
pathfindr | 51:9078e6928412 | 185 | return result; |
pathfindr | 51:9078e6928412 | 186 | } |
pathfindr | 51:9078e6928412 | 187 | void clr_8bit_flag(uint8_t& flags, uint8_t flag) { |
pathfindr | 51:9078e6928412 | 188 | flags &= ~flag; |
pathfindr | 51:9078e6928412 | 189 | } |
pathfindr | 50:a94e70c00fff | 190 | void nrf_configureForSleep(){ |
pathfindr | 50:a94e70c00fff | 191 | //Disable SPI pins to reduce power |
pathfindr | 50:a94e70c00fff | 192 | //nrf_gpio_cfg_input(PN_SPI_MOSI, NRF_GPIO_PIN_NOPULL); //Don't need this one |
pathfindr | 34:4493c9f6d707 | 193 | nrf_gpio_cfg_input(PN_SPI_MISO, NRF_GPIO_PIN_NOPULL); |
pathfindr | 50:a94e70c00fff | 194 | |
pathfindr | 50:a94e70c00fff | 195 | //disable modem control lines |
pathfindr | 50:a94e70c00fff | 196 | nrf_gpio_cfg_input(PN_GSM_PWR_KEY, NRF_GPIO_PIN_NOPULL); |
pathfindr | 50:a94e70c00fff | 197 | nrf_gpio_cfg_input(PN_GSM_WAKE_DISABLE, NRF_GPIO_PIN_NOPULL); |
pathfindr | 50:a94e70c00fff | 198 | |
pathfindr | 50:a94e70c00fff | 199 | //TWI0 |
pathfindr | 52:bd7678eade77 | 200 | NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos; |
pathfindr | 50:a94e70c00fff | 201 | *(volatile uint32_t *)0x40003FFC = 0; |
pathfindr | 50:a94e70c00fff | 202 | *(volatile uint32_t *)0x40003FFC; |
pathfindr | 50:a94e70c00fff | 203 | *(volatile uint32_t *)0x40003FFC = 1; |
pathfindr | 50:a94e70c00fff | 204 | //TWI1 |
pathfindr | 52:bd7678eade77 | 205 | NRF_TWI1->ENABLE=TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos; |
pathfindr | 50:a94e70c00fff | 206 | *(volatile uint32_t *)0x40004FFC = 0; |
pathfindr | 50:a94e70c00fff | 207 | *(volatile uint32_t *)0x40004FFC; |
pathfindr | 50:a94e70c00fff | 208 | *(volatile uint32_t *)0x40004FFC = 1; |
pathfindr | 6:388d3c7efdd9 | 209 | } |
pathfindr | 19:22261767c87a | 210 | void setState(uint8_t state) { |
pathfindr | 19:22261767c87a | 211 | RET_state_prev = RET_state; |
pathfindr | 19:22261767c87a | 212 | RET_state = state; |
pathfindr | 22:810425eb76e1 | 213 | } |
pathfindr | 51:9078e6928412 | 214 | void dumpSettings() { |
pathfindr | 51:9078e6928412 | 215 | if(RET_debug){ |
pathfindr | 34:4493c9f6d707 | 216 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_RTCunixtime:%u", RET_RTCunixtime);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 217 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_firmware:%d", RET_setting_firmware);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 218 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_minimumupdate_hrs:%d", RET_setting_minimumupdate_hrs);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 219 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_state:%d", RET_state);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 220 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_mode:%d", RET_setting_location_mode);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 221 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_accuracy:%d", RET_setting_location_accuracy);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 222 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_tx_interval_mins:%d", RET_setting_location_tx_interval_mins);debug_exe(); |
pathfindr | 54:2840f2d50734 | 223 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_location_failsafe_seconds_max:%d", RET_location_failsafe_seconds_max);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 224 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_location_timeout:%d", RET_setting_location_timeout);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 225 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_activity_tx_interval_hrs:%d", RET_setting_activity_tx_interval_hrs);debug_exe(); |
pathfindr | 45:6c7f5b556d74 | 226 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_activity_mode:%d", RET_setting_activity_mode);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 227 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_environmental_tx_interval_mins:%d", RET_setting_environmental_tx_interval_mins);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 228 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_motion_g:%d", RET_setting_motion_g);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 229 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_motion_start_seconds:%d", RET_setting_motion_start_seconds);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 230 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_motion_stop_seconds:%d", RET_setting_motion_stop_seconds);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 231 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_impact_g:%d", RET_setting_impact_g);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 232 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_impact_alert:%d", RET_setting_impact_alert);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 233 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_connection_timeout:%d", RET_setting_connection_timeout);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 234 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_beacon_interval_seconds:%d", RET_setting_beacon_interval_seconds);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 235 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_setting_beacon_scan:%d", RET_setting_beacon_scan);debug_exe(); |
pathfindr | 51:9078e6928412 | 236 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RET_pf_identifier:%s", RET_pf_identifier);debug_exe(); |
pathfindr | 34:4493c9f6d707 | 237 | } |
pathfindr | 24:c161db07557f | 238 | } |
pathfindr | 45:6c7f5b556d74 | 239 | void recordFirmwareAsValid() { |
pathfindr | 52:bd7678eade77 | 240 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 241 | bleShutdown(); |
pathfindr | 52:bd7678eade77 | 242 | #endif |
pathfindr | 51:9078e6928412 | 243 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RECORD FW %d AS VALID...", FW_VERSION);debug_exe(); |
pathfindr | 45:6c7f5b556d74 | 244 | read_app_data_from_flash(&app_data); |
pathfindr | 45:6c7f5b556d74 | 245 | bool write_app_data_to_flash_execute = false; |
pathfindr | 45:6c7f5b556d74 | 246 | if(get_flag(&app_data, app_execution_flag) == true) { |
pathfindr | 45:6c7f5b556d74 | 247 | clr_flag(&app_data, app_execution_flag); |
pathfindr | 45:6c7f5b556d74 | 248 | clr_flag(&app_data, first_run_flag); |
pathfindr | 45:6c7f5b556d74 | 249 | write_app_data_to_flash_execute = true; |
pathfindr | 45:6c7f5b556d74 | 250 | } |
pathfindr | 45:6c7f5b556d74 | 251 | if(app_data.current_firmware_version != FW_VERSION) { |
pathfindr | 45:6c7f5b556d74 | 252 | app_data.current_firmware_version = FW_VERSION; |
pathfindr | 45:6c7f5b556d74 | 253 | app_data.target_firmware_version = FW_VERSION; |
pathfindr | 45:6c7f5b556d74 | 254 | write_app_data_to_flash_execute = true; |
pathfindr | 45:6c7f5b556d74 | 255 | } |
pathfindr | 45:6c7f5b556d74 | 256 | if (write_app_data_to_flash_execute) { |
pathfindr | 45:6c7f5b556d74 | 257 | write_app_data_to_flash(&app_data); |
pathfindr | 51:9078e6928412 | 258 | //read back to check |
pathfindr | 51:9078e6928412 | 259 | ThisThread::sleep_for(200); //need this delay |
pathfindr | 51:9078e6928412 | 260 | read_app_data_from_flash(&app_data); |
pathfindr | 51:9078e6928412 | 261 | if (app_data.current_firmware_version == FW_VERSION) { |
pathfindr | 51:9078e6928412 | 262 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "OK");debug_exe(); |
pathfindr | 51:9078e6928412 | 263 | } else { |
pathfindr | 51:9078e6928412 | 264 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "FAIL - IS BLE SHUTDOWN?");debug_exe(); |
pathfindr | 51:9078e6928412 | 265 | } |
pathfindr | 51:9078e6928412 | 266 | } |
pathfindr | 45:6c7f5b556d74 | 267 | } |
pathfindr | 51:9078e6928412 | 268 | void updateBatteryV() { |
pathfindr | 19:22261767c87a | 269 | NRF52_SAADC batteryIn; |
pathfindr | 19:22261767c87a | 270 | batteryIn.addChannel(9); // vdd for battery |
pathfindr | 19:22261767c87a | 271 | batteryIn.calibrate(); |
pathfindr | 49:15ddd84ec9fa | 272 | //get initial reading, first reading is always low |
pathfindr | 49:15ddd84ec9fa | 273 | batteryIn.updateData(); batteryIn.getData()[0]; |
pathfindr | 49:15ddd84ec9fa | 274 | float voltage_accumulator = 0.0; |
pathfindr | 49:15ddd84ec9fa | 275 | uint8_t readings = 0; |
pathfindr | 49:15ddd84ec9fa | 276 | for (uint8_t i = 1; i <= 50; i++) { // need to get it 2 times to get accurate data, first one is always low for some reason |
pathfindr | 19:22261767c87a | 277 | batteryIn.updateData(); |
pathfindr | 49:15ddd84ec9fa | 278 | voltage_accumulator += (batteryIn.getData()[0])*(1.0/1024.0)*3.60; |
pathfindr | 49:15ddd84ec9fa | 279 | readings ++; |
pathfindr | 19:22261767c87a | 280 | } |
pathfindr | 51:9078e6928412 | 281 | RET_voltage = (voltage_accumulator / (float)readings); |
pathfindr | 22:810425eb76e1 | 282 | } |
pathfindr | 52:bd7678eade77 | 283 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 284 | // TEMPERATURE |
pathfindr | 52:bd7678eade77 | 285 | //------------------------------------------------------------------------------ |
pathfindr | 22:810425eb76e1 | 286 | float getTemperature() { |
pathfindr | 52:bd7678eade77 | 287 | return si7060.getTemperature(); |
pathfindr | 19:22261767c87a | 288 | } |
pathfindr | 51:9078e6928412 | 289 | void updateTemperatures() { |
pathfindr | 52:bd7678eade77 | 290 | if (RET_temperature == 0.0) {RET_temperature = getTemperature();} |
pathfindr | 51:9078e6928412 | 291 | RET_temperature = (RET_temperature + (getTemperature() - RET_temperature) * 0.25f); //smoothed |
pathfindr | 52:bd7678eade77 | 292 | if (RET_temperature < RET_temperature_min) {RET_temperature_min = RET_temperature;} |
pathfindr | 52:bd7678eade77 | 293 | if (RET_temperature > RET_temperature_max) {RET_temperature_max = RET_temperature;} |
pathfindr | 51:9078e6928412 | 294 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "Temp:%.1f Min:%.1f Max:%.1f",RET_temperature,RET_temperature_min,RET_temperature_max);debug_exe();} |
pathfindr | 51:9078e6928412 | 295 | } |
pathfindr | 27:fa76f5a08195 | 296 | void addToExceptionString(char* value) { |
pathfindr | 45:6c7f5b556d74 | 297 | if(strstr(GLOBAL_exceptionString, value) == false){ |
pathfindr | 52:bd7678eade77 | 298 | snprintf(GLOBAL_exceptionString+strlen(GLOBAL_exceptionString),sizeof(GLOBAL_exceptionString),".%s",value); |
pathfindr | 45:6c7f5b556d74 | 299 | } |
pathfindr | 27:fa76f5a08195 | 300 | } |
pathfindr | 54:2840f2d50734 | 301 | void addToExceptionStringRetainedUntilSuccess(char* value) { |
pathfindr | 54:2840f2d50734 | 302 | if(strstr(GLOBAL_exceptionStringRetainedUntilSuccess, value) == false){ |
pathfindr | 54:2840f2d50734 | 303 | snprintf(GLOBAL_exceptionStringRetainedUntilSuccess+strlen(GLOBAL_exceptionStringRetainedUntilSuccess),sizeof(GLOBAL_exceptionStringRetainedUntilSuccess),".%s",value); |
pathfindr | 54:2840f2d50734 | 304 | } |
pathfindr | 54:2840f2d50734 | 305 | } |
pathfindr | 51:9078e6928412 | 306 | void resetTemperatures() { |
pathfindr | 51:9078e6928412 | 307 | RET_temperature_max = -999.0; //Within broadcast frame. Set inital value to low |
pathfindr | 51:9078e6928412 | 308 | RET_temperature_min = 999.0; //Within broadcase frame. Set inital value to high |
pathfindr | 51:9078e6928412 | 309 | } |
pathfindr | 19:22261767c87a | 310 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 311 | // USER BUTTON HANDLING |
pathfindr | 19:22261767c87a | 312 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 313 | void buttonPress() { |
pathfindr | 51:9078e6928412 | 314 | RET_buttonPressTime = LPtimer.read_ms(); |
pathfindr | 19:22261767c87a | 315 | } |
pathfindr | 19:22261767c87a | 316 | void buttonRelease() { |
pathfindr | 51:9078e6928412 | 317 | //debounce catch |
pathfindr | 51:9078e6928412 | 318 | RET_buttonReleaseTime = LPtimer.read_ms(); |
pathfindr | 51:9078e6928412 | 319 | if ((RET_buttonReleaseTime - RET_buttonReleaseTime_prev) > 75) { |
pathfindr | 51:9078e6928412 | 320 | RET_buttonPressCount ++; |
pathfindr | 51:9078e6928412 | 321 | RET_buttonHoldTime = (RET_buttonReleaseTime - RET_buttonPressTime); |
pathfindr | 51:9078e6928412 | 322 | //temporarily enable debugging and dump settings |
pathfindr | 51:9078e6928412 | 323 | RET_debug = true; |
pathfindr | 52:bd7678eade77 | 324 | RET_debug_offat = (RET_RTCunixtime + 3600); //debug on for 1hr |
pathfindr | 51:9078e6928412 | 325 | } |
pathfindr | 51:9078e6928412 | 326 | RET_buttonReleaseTime_prev = RET_buttonReleaseTime; |
pathfindr | 19:22261767c87a | 327 | } |
pathfindr | 19:22261767c87a | 328 | //------------------------------------------------------------------------------ |
pathfindr | 19:22261767c87a | 329 | // RTC TICKER |
pathfindr | 51:9078e6928412 | 330 | //------------------------------------------------------------------------------ |
pathfindr | 54:2840f2d50734 | 331 | bool RET_flash_busy = false; |
pathfindr | 9:b0a1535b8ef2 | 332 | void RTCtick() { |
pathfindr | 51:9078e6928412 | 333 | //YOU MUST NOT CALL ANY OTHER FUNCTIONS OR DEBUG FROM INSIDE HERE!!! OR IT LOCKS UP THE DEVICE, just change vars & comparisons etc |
pathfindr | 19:22261767c87a | 334 | RET_RTCunixtime += 1; |
pathfindr | 51:9078e6928412 | 335 | |
pathfindr | 51:9078e6928412 | 336 | //button logic |
pathfindr | 51:9078e6928412 | 337 | if (RET_buttonHoldTime >= 4000 && RET_buttonHoldTime <= 10000) { |
pathfindr | 49:15ddd84ec9fa | 338 | RET_buttonHoldTime = 0; |
pathfindr | 49:15ddd84ec9fa | 339 | RET_buttonPressCount = 0; |
pathfindr | 51:9078e6928412 | 340 | if (RET_state != STATE_DORMANT) { |
pathfindr | 51:9078e6928412 | 341 | RET_state_prev = RET_state; |
pathfindr | 51:9078e6928412 | 342 | RET_state = STATE_TURNOFF; |
pathfindr | 51:9078e6928412 | 343 | } else { |
pathfindr | 51:9078e6928412 | 344 | RET_state = STATE_TURNON; |
pathfindr | 51:9078e6928412 | 345 | } |
pathfindr | 49:15ddd84ec9fa | 346 | mainthread.release(); |
pathfindr | 51:9078e6928412 | 347 | } else if (RET_buttonHoldTime >= 14000 && RET_buttonHoldTime <= 30000) { |
pathfindr | 49:15ddd84ec9fa | 348 | RET_buttonHoldTime = 0; |
pathfindr | 49:15ddd84ec9fa | 349 | RET_buttonPressCount = 0; |
pathfindr | 49:15ddd84ec9fa | 350 | RET_state = STATE_SCORCHEDEARTH; |
pathfindr | 49:15ddd84ec9fa | 351 | mainthread.release(); |
pathfindr | 49:15ddd84ec9fa | 352 | } else { |
pathfindr | 51:9078e6928412 | 353 | if((LPtimer.read_ms() - RET_buttonReleaseTime) > 1500 && RET_buttonPressCount > 0) { |
pathfindr | 49:15ddd84ec9fa | 354 | if(RET_busy == true) { |
pathfindr | 49:15ddd84ec9fa | 355 | //RTCtick_ledflash_count = 4;// 2 flashes |
pathfindr | 54:2840f2d50734 | 356 | RET_flash_busy = true; |
pathfindr | 49:15ddd84ec9fa | 357 | } else { |
pathfindr | 49:15ddd84ec9fa | 358 | RET_SetupRunAt = 0; //allow setup to run again |
pathfindr | 49:15ddd84ec9fa | 359 | switch (RET_buttonPressCount) { //double catches to help with debounce |
pathfindr | 49:15ddd84ec9fa | 360 | case 1 : |
pathfindr | 50:a94e70c00fff | 361 | if(RET_state_prev != RET_state) {RET_state_prev = RET_state;} |
pathfindr | 49:15ddd84ec9fa | 362 | RET_state = STATE_BUTTONPRESS1; |
pathfindr | 49:15ddd84ec9fa | 363 | RET_buttonPressCount = 0; |
pathfindr | 49:15ddd84ec9fa | 364 | mainthread.release(); |
pathfindr | 49:15ddd84ec9fa | 365 | break; |
pathfindr | 49:15ddd84ec9fa | 366 | case 3 : |
pathfindr | 50:a94e70c00fff | 367 | if(RET_state_prev != RET_state) {RET_state_prev = RET_state;} |
pathfindr | 49:15ddd84ec9fa | 368 | RET_state = STATE_BUTTONPRESS3; |
pathfindr | 49:15ddd84ec9fa | 369 | RET_buttonPressCount = 0; |
pathfindr | 49:15ddd84ec9fa | 370 | mainthread.release(); |
pathfindr | 49:15ddd84ec9fa | 371 | break; |
pathfindr | 49:15ddd84ec9fa | 372 | case 5 : |
pathfindr | 50:a94e70c00fff | 373 | if(RET_state_prev != RET_state) {RET_state_prev = RET_state;} |
pathfindr | 49:15ddd84ec9fa | 374 | RET_state = STATE_BUTTONPRESS5; |
pathfindr | 49:15ddd84ec9fa | 375 | RET_buttonPressCount = 0; |
pathfindr | 49:15ddd84ec9fa | 376 | mainthread.release(); |
pathfindr | 49:15ddd84ec9fa | 377 | break; |
pathfindr | 49:15ddd84ec9fa | 378 | default : |
pathfindr | 49:15ddd84ec9fa | 379 | //do nothing |
pathfindr | 49:15ddd84ec9fa | 380 | break; |
pathfindr | 39:f767b8037475 | 381 | } |
pathfindr | 9:b0a1535b8ef2 | 382 | } |
pathfindr | 51:9078e6928412 | 383 | RET_buttonPressCount = 0; |
pathfindr | 9:b0a1535b8ef2 | 384 | } |
pathfindr | 49:15ddd84ec9fa | 385 | } |
pathfindr | 52:bd7678eade77 | 386 | |
pathfindr | 54:2840f2d50734 | 387 | if (RET_busy && RET_flash_busy) { |
pathfindr | 54:2840f2d50734 | 388 | led1 = !led1; |
pathfindr | 54:2840f2d50734 | 389 | } else { |
pathfindr | 54:2840f2d50734 | 390 | RET_flash_busy = false; |
pathfindr | 54:2840f2d50734 | 391 | } |
pathfindr | 54:2840f2d50734 | 392 | /* |
pathfindr | 52:bd7678eade77 | 393 | if(RET_debug && GLOBAL_LEDSequenceinProgress == false){ |
pathfindr | 52:bd7678eade77 | 394 | if (RET_motionState) { |
pathfindr | 52:bd7678eade77 | 395 | led1 = 0; |
pathfindr | 52:bd7678eade77 | 396 | } else { |
pathfindr | 52:bd7678eade77 | 397 | led1 = 1; |
pathfindr | 52:bd7678eade77 | 398 | } |
pathfindr | 52:bd7678eade77 | 399 | } |
pathfindr | 54:2840f2d50734 | 400 | */ |
pathfindr | 9:b0a1535b8ef2 | 401 | } |
pathfindr | 52:bd7678eade77 | 402 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 403 | // GLOBALS |
pathfindr | 52:bd7678eade77 | 404 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 405 | void resetSessionVars() { |
pathfindr | 34:4493c9f6d707 | 406 | GLOBAL_accel_healthy = false; |
pathfindr | 52:bd7678eade77 | 407 | RET_motionTriggeredinFrame = false; |
pathfindr | 52:bd7678eade77 | 408 | RET_modemBrownOutCountInSession = 0; |
pathfindr | 53:c6942af186d7 | 409 | RET_humidity = 99.0f; |
pathfindr | 34:4493c9f6d707 | 410 | } |
pathfindr | 38:476a9b5629a1 | 411 | void healthCheck() { |
pathfindr | 39:f767b8037475 | 412 | //check for watchdog fire |
pathfindr | 39:f767b8037475 | 413 | if (RET_watchdogfired == true) { |
pathfindr | 39:f767b8037475 | 414 | addToExceptionString("WD"); |
pathfindr | 39:f767b8037475 | 415 | RET_watchdogfired = false; |
pathfindr | 54:2840f2d50734 | 416 | RET_haveSettings = false; |
pathfindr | 39:f767b8037475 | 417 | } |
pathfindr | 41:07e41dbd5304 | 418 | //check clock |
pathfindr | 41:07e41dbd5304 | 419 | if(RET_haveSettings == true) { |
pathfindr | 54:2840f2d50734 | 420 | if (RET_RTCunixtime < 1547678732 || RET_RTCunixtime > 1900000000) { |
pathfindr | 41:07e41dbd5304 | 421 | RET_haveSettings = false; |
pathfindr | 54:2840f2d50734 | 422 | addToExceptionString("CI"); |
pathfindr | 41:07e41dbd5304 | 423 | } |
pathfindr | 41:07e41dbd5304 | 424 | } |
pathfindr | 41:07e41dbd5304 | 425 | //check that we have a reasonable time to loc |
pathfindr | 41:07e41dbd5304 | 426 | if(RET_haveSettings == true) { |
pathfindr | 41:07e41dbd5304 | 427 | //check location tx delta is set |
pathfindr | 41:07e41dbd5304 | 428 | if (RET_eventTime_location_tx == 0) { |
pathfindr | 51:9078e6928412 | 429 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "ERR:eventTime_location_tx is 0");debug_exe();} |
pathfindr | 41:07e41dbd5304 | 430 | RET_haveSettings = false; |
pathfindr | 41:07e41dbd5304 | 431 | } |
pathfindr | 54:2840f2d50734 | 432 | //check location failsafe tx is less than 2 weeks |
pathfindr | 54:2840f2d50734 | 433 | if (RET_location_failsafe_seconds_max > (336 * 3600)) { |
pathfindr | 54:2840f2d50734 | 434 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "ERR:RET_location_failsafe_seconds_max too big");debug_exe();} |
pathfindr | 41:07e41dbd5304 | 435 | RET_haveSettings = false; |
pathfindr | 41:07e41dbd5304 | 436 | } |
pathfindr | 41:07e41dbd5304 | 437 | } |
pathfindr | 54:2840f2d50734 | 438 | //check that we have had an attempted post within failsafe time |
pathfindr | 54:2840f2d50734 | 439 | time_t timeSinceTX = (RET_RTCunixtime - RET_lastTxTime); |
pathfindr | 54:2840f2d50734 | 440 | if (RET_lastTxTime > 0 && timeSinceTX > RET_location_failsafe_seconds_max) { |
pathfindr | 54:2840f2d50734 | 441 | RET_haveSettings = false; |
pathfindr | 54:2840f2d50734 | 442 | addToExceptionString("E1"); |
pathfindr | 54:2840f2d50734 | 443 | } |
pathfindr | 54:2840f2d50734 | 444 | //if have settings false then rerun setup |
pathfindr | 41:07e41dbd5304 | 445 | if (RET_haveSettings == false) { |
pathfindr | 41:07e41dbd5304 | 446 | setState(STATE_SETUP); |
pathfindr | 41:07e41dbd5304 | 447 | } |
pathfindr | 38:476a9b5629a1 | 448 | } |
pathfindr | 24:c161db07557f | 449 | |
pathfindr | 22:810425eb76e1 | 450 | bool selfTest() { |
pathfindr | 22:810425eb76e1 | 451 | int test_count = 0; |
pathfindr | 22:810425eb76e1 | 452 | int test_pass = 0; |
pathfindr | 22:810425eb76e1 | 453 | |
pathfindr | 8:7351f8c4cd60 | 454 | //Accelerometer |
pathfindr | 22:810425eb76e1 | 455 | test_count ++; |
pathfindr | 8:7351f8c4cd60 | 456 | uint8_t lis3dh_id; |
pathfindr | 8:7351f8c4cd60 | 457 | lis3dh.LIS3DH_GetWHO_AM_I(&lis3dh_id); |
pathfindr | 27:fa76f5a08195 | 458 | if (lis3dh_id == 51) { |
pathfindr | 43:7b232f03628f | 459 | GLOBAL_accel_healthy = true; |
pathfindr | 27:fa76f5a08195 | 460 | test_pass ++; |
pathfindr | 27:fa76f5a08195 | 461 | } else { |
pathfindr | 43:7b232f03628f | 462 | GLOBAL_accel_healthy = false; |
pathfindr | 52:bd7678eade77 | 463 | addToExceptionString("AF"); |
pathfindr | 27:fa76f5a08195 | 464 | } |
pathfindr | 22:810425eb76e1 | 465 | |
pathfindr | 22:810425eb76e1 | 466 | //Result |
pathfindr | 22:810425eb76e1 | 467 | if (test_count == test_pass) { |
pathfindr | 22:810425eb76e1 | 468 | return true; |
pathfindr | 22:810425eb76e1 | 469 | } else { |
pathfindr | 22:810425eb76e1 | 470 | return false; |
pathfindr | 9:b0a1535b8ef2 | 471 | } |
pathfindr | 9:b0a1535b8ef2 | 472 | } |
pathfindr | 52:bd7678eade77 | 473 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 474 | // BLE FUNCS |
pathfindr | 52:bd7678eade77 | 475 | //------------------------------------------------------------------------------ |
pathfindr | 52:bd7678eade77 | 476 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 477 | void bleBuildData(bleData_t &bleData) |
pathfindr | 52:bd7678eade77 | 478 | { |
pathfindr | 52:bd7678eade77 | 479 | bleData.applicationSpecificId = BLE_SERVICEID_GPSPLUS; |
pathfindr | 52:bd7678eade77 | 480 | bleData.firmware = FW_VERSION; |
pathfindr | 52:bd7678eade77 | 481 | //set flags |
pathfindr | 52:bd7678eade77 | 482 | if (RET_motionTriggeredinFrame) { |
pathfindr | 52:bd7678eade77 | 483 | set_8bit_flag(RET_bleAdv_flags, bleAdv_motionTriggeredinFrame_flag); |
pathfindr | 52:bd7678eade77 | 484 | } else { |
pathfindr | 52:bd7678eade77 | 485 | clr_8bit_flag(RET_bleAdv_flags, bleAdv_motionTriggeredinFrame_flag); |
pathfindr | 52:bd7678eade77 | 486 | } |
pathfindr | 52:bd7678eade77 | 487 | if (RET_motionState) { |
pathfindr | 52:bd7678eade77 | 488 | set_8bit_flag(RET_bleAdv_flags, bleAdv_motionState_flag); |
pathfindr | 52:bd7678eade77 | 489 | } else { |
pathfindr | 52:bd7678eade77 | 490 | clr_8bit_flag(RET_bleAdv_flags, bleAdv_motionState_flag); |
pathfindr | 52:bd7678eade77 | 491 | } |
pathfindr | 52:bd7678eade77 | 492 | clr_8bit_flag(RET_bleAdv_flags, bleAdv_impact_flag); |
pathfindr | 52:bd7678eade77 | 493 | bleData.flags = RET_bleAdv_flags; |
pathfindr | 52:bd7678eade77 | 494 | bleData.voltage = uint16_t(RET_voltage * 100); |
pathfindr | 52:bd7678eade77 | 495 | bleData.temperature = uint16_t(getTemperature() * 10); |
pathfindr | 52:bd7678eade77 | 496 | bleData.humidity = 0xFF; |
pathfindr | 52:bd7678eade77 | 497 | bleData.lux = 0xFF; |
pathfindr | 52:bd7678eade77 | 498 | bleData.accel_x = 0xFF; |
pathfindr | 52:bd7678eade77 | 499 | bleData.accel_y = 0xFF; |
pathfindr | 52:bd7678eade77 | 500 | bleData.accel_z = 0xFF; |
pathfindr | 52:bd7678eade77 | 501 | /* |
pathfindr | 52:bd7678eade77 | 502 | bleData.id_1 = RET_pf_identifier[0]; //dont use this just stick it in the local name |
pathfindr | 52:bd7678eade77 | 503 | bleData.id_2 = RET_pf_identifier[1]; |
pathfindr | 52:bd7678eade77 | 504 | bleData.id_3 = RET_pf_identifier[2]; |
pathfindr | 52:bd7678eade77 | 505 | bleData.id_4 = RET_pf_identifier[3]; |
pathfindr | 52:bd7678eade77 | 506 | bleData.id_5 = RET_pf_identifier[4]; |
pathfindr | 52:bd7678eade77 | 507 | bleData.id_6 = RET_pf_identifier[5]; |
pathfindr | 52:bd7678eade77 | 508 | */ |
pathfindr | 52:bd7678eade77 | 509 | } |
pathfindr | 52:bd7678eade77 | 510 | void bleUpdateAndAdvertise(void) |
pathfindr | 52:bd7678eade77 | 511 | { |
pathfindr | 54:2840f2d50734 | 512 | if (RET_setting_beacon_interval_seconds < 2) {RET_setting_beacon_interval_seconds = 2;} |
pathfindr | 52:bd7678eade77 | 513 | int AdvertisingInterval = (RET_setting_beacon_interval_seconds * 1000); |
pathfindr | 52:bd7678eade77 | 514 | bleData_t bleData; |
pathfindr | 52:bd7678eade77 | 515 | bleBuildData(bleData); |
pathfindr | 52:bd7678eade77 | 516 | myble.gap().stopAdvertising(); |
pathfindr | 52:bd7678eade77 | 517 | myble.gap().setTxPower(DEFAULT_BEACON_POWER); // set tx power,valid values are -40, -20, -16, -12, -8, -4, 0, 4 |
pathfindr | 52:bd7678eade77 | 518 | myble.gap().accumulateAdvertisingPayloadTxPower(DEFAULT_BEACON_POWER); // (accepted values are -40, -30, -20, -16, -12, -8, -4, 0, and 4 dBm) |
pathfindr | 52:bd7678eade77 | 519 | myble.gap().setAdvertisingInterval(AdvertisingInterval); |
pathfindr | 52:bd7678eade77 | 520 | myble.gap().updateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, (uint8_t *)&bleData, sizeof(bleData_t)); |
pathfindr | 52:bd7678eade77 | 521 | //myble.gap().updateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, (uint8_t *)&bleData, sizeof(bleData_t)); |
pathfindr | 52:bd7678eade77 | 522 | myble.gap().startAdvertising(); |
pathfindr | 52:bd7678eade77 | 523 | RET_bleBroadcasting = true; |
pathfindr | 52:bd7678eade77 | 524 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "BLE Adv Start");debug_exe();} |
pathfindr | 52:bd7678eade77 | 525 | } |
pathfindr | 52:bd7678eade77 | 526 | void bleSetupAdvertising(BLE::InitializationCompleteCallbackContext *params) |
pathfindr | 52:bd7678eade77 | 527 | { |
pathfindr | 52:bd7678eade77 | 528 | if (RET_pf_identifier[0] != 0x00 && RET_pf_identifier[1] != 0x00 && RET_pf_identifier[2] != 0x00) { |
pathfindr | 52:bd7678eade77 | 529 | bleData_t bleData; |
pathfindr | 52:bd7678eade77 | 530 | bleBuildData(bleData); |
pathfindr | 52:bd7678eade77 | 531 | char localname[6]; |
pathfindr | 52:bd7678eade77 | 532 | memcpy(localname,RET_pf_identifier,6); |
pathfindr | 52:bd7678eade77 | 533 | myble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE ); |
pathfindr | 52:bd7678eade77 | 534 | myble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)localname, sizeof(localname)); |
pathfindr | 52:bd7678eade77 | 535 | myble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, (uint8_t *)&bleData, sizeof(bleData_t)); |
pathfindr | 52:bd7678eade77 | 536 | //myble.gap().accumulateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, (uint8_t *)&bleData, sizeof(bleData_t)); |
pathfindr | 52:bd7678eade77 | 537 | myble.gap().setAdvertisingType(GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED); |
pathfindr | 52:bd7678eade77 | 538 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "BLE Setup...");debug_exe();} |
pathfindr | 52:bd7678eade77 | 539 | } |
pathfindr | 52:bd7678eade77 | 540 | } |
pathfindr | 52:bd7678eade77 | 541 | void bleStopAdvertising(void) |
pathfindr | 52:bd7678eade77 | 542 | { |
pathfindr | 52:bd7678eade77 | 543 | myble.gap().stopAdvertising(); |
pathfindr | 52:bd7678eade77 | 544 | RET_bleBroadcasting = false; |
pathfindr | 52:bd7678eade77 | 545 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "BLE Adv Stop");debug_exe();} |
pathfindr | 52:bd7678eade77 | 546 | } |
pathfindr | 54:2840f2d50734 | 547 | int blecount = 0; |
pathfindr | 52:bd7678eade77 | 548 | void bleAdvertisementCallback(const Gap::AdvertisementCallbackParams_t *params) { |
pathfindr | 52:bd7678eade77 | 549 | struct AdvertisingData_t { |
pathfindr | 52:bd7678eade77 | 550 | uint8_t length; |
pathfindr | 52:bd7678eade77 | 551 | GapAdvertisingData::DataType_t dataType; |
pathfindr | 52:bd7678eade77 | 552 | uint8_t data[0]; |
pathfindr | 52:bd7678eade77 | 553 | } PACKED; |
pathfindr | 52:bd7678eade77 | 554 | struct bleData_t { |
pathfindr | 52:bd7678eade77 | 555 | uint16_t applicationSpecificId; |
pathfindr | 52:bd7678eade77 | 556 | } PACKED; |
pathfindr | 52:bd7678eade77 | 557 | |
pathfindr | 52:bd7678eade77 | 558 | //LOOKING FOR (SIAEC BETA) |
pathfindr | 52:bd7678eade77 | 559 | //14f64b977c250854 |
pathfindr | 52:bd7678eade77 | 560 | //442ce31996801546 |
pathfindr | 52:bd7678eade77 | 561 | |
pathfindr | 52:bd7678eade77 | 562 | char beta_location_tag_0[17] = {'4','1','1','7','6','9','0','5','6','4','6','8','3','f','6','8',0x00}; //bens |
pathfindr | 52:bd7678eade77 | 563 | char beta_location_tag_1[17] = {'1','4','f','6','4','b','9','7','7','c','2','5','0','8','5','4',0x00}; //singapore |
pathfindr | 52:bd7678eade77 | 564 | char beta_location_tag_2[17] = {'4','4','2','c','e','3','1','9','9','6','8','0','1','5','4','6',0x00}; //singapore |
pathfindr | 52:bd7678eade77 | 565 | |
pathfindr | 52:bd7678eade77 | 566 | //Portal demos |
pathfindr | 52:bd7678eade77 | 567 | char beta_location_tag_3[17] = {'1','5','f','c','6','d','d','5','c','3','7','f','1','f','4','a',0x00}; |
pathfindr | 52:bd7678eade77 | 568 | char beta_location_tag_4[17] = {'b','a','a','e','c','d','6','8','b','d','7','e','e','a','6','5',0x00}; |
pathfindr | 52:bd7678eade77 | 569 | char beta_location_tag_5[17] = {'7','e','4','b','7','8','e','0','f','a','3','3','0','8','a','0',0x00}; |
pathfindr | 52:bd7678eade77 | 570 | char beta_location_tag_6[17] = {'e','1','1','3','c','d','e','a','a','e','f','f','1','4','d','9',0x00}; |
pathfindr | 52:bd7678eade77 | 571 | char beta_location_tag_7[17] = {'8','c','9','2','4','5','f','f','0','c','f','a','b','9','2','f',0x00}; |
pathfindr | 52:bd7678eade77 | 572 | char beta_location_tag_8[17] = {'0','7','e','9','9','1','d','3','b','e','b','6','4','0','4','8',0x00}; |
pathfindr | 52:bd7678eade77 | 573 | char beta_location_tag_9[17] = {'9','5','6','3','a','0','8','6','2','1','e','8','e','c','1','4',0x00}; |
pathfindr | 52:bd7678eade77 | 574 | |
pathfindr | 54:2840f2d50734 | 575 | //RR demos |
pathfindr | 54:2840f2d50734 | 576 | char beta_location_tag_10[17] = {'3','3','0','2','2','c','9','f','0','b','1','8','5','3','a','c',0x00}; |
pathfindr | 54:2840f2d50734 | 577 | char beta_location_tag_11[17] = {'2','5','6','c','4','0','2','b','d','c','1','4','2','5','2','7',0x00}; |
pathfindr | 54:2840f2d50734 | 578 | char beta_location_tag_12[17] = {'8','e','9','f','0','e','c','1','4','0','e','1','2','e','e','9',0x00}; |
pathfindr | 54:2840f2d50734 | 579 | char beta_location_tag_13[17] = {'8','d','6','b','8','5','e','b','8','4','6','e','e','0','0','e',0x00}; |
pathfindr | 54:2840f2d50734 | 580 | char beta_location_tag_14[17] = {'9','3','2','7','4','c','b','9','e','4','6','d','b','6','7','6',0x00}; |
pathfindr | 54:2840f2d50734 | 581 | char beta_location_tag_15[17] = {'1','a','e','3','0','7','7','f','8','f','3','a','f','7','c','1',0x00}; |
pathfindr | 54:2840f2d50734 | 582 | char beta_location_tag_16[17] = {'f','f','d','5','a','2','e','a','4','4','9','2','e','d','a','c',0x00}; |
pathfindr | 54:2840f2d50734 | 583 | char beta_location_tag_17[17] = {'f','0','e','f','2','d','8','b','f','7','6','1','3','a','1','d',0x00}; |
pathfindr | 54:2840f2d50734 | 584 | char beta_location_tag_18[17] = {'e','e','7','6','4','c','8','5','3','4','6','b','9','5','f','2',0x00}; |
pathfindr | 54:2840f2d50734 | 585 | char beta_location_tag_19[17] = {'b','b','0','3','6','7','d','b','d','a','5','b','a','5','a','5',0x00}; |
pathfindr | 54:2840f2d50734 | 586 | |
pathfindr | 54:2840f2d50734 | 587 | blecount ++; |
pathfindr | 54:2840f2d50734 | 588 | |
pathfindr | 52:bd7678eade77 | 589 | //Search for the manufacturer specific data with matching application-ID |
pathfindr | 52:bd7678eade77 | 590 | AdvertisingData_t *pAdvData; |
pathfindr | 52:bd7678eade77 | 591 | for (size_t index = 0; index < params->advertisingDataLen; index += (pAdvData->length + 1)) { |
pathfindr | 52:bd7678eade77 | 592 | pAdvData = (AdvertisingData_t *)¶ms->advertisingData[index]; |
pathfindr | 52:bd7678eade77 | 593 | const bleData_t *pbleData = (const bleData_t *)pAdvData->data; |
pathfindr | 52:bd7678eade77 | 594 | |
pathfindr | 52:bd7678eade77 | 595 | //ESTIMOTE BEACON |
pathfindr | 52:bd7678eade77 | 596 | //example data 020104 0303 9afe1716 9afe 22 02c887042a33f9f0 00efebc60146f8ffffffff //spaces just to show identifier |
pathfindr | 52:bd7678eade77 | 597 | |
pathfindr | 52:bd7678eade77 | 598 | //BLE TYPE SWITCH |
pathfindr | 52:bd7678eade77 | 599 | switch(pbleData->applicationSpecificId) { |
pathfindr | 52:bd7678eade77 | 600 | case BLE_SERVICEID_PFBEACON1 : |
pathfindr | 52:bd7678eade77 | 601 | { |
pathfindr | 52:bd7678eade77 | 602 | char beacon_identifier[17]; |
pathfindr | 52:bd7678eade77 | 603 | snprintf(beacon_identifier, sizeof(beacon_identifier), "%02x%02x%02x%02x%02x%02x%02x%02x", |
pathfindr | 52:bd7678eade77 | 604 | params->advertisingData[12], |
pathfindr | 52:bd7678eade77 | 605 | params->advertisingData[13], |
pathfindr | 52:bd7678eade77 | 606 | params->advertisingData[14], |
pathfindr | 52:bd7678eade77 | 607 | params->advertisingData[15], |
pathfindr | 52:bd7678eade77 | 608 | params->advertisingData[16], |
pathfindr | 52:bd7678eade77 | 609 | params->advertisingData[17], |
pathfindr | 52:bd7678eade77 | 610 | params->advertisingData[18], |
pathfindr | 52:bd7678eade77 | 611 | params->advertisingData[19]); |
pathfindr | 52:bd7678eade77 | 612 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), " Mac: [%02x%02x%02x%02x%02x%02x], rssi: %d, AType: %u, S: %04x, Id: %s",params->peerAddr[5], params->peerAddr[4], params->peerAddr[3], params->peerAddr[2], params->peerAddr[1], params->peerAddr[0],params->rssi, params->type, pbleData->applicationSpecificId, beacon_identifier);debug_exe();} |
pathfindr | 52:bd7678eade77 | 613 | //check to see if its one of the two location beta beacons we are looking for... |
pathfindr | 52:bd7678eade77 | 614 | if (strcmp(beacon_identifier, beta_location_tag_0) == 0 |
pathfindr | 52:bd7678eade77 | 615 | || strcmp(beacon_identifier, beta_location_tag_1) == 0 |
pathfindr | 52:bd7678eade77 | 616 | || strcmp(beacon_identifier, beta_location_tag_2) == 0 |
pathfindr | 52:bd7678eade77 | 617 | || strcmp(beacon_identifier, beta_location_tag_3) == 0 |
pathfindr | 52:bd7678eade77 | 618 | || strcmp(beacon_identifier, beta_location_tag_4) == 0 |
pathfindr | 52:bd7678eade77 | 619 | || strcmp(beacon_identifier, beta_location_tag_5) == 0 |
pathfindr | 52:bd7678eade77 | 620 | || strcmp(beacon_identifier, beta_location_tag_6) == 0 |
pathfindr | 52:bd7678eade77 | 621 | || strcmp(beacon_identifier, beta_location_tag_7) == 0 |
pathfindr | 52:bd7678eade77 | 622 | || strcmp(beacon_identifier, beta_location_tag_8) == 0 |
pathfindr | 52:bd7678eade77 | 623 | || strcmp(beacon_identifier, beta_location_tag_9) == 0 |
pathfindr | 54:2840f2d50734 | 624 | || strcmp(beacon_identifier, beta_location_tag_10) == 0 |
pathfindr | 54:2840f2d50734 | 625 | || strcmp(beacon_identifier, beta_location_tag_11) == 0 |
pathfindr | 54:2840f2d50734 | 626 | || strcmp(beacon_identifier, beta_location_tag_12) == 0 |
pathfindr | 54:2840f2d50734 | 627 | || strcmp(beacon_identifier, beta_location_tag_13) == 0 |
pathfindr | 54:2840f2d50734 | 628 | || strcmp(beacon_identifier, beta_location_tag_14) == 0 |
pathfindr | 54:2840f2d50734 | 629 | || strcmp(beacon_identifier, beta_location_tag_15) == 0 |
pathfindr | 54:2840f2d50734 | 630 | || strcmp(beacon_identifier, beta_location_tag_16) == 0 |
pathfindr | 54:2840f2d50734 | 631 | || strcmp(beacon_identifier, beta_location_tag_17) == 0 |
pathfindr | 54:2840f2d50734 | 632 | || strcmp(beacon_identifier, beta_location_tag_18) == 0 |
pathfindr | 54:2840f2d50734 | 633 | || strcmp(beacon_identifier, beta_location_tag_19) == 0 |
pathfindr | 52:bd7678eade77 | 634 | ) { |
pathfindr | 52:bd7678eade77 | 635 | //dump advertising data |
pathfindr | 52:bd7678eade77 | 636 | //for (unsigned index = 0; index < params->advertisingDataLen; index++) { if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "%02x",params->advertisingData[index]);debug_exe(false);}} |
pathfindr | 52:bd7678eade77 | 637 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), " MATCH");debug_exe();} |
pathfindr | 52:bd7678eade77 | 638 | int tag_rssi = params->rssi * -1; //to convert to positive number |
pathfindr | 52:bd7678eade77 | 639 | if (tag_rssi < RET_closestLocationTag_rssi) { |
pathfindr | 52:bd7678eade77 | 640 | RET_closestLocationTag_rssi = tag_rssi; |
pathfindr | 52:bd7678eade77 | 641 | memcpy(RET_closestLocationTag_id, beacon_identifier, sizeof(RET_closestLocationTag_id)); |
pathfindr | 52:bd7678eade77 | 642 | RET_locationTag_present = true; |
pathfindr | 54:2840f2d50734 | 643 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "Location Tag: %s, rssi: %d",RET_closestLocationTag_id, RET_closestLocationTag_rssi);debug_exe();} |
pathfindr | 52:bd7678eade77 | 644 | } |
pathfindr | 52:bd7678eade77 | 645 | } |
pathfindr | 52:bd7678eade77 | 646 | break; |
pathfindr | 52:bd7678eade77 | 647 | } |
pathfindr | 52:bd7678eade77 | 648 | case BLE_SERVICEID_BT04 : |
pathfindr | 52:bd7678eade77 | 649 | { |
pathfindr | 53:c6942af186d7 | 650 | //get serial |
pathfindr | 53:c6942af186d7 | 651 | //char serial[9]; |
pathfindr | 53:c6942af186d7 | 652 | //snprintf(serial, sizeof(serial), "%02x%02x%02x%02x", params->advertisingData[11], params->advertisingData[12], params->advertisingData[13], params->advertisingData[14]); |
pathfindr | 53:c6942af186d7 | 653 | //if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Serial: %s", serial);debug_exe();} |
pathfindr | 53:c6942af186d7 | 654 | |
pathfindr | 53:c6942af186d7 | 655 | //get battery |
pathfindr | 53:c6942af186d7 | 656 | //int battery = params->advertisingData[15]; |
pathfindr | 53:c6942af186d7 | 657 | //if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Battery: %i", battery);debug_exe();} |
pathfindr | 53:c6942af186d7 | 658 | |
pathfindr | 53:c6942af186d7 | 659 | //get temperature positive |
pathfindr | 53:c6942af186d7 | 660 | /* |
pathfindr | 53:c6942af186d7 | 661 | bool temppositive = !(params->advertisingData[17] & 0b01000000); |
pathfindr | 53:c6942af186d7 | 662 | float temperature = |
pathfindr | 53:c6942af186d7 | 663 | ( |
pathfindr | 53:c6942af186d7 | 664 | ((params->advertisingData[17] & 0b00111111) << 8) | |
pathfindr | 53:c6942af186d7 | 665 | ((params->advertisingData[18] & 0b11111111)) |
pathfindr | 53:c6942af186d7 | 666 | ) / 100.0; |
pathfindr | 53:c6942af186d7 | 667 | if (!temppositive) temperature = -temperature; |
pathfindr | 53:c6942af186d7 | 668 | //if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Temp: %f", temperature);debug_exe();} |
pathfindr | 53:c6942af186d7 | 669 | */ |
pathfindr | 53:c6942af186d7 | 670 | |
pathfindr | 53:c6942af186d7 | 671 | //get humidity |
pathfindr | 53:c6942af186d7 | 672 | int tag_rssi = params->rssi * -1; //to convert to positive number |
pathfindr | 53:c6942af186d7 | 673 | if (tag_rssi < RET_closestBT04Tag_rssi) { |
pathfindr | 53:c6942af186d7 | 674 | RET_humidity = |
pathfindr | 53:c6942af186d7 | 675 | ( |
pathfindr | 53:c6942af186d7 | 676 | ((params->advertisingData[19] & 0b01111111) << 8) | |
pathfindr | 53:c6942af186d7 | 677 | ((params->advertisingData[20] & 0b11111111)) |
pathfindr | 53:c6942af186d7 | 678 | ) / 100.0; |
pathfindr | 54:2840f2d50734 | 679 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "Humidity Tag Present: %f",RET_humidity);debug_exe();} |
pathfindr | 53:c6942af186d7 | 680 | } |
pathfindr | 53:c6942af186d7 | 681 | //rssi |
pathfindr | 53:c6942af186d7 | 682 | //if(DEBUG_ON){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Rssi: %i", params->rssi);debug_exe();} |
pathfindr | 53:c6942af186d7 | 683 | |
pathfindr | 52:bd7678eade77 | 684 | break; |
pathfindr | 52:bd7678eade77 | 685 | } |
pathfindr | 52:bd7678eade77 | 686 | case BLE_SERVICEID_PFDETECTOR1 : |
pathfindr | 52:bd7678eade77 | 687 | { |
pathfindr | 52:bd7678eade77 | 688 | char ble_advdata[100]; |
pathfindr | 52:bd7678eade77 | 689 | snprintf(ble_advdata, sizeof(ble_advdata), "%02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", |
pathfindr | 52:bd7678eade77 | 690 | params->advertisingData[0], |
pathfindr | 52:bd7678eade77 | 691 | params->advertisingData[1], |
pathfindr | 52:bd7678eade77 | 692 | params->advertisingData[2], |
pathfindr | 52:bd7678eade77 | 693 | params->advertisingData[3], |
pathfindr | 52:bd7678eade77 | 694 | params->advertisingData[4], |
pathfindr | 52:bd7678eade77 | 695 | params->advertisingData[5], |
pathfindr | 52:bd7678eade77 | 696 | params->advertisingData[6], |
pathfindr | 52:bd7678eade77 | 697 | params->advertisingData[7], |
pathfindr | 52:bd7678eade77 | 698 | params->advertisingData[8], |
pathfindr | 52:bd7678eade77 | 699 | params->advertisingData[9], |
pathfindr | 52:bd7678eade77 | 700 | params->advertisingData[10], |
pathfindr | 52:bd7678eade77 | 701 | params->advertisingData[11], |
pathfindr | 52:bd7678eade77 | 702 | params->advertisingData[12], |
pathfindr | 52:bd7678eade77 | 703 | params->advertisingData[13], |
pathfindr | 52:bd7678eade77 | 704 | params->advertisingData[14], |
pathfindr | 52:bd7678eade77 | 705 | params->advertisingData[15], |
pathfindr | 52:bd7678eade77 | 706 | params->advertisingData[16], |
pathfindr | 52:bd7678eade77 | 707 | params->advertisingData[17], |
pathfindr | 52:bd7678eade77 | 708 | params->advertisingData[18], |
pathfindr | 52:bd7678eade77 | 709 | params->advertisingData[19], |
pathfindr | 52:bd7678eade77 | 710 | params->advertisingData[20]); |
pathfindr | 52:bd7678eade77 | 711 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), " Mac: [%02x%02x%02x%02x%02x%02x], rssi: %d, AType: %u, Id: %s",params->peerAddr[5], params->peerAddr[4], params->peerAddr[3], params->peerAddr[2], params->peerAddr[1], params->peerAddr[0],params->rssi, pAdvData->dataType, ble_advdata);debug_exe();} |
pathfindr | 54:2840f2d50734 | 712 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "Detector @rssi: %d",params->rssi);debug_exe();} |
pathfindr | 52:bd7678eade77 | 713 | if (params->rssi >= -75) { |
pathfindr | 52:bd7678eade77 | 714 | RET_detector_present = true; |
pathfindr | 52:bd7678eade77 | 715 | } |
pathfindr | 52:bd7678eade77 | 716 | break; |
pathfindr | 52:bd7678eade77 | 717 | } |
pathfindr | 52:bd7678eade77 | 718 | } |
pathfindr | 52:bd7678eade77 | 719 | } |
pathfindr | 52:bd7678eade77 | 720 | } |
pathfindr | 52:bd7678eade77 | 721 | void bleConfigureScan(void) |
pathfindr | 52:bd7678eade77 | 722 | { |
pathfindr | 52:bd7678eade77 | 723 | //configure scan |
pathfindr | 54:2840f2d50734 | 724 | myble.gap().setScanParams(200,200); //scan interval //scan window |
pathfindr | 52:bd7678eade77 | 725 | myble.gap().startScan(bleAdvertisementCallback); |
pathfindr | 52:bd7678eade77 | 726 | } |
pathfindr | 52:bd7678eade77 | 727 | void bleStopScan(void) |
pathfindr | 52:bd7678eade77 | 728 | { |
pathfindr | 52:bd7678eade77 | 729 | myble.gap().stopScan(); |
pathfindr | 52:bd7678eade77 | 730 | } |
pathfindr | 52:bd7678eade77 | 731 | void bleShutdown(void) |
pathfindr | 52:bd7678eade77 | 732 | { |
pathfindr | 52:bd7678eade77 | 733 | bleStopScan(); |
pathfindr | 52:bd7678eade77 | 734 | bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 735 | myble.shutdown(); |
pathfindr | 52:bd7678eade77 | 736 | } |
pathfindr | 52:bd7678eade77 | 737 | #endif |
pathfindr | 9:b0a1535b8ef2 | 738 | |
pathfindr | 9:b0a1535b8ef2 | 739 | //------------------------------------------------------------------------------ |
pathfindr | 9:b0a1535b8ef2 | 740 | // MOTION FUNCS |
pathfindr | 9:b0a1535b8ef2 | 741 | //------------------------------------------------------------------------------ |
pathfindr | 48:64b1613941d5 | 742 | bool checkMotion() { |
pathfindr | 51:9078e6928412 | 743 | if (RET_haveSettings) { //NEED THIS AS THINGS GO FUNKY WITHOUT RTC TIME SET CORRECTLY |
pathfindr | 51:9078e6928412 | 744 | if (lis3dh_int2) { |
pathfindr | 51:9078e6928412 | 745 | RET_motionTriggeredinFrame = true; |
pathfindr | 51:9078e6928412 | 746 | GLOBAL_needToConfigureLis3dh = true; //interrupt has fire so need to clear it |
pathfindr | 52:bd7678eade77 | 747 | if(RET_debug) { |
pathfindr | 52:bd7678eade77 | 748 | LED1on(100); |
pathfindr | 52:bd7678eade77 | 749 | } |
pathfindr | 51:9078e6928412 | 750 | if (!RET_motionPendingOnState) { |
pathfindr | 51:9078e6928412 | 751 | RET_motionPendingOnState = true; |
pathfindr | 51:9078e6928412 | 752 | RET_motionPendingOffState = false; |
pathfindr | 51:9078e6928412 | 753 | // Log start motion time |
pathfindr | 51:9078e6928412 | 754 | RET_motionStartTime = RET_RTCunixtime; |
pathfindr | 51:9078e6928412 | 755 | } |
pathfindr | 51:9078e6928412 | 756 | } else { |
pathfindr | 51:9078e6928412 | 757 | RET_motionTriggeredinFrame = false; |
pathfindr | 51:9078e6928412 | 758 | RET_motionPendingOnState = false; |
pathfindr | 51:9078e6928412 | 759 | if (!RET_motionPendingOffState) { |
pathfindr | 51:9078e6928412 | 760 | RET_motionPendingOffState = true; |
pathfindr | 51:9078e6928412 | 761 | //log stop motion time |
pathfindr | 51:9078e6928412 | 762 | RET_motionStopTime = RET_RTCunixtime; |
pathfindr | 51:9078e6928412 | 763 | } |
pathfindr | 9:b0a1535b8ef2 | 764 | } |
pathfindr | 51:9078e6928412 | 765 | //calculate motion state |
pathfindr | 51:9078e6928412 | 766 | if (RET_motionFrameStart == 0) {RET_motionFrameStart = RET_RTCunixtime;} |
pathfindr | 51:9078e6928412 | 767 | if (RET_motionPendingOnState) { |
pathfindr | 51:9078e6928412 | 768 | //check if above threshold |
pathfindr | 51:9078e6928412 | 769 | time_t inMotionForSeconds = ((RET_RTCunixtime - RET_motionStartTime) + (DEFAULT_SLEEP_FRAME / 1000)); //Plus DEFAULT_SLEEP_FRAME as it should include frame time |
pathfindr | 52:bd7678eade77 | 770 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "M:%u",inMotionForSeconds);debug_exe();} |
pathfindr | 52:bd7678eade77 | 771 | if (inMotionForSeconds >= RET_setting_motion_start_seconds) { |
pathfindr | 52:bd7678eade77 | 772 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "MotionOn");debug_exe();} |
pathfindr | 51:9078e6928412 | 773 | RET_motionState = true; |
pathfindr | 52:bd7678eade77 | 774 | RET_motionStateOnInLocTXInterval = true; |
pathfindr | 54:2840f2d50734 | 775 | GLOBAL_have_GPSlocString_prev = false; |
pathfindr | 52:bd7678eade77 | 776 | if (RET_motionState == false) { //If this is first after motionState 0 |
pathfindr | 52:bd7678eade77 | 777 | if (RET_setting_activity_mode == 2 && RET_setting_activity_tx_interval_hrs > 0) { |
pathfindr | 52:bd7678eade77 | 778 | time_t epochOffsetMins = ((RET_RTCunixtime - RET_motionFrameStart) / 60); |
pathfindr | 52:bd7678eade77 | 779 | sprintf(RET_activityData+strlen(RET_activityData),"1.%u!",epochOffsetMins); |
pathfindr | 52:bd7678eade77 | 780 | } |
pathfindr | 45:6c7f5b556d74 | 781 | } |
pathfindr | 23:a3b0ccf75ca5 | 782 | } |
pathfindr | 9:b0a1535b8ef2 | 783 | } |
pathfindr | 51:9078e6928412 | 784 | if (RET_motionPendingOffState) { |
pathfindr | 51:9078e6928412 | 785 | time_t noMotionForSeconds = ((RET_RTCunixtime - RET_motionStopTime) + (DEFAULT_SLEEP_FRAME / 1000)); //Plus DEFAULT_SLEEP_FRAME as it should include frame time |
pathfindr | 52:bd7678eade77 | 786 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "NM:%u",noMotionForSeconds);debug_exe();} |
pathfindr | 52:bd7678eade77 | 787 | if (noMotionForSeconds >= RET_setting_motion_stop_seconds) { |
pathfindr | 52:bd7678eade77 | 788 | if (RET_motionState == true) { |
pathfindr | 52:bd7678eade77 | 789 | RET_motionPendingOffState = false; |
pathfindr | 52:bd7678eade77 | 790 | RET_motionState = false; |
pathfindr | 52:bd7678eade77 | 791 | GLOBAL_motionStopFlagTriggered = true; |
pathfindr | 52:bd7678eade77 | 792 | //if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "MotionStop");debug_exe();} |
pathfindr | 52:bd7678eade77 | 793 | if (RET_setting_activity_mode > 0 && RET_setting_activity_tx_interval_hrs > 0) { |
pathfindr | 52:bd7678eade77 | 794 | RET_motionTotalActivityHoursSincePost += ((float(RET_motionStopTime)-float(RET_motionStartTime)) / 3600.0f); |
pathfindr | 52:bd7678eade77 | 795 | RET_motionTotalActivityHours += RET_motionTotalActivityHoursSincePost; |
pathfindr | 52:bd7678eade77 | 796 | if (RET_setting_activity_mode == 2) { |
pathfindr | 52:bd7678eade77 | 797 | time_t epochOffsetMins = ((RET_RTCunixtime - RET_motionFrameStart) / 60); |
pathfindr | 52:bd7678eade77 | 798 | sprintf(RET_activityData+strlen(RET_activityData),"0.%u!",epochOffsetMins); |
pathfindr | 52:bd7678eade77 | 799 | } |
pathfindr | 51:9078e6928412 | 800 | } |
pathfindr | 45:6c7f5b556d74 | 801 | } |
pathfindr | 23:a3b0ccf75ca5 | 802 | } |
pathfindr | 9:b0a1535b8ef2 | 803 | } |
pathfindr | 9:b0a1535b8ef2 | 804 | } |
pathfindr | 48:64b1613941d5 | 805 | return RET_motionState; |
pathfindr | 8:7351f8c4cd60 | 806 | } |
pathfindr | 8:7351f8c4cd60 | 807 | |
pathfindr | 14:9a54b1b65bc8 | 808 | //------------------------------------------------------------------------------ |
pathfindr | 14:9a54b1b65bc8 | 809 | // UPDATE OPERATING SETTINGS |
pathfindr | 14:9a54b1b65bc8 | 810 | //------------------------------------------------------------------------------ |
pathfindr | 14:9a54b1b65bc8 | 811 | bool saveSettings(char* settingsBuffer) { |
pathfindr | 18:22edaa7e74b1 | 812 | int matchCount = 0; |
pathfindr | 19:22261767c87a | 813 | int critical_fail_count = 0; |
pathfindr | 32:dff4858bdf37 | 814 | int TEMP_a = -1; time_t TEMP_b = 0; int TEMP_c = -1; int TEMP_d = -1; int TEMP_e = -1; int TEMP_f = -1; int TEMP_g = -1; int TEMP_h = -1; int TEMP_i = -1; int TEMP_j = -1; |
pathfindr | 51:9078e6928412 | 815 | 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; int TEMP_t = -1; char TEMP_u[7]; |
pathfindr | 50:a94e70c00fff | 816 | |
pathfindr | 51:9078e6928412 | 817 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "RESP: %s",settingsBuffer);debug_exe();} |
pathfindr | 50:a94e70c00fff | 818 | |
pathfindr | 51:9078e6928412 | 819 | //exampple |
pathfindr | 51:9078e6928412 | 820 | //+CUSD: 0,”1#a:12,b:1558020598,c:-1,d:-1,e:1,f:2,g:5,h:168,i:90,j:168,k:0,l:8,m:60,n:60,o:0,p:0,q:120,r:0,s:0,t:1,u:F859C1#”,15 |
pathfindr | 51:9078e6928412 | 821 | |
pathfindr | 51:9078e6928412 | 822 | if ( (matchCount = sscanf(settingsBuffer,"a:%d,b:%u,c:%d,d:%d,e:%d,f:%d,g:%d,h:%d,i:%d,j:%d,k:%d,l:%d,m:%d,n:%d,o:%d,p:%d,q:%d,r:%d,s:%d,t:%d,u:%s", |
pathfindr | 51:9078e6928412 | 823 | &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,&TEMP_t,&TEMP_u) ) > 0 ) { |
pathfindr | 48:64b1613941d5 | 824 | |
pathfindr | 51:9078e6928412 | 825 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "PARAMS: a:%d,b:%u,c:%d,d:%d,e:%d,f:%d,g:%d,h:%d,i:%d,j:%d,k:%d,l:%d,m:%d,n:%d,o:%d,p:%d,q:%d,r:%d,s:%d,t:%d,u:%s\n", |
pathfindr | 51:9078e6928412 | 826 | 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,TEMP_t,TEMP_u);debug_exe();} |
pathfindr | 34:4493c9f6d707 | 827 | |
pathfindr | 54:2840f2d50734 | 828 | if(TEMP_a > 0) { RET_setting_minimumupdate_hrs = TEMP_a; } |
pathfindr | 54:2840f2d50734 | 829 | if(TEMP_b > 1552915630 && TEMP_b < 1900000000) { |
pathfindr | 50:a94e70c00fff | 830 | if (RET_RTCunixtime < 1552915630) { |
pathfindr | 50:a94e70c00fff | 831 | //assume this is first proper unixtime and set |
pathfindr | 50:a94e70c00fff | 832 | RET_RTCunixtime = TEMP_b; |
pathfindr | 50:a94e70c00fff | 833 | } else { |
pathfindr | 51:9078e6928412 | 834 | //this is not a first unixtime, so check within safe range, convert to long long first to avoid -1 rollover issue |
pathfindr | 51:9078e6928412 | 835 | long long unixtime_in = TEMP_b; |
pathfindr | 51:9078e6928412 | 836 | long long unixtime_current = RET_RTCunixtime; |
pathfindr | 51:9078e6928412 | 837 | if ((unixtime_in - unixtime_current) < 604800) { //allow 1 week difference |
pathfindr | 50:a94e70c00fff | 838 | RET_RTCunixtime = TEMP_b; |
pathfindr | 50:a94e70c00fff | 839 | } else { |
pathfindr | 50:a94e70c00fff | 840 | critical_fail_count++; |
pathfindr | 51:9078e6928412 | 841 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "unixtime too far ahead. C:%u N:%u",RET_RTCunixtime,TEMP_b);debug_exe();} |
pathfindr | 50:a94e70c00fff | 842 | } |
pathfindr | 50:a94e70c00fff | 843 | } |
pathfindr | 50:a94e70c00fff | 844 | } else { |
pathfindr | 50:a94e70c00fff | 845 | critical_fail_count++; |
pathfindr | 51:9078e6928412 | 846 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "unixtime too low");debug_exe();} |
pathfindr | 50:a94e70c00fff | 847 | } |
pathfindr | 54:2840f2d50734 | 848 | if(TEMP_c > 0) { RET_setting_firmware = TEMP_c; } else { RET_setting_firmware = -1;} |
pathfindr | 54:2840f2d50734 | 849 | if(TEMP_d > -1) { setState(TEMP_d); } else { setState(STATE_NORMAL);} |
pathfindr | 54:2840f2d50734 | 850 | if(TEMP_e > 0) { RET_setting_location_mode = TEMP_e; } |
pathfindr | 52:bd7678eade77 | 851 | if(RET_setting_location_mode > 4) {RET_setting_location_mode = DEFAULT_LOCATION_MODE;} |
pathfindr | 54:2840f2d50734 | 852 | if(TEMP_f > 0) { RET_setting_location_accuracy = TEMP_f; } |
pathfindr | 34:4493c9f6d707 | 853 | if(RET_setting_location_accuracy > 3) {RET_setting_location_accuracy = DEFAULT_LOCATION_ACCURACY;} |
pathfindr | 54:2840f2d50734 | 854 | if(TEMP_g > 0) { RET_setting_location_tx_interval_mins = TEMP_g; } |
pathfindr | 54:2840f2d50734 | 855 | if(TEMP_h > 0) { RET_setting_location_tx_failsafe_hrs = TEMP_h; } |
pathfindr | 34:4493c9f6d707 | 856 | if(RET_setting_location_tx_failsafe_hrs > 504) {RET_setting_location_tx_failsafe_hrs = DEFAULT_LOCATION_TX_FAILSAFE_HRS;} |
pathfindr | 54:2840f2d50734 | 857 | if(TEMP_i > 0) { RET_setting_location_timeout = TEMP_i; } |
pathfindr | 27:fa76f5a08195 | 858 | if(RET_setting_location_timeout < 60 || RET_setting_location_timeout > 300) {RET_setting_location_timeout = DEFAULT_LOCATION_TIMEOUT;} |
pathfindr | 54:2840f2d50734 | 859 | if(TEMP_j > -1) { RET_setting_activity_tx_interval_hrs = TEMP_j; } |
pathfindr | 54:2840f2d50734 | 860 | if(TEMP_k > -1) { RET_setting_environmental_tx_interval_mins = TEMP_k; } |
pathfindr | 54:2840f2d50734 | 861 | if(TEMP_l > 0) { RET_setting_motion_g = TEMP_l; } |
pathfindr | 43:7b232f03628f | 862 | if(RET_setting_motion_g < 4 || RET_setting_motion_g > 127) {RET_setting_motion_g = DEFAULT_MOTION_G;} |
pathfindr | 54:2840f2d50734 | 863 | if(TEMP_m > -1) { RET_setting_motion_start_seconds = TEMP_m; } |
pathfindr | 54:2840f2d50734 | 864 | if(TEMP_n > -1) { RET_setting_motion_stop_seconds = TEMP_n; } |
pathfindr | 54:2840f2d50734 | 865 | if(TEMP_o > -1) { RET_setting_impact_g = TEMP_o; } |
pathfindr | 54:2840f2d50734 | 866 | if(TEMP_p > -1) { RET_setting_impact_alert = TEMP_p; } |
pathfindr | 54:2840f2d50734 | 867 | if(TEMP_q > -1) { RET_setting_connection_timeout = TEMP_q; } |
pathfindr | 47:cc6d4d0bf897 | 868 | if(RET_setting_connection_timeout < 60 || RET_setting_connection_timeout > 240) { RET_setting_connection_timeout = DEFAULT_CONNECTION_TIMEOUT; } |
pathfindr | 54:2840f2d50734 | 869 | if(TEMP_r > -1) { RET_setting_beacon_interval_seconds = TEMP_r; } |
pathfindr | 54:2840f2d50734 | 870 | if(TEMP_s > -1) { RET_setting_beacon_scan = TEMP_s; } |
pathfindr | 54:2840f2d50734 | 871 | if(TEMP_t > -1) { RET_setting_activity_mode = TEMP_t; } |
pathfindr | 51:9078e6928412 | 872 | if(TEMP_u[0] != 0x00 && TEMP_u[1] != 0x00 && TEMP_u[2] != 0x00) { strcpy(RET_pf_identifier,TEMP_u); } |
pathfindr | 45:6c7f5b556d74 | 873 | |
pathfindr | 19:22261767c87a | 874 | if (critical_fail_count == 0) { |
pathfindr | 45:6c7f5b556d74 | 875 | RET_receivedNewSettings = true; |
pathfindr | 51:9078e6928412 | 876 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "NEW SETTINGS");debug_exe();} |
pathfindr | 40:4270e09e59f2 | 877 | dumpSettings(); |
pathfindr | 32:dff4858bdf37 | 878 | RET_haveSettings = true; |
pathfindr | 34:4493c9f6d707 | 879 | GLOBAL_needToConfigureLis3dh = true; |
pathfindr | 32:dff4858bdf37 | 880 | RET_SettingsGotAt = RET_RTCunixtime; |
pathfindr | 37:505ef618f06c | 881 | //check for firmware update |
pathfindr | 38:476a9b5629a1 | 882 | if (RET_setting_firmware > 0 && RET_setting_firmware != FW_VERSION) { |
pathfindr | 48:64b1613941d5 | 883 | //Broadcast any activity data we have before fw update |
pathfindr | 48:64b1613941d5 | 884 | event_activity_tx(); |
pathfindr | 48:64b1613941d5 | 885 | //prep for FW update |
pathfindr | 52:bd7678eade77 | 886 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 887 | bleShutdown(); |
pathfindr | 52:bd7678eade77 | 888 | #endif |
pathfindr | 37:505ef618f06c | 889 | read_app_data_from_flash(&app_data); |
pathfindr | 45:6c7f5b556d74 | 890 | clr_flag(&app_data, app_execution_flag); |
pathfindr | 45:6c7f5b556d74 | 891 | clr_flag(&app_data, first_run_flag); |
pathfindr | 45:6c7f5b556d74 | 892 | app_data.current_firmware_version = FW_VERSION; |
pathfindr | 37:505ef618f06c | 893 | app_data.target_firmware_version = RET_setting_firmware; |
pathfindr | 37:505ef618f06c | 894 | write_app_data_to_flash(&app_data); |
pathfindr | 51:9078e6928412 | 895 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "OTA\n");debug_exe();} |
pathfindr | 48:64b1613941d5 | 896 | ThisThread::sleep_for(200); |
pathfindr | 37:505ef618f06c | 897 | system_reset(); |
pathfindr | 37:505ef618f06c | 898 | } |
pathfindr | 19:22261767c87a | 899 | return true; |
pathfindr | 19:22261767c87a | 900 | } else { |
pathfindr | 44:061509d1b38c | 901 | addToExceptionString("SCF"); |
pathfindr | 19:22261767c87a | 902 | return false; |
pathfindr | 19:22261767c87a | 903 | } |
pathfindr | 14:9a54b1b65bc8 | 904 | } else { |
pathfindr | 44:061509d1b38c | 905 | addToExceptionString("SPE"); |
pathfindr | 15:7aad9a7f970c | 906 | return false; |
pathfindr | 14:9a54b1b65bc8 | 907 | } |
pathfindr | 14:9a54b1b65bc8 | 908 | } |
pathfindr | 24:c161db07557f | 909 | |
pathfindr | 41:07e41dbd5304 | 910 | //------------------------------------------------------------------------------ |
pathfindr | 41:07e41dbd5304 | 911 | // SET EVENT TIMES |
pathfindr | 41:07e41dbd5304 | 912 | //------------------------------------------------------------------------------ |
pathfindr | 41:07e41dbd5304 | 913 | void setEventTime_Location() { |
pathfindr | 20:5404841fdd2b | 914 | if(RET_setting_location_tx_interval_mins > 0) { |
pathfindr | 20:5404841fdd2b | 915 | RET_eventTime_location_tx = (RET_RTCunixtime + (RET_setting_location_tx_interval_mins * 60)); |
pathfindr | 51:9078e6928412 | 916 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVTSET - LOC TX @ %u, MODE %d",RET_eventTime_location_tx, RET_setting_location_mode);debug_exe();} |
pathfindr | 20:5404841fdd2b | 917 | } |
pathfindr | 54:2840f2d50734 | 918 | if(RET_setting_location_tx_failsafe_hrs > 0 && RET_setting_location_tx_failsafe_hrs <= 168) { |
pathfindr | 54:2840f2d50734 | 919 | RET_location_failsafe_seconds_max = (RET_setting_location_tx_failsafe_hrs * 3600); |
pathfindr | 54:2840f2d50734 | 920 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVTSET - LOC FS TX %u s",RET_location_failsafe_seconds_max);debug_exe();} |
pathfindr | 54:2840f2d50734 | 921 | } else { |
pathfindr | 54:2840f2d50734 | 922 | RET_location_failsafe_seconds_max = (DEFAULT_LOCATION_TX_FAILSAFE_HRS * 3600); |
pathfindr | 20:5404841fdd2b | 923 | } |
pathfindr | 54:2840f2d50734 | 924 | RET_eventTime_location_failsafe_tx = (RET_RTCunixtime + RET_location_failsafe_seconds_max); |
pathfindr | 41:07e41dbd5304 | 925 | } |
pathfindr | 41:07e41dbd5304 | 926 | void setEventTime_Activity() { |
pathfindr | 22:810425eb76e1 | 927 | if(RET_setting_activity_tx_interval_hrs > 0) { |
pathfindr | 22:810425eb76e1 | 928 | RET_eventTime_activity_tx = (RET_RTCunixtime + (RET_setting_activity_tx_interval_hrs * 3600)); |
pathfindr | 51:9078e6928412 | 929 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVTSET - ACT TX @ %u",RET_eventTime_activity_tx);debug_exe();} |
pathfindr | 20:5404841fdd2b | 930 | } |
pathfindr | 41:07e41dbd5304 | 931 | } |
pathfindr | 41:07e41dbd5304 | 932 | void setEventTime_Environmental() { |
pathfindr | 20:5404841fdd2b | 933 | if(RET_eventTime_environmental_tx > 0) { |
pathfindr | 20:5404841fdd2b | 934 | RET_eventTime_environmental_tx = (RET_RTCunixtime + (RET_setting_environmental_tx_interval_mins * 60)); |
pathfindr | 51:9078e6928412 | 935 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "EVTSET - ENV TX @ %u",RET_eventTime_environmental_tx);debug_exe();} |
pathfindr | 34:4493c9f6d707 | 936 | } |
pathfindr | 20:5404841fdd2b | 937 | } |
pathfindr | 41:07e41dbd5304 | 938 | void setEventTimes() { |
pathfindr | 43:7b232f03628f | 939 | //SET ALL EVENT TIMES |
pathfindr | 41:07e41dbd5304 | 940 | setEventTime_Location(); |
pathfindr | 41:07e41dbd5304 | 941 | setEventTime_Activity(); |
pathfindr | 41:07e41dbd5304 | 942 | setEventTime_Environmental(); |
pathfindr | 41:07e41dbd5304 | 943 | } |
pathfindr | 13:29f67f256709 | 944 | |
pathfindr | 13:29f67f256709 | 945 | //------------------------------------------------------------------------------ |
pathfindr | 40:4270e09e59f2 | 946 | // ERROR LOG |
pathfindr | 40:4270e09e59f2 | 947 | //------------------------------------------------------------------------------ |
pathfindr | 40:4270e09e59f2 | 948 | void sendErrorLog(char* error) { |
pathfindr | 51:9078e6928412 | 949 | updateBatteryV(); |
pathfindr | 40:4270e09e59f2 | 950 | int timetaken = (RET_RTCunixtime - GLOBAL_wakeTime); |
pathfindr | 40:4270e09e59f2 | 951 | char bytestosend[100]; |
pathfindr | 40:4270e09e59f2 | 952 | memset(bytestosend,0x00,sizeof(bytestosend)); |
pathfindr | 52:bd7678eade77 | 953 | snprintf(bytestosend,sizeof(bytestosend),"(%s,a:log,f:%d,v:%.2f,e:%d,z:%s.%s,s:0)\0",GLOBAL_defaultApi,FW_VERSION,RET_voltage,timetaken,error,GLOBAL_exceptionString); |
pathfindr | 43:7b232f03628f | 954 | if (modem.on(RET_force2G)) { |
pathfindr | 48:64b1613941d5 | 955 | if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,RET_setting_connection_timeout,RET_NetworkFailCount)) { |
pathfindr | 51:9078e6928412 | 956 | modem.USSDmessage(bytestosend, false, GLOBAL_defaultApi); |
pathfindr | 43:7b232f03628f | 957 | } |
pathfindr | 43:7b232f03628f | 958 | } |
pathfindr | 40:4270e09e59f2 | 959 | ThisThread::sleep_for(250); |
pathfindr | 40:4270e09e59f2 | 960 | } |
pathfindr | 40:4270e09e59f2 | 961 | |
pathfindr | 40:4270e09e59f2 | 962 | //------------------------------------------------------------------------------ |
pathfindr | 43:7b232f03628f | 963 | // EVENTS |
pathfindr | 13:29f67f256709 | 964 | //------------------------------------------------------------------------------ |
pathfindr | 51:9078e6928412 | 965 | void failed_broadcast_log(char* eventstring) { |
pathfindr | 51:9078e6928412 | 966 | //First available free slot |
pathfindr | 51:9078e6928412 | 967 | bool saved = false; |
pathfindr | 51:9078e6928412 | 968 | for(int i = 0; i < sizeof(GLOBAL_failed_broadcast_slots); i++) { |
pathfindr | 51:9078e6928412 | 969 | if (GLOBAL_failed_broadcast_slots[i] == false) { |
pathfindr | 51:9078e6928412 | 970 | memset(GLOBAL_failed_broadcasts[i],0x00,sizeof(GLOBAL_failed_broadcasts[i])); //clear row |
pathfindr | 51:9078e6928412 | 971 | snprintf(GLOBAL_failed_broadcasts[i],sizeof(GLOBAL_failed_broadcasts[i]),"%s",eventstring); //save new row |
pathfindr | 51:9078e6928412 | 972 | GLOBAL_failed_broadcast_slots[i] = true; |
pathfindr | 51:9078e6928412 | 973 | saved = true; |
pathfindr | 51:9078e6928412 | 974 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Failed Broadcast saved: %s",eventstring);debug_exe();} |
pathfindr | 51:9078e6928412 | 975 | break; |
pathfindr | 51:9078e6928412 | 976 | } |
pathfindr | 51:9078e6928412 | 977 | } |
pathfindr | 51:9078e6928412 | 978 | if (!saved) { |
pathfindr | 51:9078e6928412 | 979 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Failed Broadcast save fail");debug_exe();} |
pathfindr | 51:9078e6928412 | 980 | } |
pathfindr | 51:9078e6928412 | 981 | return; |
pathfindr | 51:9078e6928412 | 982 | } |
pathfindr | 51:9078e6928412 | 983 | void failed_broadcasts_tx() { |
pathfindr | 52:bd7678eade77 | 984 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 985 | bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 986 | #endif |
pathfindr | 51:9078e6928412 | 987 | //check we have something to send... |
pathfindr | 51:9078e6928412 | 988 | int numbertosend = 0; |
pathfindr | 51:9078e6928412 | 989 | for(int i = 0; i < sizeof(GLOBAL_failed_broadcast_slots); i++) { |
pathfindr | 51:9078e6928412 | 990 | if (GLOBAL_failed_broadcast_slots[i] == true) { |
pathfindr | 51:9078e6928412 | 991 | numbertosend ++; |
pathfindr | 51:9078e6928412 | 992 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Retry:%s",GLOBAL_failed_broadcasts[i]);debug_exe();} |
pathfindr | 51:9078e6928412 | 993 | } |
pathfindr | 51:9078e6928412 | 994 | } |
pathfindr | 51:9078e6928412 | 995 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Failed Broadcasts to send:%d",numbertosend);debug_exe();} |
pathfindr | 51:9078e6928412 | 996 | for(int i = 0; i < sizeof(GLOBAL_failed_broadcast_slots); i++) { |
pathfindr | 51:9078e6928412 | 997 | if (GLOBAL_failed_broadcast_slots[i] == true) { |
pathfindr | 51:9078e6928412 | 998 | if (RET_NetworkFailCount <= DEFAULT_MAX_FAILED_CONNECTIONS) { |
pathfindr | 51:9078e6928412 | 999 | if (modem.on(RET_force2G)) { |
pathfindr | 51:9078e6928412 | 1000 | if (modem.registerOnNetwork(2,RET_setting_connection_timeout,RET_NetworkFailCount)) { |
pathfindr | 51:9078e6928412 | 1001 | char result[100]; |
pathfindr | 51:9078e6928412 | 1002 | bool getResponse = false; |
pathfindr | 51:9078e6928412 | 1003 | snprintf(result,sizeof(result),"%s",modem.USSDmessage(GLOBAL_failed_broadcasts[i], getResponse, GLOBAL_defaultApi)); |
pathfindr | 51:9078e6928412 | 1004 | if (strcmp(result, "sendok") == 0) { |
pathfindr | 51:9078e6928412 | 1005 | //clear row |
pathfindr | 51:9078e6928412 | 1006 | memset(GLOBAL_failed_broadcasts[i],0x00,sizeof(GLOBAL_failed_broadcasts[i])); |
pathfindr | 51:9078e6928412 | 1007 | GLOBAL_failed_broadcast_slots[i] = false; |
pathfindr | 51:9078e6928412 | 1008 | } |
pathfindr | 51:9078e6928412 | 1009 | } |
pathfindr | 51:9078e6928412 | 1010 | } |
pathfindr | 51:9078e6928412 | 1011 | } |
pathfindr | 51:9078e6928412 | 1012 | } |
pathfindr | 51:9078e6928412 | 1013 | } |
pathfindr | 51:9078e6928412 | 1014 | } |
pathfindr | 43:7b232f03628f | 1015 | bool event_setup(bool manualrun) { |
pathfindr | 52:bd7678eade77 | 1016 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 1017 | bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 1018 | #endif |
pathfindr | 51:9078e6928412 | 1019 | bool pass = false; |
pathfindr | 49:15ddd84ec9fa | 1020 | LED1on(0); |
pathfindr | 48:64b1613941d5 | 1021 | if (RET_NetworkFailCount > DEFAULT_MAX_FAILED_CONNECTIONS) addToExceptionString("NF"); |
pathfindr | 48:64b1613941d5 | 1022 | if (RET_GPSFailCount > DEFAULT_MAX_FAILED_GPS) addToExceptionString("GF"); |
pathfindr | 41:07e41dbd5304 | 1023 | RET_setupInProgress = true; |
pathfindr | 48:64b1613941d5 | 1024 | RET_NetworkFailCount = 0; |
pathfindr | 48:64b1613941d5 | 1025 | RET_GPSFailCount = 0; |
pathfindr | 49:15ddd84ec9fa | 1026 | RET_setting_connection_timeout = 180; //reset to longer value to setup run to help with connection |
pathfindr | 25:7adeb1a53360 | 1027 | bool selftestresult = selfTest(); |
pathfindr | 45:6c7f5b556d74 | 1028 | int connectionStartTime = RET_RTCunixtime; |
pathfindr | 38:476a9b5629a1 | 1029 | if (modem.on(RET_force2G)) { |
pathfindr | 48:64b1613941d5 | 1030 | if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,RET_setting_connection_timeout,RET_NetworkFailCount)) { |
pathfindr | 45:6c7f5b556d74 | 1031 | int timetaken_total = (RET_RTCunixtime - GLOBAL_wakeTime) + 10; //add 10 for ussd response time. |
pathfindr | 45:6c7f5b556d74 | 1032 | int timetaken_connection = (RET_RTCunixtime - connectionStartTime); |
pathfindr | 43:7b232f03628f | 1033 | if (manualrun) addToExceptionString("MAN"); |
pathfindr | 17:ba55c026b1d6 | 1034 | char bytestosend[160]; |
pathfindr | 52:bd7678eade77 | 1035 | snprintf(bytestosend,sizeof(bytestosend),"(%s,a:setup,f:%d,v:%.2f,t:%.1f,e:%d,y:%d,z:SETUP-%s,k:%s,m:%s,s:1)\0",GLOBAL_defaultApi,FW_VERSION,RET_voltage,RET_temperature,timetaken_total,timetaken_connection,GLOBAL_exceptionString,SKU,HW_MAJORREVISION); |
pathfindr | 34:4493c9f6d707 | 1036 | char result[200]; |
pathfindr | 51:9078e6928412 | 1037 | snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytestosend, true, GLOBAL_defaultApi)); |
pathfindr | 49:15ddd84ec9fa | 1038 | RET_setupInProgress = false; //this turns off the flashing led |
pathfindr | 51:9078e6928412 | 1039 | if (strcmp(result, "sendokrecfail") == 0) { |
pathfindr | 51:9078e6928412 | 1040 | //send ok but receive fail |
pathfindr | 51:9078e6928412 | 1041 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"USSD Send Ok but Rec fail");debug_exe();} |
pathfindr | 51:9078e6928412 | 1042 | sendErrorLog("ERR-SU-NR"); |
pathfindr | 51:9078e6928412 | 1043 | } else if (strcmp(result, "sendfail") == 0) { |
pathfindr | 51:9078e6928412 | 1044 | //do nothing |
pathfindr | 51:9078e6928412 | 1045 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"USSD Send Fail");debug_exe();} |
pathfindr | 51:9078e6928412 | 1046 | } else { |
pathfindr | 51:9078e6928412 | 1047 | if (saveSettings(result) == true) { |
pathfindr | 51:9078e6928412 | 1048 | pass = true; |
pathfindr | 51:9078e6928412 | 1049 | } else { |
pathfindr | 19:22261767c87a | 1050 | //something went critically wrong getting settings |
pathfindr | 48:64b1613941d5 | 1051 | sendErrorLog("ERR-SU-IR"); |
pathfindr | 51:9078e6928412 | 1052 | } |
pathfindr | 16:3bf5f1a5f869 | 1053 | } |
pathfindr | 13:29f67f256709 | 1054 | } |
pathfindr | 13:29f67f256709 | 1055 | } else { |
pathfindr | 19:22261767c87a | 1056 | //FAILUREMODE Modem failed to turn on |
pathfindr | 51:9078e6928412 | 1057 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"Modem Fail");debug_exe();} |
pathfindr | 13:29f67f256709 | 1058 | } |
pathfindr | 49:15ddd84ec9fa | 1059 | |
pathfindr | 49:15ddd84ec9fa | 1060 | //IF WE PASSED THEN LETS DO OTHER POSTS |
pathfindr | 49:15ddd84ec9fa | 1061 | if (pass == true) { |
pathfindr | 49:15ddd84ec9fa | 1062 | GLOBAL_wakeTime = RET_RTCunixtime; //lets reset this here so that the following loc and act function have sensible values for total time |
pathfindr | 49:15ddd84ec9fa | 1063 | //GET LOC DATA |
pathfindr | 52:bd7678eade77 | 1064 | //uint8_t previous_location_accuracy = RET_setting_location_accuracy; |
pathfindr | 52:bd7678eade77 | 1065 | //RET_setting_location_accuracy = 1; //set location mode to CL only |
pathfindr | 51:9078e6928412 | 1066 | event_location_tx(false); |
pathfindr | 52:bd7678eade77 | 1067 | //RET_setting_location_accuracy = previous_location_accuracy; //set location mode back to previous |
pathfindr | 49:15ddd84ec9fa | 1068 | //SEND ANY ACTIVITY DATA |
pathfindr | 49:15ddd84ec9fa | 1069 | event_activity_tx(); |
pathfindr | 49:15ddd84ec9fa | 1070 | LED1blink(4,500); //PASS AND END |
pathfindr | 49:15ddd84ec9fa | 1071 | } |
pathfindr | 49:15ddd84ec9fa | 1072 | |
pathfindr | 49:15ddd84ec9fa | 1073 | //TIDY UP = LOG RUN TIME - THIS MUST GO AT END AFTER WE HAVE GOT SERVER TIMESTAMP |
pathfindr | 21:e0b866630c27 | 1074 | RET_SetupRunAt = RET_RTCunixtime; |
pathfindr | 49:15ddd84ec9fa | 1075 | RET_GPSFailCount = 0; |
pathfindr | 49:15ddd84ec9fa | 1076 | RET_NetworkFailCount = 0; |
pathfindr | 52:bd7678eade77 | 1077 | setEventTimes(); |
pathfindr | 13:29f67f256709 | 1078 | //RESULT |
pathfindr | 19:22261767c87a | 1079 | return pass; |
pathfindr | 13:29f67f256709 | 1080 | } |
pathfindr | 39:f767b8037475 | 1081 | void event_turnonofflog_tx(bool turnon) { |
pathfindr | 52:bd7678eade77 | 1082 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 1083 | bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 1084 | #endif |
pathfindr | 48:64b1613941d5 | 1085 | RET_NetworkFailCount = 0; //reset network blocker |
pathfindr | 48:64b1613941d5 | 1086 | RET_GPSFailCount = 0; |
pathfindr | 51:9078e6928412 | 1087 | updateBatteryV(); |
pathfindr | 45:6c7f5b556d74 | 1088 | int connectionStartTime = RET_RTCunixtime; |
pathfindr | 39:f767b8037475 | 1089 | if (modem.on(RET_force2G)) { |
pathfindr | 39:f767b8037475 | 1090 | char locString[70]; |
pathfindr | 45:6c7f5b556d74 | 1091 | int gpsStartTime = RET_RTCunixtime; |
pathfindr | 48:64b1613941d5 | 1092 | memcpy(locString, modem.getLocation(1, RET_setting_location_timeout, RET_GPSFailCount, RET_NetworkFailCount), sizeof(locString)); |
pathfindr | 45:6c7f5b556d74 | 1093 | int timetaken_gps = (RET_RTCunixtime - gpsStartTime); |
pathfindr | 48:64b1613941d5 | 1094 | if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,RET_setting_connection_timeout,RET_NetworkFailCount)) { |
pathfindr | 45:6c7f5b556d74 | 1095 | int timetaken_total = (RET_RTCunixtime - GLOBAL_wakeTime); |
pathfindr | 45:6c7f5b556d74 | 1096 | int timetaken_connection = (RET_RTCunixtime - connectionStartTime); |
pathfindr | 39:f767b8037475 | 1097 | char bytestosend[160]; |
pathfindr | 39:f767b8037475 | 1098 | if (turnon) { |
pathfindr | 52:bd7678eade77 | 1099 | snprintf(bytestosend,sizeof(bytestosend),"(%s,a:log,f:%d,t:%.1f,v:%.2f,z:TURNON,e:%d,y:%d,x:%d,s:1%s)\0",GLOBAL_defaultApi,FW_VERSION,RET_temperature,RET_voltage,timetaken_total,timetaken_connection,timetaken_gps,locString); |
pathfindr | 39:f767b8037475 | 1100 | } else { |
pathfindr | 52:bd7678eade77 | 1101 | snprintf(bytestosend,sizeof(bytestosend),"(%s,a:log,f:%d,t:%.1f,v:%.2f,z:TURNOFF,e:%d,y:%d,x:%d,s:1%s)\0",GLOBAL_defaultApi,FW_VERSION,RET_temperature,RET_voltage,timetaken_total,timetaken_connection,timetaken_gps,locString); |
pathfindr | 39:f767b8037475 | 1102 | } |
pathfindr | 39:f767b8037475 | 1103 | char result[180]; |
pathfindr | 51:9078e6928412 | 1104 | snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytestosend, false, GLOBAL_defaultApi)); |
pathfindr | 39:f767b8037475 | 1105 | } |
pathfindr | 39:f767b8037475 | 1106 | } |
pathfindr | 39:f767b8037475 | 1107 | } |
pathfindr | 51:9078e6928412 | 1108 | void event_location_tx(bool failsafe) { |
pathfindr | 52:bd7678eade77 | 1109 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 1110 | bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 1111 | #endif |
pathfindr | 54:2840f2d50734 | 1112 | RET_lastTxTime = RET_RTCunixtime; |
pathfindr | 51:9078e6928412 | 1113 | //check if we have any outstanding to send |
pathfindr | 51:9078e6928412 | 1114 | failed_broadcasts_tx(); |
pathfindr | 49:15ddd84ec9fa | 1115 | bool selfTestResult = selfTest(); |
pathfindr | 52:bd7678eade77 | 1116 | bool skipTX = false; |
pathfindr | 51:9078e6928412 | 1117 | char bytesToSend[160]; |
pathfindr | 52:bd7678eade77 | 1118 | |
pathfindr | 52:bd7678eade77 | 1119 | //Check for Nearby Location Beacons |
pathfindr | 53:c6942af186d7 | 1120 | memset(RET_closestLocationTag_id, 0x00, sizeof(RET_closestLocationTag_id)); |
pathfindr | 53:c6942af186d7 | 1121 | RET_closestLocationTag_rssi = 999; |
pathfindr | 53:c6942af186d7 | 1122 | RET_locationTag_present = false; |
pathfindr | 53:c6942af186d7 | 1123 | RET_detector_present = false; |
pathfindr | 52:bd7678eade77 | 1124 | #if BLE_ENABLED |
pathfindr | 54:2840f2d50734 | 1125 | blecount = 0; |
pathfindr | 52:bd7678eade77 | 1126 | if (RET_setting_beacon_scan == 1 && RET_setting_location_mode != LOCATION_MODE_REALTIME) { |
pathfindr | 52:bd7678eade77 | 1127 | LowPowerTimer bleScan_t; |
pathfindr | 52:bd7678eade77 | 1128 | bleScan_t.start(); |
pathfindr | 52:bd7678eade77 | 1129 | uint32_t bleScan_startmillis = bleScan_t.read_ms(); uint32_t bleScan_runtime = 0; |
pathfindr | 52:bd7678eade77 | 1130 | if (!myble.hasInitialized()) { |
pathfindr | 52:bd7678eade77 | 1131 | myble.init(); |
pathfindr | 52:bd7678eade77 | 1132 | while (!myble.hasInitialized() && bleScan_runtime < 1000) { |
pathfindr | 52:bd7678eade77 | 1133 | bleScan_runtime = (bleScan_t.read_ms() - bleScan_startmillis); |
pathfindr | 52:bd7678eade77 | 1134 | } |
pathfindr | 52:bd7678eade77 | 1135 | } |
pathfindr | 52:bd7678eade77 | 1136 | if (myble.hasInitialized()) { |
pathfindr | 52:bd7678eade77 | 1137 | //Scan for 10 seconds |
pathfindr | 52:bd7678eade77 | 1138 | bleConfigureScan(); |
pathfindr | 52:bd7678eade77 | 1139 | bleScan_startmillis = bleScan_t.read_ms(); |
pathfindr | 54:2840f2d50734 | 1140 | while (bleScan_runtime < 20000 && RET_detector_present == false) { |
pathfindr | 52:bd7678eade77 | 1141 | bleScan_runtime = (bleScan_t.read_ms() - bleScan_startmillis); |
pathfindr | 52:bd7678eade77 | 1142 | myble.waitForEvent(); // low power wait for event |
pathfindr | 52:bd7678eade77 | 1143 | } |
pathfindr | 54:2840f2d50734 | 1144 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "BLECount: %d",blecount);debug_exe();} |
pathfindr | 53:c6942af186d7 | 1145 | if (RET_locationTag_present && RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "LocationTag: %s, rssi: %d",RET_closestLocationTag_id, RET_closestLocationTag_rssi);debug_exe();} |
pathfindr | 52:bd7678eade77 | 1146 | } |
pathfindr | 52:bd7678eade77 | 1147 | bleScan_t.stop(); |
pathfindr | 52:bd7678eade77 | 1148 | myble.gap().stopScan(); |
pathfindr | 52:bd7678eade77 | 1149 | } |
pathfindr | 52:bd7678eade77 | 1150 | //see if we are in range of ble detector, if so, no need to get gps and broadcast |
pathfindr | 52:bd7678eade77 | 1151 | if (RET_detector_present == true && RET_setting_beacon_interval_seconds > 0) { |
pathfindr | 52:bd7678eade77 | 1152 | skipTX = true; |
pathfindr | 52:bd7678eade77 | 1153 | } |
pathfindr | 52:bd7678eade77 | 1154 | #endif |
pathfindr | 52:bd7678eade77 | 1155 | |
pathfindr | 52:bd7678eade77 | 1156 | if (skipTX == false || failsafe == true) { |
pathfindr | 52:bd7678eade77 | 1157 | //Set any network or GPS fail flags |
pathfindr | 54:2840f2d50734 | 1158 | if (RET_NetworkFailCount > DEFAULT_MAX_FAILED_CONNECTIONS) {RET_NetworkFailFlag = true;} |
pathfindr | 54:2840f2d50734 | 1159 | if (RET_GPSFailCount > DEFAULT_MAX_FAILED_GPS) {addToExceptionString("GF");} |
pathfindr | 54:2840f2d50734 | 1160 | //lets check to see if we've had repeated comms failings in this location, if so dont bother trying. reset by movment and failsafe |
pathfindr | 52:bd7678eade77 | 1161 | if (RET_NetworkFailCount <= DEFAULT_MAX_FAILED_CONNECTIONS) { |
pathfindr | 54:2840f2d50734 | 1162 | if (RET_NetworkFailFlag) {RET_NetworkFailFlag = false; addToExceptionString("NF");} |
pathfindr | 54:2840f2d50734 | 1163 | if (RET_receivedNewSettings) {RET_receivedNewSettings = false; addToExceptionString("SR");} |
pathfindr | 52:bd7678eade77 | 1164 | if (modem.on(RET_force2G)) { |
pathfindr | 52:bd7678eade77 | 1165 | char locString[70]; |
pathfindr | 52:bd7678eade77 | 1166 | int gpsStartTime = RET_RTCunixtime; |
pathfindr | 52:bd7678eade77 | 1167 | |
pathfindr | 53:c6942af186d7 | 1168 | if (RET_locationTag_present) { |
pathfindr | 53:c6942af186d7 | 1169 | snprintf(locString, sizeof(locString), ",l:%s.%d\0",RET_closestLocationTag_id,RET_closestLocationTag_rssi); |
pathfindr | 53:c6942af186d7 | 1170 | addToExceptionString("BL"); |
pathfindr | 51:9078e6928412 | 1171 | } else { |
pathfindr | 53:c6942af186d7 | 1172 | //check if we have moved since last post, if not use same valid gps fix if exists |
pathfindr | 53:c6942af186d7 | 1173 | if (RET_motionStateOnInLocTXInterval == false && GLOBAL_have_GPSlocString_prev == true) { |
pathfindr | 53:c6942af186d7 | 1174 | memcpy(locString, GLOBAL_GPSlocString_prev, sizeof(locString)); |
pathfindr | 53:c6942af186d7 | 1175 | addToExceptionString("P"); |
pathfindr | 53:c6942af186d7 | 1176 | } else { |
pathfindr | 53:c6942af186d7 | 1177 | memcpy(locString, modem.getLocation(RET_setting_location_accuracy, RET_setting_location_timeout, RET_GPSFailCount, RET_NetworkFailCount), sizeof(locString)); |
pathfindr | 53:c6942af186d7 | 1178 | } |
pathfindr | 52:bd7678eade77 | 1179 | } |
pathfindr | 52:bd7678eade77 | 1180 | int timetaken_gps = (RET_RTCunixtime - gpsStartTime); |
pathfindr | 52:bd7678eade77 | 1181 | |
pathfindr | 52:bd7678eade77 | 1182 | //SEND DATA |
pathfindr | 52:bd7678eade77 | 1183 | int connectionStartTime = RET_RTCunixtime; |
pathfindr | 52:bd7678eade77 | 1184 | if (modem.registerOnNetwork(DEFAULT_CONNECTION_ATTEMPTS,RET_setting_connection_timeout,RET_NetworkFailCount)) { |
pathfindr | 52:bd7678eade77 | 1185 | int timetaken_total = (RET_RTCunixtime - GLOBAL_wakeTime) + 10; //add 10 for avg ussd response time. |
pathfindr | 52:bd7678eade77 | 1186 | int timetaken_connection = (RET_RTCunixtime - connectionStartTime); |
pathfindr | 52:bd7678eade77 | 1187 | //Check if we should wait for settings back |
pathfindr | 52:bd7678eade77 | 1188 | bool getSettings = true; |
pathfindr | 52:bd7678eade77 | 1189 | //work out if we need to get settings back |
pathfindr | 52:bd7678eade77 | 1190 | if ( ((RET_RTCunixtime - RET_SettingsGotAt)/3600) < RET_setting_minimumupdate_hrs ) { getSettings = false; timetaken_total -= 10;} //remove the extra 10 seconds from times |
pathfindr | 53:c6942af186d7 | 1191 | snprintf(bytesToSend,sizeof(bytesToSend),"(%s,a:loc,f:%d,t:%.0f,n:%.0f,q:%.0f,w:%.0f,v:%.1f,z:L%s,e:%d,y:%d,x:%d,j:%d,s:%d%s)\0",GLOBAL_defaultApi,FW_VERSION,RET_temperature,RET_temperature_min,RET_temperature_max,RET_humidity,RET_voltage,GLOBAL_exceptionString,timetaken_total,timetaken_connection,timetaken_gps,RET_motionStateOnInLocTXInterval,getSettings,locString); |
pathfindr | 52:bd7678eade77 | 1192 | //snprintf(bytesToSend,sizeof(bytesToSend),"(%s,a:loc,f:%d,t:%.0f,v:%.1f,z:L-%s,e:%d,y:%d,x:%d,j:%d,s:%d%s)\0",GLOBAL_defaultApi,FW_VERSION,RET_temperature,RET_voltage,GLOBAL_exceptionString,timetaken_total,timetaken_connection,timetaken_gps,RET_motionStateOnInLocTXInterval,getSettings,locString); |
pathfindr | 52:bd7678eade77 | 1193 | char result[180]; |
pathfindr | 52:bd7678eade77 | 1194 | snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytesToSend, getSettings, GLOBAL_defaultApi)); |
pathfindr | 52:bd7678eade77 | 1195 | if (getSettings == true && strcmp(result, "sendokrecfail") == 0) { |
pathfindr | 52:bd7678eade77 | 1196 | //send ok but receive fail |
pathfindr | 52:bd7678eade77 | 1197 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"USSD Send Ok but Rec fail");debug_exe();} |
pathfindr | 54:2840f2d50734 | 1198 | sendErrorLog("ERR-LOC-NR"); |
pathfindr | 52:bd7678eade77 | 1199 | } else if (strcmp(result, "sendok") == 0) { |
pathfindr | 52:bd7678eade77 | 1200 | //do nothing |
pathfindr | 52:bd7678eade77 | 1201 | } else if (strcmp(result, "sendfail") == 0) { |
pathfindr | 52:bd7678eade77 | 1202 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"USSD Send Fail");debug_exe();} |
pathfindr | 52:bd7678eade77 | 1203 | //need to log for retry |
pathfindr | 52:bd7678eade77 | 1204 | } else { |
pathfindr | 52:bd7678eade77 | 1205 | if (getSettings) { |
pathfindr | 52:bd7678eade77 | 1206 | if (saveSettings(result) == false){sendErrorLog("ERR-LOC-IR");} |
pathfindr | 52:bd7678eade77 | 1207 | } |
pathfindr | 48:64b1613941d5 | 1208 | } |
pathfindr | 22:810425eb76e1 | 1209 | } |
pathfindr | 22:810425eb76e1 | 1210 | } |
pathfindr | 22:810425eb76e1 | 1211 | } |
pathfindr | 20:5404841fdd2b | 1212 | } |
pathfindr | 20:5404841fdd2b | 1213 | //RESETS |
pathfindr | 52:bd7678eade77 | 1214 | RET_motionStateOnInLocTXInterval = false; |
pathfindr | 41:07e41dbd5304 | 1215 | setEventTime_Location(); |
pathfindr | 19:22261767c87a | 1216 | } |
pathfindr | 51:9078e6928412 | 1217 | void event_activity_tx() { |
pathfindr | 52:bd7678eade77 | 1218 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 1219 | bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 1220 | #endif |
pathfindr | 51:9078e6928412 | 1221 | //check if we have any outstanding to send |
pathfindr | 51:9078e6928412 | 1222 | failed_broadcasts_tx(); |
pathfindr | 51:9078e6928412 | 1223 | //check we have something to send... |
pathfindr | 51:9078e6928412 | 1224 | bool sendok = false; |
pathfindr | 51:9078e6928412 | 1225 | if (RET_motionTotalActivityHoursSincePost > 0.0f && RET_setting_activity_mode > 0) { |
pathfindr | 51:9078e6928412 | 1226 | //Build data to send |
pathfindr | 51:9078e6928412 | 1227 | char bytesToSend[160]; |
pathfindr | 51:9078e6928412 | 1228 | if (RET_setting_activity_mode == 1) { |
pathfindr | 52:bd7678eade77 | 1229 | snprintf(bytesToSend,sizeof(bytesToSend),"(%s,a:act,t:%u,r:%.2f,h:%.2f)\0",GLOBAL_defaultApi,RET_motionFrameStart,RET_motionTotalActivityHoursSincePost,RET_motionTotalActivityHours); |
pathfindr | 51:9078e6928412 | 1230 | } else if (RET_setting_activity_mode == 2) { |
pathfindr | 52:bd7678eade77 | 1231 | snprintf(bytesToSend,sizeof(bytesToSend),"(%s,a:act,e:%s,t:%u,r:%.2f)\0",GLOBAL_defaultApi,RET_activityData,RET_motionFrameStart,RET_motionTotalActivityHoursSincePost); |
pathfindr | 51:9078e6928412 | 1232 | } |
pathfindr | 51:9078e6928412 | 1233 | if (RET_NetworkFailCount <= DEFAULT_MAX_FAILED_CONNECTIONS) { |
pathfindr | 51:9078e6928412 | 1234 | if (modem.on(RET_force2G)) { |
pathfindr | 51:9078e6928412 | 1235 | //SEND DATA |
pathfindr | 51:9078e6928412 | 1236 | if (modem.registerOnNetwork(2,RET_setting_connection_timeout,RET_NetworkFailCount)) { |
pathfindr | 51:9078e6928412 | 1237 | char result[100]; |
pathfindr | 51:9078e6928412 | 1238 | bool getResponse = false; |
pathfindr | 51:9078e6928412 | 1239 | snprintf(result,sizeof(result),"%s",modem.USSDmessage(bytesToSend, getResponse, GLOBAL_defaultApi)); |
pathfindr | 51:9078e6928412 | 1240 | if (strcmp(result, "sendok") == 0) { |
pathfindr | 51:9078e6928412 | 1241 | sendok = true; |
pathfindr | 51:9078e6928412 | 1242 | //if(!RET_debug) {sendok = true;} //FOR TESTING |
pathfindr | 51:9078e6928412 | 1243 | } |
pathfindr | 51:9078e6928412 | 1244 | } |
pathfindr | 51:9078e6928412 | 1245 | } |
pathfindr | 51:9078e6928412 | 1246 | } |
pathfindr | 51:9078e6928412 | 1247 | //If send failed then log it for retry - only need to do this for mode 2, for mode the time just increments |
pathfindr | 51:9078e6928412 | 1248 | if (sendok == true) { |
pathfindr | 51:9078e6928412 | 1249 | if (RET_setting_activity_mode == 1) { |
pathfindr | 51:9078e6928412 | 1250 | RET_motionTotalActivityHoursSincePost = 0.0f; |
pathfindr | 51:9078e6928412 | 1251 | if (RET_haveSettings) { RET_motionFrameStart = RET_RTCunixtime; } |
pathfindr | 51:9078e6928412 | 1252 | } else if (RET_setting_activity_mode == 2) { |
pathfindr | 51:9078e6928412 | 1253 | RET_motionTotalActivityHoursSincePost = 0.0f; |
pathfindr | 51:9078e6928412 | 1254 | if (RET_haveSettings) { RET_motionFrameStart = RET_RTCunixtime; } |
pathfindr | 51:9078e6928412 | 1255 | } |
pathfindr | 51:9078e6928412 | 1256 | } else if (sendok == false) { |
pathfindr | 51:9078e6928412 | 1257 | if (RET_setting_activity_mode == 1) { |
pathfindr | 51:9078e6928412 | 1258 | //do nothing |
pathfindr | 51:9078e6928412 | 1259 | } else if (RET_setting_activity_mode == 2) { |
pathfindr | 51:9078e6928412 | 1260 | failed_broadcast_log(bytesToSend); |
pathfindr | 51:9078e6928412 | 1261 | RET_motionTotalActivityHoursSincePost = 0.0f; |
pathfindr | 51:9078e6928412 | 1262 | if (RET_haveSettings) { RET_motionFrameStart = RET_RTCunixtime; } |
pathfindr | 51:9078e6928412 | 1263 | } |
pathfindr | 51:9078e6928412 | 1264 | } |
pathfindr | 51:9078e6928412 | 1265 | } |
pathfindr | 51:9078e6928412 | 1266 | //RESETS |
pathfindr | 51:9078e6928412 | 1267 | memset(RET_activityData,0x00,sizeof(RET_activityData)); |
pathfindr | 51:9078e6928412 | 1268 | setEventTime_Activity(); |
pathfindr | 48:64b1613941d5 | 1269 | } |
pathfindr | 24:c161db07557f | 1270 | |
pathfindr | 7:e9a19750700d | 1271 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 1272 | // STATE ENGINE |
pathfindr | 7:e9a19750700d | 1273 | //------------------------------------------------------------------------------ |
pathfindr | 6:388d3c7efdd9 | 1274 | void mainStateEngine() { |
pathfindr | 16:3bf5f1a5f869 | 1275 | switch(RET_state) { |
pathfindr | 16:3bf5f1a5f869 | 1276 | case STATE_SETUP : |
pathfindr | 34:4493c9f6d707 | 1277 | { //need the curlies to avoid "transfer of control bypass init error warning" |
pathfindr | 48:64b1613941d5 | 1278 | RET_busy = true; |
pathfindr | 41:07e41dbd5304 | 1279 | //check that we havent run setup too recently |
pathfindr | 41:07e41dbd5304 | 1280 | time_t setupRunAt_delta = (RET_RTCunixtime - RET_SetupRunAt); |
pathfindr | 49:15ddd84ec9fa | 1281 | if (RET_SetupRunAt == 0 || setupRunAt_delta >= ONEDAYINSECONDS) { |
pathfindr | 51:9078e6928412 | 1282 | updateBatteryV(); |
pathfindr | 43:7b232f03628f | 1283 | if (event_setup(false)) { |
pathfindr | 41:07e41dbd5304 | 1284 | // All good |
pathfindr | 41:07e41dbd5304 | 1285 | setState(STATE_NORMAL); |
pathfindr | 41:07e41dbd5304 | 1286 | } else { |
pathfindr | 41:07e41dbd5304 | 1287 | RET_eventTime_wakeFromDormant = (RET_RTCunixtime + ONEDAYINSECONDS); |
pathfindr | 41:07e41dbd5304 | 1288 | setState(STATE_DORMANT); |
pathfindr | 51:9078e6928412 | 1289 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"SETUP FAILED:DORMANT until %u\n",RET_eventTime_wakeFromDormant);debug_exe();} |
pathfindr | 41:07e41dbd5304 | 1290 | } |
pathfindr | 19:22261767c87a | 1291 | } else { |
pathfindr | 41:07e41dbd5304 | 1292 | time_t setupCanRunAt = (RET_RTCunixtime + (ONEDAYINSECONDS - setupRunAt_delta)); |
pathfindr | 51:9078e6928412 | 1293 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"SETUP CAN RUN AGAIN @%u \n",setupCanRunAt);debug_exe();} |
pathfindr | 13:29f67f256709 | 1294 | } |
pathfindr | 48:64b1613941d5 | 1295 | RET_busy = false; |
pathfindr | 6:388d3c7efdd9 | 1296 | break; |
pathfindr | 34:4493c9f6d707 | 1297 | } |
pathfindr | 16:3bf5f1a5f869 | 1298 | case STATE_NORMAL : |
pathfindr | 48:64b1613941d5 | 1299 | { |
pathfindr | 48:64b1613941d5 | 1300 | RET_busy = true; |
pathfindr | 24:c161db07557f | 1301 | //LOCATION EVENT |
pathfindr | 19:22261767c87a | 1302 | bool run_location_tx = false; |
pathfindr | 27:fa76f5a08195 | 1303 | switch (RET_setting_location_mode) { |
pathfindr | 27:fa76f5a08195 | 1304 | case 1: //INTERVAL POST |
pathfindr | 27:fa76f5a08195 | 1305 | if(RET_RTCunixtime >= RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { run_location_tx = true; } |
pathfindr | 27:fa76f5a08195 | 1306 | break; |
pathfindr | 27:fa76f5a08195 | 1307 | case 2: //INTERVAL POST WITH MOTION CHECK |
pathfindr | 40:4270e09e59f2 | 1308 | if(RET_RTCunixtime >= RET_eventTime_location_tx && RET_eventTime_location_tx > 0) { |
pathfindr | 52:bd7678eade77 | 1309 | if (RET_motionStateOnInLocTXInterval == true || RET_motionState == true) { |
pathfindr | 40:4270e09e59f2 | 1310 | run_location_tx = true; |
pathfindr | 40:4270e09e59f2 | 1311 | } else { |
pathfindr | 52:bd7678eade77 | 1312 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "Skip TX no mot\n");debug_exe();} |
pathfindr | 40:4270e09e59f2 | 1313 | } |
pathfindr | 40:4270e09e59f2 | 1314 | } |
pathfindr | 27:fa76f5a08195 | 1315 | break; |
pathfindr | 27:fa76f5a08195 | 1316 | case 3: //POST ON STOP MOTION |
pathfindr | 52:bd7678eade77 | 1317 | if (GLOBAL_motionStopFlagTriggered) { GLOBAL_motionStopFlagTriggered = false; run_location_tx = true; } |
pathfindr | 27:fa76f5a08195 | 1318 | break; |
pathfindr | 27:fa76f5a08195 | 1319 | } |
pathfindr | 54:2840f2d50734 | 1320 | if(run_location_tx == false && RET_location_failsafe_seconds_count >= RET_location_failsafe_seconds_max) { |
pathfindr | 54:2840f2d50734 | 1321 | RET_location_failsafe_seconds_count = 0; //reset |
pathfindr | 48:64b1613941d5 | 1322 | RET_NetworkFailCount = 0; //reset to ensure connection |
pathfindr | 48:64b1613941d5 | 1323 | RET_GPSFailCount = 0; // reset to ensure gps try |
pathfindr | 52:bd7678eade77 | 1324 | addToExceptionString("FS"); |
pathfindr | 51:9078e6928412 | 1325 | updateBatteryV(); |
pathfindr | 51:9078e6928412 | 1326 | event_location_tx(true); |
pathfindr | 51:9078e6928412 | 1327 | } else { |
pathfindr | 54:2840f2d50734 | 1328 | if (run_location_tx) { |
pathfindr | 54:2840f2d50734 | 1329 | updateBatteryV(); |
pathfindr | 54:2840f2d50734 | 1330 | event_location_tx(false); |
pathfindr | 54:2840f2d50734 | 1331 | } |
pathfindr | 48:64b1613941d5 | 1332 | } |
pathfindr | 19:22261767c87a | 1333 | |
pathfindr | 24:c161db07557f | 1334 | //ACTIVITY EVENT |
pathfindr | 24:c161db07557f | 1335 | bool run_activity_tx = false; |
pathfindr | 45:6c7f5b556d74 | 1336 | if(RET_RTCunixtime >= RET_eventTime_activity_tx && RET_eventTime_activity_tx > 0) { |
pathfindr | 48:64b1613941d5 | 1337 | if (RET_setting_activity_mode == 1 && RET_motionTotalActivityHoursSincePost > 0.0f) { |
pathfindr | 45:6c7f5b556d74 | 1338 | run_activity_tx = true; |
pathfindr | 45:6c7f5b556d74 | 1339 | } |
pathfindr | 45:6c7f5b556d74 | 1340 | if (RET_setting_activity_mode == 2 && strlen(RET_activityData) > 1) { |
pathfindr | 45:6c7f5b556d74 | 1341 | run_activity_tx = true; |
pathfindr | 45:6c7f5b556d74 | 1342 | } |
pathfindr | 9:b0a1535b8ef2 | 1343 | } |
pathfindr | 45:6c7f5b556d74 | 1344 | //If in sendevent mode, check if buffer is close to full, if so send |
pathfindr | 45:6c7f5b556d74 | 1345 | if (RET_setting_activity_mode == 2 && strlen(RET_activityData) > (ACTIVITY_BUFFERSIZE-20)) { run_activity_tx = true; } |
pathfindr | 48:64b1613941d5 | 1346 | if (run_activity_tx) { event_activity_tx(); } |
pathfindr | 48:64b1613941d5 | 1347 | |
pathfindr | 48:64b1613941d5 | 1348 | RET_busy = false; |
pathfindr | 9:b0a1535b8ef2 | 1349 | break; |
pathfindr | 34:4493c9f6d707 | 1350 | } |
pathfindr | 16:3bf5f1a5f869 | 1351 | case STATE_DORMANT : |
pathfindr | 34:4493c9f6d707 | 1352 | { |
pathfindr | 50:a94e70c00fff | 1353 | RET_busy = true; |
pathfindr | 22:810425eb76e1 | 1354 | if (RET_RTCunixtime >= RET_eventTime_wakeFromDormant) { |
pathfindr | 22:810425eb76e1 | 1355 | if (RET_haveSettings) { |
pathfindr | 22:810425eb76e1 | 1356 | setState(STATE_NORMAL); |
pathfindr | 22:810425eb76e1 | 1357 | } else { |
pathfindr | 22:810425eb76e1 | 1358 | setState(STATE_SETUP); |
pathfindr | 22:810425eb76e1 | 1359 | } |
pathfindr | 7:e9a19750700d | 1360 | } |
pathfindr | 51:9078e6928412 | 1361 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"STATE:DORMANT until %u Prev S:%d\n",RET_eventTime_wakeFromDormant,RET_state_prev);debug_exe();} |
pathfindr | 50:a94e70c00fff | 1362 | RET_busy = false; |
pathfindr | 12:8345612bf867 | 1363 | break; |
pathfindr | 34:4493c9f6d707 | 1364 | } |
pathfindr | 16:3bf5f1a5f869 | 1365 | case STATE_BUTTONPRESS1 : |
pathfindr | 34:4493c9f6d707 | 1366 | { |
pathfindr | 50:a94e70c00fff | 1367 | RET_busy = true; |
pathfindr | 51:9078e6928412 | 1368 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"BUTTON PRESS 1\n");debug_exe();} |
pathfindr | 51:9078e6928412 | 1369 | updateBatteryV(); |
pathfindr | 51:9078e6928412 | 1370 | if (RET_voltage < 2.5f) { |
pathfindr | 48:64b1613941d5 | 1371 | LED1blink(3,500); |
pathfindr | 48:64b1613941d5 | 1372 | } else if (selfTest() == false){ |
pathfindr | 48:64b1613941d5 | 1373 | LED1blink(4,500); |
pathfindr | 48:64b1613941d5 | 1374 | } else { |
pathfindr | 48:64b1613941d5 | 1375 | if(RET_state_prev == STATE_DORMANT) { |
pathfindr | 48:64b1613941d5 | 1376 | LED1on(500); |
pathfindr | 48:64b1613941d5 | 1377 | } else if (RET_state_prev == STATE_NORMAL) { |
pathfindr | 48:64b1613941d5 | 1378 | LED1blink(2,500); |
pathfindr | 48:64b1613941d5 | 1379 | } |
pathfindr | 48:64b1613941d5 | 1380 | } |
pathfindr | 50:a94e70c00fff | 1381 | if (RET_state_prev != STATE_NORMAL || RET_state_prev != STATE_DORMANT) { |
pathfindr | 50:a94e70c00fff | 1382 | setState(STATE_NORMAL); |
pathfindr | 50:a94e70c00fff | 1383 | } else { |
pathfindr | 50:a94e70c00fff | 1384 | setState(RET_state_prev); |
pathfindr | 50:a94e70c00fff | 1385 | } |
pathfindr | 51:9078e6928412 | 1386 | dumpSettings(); |
pathfindr | 50:a94e70c00fff | 1387 | RET_busy = false; |
pathfindr | 28:24b02608fa5f | 1388 | break; |
pathfindr | 34:4493c9f6d707 | 1389 | } |
pathfindr | 28:24b02608fa5f | 1390 | case STATE_BUTTONPRESS3 : |
pathfindr | 34:4493c9f6d707 | 1391 | { |
pathfindr | 50:a94e70c00fff | 1392 | RET_busy = true; |
pathfindr | 48:64b1613941d5 | 1393 | if(RET_state_prev == STATE_DORMANT || RET_state_prev == STATE_NORMAL) { |
pathfindr | 51:9078e6928412 | 1394 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"BUTTON PRESS 3\n");debug_exe();} |
pathfindr | 48:64b1613941d5 | 1395 | LED1blink(3,500); |
pathfindr | 48:64b1613941d5 | 1396 | LED1on(0); |
pathfindr | 51:9078e6928412 | 1397 | updateBatteryV(); |
pathfindr | 48:64b1613941d5 | 1398 | event_setup(true); |
pathfindr | 48:64b1613941d5 | 1399 | LED1off(); |
pathfindr | 48:64b1613941d5 | 1400 | } |
pathfindr | 48:64b1613941d5 | 1401 | setState(STATE_NORMAL); //turns device back on |
pathfindr | 50:a94e70c00fff | 1402 | RET_busy = false; |
pathfindr | 48:64b1613941d5 | 1403 | break; |
pathfindr | 48:64b1613941d5 | 1404 | } |
pathfindr | 48:64b1613941d5 | 1405 | case STATE_BUTTONPRESS5 : |
pathfindr | 48:64b1613941d5 | 1406 | { |
pathfindr | 50:a94e70c00fff | 1407 | RET_busy = true; |
pathfindr | 48:64b1613941d5 | 1408 | if(RET_state_prev == STATE_DORMANT || RET_state_prev == STATE_NORMAL) { |
pathfindr | 51:9078e6928412 | 1409 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"BUTTON PRESS 5\n");debug_exe();} |
pathfindr | 48:64b1613941d5 | 1410 | LED1blink(5,500); |
pathfindr | 48:64b1613941d5 | 1411 | LED1on(0); |
pathfindr | 51:9078e6928412 | 1412 | updateBatteryV(); |
pathfindr | 51:9078e6928412 | 1413 | event_location_tx(false); |
pathfindr | 48:64b1613941d5 | 1414 | LED1off(); |
pathfindr | 48:64b1613941d5 | 1415 | } |
pathfindr | 48:64b1613941d5 | 1416 | setState(STATE_NORMAL); //turns device back on |
pathfindr | 50:a94e70c00fff | 1417 | RET_busy = false; |
pathfindr | 9:b0a1535b8ef2 | 1418 | break; |
pathfindr | 34:4493c9f6d707 | 1419 | } |
pathfindr | 51:9078e6928412 | 1420 | case STATE_TURNOFF : |
pathfindr | 34:4493c9f6d707 | 1421 | { |
pathfindr | 50:a94e70c00fff | 1422 | RET_busy = true; |
pathfindr | 51:9078e6928412 | 1423 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"BUTTON HOLD \n");debug_exe();} |
pathfindr | 51:9078e6928412 | 1424 | RET_eventTime_wakeFromDormant = (RET_RTCunixtime + THREEDAYSINSECONDS); |
pathfindr | 51:9078e6928412 | 1425 | setState(STATE_DORMANT); |
pathfindr | 51:9078e6928412 | 1426 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"TURNING OFF\n");debug_exe();} |
pathfindr | 51:9078e6928412 | 1427 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"STATE:DORMANT until %u\n",RET_eventTime_wakeFromDormant);debug_exe();} |
pathfindr | 51:9078e6928412 | 1428 | LED1on(5000); |
pathfindr | 51:9078e6928412 | 1429 | //event_turnonofflog_tx(false); |
pathfindr | 51:9078e6928412 | 1430 | RET_busy = false; |
pathfindr | 51:9078e6928412 | 1431 | break; |
pathfindr | 51:9078e6928412 | 1432 | } |
pathfindr | 51:9078e6928412 | 1433 | case STATE_TURNON : |
pathfindr | 51:9078e6928412 | 1434 | { |
pathfindr | 51:9078e6928412 | 1435 | RET_busy = true; |
pathfindr | 51:9078e6928412 | 1436 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"BUTTON HOLD \n");debug_exe();} |
pathfindr | 51:9078e6928412 | 1437 | if (RET_haveSettings) { |
pathfindr | 51:9078e6928412 | 1438 | setState(STATE_NORMAL); |
pathfindr | 19:22261767c87a | 1439 | } else { |
pathfindr | 51:9078e6928412 | 1440 | setState(STATE_SETUP); |
pathfindr | 19:22261767c87a | 1441 | } |
pathfindr | 51:9078e6928412 | 1442 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"TURNING ON\n");debug_exe();} |
pathfindr | 51:9078e6928412 | 1443 | LED1blink(20,100); |
pathfindr | 50:a94e70c00fff | 1444 | RET_busy = false; |
pathfindr | 6:388d3c7efdd9 | 1445 | break; |
pathfindr | 34:4493c9f6d707 | 1446 | } |
pathfindr | 39:f767b8037475 | 1447 | case STATE_SCORCHEDEARTH : |
pathfindr | 39:f767b8037475 | 1448 | { |
pathfindr | 50:a94e70c00fff | 1449 | RET_busy = true; |
pathfindr | 51:9078e6928412 | 1450 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"SCORCHED EARTH - RESETTING");debug_exe();} |
pathfindr | 39:f767b8037475 | 1451 | setState(STATE_SETUP); //this wont be used but just incase to kick it out of this state |
pathfindr | 39:f767b8037475 | 1452 | read_app_data_from_flash(&app_data); |
pathfindr | 39:f767b8037475 | 1453 | app_data.current_firmware_version = 0; |
pathfindr | 39:f767b8037475 | 1454 | app_data.target_firmware_version = 0; |
pathfindr | 39:f767b8037475 | 1455 | write_app_data_to_flash(&app_data); |
pathfindr | 39:f767b8037475 | 1456 | system_reset(); |
pathfindr | 50:a94e70c00fff | 1457 | RET_busy = false; |
pathfindr | 39:f767b8037475 | 1458 | break; |
pathfindr | 39:f767b8037475 | 1459 | } |
pathfindr | 6:388d3c7efdd9 | 1460 | default : |
pathfindr | 34:4493c9f6d707 | 1461 | { |
pathfindr | 19:22261767c87a | 1462 | setState(STATE_SETUP); |
pathfindr | 34:4493c9f6d707 | 1463 | } |
pathfindr | 6:388d3c7efdd9 | 1464 | } |
pathfindr | 6:388d3c7efdd9 | 1465 | } |
pathfindr | 6:388d3c7efdd9 | 1466 | |
pathfindr | 7:e9a19750700d | 1467 | //------------------------------------------------------------------------------ |
pathfindr | 7:e9a19750700d | 1468 | // MAIN |
pathfindr | 7:e9a19750700d | 1469 | //------------------------------------------------------------------------------ |
pathfindr | 50:a94e70c00fff | 1470 | int main() { |
pathfindr | 24:c161db07557f | 1471 | //INIT |
pathfindr | 51:9078e6928412 | 1472 | LED1off(); |
pathfindr | 51:9078e6928412 | 1473 | ThisThread::sleep_for(2000); //Initial pause, this is needed for softdevice to init, dont remove!! If we dont have this we get crashes |
pathfindr | 54:2840f2d50734 | 1474 | watchdog.configure(400.0); //6.6 mins //Do not set to less than 4500ms or can cause issues with softdevice |
pathfindr | 43:7b232f03628f | 1475 | modem.off(false); |
pathfindr | 24:c161db07557f | 1476 | RTCticker.attach(&RTCtick, 1.0); |
pathfindr | 51:9078e6928412 | 1477 | LPtimer.start(); |
pathfindr | 34:4493c9f6d707 | 1478 | button.fall(&buttonPress); |
pathfindr | 24:c161db07557f | 1479 | button.rise(&buttonRelease); |
pathfindr | 43:7b232f03628f | 1480 | read_app_data_from_flash(&app_data); |
pathfindr | 34:4493c9f6d707 | 1481 | dumpSettings(); |
pathfindr | 4:8d8e9bfa82e4 | 1482 | |
pathfindr | 4:8d8e9bfa82e4 | 1483 | //CHECK IF THIS IS RESET |
pathfindr | 43:7b232f03628f | 1484 | //0x00000008 == lock up //0x00000004 == soft reset //0x00000002 == watchdog //0x00000001 == button/hardreset |
pathfindr | 4:8d8e9bfa82e4 | 1485 | if (NRF_POWER->RESETREAS != 0xffffffff) { |
pathfindr | 43:7b232f03628f | 1486 | RET_coldBoot = 1; |
pathfindr | 4:8d8e9bfa82e4 | 1487 | switch(NRF_POWER->RESETREAS) { |
pathfindr | 4:8d8e9bfa82e4 | 1488 | case 0x00000001 : |
pathfindr | 52:bd7678eade77 | 1489 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"RR:HW\n");debug_exe();} |
pathfindr | 54:2840f2d50734 | 1490 | addToExceptionString("RH"); |
pathfindr | 4:8d8e9bfa82e4 | 1491 | break; |
pathfindr | 4:8d8e9bfa82e4 | 1492 | case 0x00000002 : |
pathfindr | 52:bd7678eade77 | 1493 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"RR:WD\n");debug_exe();} |
pathfindr | 54:2840f2d50734 | 1494 | addToExceptionString("WD"); |
pathfindr | 4:8d8e9bfa82e4 | 1495 | break; |
pathfindr | 4:8d8e9bfa82e4 | 1496 | case 0x00000004 : |
pathfindr | 52:bd7678eade77 | 1497 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"RR:SW\n");debug_exe();} |
pathfindr | 54:2840f2d50734 | 1498 | addToExceptionString("RS"); |
pathfindr | 4:8d8e9bfa82e4 | 1499 | break; |
pathfindr | 43:7b232f03628f | 1500 | case 0x00000008 : |
pathfindr | 52:bd7678eade77 | 1501 | if(RET_debug){debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"RR:LU\n");debug_exe();} |
pathfindr | 54:2840f2d50734 | 1502 | addToExceptionString("RL"); |
pathfindr | 43:7b232f03628f | 1503 | break; |
pathfindr | 4:8d8e9bfa82e4 | 1504 | } |
pathfindr | 36:8e359069192b | 1505 | NRF_POWER->RESETREAS = 0xffffffff; |
pathfindr | 4:8d8e9bfa82e4 | 1506 | } |
pathfindr | 24:c161db07557f | 1507 | |
pathfindr | 9:b0a1535b8ef2 | 1508 | //CHECK FOR FIRST BOOT |
pathfindr | 52:bd7678eade77 | 1509 | if (RET_coldBoot == 1) { |
pathfindr | 52:bd7678eade77 | 1510 | memset(RET_activityData,0x00,sizeof(RET_activityData)); |
pathfindr | 52:bd7678eade77 | 1511 | lis3dh_configureForSleep(DEFAULT_MOTION_G,DEFAULT_IMPACT_G); |
pathfindr | 51:9078e6928412 | 1512 | updateBatteryV(); |
pathfindr | 52:bd7678eade77 | 1513 | if (RET_voltage < 2.5f) { LED1errorCode(10,2);} |
pathfindr | 43:7b232f03628f | 1514 | addToExceptionString("FR"); |
pathfindr | 24:c161db07557f | 1515 | } |
pathfindr | 13:29f67f256709 | 1516 | |
pathfindr | 34:4493c9f6d707 | 1517 | //MAIN LOOP |
pathfindr | 52:bd7678eade77 | 1518 | while(true) { |
pathfindr | 39:f767b8037475 | 1519 | RET_asleep = false; |
pathfindr | 52:bd7678eade77 | 1520 | watchdogKick(); |
pathfindr | 51:9078e6928412 | 1521 | updateTemperatures(); |
pathfindr | 52:bd7678eade77 | 1522 | resetSessionVars(); |
pathfindr | 39:f767b8037475 | 1523 | healthCheck(); //this must be after resetGlobals |
pathfindr | 13:29f67f256709 | 1524 | GLOBAL_wakeTime = RET_RTCunixtime; |
pathfindr | 11:60eb0ff945f2 | 1525 | |
pathfindr | 40:4270e09e59f2 | 1526 | //check and log motion |
pathfindr | 48:64b1613941d5 | 1527 | if (RET_state == STATE_NORMAL || RET_state == STATE_SETUP) { |
pathfindr | 52:bd7678eade77 | 1528 | if (checkMotion() == true) { //if motionstate is true, then reset network and gps fail counts, so that they are not skipped |
pathfindr | 48:64b1613941d5 | 1529 | RET_NetworkFailCount = 0; |
pathfindr | 48:64b1613941d5 | 1530 | RET_GPSFailCount = 0; |
pathfindr | 48:64b1613941d5 | 1531 | } |
pathfindr | 48:64b1613941d5 | 1532 | } |
pathfindr | 40:4270e09e59f2 | 1533 | |
pathfindr | 9:b0a1535b8ef2 | 1534 | //MAIN LOGIC |
pathfindr | 51:9078e6928412 | 1535 | if(RET_debug){ |
pathfindr | 39:f767b8037475 | 1536 | if (RET_state != 99) { |
pathfindr | 54:2840f2d50734 | 1537 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "F:%d, S:%d, SET:%d, MF:%d, MS:%d, MTX:%d, %u, L:%u, FSC:%u FSM:%u, FST:%u, A:%u", FW_VERSION, RET_state, RET_haveSettings, RET_motionTriggeredinFrame, RET_motionState, RET_motionStateOnInLocTXInterval, RET_RTCunixtime,RET_eventTime_location_tx,RET_location_failsafe_seconds_count,RET_location_failsafe_seconds_max,RET_eventTime_location_failsafe_tx,RET_eventTime_activity_tx);debug_exe(); |
pathfindr | 51:9078e6928412 | 1538 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "ACT M:%d, HsP:%.2f, Ht:%.2f, D:%s",RET_setting_activity_mode,RET_motionTotalActivityHoursSincePost,RET_motionTotalActivityHours,RET_activityData);debug_exe(); |
pathfindr | 39:f767b8037475 | 1539 | } else { |
pathfindr | 43:7b232f03628f | 1540 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "F:%d, S:%d, WAKE@:%u\n", FW_VERSION, RET_state, RET_eventTime_wakeFromDormant);debug_exe(); |
pathfindr | 39:f767b8037475 | 1541 | } |
pathfindr | 51:9078e6928412 | 1542 | if (RET_coldBoot == false && RET_RTCunixtime > RET_debug_offat) { |
pathfindr | 51:9078e6928412 | 1543 | debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer),"DEBUGGING OFF\n");debug_exe(); |
pathfindr | 51:9078e6928412 | 1544 | RET_debug = false; |
pathfindr | 51:9078e6928412 | 1545 | } |
pathfindr | 38:476a9b5629a1 | 1546 | } |
pathfindr | 37:505ef618f06c | 1547 | |
pathfindr | 42:f482f4cdb319 | 1548 | //STATE ENGINE |
pathfindr | 9:b0a1535b8ef2 | 1549 | mainStateEngine(); |
pathfindr | 51:9078e6928412 | 1550 | |
pathfindr | 34:4493c9f6d707 | 1551 | //LOG FIRST RUN - BOOTLOADER COMMS |
pathfindr | 34:4493c9f6d707 | 1552 | if (RET_coldBoot) { |
pathfindr | 45:6c7f5b556d74 | 1553 | recordFirmwareAsValid(); |
pathfindr | 34:4493c9f6d707 | 1554 | RET_coldBoot = 0; |
pathfindr | 34:4493c9f6d707 | 1555 | } |
pathfindr | 51:9078e6928412 | 1556 | |
pathfindr | 52:bd7678eade77 | 1557 | //CONFIGURE BLE BEACON BROADCAST |
pathfindr | 52:bd7678eade77 | 1558 | #if BLE_ENABLED |
pathfindr | 52:bd7678eade77 | 1559 | //see if we are in range of ble detector, if so, no need to get gps and broadcast |
pathfindr | 52:bd7678eade77 | 1560 | if (RET_setting_beacon_interval_seconds > 0 && RET_pf_identifier[0] != 0x00 && RET_pf_identifier[1] != 0x00 && RET_pf_identifier[2] != 0x00) { |
pathfindr | 52:bd7678eade77 | 1561 | if (RET_bleBroadcasting == false) { |
pathfindr | 52:bd7678eade77 | 1562 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "BLE init...");debug_exe();} |
pathfindr | 52:bd7678eade77 | 1563 | myble.init(bleSetupAdvertising); |
pathfindr | 52:bd7678eade77 | 1564 | if (myble.hasInitialized()) { |
pathfindr | 52:bd7678eade77 | 1565 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "OK");debug_exe();} |
pathfindr | 52:bd7678eade77 | 1566 | bleUpdateAndAdvertise(); |
pathfindr | 52:bd7678eade77 | 1567 | } else { |
pathfindr | 52:bd7678eade77 | 1568 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "FAIL");debug_exe();} |
pathfindr | 52:bd7678eade77 | 1569 | } |
pathfindr | 52:bd7678eade77 | 1570 | } else { |
pathfindr | 52:bd7678eade77 | 1571 | if(RET_debug) {debug_prep();snprintf(GLOBAL_debug_buffer, sizeof(GLOBAL_debug_buffer), "BLE update");debug_exe();} |
pathfindr | 52:bd7678eade77 | 1572 | bleUpdateAndAdvertise(); |
pathfindr | 52:bd7678eade77 | 1573 | } |
pathfindr | 52:bd7678eade77 | 1574 | } else { |
pathfindr | 52:bd7678eade77 | 1575 | if (RET_bleBroadcasting == true) bleStopAdvertising(); |
pathfindr | 52:bd7678eade77 | 1576 | } |
pathfindr | 52:bd7678eade77 | 1577 | #endif |
pathfindr | 52:bd7678eade77 | 1578 | |
pathfindr | 9:b0a1535b8ef2 | 1579 | //PRE-SLEEP ACTIONS |
pathfindr | 54:2840f2d50734 | 1580 | RET_location_failsafe_seconds_count += (DEFAULT_SLEEP_FRAME / 1000); |
pathfindr | 54:2840f2d50734 | 1581 | memset(GLOBAL_exceptionString,0x00,sizeof(GLOBAL_exceptionString)); |
pathfindr | 45:6c7f5b556d74 | 1582 | LED1off(); |
pathfindr | 52:bd7678eade77 | 1583 | modem.off(GLOBAL_modemOn); //HARD OR SOFT SHUT DOWN - DEPENDING ON modemOn state |
pathfindr | 34:4493c9f6d707 | 1584 | if (GLOBAL_needToConfigureLis3dh) { lis3dh_configureForSleep(RET_setting_motion_g,RET_setting_impact_g); } |
pathfindr | 50:a94e70c00fff | 1585 | nrf_configureForSleep(); |
pathfindr | 34:4493c9f6d707 | 1586 | NRFuart_uninit(); |
pathfindr | 34:4493c9f6d707 | 1587 | watchdogKick(); |
pathfindr | 34:4493c9f6d707 | 1588 | //SLEEP |
pathfindr | 39:f767b8037475 | 1589 | RET_asleep = true; |
pathfindr | 26:fa3579737329 | 1590 | mainthread.wait(DEFAULT_SLEEP_FRAME); |
pathfindr | 34:4493c9f6d707 | 1591 | } |
pathfindr | 7:e9a19750700d | 1592 | } |