mirror of https://github.com/ARMmbed/mbed-os.git
90 lines
2.2 KiB
C
90 lines
2.2 KiB
C
/* mbed Microcontroller Library
|
|
* (C)Copyright TOSHIBA ELECTRONIC DEVICES & STORAGE CORPORATION 2018 All rights reserved
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
#include "sleep_api.h"
|
|
#include "gpio_include.h"
|
|
|
|
static void warming_up_time(void);
|
|
|
|
void hal_sleep(void)
|
|
{
|
|
// Set low power consumption mode IDLE
|
|
TSB_CG->STBYCR = CG_STBY_MODE_IDLE;
|
|
__DSB(); // Enter idle mode
|
|
__WFI();
|
|
}
|
|
|
|
void hal_deepsleep(void)
|
|
{
|
|
uint32_t tmp = 0;
|
|
|
|
TSB_CG_FSYSENB_IPENB31 = ENABLE;
|
|
|
|
TSB_SIWD0->EN = DISABLE;
|
|
TSB_SIWD0->CR = 0xB1;
|
|
|
|
while ((TSB_FC->SR0 & 0x01) != 0x01) {
|
|
// Flash wait
|
|
}
|
|
|
|
while (TSB_CG_WUPHCR_WUEF) {
|
|
// Wait for end of Warming-up for IHOSC1
|
|
}
|
|
|
|
TSB_CG_WUPHCR_WUCLK = DISABLE;
|
|
warming_up_time();
|
|
TSB_CG->STBYCR = CG_STBY_MODE_STOP1;
|
|
TSB_CG_PLL0SEL_PLL0SEL = DISABLE;
|
|
|
|
while (TSB_CG_PLL0SEL_PLL0ST) {
|
|
// Wait for PLL status of fsys until off state(fosc=0)
|
|
}
|
|
|
|
TSB_CG_PLL0SEL_PLL0ON = DISABLE; // Stop PLL of fsys
|
|
TSB_CG_OSCCR_IHOSC1EN = ENABLE;
|
|
TSB_CG_OSCCR_OSCSEL = DISABLE;
|
|
|
|
while (TSB_CG_OSCCR_OSCF) {
|
|
// Wait for fosc status until IHOSC1 = 0
|
|
}
|
|
|
|
tmp = TSB_CG->OSCCR;
|
|
tmp &= EXTERNEL_OSC_MASK;
|
|
TSB_CG->OSCCR = tmp;
|
|
TSB_CG_OSCCR_IHOSC2EN = DISABLE;
|
|
|
|
while (TSB_CG_OSCCR_IHOSC2F) {
|
|
// Wait for status of OFD until off "0"
|
|
}
|
|
|
|
__DSB();
|
|
__WFI();
|
|
}
|
|
|
|
static void warming_up_time(void)
|
|
{
|
|
uint32_t work = 0;
|
|
uint64_t x = 0;
|
|
|
|
x = (uint64_t)(IHOSC_CFG_WARM_UP_TIME * IHOSC_CFG_CLOCK);
|
|
x = (uint64_t)(x / (uint64_t)(1000000));
|
|
|
|
work = (uint32_t)x;
|
|
work &= (uint32_t)(0xFFFFFFF0);
|
|
work <<= 16;
|
|
work |= (uint32_t)(TSB_CG->WUPHCR & ~CGWUPHCR_WUPT_HIGH_MASK);
|
|
TSB_CG->WUPHCR = work;
|
|
}
|