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