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