implement ACPI shutdown

diff --git a/commands/acpihalt.c b/commands/acpihalt.c
new file mode 100644 (file)
index 0000000..2ba1546
--- /dev/null
+++ b/commands/acpihalt.c
@@ -0,0 +1,266 @@
+/*
+ *  GRUB  --  GRand Unified Bootloader
+ *  Copyright (C) 2010  Free Software Foundation, Inc.
+ *
+ *  GRUB is free software: you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation, either version 3 of the License, or
+ *  (at your option) any later version.
+ *
+ *  GRUB is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <grub/acpi.h>
+#include <grub/misc.h>
+#include <grub/cpu/io.h>
+
+static inline grub_uint32_t
+decode_length (const grub_uint8_t *ptr, int *numlen)
+{
+  int num_bytes, i;
+  grub_uint32_t ret;
+  if (*ptr < 64)
+    {
+      if (numlen)
+       *numlen = 1;
+      return *ptr;
+    }
+  num_bytes = *ptr >> 6;
+  if (numlen)
+    *numlen = num_bytes + 1;
+  ret = *ptr & 0xf;
+  ptr++;
+  for (i = 0; i < num_bytes; i++)
+    {
+      ret |= *ptr << (8 * i + 4);
+      ptr++;
+    }
+  return ret;
+}
+
+static inline grub_uint32_t
+skip_name_string (const grub_uint8_t *ptr, const grub_uint8_t *end)
+{
+  const grub_uint8_t *ptr0 = ptr;
+  
+  while (ptr < end && (*ptr == '^' || *ptr == '\\'))
+    ptr++;
+  switch (*ptr)
+    {
+    case '.':
+      ptr++;
+      ptr += 8;
+      break;
+    case '/':
+      ptr++;
+      ptr += 1 + (*ptr) * 4;
+      break;
+    case 0:
+      ptr++;
+      break;
+    default:
+      ptr += 4;
+      break;
+    }
+  return ptr - ptr0;
+}
+
+static inline grub_uint32_t
+skip_data_ref_object (const grub_uint8_t *ptr, const grub_uint8_t *end)
+{
+  grub_dprintf ("acpi", "data type = 0x%x\n", *ptr);
+  switch (*ptr)
+    {
+    case GRUB_ACPI_OPCODE_PACKAGE:
+      return 1 + decode_length (ptr + 1, 0);
+    case GRUB_ACPI_OPCODE_ZERO:
+    case GRUB_ACPI_OPCODE_ONES:
+    case GRUB_ACPI_OPCODE_ONE:
+      return 1;
+    case GRUB_ACPI_OPCODE_BYTE_CONST:
+      return 2;
+    case GRUB_ACPI_OPCODE_WORD_CONST:
+      return 3;
+    case GRUB_ACPI_OPCODE_DWORD_CONST:
+      return 5;
+    default:
+      if (*ptr == '^' || *ptr == '\\' || *ptr == '_'
+         || (*ptr >= 'A' && *ptr <= 'Z'))
+       return skip_name_string (ptr, end);
+      grub_printf ("Unknown opcode 0x%x\n", *ptr);
+      return 0;
+    }
+}
+
+static inline grub_uint32_t
+skip_ext_op (const grub_uint8_t *ptr, const grub_uint8_t *end)
+{
+  const grub_uint8_t *ptr0 = ptr;
+  int add;
+  grub_dprintf ("acpi", "Extended opcode: 0x%x\n", *ptr);
+  switch (*ptr)
+    {
+    case GRUB_ACPI_EXTOPCODE_MUTEX:
+      ptr++;
+      ptr += skip_name_string (ptr, end);
+      ptr++;
+      break;
+    case GRUB_ACPI_EXTOPCODE_OPERATION_REGION:
+      ptr++;
+      ptr += skip_name_string (ptr, end);
+      ptr++;
+      ptr += add = skip_data_ref_object (ptr, end);
+      if (!add)
+       return 0;
+      ptr += add = skip_data_ref_object (ptr, end);
+      if (!add)
+       return 0;
+      break;
+    case GRUB_ACPI_EXTOPCODE_FIELD_OP:
+      ptr++;
+      ptr += decode_length (ptr, 0);
+      break;
+    default:
+      grub_printf ("Unexpected extended opcode: 0x%x\n", *ptr);
+      return 0;
+    }
+  return ptr - ptr0;
+}
+
+static int
+get_sleep_type (grub_uint8_t *table, grub_uint8_t *end)
+{
+  grub_uint8_t *ptr, *prev;
+  int sleep_type = -1;
+  
+  ptr = table + sizeof (struct grub_acpi_table_header);
+  while (ptr < end && prev < ptr)
+    {
+      int add;
+      prev = ptr;
+      grub_dprintf ("acpi", "Opcode %x\n", *ptr);
+      grub_dprintf ("acpi", "Tell %x\n", ptr - table);
+      switch (*ptr)
+       {
+       case GRUB_ACPI_OPCODE_EXTOP:
+         ptr++;
+         ptr += add = skip_ext_op (ptr, end);
+         if (!add)
+           return -1;
+         break;
+       case GRUB_ACPI_OPCODE_NAME:
+         ptr++;
+         if (memcmp (ptr, "_S5_", 4) == 0)
+           {
+             int ll;
+             grub_uint8_t *ptr2 = ptr;
+             ptr2 += 4;
+             if (*ptr2 != 0x12)
+               {
+                 grub_printf ("Unknown opcode in _S5: 0x%x\n", *ptr2);
+                 return -1;
+               }
+             ptr2++;
+             decode_length (ptr2, &ll);
+             ptr2 += ll;
+             ptr2++;
+             switch (*ptr2)
+               {
+               case GRUB_ACPI_OPCODE_ZERO:
+                 sleep_type = 0;
+                 break;
+               case GRUB_ACPI_OPCODE_ONE:
+                 sleep_type = 1;
+                 break;
+               case GRUB_ACPI_OPCODE_BYTE_CONST:
+                 sleep_type = ptr2[1];
+                 break;
+               default:
+                 grub_printf ("Unknown data type in _S5: 0x%x\n", *ptr2);
+                 return -1;
+               }
+           }
+         ptr += add = skip_name_string (ptr, end);
+         if (!add)
+           return -1;
+         ptr += add = skip_data_ref_object (ptr, end);
+         if (!add)
+           return -1;
+         break;
+       case GRUB_ACPI_OPCODE_SCOPE:
+       case GRUB_ACPI_OPCODE_IF:
+       case GRUB_ACPI_OPCODE_METHOD:
+         {
+           ptr++;
+           ptr += decode_length (ptr, 0);
+           break;
+         }
+       }
+    }
+
+  grub_dprintf ("acpi", "TYP = %d\n", sleep_type);
+  return sleep_type;
+}
+
+void
+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;
+
+  rsdp2 = grub_acpi_get_rsdpv2 ();
+  if (rsdp2)
+    rsdp1 = &(rsdp2->rsdpv1);
+  else
+    rsdp1 = grub_acpi_get_rsdpv1 ();
+  grub_dprintf ("acpi", "rsdp1=%p\n", rsdp1);
+  if (!rsdp1)
+    return;
+
+  rsdt = (struct grub_acpi_table_header *) rsdp1->rsdt_addr;
+  for (entry_ptr = (grub_uint32_t *) (rsdt + 1);
+       entry_ptr < (grub_uint32_t *) (((grub_uint8_t *) rsdt)
+                                     + rsdt->length);
+       entry_ptr++)
+    {
+      if (grub_memcmp ((void *)*entry_ptr, "FACP", 4) == 0)
+       {
+         grub_uint32_t port;
+         struct grub_acpi_fadt *fadt
+           = ((struct grub_acpi_fadt *) *entry_ptr);
+         struct grub_acpi_table_header *dsdt
+           = (struct grub_acpi_table_header *) fadt->dsdt_addr;
+         int sleep_type = -1;
+
+         port = fadt->pm1a;
+
+         grub_dprintf ("acpi", "PM1a port=%x\n", port);
+
+         if (grub_memcmp (dsdt->signature, "DSDT",
+                          sizeof (dsdt->signature)) != 0)
+           break;
+
+         sleep_type = get_sleep_type ((grub_uint8_t *) dsdt,
+                                      (grub_uint8_t *) dsdt + dsdt->length);
+
+         if (sleep_type < 0 || sleep_type >= 8)
+           break;
+
+         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_printf ("ACPI shutdown failed\n");
+}

diff --git a/commands/i386/pc/halt.c b/commands/i386/pc/halt.c
index 4c39612ae81f22db67a85904d7ed1d457f917486..143f4a4ff4712a5cccdb9fc21a18ac5abaa79824 100644 (file)
--- a/commands/i386/pc/halt.c
+++ b/commands/i386/pc/halt.c
@@ -21,6 +21,7 @@
 #include <grub/misc.h>
 #include <grub/extcmd.h>
 #include <grub/i18n.h>
+#include <grub/acpi.h>
 
 static const struct grub_arg_option options[] =
   {
@@ -36,6 +37,9 @@ grub_cmd_halt (grub_extcmd_t cmd,
 {
   struct grub_arg_list *state = cmd->state;
   int no_apm = 0;
+
+  grub_acpi_halt ();
+
   if (state[0].set)
     no_apm = 1;
   grub_halt (no_apm);

diff --git a/conf/i386-pc.rmk b/conf/i386-pc.rmk
index a5a1b08ea54f62aa8556d62b322f9f5b45c5f0f3..13055b1c6f1e8a0f7e2496feb600301b967e84d4 100644 (file)
--- a/conf/i386-pc.rmk
+++ b/conf/i386-pc.rmk
@@ -165,7 +165,7 @@ xnu_mod_LDFLAGS = $(COMMON_LDFLAGS)
 xnu_mod_ASFLAGS = $(COMMON_ASFLAGS)
 
 # For halt.mod.
-halt_mod_SOURCES = commands/i386/pc/halt.c
+halt_mod_SOURCES = commands/i386/pc/halt.c commands/acpihalt.c
 halt_mod_CFLAGS = $(COMMON_CFLAGS)
 halt_mod_LDFLAGS = $(COMMON_LDFLAGS)
 

diff --git a/include/grub/acpi.h b/include/grub/acpi.h
index 7933db8241646197b09376875fb49ccbace5f5ce..ae83aed3458b8126f24eda847b8541b23a4273b4 100644 (file)
--- a/include/grub/acpi.h
+++ b/include/grub/acpi.h
@@ -58,10 +58,12 @@ struct grub_acpi_fadt
   struct grub_acpi_table_header hdr;
   grub_uint32_t facs_addr;
   grub_uint32_t dsdt_addr;
-  grub_uint8_t somefields1[88];
+  grub_uint8_t somefields1[20];
+  grub_uint32_t pm1a;
+  grub_uint8_t somefields2[64];
   grub_uint64_t facs_xaddr;
   grub_uint64_t dsdt_xaddr;
-  grub_uint8_t somefields2[96];
+  grub_uint8_t somefields3[96];
 } __attribute__ ((packed));
 
 struct grub_acpi_rsdp_v10 *grub_acpi_get_rsdpv1 (void);
@@ -72,4 +74,25 @@ grub_uint8_t grub_byte_checksum (void *base, grub_size_t size);
 
 grub_err_t grub_acpi_create_ebda (void);
 
+void grub_acpi_halt (void);
+
+#define GRUB_ACPI_SLP_EN (1 << 13)
+#define GRUB_ACPI_SLP_TYP_OFFSET 10
+
+enum
+  {
+    GRUB_ACPI_OPCODE_ZERO = 0, GRUB_ACPI_OPCODE_ONE = 1,
+    GRUB_ACPI_OPCODE_NAME = 8, GRUB_ACPI_OPCODE_BYTE_CONST = 0x0a,
+    GRUB_ACPI_OPCODE_WORD_CONST = 0x0b, GRUB_ACPI_OPCODE_DWORD_CONST = 0x0c,
+    GRUB_ACPI_OPCODE_SCOPE = 0x10, GRUB_ACPI_OPCODE_PACKAGE = 0x12,
+    GRUB_ACPI_OPCODE_METHOD = 0x14, GRUB_ACPI_OPCODE_EXTOP = 0x5b,
+    GRUB_ACPI_OPCODE_IF = 0xa0, GRUB_ACPI_OPCODE_ONES = 0xff
+  };
+enum
+  {
+    GRUB_ACPI_EXTOPCODE_MUTEX = 0x01,
+    GRUB_ACPI_EXTOPCODE_OPERATION_REGION = 0x80,
+    GRUB_ACPI_EXTOPCODE_FIELD_OP = 0x81
+  };
+
 #endif /* ! GRUB_ACPI_HEADER */