109 lines
2.6 KiB
C
109 lines
2.6 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2018, Bin Meng <bmeng.cn@gmail.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/acpi_table.h>
|
|
#include <asm/io.h>
|
|
#include <asm/tables.h>
|
|
|
|
static struct acpi_rsdp *acpi_valid_rsdp(struct acpi_rsdp *rsdp)
|
|
{
|
|
if (strncmp((char *)rsdp, RSDP_SIG, sizeof(RSDP_SIG) - 1) != 0)
|
|
return NULL;
|
|
|
|
debug("Looking on %p for valid checksum\n", rsdp);
|
|
|
|
if (table_compute_checksum((void *)rsdp, 20) != 0)
|
|
return NULL;
|
|
debug("acpi rsdp checksum 1 passed\n");
|
|
|
|
if ((rsdp->revision > 1) &&
|
|
(table_compute_checksum((void *)rsdp, rsdp->length) != 0))
|
|
return NULL;
|
|
debug("acpi rsdp checksum 2 passed\n");
|
|
|
|
return rsdp;
|
|
}
|
|
|
|
struct acpi_fadt *acpi_find_fadt(void)
|
|
{
|
|
char *p, *end;
|
|
struct acpi_rsdp *rsdp = NULL;
|
|
struct acpi_rsdt *rsdt;
|
|
struct acpi_fadt *fadt = NULL;
|
|
int i;
|
|
|
|
/* Find RSDP */
|
|
for (p = (char *)ROM_TABLE_ADDR; p < (char *)ROM_TABLE_END; p += 16) {
|
|
rsdp = acpi_valid_rsdp((struct acpi_rsdp *)p);
|
|
if (rsdp)
|
|
break;
|
|
}
|
|
|
|
if (!rsdp)
|
|
return NULL;
|
|
|
|
debug("RSDP found at %p\n", rsdp);
|
|
rsdt = (struct acpi_rsdt *)(uintptr_t)rsdp->rsdt_address;
|
|
|
|
end = (char *)rsdt + rsdt->header.length;
|
|
debug("RSDT found at %p ends at %p\n", rsdt, end);
|
|
|
|
for (i = 0; ((char *)&rsdt->entry[i]) < end; i++) {
|
|
fadt = (struct acpi_fadt *)(uintptr_t)rsdt->entry[i];
|
|
if (strncmp((char *)fadt, "FACP", 4) == 0)
|
|
break;
|
|
fadt = NULL;
|
|
}
|
|
|
|
if (!fadt)
|
|
return NULL;
|
|
|
|
debug("FADT found at %p\n", fadt);
|
|
return fadt;
|
|
}
|
|
|
|
void *acpi_find_wakeup_vector(struct acpi_fadt *fadt)
|
|
{
|
|
struct acpi_facs *facs;
|
|
void *wake_vec;
|
|
|
|
debug("Trying to find the wakeup vector...\n");
|
|
|
|
facs = (struct acpi_facs *)(uintptr_t)fadt->firmware_ctrl;
|
|
|
|
if (!facs) {
|
|
debug("No FACS found, wake up from S3 not possible.\n");
|
|
return NULL;
|
|
}
|
|
|
|
debug("FACS found at %p\n", facs);
|
|
wake_vec = (void *)(uintptr_t)facs->firmware_waking_vector;
|
|
debug("OS waking vector is %p\n", wake_vec);
|
|
|
|
return wake_vec;
|
|
}
|
|
|
|
void enter_acpi_mode(int pm1_cnt)
|
|
{
|
|
u16 val = inw(pm1_cnt);
|
|
|
|
/*
|
|
* PM1_CNT register bit0 selects the power management event to be
|
|
* either an SCI or SMI interrupt. When this bit is set, then power
|
|
* management events will generate an SCI interrupt. When this bit
|
|
* is reset power management events will generate an SMI interrupt.
|
|
*
|
|
* Per ACPI spec, it is the responsibility of the hardware to set
|
|
* or reset this bit. OSPM always preserves this bit position.
|
|
*
|
|
* U-Boot does not support SMI. And we don't have plan to support
|
|
* anything running in SMM within U-Boot. To create a legacy-free
|
|
* system, and expose ourselves to OSPM as working under ACPI mode
|
|
* already, turn this bit on.
|
|
*/
|
|
outw(val | PM1_CNT_SCI_EN, pm1_cnt);
|
|
}
|