|
|
|
@@ -4,13 +4,11 @@
|
|
|
|
|
//! grant, a broad irq window, the SCI), and runs the **shared AML module** in
|
|
|
|
|
//! ring 3 — the same parser and interpreter the kernel uses.
|
|
|
|
|
//!
|
|
|
|
|
//! M20.2 (this increment): after parsing, walk the namespace and, for each
|
|
|
|
|
//! present Device with a hardware id (`_HID`), evaluate its current resource
|
|
|
|
|
//! settings (`_CRS`) through a ring-3 `Hal` (port I/O over the claimed node),
|
|
|
|
|
//! register it under the acpi-tables node (its I/O ports and IRQs contained by
|
|
|
|
|
//! the node's broad grants), and report it to the device manager with its
|
|
|
|
|
//! EISA-decoded hid as identity. Matching those reports to drivers (ps2-bus)
|
|
|
|
|
//! and retiring the kernel's own device build follow in M20.3.
|
|
|
|
|
//! It also owns the **event side** (M21): it registers the domain-named `.power`
|
|
|
|
|
//! service, binds the SCI (System Control Interrupt), and on a power-button
|
|
|
|
|
//! fixed event publishes `power_button` to subscribers — and on init's request
|
|
|
|
|
//! writes S5 to power the machine off. The device discovery (M20) and the event
|
|
|
|
|
//! handling both run in one `runtime.service.run` loop.
|
|
|
|
|
|
|
|
|
|
const std = @import("std");
|
|
|
|
|
const runtime = @import("runtime");
|
|
|
|
@@ -18,6 +16,7 @@ const aml = @import("aml");
|
|
|
|
|
const acpi_ids = @import("acpi-ids");
|
|
|
|
|
const device = runtime.device;
|
|
|
|
|
const protocol = runtime.device_manager_protocol;
|
|
|
|
|
const power = runtime.power_protocol;
|
|
|
|
|
/// AML opcode/prefix bytes by name (`zero_opcode`, `byte_prefix`, …) — so the `_HID`
|
|
|
|
|
/// integer decode names the opcodes instead of bare 0x0A/0x0B/… (docs/coding-standards.md).
|
|
|
|
|
const opcodes = aml.opcodes;
|
|
|
|
@@ -31,6 +30,38 @@ fn writeLine(comptime fmt: []const u8, arguments: anytype) void {
|
|
|
|
|
// window — the Hal routes every port access through this one claim.
|
|
|
|
|
var node_id: u64 = 0;
|
|
|
|
|
var io_resource_index: u64 = 0;
|
|
|
|
|
// The SCI's irq resource index on the node (the len-1 irq, distinct from the
|
|
|
|
|
// broad [0,256) window), for irqBind / irqAck.
|
|
|
|
|
var sci_resource_index: u64 = 0;
|
|
|
|
|
var has_sci = false;
|
|
|
|
|
|
|
|
|
|
// PM1 event/control and GPE register ports, read from the FADT copy the kernel
|
|
|
|
|
// publishes on the node (M21). Port 0 means absent.
|
|
|
|
|
var pm1a_evt: u16 = 0;
|
|
|
|
|
var pm1b_evt: u16 = 0;
|
|
|
|
|
var pm1_evt_len: u8 = 0;
|
|
|
|
|
var pm1a_cnt: u16 = 0;
|
|
|
|
|
var pm1b_cnt: u16 = 0;
|
|
|
|
|
var gpe0_blk: u16 = 0;
|
|
|
|
|
var gpe0_len: u8 = 0;
|
|
|
|
|
var gpe1_blk: u16 = 0;
|
|
|
|
|
var gpe1_len: u8 = 0;
|
|
|
|
|
var smi_cmd: u16 = 0;
|
|
|
|
|
var acpi_enable_value: u8 = 0;
|
|
|
|
|
var s5_slp_typ_a: u8 = 0;
|
|
|
|
|
var s5_slp_typ_b: u8 = 0;
|
|
|
|
|
var s5_valid = false;
|
|
|
|
|
|
|
|
|
|
// PM1 event-register bits (ACPI): PWRBTN in the status/enable word is bit 8;
|
|
|
|
|
// the control word's SCI_EN is bit 0; SLP_EN is bit 13.
|
|
|
|
|
const pwrbtn_bit: u16 = 1 << 8;
|
|
|
|
|
const sci_en_bit: u32 = 1 << 0;
|
|
|
|
|
const slp_en: u32 = 1 << 13;
|
|
|
|
|
|
|
|
|
|
// The `.power` subscribers: endpoints handed over as capabilities, each
|
|
|
|
|
// receiving events as buffered messages. Dropped on a failed send.
|
|
|
|
|
const maximum_subscribers = 8;
|
|
|
|
|
var subscribers: [maximum_subscribers]?runtime.ipc.Handle = .{null} ** maximum_subscribers;
|
|
|
|
|
|
|
|
|
|
// Pass-1 registration record (see main): what pass 2 reports.
|
|
|
|
|
const Registered = struct { hid: [8]u8 = .{0} ** 8, hid_len: usize = 0, device_id: u64 = 0, resource_count: u64 = 0 };
|
|
|
|
@@ -85,22 +116,34 @@ pub fn main(init: runtime.process.Init) void {
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Map each memory resource (an AML blob) and note the io_port resource.
|
|
|
|
|
// Map the node's resources: the AML blobs (bytecode), the FADT (intact
|
|
|
|
|
// "FACP" header — decision 3), the io_port grant, and the SCI irq.
|
|
|
|
|
var blocks: [8][]const u8 = undefined;
|
|
|
|
|
var block_count: usize = 0;
|
|
|
|
|
var found_io = false;
|
|
|
|
|
var fadt: ?[]const u8 = null;
|
|
|
|
|
for (node.resources[0..@intCast(node.resource_count)], 0..) |resource, index| {
|
|
|
|
|
if (resource.kind == @intFromEnum(device.ResourceKind.io_port) and !found_io) {
|
|
|
|
|
io_resource_index = index;
|
|
|
|
|
found_io = true;
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
if (resource.kind == @intFromEnum(device.ResourceKind.irq) and resource.len == 1) {
|
|
|
|
|
sci_resource_index = index;
|
|
|
|
|
has_sci = true;
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
if (resource.kind != @intFromEnum(device.ResourceKind.memory)) continue;
|
|
|
|
|
const base = device.mmioMap(node_id, index) orelse continue;
|
|
|
|
|
const pointer: [*]const u8 = @ptrFromInt(base);
|
|
|
|
|
blocks[block_count] = pointer[0..@intCast(resource.len)];
|
|
|
|
|
const bytes = pointer[0..@intCast(resource.len)];
|
|
|
|
|
if (bytes.len >= 4 and std.mem.eql(u8, bytes[0..4], "FACP")) {
|
|
|
|
|
fadt = bytes;
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
if (block_count == blocks.len) continue;
|
|
|
|
|
blocks[block_count] = bytes;
|
|
|
|
|
block_count += 1;
|
|
|
|
|
if (block_count == blocks.len) break;
|
|
|
|
|
}
|
|
|
|
|
if (block_count == 0) {
|
|
|
|
|
_ = runtime.system.write("acpi: no AML blobs on the node\n");
|
|
|
|
@@ -124,29 +167,45 @@ pub fn main(init: runtime.process.Init) void {
|
|
|
|
|
while (true) runtime.system.sleep(1000);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Register + report the present _HID devices (M20.2).
|
|
|
|
|
var arena = std.heap.ArenaAllocator.init(runtime.allocator());
|
|
|
|
|
var interpreter = aml.Interpreter.init(&namespace, .{
|
|
|
|
|
// Register + report the present _HID devices (M20), then set up the power
|
|
|
|
|
// event side (M21), then serve — all in one harness loop. The interpreter
|
|
|
|
|
// and namespace outlive this frame (static), so the harness callbacks can
|
|
|
|
|
// reach them.
|
|
|
|
|
interpreter_arena = std.heap.ArenaAllocator.init(runtime.allocator());
|
|
|
|
|
persistent_namespace = namespace;
|
|
|
|
|
global_interpreter = aml.Interpreter.init(&persistent_namespace, .{
|
|
|
|
|
.mapMmio = halMapMmio,
|
|
|
|
|
.pioRead = halPioRead,
|
|
|
|
|
.pioWrite = halPioWrite,
|
|
|
|
|
}, arena.allocator());
|
|
|
|
|
}, interpreter_arena.allocator());
|
|
|
|
|
|
|
|
|
|
// Pass 1: register every present _HID device under acpi-tables, remembering
|
|
|
|
|
// each (hid, device id). Pass 2: report them all. Registering before any
|
|
|
|
|
// report reaches the manager means a driver it spawns on the first report
|
|
|
|
|
// already sees the whole set (no keyboard-before-mouse race for ps2-bus).
|
|
|
|
|
readFadt(fadt);
|
|
|
|
|
s5_valid = readSleepS5(&persistent_namespace);
|
|
|
|
|
|
|
|
|
|
runtime.service.run(power.message_maximum, .{
|
|
|
|
|
.service = .power,
|
|
|
|
|
.init = onInit,
|
|
|
|
|
.on_message = onMessage,
|
|
|
|
|
.on_notification = onNotification,
|
|
|
|
|
});
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Static so the harness callbacks (which run after main's stack frame is gone)
|
|
|
|
|
// can reach the namespace and interpreter.
|
|
|
|
|
var persistent_namespace: aml.Namespace = undefined;
|
|
|
|
|
var global_interpreter: aml.Interpreter = undefined;
|
|
|
|
|
var interpreter_arena: std.heap.ArenaAllocator = undefined;
|
|
|
|
|
|
|
|
|
|
/// Startup under the harness: register + report the discovered devices to the
|
|
|
|
|
/// manager (M20), then enable ACPI mode and arm the power button (M21).
|
|
|
|
|
fn onInit(endpoint: runtime.ipc.Handle) bool {
|
|
|
|
|
registered_count = 0;
|
|
|
|
|
walkDevices(namespace.root, &interpreter);
|
|
|
|
|
walkDevices(persistent_namespace.root, &global_interpreter);
|
|
|
|
|
|
|
|
|
|
const manager = runtime.ipc.lookup(.device_manager);
|
|
|
|
|
var i: usize = 0;
|
|
|
|
|
while (i < registered_count) : (i += 1) {
|
|
|
|
|
const entry = registered[i];
|
|
|
|
|
// Append the _HID's human-readable name when it is a known standard PnP/ACPI
|
|
|
|
|
// id (e.g. PNP0303 -> "PS/2 Keyboard"), so the boot log says what each
|
|
|
|
|
// reported device actually is. The description trails the existing fields so
|
|
|
|
|
// the acpi-report/acpi-ps2 matchers still see "<hid> (device N, M resources)".
|
|
|
|
|
const hid = entry.hid[0..entry.hid_len];
|
|
|
|
|
const desc = acpi_ids.description(hid);
|
|
|
|
|
if (desc.len != 0)
|
|
|
|
@@ -154,12 +213,7 @@ pub fn main(init: runtime.process.Init) void {
|
|
|
|
|
else
|
|
|
|
|
writeLine("acpi: reported {s} (device {d}, {d} resources)\n", .{ hid, entry.device_id, entry.resource_count });
|
|
|
|
|
if (manager) |h| {
|
|
|
|
|
var report = protocol.ChildAdded{
|
|
|
|
|
.parent = node_id,
|
|
|
|
|
.bus_address = entry.device_id,
|
|
|
|
|
.identity = 0,
|
|
|
|
|
.device_id = entry.device_id,
|
|
|
|
|
};
|
|
|
|
|
var report = protocol.ChildAdded{ .parent = node_id, .bus_address = entry.device_id, .identity = 0, .device_id = entry.device_id };
|
|
|
|
|
@memcpy(report.hid[0..entry.hid_len], entry.hid[0..entry.hid_len]);
|
|
|
|
|
var reply: [protocol.message_maximum]u8 = undefined;
|
|
|
|
|
_ = runtime.ipc.call(h, std.mem.asBytes(&report), &reply) catch {};
|
|
|
|
@@ -167,9 +221,164 @@ pub fn main(init: runtime.process.Init) void {
|
|
|
|
|
}
|
|
|
|
|
writeLine("acpi: reported {d} device(s) to the manager\n", .{registered_count});
|
|
|
|
|
|
|
|
|
|
// Stay resident: the claim holds, and the service is here to grow into the
|
|
|
|
|
// supervised discoverer (M20.3, then the M21 event side on the SCI).
|
|
|
|
|
while (true) runtime.system.sleep(1000);
|
|
|
|
|
armPowerButton(endpoint);
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// --- power event side (M21) ---------------------------------------------------
|
|
|
|
|
|
|
|
|
|
/// Read the PM1 event/control and GPE register ports plus the SMI enable pair
|
|
|
|
|
/// from the FADT copy on the node. Offsets are from the FADT table start (the
|
|
|
|
|
/// SDT header is the first 36 bytes). Prefers the 32-bit port fields; QEMU's
|
|
|
|
|
/// FADT populates them.
|
|
|
|
|
fn readFadt(fadt: ?[]const u8) void {
|
|
|
|
|
const f = fadt orelse {
|
|
|
|
|
_ = runtime.system.write("acpi: no FADT on the node — power events off\n");
|
|
|
|
|
return;
|
|
|
|
|
};
|
|
|
|
|
smi_cmd = @truncate(rd32(f, 48));
|
|
|
|
|
acpi_enable_value = f[52];
|
|
|
|
|
pm1a_evt = @truncate(rd32(f, 56));
|
|
|
|
|
pm1b_evt = @truncate(rd32(f, 60));
|
|
|
|
|
pm1a_cnt = @truncate(rd32(f, 64));
|
|
|
|
|
pm1b_cnt = @truncate(rd32(f, 68));
|
|
|
|
|
gpe0_blk = @truncate(rd32(f, 80));
|
|
|
|
|
gpe1_blk = @truncate(rd32(f, 84));
|
|
|
|
|
pm1_evt_len = if (f.len > 88) f[88] else 4;
|
|
|
|
|
gpe0_len = if (f.len > 92) f[92] else 0;
|
|
|
|
|
gpe1_len = if (f.len > 93) f[93] else 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
fn readSleepS5(ns: *aml.Namespace) bool {
|
|
|
|
|
const st = aml.sleepState(ns, 5) orelse return false;
|
|
|
|
|
s5_slp_typ_a = st.slp_typ_a;
|
|
|
|
|
s5_slp_typ_b = st.slp_typ_b;
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Enable ACPI mode if the firmware isn't already in it, then bind the SCI and
|
|
|
|
|
/// set PWRBTN_EN so the power button raises an interrupt we can see.
|
|
|
|
|
fn armPowerButton(endpoint: runtime.ipc.Handle) void {
|
|
|
|
|
if (pm1a_cnt != 0 and (halPioRead(2, pm1a_cnt) & sci_en_bit) == 0 and smi_cmd != 0) {
|
|
|
|
|
// Switch to ACPI mode: write ACPI_ENABLE to the SMI command port, then
|
|
|
|
|
// spin (bounded) until SCI_EN latches.
|
|
|
|
|
halPioWrite(1, smi_cmd, acpi_enable_value);
|
|
|
|
|
var tries: u32 = 0;
|
|
|
|
|
while (tries < 1000 and (halPioRead(2, pm1a_cnt) & sci_en_bit) == 0) : (tries += 1) {
|
|
|
|
|
runtime.system.sleep(1);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
if (!has_sci) {
|
|
|
|
|
_ = runtime.system.write("acpi: no SCI resource — power button unavailable\n");
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
if (!device.irqBind(node_id, sci_resource_index, endpoint)) {
|
|
|
|
|
_ = runtime.system.write("acpi: SCI irq_bind failed\n");
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
// PWRBTN_EN lives in the PM1 enable register at evt_blk + evt_len/2.
|
|
|
|
|
if (pm1a_evt != 0) {
|
|
|
|
|
const en_port = pm1a_evt + pm1_evt_len / 2;
|
|
|
|
|
halPioWrite(2, en_port, @as(u16, @truncate(halPioRead(2, en_port))) | pwrbtn_bit);
|
|
|
|
|
}
|
|
|
|
|
if (pm1b_evt != 0) {
|
|
|
|
|
const en_port = pm1b_evt + pm1_evt_len / 2;
|
|
|
|
|
halPioWrite(2, en_port, @as(u16, @truncate(halPioRead(2, en_port))) | pwrbtn_bit);
|
|
|
|
|
}
|
|
|
|
|
_ = runtime.system.write("acpi: power button armed\n");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// The SCI fired. Read PM1 status; a set PWRBTN_STS is the power button — clear
|
|
|
|
|
/// it (write-1), publish, log. Any other set status is cleared and logged
|
|
|
|
|
/// (GPE/Notify dispatch is M21.2). Always re-arm the line.
|
|
|
|
|
fn onSci() void {
|
|
|
|
|
var handled = false;
|
|
|
|
|
inline for (.{ pm1a_evt, pm1b_evt }) |evt_port| {
|
|
|
|
|
if (evt_port != 0) {
|
|
|
|
|
const sts: u16 = @truncate(halPioRead(2, evt_port));
|
|
|
|
|
if (sts & pwrbtn_bit != 0) {
|
|
|
|
|
halPioWrite(2, evt_port, pwrbtn_bit); // write-1-to-clear
|
|
|
|
|
handled = true;
|
|
|
|
|
} else if (sts != 0) {
|
|
|
|
|
halPioWrite(2, evt_port, sts); // clear whatever else latched
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
if (handled) {
|
|
|
|
|
_ = runtime.system.write("power: button pressed\n");
|
|
|
|
|
publishButton();
|
|
|
|
|
}
|
|
|
|
|
_ = device.irqAck(node_id, sci_resource_index);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
fn publishButton() void {
|
|
|
|
|
const event = power.EventMessage{ .event = @intFromEnum(power.Event.power_button) };
|
|
|
|
|
publishEvent(std.mem.asBytes(&event));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
fn publishEvent(bytes: []const u8) void {
|
|
|
|
|
for (&subscribers) |*slot| {
|
|
|
|
|
if (slot.*) |handle| {
|
|
|
|
|
if (!runtime.ipc.send(handle, bytes)) slot.* = null;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Enter S5 (soft off): write SLP_TYP|SLP_EN to the PM1 control register(s).
|
|
|
|
|
/// Mirrors the kernel's power.zig sleepValue. Only reached from a PID-1
|
|
|
|
|
/// shutdown request (M21.3).
|
|
|
|
|
fn enterS5() void {
|
|
|
|
|
if (!s5_valid or pm1a_cnt == 0) {
|
|
|
|
|
_ = runtime.system.write("power: S5 unavailable\n");
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
_ = runtime.system.write("power: entering S5\n");
|
|
|
|
|
halPioWrite(2, pm1a_cnt, (@as(u32, s5_slp_typ_a & 0x7) << 10) | slp_en);
|
|
|
|
|
if (pm1b_cnt != 0) halPioWrite(2, pm1b_cnt, (@as(u32, s5_slp_typ_b & 0x7) << 10) | slp_en);
|
|
|
|
|
// If control returns, the write did not take — say so instead of hanging.
|
|
|
|
|
runtime.system.sleep(500);
|
|
|
|
|
_ = runtime.system.write("power: S5 write did not take\n");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// --- harness callbacks --------------------------------------------------------
|
|
|
|
|
|
|
|
|
|
fn onNotification(badge: u64) void {
|
|
|
|
|
// The only notification the service binds is the SCI (an IRQ badge).
|
|
|
|
|
_ = badge;
|
|
|
|
|
onSci();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// The `.power` protocol: subscribe (endpoint as the call's capability),
|
|
|
|
|
/// shutdown (PID 1 only). Device discovery uses a different endpoint (the
|
|
|
|
|
/// device manager's), so nothing here handles ChildAdded.
|
|
|
|
|
fn onMessage(message: []const u8, reply: []u8, sender: u32, capability: ?runtime.ipc.Handle) usize {
|
|
|
|
|
if (message.len < 1) return 0;
|
|
|
|
|
switch (message[0]) {
|
|
|
|
|
@intFromEnum(power.Operation.subscribe) => {
|
|
|
|
|
var status: i32 = -1;
|
|
|
|
|
if (capability) |handle| {
|
|
|
|
|
for (&subscribers) |*slot| {
|
|
|
|
|
if (slot.* == null) {
|
|
|
|
|
slot.* = handle;
|
|
|
|
|
status = 0;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
const r = power.Reply{ .status = status };
|
|
|
|
|
@memcpy(reply[0..@sizeOf(power.Reply)], std.mem.asBytes(&r));
|
|
|
|
|
return @sizeOf(power.Reply);
|
|
|
|
|
},
|
|
|
|
|
@intFromEnum(power.Operation.shutdown) => {
|
|
|
|
|
// Only PID 1 (init), which has already stopped everything else.
|
|
|
|
|
const status: i32 = if (sender == 1) 0 else -1;
|
|
|
|
|
const r = power.Reply{ .status = status };
|
|
|
|
|
@memcpy(reply[0..@sizeOf(power.Reply)], std.mem.asBytes(&r));
|
|
|
|
|
if (sender == 1) enterS5();
|
|
|
|
|
return @sizeOf(power.Reply);
|
|
|
|
|
},
|
|
|
|
|
else => return 0,
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Depth-first walk: register + report each present device with a _HID, then
|
|
|
|
|