30 lines
632 B
C
30 lines
632 B
C
|
/*
|
||
|
|
* Copyright (c) 2020, MediaTek Inc. All rights reserved.
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
||
|
|
*/
|
||
|
|
#include <arch_helpers.h>
|
||
|
|
#include <common/debug.h>
|
||
|
|
#include <lib/mmio.h>
|
||
|
|
#include <mcucfg.h>
|
||
|
|
#include <mt_timer.h>
|
||
|
|
#include <platform_def.h>
|
||
|
|
|
||
|
|
static void enable_systimer_compensation(void)
|
||
|
|
{
|
||
|
|
unsigned int reg;
|
||
|
|
|
||
|
|
reg = mmio_read_32(CNTCR_REG);
|
||
|
|
reg &= ~COMP_15_EN;
|
||
|
|
reg |= COMP_20_EN;
|
||
|
|
mmio_write_32(CNTCR_REG, reg);
|
||
|
|
|
||
|
|
NOTICE("[systimer] CNTCR_REG(0x%x)\n", mmio_read_32(CNTCR_REG));
|
||
|
|
}
|
||
|
|
|
||
|
|
void mt_systimer_init(void)
|
||
|
|
{
|
||
|
|
/* systimer is default on, so we only enable systimer compensation */
|
||
|
|
enable_systimer_compensation();
|
||
|
|
}
|