]> git.karo-electronics.de Git - karo-tx-linux.git/blob - drivers/usb/dwc3/dwc3-pci.c
usb: dwc3: pci: fix failure path in dwc3_pci_probe()
[karo-tx-linux.git] / drivers / usb / dwc3 / dwc3-pci.c
1 /**
2  * dwc3-pci.c - PCI Specific glue layer
3  *
4  * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com
5  *
6  * Authors: Felipe Balbi <balbi@ti.com>,
7  *          Sebastian Andrzej Siewior <bigeasy@linutronix.de>
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions, and the following disclaimer,
14  *    without modification.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  * 3. The names of the above-listed copyright holders may not be used
19  *    to endorse or promote products derived from this software without
20  *    specific prior written permission.
21  *
22  * ALTERNATIVELY, this software may be distributed under the terms of the
23  * GNU General Public License ("GPL") version 2, as published by the Free
24  * Software Foundation.
25  *
26  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
27  * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
28  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
30  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
31  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
32  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
33  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
34  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
35  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
36  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
37  */
38
39 #include <linux/kernel.h>
40 #include <linux/module.h>
41 #include <linux/slab.h>
42 #include <linux/pci.h>
43 #include <linux/platform_device.h>
44
45 #include "core.h"
46
47 /* FIXME define these in <linux/pci_ids.h> */
48 #define PCI_VENDOR_ID_SYNOPSYS          0x16c3
49 #define PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3 0xabcd
50
51 struct dwc3_pci {
52         struct device           *dev;
53         struct platform_device  *dwc3;
54 };
55
56 static int __devinit dwc3_pci_probe(struct pci_dev *pci,
57                 const struct pci_device_id *id)
58 {
59         struct resource         res[2];
60         struct platform_device  *dwc3;
61         struct dwc3_pci         *glue;
62         int                     ret = -ENOMEM;
63         int                     devid;
64         struct device           *dev = &pci->dev;
65
66         glue = devm_kzalloc(dev, sizeof(*glue), GFP_KERNEL);
67         if (!glue) {
68                 dev_err(dev, "not enough memory\n");
69                 return -ENOMEM;
70         }
71
72         glue->dev = dev;
73
74         ret = pci_enable_device(pci);
75         if (ret) {
76                 dev_err(dev, "failed to enable pci device\n");
77                 return -ENODEV;
78         }
79
80         pci_set_power_state(pci, PCI_D0);
81         pci_set_master(pci);
82
83         devid = dwc3_get_device_id();
84         if (devid < 0) {
85                 ret = -ENOMEM;
86                 goto err1;
87         }
88
89         dwc3 = platform_device_alloc("dwc3", devid);
90         if (!dwc3) {
91                 dev_err(dev, "couldn't allocate dwc3 device\n");
92                 goto err1;
93         }
94
95         memset(res, 0x00, sizeof(struct resource) * ARRAY_SIZE(res));
96
97         res[0].start    = pci_resource_start(pci, 0);
98         res[0].end      = pci_resource_end(pci, 0);
99         res[0].name     = "dwc_usb3";
100         res[0].flags    = IORESOURCE_MEM;
101
102         res[1].start    = pci->irq;
103         res[1].name     = "dwc_usb3";
104         res[1].flags    = IORESOURCE_IRQ;
105
106         ret = platform_device_add_resources(dwc3, res, ARRAY_SIZE(res));
107         if (ret) {
108                 dev_err(dev, "couldn't add resources to dwc3 device\n");
109                 goto err2;
110         }
111
112         pci_set_drvdata(pci, glue);
113
114         dma_set_coherent_mask(&dwc3->dev, dev->coherent_dma_mask);
115
116         dwc3->dev.dma_mask = dev->dma_mask;
117         dwc3->dev.dma_parms = dev->dma_parms;
118         dwc3->dev.parent = dev;
119         glue->dwc3 = dwc3;
120
121         ret = platform_device_add(dwc3);
122         if (ret) {
123                 dev_err(dev, "failed to register dwc3 device\n");
124                 goto err3;
125         }
126
127         return 0;
128
129 err3:
130         pci_set_drvdata(pci, NULL);
131         platform_device_put(dwc3);
132
133 err2:
134         dwc3_put_device_id(devid);
135
136 err1:
137         pci_disable_device(pci);
138
139         return ret;
140 }
141
142 static void __devexit dwc3_pci_remove(struct pci_dev *pci)
143 {
144         struct dwc3_pci *glue = pci_get_drvdata(pci);
145
146         dwc3_put_device_id(glue->dwc3->id);
147         platform_device_unregister(glue->dwc3);
148         pci_set_drvdata(pci, NULL);
149         pci_disable_device(pci);
150 }
151
152 static DEFINE_PCI_DEVICE_TABLE(dwc3_pci_id_table) = {
153         {
154                 PCI_DEVICE(PCI_VENDOR_ID_SYNOPSYS,
155                                 PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3),
156         },
157         {  }    /* Terminating Entry */
158 };
159 MODULE_DEVICE_TABLE(pci, dwc3_pci_id_table);
160
161 static struct pci_driver dwc3_pci_driver = {
162         .name           = "dwc3-pci",
163         .id_table       = dwc3_pci_id_table,
164         .probe          = dwc3_pci_probe,
165         .remove         = __devexit_p(dwc3_pci_remove),
166 };
167
168 MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
169 MODULE_LICENSE("Dual BSD/GPL");
170 MODULE_DESCRIPTION("DesignWare USB3 PCI Glue Layer");
171
172 static int __devinit dwc3_pci_init(void)
173 {
174         return pci_register_driver(&dwc3_pci_driver);
175 }
176 module_init(dwc3_pci_init);
177
178 static void __exit dwc3_pci_exit(void)
179 {
180         pci_unregister_driver(&dwc3_pci_driver);
181 }
182 module_exit(dwc3_pci_exit);