freebsd-skq/usr.sbin/acpi/acpidump/acpi.c
Nate Lawson 5cf6d493ab When one entry in the RSDT is corrupted, just skip it instead of bailing out.
This gets us the info we need on systems which have proprietary tables that
don't match the standard.  For instance, an AMI system has a table of type
"OEMB" with an invalid checksum.

Tested by:	Maxim Maximov <mcsi_at_mcsi.pp.ru>
MFC after:	1 day
2004-08-18 05:56:07 +00:00

868 lines
23 KiB
C

/*-
* Copyright (c) 1998 Doug Rabson
* Copyright (c) 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
* 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.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
*
* $FreeBSD$
*/
#include <sys/param.h>
#include <sys/endian.h>
#include <sys/stat.h>
#include <sys/wait.h>
#include <assert.h>
#include <err.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include "acpidump.h"
#define BEGIN_COMMENT "/*\n"
#define END_COMMENT " */\n"
static void acpi_print_string(char *s, size_t length);
static void acpi_print_gas(struct ACPIgas *gas);
static int acpi_get_fadt_revision(struct FADTbody *fadt);
static void acpi_handle_fadt(struct ACPIsdt *fadt);
static void acpi_print_cpu(u_char cpu_id);
static void acpi_print_local_apic(u_char cpu_id, u_char apic_id,
u_int32_t flags);
static void acpi_print_io_apic(u_char apic_id, u_int32_t int_base,
u_int64_t apic_addr);
static void acpi_print_mps_flags(u_int16_t flags);
static void acpi_print_intr(u_int32_t intr, u_int16_t mps_flags);
static void acpi_print_apic(struct MADT_APIC *mp);
static void acpi_handle_apic(struct ACPIsdt *sdp);
static void acpi_handle_hpet(struct ACPIsdt *sdp);
static void acpi_print_sdt(struct ACPIsdt *sdp);
static void acpi_print_fadt(struct ACPIsdt *sdp);
static void acpi_print_facs(struct FACSbody *facs);
static void acpi_print_dsdt(struct ACPIsdt *dsdp);
static struct ACPIsdt *acpi_map_sdt(vm_offset_t pa);
static void acpi_print_rsd_ptr(struct ACPIrsdp *rp);
static void acpi_handle_rsdt(struct ACPIsdt *rsdp);
/* Size of an address. 32-bit for ACPI 1.0, 64-bit for ACPI 2.0 and up. */
static int addr_size;
static void
acpi_print_string(char *s, size_t length)
{
int c;
/* Trim trailing spaces and NULLs */
while (length > 0 && (s[length - 1] == ' ' || s[length - 1] == '\0'))
length--;
while (length--) {
c = *s++;
putchar(c);
}
}
static void
acpi_print_gas(struct ACPIgas *gas)
{
switch(gas->address_space_id) {
case ACPI_GAS_MEMORY:
printf("0x%08lx:%u[%u] (Memory)", (u_long)gas->address,
gas->bit_offset, gas->bit_width);
break;
case ACPI_GAS_IO:
printf("0x%02lx:%u[%u] (IO)", (u_long)gas->address,
gas->bit_offset, gas->bit_width);
break;
case ACPI_GAS_PCI:
printf("%x:%x+0x%x (PCI)", (uint16_t)(gas->address >> 32),
(uint16_t)((gas->address >> 16) & 0xffff),
(uint16_t)gas->address);
break;
/* XXX How to handle these below? */
case ACPI_GAS_EMBEDDED:
printf("0x%x:%u[%u] (EC)", (uint16_t)gas->address,
gas->bit_offset, gas->bit_width);
break;
case ACPI_GAS_SMBUS:
printf("0x%x:%u[%u] (SMBus)", (uint16_t)gas->address,
gas->bit_offset, gas->bit_width);
break;
case ACPI_GAS_FIXED:
default:
printf("0x%08lx (?)", (u_long)gas->address);
break;
}
}
/* The FADT revision indicates whether we use the DSDT or X_DSDT addresses. */
static int
acpi_get_fadt_revision(struct FADTbody *fadt)
{
int fadt_revision;
/* Set the FADT revision separately from the RSDP version. */
if (addr_size == 8) {
fadt_revision = 2;
/*
* A few systems (e.g., IBM T23) have an RSDP that claims
* revision 2 but the 64 bit addresses are invalid. If
* revision 2 and the 32 bit address is non-zero but the
* 32 and 64 bit versions don't match, prefer the 32 bit
* version for all subsequent tables.
*/
if (fadt->facs_ptr != 0 &&
(fadt->x_facs_ptr & 0xffffffff) != fadt->facs_ptr)
fadt_revision = 1;
} else
fadt_revision = 1;
return (fadt_revision);
}
static void
acpi_handle_fadt(struct ACPIsdt *sdp)
{
struct ACPIsdt *dsdp;
struct FACSbody *facs;
struct FADTbody *fadt;
int fadt_revision;
fadt = (struct FADTbody *)sdp->body;
acpi_print_fadt(sdp);
fadt_revision = acpi_get_fadt_revision(fadt);
if (fadt_revision == 1)
facs = (struct FACSbody *)acpi_map_sdt(fadt->facs_ptr);
else
facs = (struct FACSbody *)acpi_map_sdt(fadt->x_facs_ptr);
if (memcmp(facs->signature, "FACS", 4) != 0 || facs->len < 64)
errx(1, "FACS is corrupt");
acpi_print_facs(facs);
if (fadt_revision == 1)
dsdp = (struct ACPIsdt *)acpi_map_sdt(fadt->dsdt_ptr);
else
dsdp = (struct ACPIsdt *)acpi_map_sdt(fadt->x_dsdt_ptr);
if (acpi_checksum(dsdp, dsdp->len))
errx(1, "DSDT is corrupt");
acpi_print_dsdt(dsdp);
}
static void
acpi_print_cpu(u_char cpu_id)
{
printf("\tACPI CPU=");
if (cpu_id == 0xff)
printf("ALL\n");
else
printf("%d\n", (u_int)cpu_id);
}
static void
acpi_print_local_apic(u_char cpu_id, u_char apic_id, u_int32_t flags)
{
acpi_print_cpu(cpu_id);
printf("\tFlags={");
if (flags & ACPI_MADT_APIC_LOCAL_FLAG_ENABLED)
printf("ENABLED");
else
printf("DISABLED");
printf("}\n");
printf("\tAPIC ID=%d\n", (u_int)apic_id);
}
static void
acpi_print_io_apic(u_char apic_id, u_int32_t int_base, u_int64_t apic_addr)
{
printf("\tAPIC ID=%d\n", (u_int)apic_id);
printf("\tINT BASE=%d\n", int_base);
printf("\tADDR=0x%016jx\n", apic_addr);
}
static void
acpi_print_mps_flags(u_int16_t flags)
{
printf("\tFlags={Polarity=");
switch (flags & MPS_INT_FLAG_POLARITY_MASK) {
case MPS_INT_FLAG_POLARITY_CONFORM:
printf("conforming");
break;
case MPS_INT_FLAG_POLARITY_HIGH:
printf("active-hi");
break;
case MPS_INT_FLAG_POLARITY_LOW:
printf("active-lo");
break;
default:
printf("0x%x", flags & MPS_INT_FLAG_POLARITY_MASK);
break;
}
printf(", Trigger=");
switch (flags & MPS_INT_FLAG_TRIGGER_MASK) {
case MPS_INT_FLAG_TRIGGER_CONFORM:
printf("conforming");
break;
case MPS_INT_FLAG_TRIGGER_EDGE:
printf("edge");
break;
case MPS_INT_FLAG_TRIGGER_LEVEL:
printf("level");
break;
default:
printf("0x%x", (flags & MPS_INT_FLAG_TRIGGER_MASK) >> 2);
}
printf("}\n");
}
static void
acpi_print_intr(u_int32_t intr, u_int16_t mps_flags)
{
printf("\tINTR=%d\n", (u_int)intr);
acpi_print_mps_flags(mps_flags);
}
const char *apic_types[] = { "Local APIC", "IO APIC", "INT Override", "NMI",
"Local NMI", "Local APIC Override", "IO SAPIC",
"Local SAPIC", "Platform Interrupt" };
const char *platform_int_types[] = { "PMI", "INIT",
"Corrected Platform Error" };
static void
acpi_print_apic(struct MADT_APIC *mp)
{
printf("\tType=%s\n", apic_types[mp->type]);
switch (mp->type) {
case ACPI_MADT_APIC_TYPE_LOCAL_APIC:
acpi_print_local_apic(mp->body.local_apic.cpu_id,
mp->body.local_apic.apic_id, mp->body.local_apic.flags);
break;
case ACPI_MADT_APIC_TYPE_IO_APIC:
acpi_print_io_apic(mp->body.io_apic.apic_id,
mp->body.io_apic.int_base,
mp->body.io_apic.apic_addr);
break;
case ACPI_MADT_APIC_TYPE_INT_OVERRIDE:
printf("\tBUS=%d\n", (u_int)mp->body.int_override.bus);
printf("\tIRQ=%d\n", (u_int)mp->body.int_override.source);
acpi_print_intr(mp->body.int_override.intr,
mp->body.int_override.mps_flags);
break;
case ACPI_MADT_APIC_TYPE_NMI:
acpi_print_intr(mp->body.nmi.intr, mp->body.nmi.mps_flags);
break;
case ACPI_MADT_APIC_TYPE_LOCAL_NMI:
acpi_print_cpu(mp->body.local_nmi.cpu_id);
printf("\tLINT Pin=%d\n", mp->body.local_nmi.lintpin);
acpi_print_mps_flags(mp->body.local_nmi.mps_flags);
break;
case ACPI_MADT_APIC_TYPE_LOCAL_OVERRIDE:
printf("\tLocal APIC ADDR=0x%016jx\n",
mp->body.local_apic_override.apic_addr);
break;
case ACPI_MADT_APIC_TYPE_IO_SAPIC:
acpi_print_io_apic(mp->body.io_sapic.apic_id,
mp->body.io_sapic.int_base,
mp->body.io_sapic.apic_addr);
break;
case ACPI_MADT_APIC_TYPE_LOCAL_SAPIC:
acpi_print_local_apic(mp->body.local_sapic.cpu_id,
mp->body.local_sapic.apic_id, mp->body.local_sapic.flags);
printf("\tAPIC EID=%d\n", (u_int)mp->body.local_sapic.apic_eid);
break;
case ACPI_MADT_APIC_TYPE_INT_SRC:
printf("\tType=%s\n",
platform_int_types[mp->body.int_src.type]);
printf("\tCPU ID=%d\n", (u_int)mp->body.int_src.cpu_id);
printf("\tCPU EID=%d\n", (u_int)mp->body.int_src.cpu_id);
printf("\tSAPIC Vector=%d\n",
(u_int)mp->body.int_src.sapic_vector);
acpi_print_intr(mp->body.int_src.intr,
mp->body.int_src.mps_flags);
break;
default:
printf("\tUnknown type %d\n", (u_int)mp->type);
break;
}
}
static void
acpi_handle_apic(struct ACPIsdt *sdp)
{
struct MADTbody *madtp;
struct MADT_APIC *madt_apicp;
printf(BEGIN_COMMENT);
acpi_print_sdt(sdp);
madtp = (struct MADTbody *) sdp->body;
printf("\tLocal APIC ADDR=0x%08x\n", madtp->lapic_addr);
printf("\tFlags={");
if (madtp->flags & ACPI_APIC_FLAG_PCAT_COMPAT)
printf("PC-AT");
printf("}\n");
madt_apicp = (struct MADT_APIC *)madtp->body;
while (((uintptr_t)madt_apicp) - ((uintptr_t)sdp) < sdp->len) {
printf("\n");
acpi_print_apic(madt_apicp);
madt_apicp = (struct MADT_APIC *) ((char *)madt_apicp +
madt_apicp->len);
}
printf(END_COMMENT);
}
static void
acpi_handle_hpet(struct ACPIsdt *sdp)
{
struct HPETbody *hpetp;
printf(BEGIN_COMMENT);
acpi_print_sdt(sdp);
hpetp = (struct HPETbody *) sdp->body;
printf("\tHPET Number=%d\n", hpetp->hpet_number);
printf("\tADDR=0x%08x\n", hpetp->base_addr);
printf("\tHW Rev=0x%x\n", hpetp->block_hwrev);
printf("\tComparitors=%d\n", hpetp->block_comparitors);
printf("\tCounter Size=%d\n", hpetp->block_counter_size);
printf("\tLegacy IRQ routing capable={");
if (hpetp->block_legacy_capable)
printf("TRUE}\n");
else
printf("FALSE}\n");
printf("\tPCI Vendor ID=0x%04x\n", hpetp->block_pcivendor);
printf("\tMinimal Tick=%d\n", hpetp->clock_tick);
printf(END_COMMENT);
}
static void
acpi_handle_ecdt(struct ACPIsdt *sdp)
{
struct ECDTbody *ecdt;
printf(BEGIN_COMMENT);
acpi_print_sdt(sdp);
ecdt = (struct ECDTbody *) sdp->body;
printf("\tEC_CONTROL=");
acpi_print_gas(&ecdt->ec_control);
printf("\n\tEC_DATA=");
acpi_print_gas(&ecdt->ec_data);
printf("\n\tUID=%#x, ", ecdt->uid);
printf("GPE_BIT=%#x\n", ecdt->gpe_bit);
printf("\tEC_ID=%s\n", ecdt->ec_id);
printf(END_COMMENT);
}
static void
acpi_print_sdt(struct ACPIsdt *sdp)
{
printf(" ");
acpi_print_string(sdp->signature, 4);
printf(": Length=%d, Revision=%d, Checksum=%d,\n",
sdp->len, sdp->rev, sdp->check);
printf("\tOEMID=");
acpi_print_string(sdp->oemid, 6);
printf(", OEM Table ID=");
acpi_print_string(sdp->oemtblid, 8);
printf(", OEM Revision=0x%x,\n", sdp->oemrev);
printf("\tCreator ID=");
acpi_print_string(sdp->creator, 4);
printf(", Creator Revision=0x%x\n", sdp->crerev);
}
static void
acpi_print_rsdt(struct ACPIsdt *rsdp)
{
int i, entries;
u_long addr;
printf(BEGIN_COMMENT);
acpi_print_sdt(rsdp);
entries = (rsdp->len - SIZEOF_SDT_HDR) / addr_size;
printf("\tEntries={ ");
for (i = 0; i < entries; i++) {
if (i > 0)
printf(", ");
switch (addr_size) {
case 4:
addr = le32dec((char*)rsdp->body + i * addr_size);
break;
case 8:
addr = le64dec((char*)rsdp->body + i * addr_size);
break;
default:
addr = 0;
}
assert(addr != 0);
printf("0x%08lx", addr);
}
printf(" }\n");
printf(END_COMMENT);
}
static const char *acpi_pm_profiles[] = {
"Unspecified", "Desktop", "Mobile", "Workstation",
"Enterprise Server", "SOHO Server", "Appliance PC"
};
static void
acpi_print_fadt(struct ACPIsdt *sdp)
{
struct FADTbody *fadt;
const char *pm;
char sep;
fadt = (struct FADTbody *)sdp->body;
printf(BEGIN_COMMENT);
acpi_print_sdt(sdp);
printf(" \tFACS=0x%x, DSDT=0x%x\n", fadt->facs_ptr,
fadt->dsdt_ptr);
printf("\tINT_MODEL=%s\n", fadt->int_model ? "APIC" : "PIC");
if (fadt->pm_profile >= sizeof(acpi_pm_profiles) / sizeof(char *))
pm = "Reserved";
else
pm = acpi_pm_profiles[fadt->pm_profile];
printf("\tPreferred_PM_Profile=%s (%d)\n", pm, fadt->pm_profile);
printf("\tSCI_INT=%d\n", fadt->sci_int);
printf("\tSMI_CMD=0x%x, ", fadt->smi_cmd);
printf("ACPI_ENABLE=0x%x, ", fadt->acpi_enable);
printf("ACPI_DISABLE=0x%x, ", fadt->acpi_disable);
printf("S4BIOS_REQ=0x%x\n", fadt->s4biosreq);
printf("\tPSTATE_CNT=0x%x\n", fadt->pstate_cnt);
printf("\tPM1a_EVT_BLK=0x%x-0x%x\n",
fadt->pm1a_evt_blk,
fadt->pm1a_evt_blk + fadt->pm1_evt_len - 1);
if (fadt->pm1b_evt_blk != 0)
printf("\tPM1b_EVT_BLK=0x%x-0x%x\n",
fadt->pm1b_evt_blk,
fadt->pm1b_evt_blk + fadt->pm1_evt_len - 1);
printf("\tPM1a_CNT_BLK=0x%x-0x%x\n",
fadt->pm1a_cnt_blk,
fadt->pm1a_cnt_blk + fadt->pm1_cnt_len - 1);
if (fadt->pm1b_cnt_blk != 0)
printf("\tPM1b_CNT_BLK=0x%x-0x%x\n",
fadt->pm1b_cnt_blk,
fadt->pm1b_cnt_blk + fadt->pm1_cnt_len - 1);
if (fadt->pm2_cnt_blk != 0)
printf("\tPM2_CNT_BLK=0x%x-0x%x\n",
fadt->pm2_cnt_blk,
fadt->pm2_cnt_blk + fadt->pm2_cnt_len - 1);
printf("\tPM_TMR_BLK=0x%x-0x%x\n",
fadt->pm_tmr_blk,
fadt->pm_tmr_blk + fadt->pm_tmr_len - 1);
if (fadt->gpe0_blk != 0)
printf("\tGPE0_BLK=0x%x-0x%x\n",
fadt->gpe0_blk,
fadt->gpe0_blk + fadt->gpe0_len - 1);
if (fadt->gpe1_blk != 0)
printf("\tGPE1_BLK=0x%x-0x%x, GPE1_BASE=%d\n",
fadt->gpe1_blk,
fadt->gpe1_blk + fadt->gpe1_len - 1,
fadt->gpe1_base);
if (fadt->cst_cnt != 0)
printf("\tCST_CNT=0x%x\n", fadt->cst_cnt);
printf("\tP_LVL2_LAT=%d us, P_LVL3_LAT=%d us\n",
fadt->p_lvl2_lat, fadt->p_lvl3_lat);
printf("\tFLUSH_SIZE=%d, FLUSH_STRIDE=%d\n",
fadt->flush_size, fadt->flush_stride);
printf("\tDUTY_OFFSET=%d, DUTY_WIDTH=%d\n",
fadt->duty_off, fadt->duty_width);
printf("\tDAY_ALRM=%d, MON_ALRM=%d, CENTURY=%d\n",
fadt->day_alrm, fadt->mon_alrm, fadt->century);
#define PRINTFLAG(var, flag) do { \
if ((var) & FADT_FLAG_## flag) { \
printf("%c%s", sep, #flag); sep = ','; \
} \
} while (0)
printf("\tIAPC_BOOT_ARCH=");
sep = '{';
PRINTFLAG(fadt->iapc_boot_arch, LEGACY_DEV);
PRINTFLAG(fadt->iapc_boot_arch, 8042);
if (fadt->iapc_boot_arch != 0)
printf("}");
printf("\n");
printf("\tFlags=");
sep = '{';
PRINTFLAG(fadt->flags, WBINVD);
PRINTFLAG(fadt->flags, WBINVD_FLUSH);
PRINTFLAG(fadt->flags, PROC_C1);
PRINTFLAG(fadt->flags, P_LVL2_UP);
PRINTFLAG(fadt->flags, PWR_BUTTON);
PRINTFLAG(fadt->flags, SLP_BUTTON);
PRINTFLAG(fadt->flags, FIX_RTC);
PRINTFLAG(fadt->flags, RTC_S4);
PRINTFLAG(fadt->flags, TMR_VAL_EXT);
PRINTFLAG(fadt->flags, DCK_CAP);
PRINTFLAG(fadt->flags, RESET_REG);
PRINTFLAG(fadt->flags, SEALED_CASE);
PRINTFLAG(fadt->flags, HEADLESS);
PRINTFLAG(fadt->flags, CPU_SW_SLP);
if (fadt->flags != 0)
printf("}\n");
#undef PRINTFLAG
if (fadt->flags & FADT_FLAG_RESET_REG) {
printf("\tRESET_REG=");
acpi_print_gas(&fadt->reset_reg);
printf(", RESET_VALUE=%#x\n", fadt->reset_value);
}
if (acpi_get_fadt_revision(fadt) > 1) {
printf("\tX_FACS=0x%08lx, ", (u_long)fadt->x_facs_ptr);
printf("X_DSDT=0x%08lx\n", (u_long)fadt->x_dsdt_ptr);
printf("\tX_PM1a_EVT_BLK=");
acpi_print_gas(&fadt->x_pm1a_evt_blk);
if (fadt->x_pm1b_evt_blk.address != 0) {
printf("\n\tX_PM1b_EVT_BLK=");
acpi_print_gas(&fadt->x_pm1b_evt_blk);
}
printf("\n\tX_PM1a_CNT_BLK=");
acpi_print_gas(&fadt->x_pm1a_cnt_blk);
if (fadt->x_pm1b_cnt_blk.address != 0) {
printf("\n\tX_PM1b_CNT_BLK=");
acpi_print_gas(&fadt->x_pm1b_cnt_blk);
}
if (fadt->x_pm1b_cnt_blk.address != 0) {
printf("\n\tX_PM2_CNT_BLK=");
acpi_print_gas(&fadt->x_pm2_cnt_blk);
}
printf("\n\tX_PM_TMR_BLK=");
acpi_print_gas(&fadt->x_pm_tmr_blk);
if (fadt->x_gpe0_blk.address != 0) {
printf("\n\tX_GPE0_BLK=");
acpi_print_gas(&fadt->x_gpe0_blk);
}
if (fadt->x_gpe1_blk.address != 0) {
printf("\n\tX_GPE1_BLK=");
acpi_print_gas(&fadt->x_gpe1_blk);
}
printf("\n");
}
printf(END_COMMENT);
}
static void
acpi_print_facs(struct FACSbody *facs)
{
printf(BEGIN_COMMENT);
printf(" FACS:\tLength=%u, ", facs->len);
printf("HwSig=0x%08x, ", facs->hw_sig);
printf("Firm_Wake_Vec=0x%08x\n", facs->firm_wake_vec);
printf("\tGlobal_Lock=");
if (facs->global_lock != 0) {
if (facs->global_lock & FACS_FLAG_LOCK_PENDING)
printf("PENDING,");
if (facs->global_lock & FACS_FLAG_LOCK_OWNED)
printf("OWNED");
}
printf("\n");
printf("\tFlags=");
if (facs->flags & FACS_FLAG_S4BIOS_F)
printf("S4BIOS");
printf("\n");
if (facs->x_firm_wake_vec != 0) {
printf("\tX_Firm_Wake_Vec=%08lx\n",
(u_long)facs->x_firm_wake_vec);
}
printf("\tVersion=%u\n", facs->version);
printf(END_COMMENT);
}
static void
acpi_print_dsdt(struct ACPIsdt *dsdp)
{
printf(BEGIN_COMMENT);
acpi_print_sdt(dsdp);
printf(END_COMMENT);
}
int
acpi_checksum(void *p, size_t length)
{
u_int8_t *bp;
u_int8_t sum;
bp = p;
sum = 0;
while (length--)
sum += *bp++;
return (sum);
}
static struct ACPIsdt *
acpi_map_sdt(vm_offset_t pa)
{
struct ACPIsdt *sp;
sp = acpi_map_physical(pa, sizeof(struct ACPIsdt));
sp = acpi_map_physical(pa, sp->len);
return (sp);
}
static void
acpi_print_rsd_ptr(struct ACPIrsdp *rp)
{
printf(BEGIN_COMMENT);
printf(" RSD PTR: OEM=");
acpi_print_string(rp->oem, 6);
printf(", ACPI_Rev=%s (%d)\n", rp->revision < 2 ? "1.0x" : "2.0x",
rp->revision);
if (rp->revision < 2) {
printf("\tRSDT=0x%08x, cksum=%u\n", rp->rsdt_addr, rp->sum);
} else {
printf("\tXSDT=0x%08lx, length=%u, cksum=%u\n",
(u_long)rp->xsdt_addr, rp->length, rp->xsum);
}
printf(END_COMMENT);
}
static void
acpi_handle_rsdt(struct ACPIsdt *rsdp)
{
struct ACPIsdt *sdp;
vm_offset_t addr;
int entries, i;
acpi_print_rsdt(rsdp);
entries = (rsdp->len - SIZEOF_SDT_HDR) / addr_size;
for (i = 0; i < entries; i++) {
switch (addr_size) {
case 4:
addr = le32dec((char*)rsdp->body + i * addr_size);
break;
case 8:
addr = le64dec((char*)rsdp->body + i * addr_size);
break;
default:
assert((addr = 0));
}
sdp = (struct ACPIsdt *)acpi_map_sdt(addr);
if (acpi_checksum(sdp, sdp->len)) {
warnx("RSDT entry %d (sig %.4s) is corrupt", i,
sdp->signature);
continue;
}
if (!memcmp(sdp->signature, "FACP", 4))
acpi_handle_fadt(sdp);
else if (!memcmp(sdp->signature, "APIC", 4))
acpi_handle_apic(sdp);
else if (!memcmp(sdp->signature, "HPET", 4))
acpi_handle_hpet(sdp);
else if (!memcmp(sdp->signature, "ECDT", 4))
acpi_handle_ecdt(sdp);
else {
printf(BEGIN_COMMENT);
acpi_print_sdt(sdp);
printf(END_COMMENT);
}
}
}
struct ACPIsdt *
sdt_load_devmem(void)
{
struct ACPIrsdp *rp;
struct ACPIsdt *rsdp;
rp = acpi_find_rsd_ptr();
if (!rp)
errx(1, "Can't find ACPI information");
if (tflag)
acpi_print_rsd_ptr(rp);
if (rp->revision < 2) {
rsdp = (struct ACPIsdt *)acpi_map_sdt(rp->rsdt_addr);
if (memcmp(rsdp->signature, "RSDT", 4) != 0 ||
acpi_checksum(rsdp, rsdp->len) != 0)
errx(1, "RSDT is corrupted");
addr_size = sizeof(uint32_t);
} else {
rsdp = (struct ACPIsdt *)acpi_map_sdt(rp->xsdt_addr);
if (memcmp(rsdp->signature, "XSDT", 4) != 0 ||
acpi_checksum(rsdp, rsdp->len) != 0)
errx(1, "XSDT is corrupted");
addr_size = sizeof(uint64_t);
}
return (rsdp);
}
static int
write_dsdt(int fd, struct ACPIsdt *rsdt, struct ACPIsdt *dsdt)
{
struct ACPIsdt sdt;
struct ACPIsdt *ssdt;
uint8_t sum;
sdt = *dsdt;
if (rsdt != NULL) {
sdt.check = 0;
sum = acpi_checksum(dsdt->body, dsdt->len - SIZEOF_SDT_HDR);
ssdt = sdt_from_rsdt(rsdt, "SSDT", NULL);
while (ssdt != NULL) {
sdt.len += ssdt->len - SIZEOF_SDT_HDR;
sum += acpi_checksum(ssdt->body,
ssdt->len - SIZEOF_SDT_HDR);
ssdt = sdt_from_rsdt(rsdt, "SSDT", ssdt);
}
sum += acpi_checksum(&sdt, SIZEOF_SDT_HDR);
sdt.check -= sum;
}
write(fd, &sdt, SIZEOF_SDT_HDR);
write(fd, dsdt->body, dsdt->len - SIZEOF_SDT_HDR);
if (rsdt != NULL) {
ssdt = sdt_from_rsdt(rsdt, "SSDT", NULL);
while (ssdt != NULL) {
write(fd, ssdt->body, ssdt->len - SIZEOF_SDT_HDR);
ssdt = sdt_from_rsdt(rsdt, "SSDT", ssdt);
}
}
return (0);
}
void
dsdt_save_file(char *outfile, struct ACPIsdt *rsdt, struct ACPIsdt *dsdp)
{
int fd;
mode_t mode;
assert(outfile != NULL);
mode = S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH;
fd = open(outfile, O_WRONLY | O_CREAT | O_TRUNC, mode);
if (fd == -1) {
perror("dsdt_save_file");
return;
}
write_dsdt(fd, rsdt, dsdp);
close(fd);
}
void
aml_disassemble(struct ACPIsdt *rsdt, struct ACPIsdt *dsdp)
{
char tmpstr[32], buf[256];
FILE *fp;
int fd, len;
strcpy(tmpstr, "/tmp/acpidump.XXXXXX");
fd = mkstemp(tmpstr);
if (fd < 0) {
perror("iasl tmp file");
return;
}
write_dsdt(fd, rsdt, dsdp);
close(fd);
/* Run iasl -d on the temp file */
if (fork() == 0) {
close(STDOUT_FILENO);
if (vflag == 0)
close(STDERR_FILENO);
execl("/usr/sbin/iasl", "iasl", "-d", tmpstr, 0);
err(1, "exec");
}
wait(NULL);
unlink(tmpstr);
/* Dump iasl's output to stdout */
fp = fopen("acpidump.dsl", "r");
unlink("acpidump.dsl");
if (fp == NULL) {
perror("iasl tmp file (read)");
return;
}
while ((len = fread(buf, 1, sizeof(buf), fp)) > 0)
fwrite(buf, 1, len, stdout);
fclose(fp);
}
void
sdt_print_all(struct ACPIsdt *rsdp)
{
acpi_handle_rsdt(rsdp);
}
/* Fetch a table matching the given signature via the RSDT. */
struct ACPIsdt *
sdt_from_rsdt(struct ACPIsdt *rsdt, const char *sig, struct ACPIsdt *last)
{
struct ACPIsdt *sdt;
vm_offset_t addr;
int entries, i;
entries = (rsdt->len - SIZEOF_SDT_HDR) / addr_size;
for (i = 0; i < entries; i++) {
switch (addr_size) {
case 4:
addr = le32dec((char*)rsdt->body + i * addr_size);
break;
case 8:
addr = le64dec((char*)rsdt->body + i * addr_size);
break;
default:
assert((addr = 0));
}
sdt = (struct ACPIsdt *)acpi_map_sdt(addr);
if (last != NULL) {
if (sdt == last)
last = NULL;
continue;
}
if (memcmp(sdt->signature, sig, strlen(sig)))
continue;
if (acpi_checksum(sdt, sdt->len))
errx(1, "RSDT entry %d is corrupt", i);
return (sdt);
}
return (NULL);
}
struct ACPIsdt *
dsdt_from_fadt(struct FADTbody *fadt)
{
struct ACPIsdt *sdt;
/* Use the DSDT address if it is version 1, otherwise use X_DSDT. */
if (acpi_get_fadt_revision(fadt) == 1)
sdt = (struct ACPIsdt *)acpi_map_sdt(fadt->dsdt_ptr);
else
sdt = (struct ACPIsdt *)acpi_map_sdt(fadt->x_dsdt_ptr);
if (acpi_checksum(sdt, sdt->len))
errx(1, "DSDT is corrupt\n");
return (sdt);
}