mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-16 01:24:27 +00:00
a6485b2b3b
In order to avoid separate platform definitions when not using the default timer functions, it is better to move these functions out of the header file and into the source files, so that they can be built if needed. Move timer functions from delay_timer.h into generic_delay_timer.c. Add them as callback functions which are then called in delay_timer.c. Change-Id: I96a1eac8948b1a7b1e481899b67a083db4c9b97d Signed-off-by: Abhi Singh <abhi.singh@arm.com>
82 lines
2 KiB
C
82 lines
2 KiB
C
/*
|
|
* Copyright (c) 2016-2024, Arm Limited and Contributors. All rights reserved.
|
|
* Copyright (c) 2020, NVIDIA Corporation. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <assert.h>
|
|
|
|
#include <arch_features.h>
|
|
#include <arch_helpers.h>
|
|
#include <common/bl_common.h>
|
|
#include <common/debug.h>
|
|
#include <drivers/delay_timer.h>
|
|
#include <drivers/generic_delay_timer.h>
|
|
#include <lib/utils_def.h>
|
|
#include <plat/common/platform.h>
|
|
|
|
static timer_ops_t ops;
|
|
|
|
static uint64_t timeout_cnt_us2cnt(uint32_t us)
|
|
{
|
|
return ((uint64_t)us * (uint64_t)read_cntfrq_el0()) / 1000000ULL;
|
|
}
|
|
|
|
static uint64_t generic_delay_timeout_init_us(uint32_t us)
|
|
{
|
|
uint64_t cnt = timeout_cnt_us2cnt(us);
|
|
|
|
cnt += read_cntpct_el0();
|
|
|
|
return cnt;
|
|
}
|
|
|
|
static bool generic_delay_timeout_elapsed(uint64_t expire_cnt)
|
|
{
|
|
return read_cntpct_el0() > expire_cnt;
|
|
}
|
|
|
|
static uint32_t generic_delay_get_timer_value(void)
|
|
{
|
|
/*
|
|
* Generic delay timer implementation expects the timer to be a down
|
|
* counter. We apply bitwise NOT operator to the tick values returned
|
|
* by read_cntpct_el0() to simulate the down counter. The value is
|
|
* clipped from 64 to 32 bits.
|
|
*/
|
|
return (uint32_t)(~read_cntpct_el0());
|
|
}
|
|
|
|
void generic_delay_timer_init_args(uint32_t mult, uint32_t div)
|
|
{
|
|
ops.get_timer_value = generic_delay_get_timer_value;
|
|
ops.clk_mult = mult;
|
|
ops.clk_div = div;
|
|
ops.timeout_init_us = generic_delay_timeout_init_us;
|
|
ops.timeout_elapsed = generic_delay_timeout_elapsed;
|
|
|
|
timer_init(&ops);
|
|
|
|
VERBOSE("Generic delay timer configured with mult=%u and div=%u\n",
|
|
mult, div);
|
|
}
|
|
|
|
void generic_delay_timer_init(void)
|
|
{
|
|
assert(is_armv7_gentimer_present());
|
|
|
|
/* Value in ticks */
|
|
unsigned int mult = MHZ_TICKS_PER_SEC;
|
|
|
|
/* Value in ticks per second (Hz) */
|
|
unsigned int div = plat_get_syscnt_freq2();
|
|
|
|
/* Reduce multiplier and divider by dividing them repeatedly by 10 */
|
|
while (((mult % 10U) == 0U) && ((div % 10U) == 0U)) {
|
|
mult /= 10U;
|
|
div /= 10U;
|
|
}
|
|
|
|
generic_delay_timer_init_args(mult, div);
|
|
}
|