blob: 3eb5656a156e95b30ec52dd4aebddb4c576a6a87 [file] [log] [blame]
Patrick Georgi0a3d4e02020-03-04 14:39:09 +01001/* SPDX-License-Identifier: GPL-2.0-only */
T Michael Turney3775f1c2018-04-24 10:15:46 -07002
T Michael Turney3775f1c2018-04-24 10:15:46 -07003#include <arch/lib_helpers.h>
Yidi Lin85d78092023-10-31 18:50:06 +08004#include <commonlib/bsd/gcd.h>
5#include <timer.h>
T Michael Turney3775f1c2018-04-24 10:15:46 -07006
7void timer_monotonic_get(struct mono_time *mt)
8{
9 uint64_t tvalue = raw_read_cntpct_el0();
Yidi Lin85d78092023-10-31 18:50:06 +080010 static uint32_t tfreq, mult;
11 uint32_t div;
12
13 /*
14 * The value from raw_read_cntfrq_el0() could be large enough to
15 * cause overflow when multiplied by USECS_PER_SEC. To prevent this,
16 * both USECS_PER_SEC. and tfreq can be reduced by dividing them by
17 * their GCD.
18 */
19 if (tfreq == 0) {
20 tfreq = raw_read_cntfrq_el0();
21 mult = USECS_PER_SEC;
22 div = gcd32(tfreq, mult);
23 tfreq /= div;
24 mult /= div;
25 }
26
27 long usecs = (tvalue * mult) / tfreq;
T Michael Turney3775f1c2018-04-24 10:15:46 -070028 mono_time_set_usecs(mt, usecs);
29}