tmk_core/tool/mbed/mbed-sdk/libraries/mbed/targets/hal/TARGET_Freescale/TARGET_KLXX/sleep.c

   1 /* mbed Microcontroller Library
   2  * Copyright (c) 2006-2013 ARM Limited
   3  *
   4  * Licensed under the Apache License, Version 2.0 (the "License");
   5  * you may not use this file except in compliance with the License.
   6  * You may obtain a copy of the License at
   7  *
   8  *     http://www.apache.org/licenses/LICENSE-2.0
   9  *
  10  * Unless required by applicable law or agreed to in writing, software
  11  * distributed under the License is distributed on an "AS IS" BASIS,
  12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13  * See the License for the specific language governing permissions and
  14  * limitations under the License.
  15  */
  16 #include "sleep_api.h"
  17 #include "cmsis.h"
  18 #include "PeripheralPins.h"
  19
  20 //Normal wait mode
  21 void sleep(void)
  22 {
  23     SMC->PMPROT = SMC_PMPROT_AVLLS_MASK | SMC_PMPROT_ALLS_MASK | SMC_PMPROT_AVLP_MASK;
  24
  25     //Normal sleep mode for ARM core:
  26     SCB->SCR = 0;
  27     __WFI();
  28 }
  29
  30 //Very low-power stop mode
  31 void deepsleep(void)
  32 {
  33     //Check if ADC is enabled and HS mode is set, if yes disable it (lowers power consumption by 60uA)
  34     uint8_t ADC_HSC = 0;
  35     if (SIM->SCGC6 & SIM_SCGC6_ADC0_MASK) {
  36         if (ADC0->CFG2 & ADC_CFG2_ADHSC_MASK) {
  37             ADC_HSC = 1;
  38             ADC0->CFG2 &= ~(ADC_CFG2_ADHSC_MASK);
  39         }
  40     }
  41
  42 #if ! defined(TARGET_KL43Z)
  43     //Check if PLL/FLL is enabled:
  44     uint32_t PLL_FLL_en = (MCG->C1 & MCG_C1_CLKS_MASK) == MCG_C1_CLKS(0);
  45 #endif
  46
  47     SMC->PMPROT = SMC_PMPROT_AVLLS_MASK | SMC_PMPROT_ALLS_MASK | SMC_PMPROT_AVLP_MASK;
  48     SMC->PMCTRL = SMC_PMCTRL_STOPM(2);
  49
  50     //Deep sleep for ARM core:
  51     SCB->SCR = 1<<SCB_SCR_SLEEPDEEP_Pos;
  52
  53     __WFI();
  54
  55 #if ! defined(TARGET_KL43Z)
  56     //Switch back to PLL as clock source if needed
  57     //The interrupt that woke up the device will run at reduced speed
  58     if (PLL_FLL_en) {
  59         #ifdef MCG_C5_PLLCLKEN0_MASK        //PLL available
  60         if (MCG->C6 & (1<<MCG_C6_PLLS_SHIFT) != 0) /* If PLL */
  61             while((MCG->S & MCG_S_LOCK0_MASK) == 0x00U); /* Wait until locked */
  62         #endif
  63         MCG->C1 &= ~MCG_C1_CLKS_MASK;
  64     }
  65 #endif
  66
  67     if (ADC_HSC) {
  68         ADC0->CFG2 |= (ADC_CFG2_ADHSC_MASK);
  69     }
  70 }