init

Dependencies:   aconno_I2C Lis2dh12 WatchdogTimer

main.cpp

Committer:
pathfindr
Date:
2018-12-15
Revision:
9:b0a1535b8ef2
Parent:
8:7351f8c4cd60
Child:
10:c8798fd9773b

File content as of revision 9:b0a1535b8ef2:

#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;

//------------------------------------------------------------------------------
//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_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_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;
    
    //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;
        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
        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);
        */
    }
}