Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / arch / mips / mti-malta / malta-reset.c

diff --git a/kernel/arch/mips/mti-malta/malta-reset.c b/kernel/arch/mips/mti-malta/malta-reset.c
new file mode 100644 (file)
index 0000000..2fd2cc2
--- /dev/null
+++ b/kernel/arch/mips/mti-malta/malta-reset.c
@@ -0,0 +1,47 @@
+/*
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ *
+ * Carsten Langgaard, carstenl@mips.com
+ * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
+ */
+#include <linux/io.h>
+#include <linux/pm.h>
+
+#include <asm/reboot.h>
+#include <asm/mach-malta/malta-pm.h>
+
+#define SOFTRES_REG    0x1f000500
+#define GORESET                0x42
+
+static void mips_machine_restart(char *command)
+{
+       unsigned int __iomem *softres_reg =
+               ioremap(SOFTRES_REG, sizeof(unsigned int));
+
+       __raw_writel(GORESET, softres_reg);
+}
+
+static void mips_machine_halt(void)
+{
+       while (true);
+}
+
+static void mips_machine_power_off(void)
+{
+       mips_pm_suspend(PIIX4_FUNC3IO_PMCNTRL_SUS_TYP_SOFF);
+
+       pr_info("Failed to power down, resetting\n");
+       mips_machine_restart(NULL);
+}
+
+static int __init mips_reboot_setup(void)
+{
+       _machine_restart = mips_machine_restart;
+       _machine_halt = mips_machine_halt;
+       pm_power_off = mips_machine_power_off;
+
+       return 0;
+}
+arch_initcall(mips_reboot_setup);