104 lines
2.2 KiB
C
104 lines
2.2 KiB
C
/*
|
|
* Copyright (c) 2019 Winner Microelectronics Co., Ltd.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2019-03-13 tyx first version
|
|
*/
|
|
|
|
#include <rthw.h>
|
|
#include <rtthread.h>
|
|
#include <rtdevice.h>
|
|
#include "drv_standby.h"
|
|
|
|
#ifdef BSP_USING_STANDBY
|
|
#include "wm_type_def.h"
|
|
#include "wm_cpu.h"
|
|
#include "wm_pmu.h"
|
|
#include "wm_irq.h"
|
|
#include "wm_regs.h"
|
|
|
|
typedef volatile unsigned long vu32;
|
|
#define M32(adr) (*((vu32*) (adr)))
|
|
typedef void (*rom_standby_func)(void);
|
|
|
|
static const rom_standby_func pm_standby = (rom_standby_func)0x499;
|
|
|
|
#ifdef __ICCARM__
|
|
extern void standby_idr(void);
|
|
#endif
|
|
|
|
#if (1 == GCC_COMPILE)
|
|
void wm_pm_standby(void)
|
|
{
|
|
__asm volatile (
|
|
" cpsid i \n" /* disable irq*/
|
|
" dsb \n"
|
|
" ldr r0, =0X499 \n"
|
|
" bx r0 \n"
|
|
" movs r0, #0x00 \n"
|
|
" isb \n"
|
|
);
|
|
}
|
|
#endif
|
|
|
|
/**
|
|
* This function will put w60x into run/shutdown mode.
|
|
*
|
|
* @param timeout How many OS Ticks that MCU can sleep
|
|
*/
|
|
void sys_start_standby(int ms)
|
|
{
|
|
rt_uint32_t val;
|
|
int timeout = ms;
|
|
|
|
RT_ASSERT(timeout > 0);
|
|
|
|
tls_pmu_clk_select(0);
|
|
|
|
if (timeout <= 65535)
|
|
{
|
|
/* Enter PM_TIMER_MODE */
|
|
tls_irq_enable(PMU_TIMER1_INT);
|
|
tls_pmu_timer1_stop();
|
|
tls_pmu_timer1_start(timeout);
|
|
}
|
|
else if(timeout <= 65535000)
|
|
{
|
|
timeout /= 1000;
|
|
tls_irq_enable(PMU_TIMER0_INT);
|
|
tls_pmu_timer0_stop();
|
|
tls_pmu_timer0_start(timeout);
|
|
}
|
|
else
|
|
{
|
|
return;
|
|
}
|
|
tls_irq_enable(PMU_GPIO_WAKEUP_INT); //Open interrupt by default to clear the interrupt flag for IO wake-up
|
|
val = tls_reg_read32(HR_PMU_PS_CR);
|
|
val |= 0x01;
|
|
tls_reg_write32(HR_PMU_PS_CR, val);
|
|
}
|
|
|
|
#ifdef RT_USING_FINSH
|
|
#include <finsh.h>
|
|
#include <stdlib.h>
|
|
static void standby(uint8_t argc, char **argv)
|
|
{
|
|
if (argc != 2)
|
|
{
|
|
rt_kprintf("Usage: standby timeout(ms)\n");
|
|
rt_kprintf("eg : standby 5000\n");
|
|
}
|
|
else
|
|
{
|
|
sys_start_standby(atoi(argv[1]));
|
|
}
|
|
}
|
|
FINSH_FUNCTION_EXPORT_ALIAS(standby, __cmd_standby, sleep System);
|
|
#endif /* RT_USING_FINSH */
|
|
|
|
#endif /* BSP_USING_STANDBY */
|