Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2010-2011 Calxeda, Inc. |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify it |
| 5 | * under the terms and conditions of the GNU General Public License, |
| 6 | * version 2, as published by the Free Software Foundation. |
| 7 | * |
| 8 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 11 | * more details. |
| 12 | * |
| 13 | * You should have received a copy of the GNU General Public License along with |
| 14 | * this program. If not, see <http://www.gnu.org/licenses/>. |
| 15 | */ |
| 16 | #include <linux/clk.h> |
| 17 | #include <linux/clkdev.h> |
Rob Herring | 0583fe4 | 2013-04-10 18:27:51 -0500 | [diff] [blame] | 18 | #include <linux/clocksource.h> |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 19 | #include <linux/dma-mapping.h> |
Rob Herring | 3843114 | 2013-12-04 11:05:17 -0600 | [diff] [blame] | 20 | #include <linux/input.h> |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 21 | #include <linux/io.h> |
Rob Herring | 0529e315 | 2012-11-05 16:18:28 -0600 | [diff] [blame] | 22 | #include <linux/irqchip.h> |
Suman Anna | f2fc42b | 2014-06-12 22:30:34 +0530 | [diff] [blame] | 23 | #include <linux/pl320-ipc.h> |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 24 | #include <linux/of.h> |
| 25 | #include <linux/of_irq.h> |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 26 | #include <linux/of_address.h> |
Rob Herring | 3843114 | 2013-12-04 11:05:17 -0600 | [diff] [blame] | 27 | #include <linux/reboot.h> |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 28 | #include <linux/amba/bus.h> |
Daniel Lezcano | 60a66e3 | 2013-09-27 12:47:45 +0200 | [diff] [blame] | 29 | #include <linux/platform_device.h> |
Mark Rutland | be12039 | 2015-07-31 15:46:19 +0100 | [diff] [blame] | 30 | #include <linux/psci.h> |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 31 | |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 32 | #include <asm/hardware/cache-l2x0.h> |
| 33 | #include <asm/mach/arch.h> |
Rob Herring | 5253034 | 2012-10-27 15:38:22 -0500 | [diff] [blame] | 34 | #include <asm/mach/map.h> |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 35 | |
| 36 | #include "core.h" |
| 37 | #include "sysregs.h" |
| 38 | |
| 39 | void __iomem *sregs_base; |
Rob Herring | 7a2848d | 2012-10-25 12:13:47 -0500 | [diff] [blame] | 40 | void __iomem *scu_base_addr; |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 41 | |
| 42 | static void __init highbank_scu_map_io(void) |
| 43 | { |
| 44 | unsigned long base; |
| 45 | |
| 46 | /* Get SCU base */ |
| 47 | asm("mrc p15, 4, %0, c15, c0, 0" : "=r" (base)); |
| 48 | |
Rob Herring | 7a2848d | 2012-10-25 12:13:47 -0500 | [diff] [blame] | 49 | scu_base_addr = ioremap(base, SZ_4K); |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 50 | } |
| 51 | |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 52 | |
Russell King | 0074fb2 | 2014-03-16 17:53:23 +0000 | [diff] [blame] | 53 | static void highbank_l2c310_write_sec(unsigned long val, unsigned reg) |
Rob Herring | 8e56130 | 2012-06-06 17:20:10 -0500 | [diff] [blame] | 54 | { |
Russell King | 0074fb2 | 2014-03-16 17:53:23 +0000 | [diff] [blame] | 55 | if (reg == L2X0_CTRL) |
| 56 | highbank_smc1(0x102, val); |
| 57 | else |
| 58 | WARN_ONCE(1, "Highbank L2C310: ignoring write to reg 0x%x\n", |
| 59 | reg); |
Rob Herring | 8e56130 | 2012-06-06 17:20:10 -0500 | [diff] [blame] | 60 | } |
Rob Herring | 8e56130 | 2012-06-06 17:20:10 -0500 | [diff] [blame] | 61 | |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 62 | static void __init highbank_init_irq(void) |
| 63 | { |
Rob Herring | 0529e315 | 2012-11-05 16:18:28 -0600 | [diff] [blame] | 64 | irqchip_init(); |
Rob Herring | 8e56130 | 2012-06-06 17:20:10 -0500 | [diff] [blame] | 65 | |
Rob Herring | 7a2848d | 2012-10-25 12:13:47 -0500 | [diff] [blame] | 66 | if (of_find_compatible_node(NULL, NULL, "arm,cortex-a9")) |
| 67 | highbank_scu_map_io(); |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 68 | } |
| 69 | |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 70 | static void highbank_power_off(void) |
| 71 | { |
Rob Herring | c05ee88 | 2012-12-30 10:15:04 -0600 | [diff] [blame] | 72 | highbank_set_pwr_shutdown(); |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 73 | |
| 74 | while (1) |
| 75 | cpu_do_idle(); |
| 76 | } |
| 77 | |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 78 | static int highbank_platform_notifier(struct notifier_block *nb, |
| 79 | unsigned long event, void *__dev) |
| 80 | { |
| 81 | struct resource *res; |
| 82 | int reg = -1; |
Rob Herring | e64bf95 | 2013-07-21 14:53:37 -0500 | [diff] [blame] | 83 | u32 val; |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 84 | struct device *dev = __dev; |
| 85 | |
| 86 | if (event != BUS_NOTIFY_ADD_DEVICE) |
| 87 | return NOTIFY_DONE; |
| 88 | |
| 89 | if (of_device_is_compatible(dev->of_node, "calxeda,hb-ahci")) |
| 90 | reg = 0xc; |
| 91 | else if (of_device_is_compatible(dev->of_node, "calxeda,hb-sdhci")) |
| 92 | reg = 0x18; |
| 93 | else if (of_device_is_compatible(dev->of_node, "arm,pl330")) |
| 94 | reg = 0x20; |
| 95 | else if (of_device_is_compatible(dev->of_node, "calxeda,hb-xgmac")) { |
| 96 | res = platform_get_resource(to_platform_device(dev), |
| 97 | IORESOURCE_MEM, 0); |
| 98 | if (res) { |
| 99 | if (res->start == 0xfff50000) |
| 100 | reg = 0; |
| 101 | else if (res->start == 0xfff51000) |
| 102 | reg = 4; |
| 103 | } |
| 104 | } |
| 105 | |
| 106 | if (reg < 0) |
| 107 | return NOTIFY_DONE; |
| 108 | |
| 109 | if (of_property_read_bool(dev->of_node, "dma-coherent")) { |
Rob Herring | e64bf95 | 2013-07-21 14:53:37 -0500 | [diff] [blame] | 110 | val = readl(sregs_base + reg); |
| 111 | writel(val | 0xff01, sregs_base + reg); |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 112 | set_dma_ops(dev, &arm_coherent_dma_ops); |
Rob Herring | e64bf95 | 2013-07-21 14:53:37 -0500 | [diff] [blame] | 113 | } |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 114 | |
| 115 | return NOTIFY_OK; |
| 116 | } |
| 117 | |
| 118 | static struct notifier_block highbank_amba_nb = { |
| 119 | .notifier_call = highbank_platform_notifier, |
| 120 | }; |
| 121 | |
| 122 | static struct notifier_block highbank_platform_nb = { |
| 123 | .notifier_call = highbank_platform_notifier, |
| 124 | }; |
| 125 | |
Daniel Lezcano | 60a66e3 | 2013-09-27 12:47:45 +0200 | [diff] [blame] | 126 | static struct platform_device highbank_cpuidle_device = { |
| 127 | .name = "cpuidle-calxeda", |
| 128 | }; |
| 129 | |
Rob Herring | 3843114 | 2013-12-04 11:05:17 -0600 | [diff] [blame] | 130 | static int hb_keys_notifier(struct notifier_block *nb, unsigned long event, void *data) |
| 131 | { |
| 132 | u32 key = *(u32 *)data; |
| 133 | |
| 134 | if (event != 0x1000) |
| 135 | return 0; |
| 136 | |
| 137 | if (key == KEY_POWER) |
| 138 | orderly_poweroff(false); |
| 139 | else if (key == 0xffff) |
| 140 | ctrl_alt_del(); |
| 141 | |
| 142 | return 0; |
| 143 | } |
| 144 | static struct notifier_block hb_keys_nb = { |
| 145 | .notifier_call = hb_keys_notifier, |
| 146 | }; |
| 147 | |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 148 | static void __init highbank_init(void) |
| 149 | { |
Sebastian Hesselbarth | 26cae16 | 2013-08-27 14:42:06 +0200 | [diff] [blame] | 150 | struct device_node *np; |
| 151 | |
| 152 | /* Map system registers */ |
| 153 | np = of_find_compatible_node(NULL, NULL, "calxeda,hb-sregs"); |
| 154 | sregs_base = of_iomap(np, 0); |
| 155 | WARN_ON(!sregs_base); |
| 156 | |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 157 | pm_power_off = highbank_power_off; |
Rob Herring | a283580 | 2012-09-17 09:55:12 -0500 | [diff] [blame] | 158 | highbank_pm_init(); |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 159 | |
Rob Herring | 1dc737c | 2012-08-21 12:31:06 +0200 | [diff] [blame] | 160 | bus_register_notifier(&platform_bus_type, &highbank_platform_nb); |
| 161 | bus_register_notifier(&amba_bustype, &highbank_amba_nb); |
| 162 | |
Rob Herring | 3843114 | 2013-12-04 11:05:17 -0600 | [diff] [blame] | 163 | pl320_ipc_register_notifier(&hb_keys_nb); |
| 164 | |
Rob Herring | a410146 | 2013-02-26 16:05:46 -0600 | [diff] [blame] | 165 | if (psci_ops.cpu_suspend) |
Daniel Lezcano | 60a66e3 | 2013-09-27 12:47:45 +0200 | [diff] [blame] | 166 | platform_device_register(&highbank_cpuidle_device); |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 167 | } |
| 168 | |
Uwe Kleine-König | 543c504 | 2015-02-18 21:01:45 +0100 | [diff] [blame] | 169 | static const char *const highbank_match[] __initconst = { |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 170 | "calxeda,highbank", |
Rob Herring | e095c0d | 2012-10-25 12:19:52 -0500 | [diff] [blame] | 171 | "calxeda,ecx-2000", |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 172 | NULL, |
| 173 | }; |
| 174 | |
| 175 | DT_MACHINE_START(HIGHBANK, "Highbank") |
Rob Herring | a6a3983 | 2013-08-01 15:50:55 -0500 | [diff] [blame] | 176 | #if defined(CONFIG_ZONE_DMA) && defined(CONFIG_ARM_LPAE) |
| 177 | .dma_zone_size = (4ULL * SZ_1G), |
| 178 | #endif |
Russell King | 513b9a0 | 2014-04-28 15:34:11 +0100 | [diff] [blame] | 179 | .l2c_aux_val = 0, |
| 180 | .l2c_aux_mask = ~0, |
| 181 | .l2c_write_sec = highbank_l2c310_write_sec, |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 182 | .init_irq = highbank_init_irq, |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 183 | .init_machine = highbank_init, |
| 184 | .dt_compat = highbank_match, |
Russell King | 00e9967 | 2011-11-05 11:16:05 +0000 | [diff] [blame] | 185 | .restart = highbank_restart, |
Rob Herring | 220e6cf | 2011-06-07 10:02:55 -0500 | [diff] [blame] | 186 | MACHINE_END |