xref: /openbmc/linux/drivers/usb/phy/phy-fsl-usb.c (revision 1ac731c529cd4d6adbce134754b51ff7d822b145)
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
_fsl_readl_be(const unsigned __iomem * p)73  static u32 _fsl_readl_be(const unsigned __iomem *p)
74  {
75  	return in_be32(p);
76  }
77  
_fsl_readl_le(const unsigned __iomem * p)78  static u32 _fsl_readl_le(const unsigned __iomem *p)
79  {
80  	return in_le32(p);
81  }
82  
_fsl_writel_be(u32 v,unsigned __iomem * p)83  static void _fsl_writel_be(u32 v, unsigned __iomem *p)
84  {
85  	out_be32(p, v);
86  }
87  
_fsl_writel_le(u32 v,unsigned __iomem * p)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  
write_ulpi(u8 addr,u8 data)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 */
fsl_otg_chrg_vbus(struct otg_fsm * fsm,int on)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 */
fsl_otg_dischrg_vbus(int on)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 */
fsl_otg_drv_vbus(struct otg_fsm * fsm,int on)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   */
fsl_otg_loc_conn(struct otg_fsm * fsm,int on)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   */
fsl_otg_loc_sof(struct otg_fsm * fsm,int on)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. */
fsl_otg_start_pulse(struct otg_fsm * fsm)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  
b_data_pulse_end(unsigned long foo)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  
fsl_otg_pulse_vbus(void)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  
b_vbus_pulse_end(unsigned long foo)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  
b_srp_end(unsigned long foo)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   */
a_wait_enum(unsigned long foo)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 */
set_tmout(unsigned long indicator)278  void set_tmout(unsigned long indicator)
279  {
280  	*(int *)indicator = 1;
281  }
282  
283  /* Initialize timers */
fsl_otg_init_timers(struct otg_fsm * fsm)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 */
fsl_otg_uninit_timers(void)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  
fsl_otg_get_timer(enum otg_fsm_timer t)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 */
fsl_otg_add_timer(struct otg_fsm * fsm,void * gtimer)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  
fsl_otg_fsm_add_timer(struct otg_fsm * fsm,enum otg_fsm_timer t)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 */
fsl_otg_del_timer(struct otg_fsm * fsm,void * gtimer)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  
fsl_otg_fsm_del_timer(struct otg_fsm * fsm,enum otg_fsm_timer t)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 */
otg_reset_controller(void)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 */
fsl_otg_start_host(struct otg_fsm * fsm,int on)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   */
fsl_otg_start_gadget(struct otg_fsm * fsm,int on)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   */
fsl_otg_set_host(struct usb_otg * otg,struct usb_bus * host)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. */
fsl_otg_set_peripheral(struct usb_otg * otg,struct usb_gadget * gadget)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   */
fsl_otg_event(struct work_struct * work)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 */
fsl_otg_start_srp(struct usb_otg * otg)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 */
fsl_otg_start_hnp(struct usb_otg * otg)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   */
fsl_otg_isr(int irq,void * dev_id)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 */
fsl_otg_conf(struct platform_device * pdev)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 */
usb_otg_start(struct platform_device * pdev)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  
fsl_otg_probe(struct platform_device * pdev)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  
fsl_otg_remove(struct platform_device * pdev)986  static void 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  
1003  struct platform_driver fsl_otg_driver = {
1004  	.probe = fsl_otg_probe,
1005  	.remove_new = fsl_otg_remove,
1006  	.driver = {
1007  		.name = driver_name,
1008  		.owner = THIS_MODULE,
1009  	},
1010  };
1011  
1012  module_platform_driver(fsl_otg_driver);
1013  
1014  MODULE_DESCRIPTION(DRIVER_INFO);
1015  MODULE_AUTHOR(DRIVER_AUTHOR);
1016  MODULE_LICENSE("GPL");
1017