1
2
3
4
5
6
7
8
9
10
11
12#include <linux/kernel.h>
13#include <linux/platform_device.h>
14#include <linux/fsl_devices.h>
15#include <linux/err.h>
16#include <linux/io.h>
17#include <linux/of_platform.h>
18#include <linux/clk.h>
19#include <linux/module.h>
20
21struct fsl_usb2_dev_data {
22 char *dr_mode;
23 char *drivers[3];
24 enum fsl_usb2_operating_modes op_mode;
25};
26
27struct fsl_usb2_dev_data dr_mode_data[] = {
28 {
29 .dr_mode = "host",
30 .drivers = { "fsl-ehci", NULL, NULL, },
31 .op_mode = FSL_USB2_DR_HOST,
32 },
33 {
34 .dr_mode = "otg",
35 .drivers = { "fsl-usb2-otg", "fsl-ehci", "fsl-usb2-udc", },
36 .op_mode = FSL_USB2_DR_OTG,
37 },
38 {
39 .dr_mode = "peripheral",
40 .drivers = { "fsl-usb2-udc", NULL, NULL, },
41 .op_mode = FSL_USB2_DR_DEVICE,
42 },
43};
44
45struct fsl_usb2_dev_data *get_dr_mode_data(struct device_node *np)
46{
47 const unsigned char *prop;
48 int i;
49
50 prop = of_get_property(np, "dr_mode", NULL);
51 if (prop) {
52 for (i = 0; i < ARRAY_SIZE(dr_mode_data); i++) {
53 if (!strcmp(prop, dr_mode_data[i].dr_mode))
54 return &dr_mode_data[i];
55 }
56 }
57 pr_warn("%s: Invalid 'dr_mode' property, fallback to host mode\n",
58 np->full_name);
59 return &dr_mode_data[0];
60}
61
62static enum fsl_usb2_phy_modes determine_usb_phy(const char *phy_type)
63{
64 if (!phy_type)
65 return FSL_USB2_PHY_NONE;
66 if (!strcasecmp(phy_type, "ulpi"))
67 return FSL_USB2_PHY_ULPI;
68 if (!strcasecmp(phy_type, "utmi"))
69 return FSL_USB2_PHY_UTMI;
70 if (!strcasecmp(phy_type, "utmi_wide"))
71 return FSL_USB2_PHY_UTMI_WIDE;
72 if (!strcasecmp(phy_type, "serial"))
73 return FSL_USB2_PHY_SERIAL;
74
75 return FSL_USB2_PHY_NONE;
76}
77
78struct platform_device *fsl_usb2_device_register(
79 struct platform_device *ofdev,
80 struct fsl_usb2_platform_data *pdata,
81 const char *name, int id)
82{
83 struct platform_device *pdev;
84 const struct resource *res = ofdev->resource;
85 unsigned int num = ofdev->num_resources;
86 int retval;
87
88 pdev = platform_device_alloc(name, id);
89 if (!pdev) {
90 retval = -ENOMEM;
91 goto error;
92 }
93
94 pdev->dev.parent = &ofdev->dev;
95
96 pdev->dev.coherent_dma_mask = ofdev->dev.coherent_dma_mask;
97 *pdev->dev.dma_mask = *ofdev->dev.dma_mask;
98
99 retval = platform_device_add_data(pdev, pdata, sizeof(*pdata));
100 if (retval)
101 goto error;
102
103 if (num) {
104 retval = platform_device_add_resources(pdev, res, num);
105 if (retval)
106 goto error;
107 }
108
109 retval = platform_device_add(pdev);
110 if (retval)
111 goto error;
112
113 return pdev;
114
115error:
116 platform_device_put(pdev);
117 return ERR_PTR(retval);
118}
119
120static const struct of_device_id fsl_usb2_mph_dr_of_match[];
121
122static int usb_get_ver_info(struct device_node *np)
123{
124 int ver = -1;
125
126
127
128
129
130
131 if (of_device_is_compatible(np, "fsl-usb2-dr")) {
132 if (of_device_is_compatible(np, "fsl-usb2-dr-v1.6"))
133 ver = FSL_USB_VER_1_6;
134 else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.2"))
135 ver = FSL_USB_VER_2_2;
136 else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.4"))
137 ver = FSL_USB_VER_2_4;
138 else
139 ver = FSL_USB_VER_OLD;
140
141 if (ver > -1)
142 return ver;
143 }
144
145 if (of_device_is_compatible(np, "fsl,mpc5121-usb2-dr"))
146 return FSL_USB_VER_OLD;
147
148 if (of_device_is_compatible(np, "fsl-usb2-mph")) {
149 if (of_device_is_compatible(np, "fsl-usb2-mph-v1.6"))
150 ver = FSL_USB_VER_1_6;
151 else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.2"))
152 ver = FSL_USB_VER_2_2;
153 else
154 ver = FSL_USB_VER_OLD;
155 }
156
157 return ver;
158}
159
160static int fsl_usb2_mph_dr_of_probe(struct platform_device *ofdev)
161{
162 struct device_node *np = ofdev->dev.of_node;
163 struct platform_device *usb_dev;
164 struct fsl_usb2_platform_data data, *pdata;
165 struct fsl_usb2_dev_data *dev_data;
166 const struct of_device_id *match;
167 const unsigned char *prop;
168 static unsigned int idx;
169 int i;
170
171 if (!of_device_is_available(np))
172 return -ENODEV;
173
174 match = of_match_device(fsl_usb2_mph_dr_of_match, &ofdev->dev);
175 if (!match)
176 return -ENODEV;
177
178 pdata = &data;
179 if (match->data)
180 memcpy(pdata, match->data, sizeof(data));
181 else
182 memset(pdata, 0, sizeof(data));
183
184 dev_data = get_dr_mode_data(np);
185
186 if (of_device_is_compatible(np, "fsl-usb2-mph")) {
187 if (of_get_property(np, "port0", NULL))
188 pdata->port_enables |= FSL_USB2_PORT0_ENABLED;
189
190 if (of_get_property(np, "port1", NULL))
191 pdata->port_enables |= FSL_USB2_PORT1_ENABLED;
192
193 pdata->operating_mode = FSL_USB2_MPH_HOST;
194 } else {
195 if (of_get_property(np, "fsl,invert-drvvbus", NULL))
196 pdata->invert_drvvbus = 1;
197
198 if (of_get_property(np, "fsl,invert-pwr-fault", NULL))
199 pdata->invert_pwr_fault = 1;
200
201
202 pdata->operating_mode = dev_data->op_mode;
203 }
204
205 prop = of_get_property(np, "phy_type", NULL);
206 pdata->phy_mode = determine_usb_phy(prop);
207 pdata->controller_ver = usb_get_ver_info(np);
208
209 if (pdata->have_sysif_regs) {
210 if (pdata->controller_ver < 0) {
211 dev_warn(&ofdev->dev, "Could not get controller version\n");
212 return -ENODEV;
213 }
214 }
215
216 for (i = 0; i < ARRAY_SIZE(dev_data->drivers); i++) {
217 if (!dev_data->drivers[i])
218 continue;
219 usb_dev = fsl_usb2_device_register(ofdev, pdata,
220 dev_data->drivers[i], idx);
221 if (IS_ERR(usb_dev)) {
222 dev_err(&ofdev->dev, "Can't register usb device\n");
223 return PTR_ERR(usb_dev);
224 }
225 }
226 idx++;
227 return 0;
228}
229
230static int __unregister_subdev(struct device *dev, void *d)
231{
232 platform_device_unregister(to_platform_device(dev));
233 return 0;
234}
235
236static int fsl_usb2_mph_dr_of_remove(struct platform_device *ofdev)
237{
238 device_for_each_child(&ofdev->dev, NULL, __unregister_subdev);
239 return 0;
240}
241
242#ifdef CONFIG_PPC_MPC512x
243
244#define USBGENCTRL 0x200
245#define GC_WU_INT_CLR (1 << 5)
246#define GC_ULPI_SEL (1 << 4)
247#define GC_PPP (1 << 3)
248#define GC_PFP (1 << 2)
249#define GC_WU_ULPI_EN (1 << 1)
250#define GC_WU_IE (1 << 1)
251
252#define ISIPHYCTRL 0x204
253#define PHYCTRL_PHYE (1 << 4)
254#define PHYCTRL_BSENH (1 << 3)
255#define PHYCTRL_BSEN (1 << 2)
256#define PHYCTRL_LSFE (1 << 1)
257#define PHYCTRL_PXE (1 << 0)
258
259int fsl_usb2_mpc5121_init(struct platform_device *pdev)
260{
261 struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data;
262 struct clk *clk;
263 char clk_name[10];
264 int base, clk_num;
265
266 base = pdev->resource->start & 0xf000;
267 if (base == 0x3000)
268 clk_num = 1;
269 else if (base == 0x4000)
270 clk_num = 2;
271 else
272 return -ENODEV;
273
274 snprintf(clk_name, sizeof(clk_name), "usb%d_clk", clk_num);
275 clk = clk_get(&pdev->dev, clk_name);
276 if (IS_ERR(clk)) {
277 dev_err(&pdev->dev, "failed to get clk\n");
278 return PTR_ERR(clk);
279 }
280
281 clk_enable(clk);
282 pdata->clk = clk;
283
284 if (pdata->phy_mode == FSL_USB2_PHY_UTMI_WIDE) {
285 u32 reg = 0;
286
287 if (pdata->invert_drvvbus)
288 reg |= GC_PPP;
289
290 if (pdata->invert_pwr_fault)
291 reg |= GC_PFP;
292
293 out_be32(pdata->regs + ISIPHYCTRL, PHYCTRL_PHYE | PHYCTRL_PXE);
294 out_be32(pdata->regs + USBGENCTRL, reg);
295 }
296 return 0;
297}
298
299static void fsl_usb2_mpc5121_exit(struct platform_device *pdev)
300{
301 struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data;
302
303 pdata->regs = NULL;
304
305 if (pdata->clk) {
306 clk_disable(pdata->clk);
307 clk_put(pdata->clk);
308 }
309}
310
311static struct fsl_usb2_platform_data fsl_usb2_mpc5121_pd = {
312 .big_endian_desc = 1,
313 .big_endian_mmio = 1,
314 .es = 1,
315 .have_sysif_regs = 0,
316 .le_setup_buf = 1,
317 .init = fsl_usb2_mpc5121_init,
318 .exit = fsl_usb2_mpc5121_exit,
319};
320#endif
321
322static struct fsl_usb2_platform_data fsl_usb2_mpc8xxx_pd = {
323 .have_sysif_regs = 1,
324};
325
326static const struct of_device_id fsl_usb2_mph_dr_of_match[] = {
327 { .compatible = "fsl-usb2-mph", .data = &fsl_usb2_mpc8xxx_pd, },
328 { .compatible = "fsl-usb2-dr", .data = &fsl_usb2_mpc8xxx_pd, },
329#ifdef CONFIG_PPC_MPC512x
330 { .compatible = "fsl,mpc5121-usb2-dr", .data = &fsl_usb2_mpc5121_pd, },
331#endif
332 {},
333};
334
335static struct platform_driver fsl_usb2_mph_dr_driver = {
336 .driver = {
337 .name = "fsl-usb2-mph-dr",
338 .owner = THIS_MODULE,
339 .of_match_table = fsl_usb2_mph_dr_of_match,
340 },
341 .probe = fsl_usb2_mph_dr_of_probe,
342 .remove = fsl_usb2_mph_dr_of_remove,
343};
344
345module_platform_driver(fsl_usb2_mph_dr_driver);
346
347MODULE_DESCRIPTION("FSL MPH DR OF devices driver");
348MODULE_AUTHOR("Anatolij Gustschin <agust@denx.de>");
349MODULE_LICENSE("GPL");
350
