ohci-hcd.c 33.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * OHCI HCD (Host Controller Driver) for USB.
 *
 * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
 * (C) Copyright 2000-2004 David Brownell <dbrownell@users.sourceforge.net>
6
 *
L
Linus Torvalds 已提交
7 8 9 10
 * [ Initialisation is based on Linus'  ]
 * [ uhci code and gregs ohci fragments ]
 * [ (C) Copyright 1999 Linus Torvalds  ]
 * [ (C) Copyright 1999 Gregory P. Smith]
11 12
 *
 *
L
Linus Torvalds 已提交
13 14 15 16 17 18 19
 * OHCI is the main "non-Intel/VIA" standard for USB 1.1 host controller
 * interfaces (though some non-x86 Intel chips use it).  It supports
 * smarter hardware than UHCI.  A download link for the spec available
 * through the http://www.usb.org website.
 *
 * This file is licenced under the GPL.
 */
20

L
Linus Torvalds 已提交
21 22 23 24 25 26 27 28 29 30 31 32 33
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/pci.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/ioport.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/timer.h>
#include <linux/list.h>
#include <linux/usb.h>
34
#include <linux/usb/otg.h>
35
#include <linux/usb/hcd.h>
36
#include <linux/dma-mapping.h>
37
#include <linux/dmapool.h>
38
#include <linux/workqueue.h>
39
#include <linux/debugfs.h>
L
Linus Torvalds 已提交
40 41 42 43 44 45 46 47 48 49 50 51 52

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


#define DRIVER_AUTHOR "Roman Weissgaerber, David Brownell"
#define DRIVER_DESC "USB 1.1 'Open' Host Controller (OHCI) Driver"

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

53
#undef OHCI_VERBOSE_DEBUG	/* not always helpful */
L
Linus Torvalds 已提交
54 55

/* For initializing controller (mask in an HCFS mode too) */
56
#define	OHCI_CONTROL_INIT	OHCI_CTRL_CBSR
L
Linus Torvalds 已提交
57
#define	OHCI_INTR_INIT \
58 59
		(OHCI_INTR_MIE | OHCI_INTR_RHSC | OHCI_INTR_UE \
		| OHCI_INTR_RD | OHCI_INTR_WDH)
L
Linus Torvalds 已提交
60 61 62 63 64 65 66 67 68 69 70 71 72 73 74

#ifdef __hppa__
/* On PA-RISC, PDC can leave IR set incorrectly; ignore it there. */
#define	IR_DISABLE
#endif

#ifdef CONFIG_ARCH_OMAP
/* OMAP doesn't support IR (no SMM; not needed) */
#define	IR_DISABLE
#endif

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

static const char	hcd_name [] = "ohci_hcd";

75 76
#define	STATECHANGE_DELAY	msecs_to_jiffies(300)

L
Linus Torvalds 已提交
77 78 79 80 81
#include "ohci.h"

static void ohci_dump (struct ohci_hcd *ohci, int verbose);
static int ohci_init (struct ohci_hcd *ohci);
static void ohci_stop (struct usb_hcd *hcd);
82 83

#if defined(CONFIG_PM) || defined(CONFIG_PCI)
84
static int ohci_restart (struct ohci_hcd *ohci);
85
#endif
L
Linus Torvalds 已提交
86

L
Libin Yang 已提交
87 88 89
#ifdef CONFIG_PCI
static void quirk_amd_pll(int state);
static void amd_iso_dev_put(void);
90
static void sb800_prefetch(struct ohci_hcd *ohci, int on);
L
Libin Yang 已提交
91 92 93 94 95 96 97 98 99
#else
static inline void quirk_amd_pll(int state)
{
	return;
}
static inline void amd_iso_dev_put(void)
{
	return;
}
100 101 102 103
static inline void sb800_prefetch(struct ohci_hcd *ohci, int on)
{
	return;
}
L
Libin Yang 已提交
104 105 106
#endif


L
Linus Torvalds 已提交
107 108 109 110 111 112 113 114 115 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
#include "ohci-hub.c"
#include "ohci-dbg.c"
#include "ohci-mem.c"
#include "ohci-q.c"


/*
 * On architectures with edge-triggered interrupts we must never return
 * IRQ_NONE.
 */
#if defined(CONFIG_SA1111)  /* ... or other edge-triggered systems */
#define IRQ_NOTMINE	IRQ_HANDLED
#else
#define IRQ_NOTMINE	IRQ_NONE
#endif


/* Some boards misreport power switching/overcurrent */
static int distrust_firmware = 1;
module_param (distrust_firmware, bool, 0);
MODULE_PARM_DESC (distrust_firmware,
	"true to distrust firmware power/overcurrent setup");

/* Some boards leave IR set wrongly, since they fail BIOS/SMM handshakes */
static int no_handshake = 0;
module_param (no_handshake, bool, 0);
MODULE_PARM_DESC (no_handshake, "true (not default) disables BIOS handshake");

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

/*
 * queue up an urb for anything except the root hub
 */
static int ohci_urb_enqueue (
	struct usb_hcd	*hcd,
	struct urb	*urb,
A
Al Viro 已提交
143
	gfp_t		mem_flags
L
Linus Torvalds 已提交
144 145 146 147 148 149 150 151
) {
	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);
	struct ed	*ed;
	urb_priv_t	*urb_priv;
	unsigned int	pipe = urb->pipe;
	int		i, size = 0;
	unsigned long	flags;
	int		retval = 0;
152

L
Linus Torvalds 已提交
153
#ifdef OHCI_VERBOSE_DEBUG
154
	urb_print(urb, "SUB", usb_pipein(pipe), -EINPROGRESS);
L
Linus Torvalds 已提交
155
#endif
156

L
Linus Torvalds 已提交
157
	/* every endpoint has a ed, locate and maybe (re)initialize it */
158
	if (! (ed = ed_get (ohci, urb->ep, urb->dev, pipe, urb->interval)))
L
Linus Torvalds 已提交
159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193
		return -ENOMEM;

	/* for the private part of the URB we need the number of TDs (size) */
	switch (ed->type) {
		case PIPE_CONTROL:
			/* td_submit_urb() doesn't yet handle these */
			if (urb->transfer_buffer_length > 4096)
				return -EMSGSIZE;

			/* 1 TD for setup, 1 for ACK, plus ... */
			size = 2;
			/* FALLTHROUGH */
		// case PIPE_INTERRUPT:
		// case PIPE_BULK:
		default:
			/* one TD for every 4096 Bytes (can be upto 8K) */
			size += urb->transfer_buffer_length / 4096;
			/* ... and for any remaining bytes ... */
			if ((urb->transfer_buffer_length % 4096) != 0)
				size++;
			/* ... and maybe a zero length packet to wrap it up */
			if (size == 0)
				size++;
			else if ((urb->transfer_flags & URB_ZERO_PACKET) != 0
				&& (urb->transfer_buffer_length
					% usb_maxpacket (urb->dev, pipe,
						usb_pipeout (pipe))) == 0)
				size++;
			break;
		case PIPE_ISOCHRONOUS: /* number of packets from URB */
			size = urb->number_of_packets;
			break;
	}

	/* allocate the private part of the URB */
194
	urb_priv = kzalloc (sizeof (urb_priv_t) + size * sizeof (struct td *),
L
Linus Torvalds 已提交
195 196 197 198 199
			mem_flags);
	if (!urb_priv)
		return -ENOMEM;
	INIT_LIST_HEAD (&urb_priv->pending);
	urb_priv->length = size;
200
	urb_priv->ed = ed;
L
Linus Torvalds 已提交
201 202 203 204 205 206 207 208 209

	/* allocate the TDs (deferring hash chain updates) */
	for (i = 0; i < size; i++) {
		urb_priv->td [i] = td_alloc (ohci, mem_flags);
		if (!urb_priv->td [i]) {
			urb_priv->length = i;
			urb_free_priv (ohci, urb_priv);
			return -ENOMEM;
		}
210
	}
L
Linus Torvalds 已提交
211 212 213 214

	spin_lock_irqsave (&ohci->lock, flags);

	/* don't submit to a dead HC */
215
	if (!HCD_HW_ACCESSIBLE(hcd)) {
216 217 218
		retval = -ENODEV;
		goto fail;
	}
L
Linus Torvalds 已提交
219 220 221 222
	if (!HC_IS_RUNNING(hcd->state)) {
		retval = -ENODEV;
		goto fail;
	}
223 224
	retval = usb_hcd_link_urb_to_ep(hcd, urb);
	if (retval)
L
Linus Torvalds 已提交
225 226 227 228 229
		goto fail;

	/* schedule the ed if needed */
	if (ed->state == ED_IDLE) {
		retval = ed_schedule (ohci, ed);
230 231 232 233
		if (retval < 0) {
			usb_hcd_unlink_urb_from_ep(hcd, urb);
			goto fail;
		}
L
Linus Torvalds 已提交
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264
		if (ed->type == PIPE_ISOCHRONOUS) {
			u16	frame = ohci_frame_no(ohci);

			/* delay a few frames before the first TD */
			frame += max_t (u16, 8, ed->interval);
			frame &= ~(ed->interval - 1);
			frame |= ed->branch;
			urb->start_frame = frame;

			/* yes, only URB_ISO_ASAP is supported, and
			 * urb->start_frame is never used as input.
			 */
		}
	} else if (ed->type == PIPE_ISOCHRONOUS)
		urb->start_frame = ed->last_iso + ed->interval;

	/* fill the TDs and link them to the ed; and
	 * enable that part of the schedule, if needed
	 * and update count of queued periodic urbs
	 */
	urb->hcpriv = urb_priv;
	td_submit_urb (ohci, urb);

fail:
	if (retval)
		urb_free_priv (ohci, urb_priv);
	spin_unlock_irqrestore (&ohci->lock, flags);
	return retval;
}

/*
265 266
 * decouple the URB from the HC queues (TDs, urb_priv).
 * reporting is always done
L
Linus Torvalds 已提交
267 268 269
 * asynchronously, and we might be dealing with an urb that's
 * partially transferred, or an ED with other urbs being unlinked.
 */
270
static int ohci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
L
Linus Torvalds 已提交
271 272 273
{
	struct ohci_hcd		*ohci = hcd_to_ohci (hcd);
	unsigned long		flags;
274
	int			rc;
275

L
Linus Torvalds 已提交
276
#ifdef OHCI_VERBOSE_DEBUG
277
	urb_print(urb, "UNLINK", 1, status);
278
#endif
L
Linus Torvalds 已提交
279 280

	spin_lock_irqsave (&ohci->lock, flags);
281 282 283 284
	rc = usb_hcd_check_unlink_urb(hcd, urb, status);
	if (rc) {
		;	/* Do nothing */
	} else if (HC_IS_RUNNING(hcd->state)) {
L
Linus Torvalds 已提交
285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
		urb_priv_t  *urb_priv;

		/* Unless an IRQ completed the unlink while it was being
		 * handed to us, flag it for unlink and giveback, and force
		 * some upcoming INTR_SF to call finish_unlinks()
		 */
		urb_priv = urb->hcpriv;
		if (urb_priv) {
			if (urb_priv->ed->state == ED_OPER)
				start_ed_unlink (ohci, urb_priv->ed);
		}
	} else {
		/*
		 * with HC dead, we won't respect hc queue pointers
		 * any more ... just clean up every urb's memory.
		 */
		if (urb->hcpriv)
302
			finish_urb(ohci, urb, status);
L
Linus Torvalds 已提交
303 304
	}
	spin_unlock_irqrestore (&ohci->lock, flags);
305
	return rc;
L
Linus Torvalds 已提交
306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
}

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

/* frees config/altsetting state for endpoints,
 * including ED memory, dummy TD, and bulk/intr data toggle
 */

static void
ohci_endpoint_disable (struct usb_hcd *hcd, struct usb_host_endpoint *ep)
{
	struct ohci_hcd		*ohci = hcd_to_ohci (hcd);
	unsigned long		flags;
	struct ed		*ed = ep->hcpriv;
	unsigned		limit = 1000;

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

	if (!ed)
		return;

rescan:
	spin_lock_irqsave (&ohci->lock, flags);

	if (!HC_IS_RUNNING (hcd->state)) {
sanitize:
		ed->state = ED_IDLE;
M
Mike Nuss 已提交
334 335
		if (quirk_zfmicro(ohci) && ed->type == PIPE_INTERRUPT)
			ohci->eds_scheduled--;
336
		finish_unlinks (ohci, 0);
L
Linus Torvalds 已提交
337 338 339 340 341 342
	}

	switch (ed->state) {
	case ED_UNLINK:		/* wait for hw to finish? */
		/* major IRQ delivery trouble loses INTR_SF too... */
		if (limit-- == 0) {
M
Mike Nuss 已提交
343 344 345 346 347 348
			ohci_warn(ohci, "ED unlink timeout\n");
			if (quirk_zfmicro(ohci)) {
				ohci_warn(ohci, "Attempting ZF TD recovery\n");
				ohci->ed_to_check = ed;
				ohci->zf_delay = 2;
			}
L
Linus Torvalds 已提交
349 350 351
			goto sanitize;
		}
		spin_unlock_irqrestore (&ohci->lock, flags);
352
		schedule_timeout_uninterruptible(1);
L
Linus Torvalds 已提交
353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388
		goto rescan;
	case ED_IDLE:		/* fully unlinked */
		if (list_empty (&ed->td_list)) {
			td_free (ohci, ed->dummy);
			ed_free (ohci, ed);
			break;
		}
		/* else FALL THROUGH */
	default:
		/* caller was supposed to have unlinked any requests;
		 * that's not our job.  can't recover; must leak ed.
		 */
		ohci_err (ohci, "leak ed %p (#%02x) state %d%s\n",
			ed, ep->desc.bEndpointAddress, ed->state,
			list_empty (&ed->td_list) ? "" : " (has tds)");
		td_free (ohci, ed->dummy);
		break;
	}
	ep->hcpriv = NULL;
	spin_unlock_irqrestore (&ohci->lock, flags);
}

static int ohci_get_frame (struct usb_hcd *hcd)
{
	struct ohci_hcd		*ohci = hcd_to_ohci (hcd);

	return ohci_frame_no(ohci);
}

static void ohci_usb_reset (struct ohci_hcd *ohci)
{
	ohci->hc_control = ohci_readl (ohci, &ohci->regs->control);
	ohci->hc_control &= OHCI_CTRL_RWC;
	ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
}

389
/* ohci_shutdown forcibly disables IRQs and DMA, helping kexec and
390 391 392
 * other cases where the next software may expect clean state from the
 * "firmware".  this is bus-neutral, unlike shutdown() methods.
 */
393 394
static void
ohci_shutdown (struct usb_hcd *hcd)
395 396 397
{
	struct ohci_hcd *ohci;

398
	ohci = hcd_to_ohci (hcd);
399
	ohci_writel (ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable);
400 401 402 403 404 405 406 407
	ohci->hc_control = ohci_readl(ohci, &ohci->regs->control);

	/* If the SHUTDOWN quirk is set, don't put the controller in RESET */
	ohci->hc_control &= (ohci->flags & OHCI_QUIRK_SHUTDOWN ?
			OHCI_CTRL_RWC | OHCI_CTRL_HCFS :
			OHCI_CTRL_RWC);
	ohci_writel(ohci, ohci->hc_control, &ohci->regs->control);

408 409 410 411
	/* flush the writes */
	(void) ohci_readl (ohci, &ohci->regs->control);
}

M
Mike Nuss 已提交
412 413 414 415 416 417 418 419 420 421 422 423 424 425 426
static int check_ed(struct ohci_hcd *ohci, struct ed *ed)
{
	return (hc32_to_cpu(ohci, ed->hwINFO) & ED_IN) != 0
		&& (hc32_to_cpu(ohci, ed->hwHeadP) & TD_MASK)
			== (hc32_to_cpu(ohci, ed->hwTailP) & TD_MASK)
		&& !list_empty(&ed->td_list);
}

/* ZF Micro watchdog timer callback. The ZF Micro chipset sometimes completes
 * an interrupt TD but neglects to add it to the donelist.  On systems with
 * this chipset, we need to periodically check the state of the queues to look
 * for such "lost" TDs.
 */
static void unlink_watchdog_func(unsigned long _ohci)
{
427
	unsigned long	flags;
M
Mike Nuss 已提交
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
	unsigned	max;
	unsigned	seen_count = 0;
	unsigned	i;
	struct ed	**seen = NULL;
	struct ohci_hcd	*ohci = (struct ohci_hcd *) _ohci;

	spin_lock_irqsave(&ohci->lock, flags);
	max = ohci->eds_scheduled;
	if (!max)
		goto done;

	if (ohci->ed_to_check)
		goto out;

	seen = kcalloc(max, sizeof *seen, GFP_ATOMIC);
	if (!seen)
		goto out;

	for (i = 0; i < NUM_INTS; i++) {
		struct ed	*ed = ohci->periodic[i];

		while (ed) {
			unsigned	temp;

			/* scan this branch of the periodic schedule tree */
			for (temp = 0; temp < seen_count; temp++) {
				if (seen[temp] == ed) {
					/* we've checked it and what's after */
					ed = NULL;
					break;
				}
			}
			if (!ed)
				break;
			seen[seen_count++] = ed;
			if (!check_ed(ohci, ed)) {
				ed = ed->ed_next;
				continue;
			}

			/* HC's TD list is empty, but HCD sees at least one
			 * TD that's not been sent through the donelist.
			 */
			ohci->ed_to_check = ed;
			ohci->zf_delay = 2;

			/* The HC may wait until the next frame to report the
			 * TD as done through the donelist and INTR_WDH.  (We
			 * just *assume* it's not a multi-TD interrupt URB;
			 * those could defer the IRQ more than one frame, using
			 * DI...)  Check again after the next INTR_SF.
			 */
			ohci_writel(ohci, OHCI_INTR_SF,
					&ohci->regs->intrstatus);
			ohci_writel(ohci, OHCI_INTR_SF,
					&ohci->regs->intrenable);

			/* flush those writes */
			(void) ohci_readl(ohci, &ohci->regs->control);

			goto out;
		}
	}
out:
	kfree(seen);
	if (ohci->eds_scheduled)
494
		mod_timer(&ohci->unlink_watchdog, round_jiffies(jiffies + HZ));
M
Mike Nuss 已提交
495 496 497 498
done:
	spin_unlock_irqrestore(&ohci->lock, flags);
}

L
Linus Torvalds 已提交
499 500 501 502 503 504 505 506 507
/*-------------------------------------------------------------------------*
 * HC functions
 *-------------------------------------------------------------------------*/

/* init memory, and kick BIOS/SMM off */

static int ohci_init (struct ohci_hcd *ohci)
{
	int ret;
508
	struct usb_hcd *hcd = ohci_to_hcd(ohci);
L
Linus Torvalds 已提交
509

510 511 512
	if (distrust_firmware)
		ohci->flags |= OHCI_QUIRK_HUB_POWER;

L
Linus Torvalds 已提交
513
	disable (ohci);
514
	ohci->regs = hcd->regs;
L
Linus Torvalds 已提交
515

516 517 518 519
	/* REVISIT this BIOS handshake is now moved into PCI "quirks", and
	 * was never needed for most non-PCI systems ... remove the code?
	 */

L
Linus Torvalds 已提交
520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
#ifndef IR_DISABLE
	/* SMM owns the HC?  not for long! */
	if (!no_handshake && ohci_readl (ohci,
					&ohci->regs->control) & OHCI_CTRL_IR) {
		u32 temp;

		ohci_dbg (ohci, "USB HC TakeOver from BIOS/SMM\n");

		/* this timeout is arbitrary.  we make it long, so systems
		 * depending on usb keyboards may be usable even if the
		 * BIOS/SMM code seems pretty broken.
		 */
		temp = 500;	/* arbitrary: five seconds */

		ohci_writel (ohci, OHCI_INTR_OC, &ohci->regs->intrenable);
		ohci_writel (ohci, OHCI_OCR, &ohci->regs->cmdstatus);
		while (ohci_readl (ohci, &ohci->regs->control) & OHCI_CTRL_IR) {
			msleep (10);
			if (--temp == 0) {
				ohci_err (ohci, "USB HC takeover failed!"
					"  (BIOS/SMM bug)\n");
				return -EBUSY;
			}
		}
		ohci_usb_reset (ohci);
	}
#endif

	/* Disable HC interrupts */
	ohci_writel (ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable);
550 551 552 553

	/* flush the writes, and save key bits like RWC */
	if (ohci_readl (ohci, &ohci->regs->control) & OHCI_CTRL_RWC)
		ohci->hc_control |= OHCI_CTRL_RWC;
L
Linus Torvalds 已提交
554

555 556 557 558
	/* Read the number of ports unless overridden */
	if (ohci->num_ports == 0)
		ohci->num_ports = roothub_a(ohci) & RH_A_NDP;

L
Linus Torvalds 已提交
559 560 561
	if (ohci->hcca)
		return 0;

562
	ohci->hcca = dma_alloc_coherent (hcd->self.controller,
L
Linus Torvalds 已提交
563 564 565 566 567
			sizeof *ohci->hcca, &ohci->hcca_dma, 0);
	if (!ohci->hcca)
		return -ENOMEM;

	if ((ret = ohci_mem_init (ohci)) < 0)
568 569 570 571
		ohci_stop (hcd);
	else {
		create_debug_files (ohci);
	}
L
Linus Torvalds 已提交
572 573 574 575 576 577 578 579

	return ret;
}

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

/* Start an OHCI controller, set the BUS operational
 * resets USB and controller
580
 * enable interrupts
L
Linus Torvalds 已提交
581 582 583
 */
static int ohci_run (struct ohci_hcd *ohci)
{
584
	u32			mask, val;
L
Linus Torvalds 已提交
585
	int			first = ohci->fminterval == 0;
586
	struct usb_hcd		*hcd = ohci_to_hcd(ohci);
L
Linus Torvalds 已提交
587 588 589 590 591 592

	disable (ohci);

	/* boot firmware should have set this up (5.1.1.3.1) */
	if (first) {

593 594
		val = ohci_readl (ohci, &ohci->regs->fminterval);
		ohci->fminterval = val & 0x3fff;
L
Linus Torvalds 已提交
595 596 597 598 599 600 601
		if (ohci->fminterval != FI)
			ohci_dbg (ohci, "fminterval delta %d\n",
				ohci->fminterval - FI);
		ohci->fminterval |= FSMP (ohci->fminterval) << 16;
		/* also: power/overcurrent flags in roothub.a */
	}

602 603 604 605
	/* Reset USB nearly "by the book".  RemoteWakeupConnected has
	 * to be checked in case boot firmware (BIOS/SMM/...) has set up
	 * wakeup in a way the bus isn't aware of (e.g., legacy PCI PM).
	 * If the bus glue detected wakeup capability then it should
606
	 * already be enabled; if so we'll just enable it again.
L
Linus Torvalds 已提交
607
	 */
608 609
	if ((ohci->hc_control & OHCI_CTRL_RWC) != 0)
		device_set_wakeup_capable(hcd->self.controller, 1);
L
Linus Torvalds 已提交
610 611 612

	switch (ohci->hc_control & OHCI_CTRL_HCFS) {
	case OHCI_USB_OPER:
613
		val = 0;
L
Linus Torvalds 已提交
614 615 616 617 618
		break;
	case OHCI_USB_SUSPEND:
	case OHCI_USB_RESUME:
		ohci->hc_control &= OHCI_CTRL_RWC;
		ohci->hc_control |= OHCI_USB_RESUME;
619
		val = 10 /* msec wait */;
L
Linus Torvalds 已提交
620 621 622 623 624
		break;
	// case OHCI_USB_RESET:
	default:
		ohci->hc_control &= OHCI_CTRL_RWC;
		ohci->hc_control |= OHCI_USB_RESET;
625
		val = 50 /* msec wait */;
L
Linus Torvalds 已提交
626 627 628 629 630
		break;
	}
	ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
	// flush the writes
	(void) ohci_readl (ohci, &ohci->regs->control);
631
	msleep(val);
A
Alan Stern 已提交
632

L
Linus Torvalds 已提交
633 634 635 636 637 638 639 640
	memset (ohci->hcca, 0, sizeof (struct ohci_hcca));

	/* 2msec timelimit here means no irqs/preempt */
	spin_lock_irq (&ohci->lock);

retry:
	/* HC Reset requires max 10 us delay */
	ohci_writel (ohci, OHCI_HCR,  &ohci->regs->cmdstatus);
641
	val = 30;	/* ... allow extra time */
L
Linus Torvalds 已提交
642
	while ((ohci_readl (ohci, &ohci->regs->cmdstatus) & OHCI_HCR) != 0) {
643
		if (--val == 0) {
L
Linus Torvalds 已提交
644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692
			spin_unlock_irq (&ohci->lock);
			ohci_err (ohci, "USB HC reset timed out!\n");
			return -1;
		}
		udelay (1);
	}

	/* now we're in the SUSPEND state ... must go OPERATIONAL
	 * within 2msec else HC enters RESUME
	 *
	 * ... but some hardware won't init fmInterval "by the book"
	 * (SiS, OPTi ...), so reset again instead.  SiS doesn't need
	 * this if we write fmInterval after we're OPERATIONAL.
	 * Unclear about ALi, ServerWorks, and others ... this could
	 * easily be a longstanding bug in chip init on Linux.
	 */
	if (ohci->flags & OHCI_QUIRK_INITRESET) {
		ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
		// flush those writes
		(void) ohci_readl (ohci, &ohci->regs->control);
	}

	/* Tell the controller where the control and bulk lists are
	 * The lists are empty now. */
	ohci_writel (ohci, 0, &ohci->regs->ed_controlhead);
	ohci_writel (ohci, 0, &ohci->regs->ed_bulkhead);

	/* a reset clears this */
	ohci_writel (ohci, (u32) ohci->hcca_dma, &ohci->regs->hcca);

	periodic_reinit (ohci);

	/* some OHCI implementations are finicky about how they init.
	 * bogus values here mean not even enumeration could work.
	 */
	if ((ohci_readl (ohci, &ohci->regs->fminterval) & 0x3fff0000) == 0
			|| !ohci_readl (ohci, &ohci->regs->periodicstart)) {
		if (!(ohci->flags & OHCI_QUIRK_INITRESET)) {
			ohci->flags |= OHCI_QUIRK_INITRESET;
			ohci_dbg (ohci, "enabling initreset quirk\n");
			goto retry;
		}
		spin_unlock_irq (&ohci->lock);
		ohci_err (ohci, "init err (%08x %04x)\n",
			ohci_readl (ohci, &ohci->regs->fminterval),
			ohci_readl (ohci, &ohci->regs->periodicstart));
		return -EOVERFLOW;
	}

693
	/* use rhsc irqs after khubd is fully initialized */
694
	set_bit(HCD_FLAG_POLL_RH, &hcd->flags);
695 696 697
	hcd->uses_new_polling = 1;

	/* start controller operations */
L
Linus Torvalds 已提交
698
	ohci->hc_control &= OHCI_CTRL_RWC;
699 700
	ohci->hc_control |= OHCI_CONTROL_INIT | OHCI_USB_OPER;
	ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
701
	hcd->state = HC_STATE_RUNNING;
L
Linus Torvalds 已提交
702 703 704 705 706 707

	/* wake on ConnectStatusChange, matching external hubs */
	ohci_writel (ohci, RH_HS_DRWE, &ohci->regs->roothub.status);

	/* Choose the interrupts we care about now, others later on demand */
	mask = OHCI_INTR_INIT;
708
	ohci_writel (ohci, ~0, &ohci->regs->intrstatus);
L
Linus Torvalds 已提交
709 710 711
	ohci_writel (ohci, mask, &ohci->regs->intrenable);

	/* handle root hub init quirks ... */
712 713
	val = roothub_a (ohci);
	val &= ~(RH_A_PSM | RH_A_OCPM);
L
Linus Torvalds 已提交
714 715
	if (ohci->flags & OHCI_QUIRK_SUPERIO) {
		/* NSC 87560 and maybe others */
716 717 718
		val |= RH_A_NOCP;
		val &= ~(RH_A_POTPGT | RH_A_NPS);
		ohci_writel (ohci, val, &ohci->regs->roothub.a);
719 720
	} else if ((ohci->flags & OHCI_QUIRK_AMD756) ||
			(ohci->flags & OHCI_QUIRK_HUB_POWER)) {
L
Linus Torvalds 已提交
721 722 723
		/* hub power always on; required for AMD-756 and some
		 * Mac platforms.  ganged overcurrent reporting, if any.
		 */
724 725
		val |= RH_A_NPS;
		ohci_writel (ohci, val, &ohci->regs->roothub.a);
L
Linus Torvalds 已提交
726 727
	}
	ohci_writel (ohci, RH_HS_LPSC, &ohci->regs->roothub.status);
728
	ohci_writel (ohci, (val & RH_A_NPS) ? 0 : RH_B_PPCM,
L
Linus Torvalds 已提交
729 730 731 732
						&ohci->regs->roothub.b);
	// flush those writes
	(void) ohci_readl (ohci, &ohci->regs->control);

733
	ohci->next_statechange = jiffies + STATECHANGE_DELAY;
L
Linus Torvalds 已提交
734 735 736
	spin_unlock_irq (&ohci->lock);

	// POTPGT delay is bits 24-31, in 2 ms units.
737
	mdelay ((val >> 23) & 0x1fe);
738
	hcd->state = HC_STATE_RUNNING;
L
Linus Torvalds 已提交
739

M
Mike Nuss 已提交
740 741 742 743 744 745 746 747 748
	if (quirk_zfmicro(ohci)) {
		/* Create timer to watch for bad queue state on ZF Micro */
		setup_timer(&ohci->unlink_watchdog, unlink_watchdog_func,
				(unsigned long) ohci);

		ohci->eds_scheduled = 0;
		ohci->ed_to_check = NULL;
	}

L
Linus Torvalds 已提交
749 750 751 752 753 754 755 756 757
	ohci_dump (ohci, 1);

	return 0;
}

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

/* an interrupt happens */

758
static irqreturn_t ohci_irq (struct usb_hcd *hcd)
L
Linus Torvalds 已提交
759 760 761
{
	struct ohci_hcd		*ohci = hcd_to_ohci (hcd);
	struct ohci_regs __iomem *regs = ohci->regs;
M
Mike Nuss 已提交
762
	int			ints;
L
Linus Torvalds 已提交
763

764 765 766
	/* Read interrupt status (and flush pending writes).  We ignore the
	 * optimization of checking the LSB of hcca->done_head; it doesn't
	 * work on all systems (edge triggering for OHCI can be a factor).
M
Mike Nuss 已提交
767
	 */
768
	ints = ohci_readl(ohci, &regs->intrstatus);
L
Linus Torvalds 已提交
769

770 771 772 773
	/* Check for an all 1's result which is a typical consequence
	 * of dead, unclocked, or unplugged (CardBus...) devices
	 */
	if (ints == ~(u32)0) {
L
Linus Torvalds 已提交
774 775 776
		disable (ohci);
		ohci_dbg (ohci, "device removed!\n");
		return IRQ_HANDLED;
777 778 779 780
	}

	/* We only care about interrupts that are enabled */
	ints &= ohci_readl(ohci, &regs->intrenable);
L
Linus Torvalds 已提交
781 782

	/* interrupt for some other device? */
783
	if (ints == 0)
L
Linus Torvalds 已提交
784
		return IRQ_NOTMINE;
785

L
Linus Torvalds 已提交
786 787
	if (ints & OHCI_INTR_UE) {
		// e.g. due to PCI Master/Target Abort
M
Mike Nuss 已提交
788
		if (quirk_nec(ohci)) {
789 790 791 792 793 794 795 796 797 798 799 800
			/* Workaround for a silicon bug in some NEC chips used
			 * in Apple's PowerBooks. Adapted from Darwin code.
			 */
			ohci_err (ohci, "OHCI Unrecoverable Error, scheduling NEC chip restart\n");

			ohci_writel (ohci, OHCI_INTR_UE, &regs->intrdisable);

			schedule_work (&ohci->nec_work);
		} else {
			disable (ohci);
			ohci_err (ohci, "OHCI Unrecoverable Error, disabled\n");
		}
L
Linus Torvalds 已提交
801 802 803 804 805

		ohci_dump (ohci, 1);
		ohci_usb_reset (ohci);
	}

A
Alan Stern 已提交
806 807 808 809 810
	if (ints & OHCI_INTR_RHSC) {
		ohci_vdbg(ohci, "rhsc\n");
		ohci->next_statechange = jiffies + STATECHANGE_DELAY;
		ohci_writel(ohci, OHCI_INTR_RD | OHCI_INTR_RHSC,
				&regs->intrstatus);
811 812 813 814 815 816 817 818 819 820

		/* NOTE: Vendors didn't always make the same implementation
		 * choices for RHSC.  Many followed the spec; RHSC triggers
		 * on an edge, like setting and maybe clearing a port status
		 * change bit.  With others it's level-triggered, active
		 * until khubd clears all the port status change bits.  We'll
		 * always disable it here and rely on polling until khubd
		 * re-enables it.
		 */
		ohci_writel(ohci, OHCI_INTR_RHSC, &regs->intrdisable);
A
Alan Stern 已提交
821 822 823 824 825 826 827 828 829 830
		usb_hcd_poll_rh_status(hcd);
	}

	/* For connect and disconnect events, we expect the controller
	 * to turn on RHSC along with RD.  But for remote wakeup events
	 * this might not happen.
	 */
	else if (ints & OHCI_INTR_RD) {
		ohci_vdbg(ohci, "resume detect\n");
		ohci_writel(ohci, OHCI_INTR_RD, &regs->intrstatus);
831
		set_bit(HCD_FLAG_POLL_RH, &hcd->flags);
A
Alan Stern 已提交
832 833 834 835 836
		if (ohci->autostop) {
			spin_lock (&ohci->lock);
			ohci_rh_resume (ohci);
			spin_unlock (&ohci->lock);
		} else
D
David Brownell 已提交
837
			usb_hcd_resume_root_hub(hcd);
L
Linus Torvalds 已提交
838 839 840 841
	}

	if (ints & OHCI_INTR_WDH) {
		spin_lock (&ohci->lock);
842
		dl_done_list (ohci);
L
Linus Torvalds 已提交
843 844
		spin_unlock (&ohci->lock);
	}
845

M
Mike Nuss 已提交
846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870
	if (quirk_zfmicro(ohci) && (ints & OHCI_INTR_SF)) {
		spin_lock(&ohci->lock);
		if (ohci->ed_to_check) {
			struct ed *ed = ohci->ed_to_check;

			if (check_ed(ohci, ed)) {
				/* HC thinks the TD list is empty; HCD knows
				 * at least one TD is outstanding
				 */
				if (--ohci->zf_delay == 0) {
					struct td *td = list_entry(
						ed->td_list.next,
						struct td, td_list);
					ohci_warn(ohci,
						  "Reclaiming orphan TD %p\n",
						  td);
					takeback_td(ohci, td);
					ohci->ed_to_check = NULL;
				}
			} else
				ohci->ed_to_check = NULL;
		}
		spin_unlock(&ohci->lock);
	}

L
Linus Torvalds 已提交
871 872 873 874 875 876 877
	/* could track INTR_SO to reduce available PCI/... bandwidth */

	/* handle any pending URB/ED unlinks, leaving INTR_SF enabled
	 * when there's still unlinking to be done (next frame).
	 */
	spin_lock (&ohci->lock);
	if (ohci->ed_rm_list)
878
		finish_unlinks (ohci, ohci_frame_no(ohci));
M
Mike Nuss 已提交
879 880 881
	if ((ints & OHCI_INTR_SF) != 0
			&& !ohci->ed_rm_list
			&& !ohci->ed_to_check
L
Linus Torvalds 已提交
882
			&& HC_IS_RUNNING(hcd->state))
883
		ohci_writel (ohci, OHCI_INTR_SF, &regs->intrdisable);
L
Linus Torvalds 已提交
884 885 886 887
	spin_unlock (&ohci->lock);

	if (HC_IS_RUNNING(hcd->state)) {
		ohci_writel (ohci, ints, &regs->intrstatus);
888
		ohci_writel (ohci, OHCI_INTR_MIE, &regs->intrenable);
L
Linus Torvalds 已提交
889 890 891 892 893 894 895 896 897 898
		// flush those writes
		(void) ohci_readl (ohci, &ohci->regs->control);
	}

	return IRQ_HANDLED;
}

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

static void ohci_stop (struct usb_hcd *hcd)
899
{
L
Linus Torvalds 已提交
900 901 902 903 904 905 906 907
	struct ohci_hcd		*ohci = hcd_to_ohci (hcd);

	ohci_dump (ohci, 1);

	flush_scheduled_work();

	ohci_usb_reset (ohci);
	ohci_writel (ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable);
908 909 910
	free_irq(hcd->irq, hcd);
	hcd->irq = -1;

M
Mike Nuss 已提交
911 912
	if (quirk_zfmicro(ohci))
		del_timer(&ohci->unlink_watchdog);
L
Libin Yang 已提交
913 914
	if (quirk_amdiso(ohci))
		amd_iso_dev_put();
M
Mike Nuss 已提交
915

L
Linus Torvalds 已提交
916 917 918
	remove_debug_files (ohci);
	ohci_mem_cleanup (ohci);
	if (ohci->hcca) {
919 920
		dma_free_coherent (hcd->self.controller,
				sizeof *ohci->hcca,
L
Linus Torvalds 已提交
921 922 923 924 925 926 927 928
				ohci->hcca, ohci->hcca_dma);
		ohci->hcca = NULL;
		ohci->hcca_dma = 0;
	}
}

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

929 930
#if defined(CONFIG_PM) || defined(CONFIG_PCI)

L
Linus Torvalds 已提交
931 932 933 934 935 936 937 938 939
/* must not be called from interrupt context */
static int ohci_restart (struct ohci_hcd *ohci)
{
	int temp;
	int i;
	struct urb_priv *priv;

	spin_lock_irq(&ohci->lock);
	disable (ohci);
940 941

	/* Recycle any "live" eds/tds (and urbs). */
L
Linus Torvalds 已提交
942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964
	if (!list_empty (&ohci->pending))
		ohci_dbg(ohci, "abort schedule...\n");
	list_for_each_entry (priv, &ohci->pending, pending) {
		struct urb	*urb = priv->td[0]->urb;
		struct ed	*ed = priv->ed;

		switch (ed->state) {
		case ED_OPER:
			ed->state = ED_UNLINK;
			ed->hwINFO |= cpu_to_hc32(ohci, ED_DEQUEUE);
			ed_deschedule (ohci, ed);

			ed->ed_next = ohci->ed_rm_list;
			ed->ed_prev = NULL;
			ohci->ed_rm_list = ed;
			/* FALLTHROUGH */
		case ED_UNLINK:
			break;
		default:
			ohci_dbg(ohci, "bogus ed %p state %d\n",
					ed, ed->state);
		}

965 966
		if (!urb->unlinked)
			urb->unlinked = -ESHUTDOWN;
L
Linus Torvalds 已提交
967
	}
968
	finish_unlinks (ohci, 0);
L
Linus Torvalds 已提交
969 970 971 972 973 974 975
	spin_unlock_irq(&ohci->lock);

	/* paranoia, in case that didn't work: */

	/* empty the interrupt branches */
	for (i = 0; i < NUM_INTS; i++) ohci->load [i] = 0;
	for (i = 0; i < NUM_INTS; i++) ohci->hcca->int_table [i] = 0;
976

L
Linus Torvalds 已提交
977 978 979
	/* no EDs to remove */
	ohci->ed_rm_list = NULL;

980
	/* empty control and bulk lists */
L
Linus Torvalds 已提交
981 982 983 984 985 986 987
	ohci->ed_controltail = NULL;
	ohci->ed_bulktail    = NULL;

	if ((temp = ohci_run (ohci)) < 0) {
		ohci_err (ohci, "can't restart, %d\n", temp);
		return temp;
	}
A
Alan Stern 已提交
988
	ohci_dbg(ohci, "restart complete\n");
L
Linus Torvalds 已提交
989 990
	return 0;
}
991

992 993
#endif

994 995
/*-------------------------------------------------------------------------*/

L
Linus Torvalds 已提交
996
MODULE_AUTHOR (DRIVER_AUTHOR);
997
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
998 999 1000 1001
MODULE_LICENSE ("GPL");

#ifdef CONFIG_PCI
#include "ohci-pci.c"
1002
#define PCI_DRIVER		ohci_pci_driver
L
Linus Torvalds 已提交
1003 1004
#endif

1005
#if defined(CONFIG_ARCH_SA1100) && defined(CONFIG_SA1111)
L
Linus Torvalds 已提交
1006
#include "ohci-sa1111.c"
1007
#define SA1111_DRIVER		ohci_hcd_sa1111_driver
L
Linus Torvalds 已提交
1008 1009
#endif

1010
#if defined(CONFIG_ARCH_S3C2410) || defined(CONFIG_ARCH_S3C64XX)
1011
#include "ohci-s3c2410.c"
1012
#define PLATFORM_DRIVER		ohci_hcd_s3c2410_driver
1013 1014
#endif

1015
#ifdef CONFIG_USB_OHCI_HCD_OMAP1
L
Linus Torvalds 已提交
1016
#include "ohci-omap.c"
1017 1018 1019 1020 1021 1022
#define OMAP1_PLATFORM_DRIVER	ohci_hcd_omap_driver
#endif

#ifdef CONFIG_USB_OHCI_HCD_OMAP3
#include "ohci-omap3.c"
#define OMAP3_PLATFORM_DRIVER	ohci_hcd_omap3_driver
L
Linus Torvalds 已提交
1023 1024 1025 1026
#endif

#ifdef CONFIG_ARCH_LH7A404
#include "ohci-lh7a404.c"
1027
#define PLATFORM_DRIVER		ohci_hcd_lh7a404_driver
L
Linus Torvalds 已提交
1028 1029
#endif

1030
#if defined(CONFIG_PXA27x) || defined(CONFIG_PXA3xx)
L
Linus Torvalds 已提交
1031
#include "ohci-pxa27x.c"
1032
#define PLATFORM_DRIVER		ohci_hcd_pxa27x_driver
L
Linus Torvalds 已提交
1033 1034
#endif

1035 1036
#ifdef CONFIG_ARCH_EP93XX
#include "ohci-ep93xx.c"
1037
#define PLATFORM_DRIVER		ohci_hcd_ep93xx_driver
1038 1039
#endif

1040
#ifdef CONFIG_MIPS_ALCHEMY
L
Linus Torvalds 已提交
1041
#include "ohci-au1xxx.c"
1042
#define PLATFORM_DRIVER		ohci_hcd_au1xxx_driver
L
Linus Torvalds 已提交
1043 1044
#endif

V
Vitaly Wool 已提交
1045 1046
#ifdef CONFIG_PNX8550
#include "ohci-pnx8550.c"
1047
#define PLATFORM_DRIVER		ohci_hcd_pnx8550_driver
V
Vitaly Wool 已提交
1048 1049
#endif

L
Linus Torvalds 已提交
1050 1051
#ifdef CONFIG_USB_OHCI_HCD_PPC_SOC
#include "ohci-ppc-soc.c"
1052
#define PLATFORM_DRIVER		ohci_hcd_ppc_soc_driver
L
Linus Torvalds 已提交
1053 1054
#endif

1055
#ifdef CONFIG_ARCH_AT91
1056
#include "ohci-at91.c"
1057
#define PLATFORM_DRIVER		ohci_hcd_at91_driver
1058 1059
#endif

1060 1061
#ifdef CONFIG_ARCH_PNX4008
#include "ohci-pnx4008.c"
1062
#define PLATFORM_DRIVER		usb_hcd_pnx4008_driver
1063 1064
#endif

1065 1066 1067 1068 1069
#ifdef CONFIG_ARCH_DAVINCI_DA8XX
#include "ohci-da8xx.c"
#define PLATFORM_DRIVER		ohci_hcd_da8xx_driver
#endif

1070 1071
#if defined(CONFIG_CPU_SUBTYPE_SH7720) || \
    defined(CONFIG_CPU_SUBTYPE_SH7721) || \
1072 1073
    defined(CONFIG_CPU_SUBTYPE_SH7763) || \
    defined(CONFIG_CPU_SUBTYPE_SH7786)
1074 1075 1076 1077
#include "ohci-sh.c"
#define PLATFORM_DRIVER		ohci_hcd_sh_driver
#endif

1078

1079 1080 1081 1082 1083
#ifdef CONFIG_USB_OHCI_HCD_PPC_OF
#include "ohci-ppc-of.c"
#define OF_PLATFORM_DRIVER	ohci_hcd_ppc_of_driver
#endif

G
Geoff Levand 已提交
1084 1085
#ifdef CONFIG_PPC_PS3
#include "ohci-ps3.c"
G
Geoff Levand 已提交
1086
#define PS3_SYSTEM_BUS_DRIVER	ps3_ohci_driver
G
Geoff Levand 已提交
1087 1088
#endif

M
Michael Buesch 已提交
1089 1090 1091 1092 1093
#ifdef CONFIG_USB_OHCI_HCD_SSB
#include "ohci-ssb.c"
#define SSB_OHCI_DRIVER		ssb_ohci_driver
#endif

M
Magnus Damm 已提交
1094 1095
#ifdef CONFIG_MFD_SM501
#include "ohci-sm501.c"
1096
#define SM501_OHCI_DRIVER	ohci_hcd_sm501_driver
M
Magnus Damm 已提交
1097 1098
#endif

1099 1100 1101
#ifdef CONFIG_MFD_TC6393XB
#include "ohci-tmio.c"
#define TMIO_OHCI_DRIVER	ohci_hcd_tmio_driver
1102 1103 1104 1105 1106
#endif

#ifdef CONFIG_MACH_JZ4740
#include "ohci-jz4740.c"
#define PLATFORM_DRIVER	ohci_hcd_jz4740_driver
1107 1108
#endif

1109 1110
#if	!defined(PCI_DRIVER) &&		\
	!defined(PLATFORM_DRIVER) &&	\
1111 1112
	!defined(OMAP1_PLATFORM_DRIVER) &&	\
	!defined(OMAP3_PLATFORM_DRIVER) &&	\
1113
	!defined(OF_PLATFORM_DRIVER) &&	\
G
Geoff Levand 已提交
1114
	!defined(SA1111_DRIVER) &&	\
M
Michael Buesch 已提交
1115
	!defined(PS3_SYSTEM_BUS_DRIVER) && \
1116
	!defined(SM501_OHCI_DRIVER) && \
1117
	!defined(TMIO_OHCI_DRIVER) && \
M
Michael Buesch 已提交
1118
	!defined(SSB_OHCI_DRIVER)
L
Linus Torvalds 已提交
1119 1120
#error "missing bus glue for ohci-hcd"
#endif
1121 1122 1123 1124 1125 1126 1127 1128

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

	if (usb_disabled())
		return -ENODEV;

1129
	printk(KERN_INFO "%s: " DRIVER_DESC "\n", hcd_name);
1130 1131
	pr_debug ("%s: block sizes: ed %Zd td %Zd\n", hcd_name,
		sizeof (struct ed), sizeof (struct td));
1132
	set_bit(USB_OHCI_LOADED, &usb_hcds_loaded);
1133

1134
#ifdef DEBUG
1135
	ohci_debug_root = debugfs_create_dir("ohci", usb_debug_root);
1136 1137 1138 1139 1140 1141
	if (!ohci_debug_root) {
		retval = -ENOENT;
		goto error_debug;
	}
#endif

G
Geoff Levand 已提交
1142
#ifdef PS3_SYSTEM_BUS_DRIVER
G
Geoff Levand 已提交
1143 1144 1145
	retval = ps3_ohci_driver_register(&PS3_SYSTEM_BUS_DRIVER);
	if (retval < 0)
		goto error_ps3;
G
Geoff Levand 已提交
1146 1147
#endif

1148 1149 1150
#ifdef PLATFORM_DRIVER
	retval = platform_driver_register(&PLATFORM_DRIVER);
	if (retval < 0)
1151
		goto error_platform;
1152 1153
#endif

1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
#ifdef OMAP1_PLATFORM_DRIVER
	retval = platform_driver_register(&OMAP1_PLATFORM_DRIVER);
	if (retval < 0)
		goto error_omap1_platform;
#endif

#ifdef OMAP3_PLATFORM_DRIVER
	retval = platform_driver_register(&OMAP3_PLATFORM_DRIVER);
	if (retval < 0)
		goto error_omap3_platform;
#endif

1166 1167 1168
#ifdef OF_PLATFORM_DRIVER
	retval = of_register_platform_driver(&OF_PLATFORM_DRIVER);
	if (retval < 0)
1169
		goto error_of_platform;
1170 1171
#endif

1172 1173 1174
#ifdef SA1111_DRIVER
	retval = sa1111_driver_register(&SA1111_DRIVER);
	if (retval < 0)
1175
		goto error_sa1111;
1176 1177 1178 1179 1180
#endif

#ifdef PCI_DRIVER
	retval = pci_register_driver(&PCI_DRIVER);
	if (retval < 0)
1181
		goto error_pci;
1182 1183
#endif

M
Michael Buesch 已提交
1184 1185 1186 1187 1188 1189
#ifdef SSB_OHCI_DRIVER
	retval = ssb_driver_register(&SSB_OHCI_DRIVER);
	if (retval)
		goto error_ssb;
#endif

1190 1191 1192 1193 1194 1195
#ifdef SM501_OHCI_DRIVER
	retval = platform_driver_register(&SM501_OHCI_DRIVER);
	if (retval < 0)
		goto error_sm501;
#endif

1196 1197 1198 1199 1200 1201
#ifdef TMIO_OHCI_DRIVER
	retval = platform_driver_register(&TMIO_OHCI_DRIVER);
	if (retval < 0)
		goto error_tmio;
#endif

1202 1203 1204
	return retval;

	/* Error path */
1205 1206 1207 1208
#ifdef TMIO_OHCI_DRIVER
	platform_driver_unregister(&TMIO_OHCI_DRIVER);
 error_tmio:
#endif
1209
#ifdef SM501_OHCI_DRIVER
1210
	platform_driver_unregister(&SM501_OHCI_DRIVER);
1211 1212
 error_sm501:
#endif
M
Michael Buesch 已提交
1213
#ifdef SSB_OHCI_DRIVER
1214
	ssb_driver_unregister(&SSB_OHCI_DRIVER);
M
Michael Buesch 已提交
1215 1216
 error_ssb:
#endif
1217
#ifdef PCI_DRIVER
M
Michael Buesch 已提交
1218
	pci_unregister_driver(&PCI_DRIVER);
1219 1220 1221 1222 1223
 error_pci:
#endif
#ifdef SA1111_DRIVER
	sa1111_driver_unregister(&SA1111_DRIVER);
 error_sa1111:
1224
#endif
1225
#ifdef OF_PLATFORM_DRIVER
1226 1227
	of_unregister_platform_driver(&OF_PLATFORM_DRIVER);
 error_of_platform:
1228
#endif
1229 1230 1231
#ifdef PLATFORM_DRIVER
	platform_driver_unregister(&PLATFORM_DRIVER);
 error_platform:
G
Geoff Levand 已提交
1232
#endif
1233 1234 1235 1236 1237 1238 1239 1240
#ifdef OMAP1_PLATFORM_DRIVER
	platform_driver_unregister(&OMAP1_PLATFORM_DRIVER);
 error_omap1_platform:
#endif
#ifdef OMAP3_PLATFORM_DRIVER
	platform_driver_unregister(&OMAP3_PLATFORM_DRIVER);
 error_omap3_platform:
#endif
G
Geoff Levand 已提交
1241
#ifdef PS3_SYSTEM_BUS_DRIVER
G
Geoff Levand 已提交
1242
	ps3_ohci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER);
G
Geoff Levand 已提交
1243
 error_ps3:
1244
#endif
1245 1246 1247 1248 1249 1250
#ifdef DEBUG
	debugfs_remove(ohci_debug_root);
	ohci_debug_root = NULL;
 error_debug:
#endif

1251
	clear_bit(USB_OHCI_LOADED, &usb_hcds_loaded);
1252 1253 1254 1255 1256 1257
	return retval;
}
module_init(ohci_hcd_mod_init);

static void __exit ohci_hcd_mod_exit(void)
{
1258 1259 1260
#ifdef TMIO_OHCI_DRIVER
	platform_driver_unregister(&TMIO_OHCI_DRIVER);
#endif
1261 1262 1263
#ifdef SM501_OHCI_DRIVER
	platform_driver_unregister(&SM501_OHCI_DRIVER);
#endif
M
Michael Buesch 已提交
1264 1265 1266
#ifdef SSB_OHCI_DRIVER
	ssb_driver_unregister(&SSB_OHCI_DRIVER);
#endif
1267 1268 1269 1270 1271 1272
#ifdef PCI_DRIVER
	pci_unregister_driver(&PCI_DRIVER);
#endif
#ifdef SA1111_DRIVER
	sa1111_driver_unregister(&SA1111_DRIVER);
#endif
1273 1274 1275
#ifdef OF_PLATFORM_DRIVER
	of_unregister_platform_driver(&OF_PLATFORM_DRIVER);
#endif
1276 1277 1278
#ifdef PLATFORM_DRIVER
	platform_driver_unregister(&PLATFORM_DRIVER);
#endif
1279 1280 1281
#ifdef OMAP3_PLATFORM_DRIVER
	platform_driver_unregister(&OMAP3_PLATFORM_DRIVER);
#endif
G
Geoff Levand 已提交
1282
#ifdef PS3_SYSTEM_BUS_DRIVER
G
Geoff Levand 已提交
1283
	ps3_ohci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER);
G
Geoff Levand 已提交
1284
#endif
1285 1286 1287
#ifdef DEBUG
	debugfs_remove(ohci_debug_root);
#endif
1288
	clear_bit(USB_OHCI_LOADED, &usb_hcds_loaded);
1289 1290 1291
}
module_exit(ohci_hcd_mod_exit);