xref: /openbmc/linux/drivers/usb/musb/sunxi.c (revision 23c2b932)
1 /*
2  * Allwinner sun4i MUSB Glue Layer
3  *
4  * Copyright (C) 2015 Hans de Goede <hdegoede@redhat.com>
5  *
6  * Based on code from
7  * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  */
19 
20 #include <linux/clk.h>
21 #include <linux/err.h>
22 #include <linux/extcon.h>
23 #include <linux/io.h>
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/of.h>
27 #include <linux/phy/phy-sun4i-usb.h>
28 #include <linux/platform_device.h>
29 #include <linux/reset.h>
30 #include <linux/soc/sunxi/sunxi_sram.h>
31 #include <linux/usb/musb.h>
32 #include <linux/usb/of.h>
33 #include <linux/usb/usb_phy_generic.h>
34 #include <linux/workqueue.h>
35 #include "musb_core.h"
36 
37 /*
38  * Register offsets, note sunxi musb has a different layout then most
39  * musb implementations, we translate the layout in musb_readb & friends.
40  */
41 #define SUNXI_MUSB_POWER			0x0040
42 #define SUNXI_MUSB_DEVCTL			0x0041
43 #define SUNXI_MUSB_INDEX			0x0042
44 #define SUNXI_MUSB_VEND0			0x0043
45 #define SUNXI_MUSB_INTRTX			0x0044
46 #define SUNXI_MUSB_INTRRX			0x0046
47 #define SUNXI_MUSB_INTRTXE			0x0048
48 #define SUNXI_MUSB_INTRRXE			0x004a
49 #define SUNXI_MUSB_INTRUSB			0x004c
50 #define SUNXI_MUSB_INTRUSBE			0x0050
51 #define SUNXI_MUSB_FRAME			0x0054
52 #define SUNXI_MUSB_TXFIFOSZ			0x0090
53 #define SUNXI_MUSB_TXFIFOADD			0x0092
54 #define SUNXI_MUSB_RXFIFOSZ			0x0094
55 #define SUNXI_MUSB_RXFIFOADD			0x0096
56 #define SUNXI_MUSB_FADDR			0x0098
57 #define SUNXI_MUSB_TXFUNCADDR			0x0098
58 #define SUNXI_MUSB_TXHUBADDR			0x009a
59 #define SUNXI_MUSB_TXHUBPORT			0x009b
60 #define SUNXI_MUSB_RXFUNCADDR			0x009c
61 #define SUNXI_MUSB_RXHUBADDR			0x009e
62 #define SUNXI_MUSB_RXHUBPORT			0x009f
63 #define SUNXI_MUSB_CONFIGDATA			0x00c0
64 
65 /* VEND0 bits */
66 #define SUNXI_MUSB_VEND0_PIO_MODE		0
67 
68 /* flags */
69 #define SUNXI_MUSB_FL_ENABLED			0
70 #define SUNXI_MUSB_FL_HOSTMODE			1
71 #define SUNXI_MUSB_FL_HOSTMODE_PEND		2
72 #define SUNXI_MUSB_FL_VBUS_ON			3
73 #define SUNXI_MUSB_FL_PHY_ON			4
74 #define SUNXI_MUSB_FL_HAS_SRAM			5
75 #define SUNXI_MUSB_FL_HAS_RESET			6
76 #define SUNXI_MUSB_FL_NO_CONFIGDATA		7
77 
78 /* Our read/write methods need access and do not get passed in a musb ref :| */
79 static struct musb *sunxi_musb;
80 
81 struct sunxi_glue {
82 	struct device		*dev;
83 	struct musb		*musb;
84 	struct platform_device	*musb_pdev;
85 	struct clk		*clk;
86 	struct reset_control	*rst;
87 	struct phy		*phy;
88 	struct platform_device	*usb_phy;
89 	struct usb_phy		*xceiv;
90 	unsigned long		flags;
91 	struct work_struct	work;
92 	struct extcon_dev	*extcon;
93 	struct notifier_block	host_nb;
94 };
95 
96 /* phy_power_on / off may sleep, so we use a workqueue  */
97 static void sunxi_musb_work(struct work_struct *work)
98 {
99 	struct sunxi_glue *glue = container_of(work, struct sunxi_glue, work);
100 	bool vbus_on, phy_on;
101 
102 	if (!test_bit(SUNXI_MUSB_FL_ENABLED, &glue->flags))
103 		return;
104 
105 	if (test_and_clear_bit(SUNXI_MUSB_FL_HOSTMODE_PEND, &glue->flags)) {
106 		struct musb *musb = glue->musb;
107 		unsigned long flags;
108 		u8 devctl;
109 
110 		spin_lock_irqsave(&musb->lock, flags);
111 
112 		devctl = readb(musb->mregs + SUNXI_MUSB_DEVCTL);
113 		if (test_bit(SUNXI_MUSB_FL_HOSTMODE, &glue->flags)) {
114 			set_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
115 			musb->xceiv->otg->default_a = 1;
116 			musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
117 			MUSB_HST_MODE(musb);
118 			devctl |= MUSB_DEVCTL_SESSION;
119 		} else {
120 			clear_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
121 			musb->xceiv->otg->default_a = 0;
122 			musb->xceiv->otg->state = OTG_STATE_B_IDLE;
123 			MUSB_DEV_MODE(musb);
124 			devctl &= ~MUSB_DEVCTL_SESSION;
125 		}
126 		writeb(devctl, musb->mregs + SUNXI_MUSB_DEVCTL);
127 
128 		spin_unlock_irqrestore(&musb->lock, flags);
129 	}
130 
131 	vbus_on = test_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
132 	phy_on = test_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
133 
134 	if (phy_on != vbus_on) {
135 		if (vbus_on) {
136 			phy_power_on(glue->phy);
137 			set_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
138 		} else {
139 			phy_power_off(glue->phy);
140 			clear_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
141 		}
142 	}
143 }
144 
145 static void sunxi_musb_set_vbus(struct musb *musb, int is_on)
146 {
147 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
148 
149 	if (is_on) {
150 		set_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
151 		musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
152 	} else {
153 		clear_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
154 	}
155 
156 	schedule_work(&glue->work);
157 }
158 
159 static void sunxi_musb_pre_root_reset_end(struct musb *musb)
160 {
161 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
162 
163 	sun4i_usb_phy_set_squelch_detect(glue->phy, false);
164 }
165 
166 static void sunxi_musb_post_root_reset_end(struct musb *musb)
167 {
168 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
169 
170 	sun4i_usb_phy_set_squelch_detect(glue->phy, true);
171 }
172 
173 static irqreturn_t sunxi_musb_interrupt(int irq, void *__hci)
174 {
175 	struct musb *musb = __hci;
176 	unsigned long flags;
177 
178 	spin_lock_irqsave(&musb->lock, flags);
179 
180 	musb->int_usb = readb(musb->mregs + SUNXI_MUSB_INTRUSB);
181 	if (musb->int_usb)
182 		writeb(musb->int_usb, musb->mregs + SUNXI_MUSB_INTRUSB);
183 
184 	/*
185 	 * sunxi musb often signals babble on low / full speed device
186 	 * disconnect, without ever raising MUSB_INTR_DISCONNECT, since
187 	 * normally babble never happens treat it as disconnect.
188 	 */
189 	if ((musb->int_usb & MUSB_INTR_BABBLE) && is_host_active(musb)) {
190 		musb->int_usb &= ~MUSB_INTR_BABBLE;
191 		musb->int_usb |= MUSB_INTR_DISCONNECT;
192 	}
193 
194 	if ((musb->int_usb & MUSB_INTR_RESET) && !is_host_active(musb)) {
195 		/* ep0 FADDR must be 0 when (re)entering peripheral mode */
196 		musb_ep_select(musb->mregs, 0);
197 		musb_writeb(musb->mregs, MUSB_FADDR, 0);
198 	}
199 
200 	musb->int_tx = readw(musb->mregs + SUNXI_MUSB_INTRTX);
201 	if (musb->int_tx)
202 		writew(musb->int_tx, musb->mregs + SUNXI_MUSB_INTRTX);
203 
204 	musb->int_rx = readw(musb->mregs + SUNXI_MUSB_INTRRX);
205 	if (musb->int_rx)
206 		writew(musb->int_rx, musb->mregs + SUNXI_MUSB_INTRRX);
207 
208 	musb_interrupt(musb);
209 
210 	spin_unlock_irqrestore(&musb->lock, flags);
211 
212 	return IRQ_HANDLED;
213 }
214 
215 static int sunxi_musb_host_notifier(struct notifier_block *nb,
216 				    unsigned long event, void *ptr)
217 {
218 	struct sunxi_glue *glue = container_of(nb, struct sunxi_glue, host_nb);
219 
220 	if (event)
221 		set_bit(SUNXI_MUSB_FL_HOSTMODE, &glue->flags);
222 	else
223 		clear_bit(SUNXI_MUSB_FL_HOSTMODE, &glue->flags);
224 
225 	set_bit(SUNXI_MUSB_FL_HOSTMODE_PEND, &glue->flags);
226 	schedule_work(&glue->work);
227 
228 	return NOTIFY_DONE;
229 }
230 
231 static int sunxi_musb_init(struct musb *musb)
232 {
233 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
234 	int ret;
235 
236 	sunxi_musb = musb;
237 	musb->phy = glue->phy;
238 	musb->xceiv = glue->xceiv;
239 
240 	if (test_bit(SUNXI_MUSB_FL_HAS_SRAM, &glue->flags)) {
241 		ret = sunxi_sram_claim(musb->controller->parent);
242 		if (ret)
243 			return ret;
244 	}
245 
246 	ret = clk_prepare_enable(glue->clk);
247 	if (ret)
248 		goto error_sram_release;
249 
250 	if (test_bit(SUNXI_MUSB_FL_HAS_RESET, &glue->flags)) {
251 		ret = reset_control_deassert(glue->rst);
252 		if (ret)
253 			goto error_clk_disable;
254 	}
255 
256 	writeb(SUNXI_MUSB_VEND0_PIO_MODE, musb->mregs + SUNXI_MUSB_VEND0);
257 
258 	/* Register notifier before calling phy_init() */
259 	if (musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE) {
260 		ret = extcon_register_notifier(glue->extcon, EXTCON_USB_HOST,
261 					       &glue->host_nb);
262 		if (ret)
263 			goto error_reset_assert;
264 	}
265 
266 	ret = phy_init(glue->phy);
267 	if (ret)
268 		goto error_unregister_notifier;
269 
270 	musb->isr = sunxi_musb_interrupt;
271 
272 	/* Stop the musb-core from doing runtime pm (not supported on sunxi) */
273 	pm_runtime_get(musb->controller);
274 
275 	return 0;
276 
277 error_unregister_notifier:
278 	if (musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
279 		extcon_unregister_notifier(glue->extcon, EXTCON_USB_HOST,
280 					   &glue->host_nb);
281 error_reset_assert:
282 	if (test_bit(SUNXI_MUSB_FL_HAS_RESET, &glue->flags))
283 		reset_control_assert(glue->rst);
284 error_clk_disable:
285 	clk_disable_unprepare(glue->clk);
286 error_sram_release:
287 	if (test_bit(SUNXI_MUSB_FL_HAS_SRAM, &glue->flags))
288 		sunxi_sram_release(musb->controller->parent);
289 	return ret;
290 }
291 
292 static int sunxi_musb_exit(struct musb *musb)
293 {
294 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
295 
296 	pm_runtime_put(musb->controller);
297 
298 	cancel_work_sync(&glue->work);
299 	if (test_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags))
300 		phy_power_off(glue->phy);
301 
302 	phy_exit(glue->phy);
303 
304 	if (musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
305 		extcon_unregister_notifier(glue->extcon, EXTCON_USB_HOST,
306 					   &glue->host_nb);
307 
308 	if (test_bit(SUNXI_MUSB_FL_HAS_RESET, &glue->flags))
309 		reset_control_assert(glue->rst);
310 
311 	clk_disable_unprepare(glue->clk);
312 	if (test_bit(SUNXI_MUSB_FL_HAS_SRAM, &glue->flags))
313 		sunxi_sram_release(musb->controller->parent);
314 
315 	return 0;
316 }
317 
318 static int sunxi_set_mode(struct musb *musb, u8 mode)
319 {
320 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
321 	int ret;
322 
323 	if (mode == MUSB_HOST) {
324 		ret = phy_power_on(glue->phy);
325 		if (ret)
326 			return ret;
327 
328 		set_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
329 		/* Stop musb work from turning vbus off again */
330 		set_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
331 		musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
332 	}
333 
334 	return 0;
335 }
336 
337 static void sunxi_musb_enable(struct musb *musb)
338 {
339 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
340 
341 	glue->musb = musb;
342 
343 	/* musb_core does not call us in a balanced manner */
344 	if (test_and_set_bit(SUNXI_MUSB_FL_ENABLED, &glue->flags))
345 		return;
346 
347 	schedule_work(&glue->work);
348 }
349 
350 static void sunxi_musb_disable(struct musb *musb)
351 {
352 	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
353 
354 	clear_bit(SUNXI_MUSB_FL_ENABLED, &glue->flags);
355 }
356 
357 struct dma_controller *sunxi_musb_dma_controller_create(struct musb *musb,
358 						    void __iomem *base)
359 {
360 	return NULL;
361 }
362 
363 void sunxi_musb_dma_controller_destroy(struct dma_controller *c)
364 {
365 }
366 
367 /*
368  * sunxi musb register layout
369  * 0x00 - 0x17	fifo regs, 1 long per fifo
370  * 0x40 - 0x57	generic control regs (power - frame)
371  * 0x80 - 0x8f	ep control regs (addressed through hw_ep->regs, indexed)
372  * 0x90 - 0x97	fifo control regs (indexed)
373  * 0x98 - 0x9f	multipoint / busctl regs (indexed)
374  * 0xc0		configdata reg
375  */
376 
377 static u32 sunxi_musb_fifo_offset(u8 epnum)
378 {
379 	return (epnum * 4);
380 }
381 
382 static u32 sunxi_musb_ep_offset(u8 epnum, u16 offset)
383 {
384 	WARN_ONCE(offset != 0,
385 		  "sunxi_musb_ep_offset called with non 0 offset\n");
386 
387 	return 0x80; /* indexed, so ignore epnum */
388 }
389 
390 static u32 sunxi_musb_busctl_offset(u8 epnum, u16 offset)
391 {
392 	return SUNXI_MUSB_TXFUNCADDR + offset;
393 }
394 
395 static u8 sunxi_musb_readb(const void __iomem *addr, unsigned offset)
396 {
397 	struct sunxi_glue *glue;
398 
399 	if (addr == sunxi_musb->mregs) {
400 		/* generic control or fifo control reg access */
401 		switch (offset) {
402 		case MUSB_FADDR:
403 			return readb(addr + SUNXI_MUSB_FADDR);
404 		case MUSB_POWER:
405 			return readb(addr + SUNXI_MUSB_POWER);
406 		case MUSB_INTRUSB:
407 			return readb(addr + SUNXI_MUSB_INTRUSB);
408 		case MUSB_INTRUSBE:
409 			return readb(addr + SUNXI_MUSB_INTRUSBE);
410 		case MUSB_INDEX:
411 			return readb(addr + SUNXI_MUSB_INDEX);
412 		case MUSB_TESTMODE:
413 			return 0; /* No testmode on sunxi */
414 		case MUSB_DEVCTL:
415 			return readb(addr + SUNXI_MUSB_DEVCTL);
416 		case MUSB_TXFIFOSZ:
417 			return readb(addr + SUNXI_MUSB_TXFIFOSZ);
418 		case MUSB_RXFIFOSZ:
419 			return readb(addr + SUNXI_MUSB_RXFIFOSZ);
420 		case MUSB_CONFIGDATA + 0x10: /* See musb_read_configdata() */
421 			glue = dev_get_drvdata(sunxi_musb->controller->parent);
422 			/* A33 saves a reg, and we get to hardcode this */
423 			if (test_bit(SUNXI_MUSB_FL_NO_CONFIGDATA,
424 				     &glue->flags))
425 				return 0xde;
426 
427 			return readb(addr + SUNXI_MUSB_CONFIGDATA);
428 		/* Offset for these is fixed by sunxi_musb_busctl_offset() */
429 		case SUNXI_MUSB_TXFUNCADDR:
430 		case SUNXI_MUSB_TXHUBADDR:
431 		case SUNXI_MUSB_TXHUBPORT:
432 		case SUNXI_MUSB_RXFUNCADDR:
433 		case SUNXI_MUSB_RXHUBADDR:
434 		case SUNXI_MUSB_RXHUBPORT:
435 			/* multipoint / busctl reg access */
436 			return readb(addr + offset);
437 		default:
438 			dev_err(sunxi_musb->controller->parent,
439 				"Error unknown readb offset %u\n", offset);
440 			return 0;
441 		}
442 	} else if (addr == (sunxi_musb->mregs + 0x80)) {
443 		/* ep control reg access */
444 		/* sunxi has a 2 byte hole before the txtype register */
445 		if (offset >= MUSB_TXTYPE)
446 			offset += 2;
447 		return readb(addr + offset);
448 	}
449 
450 	dev_err(sunxi_musb->controller->parent,
451 		"Error unknown readb at 0x%x bytes offset\n",
452 		(int)(addr - sunxi_musb->mregs));
453 	return 0;
454 }
455 
456 static void sunxi_musb_writeb(void __iomem *addr, unsigned offset, u8 data)
457 {
458 	if (addr == sunxi_musb->mregs) {
459 		/* generic control or fifo control reg access */
460 		switch (offset) {
461 		case MUSB_FADDR:
462 			return writeb(data, addr + SUNXI_MUSB_FADDR);
463 		case MUSB_POWER:
464 			return writeb(data, addr + SUNXI_MUSB_POWER);
465 		case MUSB_INTRUSB:
466 			return writeb(data, addr + SUNXI_MUSB_INTRUSB);
467 		case MUSB_INTRUSBE:
468 			return writeb(data, addr + SUNXI_MUSB_INTRUSBE);
469 		case MUSB_INDEX:
470 			return writeb(data, addr + SUNXI_MUSB_INDEX);
471 		case MUSB_TESTMODE:
472 			if (data)
473 				dev_warn(sunxi_musb->controller->parent,
474 					"sunxi-musb does not have testmode\n");
475 			return;
476 		case MUSB_DEVCTL:
477 			return writeb(data, addr + SUNXI_MUSB_DEVCTL);
478 		case MUSB_TXFIFOSZ:
479 			return writeb(data, addr + SUNXI_MUSB_TXFIFOSZ);
480 		case MUSB_RXFIFOSZ:
481 			return writeb(data, addr + SUNXI_MUSB_RXFIFOSZ);
482 		/* Offset for these is fixed by sunxi_musb_busctl_offset() */
483 		case SUNXI_MUSB_TXFUNCADDR:
484 		case SUNXI_MUSB_TXHUBADDR:
485 		case SUNXI_MUSB_TXHUBPORT:
486 		case SUNXI_MUSB_RXFUNCADDR:
487 		case SUNXI_MUSB_RXHUBADDR:
488 		case SUNXI_MUSB_RXHUBPORT:
489 			/* multipoint / busctl reg access */
490 			return writeb(data, addr + offset);
491 		default:
492 			dev_err(sunxi_musb->controller->parent,
493 				"Error unknown writeb offset %u\n", offset);
494 			return;
495 		}
496 	} else if (addr == (sunxi_musb->mregs + 0x80)) {
497 		/* ep control reg access */
498 		if (offset >= MUSB_TXTYPE)
499 			offset += 2;
500 		return writeb(data, addr + offset);
501 	}
502 
503 	dev_err(sunxi_musb->controller->parent,
504 		"Error unknown writeb at 0x%x bytes offset\n",
505 		(int)(addr - sunxi_musb->mregs));
506 }
507 
508 static u16 sunxi_musb_readw(const void __iomem *addr, unsigned offset)
509 {
510 	if (addr == sunxi_musb->mregs) {
511 		/* generic control or fifo control reg access */
512 		switch (offset) {
513 		case MUSB_INTRTX:
514 			return readw(addr + SUNXI_MUSB_INTRTX);
515 		case MUSB_INTRRX:
516 			return readw(addr + SUNXI_MUSB_INTRRX);
517 		case MUSB_INTRTXE:
518 			return readw(addr + SUNXI_MUSB_INTRTXE);
519 		case MUSB_INTRRXE:
520 			return readw(addr + SUNXI_MUSB_INTRRXE);
521 		case MUSB_FRAME:
522 			return readw(addr + SUNXI_MUSB_FRAME);
523 		case MUSB_TXFIFOADD:
524 			return readw(addr + SUNXI_MUSB_TXFIFOADD);
525 		case MUSB_RXFIFOADD:
526 			return readw(addr + SUNXI_MUSB_RXFIFOADD);
527 		case MUSB_HWVERS:
528 			return 0; /* sunxi musb version is not known */
529 		default:
530 			dev_err(sunxi_musb->controller->parent,
531 				"Error unknown readw offset %u\n", offset);
532 			return 0;
533 		}
534 	} else if (addr == (sunxi_musb->mregs + 0x80)) {
535 		/* ep control reg access */
536 		return readw(addr + offset);
537 	}
538 
539 	dev_err(sunxi_musb->controller->parent,
540 		"Error unknown readw at 0x%x bytes offset\n",
541 		(int)(addr - sunxi_musb->mregs));
542 	return 0;
543 }
544 
545 static void sunxi_musb_writew(void __iomem *addr, unsigned offset, u16 data)
546 {
547 	if (addr == sunxi_musb->mregs) {
548 		/* generic control or fifo control reg access */
549 		switch (offset) {
550 		case MUSB_INTRTX:
551 			return writew(data, addr + SUNXI_MUSB_INTRTX);
552 		case MUSB_INTRRX:
553 			return writew(data, addr + SUNXI_MUSB_INTRRX);
554 		case MUSB_INTRTXE:
555 			return writew(data, addr + SUNXI_MUSB_INTRTXE);
556 		case MUSB_INTRRXE:
557 			return writew(data, addr + SUNXI_MUSB_INTRRXE);
558 		case MUSB_FRAME:
559 			return writew(data, addr + SUNXI_MUSB_FRAME);
560 		case MUSB_TXFIFOADD:
561 			return writew(data, addr + SUNXI_MUSB_TXFIFOADD);
562 		case MUSB_RXFIFOADD:
563 			return writew(data, addr + SUNXI_MUSB_RXFIFOADD);
564 		default:
565 			dev_err(sunxi_musb->controller->parent,
566 				"Error unknown writew offset %u\n", offset);
567 			return;
568 		}
569 	} else if (addr == (sunxi_musb->mregs + 0x80)) {
570 		/* ep control reg access */
571 		return writew(data, addr + offset);
572 	}
573 
574 	dev_err(sunxi_musb->controller->parent,
575 		"Error unknown writew at 0x%x bytes offset\n",
576 		(int)(addr - sunxi_musb->mregs));
577 }
578 
579 static const struct musb_platform_ops sunxi_musb_ops = {
580 	.quirks		= MUSB_INDEXED_EP,
581 	.init		= sunxi_musb_init,
582 	.exit		= sunxi_musb_exit,
583 	.enable		= sunxi_musb_enable,
584 	.disable	= sunxi_musb_disable,
585 	.set_mode	= sunxi_set_mode,
586 	.fifo_offset	= sunxi_musb_fifo_offset,
587 	.ep_offset	= sunxi_musb_ep_offset,
588 	.busctl_offset	= sunxi_musb_busctl_offset,
589 	.readb		= sunxi_musb_readb,
590 	.writeb		= sunxi_musb_writeb,
591 	.readw		= sunxi_musb_readw,
592 	.writew		= sunxi_musb_writew,
593 	.dma_init	= sunxi_musb_dma_controller_create,
594 	.dma_exit	= sunxi_musb_dma_controller_destroy,
595 	.set_vbus	= sunxi_musb_set_vbus,
596 	.pre_root_reset_end = sunxi_musb_pre_root_reset_end,
597 	.post_root_reset_end = sunxi_musb_post_root_reset_end,
598 };
599 
600 /* Allwinner OTG supports up to 5 endpoints */
601 #define SUNXI_MUSB_MAX_EP_NUM	6
602 #define SUNXI_MUSB_RAM_BITS	11
603 
604 static struct musb_fifo_cfg sunxi_musb_mode_cfg[] = {
605 	MUSB_EP_FIFO_SINGLE(1, FIFO_TX, 512),
606 	MUSB_EP_FIFO_SINGLE(1, FIFO_RX, 512),
607 	MUSB_EP_FIFO_SINGLE(2, FIFO_TX, 512),
608 	MUSB_EP_FIFO_SINGLE(2, FIFO_RX, 512),
609 	MUSB_EP_FIFO_SINGLE(3, FIFO_TX, 512),
610 	MUSB_EP_FIFO_SINGLE(3, FIFO_RX, 512),
611 	MUSB_EP_FIFO_SINGLE(4, FIFO_TX, 512),
612 	MUSB_EP_FIFO_SINGLE(4, FIFO_RX, 512),
613 	MUSB_EP_FIFO_SINGLE(5, FIFO_TX, 512),
614 	MUSB_EP_FIFO_SINGLE(5, FIFO_RX, 512),
615 };
616 
617 static struct musb_hdrc_config sunxi_musb_hdrc_config = {
618 	.fifo_cfg       = sunxi_musb_mode_cfg,
619 	.fifo_cfg_size  = ARRAY_SIZE(sunxi_musb_mode_cfg),
620 	.multipoint	= true,
621 	.dyn_fifo	= true,
622 	.soft_con       = true,
623 	.num_eps	= SUNXI_MUSB_MAX_EP_NUM,
624 	.ram_bits	= SUNXI_MUSB_RAM_BITS,
625 	.dma		= 0,
626 };
627 
628 static int sunxi_musb_probe(struct platform_device *pdev)
629 {
630 	struct musb_hdrc_platform_data	pdata;
631 	struct platform_device_info	pinfo;
632 	struct sunxi_glue		*glue;
633 	struct device_node		*np = pdev->dev.of_node;
634 	int ret;
635 
636 	if (!np) {
637 		dev_err(&pdev->dev, "Error no device tree node found\n");
638 		return -EINVAL;
639 	}
640 
641 	glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
642 	if (!glue)
643 		return -ENOMEM;
644 
645 	memset(&pdata, 0, sizeof(pdata));
646 	switch (usb_get_dr_mode(&pdev->dev)) {
647 #if defined CONFIG_USB_MUSB_DUAL_ROLE || defined CONFIG_USB_MUSB_HOST
648 	case USB_DR_MODE_HOST:
649 		pdata.mode = MUSB_PORT_MODE_HOST;
650 		break;
651 #endif
652 #ifdef CONFIG_USB_MUSB_DUAL_ROLE
653 	case USB_DR_MODE_OTG:
654 		glue->extcon = extcon_get_edev_by_phandle(&pdev->dev, 0);
655 		if (IS_ERR(glue->extcon)) {
656 			if (PTR_ERR(glue->extcon) == -EPROBE_DEFER)
657 				return -EPROBE_DEFER;
658 			dev_err(&pdev->dev, "Invalid or missing extcon\n");
659 			return PTR_ERR(glue->extcon);
660 		}
661 		pdata.mode = MUSB_PORT_MODE_DUAL_ROLE;
662 		break;
663 #endif
664 	default:
665 		dev_err(&pdev->dev, "Invalid or missing 'dr_mode' property\n");
666 		return -EINVAL;
667 	}
668 	pdata.platform_ops	= &sunxi_musb_ops;
669 	pdata.config		= &sunxi_musb_hdrc_config;
670 
671 	glue->dev = &pdev->dev;
672 	INIT_WORK(&glue->work, sunxi_musb_work);
673 	glue->host_nb.notifier_call = sunxi_musb_host_notifier;
674 
675 	if (of_device_is_compatible(np, "allwinner,sun4i-a10-musb"))
676 		set_bit(SUNXI_MUSB_FL_HAS_SRAM, &glue->flags);
677 
678 	if (of_device_is_compatible(np, "allwinner,sun6i-a31-musb"))
679 		set_bit(SUNXI_MUSB_FL_HAS_RESET, &glue->flags);
680 
681 	if (of_device_is_compatible(np, "allwinner,sun8i-a33-musb")) {
682 		set_bit(SUNXI_MUSB_FL_HAS_RESET, &glue->flags);
683 		set_bit(SUNXI_MUSB_FL_NO_CONFIGDATA, &glue->flags);
684 	}
685 
686 	glue->clk = devm_clk_get(&pdev->dev, NULL);
687 	if (IS_ERR(glue->clk)) {
688 		dev_err(&pdev->dev, "Error getting clock: %ld\n",
689 			PTR_ERR(glue->clk));
690 		return PTR_ERR(glue->clk);
691 	}
692 
693 	if (test_bit(SUNXI_MUSB_FL_HAS_RESET, &glue->flags)) {
694 		glue->rst = devm_reset_control_get(&pdev->dev, NULL);
695 		if (IS_ERR(glue->rst)) {
696 			if (PTR_ERR(glue->rst) == -EPROBE_DEFER)
697 				return -EPROBE_DEFER;
698 			dev_err(&pdev->dev, "Error getting reset %ld\n",
699 				PTR_ERR(glue->rst));
700 			return PTR_ERR(glue->rst);
701 		}
702 	}
703 
704 	glue->phy = devm_phy_get(&pdev->dev, "usb");
705 	if (IS_ERR(glue->phy)) {
706 		if (PTR_ERR(glue->phy) == -EPROBE_DEFER)
707 			return -EPROBE_DEFER;
708 		dev_err(&pdev->dev, "Error getting phy %ld\n",
709 			PTR_ERR(glue->phy));
710 		return PTR_ERR(glue->phy);
711 	}
712 
713 	glue->usb_phy = usb_phy_generic_register();
714 	if (IS_ERR(glue->usb_phy)) {
715 		dev_err(&pdev->dev, "Error registering usb-phy %ld\n",
716 			PTR_ERR(glue->usb_phy));
717 		return PTR_ERR(glue->usb_phy);
718 	}
719 
720 	glue->xceiv = devm_usb_get_phy(&pdev->dev, USB_PHY_TYPE_USB2);
721 	if (IS_ERR(glue->xceiv)) {
722 		ret = PTR_ERR(glue->xceiv);
723 		dev_err(&pdev->dev, "Error getting usb-phy %d\n", ret);
724 		goto err_unregister_usb_phy;
725 	}
726 
727 	platform_set_drvdata(pdev, glue);
728 
729 	memset(&pinfo, 0, sizeof(pinfo));
730 	pinfo.name	 = "musb-hdrc";
731 	pinfo.id	= PLATFORM_DEVID_AUTO;
732 	pinfo.parent	= &pdev->dev;
733 	pinfo.res	= pdev->resource;
734 	pinfo.num_res	= pdev->num_resources;
735 	pinfo.data	= &pdata;
736 	pinfo.size_data = sizeof(pdata);
737 
738 	glue->musb_pdev = platform_device_register_full(&pinfo);
739 	if (IS_ERR(glue->musb_pdev)) {
740 		ret = PTR_ERR(glue->musb_pdev);
741 		dev_err(&pdev->dev, "Error registering musb dev: %d\n", ret);
742 		goto err_unregister_usb_phy;
743 	}
744 
745 	return 0;
746 
747 err_unregister_usb_phy:
748 	usb_phy_generic_unregister(glue->usb_phy);
749 	return ret;
750 }
751 
752 static int sunxi_musb_remove(struct platform_device *pdev)
753 {
754 	struct sunxi_glue *glue = platform_get_drvdata(pdev);
755 	struct platform_device *usb_phy = glue->usb_phy;
756 
757 	platform_device_unregister(glue->musb_pdev);
758 	usb_phy_generic_unregister(usb_phy);
759 
760 	return 0;
761 }
762 
763 static const struct of_device_id sunxi_musb_match[] = {
764 	{ .compatible = "allwinner,sun4i-a10-musb", },
765 	{ .compatible = "allwinner,sun6i-a31-musb", },
766 	{ .compatible = "allwinner,sun8i-a33-musb", },
767 	{}
768 };
769 MODULE_DEVICE_TABLE(of, sunxi_musb_match);
770 
771 static struct platform_driver sunxi_musb_driver = {
772 	.probe = sunxi_musb_probe,
773 	.remove = sunxi_musb_remove,
774 	.driver = {
775 		.name = "musb-sunxi",
776 		.of_match_table = sunxi_musb_match,
777 	},
778 };
779 module_platform_driver(sunxi_musb_driver);
780 
781 MODULE_DESCRIPTION("Allwinner sunxi MUSB Glue Layer");
782 MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
783 MODULE_LICENSE("GPL v2");
784