31004e6
From 405b6d1cdc0d3fba50b0ba846c811a6ec1939ff3 Mon Sep 17 00:00:00 2001
31004e6
From: Vladimir 'phcoder' Serbinenko <phcoder@gmail.com>
31004e6
Date: Tue, 30 Apr 2013 17:37:37 +0200
f74b50e
Subject: [PATCH 397/482] 	* grub-core/kern/mips/loongson/init.c: Support
31004e6
 halt for loongson 2E.
31004e6
31004e6
---
31004e6
 ChangeLog                           |  4 ++++
31004e6
 grub-core/kern/mips/loongson/init.c | 33 +++++++++++++++++++++++++++++++++
31004e6
 2 files changed, 37 insertions(+)
31004e6
31004e6
diff --git a/ChangeLog b/ChangeLog
31004e6
index b0ae4ee..6b5feff 100644
31004e6
--- a/ChangeLog
31004e6
+++ b/ChangeLog
31004e6
@@ -1,5 +1,9 @@
31004e6
 2013-04-30  Vladimir Serbinenko  <phcoder@gmail.com>
31004e6
 
31004e6
+	* grub-core/kern/mips/loongson/init.c: Support halt for loongson 2E.
31004e6
+
31004e6
+2013-04-30  Vladimir Serbinenko  <phcoder@gmail.com>
31004e6
+
31004e6
 	* grub-core/partmap/amiga.c: Fix size of checksummed block.
31004e6
 
31004e6
 2013-04-29  Vladimir Serbinenko  <phcoder@gmail.com>
31004e6
diff --git a/grub-core/kern/mips/loongson/init.c b/grub-core/kern/mips/loongson/init.c
31004e6
index 52cbfd4..3ed1ded 100644
31004e6
--- a/grub-core/kern/mips/loongson/init.c
31004e6
+++ b/grub-core/kern/mips/loongson/init.c
31004e6
@@ -221,12 +221,45 @@ grub_machine_fini (void)
31004e6
 {
31004e6
 }
31004e6
 
31004e6
+static int
31004e6
+halt_via (grub_pci_device_t dev, grub_pci_id_t pciid,
31004e6
+	  void *data __attribute__ ((unused)))
31004e6
+{
31004e6
+  grub_uint16_t pm;
31004e6
+  grub_pci_address_t addr;
31004e6
+
31004e6
+  if (pciid != 0x30571106)
31004e6
+    return 0;
31004e6
+
31004e6
+  addr = grub_pci_make_address (dev, 0x40);
31004e6
+  pm = grub_pci_read (addr) & ~1;
31004e6
+
31004e6
+  if (pm == 0)
31004e6
+    {
31004e6
+      grub_pci_write (addr, 0x1801);
31004e6
+      pm = 0x1800;
31004e6
+    }
31004e6
+
31004e6
+  addr = grub_pci_make_address (dev, 0x80);
31004e6
+  grub_pci_write_byte (addr, 0xff);
31004e6
+
31004e6
+  addr = grub_pci_make_address (dev, GRUB_PCI_REG_COMMAND);
31004e6
+  grub_pci_write_word (addr, grub_pci_read_word (addr) | GRUB_PCI_COMMAND_IO_ENABLED);
31004e6
+
31004e6
+  /* FIXME: This one is derived from qemu. Check on real hardware.  */
31004e6
+  grub_outw (0x2000, pm + 4 + GRUB_MACHINE_PCI_IO_BASE);
31004e6
+  grub_millisleep (5000);
31004e6
+
31004e6
+  return 0;
31004e6
+}
31004e6
+
31004e6
 void
31004e6
 grub_halt (void)
31004e6
 {
31004e6
   switch (grub_arch_machine)
31004e6
     {
31004e6
     case GRUB_ARCH_MACHINE_FULOONG2E:
31004e6
+      grub_pci_iterate (halt_via, NULL);
31004e6
       break;
31004e6
     case GRUB_ARCH_MACHINE_FULOONG2F:
31004e6
       {
31004e6
-- 
31004e6
1.8.2.1
31004e6