fix i2c-falcon kmod package selection
[openwrt.git] / package / broadcom-diag / src / diag.c
index 766a906..8e7ffa6 100644 (file)
@@ -110,6 +110,7 @@ enum {
 
        /* Netgear */
        WGT634U,
+       WNR834BV1,
        WNR834BV2,
 
        /* Trendware */
@@ -138,6 +139,9 @@ enum {
 
        /* Microsoft */
        MN700,
+
+       /* Edimax */
+       PS1208MFG,
 };
 
 static void __init bcm4780_init(void) {
@@ -145,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);
@@ -157,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();
 }
@@ -173,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[] = {
@@ -755,8 +759,19 @@ 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",
+               .name           = "Netgear WNR834B V2",
                .buttons        = {
                        { .name = "reset",      .gpio = 1 << 6 },
                },
@@ -782,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
@@ -896,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)
@@ -1047,10 +1072,11 @@ static struct platform_t __init *platform_detect(void)
                        return &platforms[WDNetCenter];
                }
 
-               if ((!strcmp(boardnum, "08") || !strcmp(boardnum, "01")) &&
-                               !strcmp(boardtype,"0x0472") && !strcmp(getvar("cardbus"), "1")) { /* Netgear WNR834B  V1 and V2*/
-                       /* TODO: Check for version. Default platform is V2 for now. */
-                       return &platforms[WNR834BV2];
+               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 */
@@ -1122,9 +1148,13 @@ static struct platform_t __init *platform_detect(void)
        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;
 }
@@ -1136,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);
 }
@@ -1207,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;
@@ -1268,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)
@@ -1306,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);
@@ -1337,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));
                                        }
@@ -1401,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;
@@ -1434,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");
This page took 0.034089 seconds and 4 git commands to generate.