2 * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
3 * Copyright (C) 2006,2007 Eugene Konev <ejka@openwrt.org>
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.
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.
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
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>
31 #include <linux/vlynq.h>
32 #include <linux/leds.h>
33 #include <linux/string.h>
34 #include <linux/etherdevice.h>
35 #include <linux/phy.h>
36 #include <linux/phy_fixed.h>
37 #include <linux/gpio.h>
38 #include <linux/clk.h>
40 #include <asm/addrspace.h>
41 #include <asm/mach-ar7/ar7.h>
42 #include <asm/mach-ar7/prom.h>
44 /*****************************************************************************
46 ****************************************************************************/
47 struct plat_vlynq_data
{
48 struct plat_vlynq_ops ops
;
53 static int vlynq_on(struct vlynq_device
*dev
)
56 struct plat_vlynq_data
*pdata
= dev
->dev
.platform_data
;
58 ret
= gpio_request(pdata
->gpio_bit
, "vlynq");
62 ar7_device_reset(pdata
->reset_bit
);
64 ret
= ar7_gpio_disable(pdata
->gpio_bit
);
68 ret
= ar7_gpio_enable(pdata
->gpio_bit
);
72 ret
= gpio_direction_output(pdata
->gpio_bit
, 0);
74 goto out_gpio_enabled
;
78 gpio_set_value(pdata
->gpio_bit
, 1);
85 ar7_gpio_disable(pdata
->gpio_bit
);
87 ar7_device_disable(pdata
->reset_bit
);
88 gpio_free(pdata
->gpio_bit
);
93 static void vlynq_off(struct vlynq_device
*dev
)
95 struct plat_vlynq_data
*pdata
= dev
->dev
.platform_data
;
97 ar7_gpio_disable(pdata
->gpio_bit
);
98 gpio_free(pdata
->gpio_bit
);
99 ar7_device_disable(pdata
->reset_bit
);
102 static struct resource vlynq_low_res
[] = {
105 .flags
= IORESOURCE_MEM
,
106 .start
= AR7_REGS_VLYNQ0
,
107 .end
= AR7_REGS_VLYNQ0
+ 0xff,
111 .flags
= IORESOURCE_IRQ
,
117 .flags
= IORESOURCE_MEM
,
123 .flags
= IORESOURCE_IRQ
,
129 static struct resource vlynq_high_res
[] = {
132 .flags
= IORESOURCE_MEM
,
133 .start
= AR7_REGS_VLYNQ1
,
134 .end
= AR7_REGS_VLYNQ1
+ 0xff,
138 .flags
= IORESOURCE_IRQ
,
144 .flags
= IORESOURCE_MEM
,
150 .flags
= IORESOURCE_IRQ
,
156 static struct plat_vlynq_data vlynq_low_data
= {
165 static struct plat_vlynq_data vlynq_high_data
= {
174 static struct platform_device vlynq_low
= {
178 .platform_data
= &vlynq_low_data
,
180 .resource
= vlynq_low_res
,
181 .num_resources
= ARRAY_SIZE(vlynq_low_res
),
184 static struct platform_device vlynq_high
= {
188 .platform_data
= &vlynq_high_data
,
190 .resource
= vlynq_high_res
,
191 .num_resources
= ARRAY_SIZE(vlynq_high_res
),
194 /*****************************************************************************
196 ****************************************************************************/
197 static struct resource physmap_flash_resource
= {
199 .flags
= IORESOURCE_MEM
,
204 static const char *ar7_probe_types
[] = { "ar7part", NULL
};
206 static struct physmap_flash_data physmap_flash_data
= {
208 .part_probe_types
= ar7_probe_types
,
211 static struct platform_device physmap_flash
= {
212 .name
= "physmap-flash",
214 .platform_data
= &physmap_flash_data
,
216 .resource
= &physmap_flash_resource
,
220 /*****************************************************************************
222 ****************************************************************************/
223 static struct resource cpmac_low_res
[] = {
226 .flags
= IORESOURCE_MEM
,
227 .start
= AR7_REGS_MAC0
,
228 .end
= AR7_REGS_MAC0
+ 0x7ff,
232 .flags
= IORESOURCE_IRQ
,
238 static struct resource cpmac_high_res
[] = {
241 .flags
= IORESOURCE_MEM
,
242 .start
= AR7_REGS_MAC1
,
243 .end
= AR7_REGS_MAC1
+ 0x7ff,
247 .flags
= IORESOURCE_IRQ
,
253 static struct fixed_phy_status fixed_phy_status __initdata
= {
259 static struct plat_cpmac_data cpmac_low_data
= {
262 .phy_mask
= 0x80000000,
265 static struct plat_cpmac_data cpmac_high_data
= {
268 .phy_mask
= 0x7fffffff,
271 static u64 cpmac_dma_mask
= DMA_BIT_MASK(32);
273 static struct platform_device cpmac_low
= {
277 .dma_mask
= &cpmac_dma_mask
,
278 .coherent_dma_mask
= DMA_BIT_MASK(32),
279 .platform_data
= &cpmac_low_data
,
281 .resource
= cpmac_low_res
,
282 .num_resources
= ARRAY_SIZE(cpmac_low_res
),
285 static struct platform_device cpmac_high
= {
289 .dma_mask
= &cpmac_dma_mask
,
290 .coherent_dma_mask
= DMA_BIT_MASK(32),
291 .platform_data
= &cpmac_high_data
,
293 .resource
= cpmac_high_res
,
294 .num_resources
= ARRAY_SIZE(cpmac_high_res
),
297 static void __init
cpmac_get_mac(int instance
, unsigned char *dev_addr
)
301 sprintf(name
, "mac%c", 'a' + instance
);
302 mac
= prom_getenv(name
);
303 if (!mac
&& instance
) {
304 sprintf(name
, "mac%c", 'a');
305 mac
= prom_getenv(name
);
309 if (!mac_pton(mac
, dev_addr
)) {
310 pr_warn("cannot parse mac address, using random address\n");
311 eth_random_addr(dev_addr
);
314 eth_random_addr(dev_addr
);
317 /*****************************************************************************
319 ****************************************************************************/
320 static struct resource usb_res
[] = {
323 .flags
= IORESOURCE_MEM
,
324 .start
= AR7_REGS_USB
,
325 .end
= AR7_REGS_USB
+ 0xff,
329 .flags
= IORESOURCE_IRQ
,
335 .flags
= IORESOURCE_MEM
,
341 static struct platform_device ar7_udc
= {
344 .num_resources
= ARRAY_SIZE(usb_res
),
347 /*****************************************************************************
349 ****************************************************************************/
350 static struct gpio_led default_leds
[] = {
358 static struct gpio_led titan_leds
[] = {
359 { .name
= "status", .gpio
= 8, .active_low
= 1, },
360 { .name
= "wifi", .gpio
= 13, .active_low
= 1, },
363 static struct gpio_led dsl502t_leds
[] = {
381 static struct gpio_led dg834g_leds
[] = {
406 .default_trigger
= "default-on",
410 static struct gpio_led fb_sl_leds
[] = {
437 static struct gpio_led fb_fon_leds
[] = {
463 static struct gpio_led gt701_leds
[] = {
465 .name
= "inet:green",
485 .name
= "power:green",
488 .default_trigger
= "default-on",
497 static struct gpio_led_platform_data ar7_led_data
;
499 static struct platform_device ar7_gpio_leds
= {
502 .platform_data
= &ar7_led_data
,
506 static void __init
detect_leds(void)
508 char *prid
, *usb_prod
;
511 ar7_led_data
.num_leds
= ARRAY_SIZE(default_leds
);
512 ar7_led_data
.leds
= default_leds
;
514 /* FIXME: the whole thing is unreliable */
515 prid
= prom_getenv("ProductID");
516 usb_prod
= prom_getenv("usb_prod");
518 /* If we can't get the product id from PROM, use the default LEDs */
522 if (strstr(prid
, "Fritz_Box_FON")) {
523 ar7_led_data
.num_leds
= ARRAY_SIZE(fb_fon_leds
);
524 ar7_led_data
.leds
= fb_fon_leds
;
525 } else if (strstr(prid
, "Fritz_Box_")) {
526 ar7_led_data
.num_leds
= ARRAY_SIZE(fb_sl_leds
);
527 ar7_led_data
.leds
= fb_sl_leds
;
528 } else if ((!strcmp(prid
, "AR7RD") || !strcmp(prid
, "AR7DB"))
529 && usb_prod
!= NULL
&& strstr(usb_prod
, "DSL-502T")) {
530 ar7_led_data
.num_leds
= ARRAY_SIZE(dsl502t_leds
);
531 ar7_led_data
.leds
= dsl502t_leds
;
532 } else if (strstr(prid
, "DG834")) {
533 ar7_led_data
.num_leds
= ARRAY_SIZE(dg834g_leds
);
534 ar7_led_data
.leds
= dg834g_leds
;
535 } else if (strstr(prid
, "CYWM") || strstr(prid
, "CYWL")) {
536 ar7_led_data
.num_leds
= ARRAY_SIZE(titan_leds
);
537 ar7_led_data
.leds
= titan_leds
;
538 } else if (strstr(prid
, "GT701")) {
539 ar7_led_data
.num_leds
= ARRAY_SIZE(gt701_leds
);
540 ar7_led_data
.leds
= gt701_leds
;
544 /*****************************************************************************
546 ****************************************************************************/
547 static struct resource ar7_wdt_res
= {
549 .flags
= IORESOURCE_MEM
,
550 .start
= -1, /* Filled at runtime */
551 .end
= -1, /* Filled at runtime */
554 static struct platform_device ar7_wdt
= {
556 .resource
= &ar7_wdt_res
,
560 /*****************************************************************************
562 ****************************************************************************/
563 static int __init
ar7_register_uarts(void)
565 #ifdef CONFIG_SERIAL_8250
566 static struct uart_port uart_port __initdata
;
570 memset(&uart_port
, 0, sizeof(struct uart_port
));
572 bus_clk
= clk_get(NULL
, "bus");
574 panic("unable to get bus clk");
576 uart_port
.type
= PORT_AR7
;
577 uart_port
.uartclk
= clk_get_rate(bus_clk
) / 2;
578 uart_port
.iotype
= UPIO_MEM32
;
579 uart_port
.regshift
= 2;
582 uart_port
.irq
= AR7_IRQ_UART0
;
583 uart_port
.mapbase
= AR7_REGS_UART0
;
584 uart_port
.membase
= ioremap(uart_port
.mapbase
, 256);
586 res
= early_serial_setup(&uart_port
);
590 /* Only TNETD73xx have a second serial port */
591 if (ar7_has_second_uart()) {
593 uart_port
.irq
= AR7_IRQ_UART1
;
594 uart_port
.mapbase
= UR8_REGS_UART1
;
595 uart_port
.membase
= ioremap(uart_port
.mapbase
, 256);
597 res
= early_serial_setup(&uart_port
);
606 static void __init
titan_fixup_devices(void)
608 /* Set vlynq0 data */
609 vlynq_low_data
.reset_bit
= 15;
610 vlynq_low_data
.gpio_bit
= 14;
612 /* Set vlynq1 data */
613 vlynq_high_data
.reset_bit
= 16;
614 vlynq_high_data
.gpio_bit
= 7;
616 /* Set vlynq0 resources */
617 vlynq_low_res
[0].start
= TITAN_REGS_VLYNQ0
;
618 vlynq_low_res
[0].end
= TITAN_REGS_VLYNQ0
+ 0xff;
619 vlynq_low_res
[1].start
= 33;
620 vlynq_low_res
[1].end
= 33;
621 vlynq_low_res
[2].start
= 0x0c000000;
622 vlynq_low_res
[2].end
= 0x0fffffff;
623 vlynq_low_res
[3].start
= 80;
624 vlynq_low_res
[3].end
= 111;
626 /* Set vlynq1 resources */
627 vlynq_high_res
[0].start
= TITAN_REGS_VLYNQ1
;
628 vlynq_high_res
[0].end
= TITAN_REGS_VLYNQ1
+ 0xff;
629 vlynq_high_res
[1].start
= 34;
630 vlynq_high_res
[1].end
= 34;
631 vlynq_high_res
[2].start
= 0x40000000;
632 vlynq_high_res
[2].end
= 0x43ffffff;
633 vlynq_high_res
[3].start
= 112;
634 vlynq_high_res
[3].end
= 143;
636 /* Set cpmac0 data */
637 cpmac_low_data
.phy_mask
= 0x40000000;
639 /* Set cpmac1 data */
640 cpmac_high_data
.phy_mask
= 0x80000000;
642 /* Set cpmac0 resources */
643 cpmac_low_res
[0].start
= TITAN_REGS_MAC0
;
644 cpmac_low_res
[0].end
= TITAN_REGS_MAC0
+ 0x7ff;
646 /* Set cpmac1 resources */
647 cpmac_high_res
[0].start
= TITAN_REGS_MAC1
;
648 cpmac_high_res
[0].end
= TITAN_REGS_MAC1
+ 0x7ff;
651 static int __init
ar7_register_devices(void)
653 void __iomem
*bootcr
;
657 res
= ar7_register_uarts();
659 pr_err("unable to setup uart(s): %d\n", res
);
661 res
= platform_device_register(&physmap_flash
);
663 pr_warn("unable to register physmap-flash: %d\n", res
);
666 titan_fixup_devices();
668 ar7_device_disable(vlynq_low_data
.reset_bit
);
669 res
= platform_device_register(&vlynq_low
);
671 pr_warn("unable to register vlynq-low: %d\n", res
);
673 if (ar7_has_high_vlynq()) {
674 ar7_device_disable(vlynq_high_data
.reset_bit
);
675 res
= platform_device_register(&vlynq_high
);
677 pr_warn("unable to register vlynq-high: %d\n", res
);
680 if (ar7_has_high_cpmac()) {
681 res
= fixed_phy_add(PHY_POLL
, cpmac_high
.id
,
682 &fixed_phy_status
, -1);
684 cpmac_get_mac(1, cpmac_high_data
.dev_addr
);
686 res
= platform_device_register(&cpmac_high
);
688 pr_warn("unable to register cpmac-high: %d\n",
691 pr_warn("unable to add cpmac-high phy: %d\n", res
);
693 cpmac_low_data
.phy_mask
= 0xffffffff;
695 res
= fixed_phy_add(PHY_POLL
, cpmac_low
.id
, &fixed_phy_status
, -1);
697 cpmac_get_mac(0, cpmac_low_data
.dev_addr
);
698 res
= platform_device_register(&cpmac_low
);
700 pr_warn("unable to register cpmac-low: %d\n", res
);
702 pr_warn("unable to add cpmac-low phy: %d\n", res
);
705 res
= platform_device_register(&ar7_gpio_leds
);
707 pr_warn("unable to register leds: %d\n", res
);
709 res
= platform_device_register(&ar7_udc
);
711 pr_warn("unable to register usb slave: %d\n", res
);
713 /* Register watchdog only if enabled in hardware */
714 bootcr
= ioremap_nocache(AR7_REGS_DCL
, 4);
717 if (val
& AR7_WDT_HW_ENA
) {
718 if (ar7_has_high_vlynq())
719 ar7_wdt_res
.start
= UR8_REGS_WDT
;
721 ar7_wdt_res
.start
= AR7_REGS_WDT
;
723 ar7_wdt_res
.end
= ar7_wdt_res
.start
+ 0x20;
724 res
= platform_device_register(&ar7_wdt
);
726 pr_warn("unable to register watchdog: %d\n", res
);
731 device_initcall(ar7_register_devices
);