blob: 47c91f7185d2fb7cdef048388e5cf82620e68a87 [file] [log] [blame]
Shawn Guo13eed982011-09-06 15:05:25 +08001/*
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
Richard Zhaoa2585612012-04-24 14:19:13 +080013#include <linux/clk.h>
14#include <linux/clkdev.h>
Robert Leeb9d18dc2012-05-21 17:50:30 -050015#include <linux/cpuidle.h>
Shawn Guo0575fb72011-12-09 00:51:26 +010016#include <linux/delay.h>
Robert Leeb9d18dc2012-05-21 17:50:30 -050017#include <linux/export.h>
Shawn Guo13eed982011-09-06 15:05:25 +080018#include <linux/init.h>
Shawn Guo0575fb72011-12-09 00:51:26 +010019#include <linux/io.h>
Shawn Guo13eed982011-09-06 15:05:25 +080020#include <linux/irq.h>
Shawn Guo13eed982011-09-06 15:05:25 +080021#include <linux/of.h>
Shawn Guo0575fb72011-12-09 00:51:26 +010022#include <linux/of_address.h>
Shawn Guo13eed982011-09-06 15:05:25 +080023#include <linux/of_irq.h>
24#include <linux/of_platform.h>
Richard Zhao477fce42011-12-14 09:26:47 +080025#include <linux/phy.h>
Dong Aishengbaa64152012-09-05 10:57:15 +080026#include <linux/regmap.h>
Richard Zhao477fce42011-12-14 09:26:47 +080027#include <linux/micrel_phy.h>
Dong Aishengbaa64152012-09-05 10:57:15 +080028#include <linux/mfd/syscon.h>
Robert Leeb9d18dc2012-05-21 17:50:30 -050029#include <asm/cpuidle.h>
Marc Zyngier58458e02012-01-10 19:44:19 +000030#include <asm/smp_twd.h>
Shawn Guo13eed982011-09-06 15:05:25 +080031#include <asm/hardware/cache-l2x0.h>
32#include <asm/hardware/gic.h>
33#include <asm/mach/arch.h>
34#include <asm/mach/time.h>
David Howells9f97da72012-03-28 18:30:01 +010035#include <asm/system_misc.h>
Shawn Guo13eed982011-09-06 15:05:25 +080036#include <mach/common.h>
Robert Leeb9d18dc2012-05-21 17:50:30 -050037#include <mach/cpuidle.h>
Shawn Guo13eed982011-09-06 15:05:25 +080038#include <mach/hardware.h>
39
Robert Leeb9d18dc2012-05-21 17:50:30 -050040
Shawn Guo0575fb72011-12-09 00:51:26 +010041void imx6q_restart(char mode, const char *cmd)
42{
43 struct device_node *np;
44 void __iomem *wdog_base;
45
46 np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-wdt");
47 wdog_base = of_iomap(np, 0);
48 if (!wdog_base)
49 goto soft;
50
51 imx_src_prepare_restart();
52
53 /* enable wdog */
54 writew_relaxed(1 << 2, wdog_base);
55 /* write twice to ensure the request will not get ignored */
56 writew_relaxed(1 << 2, wdog_base);
57
58 /* wait for reset to assert ... */
59 mdelay(500);
60
61 pr_err("Watchdog reset failed to assert reset\n");
62
63 /* delay to allow the serial port to show the message */
64 mdelay(50);
65
66soft:
67 /* we'll take a jump through zero as a poor second */
68 soft_restart(0);
69}
70
Richard Zhao477fce42011-12-14 09:26:47 +080071/* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */
72static int ksz9021rn_phy_fixup(struct phy_device *phydev)
73{
Arnd Bergmann9f9ba0f2012-08-16 07:42:50 +000074 if (IS_BUILTIN(CONFIG_PHYLIB)) {
Shawn Guoef441802012-05-08 21:39:33 +080075 /* min rx data delay */
76 phy_write(phydev, 0x0b, 0x8105);
77 phy_write(phydev, 0x0c, 0x0000);
Richard Zhao477fce42011-12-14 09:26:47 +080078
Shawn Guoef441802012-05-08 21:39:33 +080079 /* max rx/tx clock delay, min rx/tx control delay */
80 phy_write(phydev, 0x0b, 0x8104);
81 phy_write(phydev, 0x0c, 0xf0f0);
82 phy_write(phydev, 0x0b, 0x104);
83 }
Richard Zhao477fce42011-12-14 09:26:47 +080084
85 return 0;
86}
87
Richard Zhaoa2585612012-04-24 14:19:13 +080088static void __init imx6q_sabrelite_cko1_setup(void)
89{
90 struct clk *cko1_sel, *ahb, *cko1;
91 unsigned long rate;
92
93 cko1_sel = clk_get_sys(NULL, "cko1_sel");
94 ahb = clk_get_sys(NULL, "ahb");
95 cko1 = clk_get_sys(NULL, "cko1");
96 if (IS_ERR(cko1_sel) || IS_ERR(ahb) || IS_ERR(cko1)) {
97 pr_err("cko1 setup failed!\n");
98 goto put_clk;
99 }
100 clk_set_parent(cko1_sel, ahb);
101 rate = clk_round_rate(cko1, 16000000);
102 clk_set_rate(cko1, rate);
Richard Zhaoa2585612012-04-24 14:19:13 +0800103put_clk:
104 if (!IS_ERR(cko1_sel))
105 clk_put(cko1_sel);
106 if (!IS_ERR(ahb))
107 clk_put(ahb);
108 if (!IS_ERR(cko1))
109 clk_put(cko1);
110}
111
Richard Zhao071dea52012-04-27 15:02:59 +0800112static void __init imx6q_sabrelite_init(void)
113{
Arnd Bergmann9f9ba0f2012-08-16 07:42:50 +0000114 if (IS_BUILTIN(CONFIG_PHYLIB))
Shawn Guoef441802012-05-08 21:39:33 +0800115 phy_register_fixup_for_uid(PHY_ID_KSZ9021, MICREL_PHY_ID_MASK,
Richard Zhao071dea52012-04-27 15:02:59 +0800116 ksz9021rn_phy_fixup);
Richard Zhaoa2585612012-04-24 14:19:13 +0800117 imx6q_sabrelite_cko1_setup();
Richard Zhao071dea52012-04-27 15:02:59 +0800118}
119
Richard Zhao396bf1c2012-07-12 10:25:24 +0800120static void __init imx6q_usb_init(void)
121{
Dong Aishengbaa64152012-09-05 10:57:15 +0800122 struct regmap *anatop;
Richard Zhao396bf1c2012-07-12 10:25:24 +0800123
124#define HW_ANADIG_USB1_CHRG_DETECT 0x000001b0
125#define HW_ANADIG_USB2_CHRG_DETECT 0x00000210
126
127#define BM_ANADIG_USB_CHRG_DETECT_EN_B 0x00100000
128#define BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B 0x00080000
129
Dong Aishengbaa64152012-09-05 10:57:15 +0800130 anatop = syscon_regmap_lookup_by_compatible("fsl,imx6q-anatop");
131 if (!IS_ERR(anatop)) {
132 /*
133 * The external charger detector needs to be disabled,
134 * or the signal at DP will be poor
135 */
136 regmap_write(anatop, HW_ANADIG_USB1_CHRG_DETECT,
137 BM_ANADIG_USB_CHRG_DETECT_EN_B
138 | BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B);
139 regmap_write(anatop, HW_ANADIG_USB2_CHRG_DETECT,
140 BM_ANADIG_USB_CHRG_DETECT_EN_B |
141 BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B);
142 } else {
143 pr_warn("failed to find fsl,imx6q-anatop regmap\n");
144 }
Richard Zhao396bf1c2012-07-12 10:25:24 +0800145}
146
Shawn Guo13eed982011-09-06 15:05:25 +0800147static void __init imx6q_init_machine(void)
148{
Richard Zhao477fce42011-12-14 09:26:47 +0800149 if (of_machine_is_compatible("fsl,imx6q-sabrelite"))
Richard Zhao071dea52012-04-27 15:02:59 +0800150 imx6q_sabrelite_init();
Richard Zhao477fce42011-12-14 09:26:47 +0800151
Shawn Guo13eed982011-09-06 15:05:25 +0800152 of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL);
153
154 imx6q_pm_init();
Richard Zhao396bf1c2012-07-12 10:25:24 +0800155 imx6q_usb_init();
Shawn Guo13eed982011-09-06 15:05:25 +0800156}
157
Robert Leeb9d18dc2012-05-21 17:50:30 -0500158static struct cpuidle_driver imx6q_cpuidle_driver = {
159 .name = "imx6q_cpuidle",
160 .owner = THIS_MODULE,
161 .en_core_tk_irqen = 1,
162 .states[0] = ARM_CPUIDLE_WFI_STATE,
163 .state_count = 1,
164};
165
166static void __init imx6q_init_late(void)
167{
168 imx_cpuidle_init(&imx6q_cpuidle_driver);
169}
170
Shawn Guo13eed982011-09-06 15:05:25 +0800171static void __init imx6q_map_io(void)
172{
173 imx_lluart_map_io();
174 imx_scu_map_io();
Richard Zhaof4750582011-11-17 18:54:29 +0800175 imx6q_clock_map_io();
Shawn Guo13eed982011-09-06 15:05:25 +0800176}
177
Shawn Guo13eed982011-09-06 15:05:25 +0800178static const struct of_device_id imx6q_irq_match[] __initconst = {
179 { .compatible = "arm,cortex-a9-gic", .data = gic_of_init, },
Shawn Guo13eed982011-09-06 15:05:25 +0800180 { /* sentinel */ }
181};
182
183static void __init imx6q_init_irq(void)
184{
185 l2x0_of_init(0, ~0UL);
186 imx_src_init();
187 imx_gpc_init();
188 of_irq_init(imx6q_irq_match);
189}
190
191static void __init imx6q_timer_init(void)
192{
193 mx6q_clocks_init();
Marc Zyngier58458e02012-01-10 19:44:19 +0000194 twd_local_timer_of_register();
Shawn Guo13eed982011-09-06 15:05:25 +0800195}
196
197static struct sys_timer imx6q_timer = {
198 .init = imx6q_timer_init,
199};
200
201static const char *imx6q_dt_compat[] __initdata = {
Sascha Hauer3f8976d2012-02-17 12:07:00 +0100202 "fsl,imx6q",
Shawn Guo13eed982011-09-06 15:05:25 +0800203 NULL,
204};
205
206DT_MACHINE_START(IMX6Q, "Freescale i.MX6 Quad (Device Tree)")
Marc Zyngiere4f2d972011-09-08 13:15:22 +0100207 .smp = smp_ops(imx_smp_ops),
Shawn Guo13eed982011-09-06 15:05:25 +0800208 .map_io = imx6q_map_io,
209 .init_irq = imx6q_init_irq,
210 .handle_irq = imx6q_handle_irq,
211 .timer = &imx6q_timer,
212 .init_machine = imx6q_init_machine,
Robert Leeb9d18dc2012-05-21 17:50:30 -0500213 .init_late = imx6q_init_late,
Shawn Guo13eed982011-09-06 15:05:25 +0800214 .dt_compat = imx6q_dt_compat,
Shawn Guo0575fb72011-12-09 00:51:26 +0100215 .restart = imx6q_restart,
Shawn Guo13eed982011-09-06 15:05:25 +0800216MACHINE_END