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