| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 1 | /* | 
 | 2 |  * drivers/usb/host/ohci-pnx4008.c | 
 | 3 |  * | 
 | 4 |  * driver for Philips PNX4008 USB Host | 
 | 5 |  * | 
 | 6 |  * Authors: Dmitry Chigirev <source@mvista.com> | 
| David Brownell | dd9048a | 2006-12-05 03:18:31 -0800 | [diff] [blame] | 7 |  *	    Vitaly Wool <vitalywool@gmail.com> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 8 |  * | 
 | 9 |  * register initialization is based on code examples provided by Philips | 
 | 10 |  * Copyright (c) 2005 Koninklijke Philips Electronics N.V. | 
 | 11 |  * | 
 | 12 |  * NOTE: This driver does not have suspend/resume functionality | 
 | 13 |  * This driver is intended for engineering development purposes only | 
 | 14 |  * | 
 | 15 |  * 2005-2006 (c) MontaVista Software, Inc. This file is licensed under | 
 | 16 |  * the terms of the GNU General Public License version 2. This program | 
 | 17 |  * is licensed "as is" without any warranty of any kind, whether express | 
 | 18 |  * or implied. | 
 | 19 |  */ | 
 | 20 | #include <linux/clk.h> | 
 | 21 | #include <linux/platform_device.h> | 
 | 22 | #include <linux/i2c.h> | 
 | 23 |  | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 24 | #include <mach/hardware.h> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 25 | #include <asm/io.h> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 26 |  | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 27 | #include <mach/platform.h> | 
 | 28 | #include <mach/irqs.h> | 
 | 29 | #include <mach/gpio.h> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 30 |  | 
| David Brownell | dd9048a | 2006-12-05 03:18:31 -0800 | [diff] [blame] | 31 | #define USB_CTRL	IO_ADDRESS(PNX4008_PWRMAN_BASE + 0x64) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 32 |  | 
 | 33 | /* USB_CTRL bit defines */ | 
 | 34 | #define USB_SLAVE_HCLK_EN	(1 << 24) | 
 | 35 | #define USB_HOST_NEED_CLK_EN	(1 << 21) | 
 | 36 |  | 
 | 37 | #define USB_OTG_CLK_CTRL	IO_ADDRESS(PNX4008_USB_CONFIG_BASE + 0xFF4) | 
 | 38 | #define USB_OTG_CLK_STAT	IO_ADDRESS(PNX4008_USB_CONFIG_BASE + 0xFF8) | 
 | 39 |  | 
 | 40 | /* USB_OTG_CLK_CTRL bit defines */ | 
 | 41 | #define AHB_M_CLOCK_ON		(1 << 4) | 
 | 42 | #define OTG_CLOCK_ON		(1 << 3) | 
 | 43 | #define I2C_CLOCK_ON		(1 << 2) | 
 | 44 | #define DEV_CLOCK_ON		(1 << 1) | 
 | 45 | #define HOST_CLOCK_ON		(1 << 0) | 
 | 46 |  | 
 | 47 | #define USB_OTG_STAT_CONTROL	IO_ADDRESS(PNX4008_USB_CONFIG_BASE + 0x110) | 
 | 48 |  | 
 | 49 | /* USB_OTG_STAT_CONTROL bit defines */ | 
 | 50 | #define TRANSPARENT_I2C_EN	(1 << 7) | 
 | 51 | #define HOST_EN			(1 << 0) | 
 | 52 |  | 
 | 53 | /* ISP1301 USB transceiver I2C registers */ | 
 | 54 | #define	ISP1301_MODE_CONTROL_1		0x04	/* u8 read, set, +1 clear */ | 
 | 55 |  | 
 | 56 | #define	MC1_SPEED_REG		(1 << 0) | 
 | 57 | #define	MC1_SUSPEND_REG		(1 << 1) | 
 | 58 | #define	MC1_DAT_SE0		(1 << 2) | 
 | 59 | #define	MC1_TRANSPARENT		(1 << 3) | 
 | 60 | #define	MC1_BDIS_ACON_EN	(1 << 4) | 
 | 61 | #define	MC1_OE_INT_EN		(1 << 5) | 
 | 62 | #define	MC1_UART_EN		(1 << 6) | 
 | 63 | #define	MC1_MASK		0x7f | 
 | 64 |  | 
 | 65 | #define	ISP1301_MODE_CONTROL_2		0x12	/* u8 read, set, +1 clear */ | 
 | 66 |  | 
 | 67 | #define	MC2_GLOBAL_PWR_DN	(1 << 0) | 
 | 68 | #define	MC2_SPD_SUSP_CTRL	(1 << 1) | 
 | 69 | #define	MC2_BI_DI		(1 << 2) | 
 | 70 | #define	MC2_TRANSP_BDIR0	(1 << 3) | 
 | 71 | #define	MC2_TRANSP_BDIR1	(1 << 4) | 
 | 72 | #define	MC2_AUDIO_EN		(1 << 5) | 
 | 73 | #define	MC2_PSW_EN		(1 << 6) | 
 | 74 | #define	MC2_EN2V7		(1 << 7) | 
 | 75 |  | 
 | 76 | #define	ISP1301_OTG_CONTROL_1		0x06	/* u8 read, set, +1 clear */ | 
 | 77 | #	define	OTG1_DP_PULLUP		(1 << 0) | 
 | 78 | #	define	OTG1_DM_PULLUP		(1 << 1) | 
 | 79 | #	define	OTG1_DP_PULLDOWN	(1 << 2) | 
 | 80 | #	define	OTG1_DM_PULLDOWN	(1 << 3) | 
 | 81 | #	define	OTG1_ID_PULLDOWN	(1 << 4) | 
 | 82 | #	define	OTG1_VBUS_DRV		(1 << 5) | 
 | 83 | #	define	OTG1_VBUS_DISCHRG	(1 << 6) | 
 | 84 | #	define	OTG1_VBUS_CHRG		(1 << 7) | 
 | 85 | #define	ISP1301_OTG_STATUS		0x10	/* u8 readonly */ | 
 | 86 | #	define	OTG_B_SESS_END		(1 << 6) | 
 | 87 | #	define	OTG_B_SESS_VLD		(1 << 7) | 
 | 88 |  | 
 | 89 | #define ISP1301_I2C_ADDR 0x2C | 
 | 90 |  | 
 | 91 | #define ISP1301_I2C_MODE_CONTROL_1 0x4 | 
 | 92 | #define ISP1301_I2C_MODE_CONTROL_2 0x12 | 
 | 93 | #define ISP1301_I2C_OTG_CONTROL_1 0x6 | 
 | 94 | #define ISP1301_I2C_OTG_CONTROL_2 0x10 | 
 | 95 | #define ISP1301_I2C_INTERRUPT_SOURCE 0x8 | 
 | 96 | #define ISP1301_I2C_INTERRUPT_LATCH 0xA | 
 | 97 | #define ISP1301_I2C_INTERRUPT_FALLING 0xC | 
 | 98 | #define ISP1301_I2C_INTERRUPT_RISING 0xE | 
 | 99 | #define ISP1301_I2C_REG_CLEAR_ADDR 1 | 
 | 100 |  | 
 | 101 | struct i2c_driver isp1301_driver; | 
 | 102 | struct i2c_client *isp1301_i2c_client; | 
 | 103 |  | 
 | 104 | extern int usb_disabled(void); | 
 | 105 | extern int ocpi_enable(void); | 
 | 106 |  | 
 | 107 | static struct clk *usb_clk; | 
 | 108 |  | 
 | 109 | static int isp1301_probe(struct i2c_adapter *adap); | 
 | 110 | static int isp1301_detach(struct i2c_client *client); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 111 |  | 
| Jean Delvare | 2cdddeb | 2008-01-27 18:14:47 +0100 | [diff] [blame] | 112 | static const unsigned short normal_i2c[] = | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 113 |     { ISP1301_I2C_ADDR, ISP1301_I2C_ADDR + 1, I2C_CLIENT_END }; | 
| Jean Delvare | 2cdddeb | 2008-01-27 18:14:47 +0100 | [diff] [blame] | 114 | static const unsigned short dummy_i2c_addrlist[] = { I2C_CLIENT_END }; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 115 |  | 
 | 116 | static struct i2c_client_address_data addr_data = { | 
 | 117 | 	.normal_i2c = normal_i2c, | 
 | 118 | 	.probe = dummy_i2c_addrlist, | 
 | 119 | 	.ignore = dummy_i2c_addrlist, | 
 | 120 | }; | 
 | 121 |  | 
 | 122 | struct i2c_driver isp1301_driver = { | 
| Jean Delvare | 64b3d6d | 2008-06-18 14:46:27 +0200 | [diff] [blame] | 123 | 	.driver = { | 
 | 124 | 		.name = "isp1301_pnx", | 
 | 125 | 	}, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 126 | 	.attach_adapter = isp1301_probe, | 
 | 127 | 	.detach_client = isp1301_detach, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 128 | }; | 
 | 129 |  | 
 | 130 | static int isp1301_attach(struct i2c_adapter *adap, int addr, int kind) | 
 | 131 | { | 
 | 132 | 	struct i2c_client *c; | 
| Jean Delvare | 64b3d6d | 2008-06-18 14:46:27 +0200 | [diff] [blame] | 133 | 	int err; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 134 |  | 
| Suresh Jayaraman | 13f9966 | 2007-06-28 11:16:30 -0600 | [diff] [blame] | 135 | 	c = kzalloc(sizeof(*c), GFP_KERNEL); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 136 | 	if (!c) | 
 | 137 | 		return -ENOMEM; | 
 | 138 |  | 
| Jean Delvare | 64b3d6d | 2008-06-18 14:46:27 +0200 | [diff] [blame] | 139 | 	strlcpy(c->name, "isp1301_pnx", I2C_NAME_SIZE); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 140 | 	c->flags = 0; | 
 | 141 | 	c->addr = addr; | 
 | 142 | 	c->adapter = adap; | 
 | 143 | 	c->driver = &isp1301_driver; | 
 | 144 |  | 
| Jean Delvare | 64b3d6d | 2008-06-18 14:46:27 +0200 | [diff] [blame] | 145 | 	err = i2c_attach_client(c); | 
 | 146 | 	if (err) { | 
 | 147 | 		kfree(c); | 
 | 148 | 		return err; | 
 | 149 | 	} | 
 | 150 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 151 | 	isp1301_i2c_client = c; | 
 | 152 |  | 
| Jean Delvare | 64b3d6d | 2008-06-18 14:46:27 +0200 | [diff] [blame] | 153 | 	return 0; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 154 | } | 
 | 155 |  | 
 | 156 | static int isp1301_probe(struct i2c_adapter *adap) | 
 | 157 | { | 
 | 158 | 	return i2c_probe(adap, &addr_data, isp1301_attach); | 
 | 159 | } | 
 | 160 |  | 
 | 161 | static int isp1301_detach(struct i2c_client *client) | 
 | 162 | { | 
 | 163 | 	i2c_detach_client(client); | 
 | 164 | 	kfree(isp1301_i2c_client); | 
 | 165 | 	return 0; | 
 | 166 | } | 
 | 167 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 168 | static void i2c_write(u8 buf, u8 subaddr) | 
 | 169 | { | 
 | 170 | 	char tmpbuf[2]; | 
 | 171 |  | 
 | 172 | 	tmpbuf[0] = subaddr;	/*register number */ | 
 | 173 | 	tmpbuf[1] = buf;	/*register data */ | 
 | 174 | 	i2c_master_send(isp1301_i2c_client, &tmpbuf[0], 2); | 
 | 175 | } | 
 | 176 |  | 
 | 177 | static void isp1301_configure(void) | 
 | 178 | { | 
 | 179 | 	/* PNX4008 only supports DAT_SE0 USB mode */ | 
 | 180 | 	/* PNX4008 R2A requires setting the MAX603 to output 3.6V */ | 
 | 181 | 	/* Power up externel charge-pump */ | 
 | 182 |  | 
 | 183 | 	i2c_write(MC1_DAT_SE0 | MC1_SPEED_REG, ISP1301_I2C_MODE_CONTROL_1); | 
 | 184 | 	i2c_write(~(MC1_DAT_SE0 | MC1_SPEED_REG), | 
 | 185 | 		  ISP1301_I2C_MODE_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 186 | 	i2c_write(MC2_BI_DI | MC2_PSW_EN | MC2_SPD_SUSP_CTRL, | 
 | 187 | 		  ISP1301_I2C_MODE_CONTROL_2); | 
 | 188 | 	i2c_write(~(MC2_BI_DI | MC2_PSW_EN | MC2_SPD_SUSP_CTRL), | 
 | 189 | 		  ISP1301_I2C_MODE_CONTROL_2 | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 190 | 	i2c_write(OTG1_DM_PULLDOWN | OTG1_DP_PULLDOWN, | 
 | 191 | 		  ISP1301_I2C_OTG_CONTROL_1); | 
 | 192 | 	i2c_write(~(OTG1_DM_PULLDOWN | OTG1_DP_PULLDOWN), | 
 | 193 | 		  ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 194 | 	i2c_write(0xFF, | 
 | 195 | 		  ISP1301_I2C_INTERRUPT_LATCH | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 196 | 	i2c_write(0xFF, | 
 | 197 | 		  ISP1301_I2C_INTERRUPT_FALLING | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 198 | 	i2c_write(0xFF, | 
 | 199 | 		  ISP1301_I2C_INTERRUPT_RISING | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 200 |  | 
 | 201 | } | 
 | 202 |  | 
 | 203 | static inline void isp1301_vbus_on(void) | 
 | 204 | { | 
 | 205 | 	i2c_write(OTG1_VBUS_DRV, ISP1301_I2C_OTG_CONTROL_1); | 
 | 206 | } | 
 | 207 |  | 
 | 208 | static inline void isp1301_vbus_off(void) | 
 | 209 | { | 
 | 210 | 	i2c_write(OTG1_VBUS_DRV, | 
 | 211 | 		  ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR); | 
 | 212 | } | 
 | 213 |  | 
 | 214 | static void pnx4008_start_hc(void) | 
 | 215 | { | 
 | 216 | 	unsigned long tmp = __raw_readl(USB_OTG_STAT_CONTROL) | HOST_EN; | 
 | 217 | 	__raw_writel(tmp, USB_OTG_STAT_CONTROL); | 
 | 218 | 	isp1301_vbus_on(); | 
 | 219 | } | 
 | 220 |  | 
 | 221 | static void pnx4008_stop_hc(void) | 
 | 222 | { | 
 | 223 | 	unsigned long tmp; | 
 | 224 | 	isp1301_vbus_off(); | 
 | 225 | 	tmp = __raw_readl(USB_OTG_STAT_CONTROL) & ~HOST_EN; | 
 | 226 | 	__raw_writel(tmp, USB_OTG_STAT_CONTROL); | 
 | 227 | } | 
 | 228 |  | 
 | 229 | static int __devinit ohci_pnx4008_start(struct usb_hcd *hcd) | 
 | 230 | { | 
 | 231 | 	struct ohci_hcd *ohci = hcd_to_ohci(hcd); | 
 | 232 | 	int ret; | 
 | 233 |  | 
 | 234 | 	if ((ret = ohci_init(ohci)) < 0) | 
 | 235 | 		return ret; | 
 | 236 |  | 
 | 237 | 	if ((ret = ohci_run(ohci)) < 0) { | 
 | 238 | 		dev_err(hcd->self.controller, "can't start\n"); | 
 | 239 | 		ohci_stop(hcd); | 
 | 240 | 		return ret; | 
 | 241 | 	} | 
 | 242 | 	return 0; | 
 | 243 | } | 
 | 244 |  | 
 | 245 | static const struct hc_driver ohci_pnx4008_hc_driver = { | 
 | 246 | 	.description = hcd_name, | 
 | 247 | 	.product_desc =		"pnx4008 OHCI", | 
 | 248 |  | 
 | 249 | 	/* | 
 | 250 | 	 * generic hardware linkage | 
 | 251 | 	 */ | 
 | 252 | 	.irq = ohci_irq, | 
 | 253 | 	.flags = HCD_USB11 | HCD_MEMORY, | 
 | 254 |  | 
 | 255 | 	.hcd_priv_size =	sizeof(struct ohci_hcd), | 
 | 256 | 	/* | 
 | 257 | 	 * basic lifecycle operations | 
 | 258 | 	 */ | 
 | 259 | 	.start = ohci_pnx4008_start, | 
 | 260 | 	.stop = ohci_stop, | 
| David Brownell | 8442ae0 | 2006-10-02 07:20:10 -0700 | [diff] [blame] | 261 | 	.shutdown = ohci_shutdown, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 262 |  | 
 | 263 | 	/* | 
 | 264 | 	 * managing i/o requests and associated device resources | 
 | 265 | 	 */ | 
 | 266 | 	.urb_enqueue = ohci_urb_enqueue, | 
 | 267 | 	.urb_dequeue = ohci_urb_dequeue, | 
 | 268 | 	.endpoint_disable = ohci_endpoint_disable, | 
 | 269 |  | 
 | 270 | 	/* | 
 | 271 | 	 * scheduling support | 
 | 272 | 	 */ | 
 | 273 | 	.get_frame_number = ohci_get_frame, | 
 | 274 |  | 
 | 275 | 	/* | 
 | 276 | 	 * root hub support | 
 | 277 | 	 */ | 
 | 278 | 	.hub_status_data = ohci_hub_status_data, | 
 | 279 | 	.hub_control = ohci_hub_control, | 
| David Brownell | 8442ae0 | 2006-10-02 07:20:10 -0700 | [diff] [blame] | 280 | #ifdef	CONFIG_PM | 
 | 281 | 	.bus_suspend = ohci_bus_suspend, | 
 | 282 | 	.bus_resume = ohci_bus_resume, | 
 | 283 | #endif | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 284 | 	.start_port_reset = ohci_start_port_reset, | 
 | 285 | }; | 
 | 286 |  | 
 | 287 | #define USB_CLOCK_MASK (AHB_M_CLOCK_ON| OTG_CLOCK_ON | HOST_CLOCK_ON | I2C_CLOCK_ON) | 
 | 288 |  | 
 | 289 | static void pnx4008_set_usb_bits(void) | 
 | 290 | { | 
 | 291 | 	start_int_set_falling_edge(SE_USB_OTG_ATX_INT_N); | 
 | 292 | 	start_int_ack(SE_USB_OTG_ATX_INT_N); | 
 | 293 | 	start_int_umask(SE_USB_OTG_ATX_INT_N); | 
 | 294 |  | 
 | 295 | 	start_int_set_rising_edge(SE_USB_OTG_TIMER_INT); | 
 | 296 | 	start_int_ack(SE_USB_OTG_TIMER_INT); | 
 | 297 | 	start_int_umask(SE_USB_OTG_TIMER_INT); | 
 | 298 |  | 
 | 299 | 	start_int_set_rising_edge(SE_USB_I2C_INT); | 
 | 300 | 	start_int_ack(SE_USB_I2C_INT); | 
 | 301 | 	start_int_umask(SE_USB_I2C_INT); | 
 | 302 |  | 
 | 303 | 	start_int_set_rising_edge(SE_USB_INT); | 
 | 304 | 	start_int_ack(SE_USB_INT); | 
 | 305 | 	start_int_umask(SE_USB_INT); | 
 | 306 |  | 
 | 307 | 	start_int_set_rising_edge(SE_USB_NEED_CLK_INT); | 
 | 308 | 	start_int_ack(SE_USB_NEED_CLK_INT); | 
 | 309 | 	start_int_umask(SE_USB_NEED_CLK_INT); | 
 | 310 |  | 
 | 311 | 	start_int_set_rising_edge(SE_USB_AHB_NEED_CLK_INT); | 
 | 312 | 	start_int_ack(SE_USB_AHB_NEED_CLK_INT); | 
 | 313 | 	start_int_umask(SE_USB_AHB_NEED_CLK_INT); | 
 | 314 | } | 
 | 315 |  | 
 | 316 | static void pnx4008_unset_usb_bits(void) | 
 | 317 | { | 
 | 318 | 	start_int_mask(SE_USB_OTG_ATX_INT_N); | 
 | 319 | 	start_int_mask(SE_USB_OTG_TIMER_INT); | 
 | 320 | 	start_int_mask(SE_USB_I2C_INT); | 
 | 321 | 	start_int_mask(SE_USB_INT); | 
 | 322 | 	start_int_mask(SE_USB_NEED_CLK_INT); | 
 | 323 | 	start_int_mask(SE_USB_AHB_NEED_CLK_INT); | 
 | 324 | } | 
 | 325 |  | 
 | 326 | static int __devinit usb_hcd_pnx4008_probe(struct platform_device *pdev) | 
 | 327 | { | 
 | 328 | 	struct usb_hcd *hcd = 0; | 
 | 329 | 	struct ohci_hcd *ohci; | 
 | 330 | 	const struct hc_driver *driver = &ohci_pnx4008_hc_driver; | 
 | 331 |  | 
 | 332 | 	int ret = 0, irq; | 
 | 333 |  | 
| Alan Stern | 2b70f07 | 2008-10-02 11:47:15 -0400 | [diff] [blame] | 334 | 	dev_dbg(&pdev->dev, "%s: " DRIVER_DESC " (pnx4008)\n", hcd_name); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 335 | 	if (usb_disabled()) { | 
 | 336 | 		err("USB is disabled"); | 
 | 337 | 		ret = -ENODEV; | 
 | 338 | 		goto out; | 
 | 339 | 	} | 
 | 340 |  | 
 | 341 | 	if (pdev->num_resources != 2 | 
 | 342 | 	    || pdev->resource[0].flags != IORESOURCE_MEM | 
 | 343 | 	    || pdev->resource[1].flags != IORESOURCE_IRQ) { | 
 | 344 | 		err("Invalid resource configuration"); | 
 | 345 | 		ret = -ENODEV; | 
 | 346 | 		goto out; | 
 | 347 | 	} | 
 | 348 |  | 
 | 349 | 	/* Enable AHB slave USB clock, needed for further USB clock control */ | 
 | 350 | 	__raw_writel(USB_SLAVE_HCLK_EN | (1 << 19), USB_CTRL); | 
 | 351 |  | 
 | 352 | 	ret = i2c_add_driver(&isp1301_driver); | 
 | 353 | 	if (ret < 0) { | 
 | 354 | 		err("failed to connect I2C to ISP1301 USB Transceiver"); | 
 | 355 | 		goto out; | 
 | 356 | 	} | 
 | 357 |  | 
 | 358 | 	isp1301_configure(); | 
 | 359 |  | 
 | 360 | 	/* Enable USB PLL */ | 
 | 361 | 	usb_clk = clk_get(&pdev->dev, "ck_pll5"); | 
 | 362 | 	if (IS_ERR(usb_clk)) { | 
 | 363 | 		err("failed to acquire USB PLL"); | 
 | 364 | 		ret = PTR_ERR(usb_clk); | 
 | 365 | 		goto out1; | 
 | 366 | 	} | 
 | 367 |  | 
 | 368 | 	ret = clk_enable(usb_clk); | 
 | 369 | 	if (ret < 0) { | 
 | 370 | 		err("failed to start USB PLL"); | 
 | 371 | 		goto out2; | 
 | 372 | 	} | 
 | 373 |  | 
 | 374 | 	ret = clk_set_rate(usb_clk, 48000); | 
 | 375 | 	if (ret < 0) { | 
 | 376 | 		err("failed to set USB clock rate"); | 
 | 377 | 		goto out3; | 
 | 378 | 	} | 
 | 379 |  | 
 | 380 | 	__raw_writel(__raw_readl(USB_CTRL) | USB_HOST_NEED_CLK_EN, USB_CTRL); | 
 | 381 |  | 
 | 382 | 	/* Set to enable all needed USB clocks */ | 
 | 383 | 	__raw_writel(USB_CLOCK_MASK, USB_OTG_CLK_CTRL); | 
 | 384 |  | 
 | 385 | 	while ((__raw_readl(USB_OTG_CLK_STAT) & USB_CLOCK_MASK) != | 
 | 386 | 	       USB_CLOCK_MASK) ; | 
 | 387 |  | 
| Kay Sievers | 7071a3c | 2008-05-02 06:02:41 +0200 | [diff] [blame] | 388 | 	hcd = usb_create_hcd (driver, &pdev->dev, dev_name(&pdev->dev)); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 389 | 	if (!hcd) { | 
 | 390 | 		err("Failed to allocate HC buffer"); | 
 | 391 | 		ret = -ENOMEM; | 
 | 392 | 		goto out3; | 
 | 393 | 	} | 
 | 394 |  | 
 | 395 | 	/* Set all USB bits in the Start Enable register */ | 
 | 396 | 	pnx4008_set_usb_bits(); | 
 | 397 |  | 
 | 398 | 	hcd->rsrc_start = pdev->resource[0].start; | 
 | 399 | 	hcd->rsrc_len = pdev->resource[0].end - pdev->resource[0].start + 1; | 
 | 400 | 	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) { | 
 | 401 | 		dev_dbg(&pdev->dev, "request_mem_region failed\n"); | 
 | 402 | 		ret =  -ENOMEM; | 
 | 403 | 		goto out4; | 
 | 404 | 	} | 
 | 405 | 	hcd->regs = (void __iomem *)pdev->resource[0].start; | 
 | 406 |  | 
 | 407 | 	irq = platform_get_irq(pdev, 0); | 
 | 408 | 	if (irq < 0) { | 
 | 409 | 		ret = -ENXIO; | 
 | 410 | 		goto out4; | 
 | 411 | 	} | 
 | 412 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 413 | 	pnx4008_start_hc(); | 
 | 414 | 	platform_set_drvdata(pdev, hcd); | 
 | 415 | 	ohci = hcd_to_ohci(hcd); | 
 | 416 | 	ohci_hcd_init(ohci); | 
 | 417 |  | 
 | 418 | 	dev_info(&pdev->dev, "at 0x%p, irq %d\n", hcd->regs, hcd->irq); | 
| Thomas Gleixner | 38515e9 | 2007-02-14 00:33:16 -0800 | [diff] [blame] | 419 | 	ret = usb_add_hcd(hcd, irq, IRQF_DISABLED); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 420 | 	if (ret == 0) | 
 | 421 | 		return ret; | 
 | 422 |  | 
 | 423 | 	pnx4008_stop_hc(); | 
 | 424 | out4: | 
 | 425 | 	pnx4008_unset_usb_bits(); | 
 | 426 | 	usb_put_hcd(hcd); | 
 | 427 | out3: | 
 | 428 | 	clk_disable(usb_clk); | 
 | 429 | out2: | 
 | 430 | 	clk_put(usb_clk); | 
 | 431 | out1: | 
 | 432 | 	i2c_del_driver(&isp1301_driver); | 
 | 433 | out: | 
 | 434 | 	return ret; | 
 | 435 | } | 
 | 436 |  | 
 | 437 | static int usb_hcd_pnx4008_remove(struct platform_device *pdev) | 
 | 438 | { | 
 | 439 | 	struct usb_hcd *hcd = platform_get_drvdata(pdev); | 
 | 440 |  | 
 | 441 | 	usb_remove_hcd(hcd); | 
 | 442 | 	pnx4008_stop_hc(); | 
 | 443 | 	release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | 
 | 444 | 	usb_put_hcd(hcd); | 
 | 445 | 	pnx4008_unset_usb_bits(); | 
 | 446 | 	clk_disable(usb_clk); | 
 | 447 | 	clk_put(usb_clk); | 
 | 448 | 	i2c_del_driver(&isp1301_driver); | 
 | 449 |  | 
 | 450 | 	platform_set_drvdata(pdev, NULL); | 
 | 451 |  | 
 | 452 | 	return 0; | 
 | 453 | } | 
 | 454 |  | 
| Kay Sievers | f4fce61 | 2008-04-10 21:29:22 -0700 | [diff] [blame] | 455 | /* work with hotplug and coldplug */ | 
 | 456 | MODULE_ALIAS("platform:usb-ohci"); | 
 | 457 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 458 | static struct platform_driver usb_hcd_pnx4008_driver = { | 
 | 459 | 	.driver = { | 
 | 460 | 		.name = "usb-ohci", | 
| Kay Sievers | f4fce61 | 2008-04-10 21:29:22 -0700 | [diff] [blame] | 461 | 		.owner	= THIS_MODULE, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 462 | 	}, | 
 | 463 | 	.probe = usb_hcd_pnx4008_probe, | 
 | 464 | 	.remove = usb_hcd_pnx4008_remove, | 
 | 465 | }; | 
 | 466 |  |