/* * Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved. * Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this list of * conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright notice, this list * of conditions and the following disclaimer in the documentation and/or other materials * provided with the distribution. * * 3. Neither the name of the copyright holder nor the names of its contributors may be used * to endorse or promote products derived from this software without specific prior written * permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include "los_timer.h" #include "los_config.h" #include "los_arch_context.h" #include "los_arch_interrupt.h" #include "los_reg.h" #define OS_TIMER_CLKDIV_POS 3 #define OS_TIMER_CLKDIV_MASK 7 #define OS_TIMER_INT_POS 7 #define OS_TIMER_INT_MASK 7 #define OS_TIMER_IRQ_NUM 8 #define OS_TIMER_ENABLE (1U << 0) #define OS_TIMER_32K_CLK_BIT (1U << 21) #define OS_TIMER_CNT_READ_BIT (1U << 0) #define OS_TIMER_REG_BASE 0x00802A40UL #define OS_TIMER_CLK_PWD_ADDR 0x00802008UL #define OS_TIMER_PERIOD_REG_ADDR (OS_TIMER_REG_BASE) #define OS_TIMER_CTL_REG_ADDR (OS_TIMER_REG_BASE + 12) #define OS_TIMER_READ_CTL_ADDR (OS_TIMER_REG_BASE + 16) #define OS_TIMER_READ_VAL_ADDR (OS_TIMER_REG_BASE + 20) STATIC UINT32 SysTickStart(HWI_PROC_FUNC handler); STATIC UINT64 SysTickReload(UINT64 nextResponseTime); STATIC UINT64 SysTickCycleGet(UINT32 *period); STATIC VOID SysTickLock(VOID); STATIC VOID SysTickUnlock(VOID); STATIC ArchTickTimer g_archTickTimer = { .freq = 0, .irqNum = OS_TIMER_IRQ_NUM, .periodMax = LOSCFG_BASE_CORE_TICK_RESPONSE_MAX, .init = SysTickStart, .getCycle = SysTickCycleGet, .reload = SysTickReload, .lock = SysTickLock, .unlock = SysTickUnlock, .tickHandler = NULL, }; STATIC UINT32 SysTickStart(HWI_PROC_FUNC handler) { UINT32 intSave = LOS_IntLock(); UINT32 value; ArchTickTimer *tick = &g_archTickTimer; tick->freq = OS_SYS_CLOCK; READ_UINT32(value, OS_TIMER_CLK_PWD_ADDR); value &= ~(OS_TIMER_32K_CLK_BIT); WRITE_UINT32(value, OS_TIMER_CLK_PWD_ADDR); value = LOSCFG_BASE_CORE_TICK_RESPONSE_MAX; WRITE_UINT32(value, OS_TIMER_PERIOD_REG_ADDR); READ_UINT32(value, OS_TIMER_CTL_REG_ADDR); value &= ~(OS_TIMER_CLKDIV_MASK << OS_TIMER_CLKDIV_POS); // The default is 1, and the clock does not divide. value &= ~(OS_TIMER_INT_MASK << OS_TIMER_INT_POS); // Clearing interruption. value |= 0x1 << OS_TIMER_INT_POS; value |= OS_TIMER_ENABLE; // Enable timer. WRITE_UINT32(value, OS_TIMER_CTL_REG_ADDR); (VOID)ArchHwiCreate(OS_TIMER_IRQ_NUM, 0, 0, (HWI_PROC_FUNC)handler, 0); LOS_IntRestore(intSave); return LOS_OK; } STATIC VOID SysTickClockIrqClear(VOID) { UINT32 mask = OS_TIMER_INT_MASK << OS_TIMER_INT_POS; UINT32 status; do { WRITE_UINT32(mask, OS_TIMER_CTL_REG_ADDR); READ_UINT32(status, OS_TIMER_CTL_REG_ADDR); } while (status & mask); } STATIC UINT64 SysTickReload(UINT64 nextResponseTime) { if (nextResponseTime > g_archTickTimer.periodMax) { nextResponseTime = g_archTickTimer.periodMax; } SysTickLock(); WRITE_UINT32((UINT32)nextResponseTime, OS_TIMER_PERIOD_REG_ADDR); SysTickClockIrqClear(); SysTickUnlock(); return nextResponseTime; } STATIC UINT64 SysTickCycleGet(UINT32 *period) { UINT32 val; READ_UINT32(*period, OS_TIMER_PERIOD_REG_ADDR); WRITE_UINT32(OS_TIMER_CNT_READ_BIT, OS_TIMER_READ_CTL_ADDR); do { READ_UINT32(val, OS_TIMER_READ_CTL_ADDR); } while (val & OS_TIMER_CNT_READ_BIT); // Wait for the setting to take effect. READ_UINT32(val, OS_TIMER_READ_VAL_ADDR); return (UINT64)val; } STATIC VOID SysTickLock(VOID) { UINT32 value; READ_UINT32(value, OS_TIMER_CTL_REG_ADDR); value &= ~OS_TIMER_ENABLE; value &= ~(OS_TIMER_INT_MASK << OS_TIMER_INT_POS); value |= 0x1 << OS_TIMER_INT_POS; WRITE_UINT32(value, OS_TIMER_CTL_REG_ADDR); } STATIC VOID SysTickUnlock(VOID) { UINT32 value; READ_UINT32(value, OS_TIMER_CTL_REG_ADDR); value |= OS_TIMER_ENABLE; value &= ~(OS_TIMER_INT_MASK << OS_TIMER_INT_POS); value |= 0x1 << OS_TIMER_INT_POS; WRITE_UINT32(value, OS_TIMER_CTL_REG_ADDR); } ArchTickTimer *ArchSysTickTimerGet(VOID) { return &g_archTickTimer; } UINT32 ArchEnterSleep(VOID) { dsb(); wfi(); isb(); return LOS_OK; }