Linux Audio

Check our new training course

Loading...
v3.5.6
  1/*
  2 * Copyright 2005-2009 MontaVista Software, Inc.
  3 * Copyright 2008,2012      Freescale Semiconductor, Inc.
  4 *
  5 * This program is free software; you can redistribute it and/or modify it
  6 * under the terms of the GNU General Public License as published by the
  7 * Free Software Foundation; either version 2 of the License, or (at your
  8 * option) any later version.
  9 *
 10 * This program is distributed in the hope that it will be useful, but
 11 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 12 * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 13 * for more details.
 14 *
 15 * You should have received a copy of the GNU General Public License
 16 * along with this program; if not, write to the Free Software Foundation,
 17 * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 18 *
 19 * Ported to 834x by Randy Vinson <rvinson@mvista.com> using code provided
 20 * by Hunter Wu.
 21 * Power Management support by Dave Liu <daveliu@freescale.com>,
 22 * Jerry Huang <Chang-Ming.Huang@freescale.com> and
 23 * Anton Vorontsov <avorontsov@ru.mvista.com>.
 24 */
 25
 26#include <linux/kernel.h>
 27#include <linux/types.h>
 28#include <linux/delay.h>
 29#include <linux/pm.h>
 
 30#include <linux/platform_device.h>
 31#include <linux/fsl_devices.h>
 32
 33#include "ehci-fsl.h"
 34
 35/* configure so an HC device and id are always provided */
 36/* always called with process context; sleeping is OK */
 37
 38/**
 39 * usb_hcd_fsl_probe - initialize FSL-based HCDs
 40 * @drvier: Driver to be used for this HCD
 41 * @pdev: USB Host Controller being probed
 42 * Context: !in_interrupt()
 43 *
 44 * Allocates basic resources for this USB host controller.
 45 *
 46 */
 47static int usb_hcd_fsl_probe(const struct hc_driver *driver,
 48			     struct platform_device *pdev)
 49{
 50	struct fsl_usb2_platform_data *pdata;
 51	struct usb_hcd *hcd;
 52	struct resource *res;
 53	int irq;
 54	int retval;
 55
 56	pr_debug("initializing FSL-SOC USB Controller\n");
 57
 58	/* Need platform data for setup */
 59	pdata = (struct fsl_usb2_platform_data *)pdev->dev.platform_data;
 60	if (!pdata) {
 61		dev_err(&pdev->dev,
 62			"No platform data for %s.\n", dev_name(&pdev->dev));
 63		return -ENODEV;
 64	}
 65
 66	/*
 67	 * This is a host mode driver, verify that we're supposed to be
 68	 * in host mode.
 69	 */
 70	if (!((pdata->operating_mode == FSL_USB2_DR_HOST) ||
 71	      (pdata->operating_mode == FSL_USB2_MPH_HOST) ||
 72	      (pdata->operating_mode == FSL_USB2_DR_OTG))) {
 73		dev_err(&pdev->dev,
 74			"Non Host Mode configured for %s. Wrong driver linked.\n",
 75			dev_name(&pdev->dev));
 76		return -ENODEV;
 77	}
 78
 79	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 80	if (!res) {
 81		dev_err(&pdev->dev,
 82			"Found HC with no IRQ. Check %s setup!\n",
 83			dev_name(&pdev->dev));
 84		return -ENODEV;
 85	}
 86	irq = res->start;
 87
 88	hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
 89	if (!hcd) {
 90		retval = -ENOMEM;
 91		goto err1;
 92	}
 93
 94	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 95	if (!res) {
 96		dev_err(&pdev->dev,
 97			"Found HC with no register addr. Check %s setup!\n",
 98			dev_name(&pdev->dev));
 99		retval = -ENODEV;
100		goto err2;
101	}
102	hcd->rsrc_start = res->start;
103	hcd->rsrc_len = resource_size(res);
104	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len,
105				driver->description)) {
106		dev_dbg(&pdev->dev, "controller already in use\n");
107		retval = -EBUSY;
108		goto err2;
109	}
110	hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
111
112	if (hcd->regs == NULL) {
113		dev_dbg(&pdev->dev, "error mapping memory\n");
114		retval = -EFAULT;
115		goto err3;
116	}
117
118	pdata->regs = hcd->regs;
119
120	if (pdata->power_budget)
121		hcd->power_budget = pdata->power_budget;
122
123	/*
124	 * do platform specific init: check the clock, grab/config pins, etc.
125	 */
126	if (pdata->init && pdata->init(pdev)) {
127		retval = -ENODEV;
128		goto err4;
129	}
130
131	/* Enable USB controller, 83xx or 8536 */
132	if (pdata->have_sysif_regs)
133		setbits32(hcd->regs + FSL_SOC_USB_CTRL, 0x4);
134
135	/* Don't need to set host mode here. It will be done by tdi_reset() */
136
137	retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
138	if (retval != 0)
139		goto err4;
 
140
141#ifdef CONFIG_USB_OTG
142	if (pdata->operating_mode == FSL_USB2_DR_OTG) {
143		struct ehci_hcd *ehci = hcd_to_ehci(hcd);
144
145		ehci->transceiver = usb_get_transceiver();
146		dev_dbg(&pdev->dev, "hcd=0x%p  ehci=0x%p, transceiver=0x%p\n",
147			hcd, ehci, ehci->transceiver);
148
149		if (ehci->transceiver) {
150			retval = otg_set_host(ehci->transceiver->otg,
151					      &ehci_to_hcd(ehci)->self);
152			if (retval) {
153				usb_put_transceiver(ehci->transceiver);
154				goto err4;
155			}
156		} else {
157			dev_err(&pdev->dev, "can't find transceiver\n");
158			retval = -ENODEV;
159			goto err4;
160		}
161	}
162#endif
163	return retval;
164
165      err4:
166	iounmap(hcd->regs);
167      err3:
168	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
169      err2:
170	usb_put_hcd(hcd);
171      err1:
172	dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), retval);
173	if (pdata->exit)
174		pdata->exit(pdev);
175	return retval;
176}
177
178/* may be called without controller electrically present */
179/* may be called with controller, bus, and devices active */
180
181/**
182 * usb_hcd_fsl_remove - shutdown processing for FSL-based HCDs
183 * @dev: USB Host Controller being removed
184 * Context: !in_interrupt()
185 *
186 * Reverses the effect of usb_hcd_fsl_probe().
187 *
188 */
189static void usb_hcd_fsl_remove(struct usb_hcd *hcd,
190			       struct platform_device *pdev)
191{
192	struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data;
193	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
194
195	if (ehci->transceiver) {
196		otg_set_host(ehci->transceiver->otg, NULL);
197		usb_put_transceiver(ehci->transceiver);
198	}
199
200	usb_remove_hcd(hcd);
201
202	/*
203	 * do platform specific un-initialization:
204	 * release iomux pins, disable clock, etc.
205	 */
206	if (pdata->exit)
207		pdata->exit(pdev);
208	iounmap(hcd->regs);
209	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
210	usb_put_hcd(hcd);
211}
212
213static void ehci_fsl_setup_phy(struct usb_hcd *hcd,
214			       enum fsl_usb2_phy_modes phy_mode,
215			       unsigned int port_offset)
216{
217	u32 portsc, temp;
218	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
219	void __iomem *non_ehci = hcd->regs;
220	struct device *dev = hcd->self.controller;
221	struct fsl_usb2_platform_data *pdata = dev->platform_data;
222
223	if (pdata->controller_ver < 0) {
224		dev_warn(hcd->self.controller, "Could not get controller version\n");
225		return;
226	}
227
228	portsc = ehci_readl(ehci, &ehci->regs->port_status[port_offset]);
229	portsc &= ~(PORT_PTS_MSK | PORT_PTS_PTW);
230
231	switch (phy_mode) {
232	case FSL_USB2_PHY_ULPI:
233		if (pdata->controller_ver) {
234			/* controller version 1.6 or above */
235			temp = in_be32(non_ehci + FSL_SOC_USB_CTRL);
236			out_be32(non_ehci + FSL_SOC_USB_CTRL, temp |
237				USB_CTRL_USB_EN | ULPI_PHY_CLK_SEL);
238		}
239		portsc |= PORT_PTS_ULPI;
240		break;
241	case FSL_USB2_PHY_SERIAL:
242		portsc |= PORT_PTS_SERIAL;
243		break;
244	case FSL_USB2_PHY_UTMI_WIDE:
245		portsc |= PORT_PTS_PTW;
246		/* fall through */
247	case FSL_USB2_PHY_UTMI:
248		if (pdata->controller_ver) {
249			/* controller version 1.6 or above */
250			temp = in_be32(non_ehci + FSL_SOC_USB_CTRL);
251			out_be32(non_ehci + FSL_SOC_USB_CTRL, temp |
252				UTMI_PHY_EN | USB_CTRL_USB_EN);
253			mdelay(FSL_UTMI_PHY_DLY);  /* Delay for UTMI PHY CLK to
254						become stable - 10ms*/
255		}
256		/* enable UTMI PHY */
257		if (pdata->have_sysif_regs)
258			setbits32(non_ehci + FSL_SOC_USB_CTRL,
259				  CTRL_UTMI_PHY_EN);
260		portsc |= PORT_PTS_UTMI;
261		break;
262	case FSL_USB2_PHY_NONE:
263		break;
264	}
 
 
 
 
 
 
 
 
 
 
 
 
 
265	ehci_writel(ehci, portsc, &ehci->regs->port_status[port_offset]);
 
 
 
 
 
266}
267
268static void ehci_fsl_usb_setup(struct ehci_hcd *ehci)
269{
270	struct usb_hcd *hcd = ehci_to_hcd(ehci);
271	struct fsl_usb2_platform_data *pdata;
272	void __iomem *non_ehci = hcd->regs;
273	u32 temp;
274
275	pdata = hcd->self.controller->platform_data;
276
277	/* Enable PHY interface in the control reg. */
278	if (pdata->have_sysif_regs) {
279		temp = in_be32(non_ehci + FSL_SOC_USB_CTRL);
280		out_be32(non_ehci + FSL_SOC_USB_CTRL, temp | 0x00000004);
281
282		/*
283		* Turn on cache snooping hardware, since some PowerPC platforms
284		* wholly rely on hardware to deal with cache coherent
285		*/
286
287		/* Setup Snooping for all the 4GB space */
288		/* SNOOP1 starts from 0x0, size 2G */
289		out_be32(non_ehci + FSL_SOC_USB_SNOOP1, 0x0 | SNOOP_SIZE_2GB);
290		/* SNOOP2 starts from 0x80000000, size 2G */
291		out_be32(non_ehci + FSL_SOC_USB_SNOOP2, 0x80000000 | SNOOP_SIZE_2GB);
292	}
293
294	if ((pdata->operating_mode == FSL_USB2_DR_HOST) ||
295			(pdata->operating_mode == FSL_USB2_DR_OTG))
296		ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0);
 
297
298	if (pdata->operating_mode == FSL_USB2_MPH_HOST) {
299		unsigned int chip, rev, svr;
300
301		svr = mfspr(SPRN_SVR);
302		chip = svr >> 16;
303		rev = (svr >> 4) & 0xf;
304
305		/* Deal with USB Erratum #14 on MPC834x Rev 1.0 & 1.1 chips */
306		if ((rev == 1) && (chip >= 0x8050) && (chip <= 0x8055))
307			ehci->has_fsl_port_bug = 1;
308
309		if (pdata->port_enables & FSL_USB2_PORT0_ENABLED)
310			ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0);
 
 
311		if (pdata->port_enables & FSL_USB2_PORT1_ENABLED)
312			ehci_fsl_setup_phy(hcd, pdata->phy_mode, 1);
 
313	}
314
315	if (pdata->have_sysif_regs) {
316#ifdef CONFIG_PPC_85xx
317		out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x00000008);
318		out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000080);
319#else
320		out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x0000000c);
321		out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000040);
322#endif
323		out_be32(non_ehci + FSL_SOC_USB_SICTRL, 0x00000001);
324	}
 
 
325}
326
327/* called after powerup, by probe or system-pm "wakeup" */
328static int ehci_fsl_reinit(struct ehci_hcd *ehci)
329{
330	ehci_fsl_usb_setup(ehci);
331	ehci_port_power(ehci, 0);
332
333	return 0;
334}
335
336/* called during probe() after chip reset completes */
337static int ehci_fsl_setup(struct usb_hcd *hcd)
338{
339	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
340	int retval;
341	struct fsl_usb2_platform_data *pdata;
342	struct device *dev;
343
344	dev = hcd->self.controller;
345	pdata = hcd->self.controller->platform_data;
346	ehci->big_endian_desc = pdata->big_endian_desc;
347	ehci->big_endian_mmio = pdata->big_endian_mmio;
348
349	/* EHCI registers start at offset 0x100 */
350	ehci->caps = hcd->regs + 0x100;
351	ehci->regs = hcd->regs + 0x100 +
352		HC_LENGTH(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase));
353	dbg_hcs_params(ehci, "reset");
354	dbg_hcc_params(ehci, "reset");
355
356	/* cache this readonly data; minimize chip reads */
357	ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);
 
 
 
 
 
 
358
359	hcd->has_tt = 1;
360
361	retval = ehci_halt(ehci);
362	if (retval)
363		return retval;
364
365	/* data structure init */
366	retval = ehci_init(hcd);
367	if (retval)
368		return retval;
369
370	ehci->sbrn = 0x20;
371
372	ehci_reset(ehci);
373
374	if (of_device_is_compatible(dev->parent->of_node,
375				    "fsl,mpc5121-usb2-dr")) {
376		/*
377		 * set SBUSCFG:AHBBRST so that control msgs don't
378		 * fail when doing heavy PATA writes.
379		 */
380		ehci_writel(ehci, SBUSCFG_INCR8,
381			    hcd->regs + FSL_SOC_USB_SBUSCFG);
382	}
383
384	retval = ehci_fsl_reinit(ehci);
385	return retval;
386}
387
388struct ehci_fsl {
389	struct ehci_hcd	ehci;
390
391#ifdef CONFIG_PM
392	/* Saved USB PHY settings, need to restore after deep sleep. */
393	u32 usb_ctrl;
394#endif
395};
396
397#ifdef CONFIG_PM
398
399#ifdef CONFIG_PPC_MPC512x
400static int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
401{
402	struct usb_hcd *hcd = dev_get_drvdata(dev);
403	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
404	struct fsl_usb2_platform_data *pdata = dev->platform_data;
405	u32 tmp;
406
407#ifdef DEBUG
408	u32 mode = ehci_readl(ehci, hcd->regs + FSL_SOC_USB_USBMODE);
409	mode &= USBMODE_CM_MASK;
410	tmp = ehci_readl(ehci, hcd->regs + 0x140);	/* usbcmd */
411
412	dev_dbg(dev, "suspend=%d already_suspended=%d "
413		"mode=%d  usbcmd %08x\n", pdata->suspended,
414		pdata->already_suspended, mode, tmp);
415#endif
416
417	/*
418	 * If the controller is already suspended, then this must be a
419	 * PM suspend.  Remember this fact, so that we will leave the
420	 * controller suspended at PM resume time.
421	 */
422	if (pdata->suspended) {
423		dev_dbg(dev, "already suspended, leaving early\n");
424		pdata->already_suspended = 1;
425		return 0;
426	}
427
428	dev_dbg(dev, "suspending...\n");
429
430	ehci->rh_state = EHCI_RH_SUSPENDED;
431	dev->power.power_state = PMSG_SUSPEND;
432
433	/* ignore non-host interrupts */
434	clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
435
436	/* stop the controller */
437	tmp = ehci_readl(ehci, &ehci->regs->command);
438	tmp &= ~CMD_RUN;
439	ehci_writel(ehci, tmp, &ehci->regs->command);
440
441	/* save EHCI registers */
442	pdata->pm_command = ehci_readl(ehci, &ehci->regs->command);
443	pdata->pm_command &= ~CMD_RUN;
444	pdata->pm_status  = ehci_readl(ehci, &ehci->regs->status);
445	pdata->pm_intr_enable  = ehci_readl(ehci, &ehci->regs->intr_enable);
446	pdata->pm_frame_index  = ehci_readl(ehci, &ehci->regs->frame_index);
447	pdata->pm_segment  = ehci_readl(ehci, &ehci->regs->segment);
448	pdata->pm_frame_list  = ehci_readl(ehci, &ehci->regs->frame_list);
449	pdata->pm_async_next  = ehci_readl(ehci, &ehci->regs->async_next);
450	pdata->pm_configured_flag  =
451		ehci_readl(ehci, &ehci->regs->configured_flag);
452	pdata->pm_portsc = ehci_readl(ehci, &ehci->regs->port_status[0]);
453	pdata->pm_usbgenctrl = ehci_readl(ehci,
454					  hcd->regs + FSL_SOC_USB_USBGENCTRL);
455
456	/* clear the W1C bits */
457	pdata->pm_portsc &= cpu_to_hc32(ehci, ~PORT_RWC_BITS);
458
459	pdata->suspended = 1;
460
461	/* clear PP to cut power to the port */
462	tmp = ehci_readl(ehci, &ehci->regs->port_status[0]);
463	tmp &= ~PORT_POWER;
464	ehci_writel(ehci, tmp, &ehci->regs->port_status[0]);
465
466	return 0;
467}
468
469static int ehci_fsl_mpc512x_drv_resume(struct device *dev)
470{
471	struct usb_hcd *hcd = dev_get_drvdata(dev);
472	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
473	struct fsl_usb2_platform_data *pdata = dev->platform_data;
474	u32 tmp;
475
476	dev_dbg(dev, "suspend=%d already_suspended=%d\n",
477		pdata->suspended, pdata->already_suspended);
478
479	/*
480	 * If the controller was already suspended at suspend time,
481	 * then don't resume it now.
482	 */
483	if (pdata->already_suspended) {
484		dev_dbg(dev, "already suspended, leaving early\n");
485		pdata->already_suspended = 0;
486		return 0;
487	}
488
489	if (!pdata->suspended) {
490		dev_dbg(dev, "not suspended, leaving early\n");
491		return 0;
492	}
493
494	pdata->suspended = 0;
495
496	dev_dbg(dev, "resuming...\n");
497
498	/* set host mode */
499	tmp = USBMODE_CM_HOST | (pdata->es ? USBMODE_ES : 0);
500	ehci_writel(ehci, tmp, hcd->regs + FSL_SOC_USB_USBMODE);
501
502	ehci_writel(ehci, pdata->pm_usbgenctrl,
503		    hcd->regs + FSL_SOC_USB_USBGENCTRL);
504	ehci_writel(ehci, ISIPHYCTRL_PXE | ISIPHYCTRL_PHYE,
505		    hcd->regs + FSL_SOC_USB_ISIPHYCTRL);
506
507	ehci_writel(ehci, SBUSCFG_INCR8, hcd->regs + FSL_SOC_USB_SBUSCFG);
508
509	/* restore EHCI registers */
510	ehci_writel(ehci, pdata->pm_command, &ehci->regs->command);
511	ehci_writel(ehci, pdata->pm_intr_enable, &ehci->regs->intr_enable);
512	ehci_writel(ehci, pdata->pm_frame_index, &ehci->regs->frame_index);
513	ehci_writel(ehci, pdata->pm_segment, &ehci->regs->segment);
514	ehci_writel(ehci, pdata->pm_frame_list, &ehci->regs->frame_list);
515	ehci_writel(ehci, pdata->pm_async_next, &ehci->regs->async_next);
516	ehci_writel(ehci, pdata->pm_configured_flag,
517		    &ehci->regs->configured_flag);
518	ehci_writel(ehci, pdata->pm_portsc, &ehci->regs->port_status[0]);
519
520	set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
521	ehci->rh_state = EHCI_RH_RUNNING;
522	dev->power.power_state = PMSG_ON;
523
524	tmp = ehci_readl(ehci, &ehci->regs->command);
525	tmp |= CMD_RUN;
526	ehci_writel(ehci, tmp, &ehci->regs->command);
527
528	usb_hcd_resume_root_hub(hcd);
529
530	return 0;
531}
532#else
533static inline int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
534{
535	return 0;
536}
537
538static inline int ehci_fsl_mpc512x_drv_resume(struct device *dev)
539{
540	return 0;
541}
542#endif /* CONFIG_PPC_MPC512x */
543
544static struct ehci_fsl *hcd_to_ehci_fsl(struct usb_hcd *hcd)
545{
546	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
547
548	return container_of(ehci, struct ehci_fsl, ehci);
549}
550
551static int ehci_fsl_drv_suspend(struct device *dev)
552{
553	struct usb_hcd *hcd = dev_get_drvdata(dev);
554	struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
555	void __iomem *non_ehci = hcd->regs;
556
557	if (of_device_is_compatible(dev->parent->of_node,
558				    "fsl,mpc5121-usb2-dr")) {
559		return ehci_fsl_mpc512x_drv_suspend(dev);
560	}
561
562	ehci_prepare_ports_for_controller_suspend(hcd_to_ehci(hcd),
563			device_may_wakeup(dev));
564	if (!fsl_deep_sleep())
565		return 0;
566
567	ehci_fsl->usb_ctrl = in_be32(non_ehci + FSL_SOC_USB_CTRL);
568	return 0;
569}
570
571static int ehci_fsl_drv_resume(struct device *dev)
572{
573	struct usb_hcd *hcd = dev_get_drvdata(dev);
574	struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
575	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
576	void __iomem *non_ehci = hcd->regs;
577
578	if (of_device_is_compatible(dev->parent->of_node,
579				    "fsl,mpc5121-usb2-dr")) {
580		return ehci_fsl_mpc512x_drv_resume(dev);
581	}
582
583	ehci_prepare_ports_for_controller_resume(ehci);
584	if (!fsl_deep_sleep())
585		return 0;
586
587	usb_root_hub_lost_power(hcd->self.root_hub);
588
589	/* Restore USB PHY settings and enable the controller. */
590	out_be32(non_ehci + FSL_SOC_USB_CTRL, ehci_fsl->usb_ctrl);
591
592	ehci_reset(ehci);
593	ehci_fsl_reinit(ehci);
594
595	return 0;
596}
597
598static int ehci_fsl_drv_restore(struct device *dev)
599{
600	struct usb_hcd *hcd = dev_get_drvdata(dev);
601
602	usb_root_hub_lost_power(hcd->self.root_hub);
603	return 0;
604}
605
606static struct dev_pm_ops ehci_fsl_pm_ops = {
607	.suspend = ehci_fsl_drv_suspend,
608	.resume = ehci_fsl_drv_resume,
609	.restore = ehci_fsl_drv_restore,
610};
611
612#define EHCI_FSL_PM_OPS		(&ehci_fsl_pm_ops)
613#else
614#define EHCI_FSL_PM_OPS		NULL
615#endif /* CONFIG_PM */
616
617#ifdef CONFIG_USB_OTG
618static int ehci_start_port_reset(struct usb_hcd *hcd, unsigned port)
619{
620	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
621	u32 status;
622
623	if (!port)
624		return -EINVAL;
625
626	port--;
627
628	/* start port reset before HNP protocol time out */
629	status = readl(&ehci->regs->port_status[port]);
630	if (!(status & PORT_CONNECT))
631		return -ENODEV;
632
633	/* khubd will finish the reset later */
634	if (ehci_is_TDI(ehci)) {
635		writel(PORT_RESET |
636		       (status & ~(PORT_CSC | PORT_PEC | PORT_OCC)),
637		       &ehci->regs->port_status[port]);
638	} else {
639		writel(PORT_RESET, &ehci->regs->port_status[port]);
640	}
641
642	return 0;
643}
644#else
645#define ehci_start_port_reset	NULL
646#endif /* CONFIG_USB_OTG */
647
648
649static const struct hc_driver ehci_fsl_hc_driver = {
650	.description = hcd_name,
651	.product_desc = "Freescale On-Chip EHCI Host Controller",
652	.hcd_priv_size = sizeof(struct ehci_fsl),
653
654	/*
655	 * generic hardware linkage
656	 */
657	.irq = ehci_irq,
658	.flags = HCD_USB2 | HCD_MEMORY,
659
660	/*
661	 * basic lifecycle operations
662	 */
663	.reset = ehci_fsl_setup,
664	.start = ehci_run,
665	.stop = ehci_stop,
666	.shutdown = ehci_shutdown,
667
668	/*
669	 * managing i/o requests and associated device resources
670	 */
671	.urb_enqueue = ehci_urb_enqueue,
672	.urb_dequeue = ehci_urb_dequeue,
673	.endpoint_disable = ehci_endpoint_disable,
674	.endpoint_reset = ehci_endpoint_reset,
675
676	/*
677	 * scheduling support
678	 */
679	.get_frame_number = ehci_get_frame,
680
681	/*
682	 * root hub support
683	 */
684	.hub_status_data = ehci_hub_status_data,
685	.hub_control = ehci_hub_control,
686	.bus_suspend = ehci_bus_suspend,
687	.bus_resume = ehci_bus_resume,
688	.start_port_reset = ehci_start_port_reset,
689	.relinquish_port = ehci_relinquish_port,
690	.port_handed_over = ehci_port_handed_over,
691
692	.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
693};
694
695static int ehci_fsl_drv_probe(struct platform_device *pdev)
696{
697	if (usb_disabled())
698		return -ENODEV;
699
700	/* FIXME we only want one one probe() not two */
701	return usb_hcd_fsl_probe(&ehci_fsl_hc_driver, pdev);
702}
703
704static int ehci_fsl_drv_remove(struct platform_device *pdev)
705{
706	struct usb_hcd *hcd = platform_get_drvdata(pdev);
707
708	/* FIXME we only want one one remove() not two */
709	usb_hcd_fsl_remove(hcd, pdev);
710	return 0;
711}
712
713MODULE_ALIAS("platform:fsl-ehci");
714
715static struct platform_driver ehci_fsl_driver = {
716	.probe = ehci_fsl_drv_probe,
717	.remove = ehci_fsl_drv_remove,
718	.shutdown = usb_hcd_platform_shutdown,
719	.driver = {
720		.name = "fsl-ehci",
 
721		.pm = EHCI_FSL_PM_OPS,
722	},
723};
v3.15
  1/*
  2 * Copyright 2005-2009 MontaVista Software, Inc.
  3 * Copyright 2008,2012      Freescale Semiconductor, Inc.
  4 *
  5 * This program is free software; you can redistribute it and/or modify it
  6 * under the terms of the GNU General Public License as published by the
  7 * Free Software Foundation; either version 2 of the License, or (at your
  8 * option) any later version.
  9 *
 10 * This program is distributed in the hope that it will be useful, but
 11 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 12 * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 13 * for more details.
 14 *
 15 * You should have received a copy of the GNU General Public License
 16 * along with this program; if not, write to the Free Software Foundation,
 17 * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 18 *
 19 * Ported to 834x by Randy Vinson <rvinson@mvista.com> using code provided
 20 * by Hunter Wu.
 21 * Power Management support by Dave Liu <daveliu@freescale.com>,
 22 * Jerry Huang <Chang-Ming.Huang@freescale.com> and
 23 * Anton Vorontsov <avorontsov@ru.mvista.com>.
 24 */
 25
 26#include <linux/kernel.h>
 27#include <linux/types.h>
 28#include <linux/delay.h>
 29#include <linux/pm.h>
 30#include <linux/err.h>
 31#include <linux/platform_device.h>
 32#include <linux/fsl_devices.h>
 33
 34#include "ehci-fsl.h"
 35
 36/* configure so an HC device and id are always provided */
 37/* always called with process context; sleeping is OK */
 38
 39/**
 40 * usb_hcd_fsl_probe - initialize FSL-based HCDs
 41 * @drvier: Driver to be used for this HCD
 42 * @pdev: USB Host Controller being probed
 43 * Context: !in_interrupt()
 44 *
 45 * Allocates basic resources for this USB host controller.
 46 *
 47 */
 48static int usb_hcd_fsl_probe(const struct hc_driver *driver,
 49			     struct platform_device *pdev)
 50{
 51	struct fsl_usb2_platform_data *pdata;
 52	struct usb_hcd *hcd;
 53	struct resource *res;
 54	int irq;
 55	int retval;
 56
 57	pr_debug("initializing FSL-SOC USB Controller\n");
 58
 59	/* Need platform data for setup */
 60	pdata = dev_get_platdata(&pdev->dev);
 61	if (!pdata) {
 62		dev_err(&pdev->dev,
 63			"No platform data for %s.\n", dev_name(&pdev->dev));
 64		return -ENODEV;
 65	}
 66
 67	/*
 68	 * This is a host mode driver, verify that we're supposed to be
 69	 * in host mode.
 70	 */
 71	if (!((pdata->operating_mode == FSL_USB2_DR_HOST) ||
 72	      (pdata->operating_mode == FSL_USB2_MPH_HOST) ||
 73	      (pdata->operating_mode == FSL_USB2_DR_OTG))) {
 74		dev_err(&pdev->dev,
 75			"Non Host Mode configured for %s. Wrong driver linked.\n",
 76			dev_name(&pdev->dev));
 77		return -ENODEV;
 78	}
 79
 80	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 81	if (!res) {
 82		dev_err(&pdev->dev,
 83			"Found HC with no IRQ. Check %s setup!\n",
 84			dev_name(&pdev->dev));
 85		return -ENODEV;
 86	}
 87	irq = res->start;
 88
 89	hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
 90	if (!hcd) {
 91		retval = -ENOMEM;
 92		goto err1;
 93	}
 94
 95	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 96	if (!res) {
 97		dev_err(&pdev->dev,
 98			"Found HC with no register addr. Check %s setup!\n",
 99			dev_name(&pdev->dev));
100		retval = -ENODEV;
101		goto err2;
102	}
103	hcd->rsrc_start = res->start;
104	hcd->rsrc_len = resource_size(res);
105	hcd->regs = devm_ioremap_resource(&pdev->dev, res);
106	if (IS_ERR(hcd->regs)) {
107		retval = PTR_ERR(hcd->regs);
 
108		goto err2;
109	}
 
 
 
 
 
 
 
110
111	pdata->regs = hcd->regs;
112
113	if (pdata->power_budget)
114		hcd->power_budget = pdata->power_budget;
115
116	/*
117	 * do platform specific init: check the clock, grab/config pins, etc.
118	 */
119	if (pdata->init && pdata->init(pdev)) {
120		retval = -ENODEV;
121		goto err2;
122	}
123
124	/* Enable USB controller, 83xx or 8536 */
125	if (pdata->have_sysif_regs && pdata->controller_ver < FSL_USB_VER_1_6)
126		setbits32(hcd->regs + FSL_SOC_USB_CTRL, 0x4);
127
128	/* Don't need to set host mode here. It will be done by tdi_reset() */
129
130	retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
131	if (retval != 0)
132		goto err2;
133	device_wakeup_enable(hcd->self.controller);
134
135#ifdef CONFIG_USB_OTG
136	if (pdata->operating_mode == FSL_USB2_DR_OTG) {
137		struct ehci_hcd *ehci = hcd_to_ehci(hcd);
138
139		hcd->phy = usb_get_phy(USB_PHY_TYPE_USB2);
140		dev_dbg(&pdev->dev, "hcd=0x%p  ehci=0x%p, phy=0x%p\n",
141			hcd, ehci, hcd->phy);
142
143		if (!IS_ERR_OR_NULL(hcd->phy)) {
144			retval = otg_set_host(hcd->phy->otg,
145					      &ehci_to_hcd(ehci)->self);
146			if (retval) {
147				usb_put_phy(hcd->phy);
148				goto err2;
149			}
150		} else {
151			dev_err(&pdev->dev, "can't find phy\n");
152			retval = -ENODEV;
153			goto err2;
154		}
155	}
156#endif
157	return retval;
158
 
 
 
 
159      err2:
160	usb_put_hcd(hcd);
161      err1:
162	dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), retval);
163	if (pdata->exit)
164		pdata->exit(pdev);
165	return retval;
166}
167
168/* may be called without controller electrically present */
169/* may be called with controller, bus, and devices active */
170
171/**
172 * usb_hcd_fsl_remove - shutdown processing for FSL-based HCDs
173 * @dev: USB Host Controller being removed
174 * Context: !in_interrupt()
175 *
176 * Reverses the effect of usb_hcd_fsl_probe().
177 *
178 */
179static void usb_hcd_fsl_remove(struct usb_hcd *hcd,
180			       struct platform_device *pdev)
181{
182	struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
 
183
184	if (!IS_ERR_OR_NULL(hcd->phy)) {
185		otg_set_host(hcd->phy->otg, NULL);
186		usb_put_phy(hcd->phy);
187	}
188
189	usb_remove_hcd(hcd);
190
191	/*
192	 * do platform specific un-initialization:
193	 * release iomux pins, disable clock, etc.
194	 */
195	if (pdata->exit)
196		pdata->exit(pdev);
 
 
197	usb_put_hcd(hcd);
198}
199
200static int ehci_fsl_setup_phy(struct usb_hcd *hcd,
201			       enum fsl_usb2_phy_modes phy_mode,
202			       unsigned int port_offset)
203{
204	u32 portsc;
205	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
206	void __iomem *non_ehci = hcd->regs;
207	struct device *dev = hcd->self.controller;
208	struct fsl_usb2_platform_data *pdata = dev_get_platdata(dev);
209
210	if (pdata->controller_ver < 0) {
211		dev_warn(hcd->self.controller, "Could not get controller version\n");
212		return -ENODEV;
213	}
214
215	portsc = ehci_readl(ehci, &ehci->regs->port_status[port_offset]);
216	portsc &= ~(PORT_PTS_MSK | PORT_PTS_PTW);
217
218	switch (phy_mode) {
219	case FSL_USB2_PHY_ULPI:
220		if (pdata->have_sysif_regs && pdata->controller_ver) {
221			/* controller version 1.6 or above */
222			clrbits32(non_ehci + FSL_SOC_USB_CTRL, UTMI_PHY_EN);
223			setbits32(non_ehci + FSL_SOC_USB_CTRL,
224				ULPI_PHY_CLK_SEL | USB_CTRL_USB_EN);
225		}
226		portsc |= PORT_PTS_ULPI;
227		break;
228	case FSL_USB2_PHY_SERIAL:
229		portsc |= PORT_PTS_SERIAL;
230		break;
231	case FSL_USB2_PHY_UTMI_WIDE:
232		portsc |= PORT_PTS_PTW;
233		/* fall through */
234	case FSL_USB2_PHY_UTMI:
235		if (pdata->have_sysif_regs && pdata->controller_ver) {
236			/* controller version 1.6 or above */
237			setbits32(non_ehci + FSL_SOC_USB_CTRL, UTMI_PHY_EN);
 
 
238			mdelay(FSL_UTMI_PHY_DLY);  /* Delay for UTMI PHY CLK to
239						become stable - 10ms*/
240		}
241		/* enable UTMI PHY */
242		if (pdata->have_sysif_regs)
243			setbits32(non_ehci + FSL_SOC_USB_CTRL,
244				  CTRL_UTMI_PHY_EN);
245		portsc |= PORT_PTS_UTMI;
246		break;
247	case FSL_USB2_PHY_NONE:
248		break;
249	}
250
251	if (pdata->have_sysif_regs &&
252	    pdata->controller_ver > FSL_USB_VER_1_6 &&
253	    (phy_mode == FSL_USB2_PHY_ULPI)) {
254		/* check PHY_CLK_VALID to get phy clk valid */
255		if (!(spin_event_timeout(in_be32(non_ehci + FSL_SOC_USB_CTRL) &
256				PHY_CLK_VALID, FSL_USB_PHY_CLK_TIMEOUT, 0) ||
257				in_be32(non_ehci + FSL_SOC_USB_PRICTRL))) {
258			dev_warn(hcd->self.controller, "USB PHY clock invalid\n");
259			return -EINVAL;
260		}
261	}
262
263	ehci_writel(ehci, portsc, &ehci->regs->port_status[port_offset]);
264
265	if (phy_mode != FSL_USB2_PHY_ULPI && pdata->have_sysif_regs)
266		setbits32(non_ehci + FSL_SOC_USB_CTRL, USB_CTRL_USB_EN);
267
268	return 0;
269}
270
271static int ehci_fsl_usb_setup(struct ehci_hcd *ehci)
272{
273	struct usb_hcd *hcd = ehci_to_hcd(ehci);
274	struct fsl_usb2_platform_data *pdata;
275	void __iomem *non_ehci = hcd->regs;
 
276
277	pdata = dev_get_platdata(hcd->self.controller);
278
 
279	if (pdata->have_sysif_regs) {
 
 
 
280		/*
281		* Turn on cache snooping hardware, since some PowerPC platforms
282		* wholly rely on hardware to deal with cache coherent
283		*/
284
285		/* Setup Snooping for all the 4GB space */
286		/* SNOOP1 starts from 0x0, size 2G */
287		out_be32(non_ehci + FSL_SOC_USB_SNOOP1, 0x0 | SNOOP_SIZE_2GB);
288		/* SNOOP2 starts from 0x80000000, size 2G */
289		out_be32(non_ehci + FSL_SOC_USB_SNOOP2, 0x80000000 | SNOOP_SIZE_2GB);
290	}
291
292	if ((pdata->operating_mode == FSL_USB2_DR_HOST) ||
293			(pdata->operating_mode == FSL_USB2_DR_OTG))
294		if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0))
295			return -EINVAL;
296
297	if (pdata->operating_mode == FSL_USB2_MPH_HOST) {
298		unsigned int chip, rev, svr;
299
300		svr = mfspr(SPRN_SVR);
301		chip = svr >> 16;
302		rev = (svr >> 4) & 0xf;
303
304		/* Deal with USB Erratum #14 on MPC834x Rev 1.0 & 1.1 chips */
305		if ((rev == 1) && (chip >= 0x8050) && (chip <= 0x8055))
306			ehci->has_fsl_port_bug = 1;
307
308		if (pdata->port_enables & FSL_USB2_PORT0_ENABLED)
309			if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0))
310				return -EINVAL;
311
312		if (pdata->port_enables & FSL_USB2_PORT1_ENABLED)
313			if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 1))
314				return -EINVAL;
315	}
316
317	if (pdata->have_sysif_regs) {
318#ifdef CONFIG_FSL_SOC_BOOKE
319		out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x00000008);
320		out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000080);
321#else
322		out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x0000000c);
323		out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000040);
324#endif
325		out_be32(non_ehci + FSL_SOC_USB_SICTRL, 0x00000001);
326	}
327
328	return 0;
329}
330
331/* called after powerup, by probe or system-pm "wakeup" */
332static int ehci_fsl_reinit(struct ehci_hcd *ehci)
333{
334	if (ehci_fsl_usb_setup(ehci))
335		return -EINVAL;
336
337	return 0;
338}
339
340/* called during probe() after chip reset completes */
341static int ehci_fsl_setup(struct usb_hcd *hcd)
342{
343	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
344	int retval;
345	struct fsl_usb2_platform_data *pdata;
346	struct device *dev;
347
348	dev = hcd->self.controller;
349	pdata = dev_get_platdata(hcd->self.controller);
350	ehci->big_endian_desc = pdata->big_endian_desc;
351	ehci->big_endian_mmio = pdata->big_endian_mmio;
352
353	/* EHCI registers start at offset 0x100 */
354	ehci->caps = hcd->regs + 0x100;
 
 
 
 
355
356#ifdef CONFIG_PPC_83xx
357	/*
358	 * Deal with MPC834X that need port power to be cycled after the power
359	 * fault condition is removed. Otherwise the state machine does not
360	 * reflect PORTSC[CSC] correctly.
361	 */
362	ehci->need_oc_pp_cycle = 1;
363#endif
364
365	hcd->has_tt = 1;
366
367	retval = ehci_setup(hcd);
 
 
 
 
 
368	if (retval)
369		return retval;
370
 
 
 
 
371	if (of_device_is_compatible(dev->parent->of_node,
372				    "fsl,mpc5121-usb2-dr")) {
373		/*
374		 * set SBUSCFG:AHBBRST so that control msgs don't
375		 * fail when doing heavy PATA writes.
376		 */
377		ehci_writel(ehci, SBUSCFG_INCR8,
378			    hcd->regs + FSL_SOC_USB_SBUSCFG);
379	}
380
381	retval = ehci_fsl_reinit(ehci);
382	return retval;
383}
384
385struct ehci_fsl {
386	struct ehci_hcd	ehci;
387
388#ifdef CONFIG_PM
389	/* Saved USB PHY settings, need to restore after deep sleep. */
390	u32 usb_ctrl;
391#endif
392};
393
394#ifdef CONFIG_PM
395
396#ifdef CONFIG_PPC_MPC512x
397static int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
398{
399	struct usb_hcd *hcd = dev_get_drvdata(dev);
400	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
401	struct fsl_usb2_platform_data *pdata = dev_get_platdata(dev);
402	u32 tmp;
403
404#ifdef CONFIG_DYNAMIC_DEBUG
405	u32 mode = ehci_readl(ehci, hcd->regs + FSL_SOC_USB_USBMODE);
406	mode &= USBMODE_CM_MASK;
407	tmp = ehci_readl(ehci, hcd->regs + 0x140);	/* usbcmd */
408
409	dev_dbg(dev, "suspend=%d already_suspended=%d "
410		"mode=%d  usbcmd %08x\n", pdata->suspended,
411		pdata->already_suspended, mode, tmp);
412#endif
413
414	/*
415	 * If the controller is already suspended, then this must be a
416	 * PM suspend.  Remember this fact, so that we will leave the
417	 * controller suspended at PM resume time.
418	 */
419	if (pdata->suspended) {
420		dev_dbg(dev, "already suspended, leaving early\n");
421		pdata->already_suspended = 1;
422		return 0;
423	}
424
425	dev_dbg(dev, "suspending...\n");
426
427	ehci->rh_state = EHCI_RH_SUSPENDED;
428	dev->power.power_state = PMSG_SUSPEND;
429
430	/* ignore non-host interrupts */
431	clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
432
433	/* stop the controller */
434	tmp = ehci_readl(ehci, &ehci->regs->command);
435	tmp &= ~CMD_RUN;
436	ehci_writel(ehci, tmp, &ehci->regs->command);
437
438	/* save EHCI registers */
439	pdata->pm_command = ehci_readl(ehci, &ehci->regs->command);
440	pdata->pm_command &= ~CMD_RUN;
441	pdata->pm_status  = ehci_readl(ehci, &ehci->regs->status);
442	pdata->pm_intr_enable  = ehci_readl(ehci, &ehci->regs->intr_enable);
443	pdata->pm_frame_index  = ehci_readl(ehci, &ehci->regs->frame_index);
444	pdata->pm_segment  = ehci_readl(ehci, &ehci->regs->segment);
445	pdata->pm_frame_list  = ehci_readl(ehci, &ehci->regs->frame_list);
446	pdata->pm_async_next  = ehci_readl(ehci, &ehci->regs->async_next);
447	pdata->pm_configured_flag  =
448		ehci_readl(ehci, &ehci->regs->configured_flag);
449	pdata->pm_portsc = ehci_readl(ehci, &ehci->regs->port_status[0]);
450	pdata->pm_usbgenctrl = ehci_readl(ehci,
451					  hcd->regs + FSL_SOC_USB_USBGENCTRL);
452
453	/* clear the W1C bits */
454	pdata->pm_portsc &= cpu_to_hc32(ehci, ~PORT_RWC_BITS);
455
456	pdata->suspended = 1;
457
458	/* clear PP to cut power to the port */
459	tmp = ehci_readl(ehci, &ehci->regs->port_status[0]);
460	tmp &= ~PORT_POWER;
461	ehci_writel(ehci, tmp, &ehci->regs->port_status[0]);
462
463	return 0;
464}
465
466static int ehci_fsl_mpc512x_drv_resume(struct device *dev)
467{
468	struct usb_hcd *hcd = dev_get_drvdata(dev);
469	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
470	struct fsl_usb2_platform_data *pdata = dev_get_platdata(dev);
471	u32 tmp;
472
473	dev_dbg(dev, "suspend=%d already_suspended=%d\n",
474		pdata->suspended, pdata->already_suspended);
475
476	/*
477	 * If the controller was already suspended at suspend time,
478	 * then don't resume it now.
479	 */
480	if (pdata->already_suspended) {
481		dev_dbg(dev, "already suspended, leaving early\n");
482		pdata->already_suspended = 0;
483		return 0;
484	}
485
486	if (!pdata->suspended) {
487		dev_dbg(dev, "not suspended, leaving early\n");
488		return 0;
489	}
490
491	pdata->suspended = 0;
492
493	dev_dbg(dev, "resuming...\n");
494
495	/* set host mode */
496	tmp = USBMODE_CM_HOST | (pdata->es ? USBMODE_ES : 0);
497	ehci_writel(ehci, tmp, hcd->regs + FSL_SOC_USB_USBMODE);
498
499	ehci_writel(ehci, pdata->pm_usbgenctrl,
500		    hcd->regs + FSL_SOC_USB_USBGENCTRL);
501	ehci_writel(ehci, ISIPHYCTRL_PXE | ISIPHYCTRL_PHYE,
502		    hcd->regs + FSL_SOC_USB_ISIPHYCTRL);
503
504	ehci_writel(ehci, SBUSCFG_INCR8, hcd->regs + FSL_SOC_USB_SBUSCFG);
505
506	/* restore EHCI registers */
507	ehci_writel(ehci, pdata->pm_command, &ehci->regs->command);
508	ehci_writel(ehci, pdata->pm_intr_enable, &ehci->regs->intr_enable);
509	ehci_writel(ehci, pdata->pm_frame_index, &ehci->regs->frame_index);
510	ehci_writel(ehci, pdata->pm_segment, &ehci->regs->segment);
511	ehci_writel(ehci, pdata->pm_frame_list, &ehci->regs->frame_list);
512	ehci_writel(ehci, pdata->pm_async_next, &ehci->regs->async_next);
513	ehci_writel(ehci, pdata->pm_configured_flag,
514		    &ehci->regs->configured_flag);
515	ehci_writel(ehci, pdata->pm_portsc, &ehci->regs->port_status[0]);
516
517	set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
518	ehci->rh_state = EHCI_RH_RUNNING;
519	dev->power.power_state = PMSG_ON;
520
521	tmp = ehci_readl(ehci, &ehci->regs->command);
522	tmp |= CMD_RUN;
523	ehci_writel(ehci, tmp, &ehci->regs->command);
524
525	usb_hcd_resume_root_hub(hcd);
526
527	return 0;
528}
529#else
530static inline int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
531{
532	return 0;
533}
534
535static inline int ehci_fsl_mpc512x_drv_resume(struct device *dev)
536{
537	return 0;
538}
539#endif /* CONFIG_PPC_MPC512x */
540
541static struct ehci_fsl *hcd_to_ehci_fsl(struct usb_hcd *hcd)
542{
543	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
544
545	return container_of(ehci, struct ehci_fsl, ehci);
546}
547
548static int ehci_fsl_drv_suspend(struct device *dev)
549{
550	struct usb_hcd *hcd = dev_get_drvdata(dev);
551	struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
552	void __iomem *non_ehci = hcd->regs;
553
554	if (of_device_is_compatible(dev->parent->of_node,
555				    "fsl,mpc5121-usb2-dr")) {
556		return ehci_fsl_mpc512x_drv_suspend(dev);
557	}
558
559	ehci_prepare_ports_for_controller_suspend(hcd_to_ehci(hcd),
560			device_may_wakeup(dev));
561	if (!fsl_deep_sleep())
562		return 0;
563
564	ehci_fsl->usb_ctrl = in_be32(non_ehci + FSL_SOC_USB_CTRL);
565	return 0;
566}
567
568static int ehci_fsl_drv_resume(struct device *dev)
569{
570	struct usb_hcd *hcd = dev_get_drvdata(dev);
571	struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
572	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
573	void __iomem *non_ehci = hcd->regs;
574
575	if (of_device_is_compatible(dev->parent->of_node,
576				    "fsl,mpc5121-usb2-dr")) {
577		return ehci_fsl_mpc512x_drv_resume(dev);
578	}
579
580	ehci_prepare_ports_for_controller_resume(ehci);
581	if (!fsl_deep_sleep())
582		return 0;
583
584	usb_root_hub_lost_power(hcd->self.root_hub);
585
586	/* Restore USB PHY settings and enable the controller. */
587	out_be32(non_ehci + FSL_SOC_USB_CTRL, ehci_fsl->usb_ctrl);
588
589	ehci_reset(ehci);
590	ehci_fsl_reinit(ehci);
591
592	return 0;
593}
594
595static int ehci_fsl_drv_restore(struct device *dev)
596{
597	struct usb_hcd *hcd = dev_get_drvdata(dev);
598
599	usb_root_hub_lost_power(hcd->self.root_hub);
600	return 0;
601}
602
603static struct dev_pm_ops ehci_fsl_pm_ops = {
604	.suspend = ehci_fsl_drv_suspend,
605	.resume = ehci_fsl_drv_resume,
606	.restore = ehci_fsl_drv_restore,
607};
608
609#define EHCI_FSL_PM_OPS		(&ehci_fsl_pm_ops)
610#else
611#define EHCI_FSL_PM_OPS		NULL
612#endif /* CONFIG_PM */
613
614#ifdef CONFIG_USB_OTG
615static int ehci_start_port_reset(struct usb_hcd *hcd, unsigned port)
616{
617	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
618	u32 status;
619
620	if (!port)
621		return -EINVAL;
622
623	port--;
624
625	/* start port reset before HNP protocol time out */
626	status = readl(&ehci->regs->port_status[port]);
627	if (!(status & PORT_CONNECT))
628		return -ENODEV;
629
630	/* khubd will finish the reset later */
631	if (ehci_is_TDI(ehci)) {
632		writel(PORT_RESET |
633		       (status & ~(PORT_CSC | PORT_PEC | PORT_OCC)),
634		       &ehci->regs->port_status[port]);
635	} else {
636		writel(PORT_RESET, &ehci->regs->port_status[port]);
637	}
638
639	return 0;
640}
641#else
642#define ehci_start_port_reset	NULL
643#endif /* CONFIG_USB_OTG */
644
645
646static const struct hc_driver ehci_fsl_hc_driver = {
647	.description = hcd_name,
648	.product_desc = "Freescale On-Chip EHCI Host Controller",
649	.hcd_priv_size = sizeof(struct ehci_fsl),
650
651	/*
652	 * generic hardware linkage
653	 */
654	.irq = ehci_irq,
655	.flags = HCD_USB2 | HCD_MEMORY | HCD_BH,
656
657	/*
658	 * basic lifecycle operations
659	 */
660	.reset = ehci_fsl_setup,
661	.start = ehci_run,
662	.stop = ehci_stop,
663	.shutdown = ehci_shutdown,
664
665	/*
666	 * managing i/o requests and associated device resources
667	 */
668	.urb_enqueue = ehci_urb_enqueue,
669	.urb_dequeue = ehci_urb_dequeue,
670	.endpoint_disable = ehci_endpoint_disable,
671	.endpoint_reset = ehci_endpoint_reset,
672
673	/*
674	 * scheduling support
675	 */
676	.get_frame_number = ehci_get_frame,
677
678	/*
679	 * root hub support
680	 */
681	.hub_status_data = ehci_hub_status_data,
682	.hub_control = ehci_hub_control,
683	.bus_suspend = ehci_bus_suspend,
684	.bus_resume = ehci_bus_resume,
685	.start_port_reset = ehci_start_port_reset,
686	.relinquish_port = ehci_relinquish_port,
687	.port_handed_over = ehci_port_handed_over,
688
689	.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
690};
691
692static int ehci_fsl_drv_probe(struct platform_device *pdev)
693{
694	if (usb_disabled())
695		return -ENODEV;
696
697	/* FIXME we only want one one probe() not two */
698	return usb_hcd_fsl_probe(&ehci_fsl_hc_driver, pdev);
699}
700
701static int ehci_fsl_drv_remove(struct platform_device *pdev)
702{
703	struct usb_hcd *hcd = platform_get_drvdata(pdev);
704
705	/* FIXME we only want one one remove() not two */
706	usb_hcd_fsl_remove(hcd, pdev);
707	return 0;
708}
709
710MODULE_ALIAS("platform:fsl-ehci");
711
712static struct platform_driver ehci_fsl_driver = {
713	.probe = ehci_fsl_drv_probe,
714	.remove = ehci_fsl_drv_remove,
715	.shutdown = usb_hcd_platform_shutdown,
716	.driver = {
717		.name = "fsl-ehci",
718		.owner	= THIS_MODULE,
719		.pm = EHCI_FSL_PM_OPS,
720	},
721};