/* * Copyright (c) 2025 Ian Marco Moffett and L5 engineers * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the name of the project nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include int acpi_checksum(struct acpi_header *hdr) { uint8_t csum = 0; for (int i = 0; i < hdr->length; ++i) { csum += ((char *)hdr)[i]; } return csum == 0 ? 0 : -1; } void * acpi_query(const char *query) { struct acpi_header *hdr; struct acpi_root_sdt *root_sdt; size_t root_sdt_len, signature_len; root_sdt = acpi_get_root_sdt(); root_sdt_len = acpi_get_root_sdt_len(); signature_len = sizeof(hdr->signature); for (size_t i = 0; i < root_sdt_len; ++i) { hdr = (struct acpi_header *)PHYS_TO_VIRT(root_sdt->tables[i]); if (memcmp(hdr->signature, query, signature_len) == 0) { return (void *)hdr; } } return NULL; } /* * Read a MADT entry */ int acpi_read_madt(uint32_t type, int(*cb)(struct apic_header *, size_t arg), size_t arg) { static struct acpi_madt *madt = NULL; uint8_t *cur, *end; int retval = -1; struct apic_header *apichdr; /* Try to read the MADT table */ if (madt == NULL) { madt = acpi_query("APIC"); } if (madt == NULL) { panic("ioapic_read_madt: failed to get MADT\n"); } cur = (uint8_t *)(madt + 1); end = (uint8_t *)madt + madt->hdr.length; while (cur < end) { apichdr = (void *)cur; if (apichdr->type == type) { retval = cb(apichdr, arg); } /* If the entry was found, stop */ if (retval >= 0) { return retval; } cur += apichdr->length; } return -1; }