kernel/arch/mips/ralink/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 version 2 as published
   4  * by the Free Software Foundation.
   5  *
   6  * Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>
   7  * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
   8  * Copyright (C) 2013 John Crispin <blogic@openwrt.org>
   9  */
  10
  11 #include <linux/pm.h>
  12 #include <linux/io.h>
  13 #include <linux/of.h>
  14 #include <linux/delay.h>
  15 #include <linux/reset-controller.h>
  16
  17 #include <asm/reboot.h>
  18
  19 #include <asm/mach-ralink/ralink_regs.h>
  20
  21 /* Reset Control */
  22 #define SYSC_REG_RESET_CTRL     0x034
  23
  24 #define RSTCTL_RESET_PCI        BIT(26)
  25 #define RSTCTL_RESET_SYSTEM     BIT(0)
  26
  27 static int ralink_assert_device(struct reset_controller_dev *rcdev,
  28                                 unsigned long id)
  29 {
  30         u32 val;
  31
  32         if (id < 8)
  33                 return -1;
  34
  35         val = rt_sysc_r32(SYSC_REG_RESET_CTRL);
  36         val |= BIT(id);
  37         rt_sysc_w32(val, SYSC_REG_RESET_CTRL);
  38
  39         return 0;
  40 }
  41
  42 static int ralink_deassert_device(struct reset_controller_dev *rcdev,
  43                                   unsigned long id)
  44 {
  45         u32 val;
  46
  47         if (id < 8)
  48                 return -1;
  49
  50         val = rt_sysc_r32(SYSC_REG_RESET_CTRL);
  51         val &= ~BIT(id);
  52         rt_sysc_w32(val, SYSC_REG_RESET_CTRL);
  53
  54         return 0;
  55 }
  56
  57 static int ralink_reset_device(struct reset_controller_dev *rcdev,
  58                                unsigned long id)
  59 {
  60         ralink_assert_device(rcdev, id);
  61         return ralink_deassert_device(rcdev, id);
  62 }
  63
  64 static struct reset_control_ops reset_ops = {
  65         .reset = ralink_reset_device,
  66         .assert = ralink_assert_device,
  67         .deassert = ralink_deassert_device,
  68 };
  69
  70 static struct reset_controller_dev reset_dev = {
  71         .ops                    = &reset_ops,
  72         .owner                  = THIS_MODULE,
  73         .nr_resets              = 32,
  74         .of_reset_n_cells       = 1,
  75 };
  76
  77 void ralink_rst_init(void)
  78 {
  79         reset_dev.of_node = of_find_compatible_node(NULL, NULL,
  80                                                 "ralink,rt2880-reset");
  81         if (!reset_dev.of_node)
  82                 pr_err("Failed to find reset controller node");
  83         else
  84                 reset_controller_register(&reset_dev);
  85 }
  86
  87 static void ralink_restart(char *command)
  88 {
  89         if (IS_ENABLED(CONFIG_PCI)) {
  90                 rt_sysc_m32(0, RSTCTL_RESET_PCI, SYSC_REG_RESET_CTRL);
  91                 mdelay(50);
  92         }
  93
  94         local_irq_disable();
  95         rt_sysc_w32(RSTCTL_RESET_SYSTEM, SYSC_REG_RESET_CTRL);
  96         unreachable();
  97 }
  98
  99 static void ralink_halt(void)
 100 {
 101         local_irq_disable();
 102         unreachable();
 103 }
 104
 105 static int __init mips_reboot_setup(void)
 106 {
 107         _machine_restart = ralink_restart;
 108         _machine_halt = ralink_halt;
 109
 110         return 0;
 111 }
 112
 113 arch_initcall(mips_reboot_setup);