request gpio pins and set direction correctly for pcmcia
authorFlorian Fainelli <florian@openwrt.org>
Thu, 4 Jun 2009 10:03:03 +0000 (10:03 +0000)
committerFlorian Fainelli <florian@openwrt.org>
Thu, 4 Jun 2009 10:03:03 +0000 (10:03 +0000)
SVN-Revision: 16332

target/linux/brcm63xx/files/drivers/pcmcia/bcm63xx_pcmcia.c

index 94a776273d806694d19b99e468ae7558050950fc..19b05fce0c4a2ee7f53045f0badd72ec77de05dd 100644 (file)
@@ -409,9 +409,18 @@ static int bcm63xx_drv_pcmcia_probe(struct platform_device *pdev)
        val |= 3 << PCMCIA_C2_HOLD_SHIFT;
        pcmcia_writel(skt, val, PCMCIA_C2_REG);
 
+       /* request and setup ready gpio */
+       ret = gpio_request(skt->pd->ready_gpio, "bcm63xx_pcmcia");
+       if (ret < 0)
+               goto err;
+
+       ret = gpio_direction_input(skt->pd->ready_gpio);
+       if (ret < 0)
+               goto err_gpio;
+
        ret = pcmcia_register_socket(sock);
        if (ret)
-               goto err;
+               goto err_gpio;
 
        /* start polling socket */
        mod_timer(&skt->timer,
@@ -420,6 +429,9 @@ static int bcm63xx_drv_pcmcia_probe(struct platform_device *pdev)
        platform_set_drvdata(pdev, skt);
        return 0;
 
+err_gpio:
+       gpio_free(skt->pd->ready_gpio);
+
 err:
        if (skt->io_base)
                iounmap(skt->io_base);
@@ -442,6 +454,7 @@ static int bcm63xx_drv_pcmcia_remove(struct platform_device *pdev)
        iounmap(skt->io_base);
        res = skt->reg_res;
        release_mem_region(res->start, res->end - res->start + 1);
+       gpio_free(skt->pd->ready_gpio);
        kfree(skt);
        return 0;
 }