init
Dependencies: aconno_I2C Lis2dh12 WatchdogTimer
main.cpp
- Committer:
- pathfindr
- Date:
- 2018-12-15
- Revision:
- 10:c8798fd9773b
- Parent:
- 9:b0a1535b8ef2
- Child:
- 11:60eb0ff945f2
File content as of revision 10:c8798fd9773b:
#include "main.h"
//include "nrf_soc.h"
//------------------------------------------------------------------------------
//FUNCTION PROTOTYPES
//------------------------------------------------------------------------------
static void mainStateEngine(void);
static void selftest(void);
static void buttonPress(void);
static void buttonRelease(void);
//------------------------------------------------------------------------------
//GLOBAL VARS / CLEARED ON SLEEP (IF USING SOFT REBOOT HACK)
//------------------------------------------------------------------------------
bool accel_healthy = false;
bool requireSoftReset = false;
bool motionFlagTriggered = false;
bool debugLED = false;
bool needToConfigureLis3dh = false;
//------------------------------------------------------------------------------
//RETAINED NOINIT RAM VARS
//------------------------------------------------------------------------------
#if defined ( __CC_ARM ) /** THIS IS THE MBED ONLINE COMPILER TOOLCHAIN*/
static uint8_t RET_coldBoot __attribute__((section("noinit"),zero_init));
static uint8_t RET_mode __attribute__((section("noinit"),zero_init));
static uint8_t RET_mode_prev __attribute__((section("noinit"),zero_init));
static uint8_t RET_buttonPressCount __attribute__((section("noinit"),zero_init));
static time_t RET_buttonPressTime __attribute__((section("noinit"),zero_init));
static time_t RET_buttonReleaseTime __attribute__((section("noinit"),zero_init));
static time_t RET_buttonHoldTime __attribute__((section("noinit"),zero_init));
static time_t RET_RTCunixtime __attribute__((section("noinit"),zero_init));
static long RET_RTCmicros __attribute__((section("noinit"),zero_init));
static bool RET_requireImpactFlag __attribute__((section("noinit"),zero_init));
static char RET_buffer[64] __attribute__((section("noinit"),zero_init));
//MOTION SETTINGS
static bool RET_impactTriggered __attribute__((section("noinit"),zero_init));
static bool RET_motionTriggered __attribute__((section("noinit"),zero_init));
static time_t RET_motionStartTime __attribute__((section("noinit"),zero_init));
static time_t RET_motionStopTime __attribute__((section("noinit"),zero_init));
static time_t RET_motionStartThreshold_seconds __attribute__((section("noinit"),zero_init));
static time_t RET_motionStopThreshold_seconds __attribute__((section("noinit"),zero_init));
static bool RET_motionPendingOnState __attribute__((section("noinit"),zero_init));
static bool RET_motionPendingOffState __attribute__((section("noinit"),zero_init));
static bool RET_motionState __attribute__((section("noinit"),zero_init));
static float RET_motionTotalActivityHours __attribute__((section("noinit"),zero_init));
static char RET_motionData[100] __attribute__((section("noinit"),zero_init));
//EVENT HANDLING
static time_t RET_eventTime_location_log __attribute__((section("noinit"),zero_init));
static time_t RET_eventTime_location_bc __attribute__((section("noinit"),zero_init));
static time_t RET_eventTime_environmental_log __attribute__((section("noinit"),zero_init));
static time_t RET_eventTime_environmental_bc __attribute__((section("noinit"),zero_init));
static time_t RET_eventTime_activity_bc __attribute__((section("noinit"),zero_init));
static time_t RET_eventTime_wakeFromDormant __attribute__((section("noinit"),zero_init));
#elif defined ( __GNUC__ )
#elif defined ( __ICCARM__ )
#endif
//------------------------------------------------------------------------------
//GPIO
//------------------------------------------------------------------------------
InterruptIn button(PN_IN_BUTTON); //This causes wake from sleep
//------------------------------------------------------------------------------
//PERIPHERALS
//------------------------------------------------------------------------------
//BLE myble;
WatchdogTimer watchdog(65.0); //Do not set to less than 4500ms or can cause issues with softdevice
#if NEED_CONSOLE_OUTPUT
Serial uart(PN_UART_TX, PN_UART_RX, 115200);
#endif
//------------------------------------------------------------------------------
//TIMERS
//------------------------------------------------------------------------------
LowPowerTicker RTCticker; //no impact on power consumption
//------------------------------------------------------------------------------
//THREAD SEMAPHORES
//------------------------------------------------------------------------------
Semaphore mainthread;
//------------------------------------------------------------------------------
//SINGLETONS
//------------------------------------------------------------------------------
//NVStore &nvstore = NVStore::get_instance();
//------------------------------------------------------------------------------
// LOW LEVEL FUNCS
//------------------------------------------------------------------------------
void turnOffEverything() {
//vreg_en = 0;
LED1off();
}
void gotoSleep(long sleep_milliseconds) {
turnOffEverything();
watchdog.kick();
if (requireSoftReset) { //dont need to clear this var as reset changes it back to false
system_reset();
}
mainthread.wait(sleep_milliseconds);
}
void RTCtick() {
//RET_unixtime ++;
RET_RTCmicros += 100;
RET_RTCunixtime = (RET_RTCmicros / 1000);
//button logic - check for hold
if (RET_buttonHoldTime > 4000) {
RET_buttonHoldTime = 0;
RET_buttonPressCount = 0;
RET_mode_prev = RET_mode;
RET_mode = MODE_BUTTONHOLD;
mainthread.release();
} else {
if((RET_RTCmicros - RET_buttonPressTime) > 500) {
switch (RET_buttonPressCount) {
case 1 :
RET_mode_prev = RET_mode;
RET_mode = MODE_BUTTONPRESS1;
mainthread.release();
break;
case 2 :
RET_mode_prev = RET_mode;
RET_mode = MODE_BUTTONPRESS2;
mainthread.release();
break;
default :
//do nothing
break;
}
RET_buttonPressCount = 0;
}
}
}
void factoryReset() {
//firstBoot = true;
requireSoftReset = false;
//RESET RETAINED VARS
RET_coldBoot = 1;
RET_mode = MODE_NORMAL;
RET_mode_prev = RET_mode;
RET_RTCunixtime = 0;
RET_RTCmicros = 0;
RET_eventTime_location_log = 0;
RET_eventTime_location_bc = 0;
RET_eventTime_environmental_log = 0;
RET_eventTime_environmental_bc = 0;
RET_eventTime_activity_bc = 0;
RET_eventTime_wakeFromDormant = 0;
RET_motionPendingOffState = 0;
RET_motionPendingOnState = 0;
RET_motionTriggered = 0;
RET_impactTriggered = 0;
RET_motionState = 0;
RET_motionStartTime = 0;
RET_motionStopTime = 0;
RET_motionStartThreshold_seconds = 60;
RET_motionStopThreshold_seconds = 60;
RET_motionTotalActivityHours = 0.0;
RET_buttonPressTime = 0;
RET_buttonPressCount = 0;
RET_buttonHoldTime = 0;
//CONFIGURE ACCELL DEFAULT
lis3dh_configureForSleep(10,127);
//SET IDENTIFIER
//uint32_t nv_value = 12345678;
//int rc = nvstore.set(NV_IDENTIFIER, sizeof(nv_value), &nv_value);
}
void selfTest() {
//Accelerometer
LIS3DH lis3dh(PN_SPI_MOSI, PN_SPI_MISO, PN_SPI_CS0, PN_SPI_CLK);
uint8_t lis3dh_id;
lis3dh.LIS3DH_GetWHO_AM_I(&lis3dh_id);
if (lis3dh_id == 51) {
LED1blink(10,50);
}
}
//------------------------------------------------------------------------------
// USER BUTTON HANDLING
//------------------------------------------------------------------------------
void buttonPress() {
RET_buttonPressTime = RET_RTCmicros;
}
void buttonRelease() {
RET_buttonHoldTime = (RET_RTCmicros - RET_buttonPressTime);
//debounce catch
if((RET_RTCmicros - RET_buttonPressTime) >= 100) {
RET_buttonPressCount ++;
}
}
//------------------------------------------------------------------------------
// MOTION FUNCS
//------------------------------------------------------------------------------
void checkMotion() {
if (lis3dh_int2) {
if (debugLED) LED1blink(2,100);
RET_motionTriggered = true;
needToConfigureLis3dh = true; //interrupt has fire so need to clear it
if (!RET_motionPendingOnState) {
RET_motionPendingOnState = true;
RET_motionPendingOffState = false;
// Log start motion time
RET_motionStartTime = time(NULL);
}
} else {
if (debugLED) LED1blink(2,500);
RET_motionTriggered = false;
RET_motionPendingOnState = false;
if (!RET_motionPendingOffState) {
RET_motionPendingOffState = true;
//log stop motion time
RET_motionStopTime = time(NULL);
}
}
//calculate motion state
if (RET_motionPendingOnState) {
//check if above threshold
time_t inMotionForSeconds = (time(NULL) - RET_motionStartTime);
if (inMotionForSeconds >= RET_motionStartThreshold_seconds) {
RET_motionState = true;
if (debugLED) LED1blink(10,100);
}
}
if (RET_motionPendingOffState) {
time_t noMotionForSeconds = (time(NULL) - RET_motionStopTime);
if (noMotionForSeconds >= RET_motionStartThreshold_seconds) {
RET_motionState = false;
RET_motionTotalActivityHours += (float(RET_motionStopTime - RET_motionStartTime) / 3600.0);
if (debugLED) LED1blink(5,500);
}
}
}
//------------------------------------------------------------------------------
// STATE ENGINE
//------------------------------------------------------------------------------
void mainStateEngine() {
switch(RET_mode) {
case MODE_SETUP :
factoryReset();
//selftest();
break;
case MODE_NORMAL :
//check and log motion
checkMotion();
//EVENTS
//Location
if(time(NULL) > RET_eventTime_location_log && RET_eventTime_location_log > 0) {
//getdata_environmental();
//event_location_log();
}
if(time(NULL) > RET_eventTime_location_bc && RET_eventTime_location_bc > 0) {
//getdata_battery();
//event_location_broadcast();
}
//Environmental
if(time(NULL) > RET_eventTime_environmental_log && RET_eventTime_environmental_log > 0) {
//event_environmental_log();
}
if(time(NULL) > RET_eventTime_environmental_bc && RET_eventTime_environmental_bc > 0) {
//event_environmental_bc();
}
//Activity
if(time(NULL) > RET_eventTime_activity_bc && RET_eventTime_activity_bc > 0) {
//event_activity_bc();
}
break;
case MODE_DORMANT :
if (time(NULL) > RET_eventTime_wakeFromDormant) {
RET_mode = MODE_NORMAL;
}
break;
case MODE_BUTTONPRESS1 :
LED1blink(2,300);
RET_mode = RET_mode_prev;
break;
case MODE_BUTTONPRESS2 :
LED1blink(4,300);
RET_mode = RET_mode_prev;
break;
case MODE_BUTTONHOLD :
LED1blink(10,300);
RET_mode = RET_mode_prev;
break;
default :
RET_mode = MODE_SETUP;
}
}
//------------------------------------------------------------------------------
// MAIN
//------------------------------------------------------------------------------
int main() {
RTCticker.attach(&RTCtick, 0.1);
turnOffEverything();
button.fall(&buttonPress); //does this affect power?
button.rise(&buttonRelease);
//CHECK IF THIS IS RESET
//0x00000004 == soft reset //0x00000002 == watchdog //0x00000001 == button/hardreset
if (NRF_POWER->RESETREAS != 0xffffffff) {
switch(NRF_POWER->RESETREAS) {
case 0x00000001 :
DEBUG("reset_reason: 0x%08x. - Hard Reset\n",NRF_POWER->RESETREAS);
factoryReset();
break;
case 0x00000002 :
DEBUG("reset_reason: 0x%08x. - Watchdog\n",NRF_POWER->RESETREAS);
break;
case 0x00000004 :
DEBUG("reset_reason: 0x%08x. - Soft reset\n",NRF_POWER->RESETREAS);
break;
}
NRF_POWER->RESETREAS = 0xffffffff;
}
//CHECK FOR FIRST BOOT
if (RET_coldBoot != 0) factoryReset();
while(true) {
//SLEEP
if (RET_coldBoot != 1) gotoSleep(30000); //THIS HAS TO BE THE FIRST ITEM IN THE MAIN LOOP
watchdog.kick();
//MAIN LOGIC
DEBUG("mode: %i time: %i, %i, %i, %i \n", RET_mode, RET_RTCmicros, RET_RTCunixtime, RET_buttonHoldTime, RET_buttonPressCount);
mainStateEngine();
//PRE-SLEEP ACTIONS
if (needToConfigureLis3dh) { //ONLY RESET ACCELL IF WE NEED TO
lis3dh_configureForSleep(10,127);
}
RET_coldBoot = 0;
/*
firstBoot = false; //temp
if (!firstBoot) gotoSleep(10000);
//INIT
//Modem modem(PN_UART_TX, PN_UART_RX, PN_UART_CTS, PN_UART_RTS, PN_GSM_PWR_KEY, PN_VREG_EN);
//MAIN STATE ENGINE
//Configure for sleep
lis3dh_configureForSleep(10,127);
*/
}
}