1 /*
2 * FSL SoC setup code
3 *
4 * Maintained by Kumar Gala (see MAINTAINERS for contact information)
5 *
6 * 2006 (c) MontaVista Software, Inc.
7 * Vitaly Bordug <vbordug@ru.mvista.com>
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
13 */
14
15 #include <linux/stddef.h>
16 #include <linux/kernel.h>
17 #include <linux/init.h>
18 #include <linux/errno.h>
19 #include <linux/major.h>
20 #include <linux/delay.h>
21 #include <linux/irq.h>
22 #include <linux/module.h>
23 #include <linux/device.h>
24 #include <linux/platform_device.h>
25 #include <linux/of_platform.h>
26 #include <linux/phy.h>
27 #include <linux/phy_fixed.h>
28 #include <linux/spi/spi.h>
29 #include <linux/fsl_devices.h>
30 #include <linux/fs_enet_pd.h>
31 #include <linux/fs_uart_pd.h>
32
33 #include <asm/system.h>
34 #include <asm/atomic.h>
35 #include <asm/io.h>
36 #include <asm/irq.h>
37 #include <asm/time.h>
38 #include <asm/prom.h>
39 #include <sysdev/fsl_soc.h>
40 #include <mm/mmu_decl.h>
41 #include <asm/cpm2.h>
42
43 extern void init_fcc_ioports(struct fs_platform_info*);
44 extern void init_fec_ioports(struct fs_platform_info*);
45 extern void init_smc_ioports(struct fs_uart_platform_info*);
46 static phys_addr_t immrbase = -1;
47
get_immrbase(void)48 phys_addr_t get_immrbase(void)
49 {
50 struct device_node *soc;
51
52 if (immrbase != -1)
53 return immrbase;
54
55 soc = of_find_node_by_type(NULL, "soc");
56 if (soc) {
57 int size;
58 u32 naddr;
59 const u32 *prop = of_get_property(soc, "#address-cells", &size);
60
61 if (prop && size == 4)
62 naddr = *prop;
63 else
64 naddr = 2;
65
66 prop = of_get_property(soc, "ranges", &size);
67 if (prop)
68 immrbase = of_translate_address(soc, prop + naddr);
69
70 of_node_put(soc);
71 }
72
73 return immrbase;
74 }
75
76 EXPORT_SYMBOL(get_immrbase);
77
78 static u32 sysfreq = -1;
79
fsl_get_sys_freq(void)80 u32 fsl_get_sys_freq(void)
81 {
82 struct device_node *soc;
83 const u32 *prop;
84 int size;
85
86 if (sysfreq != -1)
87 return sysfreq;
88
89 soc = of_find_node_by_type(NULL, "soc");
90 if (!soc)
91 return -1;
92
93 prop = of_get_property(soc, "clock-frequency", &size);
94 if (!prop || size != sizeof(*prop) || *prop == 0)
95 prop = of_get_property(soc, "bus-frequency", &size);
96
97 if (prop && size == sizeof(*prop))
98 sysfreq = *prop;
99
100 of_node_put(soc);
101 return sysfreq;
102 }
103 EXPORT_SYMBOL(fsl_get_sys_freq);
104
105 #if defined(CONFIG_CPM2) || defined(CONFIG_QUICC_ENGINE) || defined(CONFIG_8xx)
106
107 static u32 brgfreq = -1;
108
get_brgfreq(void)109 u32 get_brgfreq(void)
110 {
111 struct device_node *node;
112 const unsigned int *prop;
113 int size;
114
115 if (brgfreq != -1)
116 return brgfreq;
117
118 node = of_find_compatible_node(NULL, NULL, "fsl,cpm-brg");
119 if (node) {
120 prop = of_get_property(node, "clock-frequency", &size);
121 if (prop && size == 4)
122 brgfreq = *prop;
123
124 of_node_put(node);
125 return brgfreq;
126 }
127
128 /* Legacy device binding -- will go away when no users are left. */
129 node = of_find_node_by_type(NULL, "cpm");
130 if (!node)
131 node = of_find_compatible_node(NULL, NULL, "fsl,qe");
132 if (!node)
133 node = of_find_node_by_type(NULL, "qe");
134
135 if (node) {
136 prop = of_get_property(node, "brg-frequency", &size);
137 if (prop && size == 4)
138 brgfreq = *prop;
139
140 if (brgfreq == -1 || brgfreq == 0) {
141 prop = of_get_property(node, "bus-frequency", &size);
142 if (prop && size == 4)
143 brgfreq = *prop / 2;
144 }
145 of_node_put(node);
146 }
147
148 return brgfreq;
149 }
150
151 EXPORT_SYMBOL(get_brgfreq);
152
153 static u32 fs_baudrate = -1;
154
get_baudrate(void)155 u32 get_baudrate(void)
156 {
157 struct device_node *node;
158
159 if (fs_baudrate != -1)
160 return fs_baudrate;
161
162 node = of_find_node_by_type(NULL, "serial");
163 if (node) {
164 int size;
165 const unsigned int *prop = of_get_property(node,
166 "current-speed", &size);
167
168 if (prop)
169 fs_baudrate = *prop;
170 of_node_put(node);
171 }
172
173 return fs_baudrate;
174 }
175
176 EXPORT_SYMBOL(get_baudrate);
177 #endif /* CONFIG_CPM2 */
178
179 #ifdef CONFIG_FIXED_PHY
of_add_fixed_phys(void)180 static int __init of_add_fixed_phys(void)
181 {
182 int ret;
183 struct device_node *np;
184 u32 *fixed_link;
185 struct fixed_phy_status status = {};
186
187 for_each_node_by_name(np, "ethernet") {
188 fixed_link = (u32 *)of_get_property(np, "fixed-link", NULL);
189 if (!fixed_link)
190 continue;
191
192 status.link = 1;
193 status.duplex = fixed_link[1];
194 status.speed = fixed_link[2];
195 status.pause = fixed_link[3];
196 status.asym_pause = fixed_link[4];
197
198 ret = fixed_phy_add(PHY_POLL, fixed_link[0], &status);
199 if (ret) {
200 of_node_put(np);
201 return ret;
202 }
203 }
204
205 return 0;
206 }
207 arch_initcall(of_add_fixed_phys);
208 #endif /* CONFIG_FIXED_PHY */
209
210 #ifdef CONFIG_PPC_83xx
mpc83xx_wdt_init(void)211 static int __init mpc83xx_wdt_init(void)
212 {
213 struct resource r;
214 struct device_node *np;
215 struct platform_device *dev;
216 u32 freq = fsl_get_sys_freq();
217 int ret;
218
219 np = of_find_compatible_node(NULL, "watchdog", "mpc83xx_wdt");
220
221 if (!np) {
222 ret = -ENODEV;
223 goto nodev;
224 }
225
226 memset(&r, 0, sizeof(r));
227
228 ret = of_address_to_resource(np, 0, &r);
229 if (ret)
230 goto err;
231
232 dev = platform_device_register_simple("mpc83xx_wdt", 0, &r, 1);
233 if (IS_ERR(dev)) {
234 ret = PTR_ERR(dev);
235 goto err;
236 }
237
238 ret = platform_device_add_data(dev, &freq, sizeof(freq));
239 if (ret)
240 goto unreg;
241
242 of_node_put(np);
243 return 0;
244
245 unreg:
246 platform_device_unregister(dev);
247 err:
248 of_node_put(np);
249 nodev:
250 return ret;
251 }
252
253 arch_initcall(mpc83xx_wdt_init);
254 #endif
255
determine_usb_phy(const char * phy_type)256 static enum fsl_usb2_phy_modes determine_usb_phy(const char *phy_type)
257 {
258 if (!phy_type)
259 return FSL_USB2_PHY_NONE;
260 if (!strcasecmp(phy_type, "ulpi"))
261 return FSL_USB2_PHY_ULPI;
262 if (!strcasecmp(phy_type, "utmi"))
263 return FSL_USB2_PHY_UTMI;
264 if (!strcasecmp(phy_type, "utmi_wide"))
265 return FSL_USB2_PHY_UTMI_WIDE;
266 if (!strcasecmp(phy_type, "serial"))
267 return FSL_USB2_PHY_SERIAL;
268
269 return FSL_USB2_PHY_NONE;
270 }
271
fsl_usb_of_init(void)272 static int __init fsl_usb_of_init(void)
273 {
274 struct device_node *np;
275 unsigned int i = 0;
276 struct platform_device *usb_dev_mph = NULL, *usb_dev_dr_host = NULL,
277 *usb_dev_dr_client = NULL;
278 int ret;
279
280 for_each_compatible_node(np, NULL, "fsl-usb2-mph") {
281 struct resource r[2];
282 struct fsl_usb2_platform_data usb_data;
283 const unsigned char *prop = NULL;
284
285 memset(&r, 0, sizeof(r));
286 memset(&usb_data, 0, sizeof(usb_data));
287
288 ret = of_address_to_resource(np, 0, &r[0]);
289 if (ret)
290 goto err;
291
292 of_irq_to_resource(np, 0, &r[1]);
293
294 usb_dev_mph =
295 platform_device_register_simple("fsl-ehci", i, r, 2);
296 if (IS_ERR(usb_dev_mph)) {
297 ret = PTR_ERR(usb_dev_mph);
298 goto err;
299 }
300
301 usb_dev_mph->dev.coherent_dma_mask = 0xffffffffUL;
302 usb_dev_mph->dev.dma_mask = &usb_dev_mph->dev.coherent_dma_mask;
303
304 usb_data.operating_mode = FSL_USB2_MPH_HOST;
305
306 prop = of_get_property(np, "port0", NULL);
307 if (prop)
308 usb_data.port_enables |= FSL_USB2_PORT0_ENABLED;
309
310 prop = of_get_property(np, "port1", NULL);
311 if (prop)
312 usb_data.port_enables |= FSL_USB2_PORT1_ENABLED;
313
314 prop = of_get_property(np, "phy_type", NULL);
315 usb_data.phy_mode = determine_usb_phy(prop);
316
317 ret =
318 platform_device_add_data(usb_dev_mph, &usb_data,
319 sizeof(struct
320 fsl_usb2_platform_data));
321 if (ret)
322 goto unreg_mph;
323 i++;
324 }
325
326 for_each_compatible_node(np, NULL, "fsl-usb2-dr") {
327 struct resource r[2];
328 struct fsl_usb2_platform_data usb_data;
329 const unsigned char *prop = NULL;
330
331 memset(&r, 0, sizeof(r));
332 memset(&usb_data, 0, sizeof(usb_data));
333
334 ret = of_address_to_resource(np, 0, &r[0]);
335 if (ret)
336 goto unreg_mph;
337
338 of_irq_to_resource(np, 0, &r[1]);
339
340 prop = of_get_property(np, "dr_mode", NULL);
341
342 if (!prop || !strcmp(prop, "host")) {
343 usb_data.operating_mode = FSL_USB2_DR_HOST;
344 usb_dev_dr_host = platform_device_register_simple(
345 "fsl-ehci", i, r, 2);
346 if (IS_ERR(usb_dev_dr_host)) {
347 ret = PTR_ERR(usb_dev_dr_host);
348 goto err;
349 }
350 } else if (prop && !strcmp(prop, "peripheral")) {
351 usb_data.operating_mode = FSL_USB2_DR_DEVICE;
352 usb_dev_dr_client = platform_device_register_simple(
353 "fsl-usb2-udc", i, r, 2);
354 if (IS_ERR(usb_dev_dr_client)) {
355 ret = PTR_ERR(usb_dev_dr_client);
356 goto err;
357 }
358 } else if (prop && !strcmp(prop, "otg")) {
359 usb_data.operating_mode = FSL_USB2_DR_OTG;
360 usb_dev_dr_host = platform_device_register_simple(
361 "fsl-ehci", i, r, 2);
362 if (IS_ERR(usb_dev_dr_host)) {
363 ret = PTR_ERR(usb_dev_dr_host);
364 goto err;
365 }
366 usb_dev_dr_client = platform_device_register_simple(
367 "fsl-usb2-udc", i, r, 2);
368 if (IS_ERR(usb_dev_dr_client)) {
369 ret = PTR_ERR(usb_dev_dr_client);
370 goto err;
371 }
372 } else {
373 ret = -EINVAL;
374 goto err;
375 }
376
377 prop = of_get_property(np, "phy_type", NULL);
378 usb_data.phy_mode = determine_usb_phy(prop);
379
380 if (usb_dev_dr_host) {
381 usb_dev_dr_host->dev.coherent_dma_mask = 0xffffffffUL;
382 usb_dev_dr_host->dev.dma_mask = &usb_dev_dr_host->
383 dev.coherent_dma_mask;
384 if ((ret = platform_device_add_data(usb_dev_dr_host,
385 &usb_data, sizeof(struct
386 fsl_usb2_platform_data))))
387 goto unreg_dr;
388 }
389 if (usb_dev_dr_client) {
390 usb_dev_dr_client->dev.coherent_dma_mask = 0xffffffffUL;
391 usb_dev_dr_client->dev.dma_mask = &usb_dev_dr_client->
392 dev.coherent_dma_mask;
393 if ((ret = platform_device_add_data(usb_dev_dr_client,
394 &usb_data, sizeof(struct
395 fsl_usb2_platform_data))))
396 goto unreg_dr;
397 }
398 i++;
399 }
400 return 0;
401
402 unreg_dr:
403 if (usb_dev_dr_host)
404 platform_device_unregister(usb_dev_dr_host);
405 if (usb_dev_dr_client)
406 platform_device_unregister(usb_dev_dr_client);
407 unreg_mph:
408 if (usb_dev_mph)
409 platform_device_unregister(usb_dev_mph);
410 err:
411 return ret;
412 }
413
414 arch_initcall(fsl_usb_of_init);
415
of_fsl_spi_probe(char * type,char * compatible,u32 sysclk,struct spi_board_info * board_infos,unsigned int num_board_infos,void (* activate_cs)(u8 cs,u8 polarity),void (* deactivate_cs)(u8 cs,u8 polarity))416 static int __init of_fsl_spi_probe(char *type, char *compatible, u32 sysclk,
417 struct spi_board_info *board_infos,
418 unsigned int num_board_infos,
419 void (*activate_cs)(u8 cs, u8 polarity),
420 void (*deactivate_cs)(u8 cs, u8 polarity))
421 {
422 struct device_node *np;
423 unsigned int i = 0;
424
425 for_each_compatible_node(np, type, compatible) {
426 int ret;
427 unsigned int j;
428 const void *prop;
429 struct resource res[2];
430 struct platform_device *pdev;
431 struct fsl_spi_platform_data pdata = {
432 .activate_cs = activate_cs,
433 .deactivate_cs = deactivate_cs,
434 };
435
436 memset(res, 0, sizeof(res));
437
438 pdata.sysclk = sysclk;
439
440 prop = of_get_property(np, "reg", NULL);
441 if (!prop)
442 goto err;
443 pdata.bus_num = *(u32 *)prop;
444
445 prop = of_get_property(np, "cell-index", NULL);
446 if (prop)
447 i = *(u32 *)prop;
448
449 prop = of_get_property(np, "mode", NULL);
450 if (prop && !strcmp(prop, "cpu-qe"))
451 pdata.qe_mode = 1;
452
453 for (j = 0; j < num_board_infos; j++) {
454 if (board_infos[j].bus_num == pdata.bus_num)
455 pdata.max_chipselect++;
456 }
457
458 if (!pdata.max_chipselect)
459 continue;
460
461 ret = of_address_to_resource(np, 0, &res[0]);
462 if (ret)
463 goto err;
464
465 ret = of_irq_to_resource(np, 0, &res[1]);
466 if (ret == NO_IRQ)
467 goto err;
468
469 pdev = platform_device_alloc("mpc83xx_spi", i);
470 if (!pdev)
471 goto err;
472
473 ret = platform_device_add_data(pdev, &pdata, sizeof(pdata));
474 if (ret)
475 goto unreg;
476
477 ret = platform_device_add_resources(pdev, res,
478 ARRAY_SIZE(res));
479 if (ret)
480 goto unreg;
481
482 ret = platform_device_add(pdev);
483 if (ret)
484 goto unreg;
485
486 goto next;
487 unreg:
488 platform_device_del(pdev);
489 err:
490 pr_err("%s: registration failed\n", np->full_name);
491 next:
492 i++;
493 }
494
495 return i;
496 }
497
fsl_spi_init(struct spi_board_info * board_infos,unsigned int num_board_infos,void (* activate_cs)(u8 cs,u8 polarity),void (* deactivate_cs)(u8 cs,u8 polarity))498 int __init fsl_spi_init(struct spi_board_info *board_infos,
499 unsigned int num_board_infos,
500 void (*activate_cs)(u8 cs, u8 polarity),
501 void (*deactivate_cs)(u8 cs, u8 polarity))
502 {
503 u32 sysclk = -1;
504 int ret;
505
506 #ifdef CONFIG_QUICC_ENGINE
507 /* SPI controller is either clocked from QE or SoC clock */
508 sysclk = get_brgfreq();
509 #endif
510 if (sysclk == -1) {
511 sysclk = fsl_get_sys_freq();
512 if (sysclk == -1)
513 return -ENODEV;
514 }
515
516 ret = of_fsl_spi_probe(NULL, "fsl,spi", sysclk, board_infos,
517 num_board_infos, activate_cs, deactivate_cs);
518 if (!ret)
519 of_fsl_spi_probe("spi", "fsl_spi", sysclk, board_infos,
520 num_board_infos, activate_cs, deactivate_cs);
521
522 return spi_register_board_info(board_infos, num_board_infos);
523 }
524
525 #if defined(CONFIG_PPC_85xx) || defined(CONFIG_PPC_86xx)
526 static __be32 __iomem *rstcr;
527
setup_rstcr(void)528 static int __init setup_rstcr(void)
529 {
530 struct device_node *np;
531 np = of_find_node_by_name(NULL, "global-utilities");
532 if ((np && of_get_property(np, "fsl,has-rstcr", NULL))) {
533 const u32 *prop = of_get_property(np, "reg", NULL);
534 if (prop) {
535 /* map reset control register
536 * 0xE00B0 is offset of reset control register
537 */
538 rstcr = ioremap(get_immrbase() + *prop + 0xB0, 0xff);
539 if (!rstcr)
540 printk (KERN_EMERG "Error: reset control "
541 "register not mapped!\n");
542 }
543 } else
544 printk (KERN_INFO "rstcr compatible register does not exist!\n");
545 if (np)
546 of_node_put(np);
547 return 0;
548 }
549
550 arch_initcall(setup_rstcr);
551
fsl_rstcr_restart(char * cmd)552 void fsl_rstcr_restart(char *cmd)
553 {
554 local_irq_disable();
555 if (rstcr)
556 /* set reset control register */
557 out_be32(rstcr, 0x2); /* HRESET_REQ */
558
559 while (1) ;
560 }
561 #endif
562
563 #if defined(CONFIG_FB_FSL_DIU) || defined(CONFIG_FB_FSL_DIU_MODULE)
564 struct platform_diu_data_ops diu_ops;
565 EXPORT_SYMBOL(diu_ops);
566 #endif
567