xref: /openbmc/linux/drivers/usb/phy/phy-fsl-usb.c (revision 5e0266f0)
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2007,2008 Freescale semiconductor, Inc.
4  *
5  * Author: Li Yang <LeoLi@freescale.com>
6  *         Jerry Huang <Chang-Ming.Huang@freescale.com>
7  *
8  * Initialization based on code from Shlomi Gridish.
9  */
10 
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/delay.h>
14 #include <linux/slab.h>
15 #include <linux/proc_fs.h>
16 #include <linux/errno.h>
17 #include <linux/interrupt.h>
18 #include <linux/io.h>
19 #include <linux/timer.h>
20 #include <linux/usb.h>
21 #include <linux/device.h>
22 #include <linux/usb/ch9.h>
23 #include <linux/usb/gadget.h>
24 #include <linux/workqueue.h>
25 #include <linux/time.h>
26 #include <linux/fsl_devices.h>
27 #include <linux/platform_device.h>
28 #include <linux/uaccess.h>
29 
30 #include <asm/unaligned.h>
31 
32 #include "phy-fsl-usb.h"
33 
34 #ifdef VERBOSE
35 #define VDBG(fmt, args...) pr_debug("[%s]  " fmt, \
36 				 __func__, ## args)
37 #else
38 #define VDBG(stuff...)	do {} while (0)
39 #endif
40 
41 #define DRIVER_VERSION "Rev. 1.55"
42 #define DRIVER_AUTHOR "Jerry Huang/Li Yang"
43 #define DRIVER_DESC "Freescale USB OTG Transceiver Driver"
44 #define DRIVER_INFO DRIVER_DESC " " DRIVER_VERSION
45 
46 static const char driver_name[] = "fsl-usb2-otg";
47 
48 const pm_message_t otg_suspend_state = {
49 	.event = 1,
50 };
51 
52 #define HA_DATA_PULSE
53 
54 static struct usb_dr_mmap *usb_dr_regs;
55 static struct fsl_otg *fsl_otg_dev;
56 static int srp_wait_done;
57 
58 /* FSM timers */
59 struct fsl_otg_timer *a_wait_vrise_tmr, *a_wait_bcon_tmr, *a_aidl_bdis_tmr,
60 	*b_ase0_brst_tmr, *b_se0_srp_tmr;
61 
62 /* Driver specific timers */
63 struct fsl_otg_timer *b_data_pulse_tmr, *b_vbus_pulse_tmr, *b_srp_fail_tmr,
64 	*b_srp_wait_tmr, *a_wait_enum_tmr;
65 
66 static struct list_head active_timers;
67 
68 static const struct fsl_otg_config fsl_otg_initdata = {
69 	.otg_port = 1,
70 };
71 
72 #ifdef CONFIG_PPC32
73 static u32 _fsl_readl_be(const unsigned __iomem *p)
74 {
75 	return in_be32(p);
76 }
77 
78 static u32 _fsl_readl_le(const unsigned __iomem *p)
79 {
80 	return in_le32(p);
81 }
82 
83 static void _fsl_writel_be(u32 v, unsigned __iomem *p)
84 {
85 	out_be32(p, v);
86 }
87 
88 static void _fsl_writel_le(u32 v, unsigned __iomem *p)
89 {
90 	out_le32(p, v);
91 }
92 
93 static u32 (*_fsl_readl)(const unsigned __iomem *p);
94 static void (*_fsl_writel)(u32 v, unsigned __iomem *p);
95 
96 #define fsl_readl(p)		(*_fsl_readl)((p))
97 #define fsl_writel(v, p)	(*_fsl_writel)((v), (p))
98 
99 #else
100 #define fsl_readl(addr)		readl(addr)
101 #define fsl_writel(val, addr)	writel(val, addr)
102 #endif /* CONFIG_PPC32 */
103 
104 int write_ulpi(u8 addr, u8 data)
105 {
106 	u32 temp;
107 
108 	temp = 0x60000000 | (addr << 16) | data;
109 	fsl_writel(temp, &usb_dr_regs->ulpiview);
110 	return 0;
111 }
112 
113 /* -------------------------------------------------------------*/
114 /* Operations that will be called from OTG Finite State Machine */
115 
116 /* Charge vbus for vbus pulsing in SRP */
117 void fsl_otg_chrg_vbus(struct otg_fsm *fsm, int on)
118 {
119 	u32 tmp;
120 
121 	tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK;
122 
123 	if (on)
124 		/* stop discharging, start charging */
125 		tmp = (tmp & ~OTGSC_CTRL_VBUS_DISCHARGE) |
126 			OTGSC_CTRL_VBUS_CHARGE;
127 	else
128 		/* stop charging */
129 		tmp &= ~OTGSC_CTRL_VBUS_CHARGE;
130 
131 	fsl_writel(tmp, &usb_dr_regs->otgsc);
132 }
133 
134 /* Discharge vbus through a resistor to ground */
135 void fsl_otg_dischrg_vbus(int on)
136 {
137 	u32 tmp;
138 
139 	tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK;
140 
141 	if (on)
142 		/* stop charging, start discharging */
143 		tmp = (tmp & ~OTGSC_CTRL_VBUS_CHARGE) |
144 			OTGSC_CTRL_VBUS_DISCHARGE;
145 	else
146 		/* stop discharging */
147 		tmp &= ~OTGSC_CTRL_VBUS_DISCHARGE;
148 
149 	fsl_writel(tmp, &usb_dr_regs->otgsc);
150 }
151 
152 /* A-device driver vbus, controlled through PP bit in PORTSC */
153 void fsl_otg_drv_vbus(struct otg_fsm *fsm, int on)
154 {
155 	u32 tmp;
156 
157 	if (on) {
158 		tmp = fsl_readl(&usb_dr_regs->portsc) & ~PORTSC_W1C_BITS;
159 		fsl_writel(tmp | PORTSC_PORT_POWER, &usb_dr_regs->portsc);
160 	} else {
161 		tmp = fsl_readl(&usb_dr_regs->portsc) &
162 		      ~PORTSC_W1C_BITS & ~PORTSC_PORT_POWER;
163 		fsl_writel(tmp, &usb_dr_regs->portsc);
164 	}
165 }
166 
167 /*
168  * Pull-up D+, signalling connect by periperal. Also used in
169  * data-line pulsing in SRP
170  */
171 void fsl_otg_loc_conn(struct otg_fsm *fsm, int on)
172 {
173 	u32 tmp;
174 
175 	tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK;
176 
177 	if (on)
178 		tmp |= OTGSC_CTRL_DATA_PULSING;
179 	else
180 		tmp &= ~OTGSC_CTRL_DATA_PULSING;
181 
182 	fsl_writel(tmp, &usb_dr_regs->otgsc);
183 }
184 
185 /*
186  * Generate SOF by host.  This is controlled through suspend/resume the
187  * port.  In host mode, controller will automatically send SOF.
188  * Suspend will block the data on the port.
189  */
190 void fsl_otg_loc_sof(struct otg_fsm *fsm, int on)
191 {
192 	u32 tmp;
193 
194 	tmp = fsl_readl(&fsl_otg_dev->dr_mem_map->portsc) & ~PORTSC_W1C_BITS;
195 	if (on)
196 		tmp |= PORTSC_PORT_FORCE_RESUME;
197 	else
198 		tmp |= PORTSC_PORT_SUSPEND;
199 
200 	fsl_writel(tmp, &fsl_otg_dev->dr_mem_map->portsc);
201 
202 }
203 
204 /* Start SRP pulsing by data-line pulsing, followed with v-bus pulsing. */
205 void fsl_otg_start_pulse(struct otg_fsm *fsm)
206 {
207 	u32 tmp;
208 
209 	srp_wait_done = 0;
210 #ifdef HA_DATA_PULSE
211 	tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK;
212 	tmp |= OTGSC_HA_DATA_PULSE;
213 	fsl_writel(tmp, &usb_dr_regs->otgsc);
214 #else
215 	fsl_otg_loc_conn(1);
216 #endif
217 
218 	fsl_otg_add_timer(fsm, b_data_pulse_tmr);
219 }
220 
221 void b_data_pulse_end(unsigned long foo)
222 {
223 #ifdef HA_DATA_PULSE
224 #else
225 	fsl_otg_loc_conn(0);
226 #endif
227 
228 	/* Do VBUS pulse after data pulse */
229 	fsl_otg_pulse_vbus();
230 }
231 
232 void fsl_otg_pulse_vbus(void)
233 {
234 	srp_wait_done = 0;
235 	fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 1);
236 	/* start the timer to end vbus charge */
237 	fsl_otg_add_timer(&fsl_otg_dev->fsm, b_vbus_pulse_tmr);
238 }
239 
240 void b_vbus_pulse_end(unsigned long foo)
241 {
242 	fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 0);
243 
244 	/*
245 	 * As USB3300 using the same a_sess_vld and b_sess_vld voltage
246 	 * we need to discharge the bus for a while to distinguish
247 	 * residual voltage of vbus pulsing and A device pull up
248 	 */
249 	fsl_otg_dischrg_vbus(1);
250 	fsl_otg_add_timer(&fsl_otg_dev->fsm, b_srp_wait_tmr);
251 }
252 
253 void b_srp_end(unsigned long foo)
254 {
255 	fsl_otg_dischrg_vbus(0);
256 	srp_wait_done = 1;
257 
258 	if ((fsl_otg_dev->phy.otg->state == OTG_STATE_B_SRP_INIT) &&
259 	    fsl_otg_dev->fsm.b_sess_vld)
260 		fsl_otg_dev->fsm.b_srp_done = 1;
261 }
262 
263 /*
264  * Workaround for a_host suspending too fast.  When a_bus_req=0,
265  * a_host will start by SRP.  It needs to set b_hnp_enable before
266  * actually suspending to start HNP
267  */
268 void a_wait_enum(unsigned long foo)
269 {
270 	VDBG("a_wait_enum timeout\n");
271 	if (!fsl_otg_dev->phy.otg->host->b_hnp_enable)
272 		fsl_otg_add_timer(&fsl_otg_dev->fsm, a_wait_enum_tmr);
273 	else
274 		otg_statemachine(&fsl_otg_dev->fsm);
275 }
276 
277 /* The timeout callback function to set time out bit */
278 void set_tmout(unsigned long indicator)
279 {
280 	*(int *)indicator = 1;
281 }
282 
283 /* Initialize timers */
284 int fsl_otg_init_timers(struct otg_fsm *fsm)
285 {
286 	/* FSM used timers */
287 	a_wait_vrise_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_VRISE,
288 				(unsigned long)&fsm->a_wait_vrise_tmout);
289 	if (!a_wait_vrise_tmr)
290 		return -ENOMEM;
291 
292 	a_wait_bcon_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_BCON,
293 				(unsigned long)&fsm->a_wait_bcon_tmout);
294 	if (!a_wait_bcon_tmr)
295 		return -ENOMEM;
296 
297 	a_aidl_bdis_tmr = otg_timer_initializer(&set_tmout, TA_AIDL_BDIS,
298 				(unsigned long)&fsm->a_aidl_bdis_tmout);
299 	if (!a_aidl_bdis_tmr)
300 		return -ENOMEM;
301 
302 	b_ase0_brst_tmr = otg_timer_initializer(&set_tmout, TB_ASE0_BRST,
303 				(unsigned long)&fsm->b_ase0_brst_tmout);
304 	if (!b_ase0_brst_tmr)
305 		return -ENOMEM;
306 
307 	b_se0_srp_tmr = otg_timer_initializer(&set_tmout, TB_SE0_SRP,
308 				(unsigned long)&fsm->b_se0_srp);
309 	if (!b_se0_srp_tmr)
310 		return -ENOMEM;
311 
312 	b_srp_fail_tmr = otg_timer_initializer(&set_tmout, TB_SRP_FAIL,
313 				(unsigned long)&fsm->b_srp_done);
314 	if (!b_srp_fail_tmr)
315 		return -ENOMEM;
316 
317 	a_wait_enum_tmr = otg_timer_initializer(&a_wait_enum, 10,
318 				(unsigned long)&fsm);
319 	if (!a_wait_enum_tmr)
320 		return -ENOMEM;
321 
322 	/* device driver used timers */
323 	b_srp_wait_tmr = otg_timer_initializer(&b_srp_end, TB_SRP_WAIT, 0);
324 	if (!b_srp_wait_tmr)
325 		return -ENOMEM;
326 
327 	b_data_pulse_tmr = otg_timer_initializer(&b_data_pulse_end,
328 				TB_DATA_PLS, 0);
329 	if (!b_data_pulse_tmr)
330 		return -ENOMEM;
331 
332 	b_vbus_pulse_tmr = otg_timer_initializer(&b_vbus_pulse_end,
333 				TB_VBUS_PLS, 0);
334 	if (!b_vbus_pulse_tmr)
335 		return -ENOMEM;
336 
337 	return 0;
338 }
339 
340 /* Uninitialize timers */
341 void fsl_otg_uninit_timers(void)
342 {
343 	/* FSM used timers */
344 	kfree(a_wait_vrise_tmr);
345 	kfree(a_wait_bcon_tmr);
346 	kfree(a_aidl_bdis_tmr);
347 	kfree(b_ase0_brst_tmr);
348 	kfree(b_se0_srp_tmr);
349 	kfree(b_srp_fail_tmr);
350 	kfree(a_wait_enum_tmr);
351 
352 	/* device driver used timers */
353 	kfree(b_srp_wait_tmr);
354 	kfree(b_data_pulse_tmr);
355 	kfree(b_vbus_pulse_tmr);
356 }
357 
358 static struct fsl_otg_timer *fsl_otg_get_timer(enum otg_fsm_timer t)
359 {
360 	struct fsl_otg_timer *timer;
361 
362 	/* REVISIT: use array of pointers to timers instead */
363 	switch (t) {
364 	case A_WAIT_VRISE:
365 		timer = a_wait_vrise_tmr;
366 		break;
367 	case A_WAIT_BCON:
368 		timer = a_wait_vrise_tmr;
369 		break;
370 	case A_AIDL_BDIS:
371 		timer = a_wait_vrise_tmr;
372 		break;
373 	case B_ASE0_BRST:
374 		timer = a_wait_vrise_tmr;
375 		break;
376 	case B_SE0_SRP:
377 		timer = a_wait_vrise_tmr;
378 		break;
379 	case B_SRP_FAIL:
380 		timer = a_wait_vrise_tmr;
381 		break;
382 	case A_WAIT_ENUM:
383 		timer = a_wait_vrise_tmr;
384 		break;
385 	default:
386 		timer = NULL;
387 	}
388 
389 	return timer;
390 }
391 
392 /* Add timer to timer list */
393 void fsl_otg_add_timer(struct otg_fsm *fsm, void *gtimer)
394 {
395 	struct fsl_otg_timer *timer = gtimer;
396 	struct fsl_otg_timer *tmp_timer;
397 
398 	/*
399 	 * Check if the timer is already in the active list,
400 	 * if so update timer count
401 	 */
402 	list_for_each_entry(tmp_timer, &active_timers, list)
403 	    if (tmp_timer == timer) {
404 		timer->count = timer->expires;
405 		return;
406 	}
407 	timer->count = timer->expires;
408 	list_add_tail(&timer->list, &active_timers);
409 }
410 
411 static void fsl_otg_fsm_add_timer(struct otg_fsm *fsm, enum otg_fsm_timer t)
412 {
413 	struct fsl_otg_timer *timer;
414 
415 	timer = fsl_otg_get_timer(t);
416 	if (!timer)
417 		return;
418 
419 	fsl_otg_add_timer(fsm, timer);
420 }
421 
422 /* Remove timer from the timer list; clear timeout status */
423 void fsl_otg_del_timer(struct otg_fsm *fsm, void *gtimer)
424 {
425 	struct fsl_otg_timer *timer = gtimer;
426 	struct fsl_otg_timer *tmp_timer, *del_tmp;
427 
428 	list_for_each_entry_safe(tmp_timer, del_tmp, &active_timers, list)
429 		if (tmp_timer == timer)
430 			list_del(&timer->list);
431 }
432 
433 static void fsl_otg_fsm_del_timer(struct otg_fsm *fsm, enum otg_fsm_timer t)
434 {
435 	struct fsl_otg_timer *timer;
436 
437 	timer = fsl_otg_get_timer(t);
438 	if (!timer)
439 		return;
440 
441 	fsl_otg_del_timer(fsm, timer);
442 }
443 
444 /* Reset controller, not reset the bus */
445 void otg_reset_controller(void)
446 {
447 	u32 command;
448 
449 	command = fsl_readl(&usb_dr_regs->usbcmd);
450 	command |= (1 << 1);
451 	fsl_writel(command, &usb_dr_regs->usbcmd);
452 	while (fsl_readl(&usb_dr_regs->usbcmd) & (1 << 1))
453 		;
454 }
455 
456 /* Call suspend/resume routines in host driver */
457 int fsl_otg_start_host(struct otg_fsm *fsm, int on)
458 {
459 	struct usb_otg *otg = fsm->otg;
460 	struct device *dev;
461 	struct fsl_otg *otg_dev =
462 		container_of(otg->usb_phy, struct fsl_otg, phy);
463 	u32 retval = 0;
464 
465 	if (!otg->host)
466 		return -ENODEV;
467 	dev = otg->host->controller;
468 
469 	/*
470 	 * Update a_vbus_vld state as a_vbus_vld int is disabled
471 	 * in device mode
472 	 */
473 	fsm->a_vbus_vld =
474 		!!(fsl_readl(&usb_dr_regs->otgsc) & OTGSC_STS_A_VBUS_VALID);
475 	if (on) {
476 		/* start fsl usb host controller */
477 		if (otg_dev->host_working)
478 			goto end;
479 		else {
480 			otg_reset_controller();
481 			VDBG("host on......\n");
482 			if (dev->driver->pm && dev->driver->pm->resume) {
483 				retval = dev->driver->pm->resume(dev);
484 				if (fsm->id) {
485 					/* default-b */
486 					fsl_otg_drv_vbus(fsm, 1);
487 					/*
488 					 * Workaround: b_host can't driver
489 					 * vbus, but PP in PORTSC needs to
490 					 * be 1 for host to work.
491 					 * So we set drv_vbus bit in
492 					 * transceiver to 0 thru ULPI.
493 					 */
494 					write_ulpi(0x0c, 0x20);
495 				}
496 			}
497 
498 			otg_dev->host_working = 1;
499 		}
500 	} else {
501 		/* stop fsl usb host controller */
502 		if (!otg_dev->host_working)
503 			goto end;
504 		else {
505 			VDBG("host off......\n");
506 			if (dev && dev->driver) {
507 				if (dev->driver->pm && dev->driver->pm->suspend)
508 					retval = dev->driver->pm->suspend(dev);
509 				if (fsm->id)
510 					/* default-b */
511 					fsl_otg_drv_vbus(fsm, 0);
512 			}
513 			otg_dev->host_working = 0;
514 		}
515 	}
516 end:
517 	return retval;
518 }
519 
520 /*
521  * Call suspend and resume function in udc driver
522  * to stop and start udc driver.
523  */
524 int fsl_otg_start_gadget(struct otg_fsm *fsm, int on)
525 {
526 	struct usb_otg *otg = fsm->otg;
527 	struct device *dev;
528 
529 	if (!otg->gadget || !otg->gadget->dev.parent)
530 		return -ENODEV;
531 
532 	VDBG("gadget %s\n", on ? "on" : "off");
533 	dev = otg->gadget->dev.parent;
534 
535 	if (on) {
536 		if (dev->driver->resume)
537 			dev->driver->resume(dev);
538 	} else {
539 		if (dev->driver->suspend)
540 			dev->driver->suspend(dev, otg_suspend_state);
541 	}
542 
543 	return 0;
544 }
545 
546 /*
547  * Called by initialization code of host driver.  Register host controller
548  * to the OTG.  Suspend host for OTG role detection.
549  */
550 static int fsl_otg_set_host(struct usb_otg *otg, struct usb_bus *host)
551 {
552 	struct fsl_otg *otg_dev;
553 
554 	if (!otg)
555 		return -ENODEV;
556 
557 	otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
558 	if (otg_dev != fsl_otg_dev)
559 		return -ENODEV;
560 
561 	otg->host = host;
562 
563 	otg_dev->fsm.a_bus_drop = 0;
564 	otg_dev->fsm.a_bus_req = 1;
565 
566 	if (host) {
567 		VDBG("host off......\n");
568 
569 		otg->host->otg_port = fsl_otg_initdata.otg_port;
570 		otg->host->is_b_host = otg_dev->fsm.id;
571 		/*
572 		 * must leave time for hub_wq to finish its thing
573 		 * before yanking the host driver out from under it,
574 		 * so suspend the host after a short delay.
575 		 */
576 		otg_dev->host_working = 1;
577 		schedule_delayed_work(&otg_dev->otg_event, 100);
578 		return 0;
579 	} else {
580 		/* host driver going away */
581 		if (!(fsl_readl(&otg_dev->dr_mem_map->otgsc) &
582 		      OTGSC_STS_USB_ID)) {
583 			/* Mini-A cable connected */
584 			struct otg_fsm *fsm = &otg_dev->fsm;
585 
586 			otg->state = OTG_STATE_UNDEFINED;
587 			fsm->protocol = PROTO_UNDEF;
588 		}
589 	}
590 
591 	otg_dev->host_working = 0;
592 
593 	otg_statemachine(&otg_dev->fsm);
594 
595 	return 0;
596 }
597 
598 /* Called by initialization code of udc.  Register udc to OTG. */
599 static int fsl_otg_set_peripheral(struct usb_otg *otg,
600 					struct usb_gadget *gadget)
601 {
602 	struct fsl_otg *otg_dev;
603 
604 	if (!otg)
605 		return -ENODEV;
606 
607 	otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
608 	VDBG("otg_dev 0x%x\n", (int)otg_dev);
609 	VDBG("fsl_otg_dev 0x%x\n", (int)fsl_otg_dev);
610 	if (otg_dev != fsl_otg_dev)
611 		return -ENODEV;
612 
613 	if (!gadget) {
614 		if (!otg->default_a)
615 			otg->gadget->ops->vbus_draw(otg->gadget, 0);
616 		usb_gadget_vbus_disconnect(otg->gadget);
617 		otg->gadget = 0;
618 		otg_dev->fsm.b_bus_req = 0;
619 		otg_statemachine(&otg_dev->fsm);
620 		return 0;
621 	}
622 
623 	otg->gadget = gadget;
624 	otg->gadget->is_a_peripheral = !otg_dev->fsm.id;
625 
626 	otg_dev->fsm.b_bus_req = 1;
627 
628 	/* start the gadget right away if the ID pin says Mini-B */
629 	pr_debug("ID pin=%d\n", otg_dev->fsm.id);
630 	if (otg_dev->fsm.id == 1) {
631 		fsl_otg_start_host(&otg_dev->fsm, 0);
632 		otg_drv_vbus(&otg_dev->fsm, 0);
633 		fsl_otg_start_gadget(&otg_dev->fsm, 1);
634 	}
635 
636 	return 0;
637 }
638 
639 /*
640  * Delayed pin detect interrupt processing.
641  *
642  * When the Mini-A cable is disconnected from the board,
643  * the pin-detect interrupt happens before the disconnect
644  * interrupts for the connected device(s).  In order to
645  * process the disconnect interrupt(s) prior to switching
646  * roles, the pin-detect interrupts are delayed, and handled
647  * by this routine.
648  */
649 static void fsl_otg_event(struct work_struct *work)
650 {
651 	struct fsl_otg *og = container_of(work, struct fsl_otg, otg_event.work);
652 	struct otg_fsm *fsm = &og->fsm;
653 
654 	if (fsm->id) {		/* switch to gadget */
655 		fsl_otg_start_host(fsm, 0);
656 		otg_drv_vbus(fsm, 0);
657 		fsl_otg_start_gadget(fsm, 1);
658 	}
659 }
660 
661 /* B-device start SRP */
662 static int fsl_otg_start_srp(struct usb_otg *otg)
663 {
664 	struct fsl_otg *otg_dev;
665 
666 	if (!otg || otg->state != OTG_STATE_B_IDLE)
667 		return -ENODEV;
668 
669 	otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
670 	if (otg_dev != fsl_otg_dev)
671 		return -ENODEV;
672 
673 	otg_dev->fsm.b_bus_req = 1;
674 	otg_statemachine(&otg_dev->fsm);
675 
676 	return 0;
677 }
678 
679 /* A_host suspend will call this function to start hnp */
680 static int fsl_otg_start_hnp(struct usb_otg *otg)
681 {
682 	struct fsl_otg *otg_dev;
683 
684 	if (!otg)
685 		return -ENODEV;
686 
687 	otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
688 	if (otg_dev != fsl_otg_dev)
689 		return -ENODEV;
690 
691 	pr_debug("start_hnp...\n");
692 
693 	/* clear a_bus_req to enter a_suspend state */
694 	otg_dev->fsm.a_bus_req = 0;
695 	otg_statemachine(&otg_dev->fsm);
696 
697 	return 0;
698 }
699 
700 /*
701  * Interrupt handler.  OTG/host/peripheral share the same int line.
702  * OTG driver clears OTGSC interrupts and leaves USB interrupts
703  * intact.  It needs to have knowledge of some USB interrupts
704  * such as port change.
705  */
706 irqreturn_t fsl_otg_isr(int irq, void *dev_id)
707 {
708 	struct otg_fsm *fsm = &((struct fsl_otg *)dev_id)->fsm;
709 	struct usb_otg *otg = ((struct fsl_otg *)dev_id)->phy.otg;
710 	u32 otg_int_src, otg_sc;
711 
712 	otg_sc = fsl_readl(&usb_dr_regs->otgsc);
713 	otg_int_src = otg_sc & OTGSC_INTSTS_MASK & (otg_sc >> 8);
714 
715 	/* Only clear otg interrupts */
716 	fsl_writel(otg_sc, &usb_dr_regs->otgsc);
717 
718 	/*FIXME: ID change not generate when init to 0 */
719 	fsm->id = (otg_sc & OTGSC_STS_USB_ID) ? 1 : 0;
720 	otg->default_a = (fsm->id == 0);
721 
722 	/* process OTG interrupts */
723 	if (otg_int_src) {
724 		if (otg_int_src & OTGSC_INTSTS_USB_ID) {
725 			fsm->id = (otg_sc & OTGSC_STS_USB_ID) ? 1 : 0;
726 			otg->default_a = (fsm->id == 0);
727 			/* clear conn information */
728 			if (fsm->id)
729 				fsm->b_conn = 0;
730 			else
731 				fsm->a_conn = 0;
732 
733 			if (otg->host)
734 				otg->host->is_b_host = fsm->id;
735 			if (otg->gadget)
736 				otg->gadget->is_a_peripheral = !fsm->id;
737 			VDBG("ID int (ID is %d)\n", fsm->id);
738 
739 			if (fsm->id) {	/* switch to gadget */
740 				schedule_delayed_work(
741 					&((struct fsl_otg *)dev_id)->otg_event,
742 					100);
743 			} else {	/* switch to host */
744 				cancel_delayed_work(&
745 						    ((struct fsl_otg *)dev_id)->
746 						    otg_event);
747 				fsl_otg_start_gadget(fsm, 0);
748 				otg_drv_vbus(fsm, 1);
749 				fsl_otg_start_host(fsm, 1);
750 			}
751 			return IRQ_HANDLED;
752 		}
753 	}
754 	return IRQ_NONE;
755 }
756 
757 static struct otg_fsm_ops fsl_otg_ops = {
758 	.chrg_vbus = fsl_otg_chrg_vbus,
759 	.drv_vbus = fsl_otg_drv_vbus,
760 	.loc_conn = fsl_otg_loc_conn,
761 	.loc_sof = fsl_otg_loc_sof,
762 	.start_pulse = fsl_otg_start_pulse,
763 
764 	.add_timer = fsl_otg_fsm_add_timer,
765 	.del_timer = fsl_otg_fsm_del_timer,
766 
767 	.start_host = fsl_otg_start_host,
768 	.start_gadget = fsl_otg_start_gadget,
769 };
770 
771 /* Initialize the global variable fsl_otg_dev and request IRQ for OTG */
772 static int fsl_otg_conf(struct platform_device *pdev)
773 {
774 	struct fsl_otg *fsl_otg_tc;
775 	int status;
776 
777 	if (fsl_otg_dev)
778 		return 0;
779 
780 	/* allocate space to fsl otg device */
781 	fsl_otg_tc = kzalloc(sizeof(struct fsl_otg), GFP_KERNEL);
782 	if (!fsl_otg_tc)
783 		return -ENOMEM;
784 
785 	fsl_otg_tc->phy.otg = kzalloc(sizeof(struct usb_otg), GFP_KERNEL);
786 	if (!fsl_otg_tc->phy.otg) {
787 		kfree(fsl_otg_tc);
788 		return -ENOMEM;
789 	}
790 
791 	INIT_DELAYED_WORK(&fsl_otg_tc->otg_event, fsl_otg_event);
792 
793 	INIT_LIST_HEAD(&active_timers);
794 	status = fsl_otg_init_timers(&fsl_otg_tc->fsm);
795 	if (status) {
796 		pr_info("Couldn't init OTG timers\n");
797 		goto err;
798 	}
799 	mutex_init(&fsl_otg_tc->fsm.lock);
800 
801 	/* Set OTG state machine operations */
802 	fsl_otg_tc->fsm.ops = &fsl_otg_ops;
803 
804 	/* initialize the otg structure */
805 	fsl_otg_tc->phy.label = DRIVER_DESC;
806 	fsl_otg_tc->phy.dev = &pdev->dev;
807 
808 	fsl_otg_tc->phy.otg->usb_phy = &fsl_otg_tc->phy;
809 	fsl_otg_tc->phy.otg->set_host = fsl_otg_set_host;
810 	fsl_otg_tc->phy.otg->set_peripheral = fsl_otg_set_peripheral;
811 	fsl_otg_tc->phy.otg->start_hnp = fsl_otg_start_hnp;
812 	fsl_otg_tc->phy.otg->start_srp = fsl_otg_start_srp;
813 
814 	fsl_otg_dev = fsl_otg_tc;
815 
816 	/* Store the otg transceiver */
817 	status = usb_add_phy(&fsl_otg_tc->phy, USB_PHY_TYPE_USB2);
818 	if (status) {
819 		pr_warn(FSL_OTG_NAME ": unable to register OTG transceiver.\n");
820 		goto err;
821 	}
822 
823 	return 0;
824 err:
825 	fsl_otg_uninit_timers();
826 	kfree(fsl_otg_tc->phy.otg);
827 	kfree(fsl_otg_tc);
828 	return status;
829 }
830 
831 /* OTG Initialization */
832 int usb_otg_start(struct platform_device *pdev)
833 {
834 	struct fsl_otg *p_otg;
835 	struct usb_phy *otg_trans = usb_get_phy(USB_PHY_TYPE_USB2);
836 	struct otg_fsm *fsm;
837 	int status;
838 	struct resource *res;
839 	u32 temp;
840 	struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
841 
842 	p_otg = container_of(otg_trans, struct fsl_otg, phy);
843 	fsm = &p_otg->fsm;
844 
845 	/* Initialize the state machine structure with default values */
846 	SET_OTG_STATE(otg_trans, OTG_STATE_UNDEFINED);
847 	fsm->otg = p_otg->phy.otg;
848 
849 	/* We don't require predefined MEM/IRQ resource index */
850 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
851 	if (!res)
852 		return -ENXIO;
853 
854 	/* We don't request_mem_region here to enable resource sharing
855 	 * with host/device */
856 
857 	usb_dr_regs = ioremap(res->start, sizeof(struct usb_dr_mmap));
858 	p_otg->dr_mem_map = (struct usb_dr_mmap *)usb_dr_regs;
859 	pdata->regs = (void *)usb_dr_regs;
860 
861 	if (pdata->init && pdata->init(pdev) != 0)
862 		return -EINVAL;
863 
864 #ifdef CONFIG_PPC32
865 	if (pdata->big_endian_mmio) {
866 		_fsl_readl = _fsl_readl_be;
867 		_fsl_writel = _fsl_writel_be;
868 	} else {
869 		_fsl_readl = _fsl_readl_le;
870 		_fsl_writel = _fsl_writel_le;
871 	}
872 #endif
873 
874 	/* request irq */
875 	p_otg->irq = platform_get_irq(pdev, 0);
876 	if (p_otg->irq < 0)
877 		return p_otg->irq;
878 	status = request_irq(p_otg->irq, fsl_otg_isr,
879 				IRQF_SHARED, driver_name, p_otg);
880 	if (status) {
881 		dev_dbg(p_otg->phy.dev, "can't get IRQ %d, error %d\n",
882 			p_otg->irq, status);
883 		iounmap(p_otg->dr_mem_map);
884 		kfree(p_otg->phy.otg);
885 		kfree(p_otg);
886 		return status;
887 	}
888 
889 	/* stop the controller */
890 	temp = fsl_readl(&p_otg->dr_mem_map->usbcmd);
891 	temp &= ~USB_CMD_RUN_STOP;
892 	fsl_writel(temp, &p_otg->dr_mem_map->usbcmd);
893 
894 	/* reset the controller */
895 	temp = fsl_readl(&p_otg->dr_mem_map->usbcmd);
896 	temp |= USB_CMD_CTRL_RESET;
897 	fsl_writel(temp, &p_otg->dr_mem_map->usbcmd);
898 
899 	/* wait reset completed */
900 	while (fsl_readl(&p_otg->dr_mem_map->usbcmd) & USB_CMD_CTRL_RESET)
901 		;
902 
903 	/* configure the VBUSHS as IDLE(both host and device) */
904 	temp = USB_MODE_STREAM_DISABLE | (pdata->es ? USB_MODE_ES : 0);
905 	fsl_writel(temp, &p_otg->dr_mem_map->usbmode);
906 
907 	/* configure PHY interface */
908 	temp = fsl_readl(&p_otg->dr_mem_map->portsc);
909 	temp &= ~(PORTSC_PHY_TYPE_SEL | PORTSC_PTW);
910 	switch (pdata->phy_mode) {
911 	case FSL_USB2_PHY_ULPI:
912 		temp |= PORTSC_PTS_ULPI;
913 		break;
914 	case FSL_USB2_PHY_UTMI_WIDE:
915 		temp |= PORTSC_PTW_16BIT;
916 		fallthrough;
917 	case FSL_USB2_PHY_UTMI:
918 		temp |= PORTSC_PTS_UTMI;
919 		fallthrough;
920 	default:
921 		break;
922 	}
923 	fsl_writel(temp, &p_otg->dr_mem_map->portsc);
924 
925 	if (pdata->have_sysif_regs) {
926 		/* configure control enable IO output, big endian register */
927 		temp = __raw_readl(&p_otg->dr_mem_map->control);
928 		temp |= USB_CTRL_IOENB;
929 		__raw_writel(temp, &p_otg->dr_mem_map->control);
930 	}
931 
932 	/* disable all interrupt and clear all OTGSC status */
933 	temp = fsl_readl(&p_otg->dr_mem_map->otgsc);
934 	temp &= ~OTGSC_INTERRUPT_ENABLE_BITS_MASK;
935 	temp |= OTGSC_INTERRUPT_STATUS_BITS_MASK | OTGSC_CTRL_VBUS_DISCHARGE;
936 	fsl_writel(temp, &p_otg->dr_mem_map->otgsc);
937 
938 	/*
939 	 * The identification (id) input is FALSE when a Mini-A plug is inserted
940 	 * in the devices Mini-AB receptacle. Otherwise, this input is TRUE.
941 	 * Also: record initial state of ID pin
942 	 */
943 	if (fsl_readl(&p_otg->dr_mem_map->otgsc) & OTGSC_STS_USB_ID) {
944 		p_otg->phy.otg->state = OTG_STATE_UNDEFINED;
945 		p_otg->fsm.id = 1;
946 	} else {
947 		p_otg->phy.otg->state = OTG_STATE_A_IDLE;
948 		p_otg->fsm.id = 0;
949 	}
950 
951 	pr_debug("initial ID pin=%d\n", p_otg->fsm.id);
952 
953 	/* enable OTG ID pin interrupt */
954 	temp = fsl_readl(&p_otg->dr_mem_map->otgsc);
955 	temp |= OTGSC_INTR_USB_ID_EN;
956 	temp &= ~(OTGSC_CTRL_VBUS_DISCHARGE | OTGSC_INTR_1MS_TIMER_EN);
957 	fsl_writel(temp, &p_otg->dr_mem_map->otgsc);
958 
959 	return 0;
960 }
961 
962 static int fsl_otg_probe(struct platform_device *pdev)
963 {
964 	int ret;
965 
966 	if (!dev_get_platdata(&pdev->dev))
967 		return -ENODEV;
968 
969 	/* configure the OTG */
970 	ret = fsl_otg_conf(pdev);
971 	if (ret) {
972 		dev_err(&pdev->dev, "Couldn't configure OTG module\n");
973 		return ret;
974 	}
975 
976 	/* start OTG */
977 	ret = usb_otg_start(pdev);
978 	if (ret) {
979 		dev_err(&pdev->dev, "Can't init FSL OTG device\n");
980 		return ret;
981 	}
982 
983 	return ret;
984 }
985 
986 static int fsl_otg_remove(struct platform_device *pdev)
987 {
988 	struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
989 
990 	usb_remove_phy(&fsl_otg_dev->phy);
991 	free_irq(fsl_otg_dev->irq, fsl_otg_dev);
992 
993 	iounmap((void *)usb_dr_regs);
994 
995 	fsl_otg_uninit_timers();
996 	kfree(fsl_otg_dev->phy.otg);
997 	kfree(fsl_otg_dev);
998 
999 	if (pdata->exit)
1000 		pdata->exit(pdev);
1001 
1002 	return 0;
1003 }
1004 
1005 struct platform_driver fsl_otg_driver = {
1006 	.probe = fsl_otg_probe,
1007 	.remove = fsl_otg_remove,
1008 	.driver = {
1009 		.name = driver_name,
1010 		.owner = THIS_MODULE,
1011 	},
1012 };
1013 
1014 module_platform_driver(fsl_otg_driver);
1015 
1016 MODULE_DESCRIPTION(DRIVER_INFO);
1017 MODULE_AUTHOR(DRIVER_AUTHOR);
1018 MODULE_LICENSE("GPL");
1019