2016-05-18 10:37:25 +01:00
|
|
|
/*
|
2019-02-06 09:23:04 +00:00
|
|
|
* Copyright (c) 2016-2019, ARM Limited and Contributors. All rights reserved.
|
2020-02-13 21:07:12 +00:00
|
|
|
* Copyright (c) 2020, NVIDIA Corporation. All rights reserved.
|
2016-05-18 10:37:25 +01:00
|
|
|
*
|
2017-05-03 09:38:09 +01:00
|
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
2016-05-18 10:37:25 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <assert.h>
|
2018-12-14 00:18:21 +00:00
|
|
|
|
2019-02-06 09:23:04 +00:00
|
|
|
#include <arch_features.h>
|
2018-12-14 00:18:21 +00:00
|
|
|
#include <arch_helpers.h>
|
|
|
|
#include <common/bl_common.h>
|
|
|
|
#include <common/debug.h>
|
|
|
|
#include <drivers/delay_timer.h>
|
|
|
|
#include <drivers/generic_delay_timer.h>
|
2020-02-13 21:07:12 +00:00
|
|
|
#include <lib/utils_def.h>
|
2018-12-14 00:18:21 +00:00
|
|
|
#include <plat/common/platform.h>
|
2016-05-18 10:37:25 +01:00
|
|
|
|
|
|
|
static timer_ops_t ops;
|
|
|
|
|
|
|
|
static uint32_t 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 = get_timer_value;
|
|
|
|
ops.clk_mult = mult;
|
|
|
|
ops.clk_div = div;
|
|
|
|
|
|
|
|
timer_init(&ops);
|
|
|
|
|
|
|
|
VERBOSE("Generic delay timer configured with mult=%u and div=%u\n",
|
|
|
|
mult, div);
|
|
|
|
}
|
|
|
|
|
|
|
|
void generic_delay_timer_init(void)
|
|
|
|
{
|
2019-02-06 09:23:04 +00:00
|
|
|
assert(is_armv7_gentimer_present());
|
|
|
|
|
2016-05-18 10:37:25 +01:00
|
|
|
/* 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 */
|
2018-09-19 14:23:03 +01:00
|
|
|
while (((mult % 10U) == 0U) && ((div % 10U) == 0U)) {
|
|
|
|
mult /= 10U;
|
|
|
|
div /= 10U;
|
2016-05-18 10:37:25 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
generic_delay_timer_init_args(mult, div);
|
|
|
|
}
|
|
|
|
|