162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-1.0+ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * OHCI HCD (Host Controller Driver) for USB. 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at> 662306a36Sopenharmony_ci * (C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net> 762306a36Sopenharmony_ci * (C) Copyright 2002 Hewlett-Packard Company 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * USB Bus Glue for Samsung S3C2410 1062306a36Sopenharmony_ci * 1162306a36Sopenharmony_ci * Written by Christopher Hoover <ch@hpl.hp.com> 1262306a36Sopenharmony_ci * Based on fragments of previous driver by Russell King et al. 1362306a36Sopenharmony_ci * 1462306a36Sopenharmony_ci * Modified for S3C2410 from ohci-sa1111.c, ohci-omap.c and ohci-lh7a40.c 1562306a36Sopenharmony_ci * by Ben Dooks, <ben@simtec.co.uk> 1662306a36Sopenharmony_ci * Copyright (C) 2004 Simtec Electronics 1762306a36Sopenharmony_ci * 1862306a36Sopenharmony_ci * Thanks to basprog@mail.ru for updates to newer kernels 1962306a36Sopenharmony_ci * 2062306a36Sopenharmony_ci * This file is licenced under the GPL. 2162306a36Sopenharmony_ci*/ 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci#include <linux/clk.h> 2462306a36Sopenharmony_ci#include <linux/io.h> 2562306a36Sopenharmony_ci#include <linux/kernel.h> 2662306a36Sopenharmony_ci#include <linux/module.h> 2762306a36Sopenharmony_ci#include <linux/platform_device.h> 2862306a36Sopenharmony_ci#include <linux/platform_data/usb-ohci-s3c2410.h> 2962306a36Sopenharmony_ci#include <linux/usb.h> 3062306a36Sopenharmony_ci#include <linux/usb/hcd.h> 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci#include "ohci.h" 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#define valid_port(idx) ((idx) == 1 || (idx) == 2) 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci/* clock device associated with the hcd */ 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_ci#define DRIVER_DESC "OHCI S3C2410 driver" 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_cistatic struct clk *clk; 4362306a36Sopenharmony_cistatic struct clk *usb_clk; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_cistatic struct hc_driver __read_mostly ohci_s3c2410_hc_driver; 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci/* forward definitions */ 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_cistatic void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc); 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_ci/* conversion functions */ 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_cistatic struct s3c2410_hcd_info *to_s3c2410_info(struct usb_hcd *hcd) 5462306a36Sopenharmony_ci{ 5562306a36Sopenharmony_ci return dev_get_platdata(hcd->self.controller); 5662306a36Sopenharmony_ci} 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_cistatic void s3c2410_start_hc(struct platform_device *dev, struct usb_hcd *hcd) 5962306a36Sopenharmony_ci{ 6062306a36Sopenharmony_ci struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev); 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci dev_dbg(&dev->dev, "s3c2410_start_hc:\n"); 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci clk_prepare_enable(usb_clk); 6562306a36Sopenharmony_ci mdelay(2); /* let the bus clock stabilise */ 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci clk_prepare_enable(clk); 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci if (info != NULL) { 7062306a36Sopenharmony_ci info->hcd = hcd; 7162306a36Sopenharmony_ci info->report_oc = s3c2410_hcd_oc; 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci if (info->enable_oc != NULL) 7462306a36Sopenharmony_ci (info->enable_oc)(info, 1); 7562306a36Sopenharmony_ci } 7662306a36Sopenharmony_ci} 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_cistatic void s3c2410_stop_hc(struct platform_device *dev) 7962306a36Sopenharmony_ci{ 8062306a36Sopenharmony_ci struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev); 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci dev_dbg(&dev->dev, "s3c2410_stop_hc:\n"); 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ci if (info != NULL) { 8562306a36Sopenharmony_ci info->report_oc = NULL; 8662306a36Sopenharmony_ci info->hcd = NULL; 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci if (info->enable_oc != NULL) 8962306a36Sopenharmony_ci (info->enable_oc)(info, 0); 9062306a36Sopenharmony_ci } 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci clk_disable_unprepare(clk); 9362306a36Sopenharmony_ci clk_disable_unprepare(usb_clk); 9462306a36Sopenharmony_ci} 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_ci/* ohci_s3c2410_hub_status_data 9762306a36Sopenharmony_ci * 9862306a36Sopenharmony_ci * update the status data from the hub with anything that 9962306a36Sopenharmony_ci * has been detected by our system 10062306a36Sopenharmony_ci*/ 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_cistatic int 10362306a36Sopenharmony_ciohci_s3c2410_hub_status_data(struct usb_hcd *hcd, char *buf) 10462306a36Sopenharmony_ci{ 10562306a36Sopenharmony_ci struct s3c2410_hcd_info *info = to_s3c2410_info(hcd); 10662306a36Sopenharmony_ci struct s3c2410_hcd_port *port; 10762306a36Sopenharmony_ci int orig; 10862306a36Sopenharmony_ci int portno; 10962306a36Sopenharmony_ci 11062306a36Sopenharmony_ci orig = ohci_hub_status_data(hcd, buf); 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_ci if (info == NULL) 11362306a36Sopenharmony_ci return orig; 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci port = &info->port[0]; 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci /* mark any changed port as changed */ 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci for (portno = 0; portno < 2; port++, portno++) { 12062306a36Sopenharmony_ci if (port->oc_changed == 1 && 12162306a36Sopenharmony_ci port->flags & S3C_HCDFLG_USED) { 12262306a36Sopenharmony_ci dev_dbg(hcd->self.controller, 12362306a36Sopenharmony_ci "oc change on port %d\n", portno); 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_ci if (orig < 1) 12662306a36Sopenharmony_ci orig = 1; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci buf[0] |= 1<<(portno+1); 12962306a36Sopenharmony_ci } 13062306a36Sopenharmony_ci } 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_ci return orig; 13362306a36Sopenharmony_ci} 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ci/* s3c2410_usb_set_power 13662306a36Sopenharmony_ci * 13762306a36Sopenharmony_ci * configure the power on a port, by calling the platform device 13862306a36Sopenharmony_ci * routine registered with the platform device 13962306a36Sopenharmony_ci*/ 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_cistatic void s3c2410_usb_set_power(struct s3c2410_hcd_info *info, 14262306a36Sopenharmony_ci int port, int to) 14362306a36Sopenharmony_ci{ 14462306a36Sopenharmony_ci if (info == NULL) 14562306a36Sopenharmony_ci return; 14662306a36Sopenharmony_ci 14762306a36Sopenharmony_ci if (info->power_control != NULL) { 14862306a36Sopenharmony_ci info->port[port-1].power = to; 14962306a36Sopenharmony_ci (info->power_control)(port-1, to); 15062306a36Sopenharmony_ci } 15162306a36Sopenharmony_ci} 15262306a36Sopenharmony_ci 15362306a36Sopenharmony_ci/* ohci_s3c2410_hub_control 15462306a36Sopenharmony_ci * 15562306a36Sopenharmony_ci * look at control requests to the hub, and see if we need 15662306a36Sopenharmony_ci * to take any action or over-ride the results from the 15762306a36Sopenharmony_ci * request. 15862306a36Sopenharmony_ci*/ 15962306a36Sopenharmony_ci 16062306a36Sopenharmony_cistatic int ohci_s3c2410_hub_control( 16162306a36Sopenharmony_ci struct usb_hcd *hcd, 16262306a36Sopenharmony_ci u16 typeReq, 16362306a36Sopenharmony_ci u16 wValue, 16462306a36Sopenharmony_ci u16 wIndex, 16562306a36Sopenharmony_ci char *buf, 16662306a36Sopenharmony_ci u16 wLength) 16762306a36Sopenharmony_ci{ 16862306a36Sopenharmony_ci struct s3c2410_hcd_info *info = to_s3c2410_info(hcd); 16962306a36Sopenharmony_ci struct usb_hub_descriptor *desc; 17062306a36Sopenharmony_ci int ret = -EINVAL; 17162306a36Sopenharmony_ci u32 *data = (u32 *)buf; 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci dev_dbg(hcd->self.controller, 17462306a36Sopenharmony_ci "s3c2410_hub_control(%p,0x%04x,0x%04x,0x%04x,%p,%04x)\n", 17562306a36Sopenharmony_ci hcd, typeReq, wValue, wIndex, buf, wLength); 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci /* if we are only an humble host without any special capabilities 17862306a36Sopenharmony_ci * process the request straight away and exit */ 17962306a36Sopenharmony_ci 18062306a36Sopenharmony_ci if (info == NULL) { 18162306a36Sopenharmony_ci ret = ohci_hub_control(hcd, typeReq, wValue, 18262306a36Sopenharmony_ci wIndex, buf, wLength); 18362306a36Sopenharmony_ci goto out; 18462306a36Sopenharmony_ci } 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci /* check the request to see if it needs handling */ 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci switch (typeReq) { 18962306a36Sopenharmony_ci case SetPortFeature: 19062306a36Sopenharmony_ci if (wValue == USB_PORT_FEAT_POWER) { 19162306a36Sopenharmony_ci dev_dbg(hcd->self.controller, "SetPortFeat: POWER\n"); 19262306a36Sopenharmony_ci s3c2410_usb_set_power(info, wIndex, 1); 19362306a36Sopenharmony_ci goto out; 19462306a36Sopenharmony_ci } 19562306a36Sopenharmony_ci break; 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci case ClearPortFeature: 19862306a36Sopenharmony_ci switch (wValue) { 19962306a36Sopenharmony_ci case USB_PORT_FEAT_C_OVER_CURRENT: 20062306a36Sopenharmony_ci dev_dbg(hcd->self.controller, 20162306a36Sopenharmony_ci "ClearPortFeature: C_OVER_CURRENT\n"); 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci if (valid_port(wIndex)) { 20462306a36Sopenharmony_ci info->port[wIndex-1].oc_changed = 0; 20562306a36Sopenharmony_ci info->port[wIndex-1].oc_status = 0; 20662306a36Sopenharmony_ci } 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci goto out; 20962306a36Sopenharmony_ci 21062306a36Sopenharmony_ci case USB_PORT_FEAT_OVER_CURRENT: 21162306a36Sopenharmony_ci dev_dbg(hcd->self.controller, 21262306a36Sopenharmony_ci "ClearPortFeature: OVER_CURRENT\n"); 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_ci if (valid_port(wIndex)) 21562306a36Sopenharmony_ci info->port[wIndex-1].oc_status = 0; 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_ci goto out; 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci case USB_PORT_FEAT_POWER: 22062306a36Sopenharmony_ci dev_dbg(hcd->self.controller, 22162306a36Sopenharmony_ci "ClearPortFeature: POWER\n"); 22262306a36Sopenharmony_ci 22362306a36Sopenharmony_ci if (valid_port(wIndex)) { 22462306a36Sopenharmony_ci s3c2410_usb_set_power(info, wIndex, 0); 22562306a36Sopenharmony_ci return 0; 22662306a36Sopenharmony_ci } 22762306a36Sopenharmony_ci } 22862306a36Sopenharmony_ci break; 22962306a36Sopenharmony_ci } 23062306a36Sopenharmony_ci 23162306a36Sopenharmony_ci ret = ohci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength); 23262306a36Sopenharmony_ci if (ret) 23362306a36Sopenharmony_ci goto out; 23462306a36Sopenharmony_ci 23562306a36Sopenharmony_ci switch (typeReq) { 23662306a36Sopenharmony_ci case GetHubDescriptor: 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci /* update the hub's descriptor */ 23962306a36Sopenharmony_ci 24062306a36Sopenharmony_ci desc = (struct usb_hub_descriptor *)buf; 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci if (info->power_control == NULL) 24362306a36Sopenharmony_ci return ret; 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_ci dev_dbg(hcd->self.controller, "wHubCharacteristics 0x%04x\n", 24662306a36Sopenharmony_ci desc->wHubCharacteristics); 24762306a36Sopenharmony_ci 24862306a36Sopenharmony_ci /* remove the old configurations for power-switching, and 24962306a36Sopenharmony_ci * over-current protection, and insert our new configuration 25062306a36Sopenharmony_ci */ 25162306a36Sopenharmony_ci 25262306a36Sopenharmony_ci desc->wHubCharacteristics &= ~cpu_to_le16(HUB_CHAR_LPSM); 25362306a36Sopenharmony_ci desc->wHubCharacteristics |= cpu_to_le16( 25462306a36Sopenharmony_ci HUB_CHAR_INDV_PORT_LPSM); 25562306a36Sopenharmony_ci 25662306a36Sopenharmony_ci if (info->enable_oc) { 25762306a36Sopenharmony_ci desc->wHubCharacteristics &= ~cpu_to_le16( 25862306a36Sopenharmony_ci HUB_CHAR_OCPM); 25962306a36Sopenharmony_ci desc->wHubCharacteristics |= cpu_to_le16( 26062306a36Sopenharmony_ci HUB_CHAR_INDV_PORT_OCPM); 26162306a36Sopenharmony_ci } 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci dev_dbg(hcd->self.controller, "wHubCharacteristics after 0x%04x\n", 26462306a36Sopenharmony_ci desc->wHubCharacteristics); 26562306a36Sopenharmony_ci 26662306a36Sopenharmony_ci return ret; 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_ci case GetPortStatus: 26962306a36Sopenharmony_ci /* check port status */ 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci dev_dbg(hcd->self.controller, "GetPortStatus(%d)\n", wIndex); 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_ci if (valid_port(wIndex)) { 27462306a36Sopenharmony_ci if (info->port[wIndex-1].oc_changed) 27562306a36Sopenharmony_ci *data |= cpu_to_le32(RH_PS_OCIC); 27662306a36Sopenharmony_ci 27762306a36Sopenharmony_ci if (info->port[wIndex-1].oc_status) 27862306a36Sopenharmony_ci *data |= cpu_to_le32(RH_PS_POCI); 27962306a36Sopenharmony_ci } 28062306a36Sopenharmony_ci } 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci out: 28362306a36Sopenharmony_ci return ret; 28462306a36Sopenharmony_ci} 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci/* s3c2410_hcd_oc 28762306a36Sopenharmony_ci * 28862306a36Sopenharmony_ci * handle an over-current report 28962306a36Sopenharmony_ci*/ 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_cistatic void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc) 29262306a36Sopenharmony_ci{ 29362306a36Sopenharmony_ci struct s3c2410_hcd_port *port; 29462306a36Sopenharmony_ci unsigned long flags; 29562306a36Sopenharmony_ci int portno; 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_ci if (info == NULL) 29862306a36Sopenharmony_ci return; 29962306a36Sopenharmony_ci 30062306a36Sopenharmony_ci port = &info->port[0]; 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_ci local_irq_save(flags); 30362306a36Sopenharmony_ci 30462306a36Sopenharmony_ci for (portno = 0; portno < 2; port++, portno++) { 30562306a36Sopenharmony_ci if (port_oc & (1<<portno) && 30662306a36Sopenharmony_ci port->flags & S3C_HCDFLG_USED) { 30762306a36Sopenharmony_ci port->oc_status = 1; 30862306a36Sopenharmony_ci port->oc_changed = 1; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_ci /* ok, once over-current is detected, 31162306a36Sopenharmony_ci the port needs to be powered down */ 31262306a36Sopenharmony_ci s3c2410_usb_set_power(info, portno+1, 0); 31362306a36Sopenharmony_ci } 31462306a36Sopenharmony_ci } 31562306a36Sopenharmony_ci 31662306a36Sopenharmony_ci local_irq_restore(flags); 31762306a36Sopenharmony_ci} 31862306a36Sopenharmony_ci 31962306a36Sopenharmony_ci/* may be called without controller electrically present */ 32062306a36Sopenharmony_ci/* may be called with controller, bus, and devices active */ 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_ci/* 32362306a36Sopenharmony_ci * ohci_hcd_s3c2410_remove - shutdown processing for HCD 32462306a36Sopenharmony_ci * @dev: USB Host Controller being removed 32562306a36Sopenharmony_ci * 32662306a36Sopenharmony_ci * Context: task context, might sleep 32762306a36Sopenharmony_ci * 32862306a36Sopenharmony_ci * Reverses the effect of ohci_hcd_3c2410_probe(), first invoking 32962306a36Sopenharmony_ci * the HCD's stop() method. It is always called from a thread 33062306a36Sopenharmony_ci * context, normally "rmmod", "apmd", or something similar. 33162306a36Sopenharmony_ci */ 33262306a36Sopenharmony_cistatic void 33362306a36Sopenharmony_ciohci_hcd_s3c2410_remove(struct platform_device *dev) 33462306a36Sopenharmony_ci{ 33562306a36Sopenharmony_ci struct usb_hcd *hcd = platform_get_drvdata(dev); 33662306a36Sopenharmony_ci 33762306a36Sopenharmony_ci usb_remove_hcd(hcd); 33862306a36Sopenharmony_ci s3c2410_stop_hc(dev); 33962306a36Sopenharmony_ci usb_put_hcd(hcd); 34062306a36Sopenharmony_ci} 34162306a36Sopenharmony_ci 34262306a36Sopenharmony_ci/* 34362306a36Sopenharmony_ci * ohci_hcd_s3c2410_probe - initialize S3C2410-based HCDs 34462306a36Sopenharmony_ci * @dev: USB Host Controller to be probed 34562306a36Sopenharmony_ci * 34662306a36Sopenharmony_ci * Context: task context, might sleep 34762306a36Sopenharmony_ci * 34862306a36Sopenharmony_ci * Allocates basic resources for this USB host controller, and 34962306a36Sopenharmony_ci * then invokes the start() method for the HCD associated with it 35062306a36Sopenharmony_ci * through the hotplug entry's driver_data. 35162306a36Sopenharmony_ci */ 35262306a36Sopenharmony_cistatic int ohci_hcd_s3c2410_probe(struct platform_device *dev) 35362306a36Sopenharmony_ci{ 35462306a36Sopenharmony_ci struct usb_hcd *hcd = NULL; 35562306a36Sopenharmony_ci struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev); 35662306a36Sopenharmony_ci int retval, irq; 35762306a36Sopenharmony_ci 35862306a36Sopenharmony_ci s3c2410_usb_set_power(info, 1, 1); 35962306a36Sopenharmony_ci s3c2410_usb_set_power(info, 2, 1); 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci hcd = usb_create_hcd(&ohci_s3c2410_hc_driver, &dev->dev, "s3c24xx"); 36262306a36Sopenharmony_ci if (hcd == NULL) 36362306a36Sopenharmony_ci return -ENOMEM; 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci hcd->rsrc_start = dev->resource[0].start; 36662306a36Sopenharmony_ci hcd->rsrc_len = resource_size(&dev->resource[0]); 36762306a36Sopenharmony_ci 36862306a36Sopenharmony_ci hcd->regs = devm_ioremap_resource(&dev->dev, &dev->resource[0]); 36962306a36Sopenharmony_ci if (IS_ERR(hcd->regs)) { 37062306a36Sopenharmony_ci retval = PTR_ERR(hcd->regs); 37162306a36Sopenharmony_ci goto err_put; 37262306a36Sopenharmony_ci } 37362306a36Sopenharmony_ci 37462306a36Sopenharmony_ci clk = devm_clk_get(&dev->dev, "usb-host"); 37562306a36Sopenharmony_ci if (IS_ERR(clk)) { 37662306a36Sopenharmony_ci dev_err(&dev->dev, "cannot get usb-host clock\n"); 37762306a36Sopenharmony_ci retval = PTR_ERR(clk); 37862306a36Sopenharmony_ci goto err_put; 37962306a36Sopenharmony_ci } 38062306a36Sopenharmony_ci 38162306a36Sopenharmony_ci usb_clk = devm_clk_get(&dev->dev, "usb-bus-host"); 38262306a36Sopenharmony_ci if (IS_ERR(usb_clk)) { 38362306a36Sopenharmony_ci dev_err(&dev->dev, "cannot get usb-bus-host clock\n"); 38462306a36Sopenharmony_ci retval = PTR_ERR(usb_clk); 38562306a36Sopenharmony_ci goto err_put; 38662306a36Sopenharmony_ci } 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ci irq = platform_get_irq(dev, 0); 38962306a36Sopenharmony_ci if (irq < 0) { 39062306a36Sopenharmony_ci retval = irq; 39162306a36Sopenharmony_ci goto err_put; 39262306a36Sopenharmony_ci } 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci s3c2410_start_hc(dev, hcd); 39562306a36Sopenharmony_ci 39662306a36Sopenharmony_ci retval = usb_add_hcd(hcd, irq, 0); 39762306a36Sopenharmony_ci if (retval != 0) 39862306a36Sopenharmony_ci goto err_ioremap; 39962306a36Sopenharmony_ci 40062306a36Sopenharmony_ci device_wakeup_enable(hcd->self.controller); 40162306a36Sopenharmony_ci return 0; 40262306a36Sopenharmony_ci 40362306a36Sopenharmony_ci err_ioremap: 40462306a36Sopenharmony_ci s3c2410_stop_hc(dev); 40562306a36Sopenharmony_ci 40662306a36Sopenharmony_ci err_put: 40762306a36Sopenharmony_ci usb_put_hcd(hcd); 40862306a36Sopenharmony_ci return retval; 40962306a36Sopenharmony_ci} 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_ci/*-------------------------------------------------------------------------*/ 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_ci#ifdef CONFIG_PM 41462306a36Sopenharmony_cistatic int ohci_hcd_s3c2410_drv_suspend(struct device *dev) 41562306a36Sopenharmony_ci{ 41662306a36Sopenharmony_ci struct usb_hcd *hcd = dev_get_drvdata(dev); 41762306a36Sopenharmony_ci struct platform_device *pdev = to_platform_device(dev); 41862306a36Sopenharmony_ci bool do_wakeup = device_may_wakeup(dev); 41962306a36Sopenharmony_ci int rc = 0; 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_ci rc = ohci_suspend(hcd, do_wakeup); 42262306a36Sopenharmony_ci if (rc) 42362306a36Sopenharmony_ci return rc; 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci s3c2410_stop_hc(pdev); 42662306a36Sopenharmony_ci 42762306a36Sopenharmony_ci return rc; 42862306a36Sopenharmony_ci} 42962306a36Sopenharmony_ci 43062306a36Sopenharmony_cistatic int ohci_hcd_s3c2410_drv_resume(struct device *dev) 43162306a36Sopenharmony_ci{ 43262306a36Sopenharmony_ci struct usb_hcd *hcd = dev_get_drvdata(dev); 43362306a36Sopenharmony_ci struct platform_device *pdev = to_platform_device(dev); 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_ci s3c2410_start_hc(pdev, hcd); 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_ci ohci_resume(hcd, false); 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci return 0; 44062306a36Sopenharmony_ci} 44162306a36Sopenharmony_ci#else 44262306a36Sopenharmony_ci#define ohci_hcd_s3c2410_drv_suspend NULL 44362306a36Sopenharmony_ci#define ohci_hcd_s3c2410_drv_resume NULL 44462306a36Sopenharmony_ci#endif 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_cistatic const struct dev_pm_ops ohci_hcd_s3c2410_pm_ops = { 44762306a36Sopenharmony_ci .suspend = ohci_hcd_s3c2410_drv_suspend, 44862306a36Sopenharmony_ci .resume = ohci_hcd_s3c2410_drv_resume, 44962306a36Sopenharmony_ci}; 45062306a36Sopenharmony_ci 45162306a36Sopenharmony_cistatic const struct of_device_id ohci_hcd_s3c2410_dt_ids[] = { 45262306a36Sopenharmony_ci { .compatible = "samsung,s3c2410-ohci" }, 45362306a36Sopenharmony_ci { /* sentinel */ } 45462306a36Sopenharmony_ci}; 45562306a36Sopenharmony_ci 45662306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, ohci_hcd_s3c2410_dt_ids); 45762306a36Sopenharmony_ci 45862306a36Sopenharmony_cistatic struct platform_driver ohci_hcd_s3c2410_driver = { 45962306a36Sopenharmony_ci .probe = ohci_hcd_s3c2410_probe, 46062306a36Sopenharmony_ci .remove_new = ohci_hcd_s3c2410_remove, 46162306a36Sopenharmony_ci .shutdown = usb_hcd_platform_shutdown, 46262306a36Sopenharmony_ci .driver = { 46362306a36Sopenharmony_ci .name = "s3c2410-ohci", 46462306a36Sopenharmony_ci .pm = &ohci_hcd_s3c2410_pm_ops, 46562306a36Sopenharmony_ci .of_match_table = ohci_hcd_s3c2410_dt_ids, 46662306a36Sopenharmony_ci }, 46762306a36Sopenharmony_ci}; 46862306a36Sopenharmony_ci 46962306a36Sopenharmony_cistatic int __init ohci_s3c2410_init(void) 47062306a36Sopenharmony_ci{ 47162306a36Sopenharmony_ci if (usb_disabled()) 47262306a36Sopenharmony_ci return -ENODEV; 47362306a36Sopenharmony_ci 47462306a36Sopenharmony_ci ohci_init_driver(&ohci_s3c2410_hc_driver, NULL); 47562306a36Sopenharmony_ci 47662306a36Sopenharmony_ci /* 47762306a36Sopenharmony_ci * The Samsung HW has some unusual quirks, which require 47862306a36Sopenharmony_ci * Sumsung-specific workarounds. We override certain hc_driver 47962306a36Sopenharmony_ci * functions here to achieve that. We explicitly do not enhance 48062306a36Sopenharmony_ci * ohci_driver_overrides to allow this more easily, since this 48162306a36Sopenharmony_ci * is an unusual case, and we don't want to encourage others to 48262306a36Sopenharmony_ci * override these functions by making it too easy. 48362306a36Sopenharmony_ci */ 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci ohci_s3c2410_hc_driver.hub_status_data = ohci_s3c2410_hub_status_data; 48662306a36Sopenharmony_ci ohci_s3c2410_hc_driver.hub_control = ohci_s3c2410_hub_control; 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci return platform_driver_register(&ohci_hcd_s3c2410_driver); 48962306a36Sopenharmony_ci} 49062306a36Sopenharmony_cimodule_init(ohci_s3c2410_init); 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_cistatic void __exit ohci_s3c2410_cleanup(void) 49362306a36Sopenharmony_ci{ 49462306a36Sopenharmony_ci platform_driver_unregister(&ohci_hcd_s3c2410_driver); 49562306a36Sopenharmony_ci} 49662306a36Sopenharmony_cimodule_exit(ohci_s3c2410_cleanup); 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ciMODULE_DESCRIPTION(DRIVER_DESC); 49962306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 50062306a36Sopenharmony_ciMODULE_ALIAS("platform:s3c2410-ohci"); 501