1
2
3
4
5
6
7
8#include "bcma_private.h"
9#include <linux/slab.h>
10#include <linux/bcma/bcma.h>
11#include <linux/pci.h>
12#include <linux/module.h>
13
14static void bcma_host_pci_switch_core(struct bcma_device *core)
15{
16 pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN,
17 core->addr);
18 pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN2,
19 core->wrap);
20 core->bus->mapped_core = core;
21 bcma_debug(core->bus, "Switched to core: 0x%X\n", core->id.id);
22}
23
24
25
26static u16 bcma_host_pci_provide_access_to_core(struct bcma_device *core)
27{
28 switch (core->id.id) {
29 case BCMA_CORE_CHIPCOMMON:
30 return 3 * BCMA_CORE_SIZE;
31 case BCMA_CORE_PCIE:
32 return 2 * BCMA_CORE_SIZE;
33 }
34
35 if (core->bus->mapped_core != core)
36 bcma_host_pci_switch_core(core);
37 return 0;
38}
39
40static u8 bcma_host_pci_read8(struct bcma_device *core, u16 offset)
41{
42 offset += bcma_host_pci_provide_access_to_core(core);
43 return ioread8(core->bus->mmio + offset);
44}
45
46static u16 bcma_host_pci_read16(struct bcma_device *core, u16 offset)
47{
48 offset += bcma_host_pci_provide_access_to_core(core);
49 return ioread16(core->bus->mmio + offset);
50}
51
52static u32 bcma_host_pci_read32(struct bcma_device *core, u16 offset)
53{
54 offset += bcma_host_pci_provide_access_to_core(core);
55 return ioread32(core->bus->mmio + offset);
56}
57
58static void bcma_host_pci_write8(struct bcma_device *core, u16 offset,
59 u8 value)
60{
61 offset += bcma_host_pci_provide_access_to_core(core);
62 iowrite8(value, core->bus->mmio + offset);
63}
64
65static void bcma_host_pci_write16(struct bcma_device *core, u16 offset,
66 u16 value)
67{
68 offset += bcma_host_pci_provide_access_to_core(core);
69 iowrite16(value, core->bus->mmio + offset);
70}
71
72static void bcma_host_pci_write32(struct bcma_device *core, u16 offset,
73 u32 value)
74{
75 offset += bcma_host_pci_provide_access_to_core(core);
76 iowrite32(value, core->bus->mmio + offset);
77}
78
79#ifdef CONFIG_BCMA_BLOCKIO
80static void bcma_host_pci_block_read(struct bcma_device *core, void *buffer,
81 size_t count, u16 offset, u8 reg_width)
82{
83 void __iomem *addr = core->bus->mmio + offset;
84 if (core->bus->mapped_core != core)
85 bcma_host_pci_switch_core(core);
86 switch (reg_width) {
87 case sizeof(u8):
88 ioread8_rep(addr, buffer, count);
89 break;
90 case sizeof(u16):
91 WARN_ON(count & 1);
92 ioread16_rep(addr, buffer, count >> 1);
93 break;
94 case sizeof(u32):
95 WARN_ON(count & 3);
96 ioread32_rep(addr, buffer, count >> 2);
97 break;
98 default:
99 WARN_ON(1);
100 }
101}
102
103static void bcma_host_pci_block_write(struct bcma_device *core,
104 const void *buffer, size_t count,
105 u16 offset, u8 reg_width)
106{
107 void __iomem *addr = core->bus->mmio + offset;
108 if (core->bus->mapped_core != core)
109 bcma_host_pci_switch_core(core);
110 switch (reg_width) {
111 case sizeof(u8):
112 iowrite8_rep(addr, buffer, count);
113 break;
114 case sizeof(u16):
115 WARN_ON(count & 1);
116 iowrite16_rep(addr, buffer, count >> 1);
117 break;
118 case sizeof(u32):
119 WARN_ON(count & 3);
120 iowrite32_rep(addr, buffer, count >> 2);
121 break;
122 default:
123 WARN_ON(1);
124 }
125}
126#endif
127
128static u32 bcma_host_pci_aread32(struct bcma_device *core, u16 offset)
129{
130 if (core->bus->mapped_core != core)
131 bcma_host_pci_switch_core(core);
132 return ioread32(core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
133}
134
135static void bcma_host_pci_awrite32(struct bcma_device *core, u16 offset,
136 u32 value)
137{
138 if (core->bus->mapped_core != core)
139 bcma_host_pci_switch_core(core);
140 iowrite32(value, core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
141}
142
143static const struct bcma_host_ops bcma_host_pci_ops = {
144 .read8 = bcma_host_pci_read8,
145 .read16 = bcma_host_pci_read16,
146 .read32 = bcma_host_pci_read32,
147 .write8 = bcma_host_pci_write8,
148 .write16 = bcma_host_pci_write16,
149 .write32 = bcma_host_pci_write32,
150#ifdef CONFIG_BCMA_BLOCKIO
151 .block_read = bcma_host_pci_block_read,
152 .block_write = bcma_host_pci_block_write,
153#endif
154 .aread32 = bcma_host_pci_aread32,
155 .awrite32 = bcma_host_pci_awrite32,
156};
157
158static int bcma_host_pci_probe(struct pci_dev *dev,
159 const struct pci_device_id *id)
160{
161 struct bcma_bus *bus;
162 int err = -ENOMEM;
163 const char *name;
164 u32 val;
165
166
167 bus = kzalloc(sizeof(*bus), GFP_KERNEL);
168 if (!bus)
169 goto out;
170
171
172 err = pci_enable_device(dev);
173 if (err)
174 goto err_kfree_bus;
175
176 name = dev_name(&dev->dev);
177 if (dev->driver && dev->driver->name)
178 name = dev->driver->name;
179 err = pci_request_regions(dev, name);
180 if (err)
181 goto err_pci_disable;
182 pci_set_master(dev);
183
184
185
186 pci_read_config_dword(dev, 0x40, &val);
187 if ((val & 0x0000ff00) != 0)
188 pci_write_config_dword(dev, 0x40, val & 0xffff00ff);
189
190
191 if (!pci_is_pcie(dev)) {
192 bcma_err(bus, "PCI card detected, they are not supported.\n");
193 err = -ENXIO;
194 goto err_pci_release_regions;
195 }
196
197
198 err = -ENOMEM;
199 bus->mmio = pci_iomap(dev, 0, ~0UL);
200 if (!bus->mmio)
201 goto err_pci_release_regions;
202
203
204 bus->host_pci = dev;
205 bus->hosttype = BCMA_HOSTTYPE_PCI;
206 bus->ops = &bcma_host_pci_ops;
207
208 bus->boardinfo.vendor = bus->host_pci->subsystem_vendor;
209 bus->boardinfo.type = bus->host_pci->subsystem_device;
210
211
212 err = bcma_bus_register(bus);
213 if (err)
214 goto err_pci_unmap_mmio;
215
216 pci_set_drvdata(dev, bus);
217
218out:
219 return err;
220
221err_pci_unmap_mmio:
222 pci_iounmap(dev, bus->mmio);
223err_pci_release_regions:
224 pci_release_regions(dev);
225err_pci_disable:
226 pci_disable_device(dev);
227err_kfree_bus:
228 kfree(bus);
229 return err;
230}
231
232static void bcma_host_pci_remove(struct pci_dev *dev)
233{
234 struct bcma_bus *bus = pci_get_drvdata(dev);
235
236 bcma_bus_unregister(bus);
237 pci_iounmap(dev, bus->mmio);
238 pci_release_regions(dev);
239 pci_disable_device(dev);
240 kfree(bus);
241 pci_set_drvdata(dev, NULL);
242}
243
244#ifdef CONFIG_PM_SLEEP
245static int bcma_host_pci_suspend(struct device *dev)
246{
247 struct pci_dev *pdev = to_pci_dev(dev);
248 struct bcma_bus *bus = pci_get_drvdata(pdev);
249
250 bus->mapped_core = NULL;
251
252 return bcma_bus_suspend(bus);
253}
254
255static int bcma_host_pci_resume(struct device *dev)
256{
257 struct pci_dev *pdev = to_pci_dev(dev);
258 struct bcma_bus *bus = pci_get_drvdata(pdev);
259
260 return bcma_bus_resume(bus);
261}
262
263static SIMPLE_DEV_PM_OPS(bcma_pm_ops, bcma_host_pci_suspend,
264 bcma_host_pci_resume);
265#define BCMA_PM_OPS (&bcma_pm_ops)
266
267#else
268
269#define BCMA_PM_OPS NULL
270
271#endif
272
273static DEFINE_PCI_DEVICE_TABLE(bcma_pci_bridge_tbl) = {
274 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x0576) },
275 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4313) },
276 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 43224) },
277 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4331) },
278 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4353) },
279 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4357) },
280 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4358) },
281 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4359) },
282 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4365) },
283 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4727) },
284 { 0, },
285};
286MODULE_DEVICE_TABLE(pci, bcma_pci_bridge_tbl);
287
288static struct pci_driver bcma_pci_bridge_driver = {
289 .name = "bcma-pci-bridge",
290 .id_table = bcma_pci_bridge_tbl,
291 .probe = bcma_host_pci_probe,
292 .remove = bcma_host_pci_remove,
293 .driver.pm = BCMA_PM_OPS,
294};
295
296int __init bcma_host_pci_init(void)
297{
298 return pci_register_driver(&bcma_pci_bridge_driver);
299}
300
301void __exit bcma_host_pci_exit(void)
302{
303 pci_unregister_driver(&bcma_pci_bridge_driver);
304}
305
