EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

targets/TARGET_STM/sleep.c@0:b74591d5ab33, 2017-12-11 (annotated)

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* mbed Microcontroller Library
be_bryan 0:b74591d5ab33 2 *******************************************************************************
be_bryan 0:b74591d5ab33 3 * Copyright (c) 2016, STMicroelectronics
be_bryan 0:b74591d5ab33 4 * All rights reserved.
be_bryan 0:b74591d5ab33 5 *
be_bryan 0:b74591d5ab33 6 * Redistribution and use in source and binary forms, with or without
be_bryan 0:b74591d5ab33 7 * modification, are permitted provided that the following conditions are met:
be_bryan 0:b74591d5ab33 8 *
be_bryan 0:b74591d5ab33 9 * 1. Redistributions of source code must retain the above copyright notice,
be_bryan 0:b74591d5ab33 10 * this list of conditions and the following disclaimer.
be_bryan 0:b74591d5ab33 11 * 2. Redistributions in binary form must reproduce the above copyright notice,
be_bryan 0:b74591d5ab33 12 * this list of conditions and the following disclaimer in the documentation
be_bryan 0:b74591d5ab33 13 * and/or other materials provided with the distribution.
be_bryan 0:b74591d5ab33 14 * 3. Neither the name of STMicroelectronics nor the names of its contributors
be_bryan 0:b74591d5ab33 15 * may be used to endorse or promote products derived from this software
be_bryan 0:b74591d5ab33 16 * without specific prior written permission.
be_bryan 0:b74591d5ab33 17 *
be_bryan 0:b74591d5ab33 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
be_bryan 0:b74591d5ab33 19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
be_bryan 0:b74591d5ab33 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
be_bryan 0:b74591d5ab33 21 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
be_bryan 0:b74591d5ab33 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
be_bryan 0:b74591d5ab33 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
be_bryan 0:b74591d5ab33 24 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
be_bryan 0:b74591d5ab33 25 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
be_bryan 0:b74591d5ab33 26 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
be_bryan 0:b74591d5ab33 27 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
be_bryan 0:b74591d5ab33 28 *******************************************************************************
be_bryan 0:b74591d5ab33 29 */
be_bryan 0:b74591d5ab33 30 #if DEVICE_SLEEP
be_bryan 0:b74591d5ab33 31
be_bryan 0:b74591d5ab33 32 #include "cmsis.h"
be_bryan 0:b74591d5ab33 33 #include "us_ticker_api.h"
be_bryan 0:b74591d5ab33 34 #include "sleep_api.h"
be_bryan 0:b74591d5ab33 35 #include "rtc_api_hal.h"
be_bryan 0:b74591d5ab33 36 #include "hal_tick.h"
be_bryan 0:b74591d5ab33 37 #include "mbed_critical.h"
be_bryan 0:b74591d5ab33 38
be_bryan 0:b74591d5ab33 39 extern void HAL_SuspendTick(void);
be_bryan 0:b74591d5ab33 40 extern void HAL_ResumeTick(void);
be_bryan 0:b74591d5ab33 41
be_bryan 0:b74591d5ab33 42 void hal_sleep(void)
be_bryan 0:b74591d5ab33 43 {
be_bryan 0:b74591d5ab33 44 // Disable IRQs
be_bryan 0:b74591d5ab33 45 core_util_critical_section_enter();
be_bryan 0:b74591d5ab33 46
be_bryan 0:b74591d5ab33 47 // Stop HAL tick to avoid to exit sleep in 1ms
be_bryan 0:b74591d5ab33 48 HAL_SuspendTick();
be_bryan 0:b74591d5ab33 49 // Request to enter SLEEP mode
be_bryan 0:b74591d5ab33 50 HAL_PWR_EnterSLEEPMode(PWR_MAINREGULATOR_ON, PWR_SLEEPENTRY_WFI);
be_bryan 0:b74591d5ab33 51 // Restart HAL tick
be_bryan 0:b74591d5ab33 52 HAL_ResumeTick();
be_bryan 0:b74591d5ab33 53
be_bryan 0:b74591d5ab33 54 // Enable IRQs
be_bryan 0:b74591d5ab33 55 core_util_critical_section_exit();
be_bryan 0:b74591d5ab33 56 }
be_bryan 0:b74591d5ab33 57
be_bryan 0:b74591d5ab33 58 void hal_deepsleep(void)
be_bryan 0:b74591d5ab33 59 {
be_bryan 0:b74591d5ab33 60 // Disable IRQs
be_bryan 0:b74591d5ab33 61 core_util_critical_section_enter();
be_bryan 0:b74591d5ab33 62
be_bryan 0:b74591d5ab33 63 // Stop HAL tick
be_bryan 0:b74591d5ab33 64 HAL_SuspendTick();
be_bryan 0:b74591d5ab33 65 uint32_t EnterTimeUS = us_ticker_read();
be_bryan 0:b74591d5ab33 66
be_bryan 0:b74591d5ab33 67 // Request to enter STOP mode with regulator in low power mode
be_bryan 0:b74591d5ab33 68 #if TARGET_STM32L4
be_bryan 0:b74591d5ab33 69 int pwrClockEnabled = __HAL_RCC_PWR_IS_CLK_ENABLED();
be_bryan 0:b74591d5ab33 70 int lowPowerModeEnabled = PWR->CR1 & PWR_CR1_LPR;
be_bryan 0:b74591d5ab33 71
be_bryan 0:b74591d5ab33 72 if (!pwrClockEnabled) {
be_bryan 0:b74591d5ab33 73 __HAL_RCC_PWR_CLK_ENABLE();
be_bryan 0:b74591d5ab33 74 }
be_bryan 0:b74591d5ab33 75 if (lowPowerModeEnabled) {
be_bryan 0:b74591d5ab33 76 HAL_PWREx_DisableLowPowerRunMode();
be_bryan 0:b74591d5ab33 77 }
be_bryan 0:b74591d5ab33 78
be_bryan 0:b74591d5ab33 79 HAL_PWREx_EnterSTOP2Mode(PWR_STOPENTRY_WFI);
be_bryan 0:b74591d5ab33 80
be_bryan 0:b74591d5ab33 81 if (lowPowerModeEnabled) {
be_bryan 0:b74591d5ab33 82 HAL_PWREx_EnableLowPowerRunMode();
be_bryan 0:b74591d5ab33 83 }
be_bryan 0:b74591d5ab33 84 if (!pwrClockEnabled) {
be_bryan 0:b74591d5ab33 85 __HAL_RCC_PWR_CLK_DISABLE();
be_bryan 0:b74591d5ab33 86 }
be_bryan 0:b74591d5ab33 87 #else /* TARGET_STM32L4 */
be_bryan 0:b74591d5ab33 88 HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI);
be_bryan 0:b74591d5ab33 89 #endif /* TARGET_STM32L4 */
be_bryan 0:b74591d5ab33 90
be_bryan 0:b74591d5ab33 91 // Restart HAL tick
be_bryan 0:b74591d5ab33 92 HAL_ResumeTick();
be_bryan 0:b74591d5ab33 93
be_bryan 0:b74591d5ab33 94 // Enable IRQs
be_bryan 0:b74591d5ab33 95 core_util_critical_section_exit();
be_bryan 0:b74591d5ab33 96
be_bryan 0:b74591d5ab33 97 // After wake-up from STOP reconfigure the PLL
be_bryan 0:b74591d5ab33 98 SetSysClock();
be_bryan 0:b74591d5ab33 99
be_bryan 0:b74591d5ab33 100 TIM_HandleTypeDef TimMasterHandle;
be_bryan 0:b74591d5ab33 101 TimMasterHandle.Instance = TIM_MST;
be_bryan 0:b74591d5ab33 102 __HAL_TIM_SET_COUNTER(&TimMasterHandle, EnterTimeUS);
be_bryan 0:b74591d5ab33 103
be_bryan 0:b74591d5ab33 104 #if DEVICE_LOWPOWERTIMER
be_bryan 0:b74591d5ab33 105 rtc_synchronize();
be_bryan 0:b74591d5ab33 106 #endif
be_bryan 0:b74591d5ab33 107 }
be_bryan 0:b74591d5ab33 108
be_bryan 0:b74591d5ab33 109 #endif