arch/mips/loongson/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         unreachable();
  63 #else
  64         void (*fw_poweroff)(void) = (void *)loongson_sysconf.poweroff_addr;
  65
  66         fw_poweroff();
  67         while (1) {
  68                 if (cpu_wait)
  69                         cpu_wait();
  70         }
  71 #endif
  72 }
  73
  74 static void loongson_halt(void)
  75 {
  76         pr_notice("\n\n** You can safely turn off the power now **\n\n");
  77         while (1) {
  78                 if (cpu_wait)
  79                         cpu_wait();
  80         }
  81 }
  82
  83 static int __init mips_reboot_setup(void)
  84 {
  85         _machine_restart = loongson_restart;
  86         _machine_halt = loongson_halt;
  87         pm_power_off = loongson_poweroff;
  88
  89         return 0;
  90 }
  91
  92 arch_initcall(mips_reboot_setup);