Linux Audio

Check our new training course

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