Commit 4302a595 authored by Benjamin Herrenschmidt's avatar Benjamin Herrenschmidt Committed by Greg Kroah-Hartman
Browse files

USB: Rework the OHCI quirk mecanism as suggested by David 



This patch applies David Brownell's suggestion for reworking the
OHCI quirk mechanism via a table of PCI IDs. It adapts the existing
quirks to use that mechanism.

This also moves the quirks to reset() as suggested by the comment
in there. This is necessary as we need to have the endian properly
set before we try to init the controller.

Signed-off-by: default avatarBenjamin Herrenschmidt <benh@kernel.crashing.org>
Acked-by: default avatarDavid Brownell <dbrownell@users.sourceforge.net>
Acked-by: default avatarGeoff Levand <geoffrey.levand@am.sony.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 0873c764

drivers/usb/host/ohci-pci.c

+110 −63
Original line number Diff line number Diff line
@@ -20,80 +20,129 @@ 


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



static int

ohci_pci_reset (struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);



	ohci_hcd_init (ohci);

	return ohci_init (ohci);

}



static int __devinit

ohci_pci_start (struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);

	int		ret;



	/* REVISIT this whole block should move to reset(), which handles

	 * all the other one-time init.

	 */

	if (hcd->self.controller) {

		struct pci_dev *pdev = to_pci_dev(hcd->self.controller);



/* AMD 756, for most chips (early revs), corrupts register

 * values on read ... so enable the vendor workaround.

 */

		if (pdev->vendor == PCI_VENDOR_ID_AMD

				&& pdev->device == 0x740c) {

static int __devinit ohci_quirk_amd756(struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);



	ohci->flags = OHCI_QUIRK_AMD756;

	ohci_dbg (ohci, "AMD756 erratum 4 workaround\n");



	/* also erratum 10 (suspend/resume issues) */

	device_init_wakeup(&hcd->self.root_hub->dev, 0);

		}



		/* FIXME for some of the early AMD 760 southbridges, OHCI

		 * won't work at all.  blacklist them.

		 */

	return 0;

}



/* Apple's OHCI driver has a lot of bizarre workarounds

 * for this chip.  Evidently control and bulk lists

 * can get confused.  (B&W G3 models, and ...)

 */

		else if (pdev->vendor == PCI_VENDOR_ID_OPTI

				&& pdev->device == 0xc861) {

			ohci_dbg (ohci,

				"WARNING: OPTi workarounds unavailable\n");

static int __devinit ohci_quirk_opti(struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);



	ohci_dbg (ohci, "WARNING: OPTi workarounds unavailable\n");



	return 0;

}



/* Check for NSC87560. We have to look at the bridge (fn1) to

 * identify the USB (fn2). This quirk might apply to more or

 * even all NSC stuff.

 */

		else if (pdev->vendor == PCI_VENDOR_ID_NS) {

static int __devinit ohci_quirk_ns(struct usb_hcd *hcd)

{

	struct pci_dev *pdev = to_pci_dev(hcd->self.controller);

	struct pci_dev	*b;



			b  = pci_get_slot (pdev->bus,

					PCI_DEVFN (PCI_SLOT (pdev->devfn), 1));

	b  = pci_get_slot (pdev->bus, PCI_DEVFN (PCI_SLOT (pdev->devfn), 1));

	if (b && b->device == PCI_DEVICE_ID_NS_87560_LIO

	    && b->vendor == PCI_VENDOR_ID_NS) {

		struct ohci_hcd	*ohci = hcd_to_ohci (hcd);



		ohci->flags |= OHCI_QUIRK_SUPERIO;

		ohci_dbg (ohci, "Using NSC SuperIO setup\n");

	}

	pci_dev_put(b);



	return 0;

}



/* Check for Compaq's ZFMicro chipset, which needs short

 * delays before control or bulk queues get re-activated

 * in finish_unlinks()

 */

		else if (pdev->vendor == PCI_VENDOR_ID_COMPAQ

				&& pdev->device  == 0xa0f8) {

static int __devinit ohci_quirk_zfmicro(struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);



	ohci->flags |= OHCI_QUIRK_ZFMICRO;

			ohci_dbg (ohci,

				"enabled Compaq ZFMicro chipset quirk\n");

	ohci_dbg (ohci, "enabled Compaq ZFMicro chipset quirk\n");



	return 0;

}





/* List of quirks for OHCI */

static const struct pci_device_id ohci_pci_quirks[] = {

	{

		PCI_DEVICE(PCI_VENDOR_ID_AMD, 0x740c),

		.driver_data = (unsigned long)ohci_quirk_amd756,

	},

	{

		PCI_DEVICE(PCI_VENDOR_ID_OPTI, 0xc861),

		.driver_data = (unsigned long)ohci_quirk_opti,

	},

	{

		PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_ANY_ID),

		.driver_data = (unsigned long)ohci_quirk_ns,

	},

	{

		PCI_DEVICE(PCI_VENDOR_ID_COMPAQ, 0xa0f8),

		.driver_data = (unsigned long)ohci_quirk_zfmicro,

	},

	/* FIXME for some of the early AMD 760 southbridges, OHCI

	 * won't work at all.  blacklist them.

	 */

	{},

};



static int ohci_pci_reset (struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);

	int ret = 0;



	if (hcd->self.controller) {

		struct pci_dev *pdev = to_pci_dev(hcd->self.controller);

		const struct pci_device_id *quirk_id;



		quirk_id = pci_match_id(ohci_pci_quirks, pdev);

		if (quirk_id != NULL) {

			int (*quirk)(struct usb_hcd *ohci);

			quirk = (void *)quirk_id->driver_data;

			ret = quirk(hcd);

		}

	}

	if (ret == 0) {

		ohci_hcd_init (ohci);

		return ohci_init (ohci);

	}

	return ret;

}





static int __devinit ohci_pci_start (struct usb_hcd *hcd)

{

	struct ohci_hcd	*ohci = hcd_to_ohci (hcd);

	int		ret;



#ifdef CONFIG_PM /* avoid warnings about unused pdev */

	if (hcd->self.controller) {

		struct pci_dev *pdev = to_pci_dev(hcd->self.controller);



		/* RWC may not be set for add-in PCI cards, since boot

		 * firmware probably ignored them.  This transfers PCI

		 * PM wakeup capabilities (once the PCI layer is fixed).
@@ -101,16 +150,14 @@ ohci_pci_start (struct usb_hcd *hcd) 
		if (device_may_wakeup(&pdev->dev))

			ohci->hc_control |= OHCI_CTRL_RWC;

	}

#endif /* CONFIG_PM */



	/* NOTE: there may have already been a first reset, to

	 * keep bios/smm irqs from making trouble

	 */

	if ((ret = ohci_run (ohci)) < 0) {

	ret = ohci_run (ohci);

	if (ret < 0) {

		ohci_err (ohci, "can't start\n");

		ohci_stop (hcd);

		return ret;

	}

	return 0;

	return ret;

}



#ifdef	CONFIG_PM

CRA Git | Maintained and supported by SUSTech CRA and CCSE