blob: c48edae59d5043d40d72bf87a4586242814097a1 (
plain)
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
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <southbridge/intel/common/rcba.h>
#include <stdint.h>
#include "hpet.h"
#define HPTC 0x3404
#define HPET_BASE 0xfed00000
#define HPET32(x) (*((volatile u32 *)(HPET_BASE + (x))))
void enable_hpet(void)
{
u32 reg32;
reg32 = RCBA32(HPTC);
reg32 &= ~0x03;
reg32 |= (1 << 7);
RCBA32(HPTC) = reg32;
/* Read back for posted write to take effect */
RCBA32(HPTC);
HPET32(0x10) = HPET32(0x10) | 1;
}
void hpet_udelay(u32 delay)
{
u32 start, finish, now;
delay *= 15; /* now in usec */
start = HPET32(0xf0);
finish = start + delay;
while (1) {
now = HPET32(0xf0);
if (finish > start) {
if (now >= finish)
break;
} else {
if ((now < start) && (now >= finish))
break;
}
}
}
|
