SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/spi/dw_spi_mmio.c

   1 /*
   2  * dw_spi_mmio.c - Memory-mapped interface driver for DW SPI Core
   3  *
   4  * Copyright (c) 2010, Octasic semiconductor.
   5  *
   6  * This program is free software; you can redistribute it and/or modify it
   7  * under the terms and conditions of the GNU General Public License,
   8  * version 2, as published by the Free Software Foundation.
   9  */
  10
  11 #include <linux/clk.h>
  12 #include <linux/interrupt.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/spi/dw_spi.h>
  15 #include <linux/spi/spi.h>
  16
  17 #define DRIVER_NAME "dw_spi_mmio"
  18
  19 struct dw_spi_mmio {
  20         struct dw_spi  dws;
  21         struct clk     *clk;
  22 };
  23
  24 static int __devinit dw_spi_mmio_probe(struct platform_device *pdev)
  25 {
  26         struct dw_spi_mmio *dwsmmio;
  27         struct dw_spi *dws;
  28         struct resource *mem, *ioarea;
  29         int ret;
  30
  31         dwsmmio = kzalloc(sizeof(struct dw_spi_mmio), GFP_KERNEL);
  32         if (!dwsmmio) {
  33                 ret = -ENOMEM;
  34                 goto err_end;
  35         }
  36
  37         dws = &dwsmmio->dws;
  38
  39         /* Get basic io resource and map it */
  40         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  41         if (!mem) {
  42                 dev_err(&pdev->dev, "no mem resource?\n");
  43                 ret = -EINVAL;
  44                 goto err_kfree;
  45         }
  46
  47         ioarea = request_mem_region(mem->start, resource_size(mem),
  48                         pdev->name);
  49         if (!ioarea) {
  50                 dev_err(&pdev->dev, "SPI region already claimed\n");
  51                 ret = -EBUSY;
  52                 goto err_kfree;
  53         }
  54
  55         dws->regs = ioremap_nocache(mem->start, resource_size(mem));
  56         if (!dws->regs) {
  57                 dev_err(&pdev->dev, "SPI region already mapped\n");
  58                 ret = -ENOMEM;
  59                 goto err_release_reg;
  60         }
  61
  62         dws->irq = platform_get_irq(pdev, 0);
  63         if (dws->irq < 0) {
  64                 dev_err(&pdev->dev, "no irq resource?\n");
  65                 ret = dws->irq; /* -ENXIO */
  66                 goto err_unmap;
  67         }
  68
  69         dwsmmio->clk = clk_get(&pdev->dev, NULL);
  70         if (!dwsmmio->clk) {
  71                 ret = -ENODEV;
  72                 goto err_irq;
  73         }
  74         clk_enable(dwsmmio->clk);
  75
  76         dws->parent_dev = &pdev->dev;
  77         dws->bus_num = 0;
  78         dws->num_cs = 4;
  79         dws->max_freq = clk_get_rate(dwsmmio->clk);
  80
  81         ret = dw_spi_add_host(dws);
  82         if (ret)
  83                 goto err_clk;
  84
  85         platform_set_drvdata(pdev, dwsmmio);
  86         return 0;
  87
  88 err_clk:
  89         clk_disable(dwsmmio->clk);
  90         clk_put(dwsmmio->clk);
  91         dwsmmio->clk = NULL;
  92 err_irq:
  93         free_irq(dws->irq, dws);
  94 err_unmap:
  95         iounmap(dws->regs);
  96 err_release_reg:
  97         release_mem_region(mem->start, resource_size(mem));
  98 err_kfree:
  99         kfree(dwsmmio);
 100 err_end:
 101         return ret;
 102 }
 103
 104 static int __devexit dw_spi_mmio_remove(struct platform_device *pdev)
 105 {
 106         struct dw_spi_mmio *dwsmmio = platform_get_drvdata(pdev);
 107         struct resource *mem;
 108
 109         platform_set_drvdata(pdev, NULL);
 110
 111         clk_disable(dwsmmio->clk);
 112         clk_put(dwsmmio->clk);
 113         dwsmmio->clk = NULL;
 114
 115         free_irq(dwsmmio->dws.irq, &dwsmmio->dws);
 116         dw_spi_remove_host(&dwsmmio->dws);
 117         iounmap(dwsmmio->dws.regs);
 118         kfree(dwsmmio);
 119
 120         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 121         release_mem_region(mem->start, resource_size(mem));
 122         return 0;
 123 }
 124
 125 static struct platform_driver dw_spi_mmio_driver = {
 126         .remove         = __devexit_p(dw_spi_mmio_remove),
 127         .driver         = {
 128                 .name   = DRIVER_NAME,
 129                 .owner  = THIS_MODULE,
 130         },
 131 };
 132
 133 static int __init dw_spi_mmio_init(void)
 134 {
 135         return platform_driver_probe(&dw_spi_mmio_driver, dw_spi_mmio_probe);
 136 }
 137 module_init(dw_spi_mmio_init);
 138
 139 static void __exit dw_spi_mmio_exit(void)
 140 {
 141         platform_driver_unregister(&dw_spi_mmio_driver);
 142 }
 143 module_exit(dw_spi_mmio_exit);
 144
 145 MODULE_AUTHOR("Jean-Hugues Deschenes <jean-hugues.deschenes@octasic.com>");
 146 MODULE_DESCRIPTION("Memory-mapped I/O interface driver for DW SPI Core");
 147 MODULE_LICENSE("GPL v2");