tool/mbed/mbed-sdk/libraries/mbed/targets/hal/TARGET_Freescale/TARGET_KPSDK_MCUS/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 "fsl_mcg_hal.h"
  19 #include "fsl_smc_hal.h"
  20
  21 void sleep(void) {
  22     smc_power_mode_protection_config_t sleep_config = {true};
  23     SMC_HAL_SetProtection(SMC_BASE, &sleep_config);
  24
  25     SCB->SCR &= ~SCB_SCR_SLEEPDEEP_Msk;
  26     __WFI();
  27 }
  28
  29 void deepsleep(void) {
  30     mcg_clock_select_t mcg_clock = CLOCK_HAL_GetClkSrcMode(MCG_BASE);
  31
  32     smc_power_mode_protection_config_t sleep_config = {true};
  33     SMC_HAL_SetProtection(SMC_BASE, &sleep_config);
  34     SMC->PMCTRL = SMC_PMCTRL_STOPM(2);
  35
  36     //Deep sleep for ARM core:
  37     SCB->SCR = 1 << SCB_SCR_SLEEPDEEP_Pos;
  38
  39     __WFI();
  40
  41     //Switch back to PLL as clock source if needed
  42     //The interrupt that woke up the device will run at reduced speed
  43     if (mcg_clock == kMcgClkSelOut) {
  44         if (CLOCK_HAL_GetPllStatMode(MCG_BASE) == kMcgPllStatPllClkSel) {
  45             while (CLOCK_HAL_GetLock0Mode(MCG_BASE) == kMcgLockUnlocked);
  46         }
  47         CLOCK_HAL_SetClkSrcMode(MCG_BASE, kMcgClkSelOut);
  48     }
  49 }