blob: 566f2d7f2ea386b662dc9ceaaf82148c33b01ae9 [file] [log] [blame]
Florian Fainelli7ca5dc12009-06-24 11:12:57 +02001/*
2 * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
3 * Copyright (C) 2006,2007 Eugene Konev <ejka@openwrt.org>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
18 */
19
20#include <linux/init.h>
21#include <linux/types.h>
22#include <linux/module.h>
23#include <linux/delay.h>
24#include <linux/dma-mapping.h>
25#include <linux/platform_device.h>
26#include <linux/mtd/physmap.h>
27#include <linux/serial.h>
28#include <linux/serial_8250.h>
29#include <linux/ioport.h>
30#include <linux/io.h>
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020031#include <linux/vlynq.h>
32#include <linux/leds.h>
33#include <linux/string.h>
34#include <linux/etherdevice.h>
Florian Fainelli1e2c8d82009-08-04 10:52:47 +000035#include <linux/phy.h>
36#include <linux/phy_fixed.h>
Florian Fainelli5f3c9092010-01-03 21:16:51 +010037#include <linux/gpio.h>
Florian Fainelli780019d2010-01-27 09:10:06 +010038#include <linux/clk.h>
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020039
40#include <asm/addrspace.h>
41#include <asm/mach-ar7/ar7.h>
42#include <asm/mach-ar7/gpio.h>
43#include <asm/mach-ar7/prom.h>
44
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000045/*****************************************************************************
46 * VLYNQ Bus
47 ****************************************************************************/
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020048struct plat_vlynq_data {
49 struct plat_vlynq_ops ops;
50 int gpio_bit;
51 int reset_bit;
52};
53
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020054static int vlynq_on(struct vlynq_device *dev)
55{
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000056 int ret;
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020057 struct plat_vlynq_data *pdata = dev->dev.platform_data;
58
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000059 ret = gpio_request(pdata->gpio_bit, "vlynq");
60 if (ret)
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020061 goto out;
62
63 ar7_device_reset(pdata->reset_bit);
64
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000065 ret = ar7_gpio_disable(pdata->gpio_bit);
66 if (ret)
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020067 goto out_enabled;
68
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000069 ret = ar7_gpio_enable(pdata->gpio_bit);
70 if (ret)
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020071 goto out_enabled;
72
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000073 ret = gpio_direction_output(pdata->gpio_bit, 0);
74 if (ret)
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020075 goto out_gpio_enabled;
76
77 msleep(50);
78
79 gpio_set_value(pdata->gpio_bit, 1);
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000080
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020081 msleep(50);
82
83 return 0;
84
85out_gpio_enabled:
86 ar7_gpio_disable(pdata->gpio_bit);
87out_enabled:
88 ar7_device_disable(pdata->reset_bit);
89 gpio_free(pdata->gpio_bit);
90out:
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000091 return ret;
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020092}
93
94static void vlynq_off(struct vlynq_device *dev)
95{
96 struct plat_vlynq_data *pdata = dev->dev.platform_data;
Alexander Clouter4d1da8c2010-01-31 19:38:19 +000097
Florian Fainelli7ca5dc12009-06-24 11:12:57 +020098 ar7_gpio_disable(pdata->gpio_bit);
99 gpio_free(pdata->gpio_bit);
100 ar7_device_disable(pdata->reset_bit);
101}
102
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200103static struct resource vlynq_low_res[] = {
104 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000105 .name = "regs",
106 .flags = IORESOURCE_MEM,
107 .start = AR7_REGS_VLYNQ0,
108 .end = AR7_REGS_VLYNQ0 + 0xff,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200109 },
110 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000111 .name = "irq",
112 .flags = IORESOURCE_IRQ,
113 .start = 29,
114 .end = 29,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200115 },
116 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000117 .name = "mem",
118 .flags = IORESOURCE_MEM,
119 .start = 0x04000000,
120 .end = 0x04ffffff,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200121 },
122 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000123 .name = "devirq",
124 .flags = IORESOURCE_IRQ,
125 .start = 80,
126 .end = 111,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200127 },
128};
129
130static struct resource vlynq_high_res[] = {
131 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000132 .name = "regs",
133 .flags = IORESOURCE_MEM,
134 .start = AR7_REGS_VLYNQ1,
135 .end = AR7_REGS_VLYNQ1 + 0xff,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200136 },
137 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000138 .name = "irq",
139 .flags = IORESOURCE_IRQ,
140 .start = 33,
141 .end = 33,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200142 },
143 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000144 .name = "mem",
145 .flags = IORESOURCE_MEM,
146 .start = 0x0c000000,
147 .end = 0x0cffffff,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200148 },
149 {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000150 .name = "devirq",
151 .flags = IORESOURCE_IRQ,
152 .start = 112,
153 .end = 143,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200154 },
155};
156
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200157static struct plat_vlynq_data vlynq_low_data = {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000158 .ops = {
159 .on = vlynq_on,
160 .off = vlynq_off,
161 },
162 .reset_bit = 20,
163 .gpio_bit = 18,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200164};
165
166static struct plat_vlynq_data vlynq_high_data = {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000167 .ops = {
168 .on = vlynq_on,
169 .off = vlynq_off,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200170 },
Alexander Clouter1e3fb372010-03-12 19:39:48 +0000171 .reset_bit = 16,
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000172 .gpio_bit = 19,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200173};
174
175static struct platform_device vlynq_low = {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000176 .id = 0,
177 .name = "vlynq",
178 .dev = {
179 .platform_data = &vlynq_low_data,
180 },
181 .resource = vlynq_low_res,
182 .num_resources = ARRAY_SIZE(vlynq_low_res),
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200183};
184
185static struct platform_device vlynq_high = {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000186 .id = 1,
187 .name = "vlynq",
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200188 .dev = {
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000189 .platform_data = &vlynq_high_data,
190 },
191 .resource = vlynq_high_res,
192 .num_resources = ARRAY_SIZE(vlynq_high_res),
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200193};
194
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000195/*****************************************************************************
196 * Flash
197 ****************************************************************************/
198static struct resource physmap_flash_resource = {
199 .name = "mem",
200 .flags = IORESOURCE_MEM,
201 .start = 0x10000000,
202 .end = 0x107fffff,
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200203};
204
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000205static struct physmap_flash_data physmap_flash_data = {
206 .width = 2,
Florian Fainellid47fbb52009-07-15 12:09:34 +0200207};
208
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000209static struct platform_device physmap_flash = {
210 .name = "physmap-flash",
211 .dev = {
212 .platform_data = &physmap_flash_data,
213 },
214 .resource = &physmap_flash_resource,
215 .num_resources = 1,
216};
217
218/*****************************************************************************
219 * Ethernet
220 ****************************************************************************/
221static struct resource cpmac_low_res[] = {
222 {
223 .name = "regs",
224 .flags = IORESOURCE_MEM,
225 .start = AR7_REGS_MAC0,
226 .end = AR7_REGS_MAC0 + 0x7ff,
227 },
228 {
229 .name = "irq",
230 .flags = IORESOURCE_IRQ,
231 .start = 27,
232 .end = 27,
233 },
234};
235
236static struct resource cpmac_high_res[] = {
237 {
238 .name = "regs",
239 .flags = IORESOURCE_MEM,
240 .start = AR7_REGS_MAC1,
241 .end = AR7_REGS_MAC1 + 0x7ff,
242 },
243 {
244 .name = "irq",
245 .flags = IORESOURCE_IRQ,
246 .start = 41,
247 .end = 41,
248 },
249};
250
251static struct fixed_phy_status fixed_phy_status __initdata = {
252 .link = 1,
253 .speed = 100,
254 .duplex = 1,
255};
256
257static struct plat_cpmac_data cpmac_low_data = {
258 .reset_bit = 17,
259 .power_bit = 20,
260 .phy_mask = 0x80000000,
261};
262
263static struct plat_cpmac_data cpmac_high_data = {
264 .reset_bit = 21,
265 .power_bit = 22,
266 .phy_mask = 0x7fffffff,
267};
268
269static u64 cpmac_dma_mask = DMA_BIT_MASK(32);
270
271static struct platform_device cpmac_low = {
272 .id = 0,
273 .name = "cpmac",
274 .dev = {
275 .dma_mask = &cpmac_dma_mask,
276 .coherent_dma_mask = DMA_BIT_MASK(32),
277 .platform_data = &cpmac_low_data,
278 },
279 .resource = cpmac_low_res,
280 .num_resources = ARRAY_SIZE(cpmac_low_res),
281};
282
283static struct platform_device cpmac_high = {
284 .id = 1,
285 .name = "cpmac",
286 .dev = {
287 .dma_mask = &cpmac_dma_mask,
288 .coherent_dma_mask = DMA_BIT_MASK(32),
289 .platform_data = &cpmac_high_data,
290 },
291 .resource = cpmac_high_res,
292 .num_resources = ARRAY_SIZE(cpmac_high_res),
Florian Fainellid47fbb52009-07-15 12:09:34 +0200293};
294
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200295static inline unsigned char char2hex(char h)
296{
297 switch (h) {
298 case '0': case '1': case '2': case '3': case '4':
299 case '5': case '6': case '7': case '8': case '9':
300 return h - '0';
301 case 'A': case 'B': case 'C': case 'D': case 'E': case 'F':
302 return h - 'A' + 10;
303 case 'a': case 'b': case 'c': case 'd': case 'e': case 'f':
304 return h - 'a' + 10;
305 default:
306 return 0;
307 }
308}
309
310static void cpmac_get_mac(int instance, unsigned char *dev_addr)
311{
312 int i;
313 char name[5], default_mac[ETH_ALEN], *mac;
314
315 mac = NULL;
316 sprintf(name, "mac%c", 'a' + instance);
317 mac = prom_getenv(name);
318 if (!mac) {
319 sprintf(name, "mac%c", 'a');
320 mac = prom_getenv(name);
321 }
322 if (!mac) {
323 random_ether_addr(default_mac);
324 mac = default_mac;
325 }
326 for (i = 0; i < 6; i++)
327 dev_addr[i] = (char2hex(mac[i * 3]) << 4) +
328 char2hex(mac[i * 3 + 1]);
329}
330
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000331/*****************************************************************************
332 * USB
333 ****************************************************************************/
334static struct resource usb_res[] = {
335 {
336 .name = "regs",
337 .flags = IORESOURCE_MEM,
338 .start = AR7_REGS_USB,
339 .end = AR7_REGS_USB + 0xff,
340 },
341 {
342 .name = "irq",
343 .flags = IORESOURCE_IRQ,
344 .start = 32,
345 .end = 32,
346 },
347 {
348 .name = "mem",
349 .flags = IORESOURCE_MEM,
350 .start = 0x03400000,
Alexander Clouter632b6292010-01-31 19:38:52 +0000351 .end = 0x03401fff,
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000352 },
353};
354
355static struct platform_device ar7_udc = {
356 .name = "ar7_udc",
357 .resource = usb_res,
358 .num_resources = ARRAY_SIZE(usb_res),
359};
360
361/*****************************************************************************
362 * LEDs
363 ****************************************************************************/
364static struct gpio_led default_leds[] = {
365 {
366 .name = "status",
367 .gpio = 8,
368 .active_low = 1,
369 },
370};
371
372static struct gpio_led dsl502t_leds[] = {
373 {
374 .name = "status",
375 .gpio = 9,
376 .active_low = 1,
377 },
378 {
379 .name = "ethernet",
380 .gpio = 7,
381 .active_low = 1,
382 },
383 {
384 .name = "usb",
385 .gpio = 12,
386 .active_low = 1,
387 },
388};
389
390static struct gpio_led dg834g_leds[] = {
391 {
392 .name = "ppp",
393 .gpio = 6,
394 .active_low = 1,
395 },
396 {
397 .name = "status",
398 .gpio = 7,
399 .active_low = 1,
400 },
401 {
402 .name = "adsl",
403 .gpio = 8,
404 .active_low = 1,
405 },
406 {
407 .name = "wifi",
408 .gpio = 12,
409 .active_low = 1,
410 },
411 {
412 .name = "power",
413 .gpio = 14,
414 .active_low = 1,
415 .default_trigger = "default-on",
416 },
417};
418
419static struct gpio_led fb_sl_leds[] = {
420 {
421 .name = "1",
422 .gpio = 7,
423 },
424 {
425 .name = "2",
426 .gpio = 13,
427 .active_low = 1,
428 },
429 {
430 .name = "3",
431 .gpio = 10,
432 .active_low = 1,
433 },
434 {
435 .name = "4",
436 .gpio = 12,
437 .active_low = 1,
438 },
439 {
440 .name = "5",
441 .gpio = 9,
442 .active_low = 1,
443 },
444};
445
446static struct gpio_led fb_fon_leds[] = {
447 {
448 .name = "1",
449 .gpio = 8,
450 },
451 {
452 .name = "2",
453 .gpio = 3,
454 .active_low = 1,
455 },
456 {
457 .name = "3",
458 .gpio = 5,
459 },
460 {
461 .name = "4",
462 .gpio = 4,
463 .active_low = 1,
464 },
465 {
466 .name = "5",
467 .gpio = 11,
468 .active_low = 1,
469 },
470};
471
472static struct gpio_led_platform_data ar7_led_data;
473
474static struct platform_device ar7_gpio_leds = {
475 .name = "leds-gpio",
476 .dev = {
477 .platform_data = &ar7_led_data,
478 }
479};
480
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200481static void __init detect_leds(void)
482{
483 char *prid, *usb_prod;
484
485 /* Default LEDs */
486 ar7_led_data.num_leds = ARRAY_SIZE(default_leds);
487 ar7_led_data.leds = default_leds;
488
489 /* FIXME: the whole thing is unreliable */
490 prid = prom_getenv("ProductID");
491 usb_prod = prom_getenv("usb_prod");
492
493 /* If we can't get the product id from PROM, use the default LEDs */
494 if (!prid)
495 return;
496
497 if (strstr(prid, "Fritz_Box_FON")) {
498 ar7_led_data.num_leds = ARRAY_SIZE(fb_fon_leds);
499 ar7_led_data.leds = fb_fon_leds;
500 } else if (strstr(prid, "Fritz_Box_")) {
501 ar7_led_data.num_leds = ARRAY_SIZE(fb_sl_leds);
502 ar7_led_data.leds = fb_sl_leds;
503 } else if ((!strcmp(prid, "AR7RD") || !strcmp(prid, "AR7DB"))
504 && usb_prod != NULL && strstr(usb_prod, "DSL-502T")) {
505 ar7_led_data.num_leds = ARRAY_SIZE(dsl502t_leds);
506 ar7_led_data.leds = dsl502t_leds;
507 } else if (strstr(prid, "DG834")) {
508 ar7_led_data.num_leds = ARRAY_SIZE(dg834g_leds);
509 ar7_led_data.leds = dg834g_leds;
510 }
511}
512
Alexander Clouter4d1da8c2010-01-31 19:38:19 +0000513/*****************************************************************************
514 * Watchdog
515 ****************************************************************************/
516static struct resource ar7_wdt_res = {
517 .name = "regs",
518 .flags = IORESOURCE_MEM,
519 .start = -1, /* Filled at runtime */
520 .end = -1, /* Filled at runtime */
521};
522
523static struct platform_device ar7_wdt = {
524 .name = "ar7_wdt",
525 .resource = &ar7_wdt_res,
526 .num_resources = 1,
527};
528
529/*****************************************************************************
530 * Init
531 ****************************************************************************/
Alexander Clouter70843382010-01-31 19:39:57 +0000532static int __init ar7_register_uarts(void)
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200533{
Florian Fainelli50ca9612009-07-24 13:24:15 +0200534#ifdef CONFIG_SERIAL_8250
Alexander Clouter70843382010-01-31 19:39:57 +0000535 static struct uart_port uart_port __initdata;
Florian Fainelli780019d2010-01-27 09:10:06 +0100536 struct clk *bus_clk;
Alexander Clouter70843382010-01-31 19:39:57 +0000537 int res;
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200538
Alexander Clouter70843382010-01-31 19:39:57 +0000539 memset(&uart_port, 0, sizeof(struct uart_port));
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200540
Florian Fainelli780019d2010-01-27 09:10:06 +0100541 bus_clk = clk_get(NULL, "bus");
542 if (IS_ERR(bus_clk))
543 panic("unable to get bus clk\n");
544
Alexander Clouter70843382010-01-31 19:39:57 +0000545 uart_port.type = PORT_16550A;
546 uart_port.uartclk = clk_get_rate(bus_clk) / 2;
547 uart_port.iotype = UPIO_MEM32;
548 uart_port.regshift = 2;
549
550 uart_port.line = 0;
551 uart_port.irq = AR7_IRQ_UART0;
552 uart_port.mapbase = AR7_REGS_UART0;
553 uart_port.membase = ioremap(uart_port.mapbase, 256);
554
555 res = early_serial_setup(&uart_port);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200556 if (res)
557 return res;
558
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200559 /* Only TNETD73xx have a second serial port */
560 if (ar7_has_second_uart()) {
Alexander Clouter70843382010-01-31 19:39:57 +0000561 uart_port.line = 1;
562 uart_port.irq = AR7_IRQ_UART1;
563 uart_port.mapbase = UR8_REGS_UART1;
564 uart_port.membase = ioremap(uart_port.mapbase, 256);
565
566 res = early_serial_setup(&uart_port);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200567 if (res)
568 return res;
569 }
Alexander Clouter70843382010-01-31 19:39:57 +0000570#endif
571
572 return 0;
573}
574
575static int __init ar7_register_devices(void)
576{
577 void __iomem *bootcr;
578 u32 val;
Alexander Clouter70843382010-01-31 19:39:57 +0000579 int res;
580
581 res = ar7_register_uarts();
582 if (res)
583 pr_err("unable to setup uart(s): %d\n", res);
584
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200585 res = platform_device_register(&physmap_flash);
586 if (res)
Alexander Clouter70843382010-01-31 19:39:57 +0000587 pr_warning("unable to register physmap-flash: %d\n", res);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200588
589 ar7_device_disable(vlynq_low_data.reset_bit);
590 res = platform_device_register(&vlynq_low);
591 if (res)
Alexander Clouter70843382010-01-31 19:39:57 +0000592 pr_warning("unable to register vlynq-low: %d\n", res);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200593
594 if (ar7_has_high_vlynq()) {
595 ar7_device_disable(vlynq_high_data.reset_bit);
596 res = platform_device_register(&vlynq_high);
597 if (res)
Alexander Clouter70843382010-01-31 19:39:57 +0000598 pr_warning("unable to register vlynq-high: %d\n", res);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200599 }
600
601 if (ar7_has_high_cpmac()) {
Alexander Clouter727c00752010-03-13 00:09:15 +0000602 res = fixed_phy_add(PHY_POLL, cpmac_high.id, &fixed_phy_status);
Alexander Clouter70843382010-01-31 19:39:57 +0000603 if (!res) {
604 cpmac_get_mac(1, cpmac_high_data.dev_addr);
605
606 res = platform_device_register(&cpmac_high);
607 if (res)
608 pr_warning("unable to register cpmac-high: %d\n", res);
609 } else
610 pr_warning("unable to add cpmac-high phy: %d\n", res);
611 } else
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200612 cpmac_low_data.phy_mask = 0xffffffff;
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200613
Florian Fainelli1e2c8d82009-08-04 10:52:47 +0000614 res = fixed_phy_add(PHY_POLL, cpmac_low.id, &fixed_phy_status);
Alexander Clouter70843382010-01-31 19:39:57 +0000615 if (!res) {
616 cpmac_get_mac(0, cpmac_low_data.dev_addr);
617 res = platform_device_register(&cpmac_low);
618 if (res)
619 pr_warning("unable to register cpmac-low: %d\n", res);
620 } else
621 pr_warning("unable to add cpmac-low phy: %d\n", res);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200622
623 detect_leds();
624 res = platform_device_register(&ar7_gpio_leds);
625 if (res)
Alexander Clouter70843382010-01-31 19:39:57 +0000626 pr_warning("unable to register leds: %d\n", res);
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200627
628 res = platform_device_register(&ar7_udc);
Alexander Clouter70843382010-01-31 19:39:57 +0000629 if (res)
630 pr_warning("unable to register usb slave: %d\n", res);
Florian Fainelli72838a12009-08-04 23:09:36 +0200631
632 /* Register watchdog only if enabled in hardware */
Alexander Clouter70843382010-01-31 19:39:57 +0000633 bootcr = ioremap_nocache(AR7_REGS_DCL, 4);
634 val = readl(bootcr);
635 iounmap(bootcr);
636 if (val & AR7_WDT_HW_ENA) {
Florian Fainelli9c1b0132010-05-11 11:20:09 +0200637 if (ar7_has_high_vlynq())
Alexander Clouter70843382010-01-31 19:39:57 +0000638 ar7_wdt_res.start = UR8_REGS_WDT;
Florian Fainelli9c1b0132010-05-11 11:20:09 +0200639 else
640 ar7_wdt_res.start = AR7_REGS_WDT;
Florian Fainellid47fbb52009-07-15 12:09:34 +0200641
Alexander Clouter70843382010-01-31 19:39:57 +0000642 ar7_wdt_res.end = ar7_wdt_res.start + 0x20;
643 res = platform_device_register(&ar7_wdt);
644 if (res)
645 pr_warning("unable to register watchdog: %d\n", res);
646 }
647
648 return 0;
Florian Fainelli7ca5dc12009-06-24 11:12:57 +0200649}
Florian Fainelli142a2ce2010-05-11 11:20:14 +0200650device_initcall(ar7_register_devices);