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};
v3.15
  1/*
  2 * EHCI-compliant USB host controller driver for NVIDIA Tegra SoCs
  3 *
  4 * Copyright (C) 2010 Google, Inc.
  5 * Copyright (C) 2009 - 2013 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/dma-mapping.h>
 21#include <linux/err.h>
 22#include <linux/gpio.h>
 23#include <linux/io.h>
 24#include <linux/irq.h>
 25#include <linux/module.h>
 26#include <linux/of.h>
 27#include <linux/of_device.h>
 28#include <linux/of_gpio.h>
 29#include <linux/platform_device.h>
 30#include <linux/pm_runtime.h>
 31#include <linux/reset.h>
 32#include <linux/slab.h>
 33#include <linux/usb/ehci_def.h>
 34#include <linux/usb/tegra_usb_phy.h>
 35#include <linux/usb.h>
 36#include <linux/usb/hcd.h>
 37#include <linux/usb/otg.h>
 38
 39#include "ehci.h"
 40
 41#define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
 42
 43#define TEGRA_USB_DMA_ALIGN 32
 44
 45#define DRIVER_DESC "Tegra EHCI driver"
 46#define DRV_NAME "tegra-ehci"
 47
 48static struct hc_driver __read_mostly tegra_ehci_hc_driver;
 49
 50struct tegra_ehci_soc_config {
 51	bool has_hostpc;
 52};
 53
 54static int (*orig_hub_control)(struct usb_hcd *hcd,
 55				u16 typeReq, u16 wValue, u16 wIndex,
 56				char *buf, u16 wLength);
 57
 58struct tegra_ehci_hcd {
 
 59	struct tegra_usb_phy *phy;
 60	struct clk *clk;
 61	struct reset_control *rst;
 
 
 
 62	int port_resuming;
 63	bool needs_double_reset;
 64	enum tegra_usb_phy_port_speed port_speed;
 65};
 66
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 67static int tegra_ehci_internal_port_reset(
 68	struct ehci_hcd	*ehci,
 69	u32 __iomem	*portsc_reg
 70)
 71{
 72	u32		temp;
 73	unsigned long	flags;
 74	int		retval = 0;
 75	int		i, tries;
 76	u32		saved_usbintr;
 77
 78	spin_lock_irqsave(&ehci->lock, flags);
 79	saved_usbintr = ehci_readl(ehci, &ehci->regs->intr_enable);
 80	/* disable USB interrupt */
 81	ehci_writel(ehci, 0, &ehci->regs->intr_enable);
 82	spin_unlock_irqrestore(&ehci->lock, flags);
 83
 84	/*
 85	 * Here we have to do Port Reset at most twice for
 86	 * Port Enable bit to be set.
 87	 */
 88	for (i = 0; i < 2; i++) {
 89		temp = ehci_readl(ehci, portsc_reg);
 90		temp |= PORT_RESET;
 91		ehci_writel(ehci, temp, portsc_reg);
 92		mdelay(10);
 93		temp &= ~PORT_RESET;
 94		ehci_writel(ehci, temp, portsc_reg);
 95		mdelay(1);
 96		tries = 100;
 97		do {
 98			mdelay(1);
 99			/*
100			 * Up to this point, Port Enable bit is
101			 * expected to be set after 2 ms waiting.
102			 * USB1 usually takes extra 45 ms, for safety,
103			 * we take 100 ms as timeout.
104			 */
105			temp = ehci_readl(ehci, portsc_reg);
106		} while (!(temp & PORT_PE) && tries--);
107		if (temp & PORT_PE)
108			break;
109	}
110	if (i == 2)
111		retval = -ETIMEDOUT;
112
113	/*
114	 * Clear Connect Status Change bit if it's set.
115	 * We can't clear PORT_PEC. It will also cause PORT_PE to be cleared.
116	 */
117	if (temp & PORT_CSC)
118		ehci_writel(ehci, PORT_CSC, portsc_reg);
119
120	/*
121	 * Write to clear any interrupt status bits that might be set
122	 * during port reset.
123	 */
124	temp = ehci_readl(ehci, &ehci->regs->status);
125	ehci_writel(ehci, temp, &ehci->regs->status);
126
127	/* restore original interrupt enable bits */
128	ehci_writel(ehci, saved_usbintr, &ehci->regs->intr_enable);
129	return retval;
130}
131
132static int tegra_ehci_hub_control(
133	struct usb_hcd	*hcd,
134	u16		typeReq,
135	u16		wValue,
136	u16		wIndex,
137	char		*buf,
138	u16		wLength
139)
140{
141	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
142	struct tegra_ehci_hcd *tegra = (struct tegra_ehci_hcd *)ehci->priv;
143	u32 __iomem	*status_reg;
144	u32		temp;
145	unsigned long	flags;
146	int		retval = 0;
147
148	status_reg = &ehci->regs->port_status[(wIndex & 0xff) - 1];
149
150	spin_lock_irqsave(&ehci->lock, flags);
151
152	if (typeReq == GetPortStatus) {
 
 
 
 
 
 
 
 
 
 
 
153		temp = ehci_readl(ehci, status_reg);
154		if (tegra->port_resuming && !(temp & PORT_SUSPEND)) {
155			/* Resume completed, re-enable disconnect detection */
156			tegra->port_resuming = 0;
157			tegra_usb_phy_postresume(hcd->phy);
158		}
159	}
160
161	else if (typeReq == SetPortFeature && wValue == USB_PORT_FEAT_SUSPEND) {
162		temp = ehci_readl(ehci, status_reg);
163		if ((temp & PORT_PE) == 0 || (temp & PORT_RESET) != 0) {
164			retval = -EPIPE;
165			goto done;
166		}
167
168		temp &= ~(PORT_RWC_BITS | PORT_WKCONN_E);
169		temp |= PORT_WKDISC_E | PORT_WKOC_E;
170		ehci_writel(ehci, temp | PORT_SUSPEND, status_reg);
171
172		/*
173		 * If a transaction is in progress, there may be a delay in
174		 * suspending the port. Poll until the port is suspended.
175		 */
176		if (ehci_handshake(ehci, status_reg, PORT_SUSPEND,
177						PORT_SUSPEND, 5000))
178			pr_err("%s: timeout waiting for SUSPEND\n", __func__);
179
180		set_bit((wIndex & 0xff) - 1, &ehci->suspended_ports);
181		goto done;
182	}
183
184	/* For USB1 port we need to issue Port Reset twice internally */
185	if (tegra->needs_double_reset &&
186	   (typeReq == SetPortFeature && wValue == USB_PORT_FEAT_RESET)) {
187		spin_unlock_irqrestore(&ehci->lock, flags);
188		return tegra_ehci_internal_port_reset(ehci, status_reg);
189	}
190
191	/*
192	 * Tegra host controller will time the resume operation to clear the bit
193	 * when the port control state switches to HS or FS Idle. This behavior
194	 * is different from EHCI where the host controller driver is required
195	 * to set this bit to a zero after the resume duration is timed in the
196	 * driver.
197	 */
198	else if (typeReq == ClearPortFeature &&
199					wValue == USB_PORT_FEAT_SUSPEND) {
200		temp = ehci_readl(ehci, status_reg);
201		if ((temp & PORT_RESET) || !(temp & PORT_PE)) {
202			retval = -EPIPE;
203			goto done;
204		}
205
206		if (!(temp & PORT_SUSPEND))
207			goto done;
208
209		/* Disable disconnect detection during port resume */
210		tegra_usb_phy_preresume(hcd->phy);
211
212		ehci->reset_done[wIndex-1] = jiffies + msecs_to_jiffies(25);
213
214		temp &= ~(PORT_RWC_BITS | PORT_WAKE_BITS);
215		/* start resume signalling */
216		ehci_writel(ehci, temp | PORT_RESUME, status_reg);
217		set_bit(wIndex-1, &ehci->resuming_ports);
218
219		spin_unlock_irqrestore(&ehci->lock, flags);
220		msleep(20);
221		spin_lock_irqsave(&ehci->lock, flags);
222
223		/* Poll until the controller clears RESUME and SUSPEND */
224		if (ehci_handshake(ehci, status_reg, PORT_RESUME, 0, 2000))
225			pr_err("%s: timeout waiting for RESUME\n", __func__);
226		if (ehci_handshake(ehci, status_reg, PORT_SUSPEND, 0, 2000))
227			pr_err("%s: timeout waiting for SUSPEND\n", __func__);
228
229		ehci->reset_done[wIndex-1] = 0;
230		clear_bit(wIndex-1, &ehci->resuming_ports);
231
232		tegra->port_resuming = 1;
233		goto done;
234	}
235
236	spin_unlock_irqrestore(&ehci->lock, flags);
237
238	/* Handle the hub control events here */
239	return orig_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
240
241done:
242	spin_unlock_irqrestore(&ehci->lock, flags);
243	return retval;
244}
245
246struct dma_aligned_buffer {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
247	void *kmalloc_ptr;
248	void *old_xfer_buffer;
249	u8 data[0];
250};
251
252static void free_dma_aligned_buffer(struct urb *urb)
253{
254	struct dma_aligned_buffer *temp;
 
255
256	if (!(urb->transfer_flags & URB_ALIGNED_TEMP_BUFFER))
257		return;
258
259	temp = container_of(urb->transfer_buffer,
260		struct dma_aligned_buffer, data);
 
 
261
262	if (usb_urb_dir_in(urb))
263		memcpy(temp->old_xfer_buffer, temp->data,
264		       urb->transfer_buffer_length);
265	urb->transfer_buffer = temp->old_xfer_buffer;
266	kfree(temp->kmalloc_ptr);
267
268	urb->transfer_flags &= ~URB_ALIGNED_TEMP_BUFFER;
269}
270
271static int alloc_dma_aligned_buffer(struct urb *urb, gfp_t mem_flags)
272{
273	struct dma_aligned_buffer *temp, *kmalloc_ptr;
 
274	size_t kmalloc_size;
275
276	if (urb->num_sgs || urb->sg ||
277	    urb->transfer_buffer_length == 0 ||
278	    !((uintptr_t)urb->transfer_buffer & (TEGRA_USB_DMA_ALIGN - 1)))
279		return 0;
280
 
 
281	/* Allocate a buffer with enough padding for alignment */
282	kmalloc_size = urb->transfer_buffer_length +
283		sizeof(struct dma_aligned_buffer) + TEGRA_USB_DMA_ALIGN - 1;
284
285	kmalloc_ptr = kmalloc(kmalloc_size, mem_flags);
286	if (!kmalloc_ptr)
287		return -ENOMEM;
288
289	/* Position our struct dma_aligned_buffer such that data is aligned */
290	temp = PTR_ALIGN(kmalloc_ptr + 1, TEGRA_USB_DMA_ALIGN) - 1;
 
291	temp->kmalloc_ptr = kmalloc_ptr;
292	temp->old_xfer_buffer = urb->transfer_buffer;
293	if (usb_urb_dir_out(urb))
294		memcpy(temp->data, urb->transfer_buffer,
295		       urb->transfer_buffer_length);
296	urb->transfer_buffer = temp->data;
297
298	urb->transfer_flags |= URB_ALIGNED_TEMP_BUFFER;
299
300	return 0;
301}
302
303static int tegra_ehci_map_urb_for_dma(struct usb_hcd *hcd, struct urb *urb,
304				      gfp_t mem_flags)
305{
306	int ret;
307
308	ret = alloc_dma_aligned_buffer(urb, mem_flags);
309	if (ret)
310		return ret;
311
312	ret = usb_hcd_map_urb_for_dma(hcd, urb, mem_flags);
313	if (ret)
314		free_dma_aligned_buffer(urb);
315
316	return ret;
317}
318
319static void tegra_ehci_unmap_urb_for_dma(struct usb_hcd *hcd, struct urb *urb)
320{
321	usb_hcd_unmap_urb_for_dma(hcd, urb);
322	free_dma_aligned_buffer(urb);
323}
324
325static const struct tegra_ehci_soc_config tegra30_soc_config = {
326	.has_hostpc = true,
327};
328
329static const struct tegra_ehci_soc_config tegra20_soc_config = {
330	.has_hostpc = false,
331};
332
333static struct of_device_id tegra_ehci_of_match[] = {
334	{ .compatible = "nvidia,tegra30-ehci", .data = &tegra30_soc_config },
335	{ .compatible = "nvidia,tegra20-ehci", .data = &tegra20_soc_config },
336	{ },
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
337};
338
339static int tegra_ehci_probe(struct platform_device *pdev)
340{
341	const struct of_device_id *match;
342	const struct tegra_ehci_soc_config *soc_config;
343	struct resource *res;
344	struct usb_hcd *hcd;
345	struct ehci_hcd *ehci;
346	struct tegra_ehci_hcd *tegra;
 
347	int err = 0;
348	int irq;
349	struct usb_phy *u_phy;
 
 
 
 
 
 
350
351	match = of_match_device(tegra_ehci_of_match, &pdev->dev);
352	if (!match) {
353		dev_err(&pdev->dev, "Error: No device match found\n");
354		return -ENODEV;
355	}
356	soc_config = match->data;
357
358	/* Right now device-tree probed devices don't get dma_mask set.
359	 * Since shared usb code relies on it, set it here for now.
360	 * Once we have dma capability bindings this can go away.
361	 */
362	err = dma_coerce_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
363	if (err)
364		return err;
365
366	hcd = usb_create_hcd(&tegra_ehci_hc_driver, &pdev->dev,
367					dev_name(&pdev->dev));
368	if (!hcd) {
369		dev_err(&pdev->dev, "Unable to create HCD\n");
370		return -ENOMEM;
 
371	}
372	platform_set_drvdata(pdev, hcd);
373	ehci = hcd_to_ehci(hcd);
374	tegra = (struct tegra_ehci_hcd *)ehci->priv;
375
376	hcd->has_tt = 1;
377
378	tegra->clk = devm_clk_get(&pdev->dev, NULL);
379	if (IS_ERR(tegra->clk)) {
380		dev_err(&pdev->dev, "Can't get ehci clock\n");
381		err = PTR_ERR(tegra->clk);
382		goto cleanup_hcd_create;
383	}
384
385	tegra->rst = devm_reset_control_get(&pdev->dev, "usb");
386	if (IS_ERR(tegra->rst)) {
387		dev_err(&pdev->dev, "Can't get ehci reset\n");
388		err = PTR_ERR(tegra->rst);
389		goto cleanup_hcd_create;
390	}
391
392	err = clk_prepare_enable(tegra->clk);
393	if (err)
394		goto cleanup_hcd_create;
395
396	reset_control_assert(tegra->rst);
397	udelay(1);
398	reset_control_deassert(tegra->rst);
399
400	u_phy = devm_usb_get_phy_by_phandle(&pdev->dev, "nvidia,phy", 0);
401	if (IS_ERR(u_phy)) {
402		err = PTR_ERR(u_phy);
403		goto cleanup_clk_en;
 
404	}
405	hcd->phy = u_phy;
406
407	tegra->needs_double_reset = of_property_read_bool(pdev->dev.of_node,
408		"nvidia,needs-double-reset");
409
410	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
411	if (!res) {
412		dev_err(&pdev->dev, "Failed to get I/O memory\n");
413		err = -ENXIO;
414		goto cleanup_clk_en;
415	}
416	hcd->rsrc_start = res->start;
417	hcd->rsrc_len = resource_size(res);
418	hcd->regs = devm_ioremap(&pdev->dev, res->start, resource_size(res));
419	if (!hcd->regs) {
420		dev_err(&pdev->dev, "Failed to remap I/O memory\n");
421		err = -ENOMEM;
422		goto cleanup_clk_en;
423	}
424	ehci->caps = hcd->regs + 0x100;
425	ehci->has_hostpc = soc_config->has_hostpc;
426
427	err = usb_phy_init(hcd->phy);
428	if (err) {
429		dev_err(&pdev->dev, "Failed to initialize phy\n");
430		goto cleanup_clk_en;
431	}
432
433	u_phy->otg = devm_kzalloc(&pdev->dev, sizeof(struct usb_otg),
434			     GFP_KERNEL);
435	if (!u_phy->otg) {
436		dev_err(&pdev->dev, "Failed to alloc memory for otg\n");
437		err = -ENOMEM;
438		goto cleanup_phy;
439	}
440	u_phy->otg->host = hcd_to_bus(hcd);
441
442	err = usb_phy_set_suspend(hcd->phy, 0);
443	if (err) {
444		dev_err(&pdev->dev, "Failed to power on the phy\n");
445		goto cleanup_phy;
446	}
447
 
 
 
 
448	irq = platform_get_irq(pdev, 0);
449	if (!irq) {
450		dev_err(&pdev->dev, "Failed to get IRQ\n");
451		err = -ENODEV;
452		goto cleanup_phy;
453	}
 
454
455	otg_set_host(u_phy->otg, &hcd->self);
 
 
 
 
 
 
456
457	err = usb_add_hcd(hcd, irq, IRQF_SHARED);
458	if (err) {
459		dev_err(&pdev->dev, "Failed to add USB HCD\n");
460		goto cleanup_otg_set_host;
461	}
462	device_wakeup_enable(hcd->self.controller);
463
464	return err;
465
466cleanup_otg_set_host:
467	otg_set_host(u_phy->otg, NULL);
468cleanup_phy:
469	usb_phy_shutdown(hcd->phy);
470cleanup_clk_en:
471	clk_disable_unprepare(tegra->clk);
472cleanup_hcd_create:
 
 
 
 
 
 
 
 
 
 
 
473	usb_put_hcd(hcd);
 
 
474	return err;
475}
476
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
477static int tegra_ehci_remove(struct platform_device *pdev)
478{
479	struct usb_hcd *hcd = platform_get_drvdata(pdev);
480	struct tegra_ehci_hcd *tegra =
481		(struct tegra_ehci_hcd *)hcd_to_ehci(hcd)->priv;
 
 
482
483	otg_set_host(hcd->phy->otg, NULL);
 
 
 
 
 
484
485	usb_phy_shutdown(hcd->phy);
486	usb_remove_hcd(hcd);
487	usb_put_hcd(hcd);
488
489	clk_disable_unprepare(tegra->clk);
 
 
 
 
 
 
 
490
 
491	return 0;
492}
493
494static void tegra_ehci_hcd_shutdown(struct platform_device *pdev)
495{
496	struct usb_hcd *hcd = platform_get_drvdata(pdev);
 
497
498	if (hcd->driver->shutdown)
499		hcd->driver->shutdown(hcd);
500}
501
502static struct platform_driver tegra_ehci_driver = {
503	.probe		= tegra_ehci_probe,
504	.remove		= tegra_ehci_remove,
 
 
 
 
505	.shutdown	= tegra_ehci_hcd_shutdown,
506	.driver		= {
507		.name	= DRV_NAME,
508		.of_match_table = tegra_ehci_of_match,
509	}
510};
511
512static int tegra_ehci_reset(struct usb_hcd *hcd)
513{
514	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
515	int retval;
516	int txfifothresh;
517
518	retval = ehci_setup(hcd);
519	if (retval)
520		return retval;
521
522	/*
523	 * We should really pull this value out of tegra_ehci_soc_config, but
524	 * to avoid needing access to it, make use of the fact that Tegra20 is
525	 * the only one so far that needs a value of 10, and Tegra20 is the
526	 * only one which doesn't set has_hostpc.
527	 */
528	txfifothresh = ehci->has_hostpc ? 0x10 : 10;
529	ehci_writel(ehci, txfifothresh << 16, &ehci->regs->txfill_tuning);
530
531	return 0;
532}
533
534static const struct ehci_driver_overrides tegra_overrides __initconst = {
535	.extra_priv_size	= sizeof(struct tegra_ehci_hcd),
536	.reset			= tegra_ehci_reset,
537};
538
539static int __init ehci_tegra_init(void)
540{
541	if (usb_disabled())
542		return -ENODEV;
543
544	pr_info(DRV_NAME ": " DRIVER_DESC "\n");
545
546	ehci_init_driver(&tegra_ehci_hc_driver, &tegra_overrides);
547
548	/*
549	 * The Tegra HW has some unusual quirks, which require Tegra-specific
550	 * workarounds. We override certain hc_driver functions here to
551	 * achieve that. We explicitly do not enhance ehci_driver_overrides to
552	 * allow this more easily, since this is an unusual case, and we don't
553	 * want to encourage others to override these functions by making it
554	 * too easy.
555	 */
556
557	orig_hub_control = tegra_ehci_hc_driver.hub_control;
558
559	tegra_ehci_hc_driver.map_urb_for_dma = tegra_ehci_map_urb_for_dma;
560	tegra_ehci_hc_driver.unmap_urb_for_dma = tegra_ehci_unmap_urb_for_dma;
561	tegra_ehci_hc_driver.hub_control = tegra_ehci_hub_control;
562
563	return platform_driver_register(&tegra_ehci_driver);
564}
565module_init(ehci_tegra_init);
566
567static void __exit ehci_tegra_cleanup(void)
568{
569	platform_driver_unregister(&tegra_ehci_driver);
570}
571module_exit(ehci_tegra_cleanup);
572
573MODULE_DESCRIPTION(DRIVER_DESC);
574MODULE_LICENSE("GPL");
575MODULE_ALIAS("platform:" DRV_NAME);
576MODULE_DEVICE_TABLE(of, tegra_ehci_of_match);