brcm47xx: add initial support for devices with bcma bus.
[openwrt/svn-archive/archive.git] / package / broadcom-diag / src / diag.c
index 11b8f425d960822f33812b4bba94a89e3d43a1df..8e7ffa6cc77aaa347e8c14e51f2ce9090a4f5382 100644 (file)
@@ -30,8 +30,8 @@
 #include <linux/workqueue.h>
 #include <linux/skbuff.h>
 #include <linux/netlink.h>
+#include <linux/kobject.h>
 #include <net/sock.h>
-extern struct sock *uevent_sock;
 extern u64 uevent_next_seqnum(void);
 
 #include "gpio.h"
@@ -110,6 +110,8 @@ enum {
 
        /* Netgear */
        WGT634U,
+       WNR834BV1,
+       WNR834BV2,
 
        /* Trendware */
        TEW411BRPP,
@@ -137,6 +139,9 @@ enum {
 
        /* Microsoft */
        MN700,
+
+       /* Edimax */
+       PS1208MFG,
 };
 
 static void __init bcm4780_init(void) {
@@ -144,9 +149,9 @@ static void __init bcm4780_init(void) {
 
                /* Enables GPIO 3 that controls HDD and led power on ASUS WL-700gE */
                printk(MODULE_NAME ": Spinning up HDD and enabling leds\n");
-               gpio_outen(pin, pin);
-               gpio_control(pin, 0);
-               gpio_out(pin, pin);
+               ssb_gpio_outen(&ssb_bcm47xx, pin, pin);
+               ssb_gpio_control(&ssb_bcm47xx, pin, 0);
+               ssb_gpio_out(&ssb_bcm47xx, pin, pin);
 
                /* Wait 5s, so the HDD can spin up */
                set_current_state(TASK_INTERRUPTIBLE);
@@ -156,14 +161,14 @@ static void __init bcm4780_init(void) {
 static void __init NetCenter_init(void) {
                /* unset pin 6 (+12V) */
                int pin = 1 << 6;
-               gpio_outen(pin, pin);
-               gpio_control(pin, 0);
-               gpio_out(pin, pin);
+               ssb_gpio_outen(&ssb_bcm47xx, pin, pin);
+               ssb_gpio_control(&ssb_bcm47xx, pin, 0);
+               ssb_gpio_out(&ssb_bcm47xx, pin, pin);
                /* unset pin 1 (turn off red led, blue will light alone if +5V comes up) */
                pin = 1 << 1;
-               gpio_outen(pin, pin);
-               gpio_control(pin, 0);
-               gpio_out(pin, pin);
+               ssb_gpio_outen(&ssb_bcm47xx, pin, pin);
+               ssb_gpio_control(&ssb_bcm47xx, pin, 0);
+               ssb_gpio_out(&ssb_bcm47xx, pin, pin);
                /* unset pin 3 (+5V) and wait 5 seconds (harddisk spin up) */
                bcm4780_init();
 }
@@ -172,9 +177,9 @@ static void __init bcm57xx_init(void) {
        int pin = 1 << 2;
 
        /* FIXME: switch comes up, but port mappings/vlans not right */
-       gpio_outen(pin, pin);
-       gpio_control(pin, 0);
-       gpio_out(pin, pin);
+       ssb_gpio_outen(&ssb_bcm47xx, pin, pin);
+       ssb_gpio_control(&ssb_bcm47xx, pin, 0);
+       ssb_gpio_out(&ssb_bcm47xx, pin, pin);
 }
 
 static struct platform_t __initdata platforms[] = {
@@ -266,7 +271,7 @@ static struct platform_t __initdata platforms[] = {
                .name           = "Linksys WRT54G3GV2-VF",
                .buttons        = {
                        { .name = "reset",      .gpio = 1 << 6 },
-                       { .name = "3g",         .gpio = 1 << 4 },
+                       { .name = "3g",         .gpio = 1 << 5 },
                },
                .leds           = {
                        { .name = "power",      .gpio = 1 << 1, .polarity = NORMAL },
@@ -754,6 +759,28 @@ static struct platform_t __initdata platforms[] = {
                        { .name = "power",      .gpio = 1 << 3, .polarity = NORMAL },
                },
        },
+       /* Netgear */
+       [WNR834BV1] = {
+               .name           = "Netgear WNR834B V1",
+               .buttons        = { /* TODO: add reset button and confirm LEDs - GPIO from dd-wrt */ },
+               .leds           = {
+                       { .name = "power",      .gpio = 1 << 4, .polarity = REVERSE },
+                       { .name = "diag",       .gpio = 1 << 5, .polarity = REVERSE },
+                       { .name = "wlan",       .gpio = 1 << 6, .polarity = REVERSE },
+               },
+       },
+       /* Netgear */
+       [WNR834BV2] = {
+               .name           = "Netgear WNR834B V2",
+               .buttons        = {
+                       { .name = "reset",      .gpio = 1 << 6 },
+               },
+               .leds           = {
+                       { .name = "power",      .gpio = 1 << 2, .polarity = NORMAL },
+                       { .name = "diag",       .gpio = 1 << 3, .polarity = NORMAL },
+                       { .name = "connected",  .gpio = 1 << 7, .polarity = NORMAL },
+               },
+       },
        /* Trendware */
        [TEW411BRPP] = {
                .name           = "Trendware TEW411BRP+",
@@ -770,8 +797,7 @@ static struct platform_t __initdata platforms[] = {
        [STI_NAS] = {
                .name      = "SimpleTech SimpleShare NAS",
                .buttons        = {
-                       { .name = "reset",      .gpio = 1 << 7 }, // on back, hardwired, always resets device regardless OS state
-                       { .name = "power",      .gpio = 1 << 0 }, // on back
+                       { .name = "reset",      .gpio = 1 << 0 }, // Power button on back, named reset to enable failsafe.
                },
                .leds      = {
                        { .name = "diag",       .gpio = 1 << 1, .polarity = REVERSE }, // actual name ready
@@ -884,6 +910,17 @@ static struct platform_t __initdata platforms[] = {
                        { .name = "power",      .gpio = 1 << 6, .polarity = NORMAL },
                },
        },
+       /* Edimax */
+       [PS1208MFG] = {
+               .name   = "Edimax PS-1208MFG",
+               .buttons        = {
+                       { .name = "reset",      .gpio = 1 << 4 },
+               },
+               .leds     = {
+                       { .name = "status",     .gpio = 1 << 1, .polarity = NORMAL },
+                       { .name = "wlan",       .gpio = 1 << 0, .polarity = NORMAL },
+               },
+       },
 };
 
 static struct platform_t __init *platform_detect(void)
@@ -1035,6 +1072,13 @@ static struct platform_t __init *platform_detect(void)
                        return &platforms[WDNetCenter];
                }
 
+               if (!strcmp(boardtype,"0x0472") && !strcmp(getvar("cardbus"), "1")) { /* Netgear WNR834B  V1 and V2*/
+                       if (!strcmp(boardnum, "08") || !strcmp(boardnum, "8"))
+                               return &platforms[WNR834BV1];
+                       if (!strcmp(boardnum, "01") || !strcmp(boardnum, "1"))
+                               return &platforms[WNR834BV2];
+               }
+
        } else { /* PMON based - old stuff */
                if ((simple_strtoul(getvar("GemtekPmonVer"), NULL, 0) == 9) &&
                        (simple_strtoul(getvar("et0phyaddr"), NULL, 0) == 30)) {
@@ -1101,12 +1145,16 @@ static struct platform_t __init *platform_detect(void)
                return &platforms[TEW411BRPP];
        }
 
-       if (startswith(boardnum, "04FN52")) /* SimpleTech SimpleShare */
+       if (startswith(boardnum, "04FN")) /* SimpleTech SimpleShare */
                return &platforms[STI_NAS];
 
-       if (!strcmp(getvar("boardnum"), "10") && !strcmp(getvar("boardrev"), "0x13")) /* D-Link DWL-3150 */
+       if (!strcmp(boardnum, "10") && !strcmp(getvar("boardrev"), "0x13")) /* D-Link DWL-3150 */
                return &platforms[DWL3150];
 
+       if (!strcmp(boardnum, "01") && !strcmp(boardtype, "0x048e") && /* Edimax PS1208MFG */
+               !strcmp(getvar("status_gpio"), "1")) /* gpio based detection */
+               return &platforms[PS1208MFG];
+
        /* not found */
        return NULL;
 }
@@ -1118,18 +1166,18 @@ static void register_buttons(struct button_t *b)
 
        platform.button_mask &= ~gpiomask;
 
-       gpio_outen(platform.button_mask, 0);
-       gpio_control(platform.button_mask, 0);
-       platform.button_polarity = gpio_in() & platform.button_mask;
-       gpio_intpolarity(platform.button_mask, platform.button_polarity);
-       gpio_setintmask(platform.button_mask, platform.button_mask);
+       ssb_gpio_outen(&ssb_bcm47xx, platform.button_mask, 0);
+       ssb_gpio_control(&ssb_bcm47xx, platform.button_mask, 0);
+       platform.button_polarity = ssb_gpio_in(&ssb_bcm47xx, ~0) & platform.button_mask;
+       ssb_gpio_polarity(&ssb_bcm47xx, platform.button_mask, platform.button_polarity);
+       ssb_gpio_intmask(&ssb_bcm47xx, platform.button_mask, platform.button_mask);
 
        gpio_set_irqenable(1, button_handler);
 }
 
 static void unregister_buttons(struct button_t *b)
 {
-       gpio_setintmask(platform.button_mask, 0);
+       ssb_gpio_intmask(&ssb_bcm47xx, platform.button_mask, 0);
 
        gpio_set_irqenable(0, button_handler);
 }
@@ -1151,9 +1199,6 @@ static void hotplug_button(struct work_struct *work)
        struct event_t *event = container_of(work, struct event_t, wq);
        char *s;
 
-       if (!uevent_sock)
-               return;
-
        event->skb = alloc_skb(2048, GFP_KERNEL);
 
        s = skb_put(event->skb, strlen(event->action) + 2);
@@ -1161,7 +1206,7 @@ static void hotplug_button(struct work_struct *work)
        fill_event(event);
 
        NETLINK_CB(event->skb).dst_group = 1;
-       netlink_broadcast(uevent_sock, event->skb, 0, 1, GFP_KERNEL);
+       broadcast_uevent(event->skb, 0, 1, GFP_KERNEL);
 
        kfree(event);
 }
@@ -1192,12 +1237,12 @@ static irqreturn_t button_handler(int irq, void *dev_id)
        struct button_t *b;
        u32 in, changed;
 
-       in = gpio_in() & platform.button_mask;
-       gpio_intpolarity(platform.button_mask, in);
+       in = ssb_gpio_in(&ssb_bcm47xx, ~0) & platform.button_mask;
+       ssb_gpio_polarity(&ssb_bcm47xx, platform.button_mask, in);
        changed = platform.button_polarity ^ in;
        platform.button_polarity = in;
 
-       changed &= ~gpio_outen(0, 0);
+       changed &= ~ssb_gpio_outen(&ssb_bcm47xx, 0, 0);
 
        for (b = platform.buttons; b->name; b++) {
                struct event_t *event;
@@ -1253,10 +1298,10 @@ static void register_leds(struct led_t *l)
                }
        }
 
-       gpio_outen(mask, oe_mask);
-       gpio_control(mask, 0);
-       gpio_out(mask, val);
-       gpio_setintmask(mask, 0);
+       ssb_gpio_outen(&ssb_bcm47xx, mask, oe_mask);
+       ssb_gpio_control(&ssb_bcm47xx, mask, 0);
+       ssb_gpio_out(&ssb_bcm47xx, mask, val);
+       ssb_gpio_intmask(&ssb_bcm47xx, mask, 0);
 }
 
 static void unregister_leds(struct led_t *l)
@@ -1291,11 +1336,11 @@ static void led_flash(unsigned long dummy) {
 
        mask &= ~gpiomask;
        if (mask) {
-               u32 val = ~gpio_in();
+               u32 val = ~ssb_gpio_in(&ssb_bcm47xx, ~0);
 
-               gpio_outen(mask, mask);
-               gpio_control(mask, 0);
-               gpio_out(mask, val);
+               ssb_gpio_outen(&ssb_bcm47xx, mask, mask);
+               ssb_gpio_control(&ssb_bcm47xx, mask, 0);
+               ssb_gpio_out(&ssb_bcm47xx, mask, val);
        }
        if (mask || extif_blink) {
                mod_timer(&led_timer, jiffies + FLASH_TIME);
@@ -1322,7 +1367,7 @@ static ssize_t diag_proc_read(struct file *file, char *buf, size_t count, loff_t
                                        if (led->gpio & GPIO_TYPE_EXTIF) {
                                                len = sprintf(page, "%d\n", led->state);
                                        } else {
-                                               u32 in = (gpio_in() & led->gpio ? 1 : 0);
+                                               u32 in = (ssb_gpio_in(&ssb_bcm47xx, ~0) & led->gpio ? 1 : 0);
                                                u8 p = (led->polarity == NORMAL ? 0 : 1);
                                                len = sprintf(page, "%d\n", ((in ^ p) ? 1 : 0));
                                        }
@@ -1386,9 +1431,9 @@ static ssize_t diag_proc_write(struct file *file, const char *buf, size_t count,
                                                led->state = p ^ ((page[0] == '1') ? 1 : 0);
                                                set_led_extif(led);
                                        } else {
-                                               gpio_outen(led->gpio, led->gpio);
-                                               gpio_control(led->gpio, 0);
-                                               gpio_out(led->gpio, ((p ^ (page[0] == '1')) ? led->gpio : 0));
+                                               ssb_gpio_outen(&ssb_bcm47xx, led->gpio, led->gpio);
+                                               ssb_gpio_control(&ssb_bcm47xx, led->gpio, 0);
+                                               ssb_gpio_out(&ssb_bcm47xx, led->gpio, ((p ^ (page[0] == '1')) ? led->gpio : 0));
                                        }
                                }
                                break;
@@ -1419,6 +1464,13 @@ static int __init diag_init(void)
        static struct proc_dir_entry *p;
        static struct platform_t *detected;
 
+#ifdef CONFIG_BCM47XX_SSB
+       if (bcm47xx_active_bus_type != BCM47XX_BUS_TYPE_SSB) {
+               printk(MODULE_NAME ": bcma bus is not supported.\n");
+               return -ENODEV;
+       }
+#endif
+
        detected = platform_detect();
        if (!detected) {
                printk(MODULE_NAME ": Router model not detected.\n");