2 * Copyright 2011 Freescale Semiconductor, Inc.
3 * Copyright 2011 Linaro Ltd.
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:
9 * http://www.opensource.org/licenses/gpl-license.html
10 * http://www.gnu.org/copyleft/gpl.html
13 #include <linux/clk.h>
14 #include <linux/clkdev.h>
15 #include <linux/delay.h>
16 #include <linux/init.h>
18 #include <linux/irq.h>
20 #include <linux/of_address.h>
21 #include <linux/of_irq.h>
22 #include <linux/of_platform.h>
23 #include <linux/pinctrl/machine.h>
24 #include <linux/phy.h>
25 #include <linux/micrel_phy.h>
26 #include <linux/mfd/anatop.h>
27 #include <asm/smp_twd.h>
28 #include <asm/hardware/cache-l2x0.h>
29 #include <asm/hardware/gic.h>
30 #include <asm/mach/arch.h>
31 #include <asm/mach/time.h>
32 #include <asm/system_misc.h>
33 #include <mach/common.h>
34 #include <mach/hardware.h>
36 void imx6q_restart(char mode, const char *cmd)
38 struct device_node *np;
39 void __iomem *wdog_base;
41 np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-wdt");
42 wdog_base = of_iomap(np, 0);
46 imx_src_prepare_restart();
49 writew_relaxed(1 << 2, wdog_base);
50 /* write twice to ensure the request will not get ignored */
51 writew_relaxed(1 << 2, wdog_base);
53 /* wait for reset to assert ... */
56 pr_err("Watchdog reset failed to assert reset\n");
58 /* delay to allow the serial port to show the message */
62 /* we'll take a jump through zero as a poor second */
66 /* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */
67 static int ksz9021rn_phy_fixup(struct phy_device *phydev)
69 if (IS_ENABLED(CONFIG_PHYLIB)) {
70 /* min rx data delay */
71 phy_write(phydev, 0x0b, 0x8105);
72 phy_write(phydev, 0x0c, 0x0000);
74 /* max rx/tx clock delay, min rx/tx control delay */
75 phy_write(phydev, 0x0b, 0x8104);
76 phy_write(phydev, 0x0c, 0xf0f0);
77 phy_write(phydev, 0x0b, 0x104);
83 static void __init imx6q_sabrelite_cko1_setup(void)
85 struct clk *cko1_sel, *ahb, *cko1;
88 cko1_sel = clk_get_sys(NULL, "cko1_sel");
89 ahb = clk_get_sys(NULL, "ahb");
90 cko1 = clk_get_sys(NULL, "cko1");
91 if (IS_ERR(cko1_sel) || IS_ERR(ahb) || IS_ERR(cko1)) {
92 pr_err("cko1 setup failed!\n");
95 clk_set_parent(cko1_sel, ahb);
96 rate = clk_round_rate(cko1, 16000000);
97 clk_set_rate(cko1, rate);
98 clk_register_clkdev(cko1, NULL, "0-000a");
100 if (!IS_ERR(cko1_sel))
108 static void __init imx6q_sabrelite_init(void)
110 if (IS_ENABLED(CONFIG_PHYLIB))
111 phy_register_fixup_for_uid(PHY_ID_KSZ9021, MICREL_PHY_ID_MASK,
112 ksz9021rn_phy_fixup);
113 imx6q_sabrelite_cko1_setup();
116 static void __init imx6q_usb_init(void)
118 struct device_node *np;
119 struct platform_device *pdev = NULL;
120 struct anatop *adata = NULL;
122 np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-anatop");
124 pdev = of_find_device_by_node(np);
126 adata = platform_get_drvdata(pdev);
133 #define HW_ANADIG_USB1_CHRG_DETECT 0x000001b0
134 #define HW_ANADIG_USB2_CHRG_DETECT 0x00000210
136 #define BM_ANADIG_USB_CHRG_DETECT_EN_B 0x00100000
137 #define BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B 0x00080000
140 * The external charger detector needs to be disabled,
141 * or the signal at DP will be poor
143 anatop_write_reg(adata, HW_ANADIG_USB1_CHRG_DETECT,
144 BM_ANADIG_USB_CHRG_DETECT_EN_B
145 | BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B,
147 anatop_write_reg(adata, HW_ANADIG_USB2_CHRG_DETECT,
148 BM_ANADIG_USB_CHRG_DETECT_EN_B |
149 BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B,
155 static void __init imx6q_init_machine(void)
158 * This should be removed when all imx6q boards have pinctrl
159 * states for devices defined in device tree.
161 pinctrl_provide_dummies();
163 if (of_machine_is_compatible("fsl,imx6q-sabrelite"))
164 imx6q_sabrelite_init();
166 of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL);
172 static void __init imx6q_map_io(void)
176 imx6q_clock_map_io();
179 static const struct of_device_id imx6q_irq_match[] __initconst = {
180 { .compatible = "arm,cortex-a9-gic", .data = gic_of_init, },
184 static void __init imx6q_init_irq(void)
186 l2x0_of_init(0, ~0UL);
189 of_irq_init(imx6q_irq_match);
192 static void __init imx6q_timer_init(void)
195 twd_local_timer_of_register();
198 static struct sys_timer imx6q_timer = {
199 .init = imx6q_timer_init,
202 static const char *imx6q_dt_compat[] __initdata = {
204 "fsl,imx6q-sabrelite",
210 DT_MACHINE_START(IMX6Q, "Freescale i.MX6 Quad (Device Tree)")
211 .map_io = imx6q_map_io,
212 .init_irq = imx6q_init_irq,
213 .handle_irq = imx6q_handle_irq,
214 .timer = &imx6q_timer,
215 .init_machine = imx6q_init_machine,
216 .dt_compat = imx6q_dt_compat,
217 .restart = imx6q_restart,