void disable_unneeded_peripherals()
{
peripheral_disable(kInputCaptureModule);
peripheral_disable(kInputCompareModule);
peripheral_disable(kI2CModule);
peripheral_disable(kCRCModule);
peripheral_disable(kComparatorModule);
peripheral_disable(kRefOscModule);
peripheral_disable(kCTMUModule);
peripheral_disable(kHLVDModule);
// peripheral_disable(kTimer2Module);
//peripheral_disable(kTimer3Module);
peripheral_disable(kUART2Module);
peripheral_disable(kUART1Module);
}
/**
* sleep - most versatile sleep mode. SnoozeBlock configuration or any interrupt can wake the processor.
*
* @param configuration SnoozeBlock class config.
*
* @return wakeup source
*/
int SnoozeClass::sleep( SnoozeBlock &configuration ) {
SnoozeBlock *p = &configuration;
enable_periph_irq = true;
#ifdef KINETISL
tsi_set( &p->tsi_mask );
#endif
cmp_set( &p->cmp_mask );
lptmr_set( &p->lptmr_mask );
#ifdef KINETISK
rtc_alarm_set( &p->rtc_mask );
#endif
digital_set( &p->digital_mask );
#ifdef KINETISL
pinMode( 17, OUTPUT );
digitalWriteFast( 17, LOW );
#endif
if ( mcg_mode( ) == BLPI ) {
peripheral_disable( &p->setPeripheral.periph_off_mask );
enter_wait( );
peripheral_set( &p->setPeripheral.periph_off_mask );
}
else if ( mcg_mode( ) == BLPE ) {
peripheral_set( &p->setPeripheral.periph_off_mask );
blpe_blpi ( );
enter_vlpr( 0 );// now safe to enter vlpr
enter_wait( );
exit_vlpr ( );
blpi_blpe ( );
peripheral_set( &p->setPeripheral.periph_off_mask );
}
else {
peripheral_set( &p->setPeripheral.periph_off_mask );
usbDisable( );
pee_blpi ( );
enter_vlpr( 0 );// now safe to enter vlpr
enter_wait( );
exit_vlpr ( );
blpi_pee ( );
usbEnable ( );
peripheral_set( &p->setPeripheral.periph_off_mask );
}
digital_disable( &p->digital_mask );
#ifdef KINETISK
rtc_disable( &p->rtc_mask );
#endif
lptmr_disable( &p->lptmr_mask );
cmp_disable( &p->cmp_mask );
#ifdef KINETISL
tsi_disable( &p->tsi_mask );
#endif
return wakeupSource;
}
void gsm_disable_serial()
{
peripheral_disable( kUART1Module );
//TODO: Clock leave high-speed mode
}
