xref: /arm-trusted-firmware/plat/mediatek/mt8173/drivers/timer/mt_cpuxgpt.c (revision 91f16700b400a8c0651d24a598fc48ee2997a0d7)
1*91f16700Schasinglulu /*
2*91f16700Schasinglulu  * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved.
3*91f16700Schasinglulu  *
4*91f16700Schasinglulu  * SPDX-License-Identifier: BSD-3-Clause
5*91f16700Schasinglulu  */
6*91f16700Schasinglulu 
7*91f16700Schasinglulu #include <arch_helpers.h>
8*91f16700Schasinglulu #include <lib/mmio.h>
9*91f16700Schasinglulu 
10*91f16700Schasinglulu #include <mcucfg.h>
11*91f16700Schasinglulu #include <mt8173_def.h>
12*91f16700Schasinglulu #include <mt_cpuxgpt.h>
13*91f16700Schasinglulu 
14*91f16700Schasinglulu static void write_cpuxgpt(unsigned int reg_index, unsigned int value)
15*91f16700Schasinglulu {
16*91f16700Schasinglulu 	mmio_write_32((uintptr_t)&mt8173_mcucfg->xgpt_idx, reg_index);
17*91f16700Schasinglulu 	mmio_write_32((uintptr_t)&mt8173_mcucfg->xgpt_ctl, value);
18*91f16700Schasinglulu }
19*91f16700Schasinglulu 
20*91f16700Schasinglulu static void cpuxgpt_set_init_cnt(unsigned int countH, unsigned int countL)
21*91f16700Schasinglulu {
22*91f16700Schasinglulu 	write_cpuxgpt(INDEX_CNT_H_INIT, countH);
23*91f16700Schasinglulu 	/* update count when countL programmed */
24*91f16700Schasinglulu 	write_cpuxgpt(INDEX_CNT_L_INIT, countL);
25*91f16700Schasinglulu }
26*91f16700Schasinglulu 
27*91f16700Schasinglulu void generic_timer_backup(void)
28*91f16700Schasinglulu {
29*91f16700Schasinglulu 	uint64_t cval;
30*91f16700Schasinglulu 
31*91f16700Schasinglulu 	cval = read_cntpct_el0();
32*91f16700Schasinglulu 	cpuxgpt_set_init_cnt((uint32_t)(cval >> 32),
33*91f16700Schasinglulu 			       (uint32_t)(cval & 0xffffffff));
34*91f16700Schasinglulu }
35