ehci-hcd.c 38.2 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2 3 4 5
 * Enhanced Host Controller Interface (EHCI) driver for USB.
 *
 * Maintainer: Alan Stern <stern@rowland.harvard.edu>
 *
L
Linus Torvalds 已提交
6
 * Copyright (c) 2000-2004 by David Brownell
7
 *
L
Linus Torvalds 已提交
8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the
 * Free Software Foundation; either version 2 of the License, or (at your
 * option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 * for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software Foundation,
 * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/pci.h>
#include <linux/dmapool.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/ioport.h>
#include <linux/sched.h>
30
#include <linux/vmalloc.h>
L
Linus Torvalds 已提交
31 32
#include <linux/errno.h>
#include <linux/init.h>
A
Alan Stern 已提交
33
#include <linux/hrtimer.h>
L
Linus Torvalds 已提交
34 35 36
#include <linux/list.h>
#include <linux/interrupt.h>
#include <linux/usb.h>
37
#include <linux/usb/hcd.h>
L
Linus Torvalds 已提交
38 39
#include <linux/moduleparam.h>
#include <linux/dma-mapping.h>
40
#include <linux/debugfs.h>
41
#include <linux/slab.h>
L
Linus Torvalds 已提交
42 43 44 45 46 47

#include <asm/byteorder.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/unaligned.h>

G
Geoff Levand 已提交
48 49 50 51
#if defined(CONFIG_PPC_PS3)
#include <asm/firmware.h>
#endif

L
Linus Torvalds 已提交
52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73
/*-------------------------------------------------------------------------*/

/*
 * EHCI hc_driver implementation ... experimental, incomplete.
 * Based on the final 1.0 register interface specification.
 *
 * USB 2.0 shows up in upcoming www.pcmcia.org technology.
 * First was PCMCIA, like ISA; then CardBus, which is PCI.
 * Next comes "CardBay", using USB 2.0 signals.
 *
 * Contains additional contributions by Brad Hards, Rory Bolt, and others.
 * Special thanks to Intel and VIA for providing host controllers to
 * test this driver on, and Cypress (including In-System Design) for
 * providing early devices for those host controllers to talk to!
 */

#define DRIVER_AUTHOR "David Brownell"
#define DRIVER_DESC "USB 2.0 'Enhanced' Host Controller (EHCI) Driver"

static const char	hcd_name [] = "ehci_hcd";


D
David Brownell 已提交
74
#undef VERBOSE_DEBUG
L
Linus Torvalds 已提交
75 76 77 78 79 80 81 82 83 84 85 86
#undef EHCI_URB_TRACE

#ifdef DEBUG
#define EHCI_STATS
#endif

/* magic numbers that can affect system performance */
#define	EHCI_TUNE_CERR		3	/* 0-3 qtd retries; 0 == don't stop */
#define	EHCI_TUNE_RL_HS		4	/* nak throttle; see 4.9 */
#define	EHCI_TUNE_RL_TT		0
#define	EHCI_TUNE_MULT_HS	1	/* 1-3 transactions/uframe; 4.10.3 */
#define	EHCI_TUNE_MULT_TT	1
87 88 89 90 91 92 93
/*
 * Some drivers think it's safe to schedule isochronous transfers more than
 * 256 ms into the future (partly as a result of an old bug in the scheduling
 * code).  In an attempt to avoid trouble, we will use a minimum scheduling
 * length of 512 frames instead of 256.
 */
#define	EHCI_TUNE_FLS		1	/* (medium) 512-frame schedule */
L
Linus Torvalds 已提交
94 95 96 97 98 99 100 101 102 103 104

/* Initial IRQ latency:  faster than hw default */
static int log2_irq_thresh = 0;		// 0 to 6
module_param (log2_irq_thresh, int, S_IRUGO);
MODULE_PARM_DESC (log2_irq_thresh, "log2 IRQ latency, 1-64 microframes");

/* initial park setting:  slower than hw default */
static unsigned park = 0;
module_param (park, uint, S_IRUGO);
MODULE_PARM_DESC (park, "park setting; 1-3 back-to-back async packets");

105
/* for flakey hardware, ignore overcurrent indicators */
106
static bool ignore_oc = 0;
107 108 109
module_param (ignore_oc, bool, S_IRUGO);
MODULE_PARM_DESC (ignore_oc, "ignore bogus hardware overcurrent indications");

L
Linus Torvalds 已提交
110 111 112 113 114
#define	INTR_MASK (STS_IAA | STS_FATAL | STS_PCD | STS_ERR | STS_INT)

/*-------------------------------------------------------------------------*/

#include "ehci.h"
115
#include "pci-quirks.h"
L
Linus Torvalds 已提交
116

117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142
/*
 * The MosChip MCS9990 controller updates its microframe counter
 * a little before the frame counter, and occasionally we will read
 * the invalid intermediate value.  Avoid problems by checking the
 * microframe number (the low-order 3 bits); if they are 0 then
 * re-read the register to get the correct value.
 */
static unsigned ehci_moschip_read_frame_index(struct ehci_hcd *ehci)
{
	unsigned uf;

	uf = ehci_readl(ehci, &ehci->regs->frame_index);
	if (unlikely((uf & 7) == 0))
		uf = ehci_readl(ehci, &ehci->regs->frame_index);
	return uf;
}

static inline unsigned ehci_read_frame_index(struct ehci_hcd *ehci)
{
	if (ehci->frame_index_bug)
		return ehci_moschip_read_frame_index(ehci);
	return ehci_readl(ehci, &ehci->regs->frame_index);
}

#include "ehci-dbg.c"

L
Linus Torvalds 已提交
143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161
/*-------------------------------------------------------------------------*/

/*
 * handshake - spin reading hc until handshake completes or fails
 * @ptr: address of hc register to be read
 * @mask: bits to look at in result of read
 * @done: value of those bits when handshake succeeds
 * @usec: timeout in microseconds
 *
 * Returns negative errno, or zero on success
 *
 * Success happens when the "mask" bits have the specified value (hardware
 * handshake done).  There are two failure modes:  "usec" have passed (major
 * hardware flakeout), or the register reads as all-ones (hardware removed).
 *
 * That last failure should_only happen in cases like physical cardbus eject
 * before driver shutdown. But it also seems to be caused by bugs in cardbus
 * bridge shutdown:  shutting down the bridge before the devices using it.
 */
162 163
static int handshake (struct ehci_hcd *ehci, void __iomem *ptr,
		      u32 mask, u32 done, int usec)
L
Linus Torvalds 已提交
164 165 166 167
{
	u32	result;

	do {
168
		result = ehci_readl(ehci, ptr);
L
Linus Torvalds 已提交
169 170 171 172 173 174 175 176 177 178 179
		if (result == ~(u32)0)		/* card removed */
			return -ENODEV;
		result &= mask;
		if (result == done)
			return 0;
		udelay (1);
		usec--;
	} while (usec > 0);
	return -ETIMEDOUT;
}

180 181 182 183 184
/* check TDI/ARC silicon is in host mode */
static int tdi_in_host_mode (struct ehci_hcd *ehci)
{
	u32		tmp;

185
	tmp = ehci_readl(ehci, &ehci->regs->usbmode);
186 187 188
	return (tmp & 3) == USBMODE_CM_HC;
}

A
Alan Stern 已提交
189 190 191 192
/*
 * Force HC to halt state from unknown (EHCI spec section 2.3).
 * Must be called with interrupts enabled and the lock not held.
 */
L
Linus Torvalds 已提交
193 194
static int ehci_halt (struct ehci_hcd *ehci)
{
A
Alan Stern 已提交
195 196 197
	u32	temp;

	spin_lock_irq(&ehci->lock);
L
Linus Torvalds 已提交
198

199
	/* disable any irqs left enabled by previous code */
200
	ehci_writel(ehci, 0, &ehci->regs->intr_enable);
201

A
Alan Stern 已提交
202 203
	if (ehci_is_TDI(ehci) && !tdi_in_host_mode(ehci)) {
		spin_unlock_irq(&ehci->lock);
204 205 206
		return 0;
	}

207 208 209 210 211
	/*
	 * This routine gets called during probe before ehci->command
	 * has been initialized, so we can't rely on its value.
	 */
	ehci->command &= ~CMD_RUN;
212
	temp = ehci_readl(ehci, &ehci->regs->command);
213
	temp &= ~(CMD_RUN | CMD_IAAD);
214
	ehci_writel(ehci, temp, &ehci->regs->command);
G
Geoff Levand 已提交
215

A
Alan Stern 已提交
216 217
	spin_unlock_irq(&ehci->lock);
	synchronize_irq(ehci_to_hcd(ehci)->irq);
218

A
Alan Stern 已提交
219
	return handshake(ehci, &ehci->regs->status,
220
			  STS_HALT, STS_HALT, 16 * 125);
221 222
}

L
Linus Torvalds 已提交
223 224 225 226 227
/* put TDI/ARC silicon into EHCI mode */
static void tdi_reset (struct ehci_hcd *ehci)
{
	u32		tmp;

228
	tmp = ehci_readl(ehci, &ehci->regs->usbmode);
229 230 231 232 233 234 235
	tmp |= USBMODE_CM_HC;
	/* The default byte access to MMR space is LE after
	 * controller reset. Set the required endian mode
	 * for transfer buffers to match the host microprocessor
	 */
	if (ehci_big_endian_mmio(ehci))
		tmp |= USBMODE_BE;
236
	ehci_writel(ehci, tmp, &ehci->regs->usbmode);
L
Linus Torvalds 已提交
237 238
}

A
Alan Stern 已提交
239 240 241 242
/*
 * Reset a non-running (STS_HALT == 1) controller.
 * Must be called with interrupts enabled and the lock not held.
 */
L
Linus Torvalds 已提交
243 244 245
static int ehci_reset (struct ehci_hcd *ehci)
{
	int	retval;
246
	u32	command = ehci_readl(ehci, &ehci->regs->command);
L
Linus Torvalds 已提交
247

248 249
	/* If the EHCI debug controller is active, special care must be
	 * taken before and after a host controller reset */
250
	if (ehci->debug && !dbgp_reset_prep(ehci_to_hcd(ehci)))
251 252
		ehci->debug = NULL;

L
Linus Torvalds 已提交
253 254
	command |= CMD_RESET;
	dbg_cmd (ehci, "reset", command);
255
	ehci_writel(ehci, command, &ehci->regs->command);
256
	ehci->rh_state = EHCI_RH_HALTED;
L
Linus Torvalds 已提交
257
	ehci->next_statechange = jiffies;
258 259
	retval = handshake (ehci, &ehci->regs->command,
			    CMD_RESET, 0, 250 * 1000);
L
Linus Torvalds 已提交
260

261 262
	if (ehci->has_hostpc) {
		ehci_writel(ehci, USBMODE_EX_HC | USBMODE_EX_VBPS,
263 264
				&ehci->regs->usbmode_ex);
		ehci_writel(ehci, TXFIFO_DEFAULT, &ehci->regs->txfill_tuning);
265
	}
L
Linus Torvalds 已提交
266 267 268 269 270 271
	if (retval)
		return retval;

	if (ehci_is_TDI(ehci))
		tdi_reset (ehci);

272
	if (ehci->debug)
273
		dbgp_external_startup(ehci_to_hcd(ehci));
274

275 276
	ehci->port_c_suspend = ehci->suspended_ports =
			ehci->resuming_ports = 0;
L
Linus Torvalds 已提交
277 278 279
	return retval;
}

A
Alan Stern 已提交
280 281 282 283
/*
 * Idle the controller (turn off the schedules).
 * Must be called with interrupts enabled and the lock not held.
 */
L
Linus Torvalds 已提交
284 285 286 287
static void ehci_quiesce (struct ehci_hcd *ehci)
{
	u32	temp;

288
	if (ehci->rh_state != EHCI_RH_RUNNING)
289
		return;
L
Linus Torvalds 已提交
290 291

	/* wait for any schedule enables/disables to take effect */
292
	temp = (ehci->command << 10) & (STS_ASS | STS_PSS);
293
	handshake(ehci, &ehci->regs->status, STS_ASS | STS_PSS, temp, 16 * 125);
L
Linus Torvalds 已提交
294 295

	/* then disable anything that's still active */
A
Alan Stern 已提交
296
	spin_lock_irq(&ehci->lock);
297 298
	ehci->command &= ~(CMD_ASE | CMD_PSE);
	ehci_writel(ehci, ehci->command, &ehci->regs->command);
A
Alan Stern 已提交
299
	spin_unlock_irq(&ehci->lock);
L
Linus Torvalds 已提交
300 301

	/* hardware can take 16 microframes to turn off ... */
302
	handshake(ehci, &ehci->regs->status, STS_ASS | STS_PSS, 0, 16 * 125);
L
Linus Torvalds 已提交
303 304 305 306
}

/*-------------------------------------------------------------------------*/

307
static void end_unlink_async(struct ehci_hcd *ehci);
308
static void unlink_empty_async(struct ehci_hcd *ehci);
309
static void ehci_work(struct ehci_hcd *ehci);
310 311
static void start_unlink_intr(struct ehci_hcd *ehci, struct ehci_qh *qh);
static void end_unlink_intr(struct ehci_hcd *ehci, struct ehci_qh *qh);
L
Linus Torvalds 已提交
312

A
Alan Stern 已提交
313
#include "ehci-timer.c"
L
Linus Torvalds 已提交
314 315 316 317
#include "ehci-hub.c"
#include "ehci-mem.c"
#include "ehci-q.c"
#include "ehci-sched.c"
318
#include "ehci-sysfs.c"
L
Linus Torvalds 已提交
319 320 321

/*-------------------------------------------------------------------------*/

322 323 324 325 326 327 328 329 330 331 332 333 334
/* On some systems, leaving remote wakeup enabled prevents system shutdown.
 * The firmware seems to think that powering off is a wakeup event!
 * This routine turns off remote wakeup and everything else, on all ports.
 */
static void ehci_turn_off_all_ports(struct ehci_hcd *ehci)
{
	int	port = HCS_N_PORTS(ehci->hcs_params);

	while (port--)
		ehci_writel(ehci, PORT_RWC_BITS,
				&ehci->regs->port_status[port]);
}

S
Sarah Sharp 已提交
335 336
/*
 * Halt HC, turn off all ports, and let the BIOS use the companion controllers.
A
Alan Stern 已提交
337
 * Must be called with interrupts enabled and the lock not held.
338
 */
S
Sarah Sharp 已提交
339
static void ehci_silence_controller(struct ehci_hcd *ehci)
L
Linus Torvalds 已提交
340
{
S
Sarah Sharp 已提交
341
	ehci_halt(ehci);
A
Alan Stern 已提交
342 343 344

	spin_lock_irq(&ehci->lock);
	ehci->rh_state = EHCI_RH_HALTED;
345
	ehci_turn_off_all_ports(ehci);
L
Linus Torvalds 已提交
346 347

	/* make BIOS/etc use companion controller during reboot */
348
	ehci_writel(ehci, 0, &ehci->regs->configured_flag);
349 350 351

	/* unblock posted writes */
	ehci_readl(ehci, &ehci->regs->configured_flag);
A
Alan Stern 已提交
352
	spin_unlock_irq(&ehci->lock);
L
Linus Torvalds 已提交
353 354
}

S
Sarah Sharp 已提交
355 356 357 358 359 360 361 362 363
/* ehci_shutdown kick in for silicon on any bus (not just pci, etc).
 * This forcibly disables dma and IRQs, helping kexec and other cases
 * where the next system software may expect clean state.
 */
static void ehci_shutdown(struct usb_hcd *hcd)
{
	struct ehci_hcd	*ehci = hcd_to_ehci(hcd);

	spin_lock_irq(&ehci->lock);
364
	ehci->shutdown = true;
365
	ehci->rh_state = EHCI_RH_STOPPING;
A
Alan Stern 已提交
366
	ehci->enabled_hrtimer_events = 0;
S
Sarah Sharp 已提交
367
	spin_unlock_irq(&ehci->lock);
A
Alan Stern 已提交
368

A
Alan Stern 已提交
369 370
	ehci_silence_controller(ehci);

A
Alan Stern 已提交
371
	hrtimer_cancel(&ehci->hrtimer);
S
Sarah Sharp 已提交
372 373
}

M
Matt Porter 已提交
374
/*-------------------------------------------------------------------------*/
L
Linus Torvalds 已提交
375

M
Matt Porter 已提交
376 377 378 379
/*
 * ehci_work is called from some interrupts, timers, and so on.
 * it calls driver completion functions, after dropping ehci->lock.
 */
380
static void ehci_work (struct ehci_hcd *ehci)
M
Matt Porter 已提交
381 382 383 384 385
{
	/* another CPU may drop ehci->lock during a schedule scan while
	 * it reports urb completions.  this flag guards against bogus
	 * attempts at re-entrant schedule scanning.
	 */
386 387
	if (ehci->scanning) {
		ehci->need_rescan = true;
M
Matt Porter 已提交
388
		return;
389 390 391 392 393
	}
	ehci->scanning = true;

 rescan:
	ehci->need_rescan = false;
394 395
	if (ehci->async_count)
		scan_async(ehci);
396 397 398 399
	if (ehci->intr_count > 0)
		scan_intr(ehci);
	if (ehci->isoc_count > 0)
		scan_isoc(ehci);
400 401 402
	if (ehci->need_rescan)
		goto rescan;
	ehci->scanning = false;
M
Matt Porter 已提交
403 404 405 406 407

	/* the IO watchdog guards against hardware or driver bugs that
	 * misplace IRQs, and should let us run completely without IRQs.
	 * such lossage has been observed on both VT6202 and VT8235.
	 */
408
	turn_on_io_watchdog(ehci);
M
Matt Porter 已提交
409
}
L
Linus Torvalds 已提交
410

S
Sarah Sharp 已提交
411 412 413
/*
 * Called when the ehci_hcd module is removed.
 */
M
Matt Porter 已提交
414
static void ehci_stop (struct usb_hcd *hcd)
L
Linus Torvalds 已提交
415 416 417
{
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);

M
Matt Porter 已提交
418
	ehci_dbg (ehci, "stop\n");
L
Linus Torvalds 已提交
419

M
Matt Porter 已提交
420
	/* no more interrupts ... */
D
David Brownell 已提交
421

M
Matt Porter 已提交
422
	spin_lock_irq(&ehci->lock);
A
Alan Stern 已提交
423
	ehci->enabled_hrtimer_events = 0;
A
Alan Stern 已提交
424
	spin_unlock_irq(&ehci->lock);
L
Linus Torvalds 已提交
425

A
Alan Stern 已提交
426
	ehci_quiesce(ehci);
S
Sarah Sharp 已提交
427
	ehci_silence_controller(ehci);
M
Matt Porter 已提交
428
	ehci_reset (ehci);
L
Linus Torvalds 已提交
429

A
Alan Stern 已提交
430
	hrtimer_cancel(&ehci->hrtimer);
431
	remove_sysfs_files(ehci);
M
Matt Porter 已提交
432
	remove_debug_files (ehci);
L
Linus Torvalds 已提交
433

M
Matt Porter 已提交
434 435
	/* root hub is shut down separately (first, when possible) */
	spin_lock_irq (&ehci->lock);
436
	end_free_itds(ehci);
M
Matt Porter 已提交
437 438
	spin_unlock_irq (&ehci->lock);
	ehci_mem_cleanup (ehci);
L
Linus Torvalds 已提交
439

440 441
	if (ehci->amd_pll_fix == 1)
		usb_amd_dev_put();
442

M
Matt Porter 已提交
443
#ifdef	EHCI_STATS
A
Alan Stern 已提交
444 445
	ehci_dbg(ehci, "irq normal %ld err %ld iaa %ld (lost %ld)\n",
		ehci->stats.normal, ehci->stats.error, ehci->stats.iaa,
M
Matt Porter 已提交
446 447 448
		ehci->stats.lost_iaa);
	ehci_dbg (ehci, "complete %ld unlink %ld\n",
		ehci->stats.complete, ehci->stats.unlink);
L
Linus Torvalds 已提交
449 450
#endif

451 452
	dbg_status (ehci, "ehci_stop completed",
		    ehci_readl(ehci, &ehci->regs->status));
L
Linus Torvalds 已提交
453 454
}

455 456
/* one-time init, only for memory state */
static int ehci_init(struct usb_hcd *hcd)
L
Linus Torvalds 已提交
457
{
458
	struct ehci_hcd		*ehci = hcd_to_ehci(hcd);
L
Linus Torvalds 已提交
459 460 461
	u32			temp;
	int			retval;
	u32			hcc_params;
462
	struct ehci_qh_hw	*hw;
463 464 465

	spin_lock_init(&ehci->lock);

466 467 468 469
	/*
	 * keep io watchdog by default, those good HCDs could turn off it later
	 */
	ehci->need_io_watchdog = 1;
L
Linus Torvalds 已提交
470

A
Alan Stern 已提交
471 472 473
	hrtimer_init(&ehci->hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
	ehci->hrtimer.function = ehci_hrtimer_func;
	ehci->next_hrtimer_event = EHCI_HRTIMER_NO_EVENT;
474

A
Alan Stern 已提交
475 476
	hcc_params = ehci_readl(ehci, &ehci->caps->hcc_params);

477 478 479 480 481 482
	/*
	 * by default set standard 80% (== 100 usec/uframe) max periodic
	 * bandwidth as required by USB 2.0
	 */
	ehci->uframe_periodic_max = 100;

L
Linus Torvalds 已提交
483 484 485 486 487
	/*
	 * hw default: 1K periodic list heads, one per frame.
	 * periodic_size can shrink by USBCMD update if hcc_params allows.
	 */
	ehci->periodic_size = DEFAULT_I_TDPS;
488
	INIT_LIST_HEAD(&ehci->intr_qh_list);
K
Karsten Wiese 已提交
489
	INIT_LIST_HEAD(&ehci->cached_itd_list);
490
	INIT_LIST_HEAD(&ehci->cached_sitd_list);
A
Alan Stern 已提交
491

492
	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
A
Alan Stern 已提交
493 494 495 496 497 498 499 500
		/* periodic schedule size can be smaller than default */
		switch (EHCI_TUNE_FLS) {
		case 0: ehci->periodic_size = 1024; break;
		case 1: ehci->periodic_size = 512; break;
		case 2: ehci->periodic_size = 256; break;
		default:	BUG();
		}
	}
501
	if ((retval = ehci_mem_init(ehci, GFP_KERNEL)) < 0)
L
Linus Torvalds 已提交
502 503 504
		return retval;

	/* controllers may cache some of the periodic schedule ... */
505
	if (HCC_ISOC_CACHE(hcc_params))		// full frame cache
506
		ehci->i_thresh = 0;
L
Linus Torvalds 已提交
507
	else					// N microframes cached
508
		ehci->i_thresh = 2 + HCC_ISOC_THRES(hcc_params);
L
Linus Torvalds 已提交
509 510 511 512 513 514 515 516

	/*
	 * dedicate a qh for the async ring head, since we couldn't unlink
	 * a 'real' qh without stopping the async schedule [4.8].  use it
	 * as the 'reclamation list head' too.
	 * its dummy is used in hw_alt_next of many tds, to prevent the qh
	 * from automatically advancing to the next td after short reads.
	 */
517
	ehci->async->qh_next.qh = NULL;
518 519 520
	hw = ehci->async->hw;
	hw->hw_next = QH_NEXT(ehci, ehci->async->qh_dma);
	hw->hw_info1 = cpu_to_hc32(ehci, QH_HEAD);
R
Ricardo Martins 已提交
521
#if defined(CONFIG_PPC_PS3)
522
	hw->hw_info1 |= cpu_to_hc32(ehci, QH_INACTIVATE);
R
Ricardo Martins 已提交
523
#endif
524 525
	hw->hw_token = cpu_to_hc32(ehci, QTD_STS_HALT);
	hw->hw_qtd_next = EHCI_LIST_END(ehci);
526
	ehci->async->qh_state = QH_STATE_LINKED;
527
	hw->hw_alt_next = QTD_NEXT(ehci, ehci->async->dummy->qtd_dma);
L
Linus Torvalds 已提交
528 529 530 531 532

	/* clear interrupt enables, set irq latency */
	if (log2_irq_thresh < 0 || log2_irq_thresh > 6)
		log2_irq_thresh = 0;
	temp = 1 << (16 + log2_irq_thresh);
533 534 535 536 537
	if (HCC_PER_PORT_CHANGE_EVENT(hcc_params)) {
		ehci->has_ppcd = 1;
		ehci_dbg(ehci, "enable per-port change event\n");
		temp |= CMD_PPCEE;
	}
L
Linus Torvalds 已提交
538 539 540 541 542 543 544 545 546
	if (HCC_CANPARK(hcc_params)) {
		/* HW default park == 3, on hardware that supports it (like
		 * NVidia and ALI silicon), maximizes throughput on the async
		 * schedule by avoiding QH fetches between transfers.
		 *
		 * With fast usb storage devices and NForce2, "park" seems to
		 * make problems:  throughput reduction (!), data errors...
		 */
		if (park) {
547
			park = min(park, (unsigned) 3);
L
Linus Torvalds 已提交
548 549 550
			temp |= CMD_PARK;
			temp |= park << 8;
		}
551
		ehci_dbg(ehci, "park %d\n", park);
L
Linus Torvalds 已提交
552
	}
553
	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
L
Linus Torvalds 已提交
554 555 556 557
		/* periodic schedule size can be smaller than default */
		temp &= ~(3 << 2);
		temp |= (EHCI_TUNE_FLS << 2);
	}
558 559
	ehci->command = temp;

560
	/* Accept arbitrarily long scatter-gather lists */
561 562
	if (!(hcd->driver->flags & HCD_LOCAL_MEM))
		hcd->self.sg_tablesize = ~0;
563 564 565 566 567 568 569 570 571 572
	return 0;
}

/* start HC running; it's halted, ehci_init() has been run (once) */
static int ehci_run (struct usb_hcd *hcd)
{
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);
	u32			temp;
	u32			hcc_params;

573 574
	hcd->uses_new_polling = 1;

575
	/* EHCI spec section 4.1 */
576

577 578
	ehci_writel(ehci, ehci->periodic_dma, &ehci->regs->frame_list);
	ehci_writel(ehci, (u32)ehci->async->qh_dma, &ehci->regs->async_next);
579 580 581 582 583 584 585 586 587 588 589 590 591

	/*
	 * hcc_params controls whether ehci->regs->segment must (!!!)
	 * be used; it constrains QH/ITD/SITD and QTD locations.
	 * pci_pool consistent memory always uses segment zero.
	 * streaming mappings for I/O buffers, like pci_map_single(),
	 * can return segments above 4GB, if the device allows.
	 *
	 * NOTE:  the dma mask is visible through dma_supported(), so
	 * drivers can pass this info along ... like NETIF_F_HIGHDMA,
	 * Scsi_Host.highmem_io, and so forth.  It's readonly to all
	 * host side drivers though.
	 */
592
	hcc_params = ehci_readl(ehci, &ehci->caps->hcc_params);
593
	if (HCC_64BIT_ADDR(hcc_params)) {
594
		ehci_writel(ehci, 0, &ehci->regs->segment);
595 596
#if 0
// this is deeply broken on almost all architectures
597
		if (!dma_set_mask(hcd->self.controller, DMA_BIT_MASK(64)))
598 599 600 601 602
			ehci_info(ehci, "enabled 64bit DMA\n");
#endif
	}


L
Linus Torvalds 已提交
603 604
	// Philips, Intel, and maybe others need CMD_RUN before the
	// root hub will detect new devices (why?); NEC doesn't
605 606
	ehci->command &= ~(CMD_LRESET|CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET);
	ehci->command |= CMD_RUN;
607
	ehci_writel(ehci, ehci->command, &ehci->regs->command);
608
	dbg_cmd (ehci, "init", ehci->command);
L
Linus Torvalds 已提交
609 610 611 612 613 614

	/*
	 * Start, enabling full USB 2.0 functionality ... usb 1.1 devices
	 * are explicitly handed to companion controller(s), so no TT is
	 * involved with the root hub.  (Except where one is integrated,
	 * and there's no companion controller unless maybe for USB OTG.)
615 616 617 618 619
	 *
	 * Turning on the CF flag will transfer ownership of all ports
	 * from the companions to the EHCI controller.  If any of the
	 * companions are in the middle of a port reset at the time, it
	 * could cause trouble.  Write-locking ehci_cf_port_reset_rwsem
620 621 622
	 * guarantees that no resets are in progress.  After we set CF,
	 * a short delay lets the hardware catch up; new resets shouldn't
	 * be started before the port switching actions could complete.
L
Linus Torvalds 已提交
623
	 */
624
	down_write(&ehci_cf_port_reset_rwsem);
625
	ehci->rh_state = EHCI_RH_RUNNING;
626 627
	ehci_writel(ehci, FLAG_CF, &ehci->regs->configured_flag);
	ehci_readl(ehci, &ehci->regs->command);	/* unblock posted writes */
628
	msleep(5);
629
	up_write(&ehci_cf_port_reset_rwsem);
630
	ehci->last_periodic_enable = ktime_get_real();
L
Linus Torvalds 已提交
631

632
	temp = HC_VERSION(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase));
L
Linus Torvalds 已提交
633
	ehci_info (ehci,
634
		"USB %x.%x started, EHCI %x.%02x%s\n",
M
Matt Porter 已提交
635
		((ehci->sbrn & 0xf0)>>4), (ehci->sbrn & 0x0f),
636
		temp >> 8, temp & 0xff,
637
		ignore_oc ? ", overcurrent ignored" : "");
L
Linus Torvalds 已提交
638

639 640
	ehci_writel(ehci, INTR_MASK,
		    &ehci->regs->intr_enable); /* Turn On Interrupts */
L
Linus Torvalds 已提交
641

642 643 644 645 646
	/* GRR this is run-once init(), being done every time the HC starts.
	 * So long as they're part of class devices, we can't do it init()
	 * since the class device isn't created that early.
	 */
	create_debug_files(ehci);
647
	create_sysfs_files(ehci);
L
Linus Torvalds 已提交
648 649 650 651

	return 0;
}

652
static int ehci_setup(struct usb_hcd *hcd)
653 654 655 656 657 658 659 660 661 662 663 664 665 666
{
	struct ehci_hcd *ehci = hcd_to_ehci(hcd);
	int retval;

	ehci->regs = (void __iomem *)ehci->caps +
	    HC_LENGTH(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase));
	dbg_hcs_params(ehci, "reset");
	dbg_hcc_params(ehci, "reset");

	/* cache this readonly data; minimize chip reads */
	ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);

	ehci->sbrn = HCD_USB2;

667 668
	/* data structure init */
	retval = ehci_init(hcd);
669 670 671
	if (retval)
		return retval;

672
	retval = ehci_halt(ehci);
673 674 675
	if (retval)
		return retval;

676 677 678
	if (ehci_is_TDI(ehci))
		tdi_reset(ehci);

679 680 681 682 683
	ehci_reset(ehci);

	return 0;
}

L
Linus Torvalds 已提交
684 685
/*-------------------------------------------------------------------------*/

686
static irqreturn_t ehci_irq (struct usb_hcd *hcd)
L
Linus Torvalds 已提交
687 688
{
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);
689
	u32			status, masked_status, pcd_status = 0, cmd;
L
Linus Torvalds 已提交
690 691 692 693
	int			bh;

	spin_lock (&ehci->lock);

694
	status = ehci_readl(ehci, &ehci->regs->status);
L
Linus Torvalds 已提交
695 696 697 698 699 700 701

	/* e.g. cardbus physical eject */
	if (status == ~(u32) 0) {
		ehci_dbg (ehci, "device removed\n");
		goto dead;
	}

702 703 704 705 706 707
	/*
	 * We don't use STS_FLR, but some controllers don't like it to
	 * remain on, so mask it out along with the other status bits.
	 */
	masked_status = status & (INTR_MASK | STS_FLR);

708
	/* Shared IRQ? */
709
	if (!masked_status || unlikely(ehci->rh_state == EHCI_RH_HALTED)) {
L
Linus Torvalds 已提交
710 711 712 713 714
		spin_unlock(&ehci->lock);
		return IRQ_NONE;
	}

	/* clear (just) interrupts */
715
	ehci_writel(ehci, masked_status, &ehci->regs->status);
716
	cmd = ehci_readl(ehci, &ehci->regs->command);
L
Linus Torvalds 已提交
717 718
	bh = 0;

D
David Brownell 已提交
719
#ifdef	VERBOSE_DEBUG
L
Linus Torvalds 已提交
720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736
	/* unrequested/ignored: Frame List Rollover */
	dbg_status (ehci, "irq", status);
#endif

	/* INT, ERR, and IAA interrupt rates can be throttled */

	/* normal [4.15.1.2] or error [4.15.1.1] completion */
	if (likely ((status & (STS_INT|STS_ERR)) != 0)) {
		if (likely ((status & STS_ERR) == 0))
			COUNT (ehci->stats.normal);
		else
			COUNT (ehci->stats.error);
		bh = 1;
	}

	/* complete the unlinking of some qh [4.15.2.3] */
	if (status & STS_IAA) {
737 738 739 740 741 742 743 744 745 746 747 748 749 750

		/* Turn off the IAA watchdog */
		ehci->enabled_hrtimer_events &= ~BIT(EHCI_HRTIMER_IAA_WATCHDOG);

		/*
		 * Mild optimization: Allow another IAAD to reset the
		 * hrtimer, if one occurs before the next expiration.
		 * In theory we could always cancel the hrtimer, but
		 * tests show that about half the time it will be reset
		 * for some other event anyway.
		 */
		if (ehci->next_hrtimer_event == EHCI_HRTIMER_IAA_WATCHDOG)
			++ehci->next_hrtimer_event;

751
		/* guard against (alleged) silicon errata */
752
		if (cmd & CMD_IAAD)
753
			ehci_dbg(ehci, "IAA with IAAD still set?\n");
754
		if (ehci->async_iaa) {
A
Alan Stern 已提交
755
			COUNT(ehci->stats.iaa);
756 757
			end_unlink_async(ehci);
		} else
A
Alan Stern 已提交
758
			ehci_dbg(ehci, "IAA with nothing unlinked?\n");
L
Linus Torvalds 已提交
759 760 761
	}

	/* remote wakeup [4.3.1] */
762
	if (status & STS_PCD) {
L
Linus Torvalds 已提交
763
		unsigned	i = HCS_N_PORTS (ehci->hcs_params);
764
		u32		ppcd = 0;
765 766

		/* kick root hub later */
767
		pcd_status = status;
L
Linus Torvalds 已提交
768 769

		/* resume root hub? */
770
		if (ehci->rh_state == EHCI_RH_SUSPENDED)
771
			usb_hcd_resume_root_hub(hcd);
L
Linus Torvalds 已提交
772

773 774 775 776
		/* get per-port change detect bits */
		if (ehci->has_ppcd)
			ppcd = status >> 16;

L
Linus Torvalds 已提交
777
		while (i--) {
778 779 780 781 782 783 784
			int pstatus;

			/* leverage per-port change bits feature */
			if (ehci->has_ppcd && !(ppcd & (1 << i)))
				continue;
			pstatus = ehci_readl(ehci,
					 &ehci->regs->port_status[i]);
785 786

			if (pstatus & PORT_OWNER)
L
Linus Torvalds 已提交
787
				continue;
788 789 790 791 792
			if (!(test_bit(i, &ehci->suspended_ports) &&
					((pstatus & PORT_RESUME) ||
						!(pstatus & PORT_SUSPEND)) &&
					(pstatus & PORT_PE) &&
					ehci->reset_done[i] == 0))
L
Linus Torvalds 已提交
793 794 795 796
				continue;

			/* start 20 msec resume signaling from this port,
			 * and make khubd collect PORT_STAT_C_SUSPEND to
797 798
			 * stop that signaling.  Use 5 ms extra for safety,
			 * like usb_port_resume() does.
L
Linus Torvalds 已提交
799
			 */
800
			ehci->reset_done[i] = jiffies + msecs_to_jiffies(25);
801
			set_bit(i, &ehci->resuming_ports);
L
Linus Torvalds 已提交
802
			ehci_dbg (ehci, "port %d remote wakeup\n", i + 1);
803
			mod_timer(&hcd->rh_timer, ehci->reset_done[i]);
L
Linus Torvalds 已提交
804 805 806 807 808
		}
	}

	/* PCI errors [4.15.2.4] */
	if (unlikely ((status & STS_FATAL) != 0)) {
809
		ehci_err(ehci, "fatal error\n");
810 811
		dbg_cmd(ehci, "fatal", cmd);
		dbg_status(ehci, "fatal", status);
L
Linus Torvalds 已提交
812
dead:
813
		usb_hc_died(hcd);
814 815

		/* Don't let the controller do anything more */
816
		ehci->shutdown = true;
817 818 819 820 821 822 823 824
		ehci->rh_state = EHCI_RH_STOPPING;
		ehci->command &= ~(CMD_RUN | CMD_ASE | CMD_PSE);
		ehci_writel(ehci, ehci->command, &ehci->regs->command);
		ehci_writel(ehci, 0, &ehci->regs->intr_enable);
		ehci_handle_controller_death(ehci);

		/* Handle completions when the controller stops */
		bh = 0;
L
Linus Torvalds 已提交
825 826 827
	}

	if (bh)
828
		ehci_work (ehci);
L
Linus Torvalds 已提交
829
	spin_unlock (&ehci->lock);
830
	if (pcd_status)
831
		usb_hcd_poll_rh_status(hcd);
L
Linus Torvalds 已提交
832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851
	return IRQ_HANDLED;
}

/*-------------------------------------------------------------------------*/

/*
 * non-error returns are a promise to giveback() the urb later
 * we drop ownership so next owner (or urb unlink) can get it
 *
 * urb + dev is in hcd.self.controller.urb_list
 * we're queueing TDs onto software and hardware lists
 *
 * hcd-specific init for hcpriv hasn't been done yet
 *
 * NOTE:  control, bulk, and interrupt share the same code to append TDs
 * to a (possibly active) QH, and the same QH scanning code.
 */
static int ehci_urb_enqueue (
	struct usb_hcd	*hcd,
	struct urb	*urb,
A
Al Viro 已提交
852
	gfp_t		mem_flags
L
Linus Torvalds 已提交
853 854 855 856 857 858 859
) {
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);
	struct list_head	qtd_list;

	INIT_LIST_HEAD (&qtd_list);

	switch (usb_pipetype (urb->pipe)) {
860 861 862 863 864 865 866 867
	case PIPE_CONTROL:
		/* qh_completions() code doesn't handle all the fault cases
		 * in multi-TD control transfers.  Even 1KB is rare anyway.
		 */
		if (urb->transfer_buffer_length > (16 * 1024))
			return -EMSGSIZE;
		/* FALLTHROUGH */
	/* case PIPE_BULK: */
L
Linus Torvalds 已提交
868 869 870
	default:
		if (!qh_urb_transaction (ehci, urb, &qtd_list, mem_flags))
			return -ENOMEM;
871
		return submit_async(ehci, urb, &qtd_list, mem_flags);
L
Linus Torvalds 已提交
872 873 874 875

	case PIPE_INTERRUPT:
		if (!qh_urb_transaction (ehci, urb, &qtd_list, mem_flags))
			return -ENOMEM;
876
		return intr_submit(ehci, urb, &qtd_list, mem_flags);
L
Linus Torvalds 已提交
877 878 879 880 881 882 883 884 885 886 887 888 889

	case PIPE_ISOCHRONOUS:
		if (urb->dev->speed == USB_SPEED_HIGH)
			return itd_submit (ehci, urb, mem_flags);
		else
			return sitd_submit (ehci, urb, mem_flags);
	}
}

/* remove from hardware lists
 * completions normally happen asynchronously
 */

890
static int ehci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
L
Linus Torvalds 已提交
891 892 893 894
{
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);
	struct ehci_qh		*qh;
	unsigned long		flags;
895
	int			rc;
L
Linus Torvalds 已提交
896 897

	spin_lock_irqsave (&ehci->lock, flags);
898 899 900 901
	rc = usb_hcd_check_unlink_urb(hcd, urb, status);
	if (rc)
		goto done;

L
Linus Torvalds 已提交
902 903 904 905 906 907 908
	switch (usb_pipetype (urb->pipe)) {
	// case PIPE_CONTROL:
	// case PIPE_BULK:
	default:
		qh = (struct ehci_qh *) urb->hcpriv;
		if (!qh)
			break;
909 910 911
		switch (qh->qh_state) {
		case QH_STATE_LINKED:
		case QH_STATE_COMPLETING:
912
			start_unlink_async(ehci, qh);
913 914 915 916 917 918
			break;
		case QH_STATE_UNLINK:
		case QH_STATE_UNLINK_WAIT:
			/* already started */
			break;
		case QH_STATE_IDLE:
919 920
			/* QH might be waiting for a Clear-TT-Buffer */
			qh_completions(ehci, qh);
921 922
			break;
		}
L
Linus Torvalds 已提交
923 924 925 926 927 928 929 930
		break;

	case PIPE_INTERRUPT:
		qh = (struct ehci_qh *) urb->hcpriv;
		if (!qh)
			break;
		switch (qh->qh_state) {
		case QH_STATE_LINKED:
931
		case QH_STATE_COMPLETING:
932
			start_unlink_intr(ehci, qh);
933
			break;
L
Linus Torvalds 已提交
934
		case QH_STATE_IDLE:
935
			qh_completions (ehci, qh);
L
Linus Torvalds 已提交
936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952
			break;
		default:
			ehci_dbg (ehci, "bogus qh %p state %d\n",
					qh, qh->qh_state);
			goto done;
		}
		break;

	case PIPE_ISOCHRONOUS:
		// itd or sitd ...

		// wait till next completion, do it then.
		// completion irqs can wait up to 1024 msec,
		break;
	}
done:
	spin_unlock_irqrestore (&ehci->lock, flags);
953
	return rc;
L
Linus Torvalds 已提交
954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978
}

/*-------------------------------------------------------------------------*/

// bulk qh holds the data toggle

static void
ehci_endpoint_disable (struct usb_hcd *hcd, struct usb_host_endpoint *ep)
{
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);
	unsigned long		flags;
	struct ehci_qh		*qh, *tmp;

	/* ASSERT:  any requests/urbs are being unlinked */
	/* ASSERT:  nobody can be submitting urbs for this any more */

rescan:
	spin_lock_irqsave (&ehci->lock, flags);
	qh = ep->hcpriv;
	if (!qh)
		goto done;

	/* endpoints can be iso streams.  for now, we don't
	 * accelerate iso completions ... so spin a while.
	 */
979
	if (qh->hw == NULL) {
980 981 982 983 984 985 986 987
		struct ehci_iso_stream	*stream = ep->hcpriv;

		if (!list_empty(&stream->td_list))
			goto idle_timeout;

		/* BUG_ON(!list_empty(&stream->free_list)); */
		kfree(stream);
		goto done;
L
Linus Torvalds 已提交
988 989
	}

990
	if (ehci->rh_state < EHCI_RH_RUNNING)
L
Linus Torvalds 已提交
991 992 993
		qh->qh_state = QH_STATE_IDLE;
	switch (qh->qh_state) {
	case QH_STATE_LINKED:
994
	case QH_STATE_COMPLETING:
L
Linus Torvalds 已提交
995 996 997 998
		for (tmp = ehci->async->qh_next.qh;
				tmp && tmp != qh;
				tmp = tmp->qh_next.qh)
			continue;
999 1000 1001 1002
		/* periodic qh self-unlinks on empty, and a COMPLETING qh
		 * may already be unlinked.
		 */
		if (tmp)
1003
			start_unlink_async(ehci, qh);
L
Linus Torvalds 已提交
1004 1005
		/* FALL THROUGH */
	case QH_STATE_UNLINK:		/* wait for hw to finish? */
1006
	case QH_STATE_UNLINK_WAIT:
L
Linus Torvalds 已提交
1007 1008
idle_timeout:
		spin_unlock_irqrestore (&ehci->lock, flags);
1009
		schedule_timeout_uninterruptible(1);
L
Linus Torvalds 已提交
1010 1011
		goto rescan;
	case QH_STATE_IDLE:		/* fully unlinked */
1012 1013
		if (qh->clearing_tt)
			goto idle_timeout;
L
Linus Torvalds 已提交
1014
		if (list_empty (&qh->qtd_list)) {
A
Alan Stern 已提交
1015
			qh_destroy(ehci, qh);
L
Linus Torvalds 已提交
1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
			break;
		}
		/* else FALL THROUGH */
	default:
		/* caller was supposed to have unlinked any requests;
		 * that's not our job.  just leak this memory.
		 */
		ehci_err (ehci, "qh %p (#%02x) state %d%s\n",
			qh, ep->desc.bEndpointAddress, qh->qh_state,
			list_empty (&qh->qtd_list) ? "" : "(has tds)");
		break;
	}
1028
 done:
L
Linus Torvalds 已提交
1029 1030 1031 1032
	ep->hcpriv = NULL;
	spin_unlock_irqrestore (&ehci->lock, flags);
}

1033 1034 1035 1036 1037 1038
static void
ehci_endpoint_reset(struct usb_hcd *hcd, struct usb_host_endpoint *ep)
{
	struct ehci_hcd		*ehci = hcd_to_ehci(hcd);
	struct ehci_qh		*qh;
	int			eptype = usb_endpoint_type(&ep->desc);
1039 1040 1041
	int			epnum = usb_endpoint_num(&ep->desc);
	int			is_out = usb_endpoint_dir_out(&ep->desc);
	unsigned long		flags;
1042 1043 1044 1045

	if (eptype != USB_ENDPOINT_XFER_BULK && eptype != USB_ENDPOINT_XFER_INT)
		return;

1046
	spin_lock_irqsave(&ehci->lock, flags);
1047 1048 1049 1050 1051 1052 1053 1054
	qh = ep->hcpriv;

	/* For Bulk and Interrupt endpoints we maintain the toggle state
	 * in the hardware; the toggle bits in udev aren't used at all.
	 * When an endpoint is reset by usb_clear_halt() we must reset
	 * the toggle bit in the QH.
	 */
	if (qh) {
1055
		usb_settoggle(qh->dev, epnum, is_out, 0);
1056 1057
		if (!list_empty(&qh->qtd_list)) {
			WARN_ONCE(1, "clear_halt for a busy endpoint\n");
1058 1059
		} else if (qh->qh_state == QH_STATE_LINKED ||
				qh->qh_state == QH_STATE_COMPLETING) {
1060 1061 1062 1063

			/* The toggle value in the QH can't be updated
			 * while the QH is active.  Unlink it now;
			 * re-linking will call qh_refresh().
1064
			 */
1065
			if (eptype == USB_ENDPOINT_XFER_BULK)
1066
				start_unlink_async(ehci, qh);
1067
			else
1068
				start_unlink_intr(ehci, qh);
1069 1070
		}
	}
1071
	spin_unlock_irqrestore(&ehci->lock, flags);
1072 1073
}

M
Matt Porter 已提交
1074 1075 1076
static int ehci_get_frame (struct usb_hcd *hcd)
{
	struct ehci_hcd		*ehci = hcd_to_ehci (hcd);
1077
	return (ehci_read_frame_index(ehci) >> 3) % ehci->periodic_size;
M
Matt Porter 已提交
1078
}
L
Linus Torvalds 已提交
1079 1080

/*-------------------------------------------------------------------------*/
1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122

#ifdef	CONFIG_PM

/* suspend/resume, section 4.3 */

/* These routines handle the generic parts of controller suspend/resume */

static int __maybe_unused ehci_suspend(struct usb_hcd *hcd, bool do_wakeup)
{
	struct ehci_hcd		*ehci = hcd_to_ehci(hcd);

	if (time_before(jiffies, ehci->next_statechange))
		msleep(10);

	/*
	 * Root hub was already suspended.  Disable IRQ emission and
	 * mark HW unaccessible.  The PM and USB cores make sure that
	 * the root hub is either suspended or stopped.
	 */
	ehci_prepare_ports_for_controller_suspend(ehci, do_wakeup);

	spin_lock_irq(&ehci->lock);
	ehci_writel(ehci, 0, &ehci->regs->intr_enable);
	(void) ehci_readl(ehci, &ehci->regs->intr_enable);

	clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
	spin_unlock_irq(&ehci->lock);

	return 0;
}

/* Returns 0 if power was preserved, 1 if power was lost */
static int __maybe_unused ehci_resume(struct usb_hcd *hcd, bool hibernated)
{
	struct ehci_hcd		*ehci = hcd_to_ehci(hcd);

	if (time_before(jiffies, ehci->next_statechange))
		msleep(100);

	/* Mark hardware accessible again as we are back to full power by now */
	set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);

1123 1124 1125
	if (ehci->shutdown)
		return 0;		/* Controller is dead */

1126 1127 1128 1129 1130 1131 1132 1133 1134 1135
	/*
	 * If CF is still set and we aren't resuming from hibernation
	 * then we maintained suspend power.
	 * Just undo the effect of ehci_suspend().
	 */
	if (ehci_readl(ehci, &ehci->regs->configured_flag) == FLAG_CF &&
			!hibernated) {
		int	mask = INTR_MASK;

		ehci_prepare_ports_for_controller_resume(ehci);
1136 1137 1138 1139 1140

		spin_lock_irq(&ehci->lock);
		if (ehci->shutdown)
			goto skip;

1141 1142 1143 1144
		if (!hcd->self.root_hub->do_remote_wakeup)
			mask &= ~STS_PCD;
		ehci_writel(ehci, mask, &ehci->regs->intr_enable);
		ehci_readl(ehci, &ehci->regs->intr_enable);
1145 1146
 skip:
		spin_unlock_irq(&ehci->lock);
1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157
		return 0;
	}

	/*
	 * Else reset, to cope with power loss or resume from hibernation
	 * having let the firmware kick in during reboot.
	 */
	usb_root_hub_lost_power(hcd->self.root_hub);
	(void) ehci_halt(ehci);
	(void) ehci_reset(ehci);

1158 1159 1160 1161
	spin_lock_irq(&ehci->lock);
	if (ehci->shutdown)
		goto skip;

1162 1163 1164 1165
	ehci_writel(ehci, ehci->command, &ehci->regs->command);
	ehci_writel(ehci, FLAG_CF, &ehci->regs->configured_flag);
	ehci_readl(ehci, &ehci->regs->command);	/* unblock posted writes */

1166 1167 1168
	ehci->rh_state = EHCI_RH_SUSPENDED;
	spin_unlock_irq(&ehci->lock);

1169 1170 1171 1172 1173 1174 1175
	return 1;
}

#endif

/*-------------------------------------------------------------------------*/

1176 1177 1178 1179 1180 1181 1182
/*
 * The EHCI in ChipIdea HDRC cannot be a separate module or device,
 * because its registers (and irq) are shared between host/gadget/otg
 * functions  and in order to facilitate role switching we cannot
 * give the ehci driver exclusive access to those.
 */
#ifndef CHIPIDEA_EHCI
L
Linus Torvalds 已提交
1183

1184
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
1185 1186 1187
MODULE_AUTHOR (DRIVER_AUTHOR);
MODULE_LICENSE ("GPL");

M
Matt Porter 已提交
1188 1189
#ifdef CONFIG_PCI
#include "ehci-pci.c"
1190
#define	PCI_DRIVER		ehci_pci_driver
M
Matt Porter 已提交
1191
#endif
L
Linus Torvalds 已提交
1192

1193
#ifdef CONFIG_USB_EHCI_FSL
1194
#include "ehci-fsl.c"
1195
#define	PLATFORM_DRIVER		ehci_fsl_driver
1196 1197
#endif

1198 1199 1200 1201 1202
#ifdef CONFIG_USB_EHCI_MXC
#include "ehci-mxc.c"
#define PLATFORM_DRIVER		ehci_mxc_driver
#endif

1203
#ifdef CONFIG_USB_EHCI_SH
1204 1205 1206 1207
#include "ehci-sh.c"
#define PLATFORM_DRIVER		ehci_hcd_sh_driver
#endif

1208
#ifdef CONFIG_USB_EHCI_HCD_OMAP
1209 1210 1211 1212
#include "ehci-omap.c"
#define        PLATFORM_DRIVER         ehci_hcd_omap_driver
#endif

G
Geoff Levand 已提交
1213 1214
#ifdef CONFIG_PPC_PS3
#include "ehci-ps3.c"
G
Geoff Levand 已提交
1215
#define	PS3_SYSTEM_BUS_DRIVER	ps3_ehci_driver
G
Geoff Levand 已提交
1216 1217
#endif

1218 1219 1220 1221 1222
#ifdef CONFIG_USB_EHCI_HCD_PPC_OF
#include "ehci-ppc-of.c"
#define OF_PLATFORM_DRIVER	ehci_hcd_ppc_of_driver
#endif

1223 1224
#ifdef CONFIG_XPS_USB_HCD_XILINX
#include "ehci-xilinx-of.c"
1225
#define XILINX_OF_PLATFORM_DRIVER	ehci_hcd_xilinx_of_driver
1226 1227
#endif

1228
#ifdef CONFIG_PLAT_ORION
1229 1230 1231 1232
#include "ehci-orion.c"
#define	PLATFORM_DRIVER		ehci_orion_driver
#endif

1233 1234 1235 1236 1237
#ifdef CONFIG_USB_W90X900_EHCI
#include "ehci-w90x900.c"
#define	PLATFORM_DRIVER		ehci_hcd_w90x900_driver
#endif

1238 1239 1240 1241 1242
#ifdef CONFIG_ARCH_AT91
#include "ehci-atmel.c"
#define	PLATFORM_DRIVER		ehci_atmel_driver
#endif

1243 1244 1245 1246 1247
#ifdef CONFIG_USB_OCTEON_EHCI
#include "ehci-octeon.c"
#define PLATFORM_DRIVER		ehci_octeon_driver
#endif

1248 1249 1250 1251 1252
#ifdef CONFIG_ARCH_VT8500
#include "ehci-vt8500.c"
#define	PLATFORM_DRIVER		vt8500_ehci_driver
#endif

1253 1254 1255 1256 1257
#ifdef CONFIG_PLAT_SPEAR
#include "ehci-spear.c"
#define PLATFORM_DRIVER		spear_ehci_hcd_driver
#endif

1258 1259 1260 1261 1262
#ifdef CONFIG_USB_EHCI_MSM
#include "ehci-msm.c"
#define PLATFORM_DRIVER		ehci_msm_driver
#endif

1263 1264 1265 1266 1267
#ifdef CONFIG_TILE_USB
#include "ehci-tilegx.c"
#define	PLATFORM_DRIVER		ehci_hcd_tilegx_driver
#endif

1268 1269 1270 1271 1272
#ifdef CONFIG_USB_EHCI_HCD_PMC_MSP
#include "ehci-pmcmsp.c"
#define	PLATFORM_DRIVER		ehci_hcd_msp_driver
#endif

1273 1274 1275 1276 1277
#ifdef CONFIG_USB_EHCI_TEGRA
#include "ehci-tegra.c"
#define PLATFORM_DRIVER		tegra_ehci_driver
#endif

1278 1279 1280 1281 1282
#ifdef CONFIG_USB_EHCI_S5P
#include "ehci-s5p.c"
#define PLATFORM_DRIVER		s5p_ehci_driver
#endif

1283 1284 1285 1286 1287
#ifdef CONFIG_SPARC_LEON
#include "ehci-grlib.c"
#define PLATFORM_DRIVER		ehci_grlib_driver
#endif

1288 1289 1290 1291
#ifdef CONFIG_USB_EHCI_MV
#include "ehci-mv.c"
#define        PLATFORM_DRIVER         ehci_mv_driver
#endif
1292

1293 1294 1295 1296 1297
#ifdef CONFIG_MIPS_SEAD3
#include "ehci-sead3.c"
#define	PLATFORM_DRIVER		ehci_hcd_sead3_driver
#endif

1298 1299 1300 1301 1302
#ifdef CONFIG_USB_EHCI_HCD_PLATFORM
#include "ehci-platform.c"
#define PLATFORM_DRIVER		ehci_platform_driver
#endif

G
Geoff Levand 已提交
1303
#if !defined(PCI_DRIVER) && !defined(PLATFORM_DRIVER) && \
1304 1305
    !defined(PS3_SYSTEM_BUS_DRIVER) && !defined(OF_PLATFORM_DRIVER) && \
    !defined(XILINX_OF_PLATFORM_DRIVER)
M
Matt Porter 已提交
1306 1307
#error "missing bus glue for ehci-hcd"
#endif
1308 1309 1310 1311 1312

static int __init ehci_hcd_init(void)
{
	int retval = 0;

1313 1314 1315 1316
	if (usb_disabled())
		return -ENODEV;

	printk(KERN_INFO "%s: " DRIVER_DESC "\n", hcd_name);
1317 1318 1319 1320 1321 1322
	set_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
	if (test_bit(USB_UHCI_LOADED, &usb_hcds_loaded) ||
			test_bit(USB_OHCI_LOADED, &usb_hcds_loaded))
		printk(KERN_WARNING "Warning! ehci_hcd should always be loaded"
				" before uhci_hcd and ohci_hcd, not after\n");

1323 1324 1325 1326 1327
	pr_debug("%s: block sizes: qh %Zd qtd %Zd itd %Zd sitd %Zd\n",
		 hcd_name,
		 sizeof(struct ehci_qh), sizeof(struct ehci_qtd),
		 sizeof(struct ehci_itd), sizeof(struct ehci_sitd));

1328
#ifdef DEBUG
1329
	ehci_debug_root = debugfs_create_dir("ehci", usb_debug_root);
1330 1331 1332 1333
	if (!ehci_debug_root) {
		retval = -ENOENT;
		goto err_debug;
	}
1334 1335
#endif

1336 1337
#ifdef PLATFORM_DRIVER
	retval = platform_driver_register(&PLATFORM_DRIVER);
1338 1339
	if (retval < 0)
		goto clean0;
1340 1341 1342 1343
#endif

#ifdef PCI_DRIVER
	retval = pci_register_driver(&PCI_DRIVER);
1344 1345
	if (retval < 0)
		goto clean1;
G
Geoff Levand 已提交
1346 1347 1348
#endif

#ifdef PS3_SYSTEM_BUS_DRIVER
G
Geoff Levand 已提交
1349
	retval = ps3_ehci_driver_register(&PS3_SYSTEM_BUS_DRIVER);
1350 1351
	if (retval < 0)
		goto clean2;
1352
#endif
1353 1354

#ifdef OF_PLATFORM_DRIVER
1355
	retval = platform_driver_register(&OF_PLATFORM_DRIVER);
1356 1357 1358
	if (retval < 0)
		goto clean3;
#endif
1359 1360

#ifdef XILINX_OF_PLATFORM_DRIVER
1361
	retval = platform_driver_register(&XILINX_OF_PLATFORM_DRIVER);
1362 1363 1364
	if (retval < 0)
		goto clean4;
#endif
1365 1366
	return retval;

1367
#ifdef XILINX_OF_PLATFORM_DRIVER
1368
	/* platform_driver_unregister(&XILINX_OF_PLATFORM_DRIVER); */
1369 1370
clean4:
#endif
1371
#ifdef OF_PLATFORM_DRIVER
1372
	platform_driver_unregister(&OF_PLATFORM_DRIVER);
1373 1374 1375 1376 1377
clean3:
#endif
#ifdef PS3_SYSTEM_BUS_DRIVER
	ps3_ehci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER);
clean2:
G
Geoff Levand 已提交
1378 1379
#endif
#ifdef PCI_DRIVER
1380 1381
	pci_unregister_driver(&PCI_DRIVER);
clean1:
G
Geoff Levand 已提交
1382
#endif
1383 1384 1385 1386 1387 1388 1389
#ifdef PLATFORM_DRIVER
	platform_driver_unregister(&PLATFORM_DRIVER);
clean0:
#endif
#ifdef DEBUG
	debugfs_remove(ehci_debug_root);
	ehci_debug_root = NULL;
1390
err_debug:
1391
#endif
1392
	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
1393 1394 1395 1396 1397 1398
	return retval;
}
module_init(ehci_hcd_init);

static void __exit ehci_hcd_cleanup(void)
{
1399
#ifdef XILINX_OF_PLATFORM_DRIVER
1400
	platform_driver_unregister(&XILINX_OF_PLATFORM_DRIVER);
1401
#endif
1402
#ifdef OF_PLATFORM_DRIVER
1403
	platform_driver_unregister(&OF_PLATFORM_DRIVER);
1404
#endif
1405 1406 1407 1408 1409 1410
#ifdef PLATFORM_DRIVER
	platform_driver_unregister(&PLATFORM_DRIVER);
#endif
#ifdef PCI_DRIVER
	pci_unregister_driver(&PCI_DRIVER);
#endif
G
Geoff Levand 已提交
1411
#ifdef PS3_SYSTEM_BUS_DRIVER
G
Geoff Levand 已提交
1412
	ps3_ehci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER);
G
Geoff Levand 已提交
1413
#endif
1414 1415 1416
#ifdef DEBUG
	debugfs_remove(ehci_debug_root);
#endif
1417
	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
1418 1419 1420
}
module_exit(ehci_hcd_cleanup);

1421
#endif /* CHIPIDEA_EHCI */