From e8cf8971da1fc1932b04e642104db9606fd0414e Mon Sep 17 00:00:00 2001
From: Colin Watson <cjwatson@ubuntu.com>
Date: Tue, 26 Mar 2013 11:29:52 +0100
Subject: [PATCH 236/471] * grub-core/commands/acpihalt.c (skip_ext_op):
Add support for skipping Event, Device, Processor, PowerRes,
ThermalZone, and BankField extended opcodes. (get_sleep_type):
Add minimal scope handling (just enough to handle setting the scope to
the root path). (grub_acpi_halt): Parse any SSDTs as well as the
DSDT. * include/grub/acpi.h: Add enumeration values for Event, Device,
Processor, PowerRes, ThermalZone, and BankField extended opcodes.
---
ChangeLog | 11 ++++++
grub-core/commands/acpihalt.c | 82 ++++++++++++++++++++++++++++++++-----------
include/grub/acpi.h | 6 ++++
3 files changed, 78 insertions(+), 21 deletions(-)
diff --git a/ChangeLog b/ChangeLog
index 399b72f..07a69bc 100644
--- a/ChangeLog
+++ b/ChangeLog
@@ -1,3 +1,14 @@
+2013-03-26 Colin Watson <cjwatson@ubuntu.com>
+
+ * grub-core/commands/acpihalt.c (skip_ext_op): Add support for
+ skipping Event, Device, Processor, PowerRes, ThermalZone, and
+ BankField extended opcodes.
+ (get_sleep_type): Add minimal scope handling (just enough to
+ handle setting the scope to the root path).
+ (grub_acpi_halt): Parse any SSDTs as well as the DSDT.
+ * include/grub/acpi.h: Add enumeration values for Event, Device,
+ Processor, PowerRes, ThermalZone, and BankField extended opcodes.
+
2013-03-26 Vladimir Testov <vladimir.testov@rosalab.ru>
* grub-core/gfxmenu/font.c (grub_font_get_string_width): Fix
diff --git a/grub-core/commands/acpihalt.c b/grub-core/commands/acpihalt.c
index 3db224d..a8014de 100644
--- a/grub-core/commands/acpihalt.c
+++ b/grub-core/commands/acpihalt.c
@@ -41,6 +41,7 @@ typedef uint8_t grub_uint8_t;
#endif
#ifndef GRUB_DSDT_TEST
+#include <grub/mm.h>
#include <grub/misc.h>
#include <grub/time.h>
#include <grub/cpu/io.h>
@@ -146,6 +147,10 @@ skip_ext_op (const grub_uint8_t *ptr, const grub_uint8_t *end)
ptr += skip_name_string (ptr, end);
ptr++;
break;
+ case GRUB_ACPI_EXTOPCODE_EVENT_OP:
+ ptr++;
+ ptr += skip_name_string (ptr, end);
+ break;
case GRUB_ACPI_EXTOPCODE_OPERATION_REGION:
ptr++;
ptr += skip_name_string (ptr, end);
@@ -158,7 +163,12 @@ skip_ext_op (const grub_uint8_t *ptr, const grub_uint8_t *end)
return 0;
break;
case GRUB_ACPI_EXTOPCODE_FIELD_OP:
+ case GRUB_ACPI_EXTOPCODE_DEVICE_OP:
+ case GRUB_ACPI_EXTOPCODE_PROCESSOR_OP:
+ case GRUB_ACPI_EXTOPCODE_POWER_RES_OP:
+ case GRUB_ACPI_EXTOPCODE_THERMAL_ZONE_OP:
case GRUB_ACPI_EXTOPCODE_INDEX_FIELD_OP:
+ case GRUB_ACPI_EXTOPCODE_BANK_FIELD_OP:
ptr++;
ptr += decode_length (ptr, 0);
break;
@@ -170,12 +180,14 @@ skip_ext_op (const grub_uint8_t *ptr, const grub_uint8_t *end)
}
static int
-get_sleep_type (grub_uint8_t *table, grub_uint8_t *end)
+get_sleep_type (grub_uint8_t *table, grub_uint8_t *ptr, grub_uint8_t *end,
+ grub_uint8_t *scope, int scope_len)
{
- grub_uint8_t *ptr, *prev = table;
- int sleep_type = -1;
+ grub_uint8_t *prev = table;
+ int sleep_type = -2;
- ptr = table + sizeof (struct grub_acpi_table_header);
+ if (!ptr)
+ ptr = table + sizeof (struct grub_acpi_table_header);
while (ptr < end && prev < ptr)
{
int add;
@@ -202,7 +214,8 @@ get_sleep_type (grub_uint8_t *table, grub_uint8_t *end)
}
case GRUB_ACPI_OPCODE_NAME:
ptr++;
- if (memcmp (ptr, "_S5_", 4) == 0 || memcmp (ptr, "\\_S5_", 4) == 0)
+ if ((!scope || memcmp (scope, "\\", scope_len) == 0) &&
+ (memcmp (ptr, "_S5_", 4) == 0 || memcmp (ptr, "\\_S5_", 4) == 0))
{
int ll;
grub_uint8_t *ptr2 = ptr;
@@ -241,6 +254,25 @@ get_sleep_type (grub_uint8_t *table, grub_uint8_t *end)
return -1;
break;
case GRUB_ACPI_OPCODE_SCOPE:
+ {
+ int scope_sleep_type;
+ int ll;
+ grub_uint8_t *name;
+ int name_len;
+
+ ptr++;
+ add = decode_length (ptr, &ll);
+ name = ptr + ll;
+ name_len = skip_name_string (name, ptr + add);
+ if (!name_len)
+ return -1;
+ scope_sleep_type = get_sleep_type (table, name + name_len,
+ ptr + add, name, name_len);
+ if (scope_sleep_type != -2)
+ return scope_sleep_type;
+ ptr += add;
+ break;
+ }
case GRUB_ACPI_OPCODE_IF:
case GRUB_ACPI_OPCODE_METHOD:
{
@@ -291,7 +323,7 @@ main (int argc, char **argv)
return 2;
}
- printf ("Sleep type = %d\n", get_sleep_type (buf, buf + len));
+ printf ("Sleep type = %d\n", get_sleep_type (buf, NULL, buf + len, NULL, 0));
free (buf);
fclose (f);
return 0;
@@ -304,8 +336,10 @@ grub_acpi_halt (void)
{
struct grub_acpi_rsdp_v20 *rsdp2;
struct grub_acpi_rsdp_v10 *rsdp1;
- struct grub_acpi_table_header *rsdt;
- grub_uint32_t *entry_ptr;
+ struct grub_acpi_table_header *rsdt;
+ grub_uint32_t *entry_ptr;
+ grub_uint32_t port = 0;
+ int sleep_type = -1;
rsdp2 = grub_acpi_get_rsdpv2 ();
if (rsdp2)
@@ -324,33 +358,39 @@ grub_acpi_halt (void)
{
if (grub_memcmp ((void *) (grub_addr_t) *entry_ptr, "FACP", 4) == 0)
{
- grub_uint32_t port;
struct grub_acpi_fadt *fadt
= ((struct grub_acpi_fadt *) (grub_addr_t) *entry_ptr);
struct grub_acpi_table_header *dsdt
= (struct grub_acpi_table_header *) (grub_addr_t) fadt->dsdt_addr;
- int sleep_type = -1;
+ grub_uint8_t *buf = (grub_uint8_t *) dsdt;
port = fadt->pm1a;
grub_dprintf ("acpi", "PM1a port=%x\n", port);
if (grub_memcmp (dsdt->signature, "DSDT",
- sizeof (dsdt->signature)) != 0)
- break;
+ sizeof (dsdt->signature)) == 0)
+ sleep_type = get_sleep_type (buf, NULL, buf + dsdt->length,
+ NULL, 0);
+ }
+ else if (grub_memcmp ((void *) (grub_addr_t) *entry_ptr, "SSDT", 4) == 0)
+ {
+ struct grub_acpi_table_header *ssdt
+ = (struct grub_acpi_table_header *) (grub_addr_t) *entry_ptr;
+ grub_uint8_t *buf = (grub_uint8_t *) ssdt;
- sleep_type = get_sleep_type ((grub_uint8_t *) dsdt,
- (grub_uint8_t *) dsdt + dsdt->length);
+ grub_dprintf ("acpi", "SSDT = %p\n", ssdt);
- if (sleep_type < 0 || sleep_type >= 8)
- break;
+ sleep_type = get_sleep_type (buf, NULL, buf + ssdt->length, NULL, 0);
+ }
+ }
- grub_dprintf ("acpi", "SLP_TYP = %d, port = 0x%x\n",
- sleep_type, port);
+ if (port && sleep_type >= 0 && sleep_type < 8)
+ {
+ grub_dprintf ("acpi", "SLP_TYP = %d, port = 0x%x\n", sleep_type, port);
- grub_outw (GRUB_ACPI_SLP_EN
- | (sleep_type << GRUB_ACPI_SLP_TYP_OFFSET), port & 0xffff);
- }
+ grub_outw (GRUB_ACPI_SLP_EN | (sleep_type << GRUB_ACPI_SLP_TYP_OFFSET),
+ port & 0xffff);
}
grub_millisleep (1500);
diff --git a/include/grub/acpi.h b/include/grub/acpi.h
index 52d190c..8fa957d 100644
--- a/include/grub/acpi.h
+++ b/include/grub/acpi.h
@@ -203,9 +203,15 @@ enum
enum
{
GRUB_ACPI_EXTOPCODE_MUTEX = 0x01,
+ GRUB_ACPI_EXTOPCODE_EVENT_OP = 0x02,
GRUB_ACPI_EXTOPCODE_OPERATION_REGION = 0x80,
GRUB_ACPI_EXTOPCODE_FIELD_OP = 0x81,
+ GRUB_ACPI_EXTOPCODE_DEVICE_OP = 0x82,
+ GRUB_ACPI_EXTOPCODE_PROCESSOR_OP = 0x83,
+ GRUB_ACPI_EXTOPCODE_POWER_RES_OP = 0x84,
+ GRUB_ACPI_EXTOPCODE_THERMAL_ZONE_OP = 0x85,
GRUB_ACPI_EXTOPCODE_INDEX_FIELD_OP = 0x86,
+ GRUB_ACPI_EXTOPCODE_BANK_FIELD_OP = 0x87,
};
#endif /* ! GRUB_ACPI_HEADER */
--
1.8.2.1