ChibiOS Free Embedded RTOS

Code: Select all

int main( void )
{
static int timeout = 10;

    /*
     * System initializations.
     * - HAL initialization, this also initializes the configured device drivers
     *   and performs the board-specific initializations.
     * - Kernel initialization, the main() function becomes a thread and the
     *   RTOS is active.
     */
    halInit();
    chSysInit();
    debugInit();

    bootMessage();

    extStart( &EXTD1, &extio1 );

    DBGMCU->CR |= DBGMCU_CR_DBG_SLEEP | DBGMCU_CR_DBG_STOP;

    while (true)
    {
        timeout--;

        TGL_DEBUG( DBG_MASK_APP,
                   "$ APP - Testing!\r\n" );

        if(timeout == 0)
        {
            timeout = 10;

            palClearPad( GPIOA, GPIOA_GSM_PWR );

            TGL_DEBUG( DBG_MASK_APP,
                       "$ APP - Entering Low Power State!\r\n" );

            chThdSleepMilliseconds( 5000 );

            /* clear PDDS and LPDS bits */
             PWR->CR &= ~(PWR_CR_PDDS | PWR_CR_LPDS);

             /* set LPDS and clear  */
             PWR->CR |= (PWR_CR_LPDS | PWR_CR_CSBF | PWR_CR_CWUF);

             /* Setup the deepsleep mask */
             SCB->SCR |= SCB_SCR_SLEEPDEEP_Msk;

             chSysLock();
             __ISB();
             __SEV();
             __WFE();
             __WFE();
             chSysUnlock();

            /* clear the deep sleep mask */
            SCB->SCR &= ~SCB_SCR_SLEEPDEEP_Msk;

            /* reset the sytem to restart */
            __ASM volatile ("dsb");

            /* Keep priority group unchanged */
            SCB->AIRCR  = ((0x5FA << SCB_AIRCR_VECTKEY_Pos)      |        \
                           (SCB->AIRCR & SCB_AIRCR_PRIGROUP_Msk) |        \
                            SCB_AIRCR_SYSRESETREQ_Msk);

            __ASM volatile ("dsb");
        }

        chThdSleepMilliseconds( 1000 );

    }
}

Code: Select all

int main( void )
{
static int timeout = 10;

    /*
     * System initializations.
     * - HAL initialization, this also initializes the configured device drivers
     *   and performs the board-specific initializations.
     * - Kernel initialization, the main() function becomes a thread and the
     *   RTOS is active.
     */
    halInit();
    chSysInit();
    debugInit();

    bootMessage();

    extStart( &EXTD1, &extio1 );

    DBGMCU->CR |= DBGMCU_CR_DBG_SLEEP | DBGMCU_CR_DBG_STOP;

    while (true)
    {
        timeout--;

        TGL_DEBUG( DBG_MASK_APP,
                   "$ APP - Testing!\r\n" );

        if(timeout == 0)
        {
            timeout = 10;

            palClearPad( GPIOA, GPIOA_GSM_PWR );

            TGL_DEBUG( DBG_MASK_APP,
                       "$ APP - Entering Low Power State!\r\n" );

            chThdSleepMilliseconds( 5000 );

            /* clear PDDS and LPDS bits */
             PWR->CR &= ~(PWR_CR_PDDS | \
                          PWR_CR_LPDS);

             /* set LPDS and clear  */
             PWR->CR |= (PWR_CR_LPDS | \
                         PWR_CR_CSBF | \
                         PWR_CR_CWUF);

             /* Setup the deepsleep mask */
             SCB->SCR |= SCB_SCR_SLEEPDEEP_Msk;

             port_disable();

             __WFE();

             port_enable();

            /* clear the deep sleep mask */
            SCB->SCR &= ~SCB_SCR_SLEEPDEEP_Msk;

            /* Keep priority group unchanged */
            SCB->AIRCR  = ((0x5FA << SCB_AIRCR_VECTKEY_Pos)      |        \
                           (SCB->AIRCR & SCB_AIRCR_PRIGROUP_Msk) |        \
                            SCB_AIRCR_SYSRESETREQ_Msk);
        }

        chThdSleepMilliseconds( 1000 );

    }
}