wip: S3 sleep debugging

This commit is contained in:
2026-03-30 10:46:37 +02:00
parent b3ba4249ee
commit ef380db992
4 changed files with 52 additions and 24 deletions
+15 -11
View File
@@ -47,19 +47,15 @@ namespace Hal {
Io::Out16(bits, (uint16_t)g_pm1bEventBlock);
}
static void EnablePM1Events(uint16_t mask) {
static void SetPM1Events(uint16_t mask) {
uint16_t enableOffset = g_pm1EventLength / 2;
if (enableOffset == 0) return;
if (g_pm1aEventBlock != 0) {
uint16_t en = Io::In16((uint16_t)(g_pm1aEventBlock + enableOffset));
en |= mask;
Io::Out16(en, (uint16_t)(g_pm1aEventBlock + enableOffset));
Io::Out16(mask, (uint16_t)(g_pm1aEventBlock + enableOffset));
}
if (g_pm1bEventBlock != 0) {
uint16_t en = Io::In16((uint16_t)(g_pm1bEventBlock + enableOffset));
en |= mask;
Io::Out16(en, (uint16_t)(g_pm1bEventBlock + enableOffset));
Io::Out16(mask, (uint16_t)(g_pm1bEventBlock + enableOffset));
}
}
@@ -112,7 +108,7 @@ namespace Hal {
AcpiSleep::PM1_BM_STS);
// Enable power button event
EnablePM1Events(AcpiSleep::PM1_PWRBTN_EN);
SetPM1Events(AcpiSleep::PM1_PWRBTN_EN);
// Route SCI to an IRQ vector. The SCI is level-triggered,
// active-low (ACPI spec requirement). The MADT may have an
@@ -137,10 +133,18 @@ namespace Hal {
void Reinitialize() {
if (!g_initialized) return;
// Clear pending status and re-enable power button event
// Resume may leave WAK/RTC/GBL bits pending. Because the SCI is
// level-triggered, re-enabling interrupts without clearing them can
// immediately retrigger the SCI in a tight loop.
ClearPM1StatusBits(
AcpiSleep::PM1_PWRBTN_STS | AcpiSleep::PM1_SLPBTN_STS);
EnablePM1Events(AcpiSleep::PM1_PWRBTN_EN);
AcpiSleep::PM1_PWRBTN_STS | AcpiSleep::PM1_SLPBTN_STS |
AcpiSleep::PM1_WAK_STS | AcpiSleep::PM1_TMR_STS |
AcpiSleep::PM1_GBL_STS | AcpiSleep::PM1_RTC_STS |
AcpiSleep::PM1_BM_STS);
// Drop the suspend-time RTC wake enable and restore only the
// fixed events we actually want during normal runtime.
SetPM1Events(AcpiSleep::PM1_PWRBTN_EN);
}
};
+30 -13
View File
@@ -15,11 +15,12 @@ section .text
;
; Saves all CPU registers into the CpuState structure, then returns 1.
; The caller is expected to enter S3 after this returns.
; When the system resumes, AcpiResumeLongMode jumps to the saved RIP
; with RAX=0, so Suspend() knows it's a resume.
; On resume we rebuild the caller-visible stack frame and return to the
; original Suspend() continuation via AcpiResumeEntry().
;
; Returns: 1 on initial call (proceed to enter S3)
; 0 on resume from S3
; Resume does not re-enter this function directly; control is
; reconstructed by AcpiResumeLongMode/AcpiResumeEntry.
;
; CpuState layout:
; 0x00 RAX 0x40 R8 0x80 RFLAGS
@@ -41,7 +42,12 @@ AcpiSaveAndSuspend:
mov [rdi + 0x20], rsi
mov [rdi + 0x28], rdi ; save rdi (pointer to state area)
mov [rdi + 0x30], rbp
mov [rdi + 0x38], rsp
; Save the caller's post-return RSP, not our own entry RSP. The raw
; entry RSP points at this call's temporary return-address slot, which
; the suspend path will later reuse for other calls before the machine
; actually enters S3.
lea rax, [rsp + 8]
mov [rdi + 0x38], rax
mov [rdi + 0x40], r8
mov [rdi + 0x48], r9
mov [rdi + 0x50], r10
@@ -122,8 +128,8 @@ g_wakeStatePtr: dq 0
; extern "C" void AcpiResumeLongMode(CpuState* stateArea)
; rdi = pointer to CpuState structure
;
; Restores all saved registers and returns to the original Suspend() caller
; with RAX=0 to indicate "resumed from S3".
; Restores the saved machine state, reconstructs the original Suspend()
; continuation on the stack, and then jumps into the C resume path.
;
global AcpiResumeLongMode
AcpiResumeLongMode:
@@ -139,7 +145,10 @@ AcpiResumeLongMode:
; We must restore the kernel stack FIRST so push/pop work, then reload
; GDT/CS/IDT before any interrupt can fire.
; Restore kernel RSP immediately so we have a valid stack
; Restore the caller-visible kernel RSP immediately so we have a valid
; stack. AcpiSaveAndSuspend saved the post-return value (RSP after the
; original call had completed), so we will reconstruct the return address
; explicitly below before entering C.
mov rsp, [rdi + 0x38]
; Restore GDT
@@ -208,8 +217,13 @@ AcpiResumeLongMode:
mov r14, [rdi + 0x70]
mov r15, [rdi + 0x78]
; Restore RFLAGS
; Restore RFLAGS but keep IF masked until AcpiResumeEntry finishes
; rebuilding GS base, TSS, APIC, and the rest of the interrupt state.
; The saved flags usually have IF=1 because Suspend() is entered from a
; live syscall path; restoring that too early lets an IRQ hit a
; half-restored kernel.
mov rax, [rdi + 0x80]
and rax, ~(1 << 9)
push rax
popfq
@@ -219,11 +233,14 @@ AcpiResumeLongMode:
mov al, 0xC4
out 0x71, al
; Restore rdi last
mov rdi, [rdi + 0x28]
; Reconstruct the original return address. The suspend path ran many more
; calls after AcpiSaveAndSuspend returned, so the old call-frame slot on
; the kernel stack can no longer be trusted.
push qword [rdi + 0x88]
; Instead of returning to Suspend() via ret (which is fragile due to
; compiler stack frame assumptions), jump directly to a dedicated C
; resume function. This is how Linux and other kernels handle S3 resume.
; Instead of re-entering Suspend() directly from assembly, jump to a
; dedicated C resume function which rebuilds the rest of the runtime
; environment and then returns to the original caller via the RIP we just
; pushed.
extern AcpiResumeEntry
jmp AcpiResumeEntry
+2
View File
@@ -8,6 +8,8 @@
#include <cstdint>
#include <Efi/UEFI.hpp>
#include <Memory/Paging.hpp>
#include <Io/IoPort.hpp>
#include <Graphics/Cursor.hpp>
#include <ACPI/AcpiShutdown.hpp>
#include <ACPI/AcpiSleep.hpp>
+5
View File
@@ -70,6 +70,11 @@ namespace Hal {
}
void LoadTSS() {
// LTR marks the TSS descriptor busy in the GDT (type 0xB). S3 loses
// the CPU's loaded task register state, but the busy bit in RAM
// persists, so a plain second LTR on resume can #GP. Re-mark it as an
// available 64-bit TSS before reloading TR.
kernelGDT.TSS.AccessByte = 0x89;
LoadTR();
KernelLogStream(OK, "Hal") << "Loaded TSS (selector 0x28)";
}