| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 1 | /* | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 2 | * driver for NXP USB Host devices | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 3 | * | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 4 | * Currently supported OHCI host devices: | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 5 | * - NXP LPC32xx | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 6 | * | 
|  | 7 | * Authors: Dmitry Chigirev <source@mvista.com> | 
| David Brownell | dd9048a | 2006-12-05 03:18:31 -0800 | [diff] [blame] | 8 | *	    Vitaly Wool <vitalywool@gmail.com> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 9 | * | 
|  | 10 | * register initialization is based on code examples provided by Philips | 
|  | 11 | * Copyright (c) 2005 Koninklijke Philips Electronics N.V. | 
|  | 12 | * | 
|  | 13 | * NOTE: This driver does not have suspend/resume functionality | 
|  | 14 | * This driver is intended for engineering development purposes only | 
|  | 15 | * | 
|  | 16 | * 2005-2006 (c) MontaVista Software, Inc. This file is licensed under | 
|  | 17 | * the terms of the GNU General Public License version 2. This program | 
|  | 18 | * is licensed "as is" without any warranty of any kind, whether express | 
|  | 19 | * or implied. | 
|  | 20 | */ | 
|  | 21 | #include <linux/clk.h> | 
|  | 22 | #include <linux/platform_device.h> | 
|  | 23 | #include <linux/i2c.h> | 
| Roland Stigge | 2265efe | 2012-04-29 16:47:03 +0200 | [diff] [blame] | 24 | #include <linux/of.h> | 
| Roland Stigge | 73108aa | 2012-04-29 16:47:06 +0200 | [diff] [blame] | 25 | #include <linux/usb/isp1301.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/hardware.h> | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 28 | #include <asm/mach-types.h> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 29 | #include <asm/io.h> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 30 |  | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 31 | #include <mach/platform.h> | 
|  | 32 | #include <mach/irqs.h> | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 33 |  | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 34 | #define USB_CONFIG_BASE		0x31020000 | 
|  | 35 | #define PWRMAN_BASE		0x40004000 | 
|  | 36 |  | 
|  | 37 | #define USB_CTRL		IO_ADDRESS(PWRMAN_BASE + 0x64) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 38 |  | 
|  | 39 | /* USB_CTRL bit defines */ | 
|  | 40 | #define USB_SLAVE_HCLK_EN	(1 << 24) | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 41 | #define USB_DEV_NEED_CLK_EN	(1 << 22) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 42 | #define USB_HOST_NEED_CLK_EN	(1 << 21) | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 43 | #define PAD_CONTROL_LAST_DRIVEN	(1 << 19) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 44 |  | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 45 | #define USB_OTG_STAT_CONTROL	IO_ADDRESS(USB_CONFIG_BASE + 0x110) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 46 |  | 
|  | 47 | /* USB_OTG_STAT_CONTROL bit defines */ | 
|  | 48 | #define TRANSPARENT_I2C_EN	(1 << 7) | 
|  | 49 | #define HOST_EN			(1 << 0) | 
|  | 50 |  | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 51 | /* On LPC32xx, those are undefined */ | 
|  | 52 | #ifndef start_int_set_falling_edge | 
|  | 53 | #define start_int_set_falling_edge(irq) | 
|  | 54 | #define start_int_set_rising_edge(irq) | 
|  | 55 | #define start_int_ack(irq) | 
|  | 56 | #define start_int_mask(irq) | 
|  | 57 | #define start_int_umask(irq) | 
|  | 58 | #endif | 
|  | 59 |  | 
| Jean Delvare | 09ce497 | 2009-10-01 19:03:13 +0200 | [diff] [blame] | 60 | static struct i2c_client *isp1301_i2c_client; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 61 |  | 
|  | 62 | extern int usb_disabled(void); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 63 |  | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 64 | static struct clk *usb_pll_clk; | 
|  | 65 | static struct clk *usb_dev_clk; | 
|  | 66 | static struct clk *usb_otg_clk; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 67 |  | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 68 | static void isp1301_configure_lpc32xx(void) | 
|  | 69 | { | 
|  | 70 | /* LPC32XX only supports DAT_SE0 USB mode */ | 
|  | 71 | /* This sequence is important */ | 
|  | 72 |  | 
|  | 73 | /* Disable transparent UART mode first */ | 
|  | 74 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 75 | (ISP1301_I2C_MODE_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR), | 
|  | 76 | MC1_UART_EN); | 
|  | 77 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 78 | (ISP1301_I2C_MODE_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR), | 
|  | 79 | ~MC1_SPEED_REG); | 
|  | 80 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 81 | ISP1301_I2C_MODE_CONTROL_1, MC1_SPEED_REG); | 
|  | 82 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 83 | (ISP1301_I2C_MODE_CONTROL_2 | ISP1301_I2C_REG_CLEAR_ADDR), | 
|  | 84 | ~0); | 
|  | 85 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 86 | ISP1301_I2C_MODE_CONTROL_2, | 
|  | 87 | (MC2_BI_DI | MC2_PSW_EN | MC2_SPD_SUSP_CTRL)); | 
|  | 88 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 89 | (ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR), ~0); | 
|  | 90 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 91 | ISP1301_I2C_MODE_CONTROL_1, MC1_DAT_SE0); | 
|  | 92 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 93 | ISP1301_I2C_OTG_CONTROL_1, | 
|  | 94 | (OTG1_DM_PULLDOWN | OTG1_DP_PULLDOWN)); | 
|  | 95 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 96 | (ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR), | 
|  | 97 | (OTG1_DM_PULLUP | OTG1_DP_PULLUP)); | 
|  | 98 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 99 | ISP1301_I2C_INTERRUPT_LATCH | ISP1301_I2C_REG_CLEAR_ADDR, ~0); | 
|  | 100 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 101 | ISP1301_I2C_INTERRUPT_FALLING | ISP1301_I2C_REG_CLEAR_ADDR, | 
|  | 102 | ~0); | 
|  | 103 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 104 | ISP1301_I2C_INTERRUPT_RISING | ISP1301_I2C_REG_CLEAR_ADDR, ~0); | 
|  | 105 |  | 
|  | 106 | /* Enable usb_need_clk clock after transceiver is initialized */ | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 107 | __raw_writel(__raw_readl(USB_CTRL) | USB_HOST_NEED_CLK_EN, USB_CTRL); | 
| Roland Stigge | 53dc25a | 2012-03-12 22:54:51 +0100 | [diff] [blame] | 108 |  | 
|  | 109 | printk(KERN_INFO "ISP1301 Vendor ID  : 0x%04x\n", | 
|  | 110 | i2c_smbus_read_word_data(isp1301_i2c_client, 0x00)); | 
|  | 111 | printk(KERN_INFO "ISP1301 Product ID : 0x%04x\n", | 
|  | 112 | i2c_smbus_read_word_data(isp1301_i2c_client, 0x02)); | 
|  | 113 | printk(KERN_INFO "ISP1301 Version ID : 0x%04x\n", | 
|  | 114 | i2c_smbus_read_word_data(isp1301_i2c_client, 0x14)); | 
|  | 115 | } | 
|  | 116 |  | 
|  | 117 | static void isp1301_configure(void) | 
|  | 118 | { | 
| Roland Stigge | d684f05 | 2012-08-26 16:30:37 +0200 | [diff] [blame] | 119 | isp1301_configure_lpc32xx(); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 120 | } | 
|  | 121 |  | 
|  | 122 | static inline void isp1301_vbus_on(void) | 
|  | 123 | { | 
| Roland Stigge | a6a3600 | 2012-03-12 22:54:52 +0100 | [diff] [blame] | 124 | i2c_smbus_write_byte_data(isp1301_i2c_client, ISP1301_I2C_OTG_CONTROL_1, | 
|  | 125 | OTG1_VBUS_DRV); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 126 | } | 
|  | 127 |  | 
|  | 128 | static inline void isp1301_vbus_off(void) | 
|  | 129 | { | 
| Roland Stigge | a6a3600 | 2012-03-12 22:54:52 +0100 | [diff] [blame] | 130 | i2c_smbus_write_byte_data(isp1301_i2c_client, | 
|  | 131 | ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR, | 
|  | 132 | OTG1_VBUS_DRV); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 133 | } | 
|  | 134 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 135 | static void nxp_start_hc(void) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 136 | { | 
|  | 137 | unsigned long tmp = __raw_readl(USB_OTG_STAT_CONTROL) | HOST_EN; | 
|  | 138 | __raw_writel(tmp, USB_OTG_STAT_CONTROL); | 
|  | 139 | isp1301_vbus_on(); | 
|  | 140 | } | 
|  | 141 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 142 | static void nxp_stop_hc(void) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 143 | { | 
|  | 144 | unsigned long tmp; | 
|  | 145 | isp1301_vbus_off(); | 
|  | 146 | tmp = __raw_readl(USB_OTG_STAT_CONTROL) & ~HOST_EN; | 
|  | 147 | __raw_writel(tmp, USB_OTG_STAT_CONTROL); | 
|  | 148 | } | 
|  | 149 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 150 | static int __devinit ohci_nxp_start(struct usb_hcd *hcd) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 151 | { | 
|  | 152 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | 
|  | 153 | int ret; | 
|  | 154 |  | 
|  | 155 | if ((ret = ohci_init(ohci)) < 0) | 
|  | 156 | return ret; | 
|  | 157 |  | 
|  | 158 | if ((ret = ohci_run(ohci)) < 0) { | 
|  | 159 | dev_err(hcd->self.controller, "can't start\n"); | 
|  | 160 | ohci_stop(hcd); | 
|  | 161 | return ret; | 
|  | 162 | } | 
|  | 163 | return 0; | 
|  | 164 | } | 
|  | 165 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 166 | static const struct hc_driver ohci_nxp_hc_driver = { | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 167 | .description = hcd_name, | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 168 | .product_desc =		"nxp OHCI", | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 169 |  | 
|  | 170 | /* | 
|  | 171 | * generic hardware linkage | 
|  | 172 | */ | 
|  | 173 | .irq = ohci_irq, | 
|  | 174 | .flags = HCD_USB11 | HCD_MEMORY, | 
|  | 175 |  | 
|  | 176 | .hcd_priv_size =	sizeof(struct ohci_hcd), | 
|  | 177 | /* | 
|  | 178 | * basic lifecycle operations | 
|  | 179 | */ | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 180 | .start = ohci_nxp_start, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 181 | .stop = ohci_stop, | 
| David Brownell | 8442ae0 | 2006-10-02 07:20:10 -0700 | [diff] [blame] | 182 | .shutdown = ohci_shutdown, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 183 |  | 
|  | 184 | /* | 
|  | 185 | * managing i/o requests and associated device resources | 
|  | 186 | */ | 
|  | 187 | .urb_enqueue = ohci_urb_enqueue, | 
|  | 188 | .urb_dequeue = ohci_urb_dequeue, | 
|  | 189 | .endpoint_disable = ohci_endpoint_disable, | 
|  | 190 |  | 
|  | 191 | /* | 
|  | 192 | * scheduling support | 
|  | 193 | */ | 
|  | 194 | .get_frame_number = ohci_get_frame, | 
|  | 195 |  | 
|  | 196 | /* | 
|  | 197 | * root hub support | 
|  | 198 | */ | 
|  | 199 | .hub_status_data = ohci_hub_status_data, | 
|  | 200 | .hub_control = ohci_hub_control, | 
| David Brownell | 8442ae0 | 2006-10-02 07:20:10 -0700 | [diff] [blame] | 201 | #ifdef	CONFIG_PM | 
|  | 202 | .bus_suspend = ohci_bus_suspend, | 
|  | 203 | .bus_resume = ohci_bus_resume, | 
|  | 204 | #endif | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 205 | .start_port_reset = ohci_start_port_reset, | 
|  | 206 | }; | 
|  | 207 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 208 | static int __devinit usb_hcd_nxp_probe(struct platform_device *pdev) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 209 | { | 
|  | 210 | struct usb_hcd *hcd = 0; | 
|  | 211 | struct ohci_hcd *ohci; | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 212 | const struct hc_driver *driver = &ohci_nxp_hc_driver; | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 213 | struct resource *res; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 214 | int ret = 0, irq; | 
| Roland Stigge | 73108aa | 2012-04-29 16:47:06 +0200 | [diff] [blame] | 215 | struct device_node *isp1301_node; | 
|  | 216 |  | 
|  | 217 | if (pdev->dev.of_node) { | 
|  | 218 | isp1301_node = of_parse_phandle(pdev->dev.of_node, | 
|  | 219 | "transceiver", 0); | 
|  | 220 | } else { | 
|  | 221 | isp1301_node = NULL; | 
|  | 222 | } | 
|  | 223 |  | 
|  | 224 | isp1301_i2c_client = isp1301_get_client(isp1301_node); | 
|  | 225 | if (!isp1301_i2c_client) { | 
|  | 226 | ret = -EPROBE_DEFER; | 
|  | 227 | goto out; | 
|  | 228 | } | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 229 |  | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 230 | pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32); | 
|  | 231 | pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; | 
|  | 232 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 233 | dev_dbg(&pdev->dev, "%s: " DRIVER_DESC " (nxp)\n", hcd_name); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 234 | if (usb_disabled()) { | 
| Greg Kroah-Hartman | b6c227e | 2012-04-27 11:24:41 -0700 | [diff] [blame] | 235 | dev_err(&pdev->dev, "USB is disabled\n"); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 236 | ret = -ENODEV; | 
|  | 237 | goto out; | 
|  | 238 | } | 
|  | 239 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 240 | /* Enable AHB slave USB clock, needed for further USB clock control */ | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 241 | __raw_writel(USB_SLAVE_HCLK_EN | PAD_CONTROL_LAST_DRIVEN, USB_CTRL); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 242 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 243 | /* Enable USB PLL */ | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 244 | usb_pll_clk = clk_get(&pdev->dev, "ck_pll5"); | 
|  | 245 | if (IS_ERR(usb_pll_clk)) { | 
| Greg Kroah-Hartman | b6c227e | 2012-04-27 11:24:41 -0700 | [diff] [blame] | 246 | dev_err(&pdev->dev, "failed to acquire USB PLL\n"); | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 247 | ret = PTR_ERR(usb_pll_clk); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 248 | goto out1; | 
|  | 249 | } | 
|  | 250 |  | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 251 | ret = clk_enable(usb_pll_clk); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 252 | if (ret < 0) { | 
| Greg Kroah-Hartman | b6c227e | 2012-04-27 11:24:41 -0700 | [diff] [blame] | 253 | dev_err(&pdev->dev, "failed to start USB PLL\n"); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 254 | goto out2; | 
|  | 255 | } | 
|  | 256 |  | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 257 | ret = clk_set_rate(usb_pll_clk, 48000); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 258 | if (ret < 0) { | 
| Greg Kroah-Hartman | b6c227e | 2012-04-27 11:24:41 -0700 | [diff] [blame] | 259 | dev_err(&pdev->dev, "failed to set USB clock rate\n"); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 260 | goto out3; | 
|  | 261 | } | 
|  | 262 |  | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 263 | /* Enable USB device clock */ | 
|  | 264 | usb_dev_clk = clk_get(&pdev->dev, "ck_usbd"); | 
|  | 265 | if (IS_ERR(usb_dev_clk)) { | 
|  | 266 | dev_err(&pdev->dev, "failed to acquire USB DEV Clock\n"); | 
|  | 267 | ret = PTR_ERR(usb_dev_clk); | 
|  | 268 | goto out4; | 
|  | 269 | } | 
|  | 270 |  | 
|  | 271 | ret = clk_enable(usb_dev_clk); | 
|  | 272 | if (ret < 0) { | 
|  | 273 | dev_err(&pdev->dev, "failed to start USB DEV Clock\n"); | 
|  | 274 | goto out5; | 
|  | 275 | } | 
|  | 276 |  | 
|  | 277 | /* Enable USB otg clocks */ | 
|  | 278 | usb_otg_clk = clk_get(&pdev->dev, "ck_usb_otg"); | 
|  | 279 | if (IS_ERR(usb_otg_clk)) { | 
|  | 280 | dev_err(&pdev->dev, "failed to acquire USB DEV Clock\n"); | 
| Julia Lawall | 2ec15a6 | 2012-08-25 21:57:07 +0200 | [diff] [blame] | 281 | ret = PTR_ERR(usb_otg_clk); | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 282 | goto out6; | 
|  | 283 | } | 
|  | 284 |  | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 285 | __raw_writel(__raw_readl(USB_CTRL) | USB_HOST_NEED_CLK_EN, USB_CTRL); | 
|  | 286 |  | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 287 | ret = clk_enable(usb_otg_clk); | 
|  | 288 | if (ret < 0) { | 
|  | 289 | dev_err(&pdev->dev, "failed to start USB DEV Clock\n"); | 
|  | 290 | goto out7; | 
|  | 291 | } | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 292 |  | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 293 | isp1301_configure(); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 294 |  | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 295 | hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev)); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 296 | if (!hcd) { | 
| Greg Kroah-Hartman | b6c227e | 2012-04-27 11:24:41 -0700 | [diff] [blame] | 297 | dev_err(&pdev->dev, "Failed to allocate HC buffer\n"); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 298 | ret = -ENOMEM; | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 299 | goto out8; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 300 | } | 
|  | 301 |  | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 302 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 
|  | 303 | if (!res) { | 
|  | 304 | dev_err(&pdev->dev, "Failed to get MEM resource\n"); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 305 | ret =  -ENOMEM; | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 306 | goto out8; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 307 | } | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 308 |  | 
|  | 309 | hcd->regs = devm_request_and_ioremap(&pdev->dev, res); | 
|  | 310 | if (!hcd->regs) { | 
|  | 311 | dev_err(&pdev->dev, "Failed to devm_request_and_ioremap\n"); | 
|  | 312 | ret =  -ENOMEM; | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 313 | goto out8; | 
| Roland Stigge | a6a99cf | 2012-04-29 16:47:02 +0200 | [diff] [blame] | 314 | } | 
|  | 315 | hcd->rsrc_start = res->start; | 
|  | 316 | hcd->rsrc_len = resource_size(res); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 317 |  | 
|  | 318 | irq = platform_get_irq(pdev, 0); | 
|  | 319 | if (irq < 0) { | 
|  | 320 | ret = -ENXIO; | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 321 | goto out8; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 322 | } | 
|  | 323 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 324 | nxp_start_hc(); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 325 | platform_set_drvdata(pdev, hcd); | 
|  | 326 | ohci = hcd_to_ohci(hcd); | 
|  | 327 | ohci_hcd_init(ohci); | 
|  | 328 |  | 
|  | 329 | dev_info(&pdev->dev, "at 0x%p, irq %d\n", hcd->regs, hcd->irq); | 
| Yong Zhang | b5dd18d | 2011-09-07 16:10:52 +0800 | [diff] [blame] | 330 | ret = usb_add_hcd(hcd, irq, 0); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 331 | if (ret == 0) | 
|  | 332 | return ret; | 
|  | 333 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 334 | nxp_stop_hc(); | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 335 | out8: | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 336 | usb_put_hcd(hcd); | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 337 | out7: | 
|  | 338 | clk_disable(usb_otg_clk); | 
|  | 339 | out6: | 
|  | 340 | clk_put(usb_otg_clk); | 
|  | 341 | out5: | 
|  | 342 | clk_disable(usb_dev_clk); | 
|  | 343 | out4: | 
|  | 344 | clk_put(usb_dev_clk); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 345 | out3: | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 346 | clk_disable(usb_pll_clk); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 347 | out2: | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 348 | clk_put(usb_pll_clk); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 349 | out1: | 
| Jean Delvare | 3a407e7 | 2008-11-13 18:57:53 +0100 | [diff] [blame] | 350 | isp1301_i2c_client = NULL; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 351 | out: | 
|  | 352 | return ret; | 
|  | 353 | } | 
|  | 354 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 355 | static int usb_hcd_nxp_remove(struct platform_device *pdev) | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 356 | { | 
|  | 357 | struct usb_hcd *hcd = platform_get_drvdata(pdev); | 
|  | 358 |  | 
|  | 359 | usb_remove_hcd(hcd); | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 360 | nxp_stop_hc(); | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 361 | release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | 
|  | 362 | usb_put_hcd(hcd); | 
| Alexandre Pereira da Silva | 78091dc | 2012-06-20 09:02:23 -0300 | [diff] [blame] | 363 | clk_disable(usb_pll_clk); | 
|  | 364 | clk_put(usb_pll_clk); | 
|  | 365 | clk_disable(usb_dev_clk); | 
|  | 366 | clk_put(usb_dev_clk); | 
| Luotao Fu | 8740cc7 | 2010-02-19 15:42:00 +0100 | [diff] [blame] | 367 | i2c_unregister_device(isp1301_i2c_client); | 
| Jean Delvare | 3a407e7 | 2008-11-13 18:57:53 +0100 | [diff] [blame] | 368 | isp1301_i2c_client = NULL; | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 369 |  | 
|  | 370 | platform_set_drvdata(pdev, NULL); | 
|  | 371 |  | 
|  | 372 | return 0; | 
|  | 373 | } | 
|  | 374 |  | 
| Kay Sievers | f4fce61 | 2008-04-10 21:29:22 -0700 | [diff] [blame] | 375 | /* work with hotplug and coldplug */ | 
|  | 376 | MODULE_ALIAS("platform:usb-ohci"); | 
|  | 377 |  | 
| Roland Stigge | 2265efe | 2012-04-29 16:47:03 +0200 | [diff] [blame] | 378 | #ifdef CONFIG_OF | 
|  | 379 | static const struct of_device_id usb_hcd_nxp_match[] = { | 
|  | 380 | { .compatible = "nxp,ohci-nxp" }, | 
|  | 381 | {}, | 
|  | 382 | }; | 
|  | 383 | MODULE_DEVICE_TABLE(of, usb_hcd_nxp_match); | 
|  | 384 | #endif | 
|  | 385 |  | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 386 | static struct platform_driver usb_hcd_nxp_driver = { | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 387 | .driver = { | 
|  | 388 | .name = "usb-ohci", | 
| Kay Sievers | f4fce61 | 2008-04-10 21:29:22 -0700 | [diff] [blame] | 389 | .owner	= THIS_MODULE, | 
| Roland Stigge | 2265efe | 2012-04-29 16:47:03 +0200 | [diff] [blame] | 390 | .of_match_table = of_match_ptr(usb_hcd_nxp_match), | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 391 | }, | 
| Roland Stigge | 2864310 | 2012-03-12 22:54:50 +0100 | [diff] [blame] | 392 | .probe = usb_hcd_nxp_probe, | 
|  | 393 | .remove = usb_hcd_nxp_remove, | 
| Vitaly Wool | 60bbfc8 | 2006-06-29 18:28:18 +0400 | [diff] [blame] | 394 | }; | 
|  | 395 |  |