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/reset-controller.h> 15 16#include <asm/reboot.h> 17 18#include <asm/mach-ralink/ralink_regs.h> 19 20/* Reset Control */ 21#define SYSC_REG_RESET_CTRL 0x034 22#define RSTCTL_RESET_SYSTEM BIT(0) 23 24static int ralink_assert_device(struct reset_controller_dev *rcdev, 25 unsigned long id) 26{ 27 u32 val; 28 29 if (id < 8) 30 return -1; 31 32 val = rt_sysc_r32(SYSC_REG_RESET_CTRL); 33 val |= BIT(id); 34 rt_sysc_w32(val, SYSC_REG_RESET_CTRL); 35 36 return 0; 37} 38 39static int ralink_deassert_device(struct reset_controller_dev *rcdev, 40 unsigned long id) 41{ 42 u32 val; 43 44 if (id < 8) 45 return -1; 46 47 val = rt_sysc_r32(SYSC_REG_RESET_CTRL); 48 val &= ~BIT(id); 49 rt_sysc_w32(val, SYSC_REG_RESET_CTRL); 50 51 return 0; 52} 53 54static int ralink_reset_device(struct reset_controller_dev *rcdev, 55 unsigned long id) 56{ 57 ralink_assert_device(rcdev, id); 58 return ralink_deassert_device(rcdev, id); 59} 60 61static struct reset_control_ops reset_ops = { 62 .reset = ralink_reset_device, 63 .assert = ralink_assert_device, 64 .deassert = ralink_deassert_device, 65}; 66 67static struct reset_controller_dev reset_dev = { 68 .ops = &reset_ops, 69 .owner = THIS_MODULE, 70 .nr_resets = 32, 71 .of_reset_n_cells = 1, 72}; 73 74void ralink_rst_init(void) 75{ 76 reset_dev.of_node = of_find_compatible_node(NULL, NULL, 77 "ralink,rt2880-reset"); 78 if (!reset_dev.of_node) 79 pr_err("Failed to find reset controller node"); 80 else 81 reset_controller_register(&reset_dev); 82} 83 84static void ralink_restart(char *command) 85{ 86 local_irq_disable(); 87 rt_sysc_w32(RSTCTL_RESET_SYSTEM, SYSC_REG_RESET_CTRL); 88 unreachable(); 89} 90 91static void ralink_halt(void) 92{ 93 local_irq_disable(); 94 unreachable(); 95} 96 97static int __init mips_reboot_setup(void) 98{ 99 _machine_restart = ralink_restart; 100 _machine_halt = ralink_halt; 101 pm_power_off = ralink_halt; 102 103 return 0; 104} 105 106arch_initcall(mips_reboot_setup); 107