17d116dccSCC Ma /* 27d116dccSCC Ma * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved. 37d116dccSCC Ma * 482cb2c1aSdp-arm * SPDX-License-Identifier: BSD-3-Clause 57d116dccSCC Ma */ 6*09d40e0eSAntonio Nino Diaz 77d116dccSCC Ma #include <arch_helpers.h> 8*09d40e0eSAntonio Nino Diaz #include <lib/mmio.h> 9*09d40e0eSAntonio Nino Diaz 107d116dccSCC Ma #include <mcucfg.h> 117d116dccSCC Ma #include <mt8173_def.h> 127d116dccSCC Ma #include <mt_cpuxgpt.h> 137d116dccSCC Ma 147d116dccSCC Ma static void write_cpuxgpt(unsigned int reg_index, unsigned int value) 157d116dccSCC Ma { 167d116dccSCC Ma mmio_write_32((uintptr_t)&mt8173_mcucfg->xgpt_idx, reg_index); 177d116dccSCC Ma mmio_write_32((uintptr_t)&mt8173_mcucfg->xgpt_ctl, value); 187d116dccSCC Ma } 197d116dccSCC Ma 207d116dccSCC Ma static void cpuxgpt_set_init_cnt(unsigned int countH, unsigned int countL) 217d116dccSCC Ma { 227d116dccSCC Ma write_cpuxgpt(INDEX_CNT_H_INIT, countH); 237d116dccSCC Ma /* update count when countL programmed */ 247d116dccSCC Ma write_cpuxgpt(INDEX_CNT_L_INIT, countL); 257d116dccSCC Ma } 267d116dccSCC Ma 277d116dccSCC Ma void generic_timer_backup(void) 287d116dccSCC Ma { 297d116dccSCC Ma uint64_t cval; 307d116dccSCC Ma 317d116dccSCC Ma cval = read_cntpct_el0(); 327d116dccSCC Ma cpuxgpt_set_init_cnt((uint32_t)(cval >> 32), 337d116dccSCC Ma (uint32_t)(cval & 0xffffffff)); 347d116dccSCC Ma } 35