at91_usb-ohci.c

linux2.4下的USB驱动程序源代码

/*
 *  linux/drivers/at91/usb/at91_usb_ohci-at91.c
 *
 *  The outline of this code was taken from Brad Parkers <[e-mail]>
 *  original OHCI driver modifications, and reworked into a cleaner form
 *  by Russell King <[e-mail]>.
 */
#include <linux/module.h>
#include <linux/init.h>
#include <linux/sched.h>
#include <linux/ioport.h>
#include <linux/interrupt.h>
#include <linux/slab.h>
#include <linux/usb.h>

#include <asm/hardware.h>
#include <asm/irq.h>
#include <asm/io.h>

/*
  NOTE:
  The following is so that we don't have to include usb-ohci.h or pci.h as the
  usb-ohci.c driver needs these routines even when the architecture
  has no PCI bus...
*/

extern int __devinit hc_add_ohci(struct pci_dev *dev, int irq, void *membase,
	    unsigned long flags, void *ohci, const char *name,
	    const char *slot_name);
extern void hc_remove_ohci(void *ohci);

static void *at91_ohci;
AT91PS_UHP ohci_regs;

static int __init at91_ohci_init(void)
{
	int ret;

	ohci_regs = ioremap((unsigned long)AT91C_BASE_UHP, SZ_4K);
	if (!ohci_regs) {
		printk(KERN_ERR "at91_usb-ohci: ioremap failed\n");
		return -EIO;
	}

	/* Now, enable power to the USB */
        *AT91C_PIOA_OER = AT91C_PIO_PA28;  /* enable output */
        *AT91C_PIOA_PER = AT91C_PIO_PA28;  /* enable the pio */
        *AT91C_PIOA_SODR = AT91C_PIO_PA28;  /* set it */
        udelay (300);  /* MAX891L spec says wait for 200us */
	/* Now, enable the USB clock */
	*AT91C_PMC_SCER = AT91C_PMC_UHP;	/* enable system clock */
	*AT91C_PMC_PCER = 1 << AT91C_ID_UHP;	/* enable peripheral clock */

	/* Take Hc out of reset */
	ohci_regs->UHP_HcControl = 2 << 6;

	/* Initialise the generic OHCI driver. */
	ret = hc_add_ohci((struct pci_dev *) 1, AT91C_ID_UHP,
			  (void *)ohci_regs, 0, &at91_ohci,
			  "usb-ohci", "at91");
	if (ret)
		iounmap(ohci_regs);

	return ret;
}

static void __exit at91_ohci_exit(void)
{
	hc_remove_ohci(at91_ohci);

	/* Force UHP_Hc to reset */
	ohci_regs->UHP_HcControl = 0;

	 /* Stop the USB clock. */
	*AT91C_PMC_SCDR = AT91C_PMC_UHP;	/* disable system clock */
	*AT91C_PMC_PCDR = 1 << AT91C_ID_UHP;	/* disable peripheral clock */
	
	iounmap(ohci_regs);
}

module_init(at91_ohci_init);
module_exit(at91_ohci_exit);