Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2011 Freescale Semiconductor, Inc. |
| 3 | * Copyright 2011 Linaro Ltd. |
| 4 | * |
| 5 | * The code contained herein is licensed under the GNU General Public |
| 6 | * License. You may obtain a copy of the GNU General Public License |
| 7 | * Version 2 or later at the following locations: |
| 8 | * |
| 9 | * http://www.opensource.org/licenses/gpl-license.html |
| 10 | * http://www.gnu.org/copyleft/gpl.html |
| 11 | */ |
| 12 | |
Shawn Guo | 0575fb7 | 2011-12-09 00:51:26 +0100 | [diff] [blame] | 13 | #include <linux/delay.h> |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 14 | #include <linux/init.h> |
Shawn Guo | 0575fb7 | 2011-12-09 00:51:26 +0100 | [diff] [blame] | 15 | #include <linux/io.h> |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 16 | #include <linux/irq.h> |
| 17 | #include <linux/irqdomain.h> |
| 18 | #include <linux/of.h> |
Shawn Guo | 0575fb7 | 2011-12-09 00:51:26 +0100 | [diff] [blame] | 19 | #include <linux/of_address.h> |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 20 | #include <linux/of_irq.h> |
| 21 | #include <linux/of_platform.h> |
Richard Zhao | 477fce4 | 2011-12-14 09:26:47 +0800 | [diff] [blame] | 22 | #include <linux/phy.h> |
| 23 | #include <linux/micrel_phy.h> |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 24 | #include <asm/hardware/cache-l2x0.h> |
| 25 | #include <asm/hardware/gic.h> |
| 26 | #include <asm/mach/arch.h> |
| 27 | #include <asm/mach/time.h> |
David Howells | 9f97da7 | 2012-03-28 18:30:01 +0100 | [diff] [blame^] | 28 | #include <asm/system_misc.h> |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 29 | #include <mach/common.h> |
| 30 | #include <mach/hardware.h> |
| 31 | |
Shawn Guo | 0575fb7 | 2011-12-09 00:51:26 +0100 | [diff] [blame] | 32 | void imx6q_restart(char mode, const char *cmd) |
| 33 | { |
| 34 | struct device_node *np; |
| 35 | void __iomem *wdog_base; |
| 36 | |
| 37 | np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-wdt"); |
| 38 | wdog_base = of_iomap(np, 0); |
| 39 | if (!wdog_base) |
| 40 | goto soft; |
| 41 | |
| 42 | imx_src_prepare_restart(); |
| 43 | |
| 44 | /* enable wdog */ |
| 45 | writew_relaxed(1 << 2, wdog_base); |
| 46 | /* write twice to ensure the request will not get ignored */ |
| 47 | writew_relaxed(1 << 2, wdog_base); |
| 48 | |
| 49 | /* wait for reset to assert ... */ |
| 50 | mdelay(500); |
| 51 | |
| 52 | pr_err("Watchdog reset failed to assert reset\n"); |
| 53 | |
| 54 | /* delay to allow the serial port to show the message */ |
| 55 | mdelay(50); |
| 56 | |
| 57 | soft: |
| 58 | /* we'll take a jump through zero as a poor second */ |
| 59 | soft_restart(0); |
| 60 | } |
| 61 | |
Richard Zhao | 477fce4 | 2011-12-14 09:26:47 +0800 | [diff] [blame] | 62 | /* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */ |
| 63 | static int ksz9021rn_phy_fixup(struct phy_device *phydev) |
| 64 | { |
| 65 | /* min rx data delay */ |
| 66 | phy_write(phydev, 0x0b, 0x8105); |
| 67 | phy_write(phydev, 0x0c, 0x0000); |
| 68 | |
| 69 | /* max rx/tx clock delay, min rx/tx control delay */ |
| 70 | phy_write(phydev, 0x0b, 0x8104); |
| 71 | phy_write(phydev, 0x0c, 0xf0f0); |
| 72 | phy_write(phydev, 0x0b, 0x104); |
| 73 | |
| 74 | return 0; |
| 75 | } |
| 76 | |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 77 | static void __init imx6q_init_machine(void) |
| 78 | { |
Richard Zhao | 477fce4 | 2011-12-14 09:26:47 +0800 | [diff] [blame] | 79 | if (of_machine_is_compatible("fsl,imx6q-sabrelite")) |
| 80 | phy_register_fixup_for_uid(PHY_ID_KSZ9021, MICREL_PHY_ID_MASK, |
| 81 | ksz9021rn_phy_fixup); |
| 82 | |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 83 | of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL); |
| 84 | |
| 85 | imx6q_pm_init(); |
| 86 | } |
| 87 | |
| 88 | static void __init imx6q_map_io(void) |
| 89 | { |
| 90 | imx_lluart_map_io(); |
| 91 | imx_scu_map_io(); |
Richard Zhao | f475058 | 2011-11-17 18:54:29 +0800 | [diff] [blame] | 92 | imx6q_clock_map_io(); |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 93 | } |
| 94 | |
Shawn Guo | 2a3267a | 2011-12-01 14:35:29 +0800 | [diff] [blame] | 95 | static int __init imx6q_gpio_add_irq_domain(struct device_node *np, |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 96 | struct device_node *interrupt_parent) |
| 97 | { |
Shawn Guo | 04aafd7 | 2011-12-01 14:49:29 +0800 | [diff] [blame] | 98 | static int gpio_irq_base = MXC_GPIO_IRQ_START + ARCH_NR_GPIOS; |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 99 | |
Shawn Guo | 04aafd7 | 2011-12-01 14:49:29 +0800 | [diff] [blame] | 100 | gpio_irq_base -= 32; |
Grant Likely | 6b783f7 | 2012-01-10 17:09:30 -0700 | [diff] [blame] | 101 | irq_domain_add_legacy(np, 32, gpio_irq_base, 0, &irq_domain_simple_ops, |
| 102 | NULL); |
Shawn Guo | 2a3267a | 2011-12-01 14:35:29 +0800 | [diff] [blame] | 103 | |
| 104 | return 0; |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 105 | } |
| 106 | |
| 107 | static const struct of_device_id imx6q_irq_match[] __initconst = { |
| 108 | { .compatible = "arm,cortex-a9-gic", .data = gic_of_init, }, |
| 109 | { .compatible = "fsl,imx6q-gpio", .data = imx6q_gpio_add_irq_domain, }, |
| 110 | { /* sentinel */ } |
| 111 | }; |
| 112 | |
| 113 | static void __init imx6q_init_irq(void) |
| 114 | { |
| 115 | l2x0_of_init(0, ~0UL); |
| 116 | imx_src_init(); |
| 117 | imx_gpc_init(); |
| 118 | of_irq_init(imx6q_irq_match); |
| 119 | } |
| 120 | |
| 121 | static void __init imx6q_timer_init(void) |
| 122 | { |
| 123 | mx6q_clocks_init(); |
| 124 | } |
| 125 | |
| 126 | static struct sys_timer imx6q_timer = { |
| 127 | .init = imx6q_timer_init, |
| 128 | }; |
| 129 | |
| 130 | static const char *imx6q_dt_compat[] __initdata = { |
Dirk Behme | 752baf5 | 2011-12-08 08:22:01 +0100 | [diff] [blame] | 131 | "fsl,imx6q-arm2", |
Richard Zhao | 3c8276c | 2011-12-14 09:26:46 +0800 | [diff] [blame] | 132 | "fsl,imx6q-sabrelite", |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 133 | NULL, |
| 134 | }; |
| 135 | |
| 136 | DT_MACHINE_START(IMX6Q, "Freescale i.MX6 Quad (Device Tree)") |
| 137 | .map_io = imx6q_map_io, |
| 138 | .init_irq = imx6q_init_irq, |
| 139 | .handle_irq = imx6q_handle_irq, |
| 140 | .timer = &imx6q_timer, |
| 141 | .init_machine = imx6q_init_machine, |
| 142 | .dt_compat = imx6q_dt_compat, |
Shawn Guo | 0575fb7 | 2011-12-09 00:51:26 +0100 | [diff] [blame] | 143 | .restart = imx6q_restart, |
Shawn Guo | 13eed98 | 2011-09-06 15:05:25 +0800 | [diff] [blame] | 144 | MACHINE_END |