1
2
3
4
5
6
7
8
9
10
11
12#include <linux/usb.h>
13#include <linux/io.h>
14#include <linux/module.h>
15#include <linux/platform_device.h>
16#include <linux/usb/isp1760.h>
17#include <linux/usb/hcd.h>
18
19#include "isp1760-hcd.h"
20
21#if defined(CONFIG_OF) && defined(CONFIG_OF_IRQ)
22#include <linux/slab.h>
23#include <linux/of.h>
24#include <linux/of_platform.h>
25#include <linux/of_address.h>
26#include <linux/of_irq.h>
27#include <linux/of_gpio.h>
28#endif
29
30#ifdef CONFIG_PCI
31#include <linux/pci.h>
32#endif
33
34#if defined(CONFIG_OF) && defined(CONFIG_OF_IRQ)
35struct isp1760 {
36 struct usb_hcd *hcd;
37 int rst_gpio;
38};
39
40static int of_isp1760_probe(struct platform_device *dev)
41{
42 struct isp1760 *drvdata;
43 struct device_node *dp = dev->dev.of_node;
44 struct resource *res;
45 struct resource memory;
46 struct of_irq oirq;
47 int virq;
48 resource_size_t res_len;
49 int ret;
50 unsigned int devflags = 0;
51 enum of_gpio_flags gpio_flags;
52 u32 bus_width = 0;
53
54 drvdata = kzalloc(sizeof(*drvdata), GFP_KERNEL);
55 if (!drvdata)
56 return -ENOMEM;
57
58 ret = of_address_to_resource(dp, 0, &memory);
59 if (ret) {
60 ret = -ENXIO;
61 goto free_data;
62 }
63
64 res_len = resource_size(&memory);
65
66 res = request_mem_region(memory.start, res_len, dev_name(&dev->dev));
67 if (!res) {
68 ret = -EBUSY;
69 goto free_data;
70 }
71
72 if (of_irq_map_one(dp, 0, &oirq)) {
73 ret = -ENODEV;
74 goto release_reg;
75 }
76
77 virq = irq_create_of_mapping(oirq.controller, oirq.specifier,
78 oirq.size);
79
80 if (of_device_is_compatible(dp, "nxp,usb-isp1761"))
81 devflags |= ISP1760_FLAG_ISP1761;
82
83
84 of_property_read_u32(dp, "bus-width", &bus_width);
85 if (bus_width == 16)
86 devflags |= ISP1760_FLAG_BUS_WIDTH_16;
87
88 if (of_get_property(dp, "port1-otg", NULL) != NULL)
89 devflags |= ISP1760_FLAG_OTG_EN;
90
91 if (of_get_property(dp, "analog-oc", NULL) != NULL)
92 devflags |= ISP1760_FLAG_ANALOG_OC;
93
94 if (of_get_property(dp, "dack-polarity", NULL) != NULL)
95 devflags |= ISP1760_FLAG_DACK_POL_HIGH;
96
97 if (of_get_property(dp, "dreq-polarity", NULL) != NULL)
98 devflags |= ISP1760_FLAG_DREQ_POL_HIGH;
99
100 drvdata->rst_gpio = of_get_gpio_flags(dp, 0, &gpio_flags);
101 if (gpio_is_valid(drvdata->rst_gpio)) {
102 ret = gpio_request(drvdata->rst_gpio, dev_name(&dev->dev));
103 if (!ret) {
104 if (!(gpio_flags & OF_GPIO_ACTIVE_LOW)) {
105 devflags |= ISP1760_FLAG_RESET_ACTIVE_HIGH;
106 gpio_direction_output(drvdata->rst_gpio, 0);
107 } else {
108 gpio_direction_output(drvdata->rst_gpio, 1);
109 }
110 } else {
111 drvdata->rst_gpio = ret;
112 }
113 }
114
115 drvdata->hcd = isp1760_register(memory.start, res_len, virq,
116 IRQF_SHARED, drvdata->rst_gpio,
117 &dev->dev, dev_name(&dev->dev),
118 devflags);
119 if (IS_ERR(drvdata->hcd)) {
120 ret = PTR_ERR(drvdata->hcd);
121 goto free_gpio;
122 }
123
124 dev_set_drvdata(&dev->dev, drvdata);
125 return ret;
126
127free_gpio:
128 if (gpio_is_valid(drvdata->rst_gpio))
129 gpio_free(drvdata->rst_gpio);
130release_reg:
131 release_mem_region(memory.start, res_len);
132free_data:
133 kfree(drvdata);
134 return ret;
135}
136
137static int of_isp1760_remove(struct platform_device *dev)
138{
139 struct isp1760 *drvdata = dev_get_drvdata(&dev->dev);
140
141 dev_set_drvdata(&dev->dev, NULL);
142
143 usb_remove_hcd(drvdata->hcd);
144 iounmap(drvdata->hcd->regs);
145 release_mem_region(drvdata->hcd->rsrc_start, drvdata->hcd->rsrc_len);
146 usb_put_hcd(drvdata->hcd);
147
148 if (gpio_is_valid(drvdata->rst_gpio))
149 gpio_free(drvdata->rst_gpio);
150
151 kfree(drvdata);
152 return 0;
153}
154
155static const struct of_device_id of_isp1760_match[] = {
156 {
157 .compatible = "nxp,usb-isp1760",
158 },
159 {
160 .compatible = "nxp,usb-isp1761",
161 },
162 { },
163};
164MODULE_DEVICE_TABLE(of, of_isp1760_match);
165
166static struct platform_driver isp1760_of_driver = {
167 .driver = {
168 .name = "nxp-isp1760",
169 .owner = THIS_MODULE,
170 .of_match_table = of_isp1760_match,
171 },
172 .probe = of_isp1760_probe,
173 .remove = of_isp1760_remove,
174};
175#endif
176
177#ifdef CONFIG_PCI
178static int __devinit isp1761_pci_probe(struct pci_dev *dev,
179 const struct pci_device_id *id)
180{
181 u8 latency, limit;
182 __u32 reg_data;
183 int retry_count;
184 struct usb_hcd *hcd;
185 unsigned int devflags = 0;
186 int ret_status = 0;
187
188 resource_size_t pci_mem_phy0;
189 resource_size_t memlength;
190
191 u8 __iomem *chip_addr;
192 u8 __iomem *iobase;
193 resource_size_t nxp_pci_io_base;
194 resource_size_t iolength;
195
196 if (usb_disabled())
197 return -ENODEV;
198
199 if (pci_enable_device(dev) < 0)
200 return -ENODEV;
201
202 if (!dev->irq)
203 return -ENODEV;
204
205
206 nxp_pci_io_base = pci_resource_start(dev, 0);
207 iolength = pci_resource_len(dev, 0);
208
209 if (!request_mem_region(nxp_pci_io_base, iolength, "ISP1761 IO MEM")) {
210 printk(KERN_ERR "request region #1\n");
211 return -EBUSY;
212 }
213
214 iobase = ioremap_nocache(nxp_pci_io_base, iolength);
215 if (!iobase) {
216 printk(KERN_ERR "ioremap #1\n");
217 ret_status = -ENOMEM;
218 goto cleanup1;
219 }
220
221 pci_mem_phy0 = pci_resource_start(dev, 3);
222 memlength = pci_resource_len(dev, 3);
223 if (memlength < 0xffff) {
224 printk(KERN_ERR "memory length for this resource is wrong\n");
225 ret_status = -ENOMEM;
226 goto cleanup2;
227 }
228
229 if (!request_mem_region(pci_mem_phy0, memlength, "ISP-PCI")) {
230 printk(KERN_ERR "host controller already in use\n");
231 ret_status = -EBUSY;
232 goto cleanup2;
233 }
234
235
236 chip_addr = ioremap_nocache(pci_mem_phy0,memlength);
237 if (!chip_addr) {
238 printk(KERN_ERR "Error ioremap failed\n");
239 ret_status = -ENOMEM;
240 goto cleanup3;
241 }
242
243
244 pci_read_config_byte(dev, PCI_LATENCY_TIMER, &latency);
245 if (latency) {
246 pci_read_config_byte(dev, PCI_MAX_LAT, &limit);
247 if (limit && limit < latency)
248 pci_write_config_byte(dev, PCI_LATENCY_TIMER, limit);
249 }
250
251
252
253
254
255 retry_count = 20;
256 reg_data = 0;
257 while ((reg_data != 0xFACE) && retry_count) {
258
259
260
261 writel(0xface, chip_addr + HC_SCRATCH_REG);
262 udelay(100);
263 reg_data = readl(chip_addr + HC_SCRATCH_REG) & 0x0000ffff;
264 retry_count--;
265 }
266
267 iounmap(chip_addr);
268
269
270
271
272 if (reg_data != 0xFACE) {
273 dev_err(&dev->dev, "scratch register mismatch %x\n", reg_data);
274 ret_status = -ENOMEM;
275 goto cleanup3;
276 }
277
278 pci_set_master(dev);
279
280
281#define PLX_INT_CSR_REG 0x68
282 reg_data = readl(iobase + PLX_INT_CSR_REG);
283 reg_data |= 0x900;
284 writel(reg_data, iobase + PLX_INT_CSR_REG);
285
286 dev->dev.dma_mask = NULL;
287 hcd = isp1760_register(pci_mem_phy0, memlength, dev->irq,
288 IRQF_SHARED, -ENOENT, &dev->dev, dev_name(&dev->dev),
289 devflags);
290 if (IS_ERR(hcd)) {
291 ret_status = -ENODEV;
292 goto cleanup3;
293 }
294
295
296 iounmap(iobase);
297 release_mem_region(nxp_pci_io_base, iolength);
298
299 pci_set_drvdata(dev, hcd);
300 return 0;
301
302cleanup3:
303 release_mem_region(pci_mem_phy0, memlength);
304cleanup2:
305 iounmap(iobase);
306cleanup1:
307 release_mem_region(nxp_pci_io_base, iolength);
308 return ret_status;
309}
310
311static void isp1761_pci_remove(struct pci_dev *dev)
312{
313 struct usb_hcd *hcd;
314
315 hcd = pci_get_drvdata(dev);
316
317 usb_remove_hcd(hcd);
318 iounmap(hcd->regs);
319 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
320 usb_put_hcd(hcd);
321
322 pci_disable_device(dev);
323}
324
325static void isp1761_pci_shutdown(struct pci_dev *dev)
326{
327 printk(KERN_ERR "ips1761_pci_shutdown\n");
328}
329
330static const struct pci_device_id isp1760_plx [] = {
331 {
332 .class = PCI_CLASS_BRIDGE_OTHER << 8,
333 .class_mask = ~0,
334 .vendor = PCI_VENDOR_ID_PLX,
335 .device = 0x5406,
336 .subvendor = PCI_VENDOR_ID_PLX,
337 .subdevice = 0x9054,
338 },
339 { }
340};
341MODULE_DEVICE_TABLE(pci, isp1760_plx);
342
343static struct pci_driver isp1761_pci_driver = {
344 .name = "isp1760",
345 .id_table = isp1760_plx,
346 .probe = isp1761_pci_probe,
347 .remove = isp1761_pci_remove,
348 .shutdown = isp1761_pci_shutdown,
349};
350#endif
351
352static int __devinit isp1760_plat_probe(struct platform_device *pdev)
353{
354 int ret = 0;
355 struct usb_hcd *hcd;
356 struct resource *mem_res;
357 struct resource *irq_res;
358 resource_size_t mem_size;
359 struct isp1760_platform_data *priv = pdev->dev.platform_data;
360 unsigned int devflags = 0;
361 unsigned long irqflags = IRQF_SHARED;
362
363 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
364 if (!mem_res) {
365 pr_warning("isp1760: Memory resource not available\n");
366 ret = -ENODEV;
367 goto out;
368 }
369 mem_size = resource_size(mem_res);
370 if (!request_mem_region(mem_res->start, mem_size, "isp1760")) {
371 pr_warning("isp1760: Cannot reserve the memory resource\n");
372 ret = -EBUSY;
373 goto out;
374 }
375
376 irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
377 if (!irq_res) {
378 pr_warning("isp1760: IRQ resource not available\n");
379 return -ENODEV;
380 }
381 irqflags |= irq_res->flags & IRQF_TRIGGER_MASK;
382
383 if (priv) {
384 if (priv->is_isp1761)
385 devflags |= ISP1760_FLAG_ISP1761;
386 if (priv->bus_width_16)
387 devflags |= ISP1760_FLAG_BUS_WIDTH_16;
388 if (priv->port1_otg)
389 devflags |= ISP1760_FLAG_OTG_EN;
390 if (priv->analog_oc)
391 devflags |= ISP1760_FLAG_ANALOG_OC;
392 if (priv->dack_polarity_high)
393 devflags |= ISP1760_FLAG_DACK_POL_HIGH;
394 if (priv->dreq_polarity_high)
395 devflags |= ISP1760_FLAG_DREQ_POL_HIGH;
396 }
397
398 hcd = isp1760_register(mem_res->start, mem_size, irq_res->start,
399 irqflags, -ENOENT,
400 &pdev->dev, dev_name(&pdev->dev), devflags);
401
402 dev_set_drvdata(&pdev->dev, hcd);
403
404 if (IS_ERR(hcd)) {
405 pr_warning("isp1760: Failed to register the HCD device\n");
406 ret = -ENODEV;
407 goto cleanup;
408 }
409
410 pr_info("ISP1760 USB device initialised\n");
411 return ret;
412
413cleanup:
414 release_mem_region(mem_res->start, mem_size);
415out:
416 return ret;
417}
418
419static int __devexit isp1760_plat_remove(struct platform_device *pdev)
420{
421 struct resource *mem_res;
422 resource_size_t mem_size;
423 struct usb_hcd *hcd = dev_get_drvdata(&pdev->dev);
424
425 usb_remove_hcd(hcd);
426
427 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
428 mem_size = resource_size(mem_res);
429 release_mem_region(mem_res->start, mem_size);
430
431 usb_put_hcd(hcd);
432
433 return 0;
434}
435
436static struct platform_driver isp1760_plat_driver = {
437 .probe = isp1760_plat_probe,
438 .remove = __devexit_p(isp1760_plat_remove),
439 .driver = {
440 .name = "isp1760",
441 },
442};
443
444static int __init isp1760_init(void)
445{
446 int ret, any_ret = -ENODEV;
447
448 init_kmem_once();
449
450 ret = platform_driver_register(&isp1760_plat_driver);
451 if (!ret)
452 any_ret = 0;
453#if defined(CONFIG_OF) && defined(CONFIG_OF_IRQ)
454 ret = platform_driver_register(&isp1760_of_driver);
455 if (!ret)
456 any_ret = 0;
457#endif
458#ifdef CONFIG_PCI
459 ret = pci_register_driver(&isp1761_pci_driver);
460 if (!ret)
461 any_ret = 0;
462#endif
463
464 if (any_ret)
465 deinit_kmem_cache();
466 return any_ret;
467}
468module_init(isp1760_init);
469
470static void __exit isp1760_exit(void)
471{
472 platform_driver_unregister(&isp1760_plat_driver);
473#if defined(CONFIG_OF) && defined(CONFIG_OF_IRQ)
474 platform_driver_unregister(&isp1760_of_driver);
475#endif
476#ifdef CONFIG_PCI
477 pci_unregister_driver(&isp1761_pci_driver);
478#endif
479 deinit_kmem_cache();
480}
481module_exit(isp1760_exit);
482
