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