| 1 | // SPDX-License-Identifier: GPL-1.0+ |
| 2 | /* |
| 3 | * OHCI HCD (Host Controller Driver) for USB. |
| 4 | * |
| 5 | * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at> |
| 6 | * (C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net> |
| 7 | * (C) Copyright 2002 Hewlett-Packard Company |
| 8 | * |
| 9 | * Bus Glue for pxa27x |
| 10 | * |
| 11 | * Written by Christopher Hoover <ch@hpl.hp.com> |
| 12 | * Based on fragments of previous driver by Russell King et al. |
| 13 | * |
| 14 | * Modified for LH7A404 from ohci-sa1111.c |
| 15 | * by Durgesh Pattamatta <pattamattad@sharpsec.com> |
| 16 | * |
| 17 | * Modified for pxa27x from ohci-lh7a404.c |
| 18 | * by Nick Bane <nick@cecomputing.co.uk> 26-8-2004 |
| 19 | * |
| 20 | * This file is licenced under the GPL. |
| 21 | */ |
| 22 | |
| 23 | #include <linux/clk.h> |
| 24 | #include <linux/device.h> |
| 25 | #include <linux/dma-mapping.h> |
| 26 | #include <linux/io.h> |
| 27 | #include <linux/kernel.h> |
| 28 | #include <linux/module.h> |
| 29 | #include <linux/of_platform.h> |
| 30 | #include <linux/platform_data/usb-ohci-pxa27x.h> |
| 31 | #include <linux/platform_data/pxa2xx_udc.h> |
| 32 | #include <linux/platform_device.h> |
| 33 | #include <linux/regulator/consumer.h> |
| 34 | #include <linux/signal.h> |
| 35 | #include <linux/usb.h> |
| 36 | #include <linux/usb/hcd.h> |
| 37 | #include <linux/usb/otg.h> |
| 38 | #include <linux/soc/pxa/cpu.h> |
| 39 | |
| 40 | #include "ohci.h" |
| 41 | |
| 42 | #define DRIVER_DESC "OHCI PXA27x/PXA3x driver" |
| 43 | |
| 44 | /* |
| 45 | * UHC: USB Host Controller (OHCI-like) register definitions |
| 46 | */ |
| 47 | #define UHCREV (0x0000) /* UHC HCI Spec Revision */ |
| 48 | #define UHCHCON (0x0004) /* UHC Host Control Register */ |
| 49 | #define UHCCOMS (0x0008) /* UHC Command Status Register */ |
| 50 | #define UHCINTS (0x000C) /* UHC Interrupt Status Register */ |
| 51 | #define UHCINTE (0x0010) /* UHC Interrupt Enable */ |
| 52 | #define UHCINTD (0x0014) /* UHC Interrupt Disable */ |
| 53 | #define UHCHCCA (0x0018) /* UHC Host Controller Comm. Area */ |
| 54 | #define UHCPCED (0x001C) /* UHC Period Current Endpt Descr */ |
| 55 | #define UHCCHED (0x0020) /* UHC Control Head Endpt Descr */ |
| 56 | #define UHCCCED (0x0024) /* UHC Control Current Endpt Descr */ |
| 57 | #define UHCBHED (0x0028) /* UHC Bulk Head Endpt Descr */ |
| 58 | #define UHCBCED (0x002C) /* UHC Bulk Current Endpt Descr */ |
| 59 | #define UHCDHEAD (0x0030) /* UHC Done Head */ |
| 60 | #define UHCFMI (0x0034) /* UHC Frame Interval */ |
| 61 | #define UHCFMR (0x0038) /* UHC Frame Remaining */ |
| 62 | #define UHCFMN (0x003C) /* UHC Frame Number */ |
| 63 | #define UHCPERS (0x0040) /* UHC Periodic Start */ |
| 64 | #define UHCLS (0x0044) /* UHC Low Speed Threshold */ |
| 65 | |
| 66 | #define UHCRHDA (0x0048) /* UHC Root Hub Descriptor A */ |
| 67 | #define UHCRHDA_NOCP (1 << 12) /* No over current protection */ |
| 68 | #define UHCRHDA_OCPM (1 << 11) /* Over Current Protection Mode */ |
| 69 | #define UHCRHDA_POTPGT(x) \ |
| 70 | (((x) & 0xff) << 24) /* Power On To Power Good Time */ |
| 71 | |
| 72 | #define UHCRHDB (0x004C) /* UHC Root Hub Descriptor B */ |
| 73 | #define UHCRHS (0x0050) /* UHC Root Hub Status */ |
| 74 | #define UHCRHPS1 (0x0054) /* UHC Root Hub Port 1 Status */ |
| 75 | #define UHCRHPS2 (0x0058) /* UHC Root Hub Port 2 Status */ |
| 76 | #define UHCRHPS3 (0x005C) /* UHC Root Hub Port 3 Status */ |
| 77 | |
| 78 | #define UHCSTAT (0x0060) /* UHC Status Register */ |
| 79 | #define UHCSTAT_UPS3 (1 << 16) /* USB Power Sense Port3 */ |
| 80 | #define UHCSTAT_SBMAI (1 << 15) /* System Bus Master Abort Interrupt*/ |
| 81 | #define UHCSTAT_SBTAI (1 << 14) /* System Bus Target Abort Interrupt*/ |
| 82 | #define UHCSTAT_UPRI (1 << 13) /* USB Port Resume Interrupt */ |
| 83 | #define UHCSTAT_UPS2 (1 << 12) /* USB Power Sense Port 2 */ |
| 84 | #define UHCSTAT_UPS1 (1 << 11) /* USB Power Sense Port 1 */ |
| 85 | #define UHCSTAT_HTA (1 << 10) /* HCI Target Abort */ |
| 86 | #define UHCSTAT_HBA (1 << 8) /* HCI Buffer Active */ |
| 87 | #define UHCSTAT_RWUE (1 << 7) /* HCI Remote Wake Up Event */ |
| 88 | |
| 89 | #define UHCHR (0x0064) /* UHC Reset Register */ |
| 90 | #define UHCHR_SSEP3 (1 << 11) /* Sleep Standby Enable for Port3 */ |
| 91 | #define UHCHR_SSEP2 (1 << 10) /* Sleep Standby Enable for Port2 */ |
| 92 | #define UHCHR_SSEP1 (1 << 9) /* Sleep Standby Enable for Port1 */ |
| 93 | #define UHCHR_PCPL (1 << 7) /* Power control polarity low */ |
| 94 | #define UHCHR_PSPL (1 << 6) /* Power sense polarity low */ |
| 95 | #define UHCHR_SSE (1 << 5) /* Sleep Standby Enable */ |
| 96 | #define UHCHR_UIT (1 << 4) /* USB Interrupt Test */ |
| 97 | #define UHCHR_SSDC (1 << 3) /* Simulation Scale Down Clock */ |
| 98 | #define UHCHR_CGR (1 << 2) /* Clock Generation Reset */ |
| 99 | #define UHCHR_FHR (1 << 1) /* Force Host Controller Reset */ |
| 100 | #define UHCHR_FSBIR (1 << 0) /* Force System Bus Iface Reset */ |
| 101 | |
| 102 | #define UHCHIE (0x0068) /* UHC Interrupt Enable Register*/ |
| 103 | #define UHCHIE_UPS3IE (1 << 14) /* Power Sense Port3 IntEn */ |
| 104 | #define UHCHIE_UPRIE (1 << 13) /* Port Resume IntEn */ |
| 105 | #define UHCHIE_UPS2IE (1 << 12) /* Power Sense Port2 IntEn */ |
| 106 | #define UHCHIE_UPS1IE (1 << 11) /* Power Sense Port1 IntEn */ |
| 107 | #define UHCHIE_TAIE (1 << 10) /* HCI Interface Transfer Abort |
| 108 | Interrupt Enable*/ |
| 109 | #define UHCHIE_HBAIE (1 << 8) /* HCI Buffer Active IntEn */ |
| 110 | #define UHCHIE_RWIE (1 << 7) /* Remote Wake-up IntEn */ |
| 111 | |
| 112 | #define UHCHIT (0x006C) /* UHC Interrupt Test register */ |
| 113 | |
| 114 | #define PXA_UHC_MAX_PORTNUM 3 |
| 115 | |
| 116 | static struct hc_driver __read_mostly ohci_pxa27x_hc_driver; |
| 117 | |
| 118 | struct pxa27x_ohci { |
| 119 | struct clk *clk; |
| 120 | void __iomem *mmio_base; |
| 121 | struct regulator *vbus[3]; |
| 122 | bool vbus_enabled[3]; |
| 123 | }; |
| 124 | |
| 125 | #define to_pxa27x_ohci(hcd) (struct pxa27x_ohci *)(hcd_to_ohci(hcd)->priv) |
| 126 | |
| 127 | /* |
| 128 | PMM_NPS_MODE -- PMM Non-power switching mode |
| 129 | Ports are powered continuously. |
| 130 | |
| 131 | PMM_GLOBAL_MODE -- PMM global switching mode |
| 132 | All ports are powered at the same time. |
| 133 | |
| 134 | PMM_PERPORT_MODE -- PMM per port switching mode |
| 135 | Ports are powered individually. |
| 136 | */ |
| 137 | static int pxa27x_ohci_select_pmm(struct pxa27x_ohci *pxa_ohci, int mode) |
| 138 | { |
| 139 | uint32_t uhcrhda = __raw_readl(addr: pxa_ohci->mmio_base + UHCRHDA); |
| 140 | uint32_t uhcrhdb = __raw_readl(addr: pxa_ohci->mmio_base + UHCRHDB); |
| 141 | |
| 142 | switch (mode) { |
| 143 | case PMM_NPS_MODE: |
| 144 | uhcrhda |= RH_A_NPS; |
| 145 | break; |
| 146 | case PMM_GLOBAL_MODE: |
| 147 | uhcrhda &= ~(RH_A_NPS | RH_A_PSM); |
| 148 | break; |
| 149 | case PMM_PERPORT_MODE: |
| 150 | uhcrhda &= ~(RH_A_NPS); |
| 151 | uhcrhda |= RH_A_PSM; |
| 152 | |
| 153 | /* Set port power control mask bits, only 3 ports. */ |
| 154 | uhcrhdb |= (0x7<<17); |
| 155 | break; |
| 156 | default: |
| 157 | printk( KERN_ERR |
| 158 | "Invalid mode %d, set to non-power switch mode.\n" , |
| 159 | mode ); |
| 160 | |
| 161 | uhcrhda |= RH_A_NPS; |
| 162 | } |
| 163 | |
| 164 | __raw_writel(val: uhcrhda, addr: pxa_ohci->mmio_base + UHCRHDA); |
| 165 | __raw_writel(val: uhcrhdb, addr: pxa_ohci->mmio_base + UHCRHDB); |
| 166 | return 0; |
| 167 | } |
| 168 | |
| 169 | static int pxa27x_ohci_set_vbus_power(struct pxa27x_ohci *pxa_ohci, |
| 170 | unsigned int port, bool enable) |
| 171 | { |
| 172 | struct regulator *vbus = pxa_ohci->vbus[port]; |
| 173 | int ret = 0; |
| 174 | |
| 175 | if (IS_ERR_OR_NULL(ptr: vbus)) |
| 176 | return 0; |
| 177 | |
| 178 | if (enable && !pxa_ohci->vbus_enabled[port]) |
| 179 | ret = regulator_enable(regulator: vbus); |
| 180 | else if (!enable && pxa_ohci->vbus_enabled[port]) |
| 181 | ret = regulator_disable(regulator: vbus); |
| 182 | |
| 183 | if (ret < 0) |
| 184 | return ret; |
| 185 | |
| 186 | pxa_ohci->vbus_enabled[port] = enable; |
| 187 | |
| 188 | return 0; |
| 189 | } |
| 190 | |
| 191 | static int pxa27x_ohci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, |
| 192 | u16 wIndex, char *buf, u16 wLength) |
| 193 | { |
| 194 | struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd); |
| 195 | int ret; |
| 196 | |
| 197 | switch (typeReq) { |
| 198 | case SetPortFeature: |
| 199 | case ClearPortFeature: |
| 200 | if (!wIndex || wIndex > 3) |
| 201 | return -EPIPE; |
| 202 | |
| 203 | if (wValue != USB_PORT_FEAT_POWER) |
| 204 | break; |
| 205 | |
| 206 | ret = pxa27x_ohci_set_vbus_power(pxa_ohci, port: wIndex - 1, |
| 207 | enable: typeReq == SetPortFeature); |
| 208 | if (ret) |
| 209 | return ret; |
| 210 | break; |
| 211 | } |
| 212 | |
| 213 | return ohci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength); |
| 214 | } |
| 215 | /*-------------------------------------------------------------------------*/ |
| 216 | |
| 217 | static inline void pxa27x_setup_hc(struct pxa27x_ohci *pxa_ohci, |
| 218 | struct pxaohci_platform_data *inf) |
| 219 | { |
| 220 | uint32_t uhchr = __raw_readl(addr: pxa_ohci->mmio_base + UHCHR); |
| 221 | uint32_t uhcrhda = __raw_readl(addr: pxa_ohci->mmio_base + UHCRHDA); |
| 222 | |
| 223 | if (inf->flags & ENABLE_PORT1) |
| 224 | uhchr &= ~UHCHR_SSEP1; |
| 225 | |
| 226 | if (inf->flags & ENABLE_PORT2) |
| 227 | uhchr &= ~UHCHR_SSEP2; |
| 228 | |
| 229 | if (inf->flags & ENABLE_PORT3) |
| 230 | uhchr &= ~UHCHR_SSEP3; |
| 231 | |
| 232 | if (inf->flags & POWER_CONTROL_LOW) |
| 233 | uhchr |= UHCHR_PCPL; |
| 234 | |
| 235 | if (inf->flags & POWER_SENSE_LOW) |
| 236 | uhchr |= UHCHR_PSPL; |
| 237 | |
| 238 | if (inf->flags & NO_OC_PROTECTION) |
| 239 | uhcrhda |= UHCRHDA_NOCP; |
| 240 | else |
| 241 | uhcrhda &= ~UHCRHDA_NOCP; |
| 242 | |
| 243 | if (inf->flags & OC_MODE_PERPORT) |
| 244 | uhcrhda |= UHCRHDA_OCPM; |
| 245 | else |
| 246 | uhcrhda &= ~UHCRHDA_OCPM; |
| 247 | |
| 248 | if (inf->power_on_delay) { |
| 249 | uhcrhda &= ~UHCRHDA_POTPGT(0xff); |
| 250 | uhcrhda |= UHCRHDA_POTPGT(inf->power_on_delay / 2); |
| 251 | } |
| 252 | |
| 253 | __raw_writel(val: uhchr, addr: pxa_ohci->mmio_base + UHCHR); |
| 254 | __raw_writel(val: uhcrhda, addr: pxa_ohci->mmio_base + UHCRHDA); |
| 255 | } |
| 256 | |
| 257 | static inline void pxa27x_reset_hc(struct pxa27x_ohci *pxa_ohci) |
| 258 | { |
| 259 | uint32_t uhchr = __raw_readl(addr: pxa_ohci->mmio_base + UHCHR); |
| 260 | |
| 261 | __raw_writel(val: uhchr | UHCHR_FHR, addr: pxa_ohci->mmio_base + UHCHR); |
| 262 | udelay(usec: 11); |
| 263 | __raw_writel(val: uhchr & ~UHCHR_FHR, addr: pxa_ohci->mmio_base + UHCHR); |
| 264 | } |
| 265 | |
| 266 | static int pxa27x_start_hc(struct pxa27x_ohci *pxa_ohci, struct device *dev) |
| 267 | { |
| 268 | int retval; |
| 269 | struct pxaohci_platform_data *inf; |
| 270 | uint32_t uhchr; |
| 271 | |
| 272 | inf = dev_get_platdata(dev); |
| 273 | |
| 274 | retval = clk_prepare_enable(clk: pxa_ohci->clk); |
| 275 | if (retval) |
| 276 | return retval; |
| 277 | |
| 278 | pxa27x_reset_hc(pxa_ohci); |
| 279 | |
| 280 | uhchr = __raw_readl(addr: pxa_ohci->mmio_base + UHCHR) | UHCHR_FSBIR; |
| 281 | __raw_writel(val: uhchr, addr: pxa_ohci->mmio_base + UHCHR); |
| 282 | |
| 283 | while (__raw_readl(addr: pxa_ohci->mmio_base + UHCHR) & UHCHR_FSBIR) |
| 284 | cpu_relax(); |
| 285 | |
| 286 | pxa27x_setup_hc(pxa_ohci, inf); |
| 287 | |
| 288 | if (inf->init) |
| 289 | retval = inf->init(dev); |
| 290 | |
| 291 | if (retval < 0) { |
| 292 | clk_disable_unprepare(clk: pxa_ohci->clk); |
| 293 | return retval; |
| 294 | } |
| 295 | |
| 296 | uhchr = __raw_readl(addr: pxa_ohci->mmio_base + UHCHR) & ~UHCHR_SSE; |
| 297 | __raw_writel(val: uhchr, addr: pxa_ohci->mmio_base + UHCHR); |
| 298 | __raw_writel(UHCHIE_UPRIE | UHCHIE_RWIE, addr: pxa_ohci->mmio_base + UHCHIE); |
| 299 | |
| 300 | /* Clear any OTG Pin Hold */ |
| 301 | pxa27x_clear_otgph(); |
| 302 | return 0; |
| 303 | } |
| 304 | |
| 305 | static void pxa27x_stop_hc(struct pxa27x_ohci *pxa_ohci, struct device *dev) |
| 306 | { |
| 307 | struct pxaohci_platform_data *inf; |
| 308 | uint32_t uhccoms; |
| 309 | |
| 310 | inf = dev_get_platdata(dev); |
| 311 | |
| 312 | if (inf->exit) |
| 313 | inf->exit(dev); |
| 314 | |
| 315 | pxa27x_reset_hc(pxa_ohci); |
| 316 | |
| 317 | /* Host Controller Reset */ |
| 318 | uhccoms = __raw_readl(addr: pxa_ohci->mmio_base + UHCCOMS) | 0x01; |
| 319 | __raw_writel(val: uhccoms, addr: pxa_ohci->mmio_base + UHCCOMS); |
| 320 | udelay(usec: 10); |
| 321 | |
| 322 | clk_disable_unprepare(clk: pxa_ohci->clk); |
| 323 | } |
| 324 | |
| 325 | #ifdef CONFIG_OF |
| 326 | static const struct of_device_id pxa_ohci_dt_ids[] = { |
| 327 | { .compatible = "marvell,pxa-ohci" }, |
| 328 | { } |
| 329 | }; |
| 330 | |
| 331 | MODULE_DEVICE_TABLE(of, pxa_ohci_dt_ids); |
| 332 | |
| 333 | static int ohci_pxa_of_init(struct platform_device *pdev) |
| 334 | { |
| 335 | struct device_node *np = pdev->dev.of_node; |
| 336 | struct pxaohci_platform_data *pdata; |
| 337 | u32 tmp; |
| 338 | int ret; |
| 339 | |
| 340 | if (!np) |
| 341 | return 0; |
| 342 | |
| 343 | /* Right now device-tree probed devices don't get dma_mask set. |
| 344 | * Since shared usb code relies on it, set it here for now. |
| 345 | * Once we have dma capability bindings this can go away. |
| 346 | */ |
| 347 | ret = dma_coerce_mask_and_coherent(dev: &pdev->dev, DMA_BIT_MASK(32)); |
| 348 | if (ret) |
| 349 | return ret; |
| 350 | |
| 351 | pdata = devm_kzalloc(dev: &pdev->dev, size: sizeof(*pdata), GFP_KERNEL); |
| 352 | if (!pdata) |
| 353 | return -ENOMEM; |
| 354 | |
| 355 | if (of_property_read_bool(np, propname: "marvell,enable-port1" )) |
| 356 | pdata->flags |= ENABLE_PORT1; |
| 357 | if (of_property_read_bool(np, propname: "marvell,enable-port2" )) |
| 358 | pdata->flags |= ENABLE_PORT2; |
| 359 | if (of_property_read_bool(np, propname: "marvell,enable-port3" )) |
| 360 | pdata->flags |= ENABLE_PORT3; |
| 361 | if (of_property_read_bool(np, propname: "marvell,port-sense-low" )) |
| 362 | pdata->flags |= POWER_SENSE_LOW; |
| 363 | if (of_property_read_bool(np, propname: "marvell,power-control-low" )) |
| 364 | pdata->flags |= POWER_CONTROL_LOW; |
| 365 | if (of_property_read_bool(np, propname: "marvell,no-oc-protection" )) |
| 366 | pdata->flags |= NO_OC_PROTECTION; |
| 367 | if (of_property_read_bool(np, propname: "marvell,oc-mode-perport" )) |
| 368 | pdata->flags |= OC_MODE_PERPORT; |
| 369 | if (!of_property_read_u32(np, propname: "marvell,power-on-delay" , out_value: &tmp)) |
| 370 | pdata->power_on_delay = tmp; |
| 371 | if (!of_property_read_u32(np, propname: "marvell,port-mode" , out_value: &tmp)) |
| 372 | pdata->port_mode = tmp; |
| 373 | if (!of_property_read_u32(np, propname: "marvell,power-budget" , out_value: &tmp)) |
| 374 | pdata->power_budget = tmp; |
| 375 | |
| 376 | pdev->dev.platform_data = pdata; |
| 377 | |
| 378 | return 0; |
| 379 | } |
| 380 | #else |
| 381 | static int ohci_pxa_of_init(struct platform_device *pdev) |
| 382 | { |
| 383 | return 0; |
| 384 | } |
| 385 | #endif |
| 386 | |
| 387 | /*-------------------------------------------------------------------------*/ |
| 388 | |
| 389 | /* configure so an HC device and id are always provided */ |
| 390 | /* always called with process context; sleeping is OK */ |
| 391 | |
| 392 | |
| 393 | /** |
| 394 | * ohci_hcd_pxa27x_probe - initialize pxa27x-based HCDs |
| 395 | * @pdev: USB Host controller to probe |
| 396 | * |
| 397 | * Context: task context, might sleep |
| 398 | * |
| 399 | * Allocates basic resources for this USB host controller, and |
| 400 | * then invokes the start() method for the HCD associated with it |
| 401 | * through the hotplug entry's driver_data. |
| 402 | */ |
| 403 | static int ohci_hcd_pxa27x_probe(struct platform_device *pdev) |
| 404 | { |
| 405 | int retval, irq; |
| 406 | struct usb_hcd *hcd; |
| 407 | struct pxaohci_platform_data *inf; |
| 408 | struct pxa27x_ohci *pxa_ohci; |
| 409 | struct ohci_hcd *ohci; |
| 410 | struct resource *r; |
| 411 | struct clk *usb_clk; |
| 412 | unsigned int i; |
| 413 | |
| 414 | retval = ohci_pxa_of_init(pdev); |
| 415 | if (retval) |
| 416 | return retval; |
| 417 | |
| 418 | inf = dev_get_platdata(dev: &pdev->dev); |
| 419 | |
| 420 | if (!inf) |
| 421 | return -ENODEV; |
| 422 | |
| 423 | irq = platform_get_irq(pdev, 0); |
| 424 | if (irq < 0) { |
| 425 | pr_err("no resource of IORESOURCE_IRQ" ); |
| 426 | return irq; |
| 427 | } |
| 428 | |
| 429 | usb_clk = devm_clk_get(dev: &pdev->dev, NULL); |
| 430 | if (IS_ERR(ptr: usb_clk)) |
| 431 | return PTR_ERR(ptr: usb_clk); |
| 432 | |
| 433 | hcd = usb_create_hcd(driver: &ohci_pxa27x_hc_driver, dev: &pdev->dev, bus_name: "pxa27x" ); |
| 434 | if (!hcd) |
| 435 | return -ENOMEM; |
| 436 | |
| 437 | hcd->regs = devm_platform_get_and_ioremap_resource(pdev, index: 0, res: &r); |
| 438 | if (IS_ERR(ptr: hcd->regs)) { |
| 439 | retval = PTR_ERR(ptr: hcd->regs); |
| 440 | goto err; |
| 441 | } |
| 442 | hcd->rsrc_start = r->start; |
| 443 | hcd->rsrc_len = resource_size(res: r); |
| 444 | |
| 445 | /* initialize "struct pxa27x_ohci" */ |
| 446 | pxa_ohci = to_pxa27x_ohci(hcd); |
| 447 | pxa_ohci->clk = usb_clk; |
| 448 | pxa_ohci->mmio_base = (void __iomem *)hcd->regs; |
| 449 | |
| 450 | for (i = 0; i < 3; ++i) { |
| 451 | char name[6]; |
| 452 | |
| 453 | if (!(inf->flags & (ENABLE_PORT1 << i))) |
| 454 | continue; |
| 455 | |
| 456 | sprintf(buf: name, fmt: "vbus%u" , i + 1); |
| 457 | pxa_ohci->vbus[i] = devm_regulator_get(dev: &pdev->dev, id: name); |
| 458 | } |
| 459 | |
| 460 | retval = pxa27x_start_hc(pxa_ohci, dev: &pdev->dev); |
| 461 | if (retval < 0) { |
| 462 | pr_debug("pxa27x_start_hc failed" ); |
| 463 | goto err; |
| 464 | } |
| 465 | |
| 466 | /* Select Power Management Mode */ |
| 467 | pxa27x_ohci_select_pmm(pxa_ohci, mode: inf->port_mode); |
| 468 | |
| 469 | if (inf->power_budget) |
| 470 | hcd->power_budget = inf->power_budget; |
| 471 | |
| 472 | /* The value of NDP in roothub_a is incorrect on this hardware */ |
| 473 | ohci = hcd_to_ohci(hcd); |
| 474 | ohci->num_ports = 3; |
| 475 | |
| 476 | retval = usb_add_hcd(hcd, irqnum: irq, irqflags: 0); |
| 477 | if (retval == 0) { |
| 478 | device_wakeup_enable(dev: hcd->self.controller); |
| 479 | return retval; |
| 480 | } |
| 481 | |
| 482 | pxa27x_stop_hc(pxa_ohci, dev: &pdev->dev); |
| 483 | err: |
| 484 | usb_put_hcd(hcd); |
| 485 | return retval; |
| 486 | } |
| 487 | |
| 488 | |
| 489 | /* may be called without controller electrically present */ |
| 490 | /* may be called with controller, bus, and devices active */ |
| 491 | |
| 492 | /** |
| 493 | * ohci_hcd_pxa27x_remove - shutdown processing for pxa27x-based HCDs |
| 494 | * @pdev: USB Host Controller being removed |
| 495 | * |
| 496 | * Context: task context, might sleep |
| 497 | * |
| 498 | * Reverses the effect of ohci_hcd_pxa27x_probe(), first invoking |
| 499 | * the HCD's stop() method. It is always called from a thread |
| 500 | * context, normally "rmmod", "apmd", or something similar. |
| 501 | */ |
| 502 | static void ohci_hcd_pxa27x_remove(struct platform_device *pdev) |
| 503 | { |
| 504 | struct usb_hcd *hcd = platform_get_drvdata(pdev); |
| 505 | struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd); |
| 506 | unsigned int i; |
| 507 | |
| 508 | usb_remove_hcd(hcd); |
| 509 | pxa27x_stop_hc(pxa_ohci, dev: &pdev->dev); |
| 510 | |
| 511 | for (i = 0; i < 3; ++i) |
| 512 | pxa27x_ohci_set_vbus_power(pxa_ohci, port: i, enable: false); |
| 513 | |
| 514 | usb_put_hcd(hcd); |
| 515 | } |
| 516 | |
| 517 | /*-------------------------------------------------------------------------*/ |
| 518 | |
| 519 | #ifdef CONFIG_PM |
| 520 | static int ohci_hcd_pxa27x_drv_suspend(struct device *dev) |
| 521 | { |
| 522 | struct usb_hcd *hcd = dev_get_drvdata(dev); |
| 523 | struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd); |
| 524 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); |
| 525 | bool do_wakeup = device_may_wakeup(dev); |
| 526 | int ret; |
| 527 | |
| 528 | |
| 529 | if (time_before(jiffies, ohci->next_statechange)) |
| 530 | msleep(msecs: 5); |
| 531 | ohci->next_statechange = jiffies; |
| 532 | |
| 533 | ret = ohci_suspend(hcd, do_wakeup); |
| 534 | if (ret) |
| 535 | return ret; |
| 536 | |
| 537 | pxa27x_stop_hc(pxa_ohci, dev); |
| 538 | return ret; |
| 539 | } |
| 540 | |
| 541 | static int ohci_hcd_pxa27x_drv_resume(struct device *dev) |
| 542 | { |
| 543 | struct usb_hcd *hcd = dev_get_drvdata(dev); |
| 544 | struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd); |
| 545 | struct pxaohci_platform_data *inf = dev_get_platdata(dev); |
| 546 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); |
| 547 | int status; |
| 548 | |
| 549 | if (time_before(jiffies, ohci->next_statechange)) |
| 550 | msleep(msecs: 5); |
| 551 | ohci->next_statechange = jiffies; |
| 552 | |
| 553 | status = pxa27x_start_hc(pxa_ohci, dev); |
| 554 | if (status < 0) |
| 555 | return status; |
| 556 | |
| 557 | /* Select Power Management Mode */ |
| 558 | pxa27x_ohci_select_pmm(pxa_ohci, mode: inf->port_mode); |
| 559 | |
| 560 | ohci_resume(hcd, hibernated: false); |
| 561 | return 0; |
| 562 | } |
| 563 | |
| 564 | static const struct dev_pm_ops ohci_hcd_pxa27x_pm_ops = { |
| 565 | .suspend = ohci_hcd_pxa27x_drv_suspend, |
| 566 | .resume = ohci_hcd_pxa27x_drv_resume, |
| 567 | }; |
| 568 | #endif |
| 569 | |
| 570 | static struct platform_driver ohci_hcd_pxa27x_driver = { |
| 571 | .probe = ohci_hcd_pxa27x_probe, |
| 572 | .remove = ohci_hcd_pxa27x_remove, |
| 573 | .shutdown = usb_hcd_platform_shutdown, |
| 574 | .driver = { |
| 575 | .name = "pxa27x-ohci" , |
| 576 | .of_match_table = of_match_ptr(pxa_ohci_dt_ids), |
| 577 | #ifdef CONFIG_PM |
| 578 | .pm = &ohci_hcd_pxa27x_pm_ops, |
| 579 | #endif |
| 580 | }, |
| 581 | }; |
| 582 | |
| 583 | static const struct ohci_driver_overrides pxa27x_overrides __initconst = { |
| 584 | .extra_priv_size = sizeof(struct pxa27x_ohci), |
| 585 | }; |
| 586 | |
| 587 | static int __init ohci_pxa27x_init(void) |
| 588 | { |
| 589 | if (usb_disabled()) |
| 590 | return -ENODEV; |
| 591 | |
| 592 | ohci_init_driver(drv: &ohci_pxa27x_hc_driver, over: &pxa27x_overrides); |
| 593 | ohci_pxa27x_hc_driver.hub_control = pxa27x_ohci_hub_control; |
| 594 | |
| 595 | return platform_driver_register(&ohci_hcd_pxa27x_driver); |
| 596 | } |
| 597 | module_init(ohci_pxa27x_init); |
| 598 | |
| 599 | static void __exit ohci_pxa27x_cleanup(void) |
| 600 | { |
| 601 | platform_driver_unregister(&ohci_hcd_pxa27x_driver); |
| 602 | } |
| 603 | module_exit(ohci_pxa27x_cleanup); |
| 604 | |
| 605 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 606 | MODULE_LICENSE("GPL" ); |
| 607 | MODULE_ALIAS("platform:pxa27x-ohci" ); |
| 608 | |