linux/drivers/spi/spi-pxa2xx-pci.c
<<
>>
Prefs
   1/*
   2 * CE4100's SPI device is more or less the same one as found on PXA
   3 *
   4 */
   5#include <linux/pci.h>
   6#include <linux/platform_device.h>
   7#include <linux/of_device.h>
   8#include <linux/module.h>
   9#include <linux/spi/pxa2xx_spi.h>
  10
  11struct ce4100_info {
  12        struct ssp_device ssp;
  13        struct platform_device *spi_pdev;
  14};
  15
  16static DEFINE_MUTEX(ssp_lock);
  17static LIST_HEAD(ssp_list);
  18
  19struct ssp_device *pxa_ssp_request(int port, const char *label)
  20{
  21        struct ssp_device *ssp = NULL;
  22
  23        mutex_lock(&ssp_lock);
  24
  25        list_for_each_entry(ssp, &ssp_list, node) {
  26                if (ssp->port_id == port && ssp->use_count == 0) {
  27                        ssp->use_count++;
  28                        ssp->label = label;
  29                        break;
  30                }
  31        }
  32
  33        mutex_unlock(&ssp_lock);
  34
  35        if (&ssp->node == &ssp_list)
  36                return NULL;
  37
  38        return ssp;
  39}
  40EXPORT_SYMBOL_GPL(pxa_ssp_request);
  41
  42void pxa_ssp_free(struct ssp_device *ssp)
  43{
  44        mutex_lock(&ssp_lock);
  45        if (ssp->use_count) {
  46                ssp->use_count--;
  47                ssp->label = NULL;
  48        } else
  49                dev_err(&ssp->pdev->dev, "device already free\n");
  50        mutex_unlock(&ssp_lock);
  51}
  52EXPORT_SYMBOL_GPL(pxa_ssp_free);
  53
  54static int ce4100_spi_probe(struct pci_dev *dev,
  55                const struct pci_device_id *ent)
  56{
  57        int ret;
  58        resource_size_t phys_beg;
  59        resource_size_t phys_len;
  60        struct ce4100_info *spi_info;
  61        struct platform_device *pdev;
  62        struct pxa2xx_spi_master spi_pdata;
  63        struct ssp_device *ssp;
  64
  65        ret = pci_enable_device(dev);
  66        if (ret)
  67                return ret;
  68
  69        phys_beg = pci_resource_start(dev, 0);
  70        phys_len = pci_resource_len(dev, 0);
  71
  72        if (!request_mem_region(phys_beg, phys_len,
  73                                "CE4100 SPI")) {
  74                dev_err(&dev->dev, "Can't request register space.\n");
  75                ret = -EBUSY;
  76                return ret;
  77        }
  78
  79        pdev = platform_device_alloc("pxa2xx-spi", dev->devfn);
  80        spi_info = kzalloc(sizeof(*spi_info), GFP_KERNEL);
  81        if (!pdev || !spi_info ) {
  82                ret = -ENOMEM;
  83                goto err_nomem;
  84        }
  85        memset(&spi_pdata, 0, sizeof(spi_pdata));
  86        spi_pdata.num_chipselect = dev->devfn;
  87
  88        ret = platform_device_add_data(pdev, &spi_pdata, sizeof(spi_pdata));
  89        if (ret)
  90                goto err_nomem;
  91
  92        pdev->dev.parent = &dev->dev;
  93        pdev->dev.of_node = dev->dev.of_node;
  94        ssp = &spi_info->ssp;
  95        ssp->phys_base = pci_resource_start(dev, 0);
  96        ssp->mmio_base = ioremap(phys_beg, phys_len);
  97        if (!ssp->mmio_base) {
  98                dev_err(&pdev->dev, "failed to ioremap() registers\n");
  99                ret = -EIO;
 100                goto err_nomem;
 101        }
 102        ssp->irq = dev->irq;
 103        ssp->port_id = pdev->id;
 104        ssp->type = PXA25x_SSP;
 105
 106        mutex_lock(&ssp_lock);
 107        list_add(&ssp->node, &ssp_list);
 108        mutex_unlock(&ssp_lock);
 109
 110        pci_set_drvdata(dev, spi_info);
 111
 112        ret = platform_device_add(pdev);
 113        if (ret)
 114                goto err_dev_add;
 115
 116        return ret;
 117
 118err_dev_add:
 119        pci_set_drvdata(dev, NULL);
 120        mutex_lock(&ssp_lock);
 121        list_del(&ssp->node);
 122        mutex_unlock(&ssp_lock);
 123        iounmap(ssp->mmio_base);
 124
 125err_nomem:
 126        release_mem_region(phys_beg, phys_len);
 127        platform_device_put(pdev);
 128        kfree(spi_info);
 129        return ret;
 130}
 131
 132static void ce4100_spi_remove(struct pci_dev *dev)
 133{
 134        struct ce4100_info *spi_info;
 135        struct ssp_device *ssp;
 136
 137        spi_info = pci_get_drvdata(dev);
 138        ssp = &spi_info->ssp;
 139        platform_device_unregister(spi_info->spi_pdev);
 140
 141        iounmap(ssp->mmio_base);
 142        release_mem_region(pci_resource_start(dev, 0),
 143                        pci_resource_len(dev, 0));
 144
 145        mutex_lock(&ssp_lock);
 146        list_del(&ssp->node);
 147        mutex_unlock(&ssp_lock);
 148
 149        pci_set_drvdata(dev, NULL);
 150        pci_disable_device(dev);
 151        kfree(spi_info);
 152}
 153
 154static DEFINE_PCI_DEVICE_TABLE(ce4100_spi_devices) = {
 155        { PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x2e6a) },
 156        { },
 157};
 158MODULE_DEVICE_TABLE(pci, ce4100_spi_devices);
 159
 160static struct pci_driver ce4100_spi_driver = {
 161        .name           = "ce4100_spi",
 162        .id_table       = ce4100_spi_devices,
 163        .probe          = ce4100_spi_probe,
 164        .remove         = ce4100_spi_remove,
 165};
 166
 167module_pci_driver(ce4100_spi_driver);
 168
 169MODULE_DESCRIPTION("CE4100 PCI-SPI glue code for PXA's driver");
 170MODULE_LICENSE("GPL v2");
 171MODULE_AUTHOR("Sebastian Andrzej Siewior <bigeasy@linutronix.de>");
 172
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.