Lynx framebuffers multidomain implementation.
[linux/elbrus.git] / arch / arm / mach-mxs / mach-mxs.c
blob1dc5acd4fc99bb7f0001217214d53199dd89174d
1 /*
2 * Copyright 2012 Freescale Semiconductor, Inc.
3 * Copyright 2012 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/clk/mxs.h>
15 #include <linux/clkdev.h>
16 #include <linux/delay.h>
17 #include <linux/err.h>
18 #include <linux/gpio.h>
19 #include <linux/init.h>
20 #include <linux/irqchip/mxs.h>
21 #include <linux/reboot.h>
22 #include <linux/micrel_phy.h>
23 #include <linux/of_address.h>
24 #include <linux/of_platform.h>
25 #include <linux/phy.h>
26 #include <linux/pinctrl/consumer.h>
27 #include <linux/sys_soc.h>
28 #include <asm/mach/arch.h>
29 #include <asm/mach/map.h>
30 #include <asm/mach/time.h>
31 #include <asm/system_misc.h>
33 #include "pm.h"
35 /* MXS DIGCTL SAIF CLKMUX */
36 #define MXS_DIGCTL_SAIF_CLKMUX_DIRECT 0x0
37 #define MXS_DIGCTL_SAIF_CLKMUX_CROSSINPUT 0x1
38 #define MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0 0x2
39 #define MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR1 0x3
41 #define HW_DIGCTL_CHIPID 0x310
42 #define HW_DIGCTL_CHIPID_MASK (0xffff << 16)
43 #define HW_DIGCTL_REV_MASK 0xff
44 #define HW_DIGCTL_CHIPID_MX23 (0x3780 << 16)
45 #define HW_DIGCTL_CHIPID_MX28 (0x2800 << 16)
47 #define MXS_CHIP_REVISION_1_0 0x10
48 #define MXS_CHIP_REVISION_1_1 0x11
49 #define MXS_CHIP_REVISION_1_2 0x12
50 #define MXS_CHIP_REVISION_1_3 0x13
51 #define MXS_CHIP_REVISION_1_4 0x14
52 #define MXS_CHIP_REV_UNKNOWN 0xff
54 #define MXS_GPIO_NR(bank, nr) ((bank) * 32 + (nr))
56 #define MXS_SET_ADDR 0x4
57 #define MXS_CLR_ADDR 0x8
58 #define MXS_TOG_ADDR 0xc
60 static u32 chipid;
61 static u32 socid;
63 static void __iomem *reset_addr;
65 static inline void __mxs_setl(u32 mask, void __iomem *reg)
67 __raw_writel(mask, reg + MXS_SET_ADDR);
70 static inline void __mxs_clrl(u32 mask, void __iomem *reg)
72 __raw_writel(mask, reg + MXS_CLR_ADDR);
75 static inline void __mxs_togl(u32 mask, void __iomem *reg)
77 __raw_writel(mask, reg + MXS_TOG_ADDR);
80 #define OCOTP_WORD_OFFSET 0x20
81 #define OCOTP_WORD_COUNT 0x20
83 #define BM_OCOTP_CTRL_BUSY (1 << 8)
84 #define BM_OCOTP_CTRL_ERROR (1 << 9)
85 #define BM_OCOTP_CTRL_RD_BANK_OPEN (1 << 12)
87 static DEFINE_MUTEX(ocotp_mutex);
88 static u32 ocotp_words[OCOTP_WORD_COUNT];
90 static const u32 *mxs_get_ocotp(void)
92 struct device_node *np;
93 void __iomem *ocotp_base;
94 int timeout = 0x400;
95 size_t i;
96 static int once;
98 if (once)
99 return ocotp_words;
101 np = of_find_compatible_node(NULL, NULL, "fsl,ocotp");
102 ocotp_base = of_iomap(np, 0);
103 WARN_ON(!ocotp_base);
105 mutex_lock(&ocotp_mutex);
108 * clk_enable(hbus_clk) for ocotp can be skipped
109 * as it must be on when system is running.
112 /* try to clear ERROR bit */
113 __mxs_clrl(BM_OCOTP_CTRL_ERROR, ocotp_base);
115 /* check both BUSY and ERROR cleared */
116 while ((__raw_readl(ocotp_base) &
117 (BM_OCOTP_CTRL_BUSY | BM_OCOTP_CTRL_ERROR)) && --timeout)
118 cpu_relax();
120 if (unlikely(!timeout))
121 goto error_unlock;
123 /* open OCOTP banks for read */
124 __mxs_setl(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base);
126 /* approximately wait 32 hclk cycles */
127 udelay(1);
129 /* poll BUSY bit becoming cleared */
130 timeout = 0x400;
131 while ((__raw_readl(ocotp_base) & BM_OCOTP_CTRL_BUSY) && --timeout)
132 cpu_relax();
134 if (unlikely(!timeout))
135 goto error_unlock;
137 for (i = 0; i < OCOTP_WORD_COUNT; i++)
138 ocotp_words[i] = __raw_readl(ocotp_base + OCOTP_WORD_OFFSET +
139 i * 0x10);
141 /* close banks for power saving */
142 __mxs_clrl(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base);
144 once = 1;
146 mutex_unlock(&ocotp_mutex);
148 return ocotp_words;
150 error_unlock:
151 mutex_unlock(&ocotp_mutex);
152 pr_err("%s: timeout in reading OCOTP\n", __func__);
153 return NULL;
156 enum mac_oui {
157 OUI_FSL,
158 OUI_DENX,
159 OUI_CRYSTALFONTZ,
162 static void __init update_fec_mac_prop(enum mac_oui oui)
164 struct device_node *np, *from = NULL;
165 struct property *newmac;
166 const u32 *ocotp = mxs_get_ocotp();
167 u8 *macaddr;
168 u32 val;
169 int i;
171 for (i = 0; i < 2; i++) {
172 np = of_find_compatible_node(from, NULL, "fsl,imx28-fec");
173 if (!np)
174 return;
176 from = np;
178 if (of_get_property(np, "local-mac-address", NULL))
179 continue;
181 newmac = kzalloc(sizeof(*newmac) + 6, GFP_KERNEL);
182 if (!newmac)
183 return;
184 newmac->value = newmac + 1;
185 newmac->length = 6;
187 newmac->name = kstrdup("local-mac-address", GFP_KERNEL);
188 if (!newmac->name) {
189 kfree(newmac);
190 return;
194 * OCOTP only stores the last 4 octets for each mac address,
195 * so hard-code OUI here.
197 macaddr = newmac->value;
198 switch (oui) {
199 case OUI_FSL:
200 macaddr[0] = 0x00;
201 macaddr[1] = 0x04;
202 macaddr[2] = 0x9f;
203 break;
204 case OUI_DENX:
205 macaddr[0] = 0xc0;
206 macaddr[1] = 0xe5;
207 macaddr[2] = 0x4e;
208 break;
209 case OUI_CRYSTALFONTZ:
210 macaddr[0] = 0x58;
211 macaddr[1] = 0xb9;
212 macaddr[2] = 0xe1;
213 break;
215 val = ocotp[i];
216 macaddr[3] = (val >> 16) & 0xff;
217 macaddr[4] = (val >> 8) & 0xff;
218 macaddr[5] = (val >> 0) & 0xff;
220 of_update_property(np, newmac);
224 static inline void enable_clk_enet_out(void)
226 struct clk *clk = clk_get_sys("enet_out", NULL);
228 if (!IS_ERR(clk))
229 clk_prepare_enable(clk);
232 static void __init imx28_evk_init(void)
234 update_fec_mac_prop(OUI_FSL);
236 mxs_saif_clkmux_select(MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0);
239 static int apx4devkit_phy_fixup(struct phy_device *phy)
241 phy->dev_flags |= MICREL_PHY_50MHZ_CLK;
242 return 0;
245 static void __init apx4devkit_init(void)
247 enable_clk_enet_out();
249 if (IS_BUILTIN(CONFIG_PHYLIB))
250 phy_register_fixup_for_uid(PHY_ID_KSZ8051, MICREL_PHY_ID_MASK,
251 apx4devkit_phy_fixup);
254 #define ENET0_MDC__GPIO_4_0 MXS_GPIO_NR(4, 0)
255 #define ENET0_MDIO__GPIO_4_1 MXS_GPIO_NR(4, 1)
256 #define ENET0_RX_EN__GPIO_4_2 MXS_GPIO_NR(4, 2)
257 #define ENET0_RXD0__GPIO_4_3 MXS_GPIO_NR(4, 3)
258 #define ENET0_RXD1__GPIO_4_4 MXS_GPIO_NR(4, 4)
259 #define ENET0_TX_EN__GPIO_4_6 MXS_GPIO_NR(4, 6)
260 #define ENET0_TXD0__GPIO_4_7 MXS_GPIO_NR(4, 7)
261 #define ENET0_TXD1__GPIO_4_8 MXS_GPIO_NR(4, 8)
262 #define ENET_CLK__GPIO_4_16 MXS_GPIO_NR(4, 16)
264 #define TX28_FEC_PHY_POWER MXS_GPIO_NR(3, 29)
265 #define TX28_FEC_PHY_RESET MXS_GPIO_NR(4, 13)
266 #define TX28_FEC_nINT MXS_GPIO_NR(4, 5)
268 static const struct gpio tx28_gpios[] __initconst = {
269 { ENET0_MDC__GPIO_4_0, GPIOF_OUT_INIT_LOW, "GPIO_4_0" },
270 { ENET0_MDIO__GPIO_4_1, GPIOF_OUT_INIT_LOW, "GPIO_4_1" },
271 { ENET0_RX_EN__GPIO_4_2, GPIOF_OUT_INIT_LOW, "GPIO_4_2" },
272 { ENET0_RXD0__GPIO_4_3, GPIOF_OUT_INIT_LOW, "GPIO_4_3" },
273 { ENET0_RXD1__GPIO_4_4, GPIOF_OUT_INIT_LOW, "GPIO_4_4" },
274 { ENET0_TX_EN__GPIO_4_6, GPIOF_OUT_INIT_LOW, "GPIO_4_6" },
275 { ENET0_TXD0__GPIO_4_7, GPIOF_OUT_INIT_LOW, "GPIO_4_7" },
276 { ENET0_TXD1__GPIO_4_8, GPIOF_OUT_INIT_LOW, "GPIO_4_8" },
277 { ENET_CLK__GPIO_4_16, GPIOF_OUT_INIT_LOW, "GPIO_4_16" },
278 { TX28_FEC_PHY_POWER, GPIOF_OUT_INIT_LOW, "fec-phy-power" },
279 { TX28_FEC_PHY_RESET, GPIOF_OUT_INIT_LOW, "fec-phy-reset" },
280 { TX28_FEC_nINT, GPIOF_DIR_IN, "fec-int" },
283 static void __init tx28_post_init(void)
285 struct device_node *np;
286 struct platform_device *pdev;
287 struct pinctrl *pctl;
288 int ret;
290 enable_clk_enet_out();
292 np = of_find_compatible_node(NULL, NULL, "fsl,imx28-fec");
293 pdev = of_find_device_by_node(np);
294 if (!pdev) {
295 pr_err("%s: failed to find fec device\n", __func__);
296 return;
299 pctl = pinctrl_get_select(&pdev->dev, "gpio_mode");
300 if (IS_ERR(pctl)) {
301 pr_err("%s: failed to get pinctrl state\n", __func__);
302 return;
305 ret = gpio_request_array(tx28_gpios, ARRAY_SIZE(tx28_gpios));
306 if (ret) {
307 pr_err("%s: failed to request gpios: %d\n", __func__, ret);
308 return;
311 /* Power up fec phy */
312 gpio_set_value(TX28_FEC_PHY_POWER, 1);
313 msleep(26); /* 25ms according to data sheet */
315 /* Mode strap pins */
316 gpio_set_value(ENET0_RX_EN__GPIO_4_2, 1);
317 gpio_set_value(ENET0_RXD0__GPIO_4_3, 1);
318 gpio_set_value(ENET0_RXD1__GPIO_4_4, 1);
320 udelay(100); /* minimum assertion time for nRST */
322 /* Deasserting FEC PHY RESET */
323 gpio_set_value(TX28_FEC_PHY_RESET, 1);
325 pinctrl_put(pctl);
328 static void __init crystalfontz_init(void)
330 update_fec_mac_prop(OUI_CRYSTALFONTZ);
333 static void __init m28cu3_init(void)
335 update_fec_mac_prop(OUI_DENX);
338 static const char __init *mxs_get_soc_id(void)
340 struct device_node *np;
341 void __iomem *digctl_base;
343 np = of_find_compatible_node(NULL, NULL, "fsl,imx23-digctl");
344 digctl_base = of_iomap(np, 0);
345 WARN_ON(!digctl_base);
347 chipid = readl(digctl_base + HW_DIGCTL_CHIPID);
348 socid = chipid & HW_DIGCTL_CHIPID_MASK;
350 iounmap(digctl_base);
351 of_node_put(np);
353 switch (socid) {
354 case HW_DIGCTL_CHIPID_MX23:
355 return "i.MX23";
356 case HW_DIGCTL_CHIPID_MX28:
357 return "i.MX28";
358 default:
359 return "Unknown";
363 static u32 __init mxs_get_cpu_rev(void)
365 u32 rev = chipid & HW_DIGCTL_REV_MASK;
367 switch (socid) {
368 case HW_DIGCTL_CHIPID_MX23:
369 switch (rev) {
370 case 0x0:
371 return MXS_CHIP_REVISION_1_0;
372 case 0x1:
373 return MXS_CHIP_REVISION_1_1;
374 case 0x2:
375 return MXS_CHIP_REVISION_1_2;
376 case 0x3:
377 return MXS_CHIP_REVISION_1_3;
378 case 0x4:
379 return MXS_CHIP_REVISION_1_4;
380 default:
381 return MXS_CHIP_REV_UNKNOWN;
383 case HW_DIGCTL_CHIPID_MX28:
384 switch (rev) {
385 case 0x0:
386 return MXS_CHIP_REVISION_1_1;
387 case 0x1:
388 return MXS_CHIP_REVISION_1_2;
389 default:
390 return MXS_CHIP_REV_UNKNOWN;
392 default:
393 return MXS_CHIP_REV_UNKNOWN;
397 static const char __init *mxs_get_revision(void)
399 u32 rev = mxs_get_cpu_rev();
401 if (rev != MXS_CHIP_REV_UNKNOWN)
402 return kasprintf(GFP_KERNEL, "%d.%d", (rev >> 4) & 0xf,
403 rev & 0xf);
404 else
405 return kasprintf(GFP_KERNEL, "%s", "Unknown");
408 #define MX23_CLKCTRL_RESET_OFFSET 0x120
409 #define MX28_CLKCTRL_RESET_OFFSET 0x1e0
411 static int __init mxs_restart_init(void)
413 struct device_node *np;
415 np = of_find_compatible_node(NULL, NULL, "fsl,clkctrl");
416 reset_addr = of_iomap(np, 0);
417 if (!reset_addr)
418 return -ENODEV;
420 if (of_device_is_compatible(np, "fsl,imx23-clkctrl"))
421 reset_addr += MX23_CLKCTRL_RESET_OFFSET;
422 else
423 reset_addr += MX28_CLKCTRL_RESET_OFFSET;
424 of_node_put(np);
426 return 0;
429 static void __init mxs_machine_init(void)
431 struct device_node *root;
432 struct device *parent;
433 struct soc_device *soc_dev;
434 struct soc_device_attribute *soc_dev_attr;
435 int ret;
437 soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
438 if (!soc_dev_attr)
439 return;
441 root = of_find_node_by_path("/");
442 ret = of_property_read_string(root, "model", &soc_dev_attr->machine);
443 if (ret)
444 return;
446 soc_dev_attr->family = "Freescale MXS Family";
447 soc_dev_attr->soc_id = mxs_get_soc_id();
448 soc_dev_attr->revision = mxs_get_revision();
450 soc_dev = soc_device_register(soc_dev_attr);
451 if (IS_ERR(soc_dev)) {
452 kfree(soc_dev_attr->revision);
453 kfree(soc_dev_attr);
454 return;
457 parent = soc_device_to_device(soc_dev);
459 if (of_machine_is_compatible("fsl,imx28-evk"))
460 imx28_evk_init();
461 else if (of_machine_is_compatible("bluegiga,apx4devkit"))
462 apx4devkit_init();
463 else if (of_machine_is_compatible("crystalfontz,cfa10036"))
464 crystalfontz_init();
465 else if (of_machine_is_compatible("msr,m28cu3"))
466 m28cu3_init();
468 of_platform_populate(NULL, of_default_bus_match_table,
469 NULL, parent);
471 mxs_restart_init();
473 if (of_machine_is_compatible("karo,tx28"))
474 tx28_post_init();
477 #define MXS_CLKCTRL_RESET_CHIP (1 << 1)
480 * Reset the system. It is called by machine_restart().
482 static void mxs_restart(enum reboot_mode mode, const char *cmd)
484 if (reset_addr) {
485 /* reset the chip */
486 __mxs_setl(MXS_CLKCTRL_RESET_CHIP, reset_addr);
488 pr_err("Failed to assert the chip reset\n");
490 /* Delay to allow the serial port to show the message */
491 mdelay(50);
494 /* We'll take a jump through zero as a poor second */
495 soft_restart(0);
498 static const char *mxs_dt_compat[] __initdata = {
499 "fsl,imx28",
500 "fsl,imx23",
501 NULL,
504 DT_MACHINE_START(MXS, "Freescale MXS (Device Tree)")
505 .handle_irq = icoll_handle_irq,
506 .init_machine = mxs_machine_init,
507 .init_late = mxs_pm_init,
508 .dt_compat = mxs_dt_compat,
509 .restart = mxs_restart,
510 MACHINE_END