fixup "hw: calibrate Local APIC via ACPI timer" (final cosmetic touches)

and one bug fix
This commit is contained in:
Christian Helmuth
2025-01-22 12:12:47 +01:00
parent 8bdddbd46a
commit 28ecbbbb71
16 changed files with 46 additions and 41 deletions

View File

@@ -17,6 +17,7 @@
#include <base/fixed_stdint.h>
namespace Hw {
using Genode::uint8_t;
using Genode::uint16_t;

View File

@@ -92,33 +92,32 @@ static uint32_t calibrate_tsc_frequency(addr_t fadt_addr)
}
static void calibrate_lapic_frequency(addr_t fadt_addr, uint32_t &ticks_per_ms, uint32_t &div)
static Hw::Local_apic::Calibration calibrate_lapic_frequency(addr_t fadt_addr)
{
uint32_t const default_ticks_per_ms = TIMER_MIN_TICKS_PER_MS;
uint32_t const sleep_ms = 10;
uint32_t const default_freq = TIMER_MIN_TICKS_PER_MS;
if (!fadt_addr) {
warning("FADT not found, setting minimum Local APIC frequency of ", default_ticks_per_ms, "kHz");
ticks_per_ms = default_ticks_per_ms;
warning("FADT not found, setting minimum Local APIC frequency of ", default_freq, "kHz");
return { default_freq, 1 };
}
uint32_t const sleep_ms = 10;
Hw::Acpi_fadt fadt(reinterpret_cast<Hw::Acpi_generic *>(fadt_addr));
Hw::Local_apic lapic(Hw::Cpu_memory_map::lapic_phys_base());
ticks_per_ms = 0;
auto const result =
lapic.calibrate_divider([&] {
return fadt.calibrate_freq_khz(sleep_ms, [&] {
return lapic.read<Hw::Local_apic::Tmr_current>(); }, true); });
lapic.calibrate_divider(ticks_per_ms, div, [&]() {
return fadt.calibrate_freq_khz(sleep_ms, [&]() {
return lapic.read<Hw::Local_apic::Tmr_current>();;
}, true);
});
if (!ticks_per_ms) {
warning("FADT not found, setting minimum Local APIC frequency of ", default_ticks_per_ms, "kHz");
ticks_per_ms = default_ticks_per_ms;
if (!result.freq_khz) {
warning("FADT not found, setting minimum Local APIC frequency of ", default_freq, "kHz");
return { default_freq, 1 };
}
return result;
}
@@ -132,8 +131,6 @@ static void disable_pit()
PIT_MODE = 0x43,
};
struct Calibration_failed : Genode::Exception { };
/**
* Disable PIT timer channel. This is necessary since BIOS sets up
* channel 0 to fire periodically.
@@ -328,8 +325,10 @@ Bootstrap::Platform::Board::Board()
cpus = !cpus ? 1 : max_cpus;
}
calibrate_lapic_frequency(info.acpi_fadt, info.lapic_ticks_per_ms, info.lapic_div);
info.tsc_freq_khz = calibrate_tsc_frequency(info.acpi_fadt);
auto r = calibrate_lapic_frequency(info.acpi_fadt);
info.lapic_freq_khz = r.freq_khz;
info.lapic_div = r.div;
info.tsc_freq_khz = calibrate_tsc_frequency(info.acpi_fadt);
disable_pit();

View File

@@ -45,7 +45,7 @@ void Board::Timer::init()
}
Platform::apply_with_boot_info([&](auto const &boot_info) {
ticks_per_ms = boot_info.plat_info.lapic_ticks_per_ms;
ticks_per_ms = boot_info.plat_info.lapic_freq_khz;
divider = boot_info.plat_info.lapic_div;
});
}

View File

@@ -84,27 +84,32 @@ struct Hw::Local_apic : Genode::Mmio<Hw::Cpu_memory_map::LAPIC_SIZE>
};
};
void calibrate_divider(uint32_t &ticks_per_ms, uint32_t &divider, auto calibration_fn)
struct Calibration { uint32_t freq_khz; uint32_t div; };
Calibration calibrate_divider(auto calibration_fn)
{
Calibration result { };
/* calibrate LAPIC frequency to fullfill our requirements */
for (Divide_configuration::access_t div = Divide_configuration::Divide_value::MAX;
div && ticks_per_ms < TIMER_MIN_TICKS_PER_MS; div--)
{
div && result.freq_khz < TIMER_MIN_TICKS_PER_MS; div--) {
if (!div) {
raw("Failed to calibrate Local APIC frequency");
ticks_per_ms = 0;
break;
return { 0, 1 };
}
write<Divide_configuration::Divide_value>((uint8_t)div);
write<Tmr_initial>(~0U);
/* Calculate timer frequency */
ticks_per_ms = calibration_fn();
divider = div;
result.freq_khz = calibration_fn();
result.div = div;
write<Tmr_initial>(0);
}
return result;
}
Local_apic(addr_t const addr) : Mmio({(char*)addr, Mmio::SIZE}) {}

View File

@@ -45,8 +45,8 @@ struct Hw::Pc_board::Boot_info
Genode::addr_t efi_system_table { 0 };
Genode::addr_t acpi_fadt { 0 };
Genode::uint32_t tsc_freq_khz { 0 };
Genode::uint32_t lapic_ticks_per_ms { 0 };
Genode::uint32_t lapic_div { 0 };
Genode::uint32_t lapic_freq_khz { 0 };
Genode::uint32_t lapic_div { 0 };
Boot_info() {}
Boot_info(Acpi_rsdp const &acpi_rsdp,

View File

@@ -1 +1 @@
2025-01-16 2cdd7e0cf9eab4981f58b89b33b9a106c3c2bd33
2024-12-10 19af2857787095f29ff1156ca12921a84b8c2c88

View File

@@ -1 +1 @@
2025-01-16 9f4e7fa4380d2eb941adb197daf5952916a71463
2024-12-10 0cb59fb39e1ef2c557804fe74904f262e7cc990d

View File

@@ -1 +1 @@
2025-01-16 95ced46da790f7a009eb0522f132fe2335bce645
2024-12-10 6cfb903adb9b3a37335b8a153735ea5f2add9479

View File

@@ -1 +1 @@
2025-01-16 befac925d2cc4461c3fd3fe63877f05e338e80ce
2024-12-10 f6e7dcb77f24f2f69afe225449744ca3f78e94ac

View File

@@ -1 +1 @@
2025-01-16 a67c57084fc6a10686dc283c7479ef3c05065b5f
2024-12-10 11b1ec97e8ebc727801208d4d1c5c1066e7037ed

View File

@@ -1 +1 @@
2025-01-16 67e33ff7cf31a432bd8d93a0394ebc55199e888d
2024-12-10 121ec4ccd1bb65240ce5000ca49a48bf58bb74d8

View File

@@ -1 +1 @@
2025-01-16 049b93c7a4e9bfd6b8637aab8f37f774bcf9a5dc
2024-12-10 fe0faac47649d3c25dfc42bb764f18802862def9

View File

@@ -1 +1 @@
2025-01-16 3e48430b91da4cb566a1b6f7c3fec02a915a782d
2024-12-10 7fdaf553f171d5af35643f456d09af93f4167e69

View File

@@ -1 +1 @@
2025-01-16 473ed002fe1d43c491db3c9730774d09e16f8b2a
2024-12-10 126809511e7c96a49bcc4109ccea98102afc9495

View File

@@ -1 +1 @@
2025-01-16 f21f3cbf85a383a0d03729c0aa0853815c8d67a1
2024-12-10 855cac282025e574e9a9619bfc063dbd0fa3700d

View File

@@ -1 +1 @@
2025-01-16 376e356fec3b8b0dd163d2f6408f8c9796618b7d
2024-12-10 f87120b971a2fe5732884f78ecd127c86eb6ce28