1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
|
/** @file
CPUCFG 0x4 and 0x5 for Stable Counter frequency instance of Timer Library.
Copyright (c) 2024, Loongson Technology Corporation Limited. All rights reserved.<BR>
SPDX-License-Identifier: BSD-2-Clause-Patent
**/
#include <Base.h>
#include <Library/BaseLib.h>
#include <Library/DebugLib.h>
#include <Library/SafeIntLib.h>
#include <Library/TimerLib.h>
#include <Register/LoongArch64/Cpucfg.h>
/**
Calculate clock frequency using CPUCFG 0x4 and 0x5 registers.
@param VOID.
@return The frequency in Hz.
**/
STATIC
UINT64
CalcConstFreq (
VOID
)
{
UINT32 BaseFreq;
UINT64 ClockMultiplier;
UINT32 ClockDivide;
CPUCFG_REG4_INFO_DATA CcFreq;
CPUCFG_REG5_INFO_DATA CpucfgReg5Data;
UINT64 StableTimerFreq;
//
// Get the the crystal frequency corresponding to the constant
// frequency timer and the clock used by the timer.
//
AsmCpucfg (CPUCFG_REG4_INFO, &CcFreq.Uint32);
//
// Get the multiplication factor and frequency division factor
// corresponding to the constant frequency timer and the clock
// used by the timer.
//
AsmCpucfg (CPUCFG_REG5_INFO, &CpucfgReg5Data.Uint32);
BaseFreq = CcFreq.Bits.CC_FREQ;
ClockMultiplier = CpucfgReg5Data.Bits.CC_MUL & 0xFFFF;
ClockDivide = CpucfgReg5Data.Bits.CC_DIV & 0xFFFF;
if ((BaseFreq == 0x0) || (ClockMultiplier == 0x0) || (ClockDivide == 0x0)) {
DEBUG ((
DEBUG_ERROR,
"LoongArch Stable Timer is not available in the CPU, hence this library cannot be used.\n"
));
ASSERT (FALSE);
CpuDeadLoop ();
}
StableTimerFreq = ((ClockMultiplier * BaseFreq) / ClockDivide);
ASSERT (StableTimerFreq != 0);
return StableTimerFreq;
}
/**
Stalls the CPU for at least the given number of microseconds.
Stalls the CPU for the number of microseconds specified by MicroSeconds.
@param MicroSeconds The minimum number of microseconds to delay.
@return MicroSeconds
**/
UINTN
EFIAPI
MicroSecondDelay (
IN UINTN MicroSeconds
)
{
UINT64 CurrentTicks, ExceptedTicks, Remaining;
RETURN_STATUS Status;
Status = SafeUint64Mult (MicroSeconds, CalcConstFreq (), &Remaining);
ASSERT_RETURN_ERROR (Status);
ExceptedTicks = DivU64x32 (Remaining, 1000000U);
CurrentTicks = AsmReadStableCounter ();
ExceptedTicks += CurrentTicks;
do {
CurrentTicks = AsmReadStableCounter ();
} while (CurrentTicks < ExceptedTicks);
return MicroSeconds;
}
/**
Stalls the CPU for at least the given number of nanoseconds.
Stalls the CPU for the number of nanoseconds specified by NanoSeconds.
@param NanoSeconds The minimum number of nanoseconds to delay.
@return NanoSeconds
**/
UINTN
EFIAPI
NanoSecondDelay (
IN UINTN NanoSeconds
)
{
UINTN MicroSeconds;
// Round up to 1us Tick Number
MicroSeconds = NanoSeconds / 1000;
MicroSeconds += ((NanoSeconds % 1000) == 0) ? 0 : 1;
MicroSecondDelay (MicroSeconds);
return NanoSeconds;
}
/**
Retrieves the current value of a 64-bit free running Stable Counter.
The LoongArch defines a constant frequency timer, whose main body is a
64-bit counter called StableCounter. StableCounter is set to 0 after
reset, and then increments by 1 every counting clock cycle. When the
count reaches all 1s, it automatically wraps around to 0 and continues
to increment.
The properties of the Stable Counter can be retrieved from
GetPerformanceCounterProperties().
@return The current value of the Stable Counter.
**/
UINT64
EFIAPI
GetPerformanceCounter (
VOID
)
{
//
// Just return the value of Stable Counter.
//
return AsmReadStableCounter ();
}
/**
Retrieves the 64-bit frequency in Hz and the range of Stable Counter
values.
If StartValue is not NULL, then the value that the stbale counter starts
with immediately after is it rolls over is returned in StartValue. If
EndValue is not NULL, then the value that the stable counter end with
immediately before it rolls over is returned in EndValue. The 64-bit
frequency of the system frequency in Hz is always returned.
@param StartValue The value the stable counter starts with when it
rolls over.
@param EndValue The value that the stable counter ends with before
it rolls over.
@return The frequency in Hz.
**/
UINT64
EFIAPI
GetPerformanceCounterProperties (
OUT UINT64 *StartValue OPTIONAL,
OUT UINT64 *EndValue OPTIONAL
)
{
if (StartValue != NULL) {
*StartValue = 0;
}
if (EndValue != NULL) {
*EndValue = 0xFFFFFFFFFFFFFFFFULL;
}
return CalcConstFreq ();
}
/**
Converts elapsed ticks of performance counter to time in nanoseconds.
This function converts the elapsed ticks of running performance counter to
time value in unit of nanoseconds.
@param Ticks The number of elapsed ticks of running performance counter.
@return The elapsed time in nanoseconds.
**/
UINT64
EFIAPI
GetTimeInNanoSecond (
IN UINT64 Ticks
)
{
UINT64 Frequency;
UINT64 NanoSeconds;
UINT64 Remainder;
INTN Shift;
RETURN_STATUS Status;
Frequency = GetPerformanceCounterProperties (NULL, NULL);
//
// Ticks
// Time = --------- x 1,000,000,000
// Frequency
//
Status = SafeUint64Mult (
DivU64x64Remainder (Ticks, Frequency, &Remainder),
1000000000u,
&NanoSeconds
);
ASSERT_RETURN_ERROR (Status);
//
// Ensure (Remainder * 1,000,000,000) will not overflow 64-bit.
// Since 2^29 < 1,000,000,000 = 0x3B9ACA00 < 2^30, Remainder should < 2^(64-30) = 2^34,
// i.e. highest bit set in Remainder should <= 33.
//
Shift = MAX (0, HighBitSet64 (Remainder) - 33);
Remainder = RShiftU64 (Remainder, (UINTN)Shift);
Frequency = RShiftU64 (Frequency, (UINTN)Shift);
Status = SafeUint64Add (
NanoSeconds,
DivU64x64Remainder (
MultU64x32 (Remainder, 1000000000u),
Frequency,
NULL
),
&NanoSeconds
);
ASSERT_RETURN_ERROR (Status);
return NanoSeconds;
}
|