Linux Audio

Check our new training course

Loading...
v3.1
 
  1/*
  2 * EHCI-compliant USB host controller driver for NVIDIA Tegra SoCs
  3 *
  4 * Copyright (C) 2010 Google, Inc.
  5 * Copyright (C) 2009 NVIDIA Corporation
  6 *
  7 * This program is free software; you can redistribute it and/or modify it
  8 * under the terms of the GNU General Public License as published by the
  9 * Free Software Foundation; either version 2 of the License, or (at your
 10 * option) any later version.
 11 *
 12 * This program is distributed in the hope that it will be useful, but WITHOUT
 13 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 14 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 15 * more details.
 16 *
 17 */
 18
 19#include <linux/clk.h>
 20#include <linux/platform_device.h>
 21#include <linux/platform_data/tegra_usb.h>
 
 
 22#include <linux/irq.h>
 
 
 
 
 
 
 
 
 
 
 
 
 23#include <linux/usb/otg.h>
 24#include <mach/usb_phy.h>
 
 
 
 25
 26#define TEGRA_USB_DMA_ALIGN 32
 27
 
 
 
 
 
 
 
 
 
 28struct tegra_ehci_hcd {
 29	struct ehci_hcd *ehci;
 30	struct tegra_usb_phy *phy;
 31	struct clk *clk;
 32	struct clk *emc_clk;
 33	struct otg_transceiver *transceiver;
 34	int host_resumed;
 35	int bus_suspended;
 36	int port_resuming;
 37	int power_down_on_bus_suspend;
 38	enum tegra_usb_phy_port_speed port_speed;
 39};
 40
 41static void tegra_ehci_power_up(struct usb_hcd *hcd)
 42{
 43	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
 
 
 
 
 
 
 
 
 
 44
 45	clk_enable(tegra->emc_clk);
 46	clk_enable(tegra->clk);
 47	tegra_usb_phy_power_on(tegra->phy);
 48	tegra->host_resumed = 1;
 49}
 
 
 
 
 
 
 
 
 
 
 
 
 
 50
 51static void tegra_ehci_power_down(struct usb_hcd *hcd)
 52{
 53	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
 54
 55	tegra->host_resumed = 0;
 56	tegra_usb_phy_power_off(tegra->phy);
 57	clk_disable(tegra->clk);
 58	clk_disable(tegra->emc_clk);
 
 
 
 
 
 
 
 
 
 
 
 
 59}
 60
 61static int tegra_ehci_internal_port_reset(
 62	struct ehci_hcd	*ehci,
 63	u32 __iomem	*portsc_reg
 64)
 65{
 66	u32		temp;
 67	unsigned long	flags;
 68	int		retval = 0;
 69	int		i, tries;
 70	u32		saved_usbintr;
 71
 72	spin_lock_irqsave(&ehci->lock, flags);
 73	saved_usbintr = ehci_readl(ehci, &ehci->regs->intr_enable);
 74	/* disable USB interrupt */
 75	ehci_writel(ehci, 0, &ehci->regs->intr_enable);
 76	spin_unlock_irqrestore(&ehci->lock, flags);
 77
 78	/*
 79	 * Here we have to do Port Reset at most twice for
 80	 * Port Enable bit to be set.
 81	 */
 82	for (i = 0; i < 2; i++) {
 83		temp = ehci_readl(ehci, portsc_reg);
 84		temp |= PORT_RESET;
 85		ehci_writel(ehci, temp, portsc_reg);
 86		mdelay(10);
 87		temp &= ~PORT_RESET;
 88		ehci_writel(ehci, temp, portsc_reg);
 89		mdelay(1);
 90		tries = 100;
 91		do {
 92			mdelay(1);
 93			/*
 94			 * Up to this point, Port Enable bit is
 95			 * expected to be set after 2 ms waiting.
 96			 * USB1 usually takes extra 45 ms, for safety,
 97			 * we take 100 ms as timeout.
 98			 */
 99			temp = ehci_readl(ehci, portsc_reg);
100		} while (!(temp & PORT_PE) && tries--);
101		if (temp & PORT_PE)
102			break;
103	}
104	if (i == 2)
105		retval = -ETIMEDOUT;
106
107	/*
108	 * Clear Connect Status Change bit if it's set.
109	 * We can't clear PORT_PEC. It will also cause PORT_PE to be cleared.
110	 */
111	if (temp & PORT_CSC)
112		ehci_writel(ehci, PORT_CSC, portsc_reg);
113
114	/*
115	 * Write to clear any interrupt status bits that might be set
116	 * during port reset.
117	 */
118	temp = ehci_readl(ehci, &ehci->regs->status);
119	ehci_writel(ehci, temp, &ehci->regs->status);
120
121	/* restore original interrupt enable bits */
122	ehci_writel(ehci, saved_usbintr, &ehci->regs->intr_enable);
123	return retval;
124}
125
126static int tegra_ehci_hub_control(
127	struct usb_hcd	*hcd,
128	u16		typeReq,
129	u16		wValue,
130	u16		wIndex,
131	char		*buf,
132	u16		wLength
133)
134{
135	struct ehci_hcd	*ehci = hcd_to_ehci(hcd);
136	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
137	u32 __iomem	*status_reg;
138	u32		temp;
139	unsigned long	flags;
140	int		retval = 0;
141
142	status_reg = &ehci->regs->port_status[(wIndex & 0xff) - 1];
143
144	spin_lock_irqsave(&ehci->lock, flags);
145
146	/*
147	 * In ehci_hub_control() for USB_PORT_FEAT_ENABLE clears the other bits
148	 * that are write on clear, by writing back the register read value, so
149	 * USB_PORT_FEAT_ENABLE is handled by masking the set on clear bits
150	 */
151	if (typeReq == ClearPortFeature && wValue == USB_PORT_FEAT_ENABLE) {
152		temp = ehci_readl(ehci, status_reg) & ~PORT_RWC_BITS;
153		ehci_writel(ehci, temp & ~PORT_PE, status_reg);
154		goto done;
155	}
156
157	else if (typeReq == GetPortStatus) {
158		temp = ehci_readl(ehci, status_reg);
159		if (tegra->port_resuming && !(temp & PORT_SUSPEND)) {
160			/* Resume completed, re-enable disconnect detection */
161			tegra->port_resuming = 0;
162			tegra_usb_phy_postresume(tegra->phy);
163		}
164	}
165
166	else if (typeReq == SetPortFeature && wValue == USB_PORT_FEAT_SUSPEND) {
167		temp = ehci_readl(ehci, status_reg);
168		if ((temp & PORT_PE) == 0 || (temp & PORT_RESET) != 0) {
169			retval = -EPIPE;
170			goto done;
171		}
172
173		temp &= ~PORT_WKCONN_E;
174		temp |= PORT_WKDISC_E | PORT_WKOC_E;
175		ehci_writel(ehci, temp | PORT_SUSPEND, status_reg);
176
177		/*
178		 * If a transaction is in progress, there may be a delay in
179		 * suspending the port. Poll until the port is suspended.
180		 */
181		if (handshake(ehci, status_reg, PORT_SUSPEND,
182						PORT_SUSPEND, 5000))
183			pr_err("%s: timeout waiting for SUSPEND\n", __func__);
184
185		set_bit((wIndex & 0xff) - 1, &ehci->suspended_ports);
186		goto done;
187	}
188
189	/* For USB1 port we need to issue Port Reset twice internally */
190	if (tegra->phy->instance == 0 &&
191	   (typeReq == SetPortFeature && wValue == USB_PORT_FEAT_RESET)) {
192		spin_unlock_irqrestore(&ehci->lock, flags);
193		return tegra_ehci_internal_port_reset(ehci, status_reg);
194	}
195
196	/*
197	 * Tegra host controller will time the resume operation to clear the bit
198	 * when the port control state switches to HS or FS Idle. This behavior
199	 * is different from EHCI where the host controller driver is required
200	 * to set this bit to a zero after the resume duration is timed in the
201	 * driver.
202	 */
203	else if (typeReq == ClearPortFeature &&
204					wValue == USB_PORT_FEAT_SUSPEND) {
205		temp = ehci_readl(ehci, status_reg);
206		if ((temp & PORT_RESET) || !(temp & PORT_PE)) {
207			retval = -EPIPE;
208			goto done;
209		}
210
211		if (!(temp & PORT_SUSPEND))
212			goto done;
213
214		/* Disable disconnect detection during port resume */
215		tegra_usb_phy_preresume(tegra->phy);
216
217		ehci->reset_done[wIndex-1] = jiffies + msecs_to_jiffies(25);
218
219		temp &= ~(PORT_RWC_BITS | PORT_WAKE_BITS);
220		/* start resume signalling */
221		ehci_writel(ehci, temp | PORT_RESUME, status_reg);
 
222
223		spin_unlock_irqrestore(&ehci->lock, flags);
224		msleep(20);
225		spin_lock_irqsave(&ehci->lock, flags);
226
227		/* Poll until the controller clears RESUME and SUSPEND */
228		if (handshake(ehci, status_reg, PORT_RESUME, 0, 2000))
229			pr_err("%s: timeout waiting for RESUME\n", __func__);
230		if (handshake(ehci, status_reg, PORT_SUSPEND, 0, 2000))
231			pr_err("%s: timeout waiting for SUSPEND\n", __func__);
232
233		ehci->reset_done[wIndex-1] = 0;
 
234
235		tegra->port_resuming = 1;
236		goto done;
237	}
238
239	spin_unlock_irqrestore(&ehci->lock, flags);
240
241	/* Handle the hub control events here */
242	return ehci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
 
243done:
244	spin_unlock_irqrestore(&ehci->lock, flags);
245	return retval;
246}
247
248static void tegra_ehci_restart(struct usb_hcd *hcd)
249{
250	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
251
252	ehci_reset(ehci);
253
254	/* setup the frame list and Async q heads */
255	ehci_writel(ehci, ehci->periodic_dma, &ehci->regs->frame_list);
256	ehci_writel(ehci, (u32)ehci->async->qh_dma, &ehci->regs->async_next);
257	/* setup the command register and set the controller in RUN mode */
258	ehci->command &= ~(CMD_LRESET|CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET);
259	ehci->command |= CMD_RUN;
260	ehci_writel(ehci, ehci->command, &ehci->regs->command);
261
262	down_write(&ehci_cf_port_reset_rwsem);
263	ehci_writel(ehci, FLAG_CF, &ehci->regs->configured_flag);
264	/* flush posted writes */
265	ehci_readl(ehci, &ehci->regs->command);
266	up_write(&ehci_cf_port_reset_rwsem);
267}
268
269static int tegra_usb_suspend(struct usb_hcd *hcd)
270{
271	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
272	struct ehci_regs __iomem *hw = tegra->ehci->regs;
273	unsigned long flags;
274
275	spin_lock_irqsave(&tegra->ehci->lock, flags);
276
277	tegra->port_speed = (readl(&hw->port_status[0]) >> 26) & 0x3;
278	ehci_halt(tegra->ehci);
279	clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
280
281	spin_unlock_irqrestore(&tegra->ehci->lock, flags);
282
283	tegra_ehci_power_down(hcd);
284	return 0;
285}
286
287static int tegra_usb_resume(struct usb_hcd *hcd)
288{
289	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
290	struct ehci_hcd	*ehci = hcd_to_ehci(hcd);
291	struct ehci_regs __iomem *hw = ehci->regs;
292	unsigned long val;
293
294	set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
295	tegra_ehci_power_up(hcd);
296
297	if (tegra->port_speed > TEGRA_USB_PHY_PORT_SPEED_HIGH) {
298		/* Wait for the phy to detect new devices
299		 * before we restart the controller */
300		msleep(10);
301		goto restart;
302	}
303
304	/* Force the phy to keep data lines in suspend state */
305	tegra_ehci_phy_restore_start(tegra->phy, tegra->port_speed);
306
307	/* Enable host mode */
308	tdi_reset(ehci);
309
310	/* Enable Port Power */
311	val = readl(&hw->port_status[0]);
312	val |= PORT_POWER;
313	writel(val, &hw->port_status[0]);
314	udelay(10);
315
316	/* Check if the phy resume from LP0. When the phy resume from LP0
317	 * USB register will be reset. */
318	if (!readl(&hw->async_next)) {
319		/* Program the field PTC based on the saved speed mode */
320		val = readl(&hw->port_status[0]);
321		val &= ~PORT_TEST(~0);
322		if (tegra->port_speed == TEGRA_USB_PHY_PORT_SPEED_HIGH)
323			val |= PORT_TEST_FORCE;
324		else if (tegra->port_speed == TEGRA_USB_PHY_PORT_SPEED_FULL)
325			val |= PORT_TEST(6);
326		else if (tegra->port_speed == TEGRA_USB_PHY_PORT_SPEED_LOW)
327			val |= PORT_TEST(7);
328		writel(val, &hw->port_status[0]);
329		udelay(10);
330
331		/* Disable test mode by setting PTC field to NORMAL_OP */
332		val = readl(&hw->port_status[0]);
333		val &= ~PORT_TEST(~0);
334		writel(val, &hw->port_status[0]);
335		udelay(10);
336	}
337
338	/* Poll until CCS is enabled */
339	if (handshake(ehci, &hw->port_status[0], PORT_CONNECT,
340						 PORT_CONNECT, 2000)) {
341		pr_err("%s: timeout waiting for PORT_CONNECT\n", __func__);
342		goto restart;
343	}
344
345	/* Poll until PE is enabled */
346	if (handshake(ehci, &hw->port_status[0], PORT_PE,
347						 PORT_PE, 2000)) {
348		pr_err("%s: timeout waiting for USB_PORTSC1_PE\n", __func__);
349		goto restart;
350	}
351
352	/* Clear the PCI status, to avoid an interrupt taken upon resume */
353	val = readl(&hw->status);
354	val |= STS_PCD;
355	writel(val, &hw->status);
356
357	/* Put controller in suspend mode by writing 1 to SUSP bit of PORTSC */
358	val = readl(&hw->port_status[0]);
359	if ((val & PORT_POWER) && (val & PORT_PE)) {
360		val |= PORT_SUSPEND;
361		writel(val, &hw->port_status[0]);
362
363		/* Wait until port suspend completes */
364		if (handshake(ehci, &hw->port_status[0], PORT_SUSPEND,
365							 PORT_SUSPEND, 1000)) {
366			pr_err("%s: timeout waiting for PORT_SUSPEND\n",
367								__func__);
368			goto restart;
369		}
370	}
371
372	tegra_ehci_phy_restore_end(tegra->phy);
373	return 0;
374
375restart:
376	if (tegra->port_speed <= TEGRA_USB_PHY_PORT_SPEED_HIGH)
377		tegra_ehci_phy_restore_end(tegra->phy);
378
379	tegra_ehci_restart(hcd);
380	return 0;
381}
382
383static void tegra_ehci_shutdown(struct usb_hcd *hcd)
384{
385	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
386
387	/* ehci_shutdown touches the USB controller registers, make sure
388	 * controller has clocks to it */
389	if (!tegra->host_resumed)
390		tegra_ehci_power_up(hcd);
391
392	ehci_shutdown(hcd);
393}
394
395static int tegra_ehci_setup(struct usb_hcd *hcd)
396{
397	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
398	int retval;
399
400	/* EHCI registers start at offset 0x100 */
401	ehci->caps = hcd->regs + 0x100;
402	ehci->regs = hcd->regs + 0x100 +
403		HC_LENGTH(ehci, readl(&ehci->caps->hc_capbase));
404
405	dbg_hcs_params(ehci, "reset");
406	dbg_hcc_params(ehci, "reset");
407
408	/* cache this readonly data; minimize chip reads */
409	ehci->hcs_params = readl(&ehci->caps->hcs_params);
410
411	/* switch to host mode */
412	hcd->has_tt = 1;
413	ehci_reset(ehci);
414
415	retval = ehci_halt(ehci);
416	if (retval)
417		return retval;
418
419	/* data structure init */
420	retval = ehci_init(hcd);
421	if (retval)
422		return retval;
423
424	ehci->sbrn = 0x20;
425
426	ehci_port_power(ehci, 1);
427	return retval;
428}
429
430#ifdef CONFIG_PM
431static int tegra_ehci_bus_suspend(struct usb_hcd *hcd)
432{
433	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
434	int error_status = 0;
435
436	error_status = ehci_bus_suspend(hcd);
437	if (!error_status && tegra->power_down_on_bus_suspend) {
438		tegra_usb_suspend(hcd);
439		tegra->bus_suspended = 1;
440	}
441
442	return error_status;
443}
444
445static int tegra_ehci_bus_resume(struct usb_hcd *hcd)
446{
447	struct tegra_ehci_hcd *tegra = dev_get_drvdata(hcd->self.controller);
448
449	if (tegra->bus_suspended && tegra->power_down_on_bus_suspend) {
450		tegra_usb_resume(hcd);
451		tegra->bus_suspended = 0;
452	}
453
454	tegra_usb_phy_preresume(tegra->phy);
455	tegra->port_resuming = 1;
456	return ehci_bus_resume(hcd);
457}
458#endif
459
460struct temp_buffer {
461	void *kmalloc_ptr;
462	void *old_xfer_buffer;
463	u8 data[0];
464};
465
466static void free_temp_buffer(struct urb *urb)
467{
468	enum dma_data_direction dir;
469	struct temp_buffer *temp;
470
471	if (!(urb->transfer_flags & URB_ALIGNED_TEMP_BUFFER))
472		return;
473
474	dir = usb_urb_dir_in(urb) ? DMA_FROM_DEVICE : DMA_TO_DEVICE;
 
475
476	temp = container_of(urb->transfer_buffer, struct temp_buffer,
477			    data);
 
 
 
478
479	if (dir == DMA_FROM_DEVICE)
480		memcpy(temp->old_xfer_buffer, temp->data,
481		       urb->transfer_buffer_length);
482	urb->transfer_buffer = temp->old_xfer_buffer;
483	kfree(temp->kmalloc_ptr);
484
485	urb->transfer_flags &= ~URB_ALIGNED_TEMP_BUFFER;
486}
487
488static int alloc_temp_buffer(struct urb *urb, gfp_t mem_flags)
489{
490	enum dma_data_direction dir;
491	struct temp_buffer *temp, *kmalloc_ptr;
492	size_t kmalloc_size;
493
494	if (urb->num_sgs || urb->sg ||
495	    urb->transfer_buffer_length == 0 ||
496	    !((uintptr_t)urb->transfer_buffer & (TEGRA_USB_DMA_ALIGN - 1)))
497		return 0;
498
499	dir = usb_urb_dir_in(urb) ? DMA_FROM_DEVICE : DMA_TO_DEVICE;
500
501	/* Allocate a buffer with enough padding for alignment */
502	kmalloc_size = urb->transfer_buffer_length +
503		sizeof(struct temp_buffer) + TEGRA_USB_DMA_ALIGN - 1;
504
505	kmalloc_ptr = kmalloc(kmalloc_size, mem_flags);
506	if (!kmalloc_ptr)
507		return -ENOMEM;
508
509	/* Position our struct temp_buffer such that data is aligned */
510	temp = PTR_ALIGN(kmalloc_ptr + 1, TEGRA_USB_DMA_ALIGN) - 1;
511
512	temp->kmalloc_ptr = kmalloc_ptr;
513	temp->old_xfer_buffer = urb->transfer_buffer;
514	if (dir == DMA_TO_DEVICE)
515		memcpy(temp->data, urb->transfer_buffer,
516		       urb->transfer_buffer_length);
517	urb->transfer_buffer = temp->data;
518
519	urb->transfer_flags |= URB_ALIGNED_TEMP_BUFFER;
520
521	return 0;
522}
523
524static int tegra_ehci_map_urb_for_dma(struct usb_hcd *hcd, struct urb *urb,
525				      gfp_t mem_flags)
526{
527	int ret;
528
529	ret = alloc_temp_buffer(urb, mem_flags);
530	if (ret)
531		return ret;
532
533	ret = usb_hcd_map_urb_for_dma(hcd, urb, mem_flags);
534	if (ret)
535		free_temp_buffer(urb);
536
537	return ret;
538}
539
540static void tegra_ehci_unmap_urb_for_dma(struct usb_hcd *hcd, struct urb *urb)
541{
542	usb_hcd_unmap_urb_for_dma(hcd, urb);
543	free_temp_buffer(urb);
544}
545
546static const struct hc_driver tegra_ehci_hc_driver = {
547	.description		= hcd_name,
548	.product_desc		= "Tegra EHCI Host Controller",
549	.hcd_priv_size		= sizeof(struct ehci_hcd),
550
551	.flags			= HCD_USB2 | HCD_MEMORY,
552
553	.reset			= tegra_ehci_setup,
554	.irq			= ehci_irq,
555
556	.start			= ehci_run,
557	.stop			= ehci_stop,
558	.shutdown		= tegra_ehci_shutdown,
559	.urb_enqueue		= ehci_urb_enqueue,
560	.urb_dequeue		= ehci_urb_dequeue,
561	.map_urb_for_dma	= tegra_ehci_map_urb_for_dma,
562	.unmap_urb_for_dma	= tegra_ehci_unmap_urb_for_dma,
563	.endpoint_disable	= ehci_endpoint_disable,
564	.endpoint_reset		= ehci_endpoint_reset,
565	.get_frame_number	= ehci_get_frame,
566	.hub_status_data	= ehci_hub_status_data,
567	.hub_control		= tegra_ehci_hub_control,
568	.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
569#ifdef CONFIG_PM
570	.bus_suspend		= tegra_ehci_bus_suspend,
571	.bus_resume		= tegra_ehci_bus_resume,
572#endif
573	.relinquish_port	= ehci_relinquish_port,
574	.port_handed_over	= ehci_port_handed_over,
575};
576
577static int tegra_ehci_probe(struct platform_device *pdev)
578{
 
 
579	struct resource *res;
580	struct usb_hcd *hcd;
 
581	struct tegra_ehci_hcd *tegra;
582	struct tegra_ehci_platform_data *pdata;
583	int err = 0;
584	int irq;
585	int instance = pdev->id;
586
587	pdata = pdev->dev.platform_data;
588	if (!pdata) {
589		dev_err(&pdev->dev, "Platform data missing\n");
590		return -EINVAL;
591	}
592
593	tegra = kzalloc(sizeof(struct tegra_ehci_hcd), GFP_KERNEL);
594	if (!tegra)
595		return -ENOMEM;
 
 
 
 
 
596
597	hcd = usb_create_hcd(&tegra_ehci_hc_driver, &pdev->dev,
598					dev_name(&pdev->dev));
599	if (!hcd) {
600		dev_err(&pdev->dev, "Unable to create HCD\n");
601		err = -ENOMEM;
602		goto fail_hcd;
603	}
 
 
 
604
605	platform_set_drvdata(pdev, tegra);
606
607	tegra->clk = clk_get(&pdev->dev, NULL);
608	if (IS_ERR(tegra->clk)) {
609		dev_err(&pdev->dev, "Can't get ehci clock\n");
610		err = PTR_ERR(tegra->clk);
611		goto fail_clk;
612	}
613
614	err = clk_enable(tegra->clk);
 
 
 
 
 
 
 
615	if (err)
616		goto fail_clken;
617
618	tegra->emc_clk = clk_get(&pdev->dev, "emc");
619	if (IS_ERR(tegra->emc_clk)) {
620		dev_err(&pdev->dev, "Can't get emc clock\n");
621		err = PTR_ERR(tegra->emc_clk);
622		goto fail_emc_clk;
623	}
624
625	clk_enable(tegra->emc_clk);
626	clk_set_rate(tegra->emc_clk, 400000000);
 
 
 
 
 
 
 
 
627
628	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
629	if (!res) {
630		dev_err(&pdev->dev, "Failed to get I/O memory\n");
631		err = -ENXIO;
632		goto fail_io;
633	}
634	hcd->rsrc_start = res->start;
635	hcd->rsrc_len = resource_size(res);
636	hcd->regs = ioremap(res->start, resource_size(res));
637	if (!hcd->regs) {
638		dev_err(&pdev->dev, "Failed to remap I/O memory\n");
639		err = -ENOMEM;
640		goto fail_io;
 
 
 
641	}
642
643	tegra->phy = tegra_usb_phy_open(instance, hcd->regs, pdata->phy_config,
644						TEGRA_USB_PHY_MODE_HOST);
645	if (IS_ERR(tegra->phy)) {
646		dev_err(&pdev->dev, "Failed to open USB phy\n");
647		err = -ENXIO;
648		goto fail_phy;
649	}
 
650
651	err = tegra_usb_phy_power_on(tegra->phy);
652	if (err) {
653		dev_err(&pdev->dev, "Failed to power on the phy\n");
654		goto fail;
655	}
656
657	tegra->host_resumed = 1;
658	tegra->power_down_on_bus_suspend = pdata->power_down_on_bus_suspend;
659	tegra->ehci = hcd_to_ehci(hcd);
660
661	irq = platform_get_irq(pdev, 0);
662	if (!irq) {
663		dev_err(&pdev->dev, "Failed to get IRQ\n");
664		err = -ENODEV;
665		goto fail;
666	}
667	set_irq_flags(irq, IRQF_VALID);
668
669#ifdef CONFIG_USB_OTG_UTILS
670	if (pdata->operating_mode == TEGRA_USB_OTG) {
671		tegra->transceiver = otg_get_transceiver();
672		if (tegra->transceiver)
673			otg_set_host(tegra->transceiver, &hcd->self);
674	}
675#endif
676
677	err = usb_add_hcd(hcd, irq, IRQF_DISABLED | IRQF_SHARED);
678	if (err) {
679		dev_err(&pdev->dev, "Failed to add USB HCD\n");
680		goto fail;
681	}
 
682
683	return err;
684
685fail:
686#ifdef CONFIG_USB_OTG_UTILS
687	if (tegra->transceiver) {
688		otg_set_host(tegra->transceiver, NULL);
689		otg_put_transceiver(tegra->transceiver);
690	}
691#endif
692	tegra_usb_phy_close(tegra->phy);
693fail_phy:
694	iounmap(hcd->regs);
695fail_io:
696	clk_disable(tegra->emc_clk);
697	clk_put(tegra->emc_clk);
698fail_emc_clk:
699	clk_disable(tegra->clk);
700fail_clken:
701	clk_put(tegra->clk);
702fail_clk:
703	usb_put_hcd(hcd);
704fail_hcd:
705	kfree(tegra);
706	return err;
707}
708
709#ifdef CONFIG_PM
710static int tegra_ehci_resume(struct platform_device *pdev)
711{
712	struct tegra_ehci_hcd *tegra = platform_get_drvdata(pdev);
713	struct usb_hcd *hcd = ehci_to_hcd(tegra->ehci);
714
715	if (tegra->bus_suspended)
716		return 0;
717
718	return tegra_usb_resume(hcd);
719}
720
721static int tegra_ehci_suspend(struct platform_device *pdev, pm_message_t state)
722{
723	struct tegra_ehci_hcd *tegra = platform_get_drvdata(pdev);
724	struct usb_hcd *hcd = ehci_to_hcd(tegra->ehci);
725
726	if (tegra->bus_suspended)
727		return 0;
728
729	if (time_before(jiffies, tegra->ehci->next_statechange))
730		msleep(10);
731
732	return tegra_usb_suspend(hcd);
733}
734#endif
735
736static int tegra_ehci_remove(struct platform_device *pdev)
737{
738	struct tegra_ehci_hcd *tegra = platform_get_drvdata(pdev);
739	struct usb_hcd *hcd = ehci_to_hcd(tegra->ehci);
740
741	if (tegra == NULL || hcd == NULL)
742		return -EINVAL;
743
744#ifdef CONFIG_USB_OTG_UTILS
745	if (tegra->transceiver) {
746		otg_set_host(tegra->transceiver, NULL);
747		otg_put_transceiver(tegra->transceiver);
748	}
749#endif
750
 
751	usb_remove_hcd(hcd);
752	usb_put_hcd(hcd);
753
754	tegra_usb_phy_close(tegra->phy);
755	iounmap(hcd->regs);
756
757	clk_disable(tegra->clk);
758	clk_put(tegra->clk);
759
760	clk_disable(tegra->emc_clk);
761	clk_put(tegra->emc_clk);
762
763	kfree(tegra);
764	return 0;
765}
766
767static void tegra_ehci_hcd_shutdown(struct platform_device *pdev)
768{
769	struct tegra_ehci_hcd *tegra = platform_get_drvdata(pdev);
770	struct usb_hcd *hcd = ehci_to_hcd(tegra->ehci);
771
772	if (hcd->driver->shutdown)
773		hcd->driver->shutdown(hcd);
774}
775
776static struct platform_driver tegra_ehci_driver = {
777	.probe		= tegra_ehci_probe,
778	.remove		= tegra_ehci_remove,
779#ifdef CONFIG_PM
780	.suspend	= tegra_ehci_suspend,
781	.resume		= tegra_ehci_resume,
782#endif
783	.shutdown	= tegra_ehci_hcd_shutdown,
784	.driver		= {
785		.name	= "tegra-ehci",
 
786	}
787};
v5.4
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * EHCI-compliant USB host controller driver for NVIDIA Tegra SoCs
  4 *
  5 * Copyright (C) 2010 Google, Inc.
  6 * Copyright (C) 2009 - 2013 NVIDIA Corporation
 
 
 
 
 
 
 
 
 
 
 
  7 */
  8
  9#include <linux/clk.h>
 10#include <linux/dma-mapping.h>
 11#include <linux/err.h>
 12#include <linux/gpio.h>
 13#include <linux/io.h>
 14#include <linux/irq.h>
 15#include <linux/module.h>
 16#include <linux/of.h>
 17#include <linux/of_device.h>
 18#include <linux/of_gpio.h>
 19#include <linux/platform_device.h>
 20#include <linux/pm_runtime.h>
 21#include <linux/reset.h>
 22#include <linux/slab.h>
 23#include <linux/usb/ehci_def.h>
 24#include <linux/usb/tegra_usb_phy.h>
 25#include <linux/usb.h>
 26#include <linux/usb/hcd.h>
 27#include <linux/usb/otg.h>
 28
 29#include "ehci.h"
 30
 31#define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
 32
 33#define TEGRA_USB_DMA_ALIGN 32
 34
 35#define DRIVER_DESC "Tegra EHCI driver"
 36#define DRV_NAME "tegra-ehci"
 37
 38static struct hc_driver __read_mostly tegra_ehci_hc_driver;
 39
 40struct tegra_ehci_soc_config {
 41	bool has_hostpc;
 42};
 43
 44struct tegra_ehci_hcd {
 
 45	struct tegra_usb_phy *phy;
 46	struct clk *clk;
 47	struct reset_control *rst;
 
 
 
 48	int port_resuming;
 49	bool needs_double_reset;
 50	enum tegra_usb_phy_port_speed port_speed;
 51};
 52
 53static int tegra_reset_usb_controller(struct platform_device *pdev)
 54{
 55	struct device_node *phy_np;
 56	struct usb_hcd *hcd = platform_get_drvdata(pdev);
 57	struct tegra_ehci_hcd *tegra =
 58		(struct tegra_ehci_hcd *)hcd_to_ehci(hcd)->priv;
 59	struct reset_control *rst;
 60	int err;
 61
 62	phy_np = of_parse_phandle(pdev->dev.of_node, "nvidia,phy", 0);
 63	if (!phy_np)
 64		return -ENOENT;
 65
 66	/*
 67	 * The 1st USB controller contains some UTMI pad registers that are
 68	 * global for all the controllers on the chip. Those registers are
 69	 * also cleared when reset is asserted to the 1st controller.
 70	 */
 71	rst = of_reset_control_get_shared(phy_np, "utmi-pads");
 72	if (IS_ERR(rst)) {
 73		dev_warn(&pdev->dev,
 74			 "can't get utmi-pads reset from the PHY\n");
 75		dev_warn(&pdev->dev,
 76			 "continuing, but please update your DT\n");
 77	} else {
 78		/*
 79		 * PHY driver performs UTMI-pads reset in a case of
 80		 * non-legacy DT.
 81		 */
 82		reset_control_put(rst);
 83	}
 84
 85	of_node_put(phy_np);
 
 
 86
 87	/* reset control is shared, hence initialize it first */
 88	err = reset_control_deassert(tegra->rst);
 89	if (err)
 90		return err;
 91
 92	err = reset_control_assert(tegra->rst);
 93	if (err)
 94		return err;
 95
 96	udelay(1);
 97
 98	err = reset_control_deassert(tegra->rst);
 99	if (err)
100		return err;
101
102	return 0;
103}
104
105static int tegra_ehci_internal_port_reset(
106	struct ehci_hcd	*ehci,
107	u32 __iomem	*portsc_reg
108)
109{
110	u32		temp;
111	unsigned long	flags;
112	int		retval = 0;
113	int		i, tries;
114	u32		saved_usbintr;
115
116	spin_lock_irqsave(&ehci->lock, flags);
117	saved_usbintr = ehci_readl(ehci, &ehci->regs->intr_enable);
118	/* disable USB interrupt */
119	ehci_writel(ehci, 0, &ehci->regs->intr_enable);
120	spin_unlock_irqrestore(&ehci->lock, flags);
121
122	/*
123	 * Here we have to do Port Reset at most twice for
124	 * Port Enable bit to be set.
125	 */
126	for (i = 0; i < 2; i++) {
127		temp = ehci_readl(ehci, portsc_reg);
128		temp |= PORT_RESET;
129		ehci_writel(ehci, temp, portsc_reg);
130		mdelay(10);
131		temp &= ~PORT_RESET;
132		ehci_writel(ehci, temp, portsc_reg);
133		mdelay(1);
134		tries = 100;
135		do {
136			mdelay(1);
137			/*
138			 * Up to this point, Port Enable bit is
139			 * expected to be set after 2 ms waiting.
140			 * USB1 usually takes extra 45 ms, for safety,
141			 * we take 100 ms as timeout.
142			 */
143			temp = ehci_readl(ehci, portsc_reg);
144		} while (!(temp & PORT_PE) && tries--);
145		if (temp & PORT_PE)
146			break;
147	}
148	if (i == 2)
149		retval = -ETIMEDOUT;
150
151	/*
152	 * Clear Connect Status Change bit if it's set.
153	 * We can't clear PORT_PEC. It will also cause PORT_PE to be cleared.
154	 */
155	if (temp & PORT_CSC)
156		ehci_writel(ehci, PORT_CSC, portsc_reg);
157
158	/*
159	 * Write to clear any interrupt status bits that might be set
160	 * during port reset.
161	 */
162	temp = ehci_readl(ehci, &ehci->regs->status);
163	ehci_writel(ehci, temp, &ehci->regs->status);
164
165	/* restore original interrupt enable bits */
166	ehci_writel(ehci, saved_usbintr, &ehci->regs->intr_enable);
167	return retval;
168}
169
170static int tegra_ehci_hub_control(
171	struct usb_hcd	*hcd,
172	u16		typeReq,
173	u16		wValue,
174	u16		wIndex,
175	char		*buf,
176	u16		wLength
177)
178{
179	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
180	struct tegra_ehci_hcd *tegra = (struct tegra_ehci_hcd *)ehci->priv;
181	u32 __iomem	*status_reg;
182	u32		temp;
183	unsigned long	flags;
184	int		retval = 0;
185
186	status_reg = &ehci->regs->port_status[(wIndex & 0xff) - 1];
187
188	spin_lock_irqsave(&ehci->lock, flags);
189
190	if (typeReq == GetPortStatus) {
 
 
 
 
 
 
 
 
 
 
 
191		temp = ehci_readl(ehci, status_reg);
192		if (tegra->port_resuming && !(temp & PORT_SUSPEND)) {
193			/* Resume completed, re-enable disconnect detection */
194			tegra->port_resuming = 0;
195			tegra_usb_phy_postresume(hcd->usb_phy);
196		}
197	}
198
199	else if (typeReq == SetPortFeature && wValue == USB_PORT_FEAT_SUSPEND) {
200		temp = ehci_readl(ehci, status_reg);
201		if ((temp & PORT_PE) == 0 || (temp & PORT_RESET) != 0) {
202			retval = -EPIPE;
203			goto done;
204		}
205
206		temp &= ~(PORT_RWC_BITS | PORT_WKCONN_E);
207		temp |= PORT_WKDISC_E | PORT_WKOC_E;
208		ehci_writel(ehci, temp | PORT_SUSPEND, status_reg);
209
210		/*
211		 * If a transaction is in progress, there may be a delay in
212		 * suspending the port. Poll until the port is suspended.
213		 */
214		if (ehci_handshake(ehci, status_reg, PORT_SUSPEND,
215						PORT_SUSPEND, 5000))
216			pr_err("%s: timeout waiting for SUSPEND\n", __func__);
217
218		set_bit((wIndex & 0xff) - 1, &ehci->suspended_ports);
219		goto done;
220	}
221
222	/* For USB1 port we need to issue Port Reset twice internally */
223	if (tegra->needs_double_reset &&
224	   (typeReq == SetPortFeature && wValue == USB_PORT_FEAT_RESET)) {
225		spin_unlock_irqrestore(&ehci->lock, flags);
226		return tegra_ehci_internal_port_reset(ehci, status_reg);
227	}
228
229	/*
230	 * Tegra host controller will time the resume operation to clear the bit
231	 * when the port control state switches to HS or FS Idle. This behavior
232	 * is different from EHCI where the host controller driver is required
233	 * to set this bit to a zero after the resume duration is timed in the
234	 * driver.
235	 */
236	else if (typeReq == ClearPortFeature &&
237					wValue == USB_PORT_FEAT_SUSPEND) {
238		temp = ehci_readl(ehci, status_reg);
239		if ((temp & PORT_RESET) || !(temp & PORT_PE)) {
240			retval = -EPIPE;
241			goto done;
242		}
243
244		if (!(temp & PORT_SUSPEND))
245			goto done;
246
247		/* Disable disconnect detection during port resume */
248		tegra_usb_phy_preresume(hcd->usb_phy);
249
250		ehci->reset_done[wIndex-1] = jiffies + msecs_to_jiffies(25);
251
252		temp &= ~(PORT_RWC_BITS | PORT_WAKE_BITS);
253		/* start resume signalling */
254		ehci_writel(ehci, temp | PORT_RESUME, status_reg);
255		set_bit(wIndex-1, &ehci->resuming_ports);
256
257		spin_unlock_irqrestore(&ehci->lock, flags);
258		msleep(20);
259		spin_lock_irqsave(&ehci->lock, flags);
260
261		/* Poll until the controller clears RESUME and SUSPEND */
262		if (ehci_handshake(ehci, status_reg, PORT_RESUME, 0, 2000))
263			pr_err("%s: timeout waiting for RESUME\n", __func__);
264		if (ehci_handshake(ehci, status_reg, PORT_SUSPEND, 0, 2000))
265			pr_err("%s: timeout waiting for SUSPEND\n", __func__);
266
267		ehci->reset_done[wIndex-1] = 0;
268		clear_bit(wIndex-1, &ehci->resuming_ports);
269
270		tegra->port_resuming = 1;
271		goto done;
272	}
273
274	spin_unlock_irqrestore(&ehci->lock, flags);
275
276	/* Handle the hub control events here */
277	return ehci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
278
279done:
280	spin_unlock_irqrestore(&ehci->lock, flags);
281	return retval;
282}
283
284struct dma_aligned_buffer {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
285	void *kmalloc_ptr;
286	void *old_xfer_buffer;
287	u8 data[0];
288};
289
290static void free_dma_aligned_buffer(struct urb *urb)
291{
292	struct dma_aligned_buffer *temp;
293	size_t length;
294
295	if (!(urb->transfer_flags & URB_ALIGNED_TEMP_BUFFER))
296		return;
297
298	temp = container_of(urb->transfer_buffer,
299		struct dma_aligned_buffer, data);
300
301	if (usb_urb_dir_in(urb)) {
302		if (usb_pipeisoc(urb->pipe))
303			length = urb->transfer_buffer_length;
304		else
305			length = urb->actual_length;
306
307		memcpy(temp->old_xfer_buffer, temp->data, length);
308	}
 
309	urb->transfer_buffer = temp->old_xfer_buffer;
310	kfree(temp->kmalloc_ptr);
311
312	urb->transfer_flags &= ~URB_ALIGNED_TEMP_BUFFER;
313}
314
315static int alloc_dma_aligned_buffer(struct urb *urb, gfp_t mem_flags)
316{
317	struct dma_aligned_buffer *temp, *kmalloc_ptr;
 
318	size_t kmalloc_size;
319
320	if (urb->num_sgs || urb->sg ||
321	    urb->transfer_buffer_length == 0 ||
322	    !((uintptr_t)urb->transfer_buffer & (TEGRA_USB_DMA_ALIGN - 1)))
323		return 0;
324
 
 
325	/* Allocate a buffer with enough padding for alignment */
326	kmalloc_size = urb->transfer_buffer_length +
327		sizeof(struct dma_aligned_buffer) + TEGRA_USB_DMA_ALIGN - 1;
328
329	kmalloc_ptr = kmalloc(kmalloc_size, mem_flags);
330	if (!kmalloc_ptr)
331		return -ENOMEM;
332
333	/* Position our struct dma_aligned_buffer such that data is aligned */
334	temp = PTR_ALIGN(kmalloc_ptr + 1, TEGRA_USB_DMA_ALIGN) - 1;
 
335	temp->kmalloc_ptr = kmalloc_ptr;
336	temp->old_xfer_buffer = urb->transfer_buffer;
337	if (usb_urb_dir_out(urb))
338		memcpy(temp->data, urb->transfer_buffer,
339		       urb->transfer_buffer_length);
340	urb->transfer_buffer = temp->data;
341
342	urb->transfer_flags |= URB_ALIGNED_TEMP_BUFFER;
343
344	return 0;
345}
346
347static int tegra_ehci_map_urb_for_dma(struct usb_hcd *hcd, struct urb *urb,
348				      gfp_t mem_flags)
349{
350	int ret;
351
352	ret = alloc_dma_aligned_buffer(urb, mem_flags);
353	if (ret)
354		return ret;
355
356	ret = usb_hcd_map_urb_for_dma(hcd, urb, mem_flags);
357	if (ret)
358		free_dma_aligned_buffer(urb);
359
360	return ret;
361}
362
363static void tegra_ehci_unmap_urb_for_dma(struct usb_hcd *hcd, struct urb *urb)
364{
365	usb_hcd_unmap_urb_for_dma(hcd, urb);
366	free_dma_aligned_buffer(urb);
367}
368
369static const struct tegra_ehci_soc_config tegra30_soc_config = {
370	.has_hostpc = true,
371};
372
373static const struct tegra_ehci_soc_config tegra20_soc_config = {
374	.has_hostpc = false,
375};
376
377static const struct of_device_id tegra_ehci_of_match[] = {
378	{ .compatible = "nvidia,tegra30-ehci", .data = &tegra30_soc_config },
379	{ .compatible = "nvidia,tegra20-ehci", .data = &tegra20_soc_config },
380	{ },
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
381};
382
383static int tegra_ehci_probe(struct platform_device *pdev)
384{
385	const struct of_device_id *match;
386	const struct tegra_ehci_soc_config *soc_config;
387	struct resource *res;
388	struct usb_hcd *hcd;
389	struct ehci_hcd *ehci;
390	struct tegra_ehci_hcd *tegra;
 
391	int err = 0;
392	int irq;
393	struct usb_phy *u_phy;
394
395	match = of_match_device(tegra_ehci_of_match, &pdev->dev);
396	if (!match) {
397		dev_err(&pdev->dev, "Error: No device match found\n");
398		return -ENODEV;
399	}
400	soc_config = match->data;
401
402	/* Right now device-tree probed devices don't get dma_mask set.
403	 * Since shared usb code relies on it, set it here for now.
404	 * Once we have dma capability bindings this can go away.
405	 */
406	err = dma_coerce_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
407	if (err)
408		return err;
409
410	hcd = usb_create_hcd(&tegra_ehci_hc_driver, &pdev->dev,
411					dev_name(&pdev->dev));
412	if (!hcd) {
413		dev_err(&pdev->dev, "Unable to create HCD\n");
414		return -ENOMEM;
 
415	}
416	platform_set_drvdata(pdev, hcd);
417	ehci = hcd_to_ehci(hcd);
418	tegra = (struct tegra_ehci_hcd *)ehci->priv;
419
420	hcd->has_tt = 1;
421
422	tegra->clk = devm_clk_get(&pdev->dev, NULL);
423	if (IS_ERR(tegra->clk)) {
424		dev_err(&pdev->dev, "Can't get ehci clock\n");
425		err = PTR_ERR(tegra->clk);
426		goto cleanup_hcd_create;
427	}
428
429	tegra->rst = devm_reset_control_get_shared(&pdev->dev, "usb");
430	if (IS_ERR(tegra->rst)) {
431		dev_err(&pdev->dev, "Can't get ehci reset\n");
432		err = PTR_ERR(tegra->rst);
433		goto cleanup_hcd_create;
434	}
435
436	err = clk_prepare_enable(tegra->clk);
437	if (err)
438		goto cleanup_hcd_create;
439
440	err = tegra_reset_usb_controller(pdev);
441	if (err) {
442		dev_err(&pdev->dev, "Failed to reset controller\n");
443		goto cleanup_clk_en;
 
444	}
445
446	u_phy = devm_usb_get_phy_by_phandle(&pdev->dev, "nvidia,phy", 0);
447	if (IS_ERR(u_phy)) {
448		err = -EPROBE_DEFER;
449		goto cleanup_clk_en;
450	}
451	hcd->usb_phy = u_phy;
452	hcd->skip_phy_initialization = 1;
453
454	tegra->needs_double_reset = of_property_read_bool(pdev->dev.of_node,
455		"nvidia,needs-double-reset");
456
457	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
458	hcd->regs = devm_ioremap_resource(&pdev->dev, res);
459	if (IS_ERR(hcd->regs)) {
460		err = PTR_ERR(hcd->regs);
461		goto cleanup_clk_en;
462	}
463	hcd->rsrc_start = res->start;
464	hcd->rsrc_len = resource_size(res);
465
466	ehci->caps = hcd->regs + 0x100;
467	ehci->has_hostpc = soc_config->has_hostpc;
468
469	err = usb_phy_init(hcd->usb_phy);
470	if (err) {
471		dev_err(&pdev->dev, "Failed to initialize phy\n");
472		goto cleanup_clk_en;
473	}
474
475	u_phy->otg = devm_kzalloc(&pdev->dev, sizeof(struct usb_otg),
476			     GFP_KERNEL);
477	if (!u_phy->otg) {
478		err = -ENOMEM;
479		goto cleanup_phy;
 
480	}
481	u_phy->otg->host = hcd_to_bus(hcd);
482
483	err = usb_phy_set_suspend(hcd->usb_phy, 0);
484	if (err) {
485		dev_err(&pdev->dev, "Failed to power on the phy\n");
486		goto cleanup_phy;
487	}
488
 
 
 
 
489	irq = platform_get_irq(pdev, 0);
490	if (!irq) {
491		dev_err(&pdev->dev, "Failed to get IRQ\n");
492		err = -ENODEV;
493		goto cleanup_phy;
494	}
 
495
496	otg_set_host(u_phy->otg, &hcd->self);
 
 
 
 
 
 
497
498	err = usb_add_hcd(hcd, irq, IRQF_SHARED);
499	if (err) {
500		dev_err(&pdev->dev, "Failed to add USB HCD\n");
501		goto cleanup_otg_set_host;
502	}
503	device_wakeup_enable(hcd->self.controller);
504
505	return err;
506
507cleanup_otg_set_host:
508	otg_set_host(u_phy->otg, NULL);
509cleanup_phy:
510	usb_phy_shutdown(hcd->usb_phy);
511cleanup_clk_en:
512	clk_disable_unprepare(tegra->clk);
513cleanup_hcd_create:
 
 
 
 
 
 
 
 
 
 
 
514	usb_put_hcd(hcd);
 
 
515	return err;
516}
517
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
518static int tegra_ehci_remove(struct platform_device *pdev)
519{
520	struct usb_hcd *hcd = platform_get_drvdata(pdev);
521	struct tegra_ehci_hcd *tegra =
522		(struct tegra_ehci_hcd *)hcd_to_ehci(hcd)->priv;
 
 
523
524	otg_set_host(hcd->usb_phy->otg, NULL);
 
 
 
 
 
525
526	usb_phy_shutdown(hcd->usb_phy);
527	usb_remove_hcd(hcd);
 
528
529	reset_control_assert(tegra->rst);
530	udelay(1);
531
532	clk_disable_unprepare(tegra->clk);
 
533
534	usb_put_hcd(hcd);
 
535
 
536	return 0;
537}
538
539static void tegra_ehci_hcd_shutdown(struct platform_device *pdev)
540{
541	struct usb_hcd *hcd = platform_get_drvdata(pdev);
 
542
543	if (hcd->driver->shutdown)
544		hcd->driver->shutdown(hcd);
545}
546
547static struct platform_driver tegra_ehci_driver = {
548	.probe		= tegra_ehci_probe,
549	.remove		= tegra_ehci_remove,
 
 
 
 
550	.shutdown	= tegra_ehci_hcd_shutdown,
551	.driver		= {
552		.name	= DRV_NAME,
553		.of_match_table = tegra_ehci_of_match,
554	}
555};
556
557static int tegra_ehci_reset(struct usb_hcd *hcd)
558{
559	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
560	int retval;
561	int txfifothresh;
562
563	retval = ehci_setup(hcd);
564	if (retval)
565		return retval;
566
567	/*
568	 * We should really pull this value out of tegra_ehci_soc_config, but
569	 * to avoid needing access to it, make use of the fact that Tegra20 is
570	 * the only one so far that needs a value of 10, and Tegra20 is the
571	 * only one which doesn't set has_hostpc.
572	 */
573	txfifothresh = ehci->has_hostpc ? 0x10 : 10;
574	ehci_writel(ehci, txfifothresh << 16, &ehci->regs->txfill_tuning);
575
576	return 0;
577}
578
579static const struct ehci_driver_overrides tegra_overrides __initconst = {
580	.extra_priv_size	= sizeof(struct tegra_ehci_hcd),
581	.reset			= tegra_ehci_reset,
582};
583
584static int __init ehci_tegra_init(void)
585{
586	if (usb_disabled())
587		return -ENODEV;
588
589	pr_info(DRV_NAME ": " DRIVER_DESC "\n");
590
591	ehci_init_driver(&tegra_ehci_hc_driver, &tegra_overrides);
592
593	/*
594	 * The Tegra HW has some unusual quirks, which require Tegra-specific
595	 * workarounds. We override certain hc_driver functions here to
596	 * achieve that. We explicitly do not enhance ehci_driver_overrides to
597	 * allow this more easily, since this is an unusual case, and we don't
598	 * want to encourage others to override these functions by making it
599	 * too easy.
600	 */
601
602	tegra_ehci_hc_driver.map_urb_for_dma = tegra_ehci_map_urb_for_dma;
603	tegra_ehci_hc_driver.unmap_urb_for_dma = tegra_ehci_unmap_urb_for_dma;
604	tegra_ehci_hc_driver.hub_control = tegra_ehci_hub_control;
605
606	return platform_driver_register(&tegra_ehci_driver);
607}
608module_init(ehci_tegra_init);
609
610static void __exit ehci_tegra_cleanup(void)
611{
612	platform_driver_unregister(&tegra_ehci_driver);
613}
614module_exit(ehci_tegra_cleanup);
615
616MODULE_DESCRIPTION(DRIVER_DESC);
617MODULE_LICENSE("GPL");
618MODULE_ALIAS("platform:" DRV_NAME);
619MODULE_DEVICE_TABLE(of, tegra_ehci_of_match);