• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Cadence PCI Glue driver.
4  *
5  * Copyright (C) 2019 Cadence.
6  *
7  * Author: Pawel Laszczak <pawell@cadence.com>
8  *
9  */
10 
11 #include <linux/platform_device.h>
12 #include <linux/dma-mapping.h>
13 #include <linux/kernel.h>
14 #include <linux/module.h>
15 #include <linux/slab.h>
16 #include <linux/pci.h>
17 
18 #include "core.h"
19 #include "gadget-export.h"
20 
21 #define PCI_BAR_HOST		0
22 #define PCI_BAR_OTG		0
23 #define PCI_BAR_DEV		2
24 
25 #define PCI_DEV_FN_HOST_DEVICE	0
26 #define PCI_DEV_FN_OTG		1
27 
28 #define PCI_DRIVER_NAME		"cdns-pci-usbssp"
29 #define PLAT_DRIVER_NAME	"cdns-usbssp"
30 
31 #define CDNS_VENDOR_ID		0x17cd
32 #define CDNS_DEVICE_ID		0x0200
33 #define CDNS_DRD_ID		0x0100
34 #define CDNS_DRD_IF		(PCI_CLASS_SERIAL_USB << 8 | 0x80)
35 
cdnsp_get_second_fun(struct pci_dev * pdev)36 static struct pci_dev *cdnsp_get_second_fun(struct pci_dev *pdev)
37 {
38 	/*
39 	 * Gets the second function.
40 	 * Platform has two function. The fist keeps resources for
41 	 * Host/Device while the secon keeps resources for DRD/OTG.
42 	 */
43 	if (pdev->device == CDNS_DEVICE_ID)
44 		return  pci_get_device(pdev->vendor, CDNS_DRD_ID, NULL);
45 	else if (pdev->device == CDNS_DRD_ID)
46 		return pci_get_device(pdev->vendor, CDNS_DEVICE_ID, NULL);
47 
48 	return NULL;
49 }
50 
cdnsp_pci_probe(struct pci_dev * pdev,const struct pci_device_id * id)51 static int cdnsp_pci_probe(struct pci_dev *pdev,
52 			   const struct pci_device_id *id)
53 {
54 	struct device *dev = &pdev->dev;
55 	struct pci_dev *func;
56 	struct resource *res;
57 	struct cdns *cdnsp;
58 	int ret;
59 
60 	/*
61 	 * For GADGET/HOST PCI (devfn) function number is 0,
62 	 * for OTG PCI (devfn) function number is 1.
63 	 */
64 	if (!id || (pdev->devfn != PCI_DEV_FN_HOST_DEVICE &&
65 		    pdev->devfn != PCI_DEV_FN_OTG))
66 		return -EINVAL;
67 
68 	func = cdnsp_get_second_fun(pdev);
69 	if (!func)
70 		return -EINVAL;
71 
72 	if (func->class == PCI_CLASS_SERIAL_USB_XHCI ||
73 	    pdev->class == PCI_CLASS_SERIAL_USB_XHCI) {
74 		ret = -EINVAL;
75 		goto put_pci;
76 	}
77 
78 	ret = pcim_enable_device(pdev);
79 	if (ret) {
80 		dev_err(&pdev->dev, "Enabling PCI device has failed %d\n", ret);
81 		goto put_pci;
82 	}
83 
84 	pci_set_master(pdev);
85 	if (pci_is_enabled(func)) {
86 		cdnsp = pci_get_drvdata(func);
87 	} else {
88 		cdnsp = kzalloc(sizeof(*cdnsp), GFP_KERNEL);
89 		if (!cdnsp) {
90 			ret = -ENOMEM;
91 			goto disable_pci;
92 		}
93 	}
94 
95 	/* For GADGET device function number is 0. */
96 	if (pdev->devfn == 0) {
97 		resource_size_t rsrc_start, rsrc_len;
98 
99 		/* Function 0: host(BAR_0) + device(BAR_1).*/
100 		dev_dbg(dev, "Initialize resources\n");
101 		rsrc_start = pci_resource_start(pdev, PCI_BAR_DEV);
102 		rsrc_len = pci_resource_len(pdev, PCI_BAR_DEV);
103 		res = devm_request_mem_region(dev, rsrc_start, rsrc_len, "dev");
104 		if (!res) {
105 			dev_dbg(dev, "controller already in use\n");
106 			ret = -EBUSY;
107 			goto free_cdnsp;
108 		}
109 
110 		cdnsp->dev_regs = devm_ioremap(dev, rsrc_start, rsrc_len);
111 		if (!cdnsp->dev_regs) {
112 			dev_dbg(dev, "error mapping memory\n");
113 			ret = -EFAULT;
114 			goto free_cdnsp;
115 		}
116 
117 		cdnsp->dev_irq = pdev->irq;
118 		dev_dbg(dev, "USBSS-DEV physical base addr: %pa\n",
119 			&rsrc_start);
120 
121 		res = &cdnsp->xhci_res[0];
122 		res->start = pci_resource_start(pdev, PCI_BAR_HOST);
123 		res->end = pci_resource_end(pdev, PCI_BAR_HOST);
124 		res->name = "xhci";
125 		res->flags = IORESOURCE_MEM;
126 		dev_dbg(dev, "USBSS-XHCI physical base addr: %pa\n",
127 			&res->start);
128 
129 		/* Interrupt for XHCI, */
130 		res = &cdnsp->xhci_res[1];
131 		res->start = pdev->irq;
132 		res->name = "host";
133 		res->flags = IORESOURCE_IRQ;
134 	} else {
135 		res = &cdnsp->otg_res;
136 		res->start = pci_resource_start(pdev, PCI_BAR_OTG);
137 		res->end =   pci_resource_end(pdev, PCI_BAR_OTG);
138 		res->name = "otg";
139 		res->flags = IORESOURCE_MEM;
140 		dev_dbg(dev, "CDNSP-DRD physical base addr: %pa\n",
141 			&res->start);
142 
143 		/* Interrupt for OTG/DRD. */
144 		cdnsp->otg_irq = pdev->irq;
145 	}
146 
147 	if (pci_is_enabled(func)) {
148 		cdnsp->dev = dev;
149 		cdnsp->gadget_init = cdnsp_gadget_init;
150 
151 		ret = cdns_init(cdnsp);
152 		if (ret)
153 			goto free_cdnsp;
154 	}
155 
156 	pci_set_drvdata(pdev, cdnsp);
157 
158 	device_wakeup_enable(&pdev->dev);
159 	if (pci_dev_run_wake(pdev))
160 		pm_runtime_put_noidle(&pdev->dev);
161 
162 	return 0;
163 
164 free_cdnsp:
165 	if (!pci_is_enabled(func))
166 		kfree(cdnsp);
167 
168 disable_pci:
169 	pci_disable_device(pdev);
170 
171 put_pci:
172 	pci_dev_put(func);
173 
174 	return ret;
175 }
176 
cdnsp_pci_remove(struct pci_dev * pdev)177 static void cdnsp_pci_remove(struct pci_dev *pdev)
178 {
179 	struct cdns *cdnsp;
180 	struct pci_dev *func;
181 
182 	func = cdnsp_get_second_fun(pdev);
183 	cdnsp = (struct cdns *)pci_get_drvdata(pdev);
184 
185 	if (pci_dev_run_wake(pdev))
186 		pm_runtime_get_noresume(&pdev->dev);
187 
188 	if (pci_is_enabled(func)) {
189 		cdns_remove(cdnsp);
190 	} else {
191 		kfree(cdnsp);
192 	}
193 
194 	pci_dev_put(func);
195 }
196 
cdnsp_pci_suspend(struct device * dev)197 static int __maybe_unused cdnsp_pci_suspend(struct device *dev)
198 {
199 	struct cdns *cdns = dev_get_drvdata(dev);
200 
201 	return cdns_suspend(cdns);
202 }
203 
cdnsp_pci_resume(struct device * dev)204 static int __maybe_unused cdnsp_pci_resume(struct device *dev)
205 {
206 	struct cdns *cdns = dev_get_drvdata(dev);
207 	unsigned long flags;
208 	int ret;
209 
210 	spin_lock_irqsave(&cdns->lock, flags);
211 	ret = cdns_resume(cdns);
212 	spin_unlock_irqrestore(&cdns->lock, flags);
213 	cdns_set_active(cdns, 1);
214 
215 	return ret;
216 }
217 
218 static const struct dev_pm_ops cdnsp_pci_pm_ops = {
219 	SET_SYSTEM_SLEEP_PM_OPS(cdnsp_pci_suspend, cdnsp_pci_resume)
220 };
221 
222 static const struct pci_device_id cdnsp_pci_ids[] = {
223 	{ PCI_VENDOR_ID_CDNS, CDNS_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,
224 	  PCI_CLASS_SERIAL_USB_DEVICE, PCI_ANY_ID },
225 	{ PCI_VENDOR_ID_CDNS, CDNS_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,
226 	  CDNS_DRD_IF, PCI_ANY_ID },
227 	{ PCI_VENDOR_ID_CDNS, CDNS_DRD_ID, PCI_ANY_ID, PCI_ANY_ID,
228 	  CDNS_DRD_IF, PCI_ANY_ID },
229 	{ 0, }
230 };
231 
232 static struct pci_driver cdnsp_pci_driver = {
233 	.name = "cdnsp-pci",
234 	.id_table = &cdnsp_pci_ids[0],
235 	.probe = cdnsp_pci_probe,
236 	.remove = cdnsp_pci_remove,
237 	.driver = {
238 		.pm = &cdnsp_pci_pm_ops,
239 	}
240 };
241 
242 module_pci_driver(cdnsp_pci_driver);
243 MODULE_DEVICE_TABLE(pci, cdnsp_pci_ids);
244 
245 MODULE_ALIAS("pci:cdnsp");
246 MODULE_AUTHOR("Pawel Laszczak <pawell@cadence.com>");
247 MODULE_LICENSE("GPL v2");
248 MODULE_DESCRIPTION("Cadence CDNSP PCI driver");
249