From: Joachim Eastwood <manab...@gmail.com>

Signed-off-by: Joachim Eastwood <manab...@gmail.com>
Signed-off-by: Nicolas Ferre <nicolas.fe...@atmel.com>
---
 drivers/pcmcia/at91_cf.c | 77 +++++++++++++++---------------------------------
 1 file changed, 24 insertions(+), 53 deletions(-)

diff --git a/drivers/pcmcia/at91_cf.c b/drivers/pcmcia/at91_cf.c
index 4eec14b..43bc342 100644
--- a/drivers/pcmcia/at91_cf.c
+++ b/drivers/pcmcia/at91_cf.c
@@ -227,7 +227,7 @@ static int __init at91_cf_probe(struct platform_device 
*pdev)
        if (!io)
                return -ENODEV;
 
-       cf = kzalloc(sizeof *cf, GFP_KERNEL);
+       cf = devm_kzalloc(&pdev->dev, sizeof(*cf), GFP_KERNEL);
        if (!cf)
                return -ENOMEM;
 
@@ -237,22 +237,25 @@ static int __init at91_cf_probe(struct platform_device 
*pdev)
        platform_set_drvdata(pdev, cf);
 
        /* must be a GPIO; ergo must trigger on both edges */
-       status = gpio_request(board->det_pin, "cf_det");
+       status = devm_gpio_request(&pdev->dev, board->det_pin, "cf_det");
        if (status < 0)
-               goto fail0;
-       status = request_irq(gpio_to_irq(board->det_pin), at91_cf_irq, 0, 
"at91_cf detect", cf);
+               return status;
+
+       status = devm_request_irq(&pdev->dev, gpio_to_irq(board->det_pin),
+                                       at91_cf_irq, 0, "at91_cf detect", cf);
        if (status < 0)
-               goto fail00;
+               return status;
+
        device_init_wakeup(&pdev->dev, 1);
 
-       status = gpio_request(board->rst_pin, "cf_rst");
+       status = devm_gpio_request(&pdev->dev, board->rst_pin, "cf_rst");
        if (status < 0)
                goto fail0a;
 
        if (gpio_is_valid(board->vcc_pin)) {
-               status = gpio_request(board->vcc_pin, "cf_vcc");
+               status = devm_gpio_request(&pdev->dev, board->vcc_pin, 
"cf_vcc");
                if (status < 0)
-                       goto fail0b;
+                       goto fail0a;
        }
 
        /*
@@ -262,29 +265,30 @@ static int __init at91_cf_probe(struct platform_device 
*pdev)
         * (Note:  DK board doesn't wire the IRQ pin...)
         */
        if (gpio_is_valid(board->irq_pin)) {
-               status = gpio_request(board->irq_pin, "cf_irq");
+               status = devm_gpio_request(&pdev->dev, board->irq_pin, 
"cf_irq");
                if (status < 0)
-                       goto fail0c;
-               status = request_irq(gpio_to_irq(board->irq_pin), at91_cf_irq,
-                               IRQF_SHARED, "at91_cf", cf);
+                       goto fail0a;
+
+               status = devm_request_irq(&pdev->dev, 
gpio_to_irq(board->irq_pin),
+                                       at91_cf_irq, IRQF_SHARED, "at91_cf", 
cf);
                if (status < 0)
-                       goto fail0d;
+                       goto fail0a;
                cf->socket.pci_irq = gpio_to_irq(board->irq_pin);
        } else
                cf->socket.pci_irq = nr_irqs + 1;
 
        /* pcmcia layer only remaps "real" memory not iospace */
-       cf->socket.io_offset = (unsigned long)
-                       ioremap(cf->phys_baseaddr + CF_IO_PHYS, SZ_2K);
+       cf->socket.io_offset = (unsigned long) devm_ioremap(&pdev->dev,
+                                       cf->phys_baseaddr + CF_IO_PHYS, SZ_2K);
        if (!cf->socket.io_offset) {
                status = -ENXIO;
-               goto fail1;
+               goto fail0a;
        }
 
        /* reserve chip-select regions */
-       if (!request_mem_region(io->start, resource_size(io), "at91_cf")) {
+       if (!devm_request_mem_region(&pdev->dev, io->start, resource_size(io), 
"at91_cf")) {
                status = -ENXIO;
-               goto fail1;
+               goto fail0a;
        }
 
        dev_info(&pdev->dev, "irqs det #%d, io #%d\n",
@@ -301,55 +305,22 @@ static int __init at91_cf_probe(struct platform_device 
*pdev)
 
        status = pcmcia_register_socket(&cf->socket);
        if (status < 0)
-               goto fail2;
+               goto fail0a;
 
        return 0;
 
-fail2:
-       release_mem_region(io->start, resource_size(io));
-fail1:
-       if (cf->socket.io_offset)
-               iounmap((void __iomem *) cf->socket.io_offset);
-       if (gpio_is_valid(board->irq_pin)) {
-               free_irq(gpio_to_irq(board->irq_pin), cf);
-fail0d:
-               gpio_free(board->irq_pin);
-       }
-fail0c:
-       if (gpio_is_valid(board->vcc_pin))
-               gpio_free(board->vcc_pin);
-fail0b:
-       gpio_free(board->rst_pin);
 fail0a:
        device_init_wakeup(&pdev->dev, 0);
-       free_irq(gpio_to_irq(board->det_pin), cf);
-fail00:
-       gpio_free(board->det_pin);
-fail0:
-       kfree(cf);
        return status;
 }
 
 static int __exit at91_cf_remove(struct platform_device *pdev)
 {
        struct at91_cf_socket   *cf = platform_get_drvdata(pdev);
-       struct at91_cf_data     *board = cf->board;
-       struct resource         *io = cf->socket.io[0].res;
 
        pcmcia_unregister_socket(&cf->socket);
-       release_mem_region(io->start, resource_size(io));
-       iounmap((void __iomem *) cf->socket.io_offset);
-       if (gpio_is_valid(board->irq_pin)) {
-               free_irq(gpio_to_irq(board->irq_pin), cf);
-               gpio_free(board->irq_pin);
-       }
-       if (gpio_is_valid(board->vcc_pin))
-               gpio_free(board->vcc_pin);
-       gpio_free(board->rst_pin);
        device_init_wakeup(&pdev->dev, 0);
-       free_irq(gpio_to_irq(board->det_pin), cf);
-       gpio_free(board->det_pin);
-       kfree(cf);
+
        return 0;
 }
 
-- 
1.8.2.2


_______________________________________________
Linux PCMCIA reimplementation list
http://lists.infradead.org/mailman/listinfo/linux-pcmcia

Reply via email to