#include <linux/types.h>
#include <linux/module.h>
#include <linux/delay.h>
+#include <linux/dma-mapping.h>
#include <linux/platform_device.h>
#include <linux/mtd/physmap.h>
#include <linux/serial.h>
#include <linux/serial_8250.h>
#include <linux/ioport.h>
#include <linux/io.h>
+#include <linux/version.h>
+#include <linux/vlynq.h>
+#include <linux/leds.h>
+#include <linux/string.h>
#include <asm/addrspace.h>
#include <asm/ar7/ar7.h>
#include <asm/ar7/gpio.h>
#include <asm/ar7/prom.h>
-#include <asm/ar7/vlynq.h>
struct plat_vlynq_data {
struct plat_vlynq_ops ops;
if ((result = ar7_gpio_enable(pdata->gpio_bit)))
goto out_enabled;
- if ((result = gpio_direction_output(pdata->gpio_bit)))
+ if ((result = gpio_direction_output(pdata->gpio_bit, 0)))
goto out_gpio_enabled;
- gpio_set_value(pdata->gpio_bit, 0);
mdelay(50);
gpio_set_value(pdata->gpio_bit, 1);
},
};
+static struct resource usb_res[] = {
+ {
+ .name = "regs",
+ .flags = IORESOURCE_MEM,
+ .start = AR7_REGS_USB,
+ .end = AR7_REGS_USB + 0xff,
+ },
+ {
+ .name = "irq",
+ .flags = IORESOURCE_IRQ,
+ .start = 32,
+ .end = 32,
+ },
+ {
+ .name = "mem",
+ .flags = IORESOURCE_MEM,
+ .start = 0x03400000,
+ .end = 0x034001fff,
+ },
+};
+
static struct physmap_flash_data physmap_flash_data = {
.width = 2,
};
.num_resources = 1,
};
+static u64 cpmac_dma_mask = DMA_32BIT_MASK;
static struct platform_device cpmac_low = {
.id = 0,
.name = "cpmac",
- .dev.platform_data = &cpmac_low_data,
+ .dev = {
+ .dma_mask = &cpmac_dma_mask,
+ .coherent_dma_mask = DMA_32BIT_MASK,
+ .platform_data = &cpmac_low_data,
+ },
.resource = cpmac_low_res,
.num_resources = ARRAY_SIZE(cpmac_low_res),
};
static struct platform_device cpmac_high = {
.id = 1,
.name = "cpmac",
- .dev.platform_data = &cpmac_high_data,
+ .dev = {
+ .dma_mask = &cpmac_dma_mask,
+ .coherent_dma_mask = DMA_32BIT_MASK,
+ .platform_data = &cpmac_high_data,
+ },
.resource = cpmac_high_res,
.num_resources = ARRAY_SIZE(cpmac_high_res),
};
};
#endif
+static struct gpio_led default_leds[] = {
+ { .name = "status", .gpio = 8, .active_low = 1, },
+};
+
+static struct gpio_led fb_sl_leds[] = {
+ { .name = "1", .gpio = 7, },
+ { .name = "2", .gpio = 13, .active_low = 1, },
+ { .name = "3", .gpio = 10, .active_low = 1, },
+ { .name = "4", .gpio = 12, .active_low = 1, },
+ { .name = "5", .gpio = 9, .active_low = 1, },
+};
+
+static struct gpio_led fb_fon_leds[] = {
+ { .name = "1", .gpio = 8, },
+ { .name = "2", .gpio = 3, .active_low = 1, },
+ { .name = "3", .gpio = 5, },
+ { .name = "4", .gpio = 4, .active_low = 1, },
+ { .name = "5", .gpio = 11, .active_low = 1, },
+};
+
+static struct gpio_led_platform_data ar7_led_data;
+
+static struct platform_device ar7_gpio_leds = {
+ .name = "leds-gpio",
+ .id = -1,
+ .dev = {
+ .platform_data = &ar7_led_data,
+ }
+};
+
+static struct platform_device ar7_udc = {
+ .id = -1,
+ .name = "ar7_udc",
+ .resource = usb_res,
+ .num_resources = ARRAY_SIZE(usb_res),
+};
+
static inline unsigned char char2hex(char h)
{
switch (h) {
char2hex(mac[i * 3 + 1]);
}
+static void __init detect_leds(void)
+{
+ char *prId;
+
+ /* Default LEDs */
+ ar7_led_data.num_leds = ARRAY_SIZE(default_leds);
+ ar7_led_data.leds = default_leds;
+
+ /* FIXME: the whole thing is unreliable */
+ prId = prom_getenv("ProductID");
+
+ /* If we can't get the product id from PROM, use the default LEDs */
+ if (!prId)
+ return;
+
+ if (strstr(prId, "Fritz_Box_FON")) {
+ ar7_led_data.num_leds = ARRAY_SIZE(fb_fon_leds);
+ ar7_led_data.leds = fb_fon_leds;
+ } else if (strstr(prId, "Fritz_Box_")) {
+ ar7_led_data.num_leds = ARRAY_SIZE(fb_sl_leds);
+ ar7_led_data.leds = fb_sl_leds;
+ }
+}
+
static int __init ar7_register_devices(void)
{
int res;
cpmac_get_mac(0, cpmac_low_data.dev_addr);
res = platform_device_register(&cpmac_low);
+ if (res)
+ return res;
+
+ detect_leds();
+ res = platform_device_register(&ar7_gpio_leds);
+ if (res)
+ return res;
+
+ res = platform_device_register(&ar7_udc);
return res;
}