arch/mips/loongson64/common/reset.c

   1 /*
   2  * This program is free software; you can redistribute  it and/or modify it
   3  * under  the terms of  the GNU General  Public License as published by the
   4  * Free Software Foundation;  either version 2 of the  License, or (at your
   5  * option) any later version.
   6  *
   7  * Copyright (C) 2007 Lemote, Inc. & Institute of Computing Technology
   8  * Author: Fuxin Zhang, zhangfx@lemote.com
   9  * Copyright (C) 2009 Lemote, Inc.
  10  * Author: Zhangjin Wu, wuzhangjin@gmail.com
  11  */
  12 #include <linux/init.h>
  13 #include <linux/pm.h>
  14
  15 #include <asm/idle.h>
  16 #include <asm/reboot.h>
  17
  18 #include <loongson.h>
  19 #include <boot_param.h>
  20
  21 static inline void loongson_reboot(void)
  22 {
  23 #ifndef CONFIG_CPU_JUMP_WORKAROUNDS
  24         ((void (*)(void))ioremap_nocache(LOONGSON_BOOT_BASE, 4)) ();
  25 #else
  26         void (*func)(void);
  27
  28         func = (void *)ioremap_nocache(LOONGSON_BOOT_BASE, 4);
  29
  30         __asm__ __volatile__(
  31         "       .set    noat                                            \n"
  32         "       jr      %[func]                                         \n"
  33         "       .set    at                                              \n"
  34         : /* No outputs */
  35         : [func] "r" (func));
  36 #endif
  37 }
  38
  39 static void loongson_restart(char *command)
  40 {
  41 #ifndef CONFIG_LEFI_FIRMWARE_INTERFACE
  42         /* do preparation for reboot */
  43         mach_prepare_reboot();
  44
  45         /* reboot via jumping to boot base address */
  46         loongson_reboot();
  47 #else
  48         void (*fw_restart)(void) = (void *)loongson_sysconf.restart_addr;
  49
  50         fw_restart();
  51         while (1) {
  52                 if (cpu_wait)
  53                         cpu_wait();
  54         }
  55 #endif
  56 }
  57
  58 static void loongson_poweroff(void)
  59 {
  60 #ifndef CONFIG_LEFI_FIRMWARE_INTERFACE
  61         mach_prepare_shutdown();
  62
  63         /*
  64          * It needs a wait loop here, but mips/kernel/reset.c already calls
  65          * a generic delay loop, machine_hang(), so simply return.
  66          */
  67         return;
  68 #else
  69         void (*fw_poweroff)(void) = (void *)loongson_sysconf.poweroff_addr;
  70
  71         fw_poweroff();
  72         while (1) {
  73                 if (cpu_wait)
  74                         cpu_wait();
  75         }
  76 #endif
  77 }
  78
  79 static void loongson_halt(void)
  80 {
  81         pr_notice("\n\n** You can safely turn off the power now **\n\n");
  82         while (1) {
  83                 if (cpu_wait)
  84                         cpu_wait();
  85         }
  86 }
  87
  88 static int __init mips_reboot_setup(void)
  89 {
  90         _machine_restart = loongson_restart;
  91         _machine_halt = loongson_halt;
  92         pm_power_off = loongson_poweroff;
  93
  94         return 0;
  95 }
  96
  97 arch_initcall(mips_reboot_setup);