blob: bedbb23758926b1c41b1807a05c83afbd896f5c8 (
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
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
|
/* -------------------------------------------
Copyright (C) 2024, Amlal EL Mahrouss, all rights reserved.
File: HalTimer.cc
Purpose: HAL timer
Revision History:
07/07/24: Added file (amlel)
------------------------------------------- */
#include <Mod/ACPI/ACPIFactoryInterface.h>
#include <ArchKit/ArchKit.h>
#include <KernelKit/Timer.h>
// timer slot 0
#define cHPETCounterRegValue (0x00)
#define cHPETConfigRegValue (0x20)
#define cHPETCompRegValue (0x24)
#define cHPETInterruptRegValue (0x2C)
///! BUGS: 0
///! @file HalTimer.cc
///! @brief Hardware Timer (HPET)
namespace Kernel::Detail
{
struct HPET_BLOCK : public Kernel::SDT
{
Kernel::UInt8 hardware_rev_id;
Kernel::UInt8 comparator_count : 5;
Kernel::UInt8 counter_size : 1;
Kernel::UInt8 reserved : 1;
Kernel::UInt8 legacy_replacement : 1;
Kernel::UInt16 pci_vendor_id;
ACPI_ADDRESS address;
Kernel::UInt8 hpet_number;
Kernel::UInt16 minimum_tick;
Kernel::UInt8 page_protection;
} PACKED;
} // namespace Kernel::Detail
using namespace Kernel;
HardwareTimer::HardwareTimer(Int64 ms)
: fWaitFor(ms)
{
auto power = PowerFactoryInterface(kHandoverHeader->f_HardwareTables.f_VendorPtr);
auto hpet = (Detail::HPET_BLOCK*)power.Find("HPET").Leak().Leak();
MUST_PASS(hpet);
fDigitalTimer = (IntPtr*)hpet->address.Address;
}
HardwareTimer::~HardwareTimer()
{
fDigitalTimer = nullptr;
fWaitFor = 0;
}
BOOL HardwareTimer::Wait() noexcept
{
if (fWaitFor < 1)
return NO;
// if not enabled yet.
if (!(*(fDigitalTimer + cHPETConfigRegValue) & (1 << 0)))
{
*(fDigitalTimer + cHPETConfigRegValue) |= (1 << 0); // enable it
*(fDigitalTimer + cHPETConfigRegValue) |= (1 << 3); // one shot conf
}
UInt64 ticks = fWaitFor / ((*(fDigitalTimer) >> 32) & __UINT32_MAX__);
UInt64 prev = *(fDigitalTimer + cHPETCounterRegValue);
prev += ticks;
while (*(fDigitalTimer + cHPETCounterRegValue) < (ticks))
;
return YES;
}
|
