* grub-core/kern/mips/loongson/init.c: Support halt for loongson 2E.

diff --git a/ChangeLog b/ChangeLog
index b0ae4eebf3492c672e0028345f72d821d2e0a54d..6b5feff559bf88611547c445f7d1acd25c612278 100644 (file)
--- a/ChangeLog
+++ b/ChangeLog
@@ -1,3 +1,7 @@
+2013-04-30  Vladimir Serbinenko  <phcoder@gmail.com>
+
+       * grub-core/kern/mips/loongson/init.c: Support halt for loongson 2E.
+
 2013-04-30  Vladimir Serbinenko  <phcoder@gmail.com>
 
        * grub-core/partmap/amiga.c: Fix size of checksummed block.

diff --git a/grub-core/kern/mips/loongson/init.c b/grub-core/kern/mips/loongson/init.c
index 52cbfd407117413b13e5b5b1c92d0ec459a5b391..3ed1ded61b2144a907a95fa1bf3babd30f72b4cb 100644 (file)
--- a/grub-core/kern/mips/loongson/init.c
+++ b/grub-core/kern/mips/loongson/init.c
@@ -221,12 +221,45 @@ grub_machine_fini (void)
 {
 }
 
+static int
+halt_via (grub_pci_device_t dev, grub_pci_id_t pciid,
+         void *data __attribute__ ((unused)))
+{
+  grub_uint16_t pm;
+  grub_pci_address_t addr;
+
+  if (pciid != 0x30571106)
+    return 0;
+
+  addr = grub_pci_make_address (dev, 0x40);
+  pm = grub_pci_read (addr) & ~1;
+
+  if (pm == 0)
+    {
+      grub_pci_write (addr, 0x1801);
+      pm = 0x1800;
+    }
+
+  addr = grub_pci_make_address (dev, 0x80);
+  grub_pci_write_byte (addr, 0xff);
+
+  addr = grub_pci_make_address (dev, GRUB_PCI_REG_COMMAND);
+  grub_pci_write_word (addr, grub_pci_read_word (addr) | GRUB_PCI_COMMAND_IO_ENABLED);
+
+  /* FIXME: This one is derived from qemu. Check on real hardware.  */
+  grub_outw (0x2000, pm + 4 + GRUB_MACHINE_PCI_IO_BASE);
+  grub_millisleep (5000);
+
+  return 0;
+}
+
 void
 grub_halt (void)
 {
   switch (grub_arch_machine)
     {
     case GRUB_ARCH_MACHINE_FULOONG2E:
+      grub_pci_iterate (halt_via, NULL);
       break;
     case GRUB_ARCH_MACHINE_FULOONG2F:
       {