 07fd296d3a
			
		
	
	
	07fd296d3a
	
	
	
		
			
			All boards, except Amstrad E3, mark USB config with __initdata. As a result, when you compile USB into modules, they will try to refer already released platform data and the behaviour is undefined. For example on Nokia 770, I get the following kernel panic when modprobing ohci-hcd: [ 3.462158] Unable to handle kernel paging request at virtual address e7fddef0 [ 3.477050] pgd = c3434000 [ 3.487365] [e7fddef0] *pgd=00000000 [ 3.498535] Internal error: Oops: 80000005 [#1] ARM [ 3.510955] Modules linked in: ohci_hcd(+) [ 3.522705] CPU: 0 Not tainted (3.7.0-770_tiny+ #5) [ 3.535552] PC is at 0xe7fddef0 [ 3.546508] LR is at ohci_omap_init+0x5c/0x144 [ohci_hcd] [ 3.560272] pc : [<e7fddef0>] lr : [<bf003140>] psr: a0000013 [ 3.560272] sp : c344bdb0 ip : c344bce0 fp : c344bdcc [ 3.589782] r10: 00000001 r9 : 00000000 r8 : 00000000 [ 3.604553] r7 : 00000026 r6 : 000000de r5 : c0227300 r4 : c342d620 [ 3.621032] r3 : e7fddef0 r2 : c048b880 r1 : 00000000 r0 : 0000000a [ 3.637786] Flags: NzCv IRQs on FIQs on Mode SVC_32 ISA ARM Segment user [ 3.655822] Control: 0005317f Table: 13434000 DAC: 00000015 [ 3.672790] Process modprobe (pid: 425, stack limit = 0xc344a1b8) [ 3.690643] Stack: (0xc344bdb0 to 0xc344c000) [ 3.707031] bda0: bf0030e4 c342d620 00000000 c049e62c [ 3.727905] bdc0: c344be04 c344bdd0 c0150ff0 bf0030f4 bf001b88 00000000 c048a4ac c345b020 [ 3.748870] bde0: c342d620 00000000 c048a468 bf003968 00000001 bf006000 c344be34 c344be08 [ 3.769836] be00: bf001bf0 c0150e48 00000000 c344be18 c00b9bfc c048a478 c048a4ac bf0037f8 [ 3.790985] be20: c012ca04 c000e024 c344be44 c344be38 c012d968 bf001a84 c344be64 c344be48 [ 3.812164] be40: c012c8ac c012d95c 00000000 c048a478 c048a4ac bf0037f8 c344be84 c344be68 [ 3.833740] be60: c012ca74 c012c80c 20000013 00000000 c344be88 bf0037f8 c344beac c344be88 [ 3.855468] be80: c012b038 c012ca14 c38093cc c383ee10 bf0037f8 c35be5a0 c049d5e8 00000000 [ 3.877166] bea0: c344bebc c344beb0 c012c40c c012aff4 c344beec c344bec0 c012bfc0 c012c3fc [ 3.898834] bec0: bf00378c 00000000 c344beec bf0037f8 00067f39 00000000 00005c44 c000e024 [ 3.920837] bee0: c344bf14 c344bef0 c012cd54 c012befc c04ce080 00067f39 00000000 00005c44 [ 3.943023] bf00: c000e024 bf006000 c344bf24 c344bf18 c012db14 c012ccc0 c344bf3c c344bf28 [ 3.965423] bf20: bf00604c c012dad8 c344a000 bf003834 c344bf7c c344bf40 c00087ac bf006010 [ 3.987976] bf40: 0000000f bf003834 00067f39 00000000 00005c44 bf003834 00067f39 00000000 [ 4.010711] bf60: 00005c44 c000e024 c344a000 00000000 c344bfa4 c344bf80 c004c35c c0008720 [ 4.033569] bf80: c344bfac c344bf90 01422192 01427ea0 00000000 00000080 00000000 c344bfa8 [ 4.056518] bfa0: c000dec0 c004c2f0 01422192 01427ea0 01427ea0 00005c44 00067f39 00000000 [ 4.079406] bfc0: 01422192 01427ea0 00000000 00000080 b6e11008 014221aa be941fcc b6e1e008 [ 4.102569] bfe0: b6ef6300 be941758 0000e93c b6ef6310 60000010 01427ea0 00000000 00000000 [ 4.125946] Backtrace: [ 4.143463] [<bf0030e4>] (ohci_omap_init+0x0/0x144 [ohci_hcd]) from [<c0150ff0>] (usb_add_hcd+0x1b8/0x61c) [ 4.183898] r6:c049e62c r5:00000000 r4:c342d620 r3:bf0030e4 [ 4.205596] [<c0150e38>] (usb_add_hcd+0x0/0x61c) from [<bf001bf0>] (ohci_hcd_omap_drv_probe+0x17c/0x224 [ohci_hcd]) [ 4.248138] [<bf001a74>] (ohci_hcd_omap_drv_probe+0x0/0x224 [ohci_hcd]) from [<c012d968>] (platform_drv_probe+0x1c/0x20) [ 4.292144] r8:c000e024 r7:c012ca04 r6:bf0037f8 r5:c048a4ac r4:c048a478 [ 4.316192] [<c012d94c>] (platform_drv_probe+0x0/0x20) from [<c012c8ac>] (driver_probe_device+0xb0/0x208) [ 4.360168] [<c012c7fc>] (driver_probe_device+0x0/0x208) from [<c012ca74>] (__driver_attach+0x70/0x94) [ 4.405548] r6:bf0037f8 r5:c048a4ac r4:c048a478 r3:00000000 [ 4.429809] [<c012ca04>] (__driver_attach+0x0/0x94) from [<c012b038>] (bus_for_each_dev+0x54/0x90) [ 4.475708] r6:bf0037f8 r5:c344be88 r4:00000000 r3:20000013 [ 4.500366] [<c012afe4>] (bus_for_each_dev+0x0/0x90) from [<c012c40c>] (driver_attach+0x20/0x28) [ 4.528442] r7:00000000 r6:c049d5e8 r5:c35be5a0 r4:bf0037f8 [ 4.553466] [<c012c3ec>] (driver_attach+0x0/0x28) from [<c012bfc0>] (bus_add_driver+0xd4/0x228) [ 4.581878] [<c012beec>] (bus_add_driver+0x0/0x228) from [<c012cd54>] (driver_register+0xa4/0x134) [ 4.629730] r8:c000e024 r7:00005c44 r6:00000000 r5:00067f39 r4:bf0037f8 [ 4.656738] [<c012ccb0>] (driver_register+0x0/0x134) from [<c012db14>] (platform_driver_register+0x4c/0x60) [ 4.706542] [<c012dac8>] (platform_driver_register+0x0/0x60) from [<bf00604c>] (ohci_hcd_mod_init+0x4c/0x8c [ohci_hcd]) [ 4.757843] [<bf006000>] (ohci_hcd_mod_init+0x0/0x8c [ohci_hcd]) from [<c00087ac>] (do_one_initcall+0x9c/0x174) [ 4.808990] r4:bf003834 r3:c344a000 [ 4.832641] [<c0008710>] (do_one_initcall+0x0/0x174) from [<c004c35c>] (sys_init_module+0x7c/0x194) [ 4.881530] [<c004c2e0>] (sys_init_module+0x0/0x194) from [<c000dec0>] (ret_fast_syscall+0x0/0x2c) [ 4.930664] r7:00000080 r6:00000000 r5:01427ea0 r4:01422192 [ 4.956481] Code: bad PC value [ 4.978729] ---[ end trace 58280240f08342c4 ]--- [ 5.002258] Kernel panic - not syncing: Fatal exception Fix this by taking a copy of the data. Also mark Amstrad E3's data with __initdata to save some memory with multi-board kernels. Signed-off-by: Aaro Koskinen <aaro.koskinen@iki.fi> Signed-off-by: Tony Lindgren <tony@atomide.com>
		
			
				
	
	
		
			653 lines
		
	
	
	
		
			15 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			653 lines
		
	
	
	
		
			15 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Platform level USB initialization for FS USB OTG controller on omap1 and 24xx
 | |
|  *
 | |
|  * Copyright (C) 2004 Texas Instruments, Inc.
 | |
|  *
 | |
|  * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/io.h>
 | |
| 
 | |
| #include <asm/irq.h>
 | |
| 
 | |
| #include <mach/mux.h>
 | |
| 
 | |
| #include <mach/usb.h>
 | |
| 
 | |
| #include "common.h"
 | |
| 
 | |
| /* These routines should handle the standard chip-specific modes
 | |
|  * for usb0/1/2 ports, covering basic mux and transceiver setup.
 | |
|  *
 | |
|  * Some board-*.c files will need to set up additional mux options,
 | |
|  * like for suspend handling, vbus sensing, GPIOs, and the D+ pullup.
 | |
|  */
 | |
| 
 | |
| /* TESTED ON:
 | |
|  *  - 1611B H2 (with usb1 mini-AB) using standard Mini-B or OTG cables
 | |
|  *  - 5912 OSK OHCI (with usb0 standard-A), standard A-to-B cables
 | |
|  *  - 5912 OSK UDC, with *nonstandard* A-to-A cable
 | |
|  *  - 1510 Innovator UDC with bundled usb0 cable
 | |
|  *  - 1510 Innovator OHCI with bundled usb1/usb2 cable
 | |
|  *  - 1510 Innovator OHCI with custom usb0 cable, feeding 5V VBUS
 | |
|  *  - 1710 custom development board using alternate pin group
 | |
|  *  - 1710 H3 (with usb1 mini-AB) using standard Mini-B or OTG cables
 | |
|  */
 | |
| 
 | |
| #define INT_USB_IRQ_GEN		IH2_BASE + 20
 | |
| #define INT_USB_IRQ_NISO	IH2_BASE + 30
 | |
| #define INT_USB_IRQ_ISO		IH2_BASE + 29
 | |
| #define INT_USB_IRQ_HGEN	INT_USB_HHC_1
 | |
| #define INT_USB_IRQ_OTG		IH2_BASE + 8
 | |
| 
 | |
| #ifdef	CONFIG_ARCH_OMAP_OTG
 | |
| 
 | |
| void __init
 | |
| omap_otg_init(struct omap_usb_config *config)
 | |
| {
 | |
| 	u32		syscon;
 | |
| 	int		alt_pingroup = 0;
 | |
| 
 | |
| 	/* NOTE:  no bus or clock setup (yet?) */
 | |
| 
 | |
| 	syscon = omap_readl(OTG_SYSCON_1) & 0xffff;
 | |
| 	if (!(syscon & OTG_RESET_DONE))
 | |
| 		pr_debug("USB resets not complete?\n");
 | |
| 
 | |
| 	//omap_writew(0, OTG_IRQ_EN);
 | |
| 
 | |
| 	/* pin muxing and transceiver pinouts */
 | |
| 	if (config->pins[0] > 2)	/* alt pingroup 2 */
 | |
| 		alt_pingroup = 1;
 | |
| 	syscon |= config->usb0_init(config->pins[0], is_usb0_device(config));
 | |
| 	syscon |= config->usb1_init(config->pins[1]);
 | |
| 	syscon |= config->usb2_init(config->pins[2], alt_pingroup);
 | |
| 	pr_debug("OTG_SYSCON_1 = %08x\n", omap_readl(OTG_SYSCON_1));
 | |
| 	omap_writel(syscon, OTG_SYSCON_1);
 | |
| 
 | |
| 	syscon = config->hmc_mode;
 | |
| 	syscon |= USBX_SYNCHRO | (4 << 16) /* B_ASE0_BRST */;
 | |
| #ifdef	CONFIG_USB_OTG
 | |
| 	if (config->otg)
 | |
| 		syscon |= OTG_EN;
 | |
| #endif
 | |
| 	if (cpu_class_is_omap1())
 | |
| 		pr_debug("USB_TRANSCEIVER_CTRL = %03x\n",
 | |
| 			 omap_readl(USB_TRANSCEIVER_CTRL));
 | |
| 	pr_debug("OTG_SYSCON_2 = %08x\n", omap_readl(OTG_SYSCON_2));
 | |
| 	omap_writel(syscon, OTG_SYSCON_2);
 | |
| 
 | |
| 	printk("USB: hmc %d", config->hmc_mode);
 | |
| 	if (!alt_pingroup)
 | |
| 		printk(", usb2 alt %d wires", config->pins[2]);
 | |
| 	else if (config->pins[0])
 | |
| 		printk(", usb0 %d wires%s", config->pins[0],
 | |
| 			is_usb0_device(config) ? " (dev)" : "");
 | |
| 	if (config->pins[1])
 | |
| 		printk(", usb1 %d wires", config->pins[1]);
 | |
| 	if (!alt_pingroup && config->pins[2])
 | |
| 		printk(", usb2 %d wires", config->pins[2]);
 | |
| 	if (config->otg)
 | |
| 		printk(", Mini-AB on usb%d", config->otg - 1);
 | |
| 	printk("\n");
 | |
| 
 | |
| 	if (cpu_class_is_omap1()) {
 | |
| 		u16 w;
 | |
| 
 | |
| 		/* leave USB clocks/controllers off until needed */
 | |
| 		w = omap_readw(ULPD_SOFT_REQ);
 | |
| 		w &= ~SOFT_USB_CLK_REQ;
 | |
| 		omap_writew(w, ULPD_SOFT_REQ);
 | |
| 
 | |
| 		w = omap_readw(ULPD_CLOCK_CTRL);
 | |
| 		w &= ~USB_MCLK_EN;
 | |
| 		w |= DIS_USB_PVCI_CLK;
 | |
| 		omap_writew(w, ULPD_CLOCK_CTRL);
 | |
| 	}
 | |
| 	syscon = omap_readl(OTG_SYSCON_1);
 | |
| 	syscon |= HST_IDLE_EN|DEV_IDLE_EN|OTG_IDLE_EN;
 | |
| 
 | |
| #ifdef	CONFIG_USB_GADGET_OMAP
 | |
| 	if (config->otg || config->register_dev) {
 | |
| 		struct platform_device *udc_device = config->udc_device;
 | |
| 		int status;
 | |
| 
 | |
| 		syscon &= ~DEV_IDLE_EN;
 | |
| 		udc_device->dev.platform_data = config;
 | |
| 		status = platform_device_register(udc_device);
 | |
| 		if (status)
 | |
| 			pr_debug("can't register UDC device, %d\n", status);
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| #if	defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE)
 | |
| 	if (config->otg || config->register_host) {
 | |
| 		struct platform_device *ohci_device = config->ohci_device;
 | |
| 		int status;
 | |
| 
 | |
| 		syscon &= ~HST_IDLE_EN;
 | |
| 		ohci_device->dev.platform_data = config;
 | |
| 		status = platform_device_register(ohci_device);
 | |
| 		if (status)
 | |
| 			pr_debug("can't register OHCI device, %d\n", status);
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| #ifdef	CONFIG_USB_OTG
 | |
| 	if (config->otg) {
 | |
| 		struct platform_device *otg_device = config->otg_device;
 | |
| 		int status;
 | |
| 
 | |
| 		syscon &= ~OTG_IDLE_EN;
 | |
| 		otg_device->dev.platform_data = config;
 | |
| 		status = platform_device_register(otg_device);
 | |
| 		if (status)
 | |
| 			pr_debug("can't register OTG device, %d\n", status);
 | |
| 	}
 | |
| #endif
 | |
| 	pr_debug("OTG_SYSCON_1 = %08x\n", omap_readl(OTG_SYSCON_1));
 | |
| 	omap_writel(syscon, OTG_SYSCON_1);
 | |
| }
 | |
| 
 | |
| #else
 | |
| void omap_otg_init(struct omap_usb_config *config) {}
 | |
| #endif
 | |
| 
 | |
| #ifdef	CONFIG_USB_GADGET_OMAP
 | |
| 
 | |
| static struct resource udc_resources[] = {
 | |
| 	/* order is significant! */
 | |
| 	{		/* registers */
 | |
| 		.start		= UDC_BASE,
 | |
| 		.end		= UDC_BASE + 0xff,
 | |
| 		.flags		= IORESOURCE_MEM,
 | |
| 	}, {		/* general IRQ */
 | |
| 		.start		= INT_USB_IRQ_GEN,
 | |
| 		.flags		= IORESOURCE_IRQ,
 | |
| 	}, {		/* PIO IRQ */
 | |
| 		.start		= INT_USB_IRQ_NISO,
 | |
| 		.flags		= IORESOURCE_IRQ,
 | |
| 	}, {		/* SOF IRQ */
 | |
| 		.start		= INT_USB_IRQ_ISO,
 | |
| 		.flags		= IORESOURCE_IRQ,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static u64 udc_dmamask = ~(u32)0;
 | |
| 
 | |
| static struct platform_device udc_device = {
 | |
| 	.name		= "omap_udc",
 | |
| 	.id		= -1,
 | |
| 	.dev = {
 | |
| 		.dma_mask		= &udc_dmamask,
 | |
| 		.coherent_dma_mask	= 0xffffffff,
 | |
| 	},
 | |
| 	.num_resources	= ARRAY_SIZE(udc_resources),
 | |
| 	.resource	= udc_resources,
 | |
| };
 | |
| 
 | |
| static inline void udc_device_init(struct omap_usb_config *pdata)
 | |
| {
 | |
| 	/* IRQ numbers for omap7xx */
 | |
| 	if(cpu_is_omap7xx()) {
 | |
| 		udc_resources[1].start = INT_7XX_USB_GENI;
 | |
| 		udc_resources[2].start = INT_7XX_USB_NON_ISO;
 | |
| 		udc_resources[3].start = INT_7XX_USB_ISO;
 | |
| 	}
 | |
| 	pdata->udc_device = &udc_device;
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| static inline void udc_device_init(struct omap_usb_config *pdata)
 | |
| {
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 | |
| #if	defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE)
 | |
| 
 | |
| /* The dmamask must be set for OHCI to work */
 | |
| static u64 ohci_dmamask = ~(u32)0;
 | |
| 
 | |
| static struct resource ohci_resources[] = {
 | |
| 	{
 | |
| 		.start	= OMAP_OHCI_BASE,
 | |
| 		.end	= OMAP_OHCI_BASE + 0xff,
 | |
| 		.flags	= IORESOURCE_MEM,
 | |
| 	},
 | |
| 	{
 | |
| 		.start	= INT_USB_IRQ_HGEN,
 | |
| 		.flags	= IORESOURCE_IRQ,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static struct platform_device ohci_device = {
 | |
| 	.name			= "ohci",
 | |
| 	.id			= -1,
 | |
| 	.dev = {
 | |
| 		.dma_mask		= &ohci_dmamask,
 | |
| 		.coherent_dma_mask	= 0xffffffff,
 | |
| 	},
 | |
| 	.num_resources	= ARRAY_SIZE(ohci_resources),
 | |
| 	.resource		= ohci_resources,
 | |
| };
 | |
| 
 | |
| static inline void ohci_device_init(struct omap_usb_config *pdata)
 | |
| {
 | |
| 	if (cpu_is_omap7xx())
 | |
| 		ohci_resources[1].start = INT_7XX_USB_HHC_1;
 | |
| 	pdata->ohci_device = &ohci_device;
 | |
| 	pdata->ocpi_enable = &ocpi_enable;
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| static inline void ohci_device_init(struct omap_usb_config *pdata)
 | |
| {
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 | |
| #if	defined(CONFIG_USB_OTG) && defined(CONFIG_ARCH_OMAP_OTG)
 | |
| 
 | |
| static struct resource otg_resources[] = {
 | |
| 	/* order is significant! */
 | |
| 	{
 | |
| 		.start		= OTG_BASE,
 | |
| 		.end		= OTG_BASE + 0xff,
 | |
| 		.flags		= IORESOURCE_MEM,
 | |
| 	}, {
 | |
| 		.start		= INT_USB_IRQ_OTG,
 | |
| 		.flags		= IORESOURCE_IRQ,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static struct platform_device otg_device = {
 | |
| 	.name		= "omap_otg",
 | |
| 	.id		= -1,
 | |
| 	.num_resources	= ARRAY_SIZE(otg_resources),
 | |
| 	.resource	= otg_resources,
 | |
| };
 | |
| 
 | |
| static inline void otg_device_init(struct omap_usb_config *pdata)
 | |
| {
 | |
| 	if (cpu_is_omap7xx())
 | |
| 		otg_resources[1].start = INT_7XX_USB_OTG;
 | |
| 	pdata->otg_device = &otg_device;
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| static inline void otg_device_init(struct omap_usb_config *pdata)
 | |
| {
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 | |
| static u32 __init omap1_usb0_init(unsigned nwires, unsigned is_device)
 | |
| {
 | |
| 	u32	syscon1 = 0;
 | |
| 
 | |
| 	if (nwires == 0) {
 | |
| 		if (!cpu_is_omap15xx()) {
 | |
| 			u32 l;
 | |
| 
 | |
| 			/* pulldown D+/D- */
 | |
| 			l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 			l &= ~(3 << 1);
 | |
| 			omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 		}
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (is_device) {
 | |
| 		if (cpu_is_omap7xx()) {
 | |
| 			omap_cfg_reg(AA17_7XX_USB_DM);
 | |
| 			omap_cfg_reg(W16_7XX_USB_PU_EN);
 | |
| 			omap_cfg_reg(W17_7XX_USB_VBUSI);
 | |
| 			omap_cfg_reg(W18_7XX_USB_DMCK_OUT);
 | |
| 			omap_cfg_reg(W19_7XX_USB_DCRST);
 | |
| 		} else
 | |
| 			omap_cfg_reg(W4_USB_PUEN);
 | |
| 	}
 | |
| 
 | |
| 	if (nwires == 2) {
 | |
| 		u32 l;
 | |
| 
 | |
| 		// omap_cfg_reg(P9_USB_DP);
 | |
| 		// omap_cfg_reg(R8_USB_DM);
 | |
| 
 | |
| 		if (cpu_is_omap15xx()) {
 | |
| 			/* This works on 1510-Innovator */
 | |
| 			return 0;
 | |
| 		}
 | |
| 
 | |
| 		/* NOTES:
 | |
| 		 *  - peripheral should configure VBUS detection!
 | |
| 		 *  - only peripherals may use the internal D+/D- pulldowns
 | |
| 		 *  - OTG support on this port not yet written
 | |
| 		 */
 | |
| 
 | |
| 		/* Don't do this for omap7xx -- it causes USB to not work correctly */
 | |
| 		if (!cpu_is_omap7xx()) {
 | |
| 			l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 			l &= ~(7 << 4);
 | |
| 			if (!is_device)
 | |
| 				l |= (3 << 1);
 | |
| 			omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 		}
 | |
| 
 | |
| 		return 3 << 16;
 | |
| 	}
 | |
| 
 | |
| 	/* alternate pin config, external transceiver */
 | |
| 	if (cpu_is_omap15xx()) {
 | |
| 		printk(KERN_ERR "no usb0 alt pin config on 15xx\n");
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	omap_cfg_reg(V6_USB0_TXD);
 | |
| 	omap_cfg_reg(W9_USB0_TXEN);
 | |
| 	omap_cfg_reg(W5_USB0_SE0);
 | |
| 	if (nwires != 3)
 | |
| 		omap_cfg_reg(Y5_USB0_RCV);
 | |
| 
 | |
| 	/* NOTE:  SPEED and SUSP aren't configured here.  OTG hosts
 | |
| 	 * may be able to use I2C requests to set those bits along
 | |
| 	 * with VBUS switching and overcurrent detection.
 | |
| 	 */
 | |
| 
 | |
| 	if (nwires != 6) {
 | |
| 		u32 l;
 | |
| 
 | |
| 		l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 		l &= ~CONF_USB2_UNI_R;
 | |
| 		omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 	}
 | |
| 
 | |
| 	switch (nwires) {
 | |
| 	case 3:
 | |
| 		syscon1 = 2;
 | |
| 		break;
 | |
| 	case 4:
 | |
| 		syscon1 = 1;
 | |
| 		break;
 | |
| 	case 6:
 | |
| 		syscon1 = 3;
 | |
| 		{
 | |
| 			u32 l;
 | |
| 
 | |
| 			omap_cfg_reg(AA9_USB0_VP);
 | |
| 			omap_cfg_reg(R9_USB0_VM);
 | |
| 			l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 			l |= CONF_USB2_UNI_R;
 | |
| 			omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 		}
 | |
| 		break;
 | |
| 	default:
 | |
| 		printk(KERN_ERR "illegal usb%d %d-wire transceiver\n",
 | |
| 			0, nwires);
 | |
| 	}
 | |
| 
 | |
| 	return syscon1 << 16;
 | |
| }
 | |
| 
 | |
| static u32 __init omap1_usb1_init(unsigned nwires)
 | |
| {
 | |
| 	u32	syscon1 = 0;
 | |
| 
 | |
| 	if (!cpu_is_omap15xx() && nwires != 6) {
 | |
| 		u32 l;
 | |
| 
 | |
| 		l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 		l &= ~CONF_USB1_UNI_R;
 | |
| 		omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 	}
 | |
| 	if (nwires == 0)
 | |
| 		return 0;
 | |
| 
 | |
| 	/* external transceiver */
 | |
| 	omap_cfg_reg(USB1_TXD);
 | |
| 	omap_cfg_reg(USB1_TXEN);
 | |
| 	if (nwires != 3)
 | |
| 		omap_cfg_reg(USB1_RCV);
 | |
| 
 | |
| 	if (cpu_is_omap15xx()) {
 | |
| 		omap_cfg_reg(USB1_SEO);
 | |
| 		omap_cfg_reg(USB1_SPEED);
 | |
| 		// SUSP
 | |
| 	} else if (cpu_is_omap1610() || cpu_is_omap5912()) {
 | |
| 		omap_cfg_reg(W13_1610_USB1_SE0);
 | |
| 		omap_cfg_reg(R13_1610_USB1_SPEED);
 | |
| 		// SUSP
 | |
| 	} else if (cpu_is_omap1710()) {
 | |
| 		omap_cfg_reg(R13_1710_USB1_SE0);
 | |
| 		// SUSP
 | |
| 	} else {
 | |
| 		pr_debug("usb%d cpu unrecognized\n", 1);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	switch (nwires) {
 | |
| 	case 2:
 | |
| 		goto bad;
 | |
| 	case 3:
 | |
| 		syscon1 = 2;
 | |
| 		break;
 | |
| 	case 4:
 | |
| 		syscon1 = 1;
 | |
| 		break;
 | |
| 	case 6:
 | |
| 		syscon1 = 3;
 | |
| 		omap_cfg_reg(USB1_VP);
 | |
| 		omap_cfg_reg(USB1_VM);
 | |
| 		if (!cpu_is_omap15xx()) {
 | |
| 			u32 l;
 | |
| 
 | |
| 			l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 			l |= CONF_USB1_UNI_R;
 | |
| 			omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 		}
 | |
| 		break;
 | |
| 	default:
 | |
| bad:
 | |
| 		printk(KERN_ERR "illegal usb%d %d-wire transceiver\n",
 | |
| 			1, nwires);
 | |
| 	}
 | |
| 
 | |
| 	return syscon1 << 20;
 | |
| }
 | |
| 
 | |
| static u32 __init omap1_usb2_init(unsigned nwires, unsigned alt_pingroup)
 | |
| {
 | |
| 	u32	syscon1 = 0;
 | |
| 
 | |
| 	/* NOTE omap1 erratum: must leave USB2_UNI_R set if usb0 in use */
 | |
| 	if (alt_pingroup || nwires == 0)
 | |
| 		return 0;
 | |
| 
 | |
| 	if (!cpu_is_omap15xx() && nwires != 6) {
 | |
| 		u32 l;
 | |
| 
 | |
| 		l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 		l &= ~CONF_USB2_UNI_R;
 | |
| 		omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 	}
 | |
| 
 | |
| 	/* external transceiver */
 | |
| 	if (cpu_is_omap15xx()) {
 | |
| 		omap_cfg_reg(USB2_TXD);
 | |
| 		omap_cfg_reg(USB2_TXEN);
 | |
| 		omap_cfg_reg(USB2_SEO);
 | |
| 		if (nwires != 3)
 | |
| 			omap_cfg_reg(USB2_RCV);
 | |
| 		/* there is no USB2_SPEED */
 | |
| 	} else if (cpu_is_omap16xx()) {
 | |
| 		omap_cfg_reg(V6_USB2_TXD);
 | |
| 		omap_cfg_reg(W9_USB2_TXEN);
 | |
| 		omap_cfg_reg(W5_USB2_SE0);
 | |
| 		if (nwires != 3)
 | |
| 			omap_cfg_reg(Y5_USB2_RCV);
 | |
| 		// FIXME omap_cfg_reg(USB2_SPEED);
 | |
| 	} else {
 | |
| 		pr_debug("usb%d cpu unrecognized\n", 1);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	// omap_cfg_reg(USB2_SUSP);
 | |
| 
 | |
| 	switch (nwires) {
 | |
| 	case 2:
 | |
| 		goto bad;
 | |
| 	case 3:
 | |
| 		syscon1 = 2;
 | |
| 		break;
 | |
| 	case 4:
 | |
| 		syscon1 = 1;
 | |
| 		break;
 | |
| 	case 5:
 | |
| 		goto bad;
 | |
| 	case 6:
 | |
| 		syscon1 = 3;
 | |
| 		if (cpu_is_omap15xx()) {
 | |
| 			omap_cfg_reg(USB2_VP);
 | |
| 			omap_cfg_reg(USB2_VM);
 | |
| 		} else {
 | |
| 			u32 l;
 | |
| 
 | |
| 			omap_cfg_reg(AA9_USB2_VP);
 | |
| 			omap_cfg_reg(R9_USB2_VM);
 | |
| 			l = omap_readl(USB_TRANSCEIVER_CTRL);
 | |
| 			l |= CONF_USB2_UNI_R;
 | |
| 			omap_writel(l, USB_TRANSCEIVER_CTRL);
 | |
| 		}
 | |
| 		break;
 | |
| 	default:
 | |
| bad:
 | |
| 		printk(KERN_ERR "illegal usb%d %d-wire transceiver\n",
 | |
| 			2, nwires);
 | |
| 	}
 | |
| 
 | |
| 	return syscon1 << 24;
 | |
| }
 | |
| 
 | |
| #ifdef	CONFIG_ARCH_OMAP15XX
 | |
| 
 | |
| /* ULPD_DPLL_CTRL */
 | |
| #define DPLL_IOB		(1 << 13)
 | |
| #define DPLL_PLL_ENABLE		(1 << 4)
 | |
| #define DPLL_LOCK		(1 << 0)
 | |
| 
 | |
| /* ULPD_APLL_CTRL */
 | |
| #define APLL_NDPLL_SWITCH	(1 << 0)
 | |
| 
 | |
| static void __init omap_1510_usb_init(struct omap_usb_config *config)
 | |
| {
 | |
| 	unsigned int val;
 | |
| 	u16 w;
 | |
| 
 | |
| 	config->usb0_init(config->pins[0], is_usb0_device(config));
 | |
| 	config->usb1_init(config->pins[1]);
 | |
| 	config->usb2_init(config->pins[2], 0);
 | |
| 
 | |
| 	val = omap_readl(MOD_CONF_CTRL_0) & ~(0x3f << 1);
 | |
| 	val |= (config->hmc_mode << 1);
 | |
| 	omap_writel(val, MOD_CONF_CTRL_0);
 | |
| 
 | |
| 	printk("USB: hmc %d", config->hmc_mode);
 | |
| 	if (config->pins[0])
 | |
| 		printk(", usb0 %d wires%s", config->pins[0],
 | |
| 			is_usb0_device(config) ? " (dev)" : "");
 | |
| 	if (config->pins[1])
 | |
| 		printk(", usb1 %d wires", config->pins[1]);
 | |
| 	if (config->pins[2])
 | |
| 		printk(", usb2 %d wires", config->pins[2]);
 | |
| 	printk("\n");
 | |
| 
 | |
| 	/* use DPLL for 48 MHz function clock */
 | |
| 	pr_debug("APLL %04x DPLL %04x REQ %04x\n", omap_readw(ULPD_APLL_CTRL),
 | |
| 			omap_readw(ULPD_DPLL_CTRL), omap_readw(ULPD_SOFT_REQ));
 | |
| 
 | |
| 	w = omap_readw(ULPD_APLL_CTRL);
 | |
| 	w &= ~APLL_NDPLL_SWITCH;
 | |
| 	omap_writew(w, ULPD_APLL_CTRL);
 | |
| 
 | |
| 	w = omap_readw(ULPD_DPLL_CTRL);
 | |
| 	w |= DPLL_IOB | DPLL_PLL_ENABLE;
 | |
| 	omap_writew(w, ULPD_DPLL_CTRL);
 | |
| 
 | |
| 	w = omap_readw(ULPD_SOFT_REQ);
 | |
| 	w |= SOFT_UDC_REQ | SOFT_DPLL_REQ;
 | |
| 	omap_writew(w, ULPD_SOFT_REQ);
 | |
| 
 | |
| 	while (!(omap_readw(ULPD_DPLL_CTRL) & DPLL_LOCK))
 | |
| 		cpu_relax();
 | |
| 
 | |
| #ifdef	CONFIG_USB_GADGET_OMAP
 | |
| 	if (config->register_dev) {
 | |
| 		int status;
 | |
| 
 | |
| 		udc_device.dev.platform_data = config;
 | |
| 		status = platform_device_register(&udc_device);
 | |
| 		if (status)
 | |
| 			pr_debug("can't register UDC device, %d\n", status);
 | |
| 		/* udc driver gates 48MHz by D+ pullup */
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| #if	defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE)
 | |
| 	if (config->register_host) {
 | |
| 		int status;
 | |
| 
 | |
| 		ohci_device.dev.platform_data = config;
 | |
| 		status = platform_device_register(&ohci_device);
 | |
| 		if (status)
 | |
| 			pr_debug("can't register OHCI device, %d\n", status);
 | |
| 		/* hcd explicitly gates 48MHz */
 | |
| 	}
 | |
| #endif
 | |
| }
 | |
| 
 | |
| #else
 | |
| static inline void omap_1510_usb_init(struct omap_usb_config *config) {}
 | |
| #endif
 | |
| 
 | |
| void __init omap1_usb_init(struct omap_usb_config *_pdata)
 | |
| {
 | |
| 	struct omap_usb_config *pdata;
 | |
| 
 | |
| 	pdata = kmemdup(_pdata, sizeof(*pdata), GFP_KERNEL);
 | |
| 	if (!pdata)
 | |
| 		return;
 | |
| 
 | |
| 	pdata->usb0_init = omap1_usb0_init;
 | |
| 	pdata->usb1_init = omap1_usb1_init;
 | |
| 	pdata->usb2_init = omap1_usb2_init;
 | |
| 	udc_device_init(pdata);
 | |
| 	ohci_device_init(pdata);
 | |
| 	otg_device_init(pdata);
 | |
| 
 | |
| 	if (cpu_is_omap7xx() || cpu_is_omap16xx())
 | |
| 		omap_otg_init(pdata);
 | |
| 	else if (cpu_is_omap15xx())
 | |
| 		omap_1510_usb_init(pdata);
 | |
| 	else
 | |
| 		printk(KERN_ERR "USB: No init for your chip yet\n");
 | |
| }
 |