Linux Audio

Check our new training course

Loading...
v6.8
  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 * USB Bus Glue for Samsung S3C2410
 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 S3C2410 from ohci-sa1111.c, ohci-omap.c and ohci-lh7a40.c
 15 *	by Ben Dooks, <ben@simtec.co.uk>
 16 *	Copyright (C) 2004 Simtec Electronics
 17 *
 18 * Thanks to basprog@mail.ru for updates to newer kernels
 19 *
 20 * This file is licenced under the GPL.
 21*/
 22
 23#include <linux/clk.h>
 24#include <linux/io.h>
 25#include <linux/kernel.h>
 26#include <linux/module.h>
 27#include <linux/platform_device.h>
 28#include <linux/platform_data/usb-ohci-s3c2410.h>
 29#include <linux/usb.h>
 30#include <linux/usb/hcd.h>
 31
 32#include "ohci.h"
 33
 34
 35#define valid_port(idx) ((idx) == 1 || (idx) == 2)
 36
 37/* clock device associated with the hcd */
 38
 39
 40#define DRIVER_DESC "OHCI S3C2410 driver"
 41
 42static struct clk *clk;
 43static struct clk *usb_clk;
 44
 45static struct hc_driver __read_mostly ohci_s3c2410_hc_driver;
 46
 47/* forward definitions */
 48
 49static void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc);
 50
 51/* conversion functions */
 52
 53static struct s3c2410_hcd_info *to_s3c2410_info(struct usb_hcd *hcd)
 54{
 55	return dev_get_platdata(hcd->self.controller);
 56}
 57
 58static void s3c2410_start_hc(struct platform_device *dev, struct usb_hcd *hcd)
 59{
 60	struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev);
 61
 62	dev_dbg(&dev->dev, "s3c2410_start_hc:\n");
 63
 64	clk_prepare_enable(usb_clk);
 65	mdelay(2);			/* let the bus clock stabilise */
 66
 67	clk_prepare_enable(clk);
 68
 69	if (info != NULL) {
 70		info->hcd	= hcd;
 71		info->report_oc = s3c2410_hcd_oc;
 72
 73		if (info->enable_oc != NULL)
 74			(info->enable_oc)(info, 1);
 75	}
 76}
 77
 78static void s3c2410_stop_hc(struct platform_device *dev)
 79{
 80	struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev);
 81
 82	dev_dbg(&dev->dev, "s3c2410_stop_hc:\n");
 83
 84	if (info != NULL) {
 85		info->report_oc = NULL;
 86		info->hcd	= NULL;
 87
 88		if (info->enable_oc != NULL)
 89			(info->enable_oc)(info, 0);
 90	}
 91
 92	clk_disable_unprepare(clk);
 93	clk_disable_unprepare(usb_clk);
 94}
 95
 96/* ohci_s3c2410_hub_status_data
 97 *
 98 * update the status data from the hub with anything that
 99 * has been detected by our system
100*/
101
102static int
103ohci_s3c2410_hub_status_data(struct usb_hcd *hcd, char *buf)
104{
105	struct s3c2410_hcd_info *info = to_s3c2410_info(hcd);
106	struct s3c2410_hcd_port *port;
107	int orig;
108	int portno;
109
110	orig = ohci_hub_status_data(hcd, buf);
111
112	if (info == NULL)
113		return orig;
114
115	port = &info->port[0];
116
117	/* mark any changed port as changed */
118
119	for (portno = 0; portno < 2; port++, portno++) {
120		if (port->oc_changed == 1 &&
121		    port->flags & S3C_HCDFLG_USED) {
122			dev_dbg(hcd->self.controller,
123				"oc change on port %d\n", portno);
124
125			if (orig < 1)
126				orig = 1;
127
128			buf[0] |= 1<<(portno+1);
129		}
130	}
131
132	return orig;
133}
134
135/* s3c2410_usb_set_power
136 *
137 * configure the power on a port, by calling the platform device
138 * routine registered with the platform device
139*/
140
141static void s3c2410_usb_set_power(struct s3c2410_hcd_info *info,
142				  int port, int to)
143{
144	if (info == NULL)
145		return;
146
147	if (info->power_control != NULL) {
148		info->port[port-1].power = to;
149		(info->power_control)(port-1, to);
150	}
151}
152
153/* ohci_s3c2410_hub_control
154 *
155 * look at control requests to the hub, and see if we need
156 * to take any action or over-ride the results from the
157 * request.
158*/
159
160static int ohci_s3c2410_hub_control(
161	struct usb_hcd	*hcd,
162	u16		typeReq,
163	u16		wValue,
164	u16		wIndex,
165	char		*buf,
166	u16		wLength)
167{
168	struct s3c2410_hcd_info *info = to_s3c2410_info(hcd);
169	struct usb_hub_descriptor *desc;
170	int ret = -EINVAL;
171	u32 *data = (u32 *)buf;
172
173	dev_dbg(hcd->self.controller,
174		"s3c2410_hub_control(%p,0x%04x,0x%04x,0x%04x,%p,%04x)\n",
175		hcd, typeReq, wValue, wIndex, buf, wLength);
176
177	/* if we are only an humble host without any special capabilities
178	 * process the request straight away and exit */
179
180	if (info == NULL) {
181		ret = ohci_hub_control(hcd, typeReq, wValue,
182				       wIndex, buf, wLength);
183		goto out;
184	}
185
186	/* check the request to see if it needs handling */
187
188	switch (typeReq) {
189	case SetPortFeature:
190		if (wValue == USB_PORT_FEAT_POWER) {
191			dev_dbg(hcd->self.controller, "SetPortFeat: POWER\n");
192			s3c2410_usb_set_power(info, wIndex, 1);
193			goto out;
194		}
195		break;
196
197	case ClearPortFeature:
198		switch (wValue) {
199		case USB_PORT_FEAT_C_OVER_CURRENT:
200			dev_dbg(hcd->self.controller,
201				"ClearPortFeature: C_OVER_CURRENT\n");
202
203			if (valid_port(wIndex)) {
204				info->port[wIndex-1].oc_changed = 0;
205				info->port[wIndex-1].oc_status = 0;
206			}
207
208			goto out;
209
210		case USB_PORT_FEAT_OVER_CURRENT:
211			dev_dbg(hcd->self.controller,
212				"ClearPortFeature: OVER_CURRENT\n");
213
214			if (valid_port(wIndex))
215				info->port[wIndex-1].oc_status = 0;
216
217			goto out;
218
219		case USB_PORT_FEAT_POWER:
220			dev_dbg(hcd->self.controller,
221				"ClearPortFeature: POWER\n");
222
223			if (valid_port(wIndex)) {
224				s3c2410_usb_set_power(info, wIndex, 0);
225				return 0;
226			}
227		}
228		break;
229	}
230
231	ret = ohci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
232	if (ret)
233		goto out;
234
235	switch (typeReq) {
236	case GetHubDescriptor:
237
238		/* update the hub's descriptor */
239
240		desc = (struct usb_hub_descriptor *)buf;
241
242		if (info->power_control == NULL)
243			return ret;
244
245		dev_dbg(hcd->self.controller, "wHubCharacteristics 0x%04x\n",
246			desc->wHubCharacteristics);
247
248		/* remove the old configurations for power-switching, and
249		 * over-current protection, and insert our new configuration
250		 */
251
252		desc->wHubCharacteristics &= ~cpu_to_le16(HUB_CHAR_LPSM);
253		desc->wHubCharacteristics |= cpu_to_le16(
254			HUB_CHAR_INDV_PORT_LPSM);
255
256		if (info->enable_oc) {
257			desc->wHubCharacteristics &= ~cpu_to_le16(
258				HUB_CHAR_OCPM);
259			desc->wHubCharacteristics |=  cpu_to_le16(
260				HUB_CHAR_INDV_PORT_OCPM);
 
261		}
262
263		dev_dbg(hcd->self.controller, "wHubCharacteristics after 0x%04x\n",
264			desc->wHubCharacteristics);
265
266		return ret;
267
268	case GetPortStatus:
269		/* check port status */
270
271		dev_dbg(hcd->self.controller, "GetPortStatus(%d)\n", wIndex);
272
273		if (valid_port(wIndex)) {
274			if (info->port[wIndex-1].oc_changed)
275				*data |= cpu_to_le32(RH_PS_OCIC);
276
277			if (info->port[wIndex-1].oc_status)
278				*data |= cpu_to_le32(RH_PS_POCI);
279		}
280	}
281
282 out:
283	return ret;
284}
285
286/* s3c2410_hcd_oc
287 *
288 * handle an over-current report
289*/
290
291static void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc)
292{
293	struct s3c2410_hcd_port *port;
 
294	unsigned long flags;
295	int portno;
296
297	if (info == NULL)
298		return;
299
300	port = &info->port[0];
 
301
302	local_irq_save(flags);
303
304	for (portno = 0; portno < 2; port++, portno++) {
305		if (port_oc & (1<<portno) &&
306		    port->flags & S3C_HCDFLG_USED) {
307			port->oc_status = 1;
308			port->oc_changed = 1;
309
310			/* ok, once over-current is detected,
311			   the port needs to be powered down */
312			s3c2410_usb_set_power(info, portno+1, 0);
313		}
314	}
315
316	local_irq_restore(flags);
317}
318
319/* may be called without controller electrically present */
320/* may be called with controller, bus, and devices active */
321
322/*
323 * ohci_hcd_s3c2410_remove - shutdown processing for HCD
324 * @dev: USB Host Controller being removed
 
325 *
326 * Context: task context, might sleep
327 *
328 * Reverses the effect of ohci_hcd_3c2410_probe(), first invoking
329 * the HCD's stop() method.  It is always called from a thread
330 * context, normally "rmmod", "apmd", or something similar.
331 */
 
 
332static void
333ohci_hcd_s3c2410_remove(struct platform_device *dev)
334{
335	struct usb_hcd *hcd = platform_get_drvdata(dev);
336
337	usb_remove_hcd(hcd);
338	s3c2410_stop_hc(dev);
 
 
339	usb_put_hcd(hcd);
340}
341
342/*
343 * ohci_hcd_s3c2410_probe - initialize S3C2410-based HCDs
344 * @dev: USB Host Controller to be probed
345 *
346 * Context: task context, might sleep
347 *
348 * Allocates basic resources for this USB host controller, and
349 * then invokes the start() method for the HCD associated with it
350 * through the hotplug entry's driver_data.
 
351 */
352static int ohci_hcd_s3c2410_probe(struct platform_device *dev)
 
353{
354	struct usb_hcd *hcd = NULL;
355	struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev);
356	int retval, irq;
357
358	s3c2410_usb_set_power(info, 1, 1);
359	s3c2410_usb_set_power(info, 2, 1);
360
361	hcd = usb_create_hcd(&ohci_s3c2410_hc_driver, &dev->dev, "s3c24xx");
362	if (hcd == NULL)
363		return -ENOMEM;
364
365	hcd->rsrc_start = dev->resource[0].start;
366	hcd->rsrc_len	= resource_size(&dev->resource[0]);
367
368	hcd->regs = devm_ioremap_resource(&dev->dev, &dev->resource[0]);
369	if (IS_ERR(hcd->regs)) {
370		retval = PTR_ERR(hcd->regs);
371		goto err_put;
372	}
373
374	clk = devm_clk_get(&dev->dev, "usb-host");
375	if (IS_ERR(clk)) {
376		dev_err(&dev->dev, "cannot get usb-host clock\n");
377		retval = PTR_ERR(clk);
378		goto err_put;
379	}
380
381	usb_clk = devm_clk_get(&dev->dev, "usb-bus-host");
382	if (IS_ERR(usb_clk)) {
383		dev_err(&dev->dev, "cannot get usb-bus-host clock\n");
384		retval = PTR_ERR(usb_clk);
385		goto err_put;
386	}
387
388	irq = platform_get_irq(dev, 0);
389	if (irq < 0) {
390		retval = irq;
391		goto err_put;
 
 
 
392	}
393
394	s3c2410_start_hc(dev, hcd);
395
396	retval = usb_add_hcd(hcd, irq, 0);
397	if (retval != 0)
398		goto err_ioremap;
399
400	device_wakeup_enable(hcd->self.controller);
401	return 0;
402
403 err_ioremap:
404	s3c2410_stop_hc(dev);
 
 
 
 
 
 
 
 
405
406 err_put:
407	usb_put_hcd(hcd);
408	return retval;
409}
410
411/*-------------------------------------------------------------------------*/
412
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
413#ifdef CONFIG_PM
414static int ohci_hcd_s3c2410_drv_suspend(struct device *dev)
415{
416	struct usb_hcd *hcd = dev_get_drvdata(dev);
 
417	struct platform_device *pdev = to_platform_device(dev);
418	bool do_wakeup = device_may_wakeup(dev);
419	int rc = 0;
420
421	rc = ohci_suspend(hcd, do_wakeup);
422	if (rc)
423		return rc;
 
 
 
 
 
 
 
 
 
 
424
425	s3c2410_stop_hc(pdev);
 
 
426
427	return rc;
428}
429
430static int ohci_hcd_s3c2410_drv_resume(struct device *dev)
431{
432	struct usb_hcd *hcd = dev_get_drvdata(dev);
433	struct platform_device *pdev = to_platform_device(dev);
434
435	s3c2410_start_hc(pdev, hcd);
436
437	ohci_resume(hcd, false);
 
438
439	return 0;
440}
441#else
442#define ohci_hcd_s3c2410_drv_suspend	NULL
443#define ohci_hcd_s3c2410_drv_resume	NULL
444#endif
445
446static const struct dev_pm_ops ohci_hcd_s3c2410_pm_ops = {
447	.suspend	= ohci_hcd_s3c2410_drv_suspend,
448	.resume		= ohci_hcd_s3c2410_drv_resume,
449};
450
451static const struct of_device_id ohci_hcd_s3c2410_dt_ids[] = {
452	{ .compatible = "samsung,s3c2410-ohci" },
453	{ /* sentinel */ }
454};
455
456MODULE_DEVICE_TABLE(of, ohci_hcd_s3c2410_dt_ids);
457
458static struct platform_driver ohci_hcd_s3c2410_driver = {
459	.probe		= ohci_hcd_s3c2410_probe,
460	.remove_new	= ohci_hcd_s3c2410_remove,
461	.shutdown	= usb_hcd_platform_shutdown,
462	.driver		= {
 
463		.name	= "s3c2410-ohci",
464		.pm	= &ohci_hcd_s3c2410_pm_ops,
465		.of_match_table	= ohci_hcd_s3c2410_dt_ids,
466	},
467};
468
469static int __init ohci_s3c2410_init(void)
470{
471	if (usb_disabled())
472		return -ENODEV;
473
474	ohci_init_driver(&ohci_s3c2410_hc_driver, NULL);
475
476	/*
477	 * The Samsung HW has some unusual quirks, which require
478	 * Sumsung-specific workarounds. We override certain hc_driver
479	 * functions here to achieve that. We explicitly do not enhance
480	 * ohci_driver_overrides to allow this more easily, since this
481	 * is an unusual case, and we don't want to encourage others to
482	 * override these functions by making it too easy.
483	 */
484
485	ohci_s3c2410_hc_driver.hub_status_data	= ohci_s3c2410_hub_status_data;
486	ohci_s3c2410_hc_driver.hub_control	= ohci_s3c2410_hub_control;
487
488	return platform_driver_register(&ohci_hcd_s3c2410_driver);
489}
490module_init(ohci_s3c2410_init);
491
492static void __exit ohci_s3c2410_cleanup(void)
493{
494	platform_driver_unregister(&ohci_hcd_s3c2410_driver);
495}
496module_exit(ohci_s3c2410_cleanup);
497
498MODULE_DESCRIPTION(DRIVER_DESC);
499MODULE_LICENSE("GPL");
500MODULE_ALIAS("platform:s3c2410-ohci");
v3.5.6
 
  1/*
  2 * OHCI HCD (Host Controller Driver) for USB.
  3 *
  4 * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
  5 * (C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net>
  6 * (C) Copyright 2002 Hewlett-Packard Company
  7 *
  8 * USB Bus Glue for Samsung S3C2410
  9 *
 10 * Written by Christopher Hoover <ch@hpl.hp.com>
 11 * Based on fragments of previous driver by Russell King et al.
 12 *
 13 * Modified for S3C2410 from ohci-sa1111.c, ohci-omap.c and ohci-lh7a40.c
 14 *	by Ben Dooks, <ben@simtec.co.uk>
 15 *	Copyright (C) 2004 Simtec Electronics
 16 *
 17 * Thanks to basprog@mail.ru for updates to newer kernels
 18 *
 19 * This file is licenced under the GPL.
 20*/
 21
 
 
 
 
 22#include <linux/platform_device.h>
 23#include <linux/clk.h>
 24#include <plat/usb-control.h>
 
 
 
 
 25
 26#define valid_port(idx) ((idx) == 1 || (idx) == 2)
 27
 28/* clock device associated with the hcd */
 29
 
 
 
 30static struct clk *clk;
 31static struct clk *usb_clk;
 32
 
 
 33/* forward definitions */
 34
 35static void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc);
 36
 37/* conversion functions */
 38
 39static struct s3c2410_hcd_info *to_s3c2410_info(struct usb_hcd *hcd)
 40{
 41	return hcd->self.controller->platform_data;
 42}
 43
 44static void s3c2410_start_hc(struct platform_device *dev, struct usb_hcd *hcd)
 45{
 46	struct s3c2410_hcd_info *info = dev->dev.platform_data;
 47
 48	dev_dbg(&dev->dev, "s3c2410_start_hc:\n");
 49
 50	clk_enable(usb_clk);
 51	mdelay(2);			/* let the bus clock stabilise */
 52
 53	clk_enable(clk);
 54
 55	if (info != NULL) {
 56		info->hcd	= hcd;
 57		info->report_oc = s3c2410_hcd_oc;
 58
 59		if (info->enable_oc != NULL)
 60			(info->enable_oc)(info, 1);
 61	}
 62}
 63
 64static void s3c2410_stop_hc(struct platform_device *dev)
 65{
 66	struct s3c2410_hcd_info *info = dev->dev.platform_data;
 67
 68	dev_dbg(&dev->dev, "s3c2410_stop_hc:\n");
 69
 70	if (info != NULL) {
 71		info->report_oc = NULL;
 72		info->hcd	= NULL;
 73
 74		if (info->enable_oc != NULL)
 75			(info->enable_oc)(info, 0);
 76	}
 77
 78	clk_disable(clk);
 79	clk_disable(usb_clk);
 80}
 81
 82/* ohci_s3c2410_hub_status_data
 83 *
 84 * update the status data from the hub with anything that
 85 * has been detected by our system
 86*/
 87
 88static int
 89ohci_s3c2410_hub_status_data(struct usb_hcd *hcd, char *buf)
 90{
 91	struct s3c2410_hcd_info *info = to_s3c2410_info(hcd);
 92	struct s3c2410_hcd_port *port;
 93	int orig;
 94	int portno;
 95
 96	orig  = ohci_hub_status_data(hcd, buf);
 97
 98	if (info == NULL)
 99		return orig;
100
101	port = &info->port[0];
102
103	/* mark any changed port as changed */
104
105	for (portno = 0; portno < 2; port++, portno++) {
106		if (port->oc_changed == 1 &&
107		    port->flags & S3C_HCDFLG_USED) {
108			dev_dbg(hcd->self.controller,
109				"oc change on port %d\n", portno);
110
111			if (orig < 1)
112				orig = 1;
113
114			buf[0] |= 1<<(portno+1);
115		}
116	}
117
118	return orig;
119}
120
121/* s3c2410_usb_set_power
122 *
123 * configure the power on a port, by calling the platform device
124 * routine registered with the platform device
125*/
126
127static void s3c2410_usb_set_power(struct s3c2410_hcd_info *info,
128				  int port, int to)
129{
130	if (info == NULL)
131		return;
132
133	if (info->power_control != NULL) {
134		info->port[port-1].power = to;
135		(info->power_control)(port-1, to);
136	}
137}
138
139/* ohci_s3c2410_hub_control
140 *
141 * look at control requests to the hub, and see if we need
142 * to take any action or over-ride the results from the
143 * request.
144*/
145
146static int ohci_s3c2410_hub_control(
147	struct usb_hcd	*hcd,
148	u16		typeReq,
149	u16		wValue,
150	u16		wIndex,
151	char		*buf,
152	u16		wLength)
153{
154	struct s3c2410_hcd_info *info = to_s3c2410_info(hcd);
155	struct usb_hub_descriptor *desc;
156	int ret = -EINVAL;
157	u32 *data = (u32 *)buf;
158
159	dev_dbg(hcd->self.controller,
160		"s3c2410_hub_control(%p,0x%04x,0x%04x,0x%04x,%p,%04x)\n",
161		hcd, typeReq, wValue, wIndex, buf, wLength);
162
163	/* if we are only an humble host without any special capabilities
164	 * process the request straight away and exit */
165
166	if (info == NULL) {
167		ret = ohci_hub_control(hcd, typeReq, wValue,
168				       wIndex, buf, wLength);
169		goto out;
170	}
171
172	/* check the request to see if it needs handling */
173
174	switch (typeReq) {
175	case SetPortFeature:
176		if (wValue == USB_PORT_FEAT_POWER) {
177			dev_dbg(hcd->self.controller, "SetPortFeat: POWER\n");
178			s3c2410_usb_set_power(info, wIndex, 1);
179			goto out;
180		}
181		break;
182
183	case ClearPortFeature:
184		switch (wValue) {
185		case USB_PORT_FEAT_C_OVER_CURRENT:
186			dev_dbg(hcd->self.controller,
187				"ClearPortFeature: C_OVER_CURRENT\n");
188
189			if (valid_port(wIndex)) {
190				info->port[wIndex-1].oc_changed = 0;
191				info->port[wIndex-1].oc_status = 0;
192			}
193
194			goto out;
195
196		case USB_PORT_FEAT_OVER_CURRENT:
197			dev_dbg(hcd->self.controller,
198				"ClearPortFeature: OVER_CURRENT\n");
199
200			if (valid_port(wIndex))
201				info->port[wIndex-1].oc_status = 0;
202
203			goto out;
204
205		case USB_PORT_FEAT_POWER:
206			dev_dbg(hcd->self.controller,
207				"ClearPortFeature: POWER\n");
208
209			if (valid_port(wIndex)) {
210				s3c2410_usb_set_power(info, wIndex, 0);
211				return 0;
212			}
213		}
214		break;
215	}
216
217	ret = ohci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
218	if (ret)
219		goto out;
220
221	switch (typeReq) {
222	case GetHubDescriptor:
223
224		/* update the hub's descriptor */
225
226		desc = (struct usb_hub_descriptor *)buf;
227
228		if (info->power_control == NULL)
229			return ret;
230
231		dev_dbg(hcd->self.controller, "wHubCharacteristics 0x%04x\n",
232			desc->wHubCharacteristics);
233
234		/* remove the old configurations for power-switching, and
235		 * over-current protection, and insert our new configuration
236		 */
237
238		desc->wHubCharacteristics &= ~cpu_to_le16(HUB_CHAR_LPSM);
239		desc->wHubCharacteristics |= cpu_to_le16(0x0001);
 
240
241		if (info->enable_oc) {
242			desc->wHubCharacteristics &= ~cpu_to_le16(
243				HUB_CHAR_OCPM);
244			desc->wHubCharacteristics |=  cpu_to_le16(
245				0x0008 |
246				0x0001);
247		}
248
249		dev_dbg(hcd->self.controller, "wHubCharacteristics after 0x%04x\n",
250			desc->wHubCharacteristics);
251
252		return ret;
253
254	case GetPortStatus:
255		/* check port status */
256
257		dev_dbg(hcd->self.controller, "GetPortStatus(%d)\n", wIndex);
258
259		if (valid_port(wIndex)) {
260			if (info->port[wIndex-1].oc_changed)
261				*data |= cpu_to_le32(RH_PS_OCIC);
262
263			if (info->port[wIndex-1].oc_status)
264				*data |= cpu_to_le32(RH_PS_POCI);
265		}
266	}
267
268 out:
269	return ret;
270}
271
272/* s3c2410_hcd_oc
273 *
274 * handle an over-current report
275*/
276
277static void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc)
278{
279	struct s3c2410_hcd_port *port;
280	struct usb_hcd *hcd;
281	unsigned long flags;
282	int portno;
283
284	if (info == NULL)
285		return;
286
287	port = &info->port[0];
288	hcd = info->hcd;
289
290	local_irq_save(flags);
291
292	for (portno = 0; portno < 2; port++, portno++) {
293		if (port_oc & (1<<portno) &&
294		    port->flags & S3C_HCDFLG_USED) {
295			port->oc_status = 1;
296			port->oc_changed = 1;
297
298			/* ok, once over-current is detected,
299			   the port needs to be powered down */
300			s3c2410_usb_set_power(info, portno+1, 0);
301		}
302	}
303
304	local_irq_restore(flags);
305}
306
307/* may be called without controller electrically present */
308/* may be called with controller, bus, and devices active */
309
310/*
311 * usb_hcd_s3c2410_remove - shutdown processing for HCD
312 * @dev: USB Host Controller being removed
313 * Context: !in_interrupt()
314 *
315 * Reverses the effect of usb_hcd_3c2410_probe(), first invoking
 
 
316 * the HCD's stop() method.  It is always called from a thread
317 * context, normally "rmmod", "apmd", or something similar.
318 *
319*/
320
321static void
322usb_hcd_s3c2410_remove(struct usb_hcd *hcd, struct platform_device *dev)
323{
 
 
324	usb_remove_hcd(hcd);
325	s3c2410_stop_hc(dev);
326	iounmap(hcd->regs);
327	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
328	usb_put_hcd(hcd);
329}
330
331/**
332 * usb_hcd_s3c2410_probe - initialize S3C2410-based HCDs
333 * Context: !in_interrupt()
 
 
334 *
335 * Allocates basic resources for this USB host controller, and
336 * then invokes the start() method for the HCD associated with it
337 * through the hotplug entry's driver_data.
338 *
339 */
340static int usb_hcd_s3c2410_probe(const struct hc_driver *driver,
341				  struct platform_device *dev)
342{
343	struct usb_hcd *hcd = NULL;
344	int retval;
 
345
346	s3c2410_usb_set_power(dev->dev.platform_data, 1, 1);
347	s3c2410_usb_set_power(dev->dev.platform_data, 2, 1);
348
349	hcd = usb_create_hcd(driver, &dev->dev, "s3c24xx");
350	if (hcd == NULL)
351		return -ENOMEM;
352
353	hcd->rsrc_start = dev->resource[0].start;
354	hcd->rsrc_len	= resource_size(&dev->resource[0]);
355
356	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {
357		dev_err(&dev->dev, "request_mem_region failed\n");
358		retval = -EBUSY;
359		goto err_put;
360	}
361
362	clk = clk_get(&dev->dev, "usb-host");
363	if (IS_ERR(clk)) {
364		dev_err(&dev->dev, "cannot get usb-host clock\n");
365		retval = PTR_ERR(clk);
366		goto err_mem;
367	}
368
369	usb_clk = clk_get(&dev->dev, "usb-bus-host");
370	if (IS_ERR(usb_clk)) {
371		dev_err(&dev->dev, "cannot get usb-bus-host clock\n");
372		retval = PTR_ERR(usb_clk);
373		goto err_clk;
374	}
375
376	s3c2410_start_hc(dev, hcd);
377
378	hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
379	if (!hcd->regs) {
380		dev_err(&dev->dev, "ioremap failed\n");
381		retval = -ENOMEM;
382		goto err_ioremap;
383	}
384
385	ohci_hcd_init(hcd_to_ohci(hcd));
386
387	retval = usb_add_hcd(hcd, dev->resource[1].start, 0);
388	if (retval != 0)
389		goto err_ioremap;
390
 
391	return 0;
392
393 err_ioremap:
394	s3c2410_stop_hc(dev);
395	iounmap(hcd->regs);
396	clk_put(usb_clk);
397
398 err_clk:
399	clk_put(clk);
400
401 err_mem:
402	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
403
404 err_put:
405	usb_put_hcd(hcd);
406	return retval;
407}
408
409/*-------------------------------------------------------------------------*/
410
411static int
412ohci_s3c2410_start(struct usb_hcd *hcd)
413{
414	struct ohci_hcd	*ohci = hcd_to_ohci(hcd);
415	int ret;
416
417	ret = ohci_init(ohci);
418	if (ret < 0)
419		return ret;
420
421	ret = ohci_run(ohci);
422	if (ret < 0) {
423		dev_err(hcd->self.controller, "can't start %s\n",
424			hcd->self.bus_name);
425		ohci_stop(hcd);
426		return ret;
427	}
428
429	return 0;
430}
431
432
433static const struct hc_driver ohci_s3c2410_hc_driver = {
434	.description =		hcd_name,
435	.product_desc =		"S3C24XX OHCI",
436	.hcd_priv_size =	sizeof(struct ohci_hcd),
437
438	/*
439	 * generic hardware linkage
440	 */
441	.irq =			ohci_irq,
442	.flags =		HCD_USB11 | HCD_MEMORY,
443
444	/*
445	 * basic lifecycle operations
446	 */
447	.start =		ohci_s3c2410_start,
448	.stop =			ohci_stop,
449	.shutdown =		ohci_shutdown,
450
451	/*
452	 * managing i/o requests and associated device resources
453	 */
454	.urb_enqueue =		ohci_urb_enqueue,
455	.urb_dequeue =		ohci_urb_dequeue,
456	.endpoint_disable =	ohci_endpoint_disable,
457
458	/*
459	 * scheduling support
460	 */
461	.get_frame_number =	ohci_get_frame,
462
463	/*
464	 * root hub support
465	 */
466	.hub_status_data =	ohci_s3c2410_hub_status_data,
467	.hub_control =		ohci_s3c2410_hub_control,
468#ifdef	CONFIG_PM
469	.bus_suspend =		ohci_bus_suspend,
470	.bus_resume =		ohci_bus_resume,
471#endif
472	.start_port_reset =	ohci_start_port_reset,
473};
474
475/* device driver */
476
477static int __devinit ohci_hcd_s3c2410_drv_probe(struct platform_device *pdev)
478{
479	return usb_hcd_s3c2410_probe(&ohci_s3c2410_hc_driver, pdev);
480}
481
482static int __devexit ohci_hcd_s3c2410_drv_remove(struct platform_device *pdev)
483{
484	struct usb_hcd *hcd = platform_get_drvdata(pdev);
485
486	usb_hcd_s3c2410_remove(hcd, pdev);
487	return 0;
488}
489
490#ifdef CONFIG_PM
491static int ohci_hcd_s3c2410_drv_suspend(struct device *dev)
492{
493	struct usb_hcd *hcd = dev_get_drvdata(dev);
494	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
495	struct platform_device *pdev = to_platform_device(dev);
496	unsigned long flags;
497	int rc = 0;
498
499	/*
500	 * Root hub was already suspended. Disable irq emission and
501	 * mark HW unaccessible, bail out if RH has been resumed. Use
502	 * the spinlock to properly synchronize with possible pending
503	 * RH suspend or resume activity.
504	 */
505	spin_lock_irqsave(&ohci->lock, flags);
506	if (ohci->rh_state != OHCI_RH_SUSPENDED) {
507		rc = -EINVAL;
508		goto bail;
509	}
510
511	clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
512
513	s3c2410_stop_hc(pdev);
514bail:
515	spin_unlock_irqrestore(&ohci->lock, flags);
516
517	return rc;
518}
519
520static int ohci_hcd_s3c2410_drv_resume(struct device *dev)
521{
522	struct usb_hcd *hcd = dev_get_drvdata(dev);
523	struct platform_device *pdev = to_platform_device(dev);
524
525	s3c2410_start_hc(pdev, hcd);
526
527	set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
528	ohci_finish_controller_resume(hcd);
529
530	return 0;
531}
532#else
533#define ohci_hcd_s3c2410_drv_suspend	NULL
534#define ohci_hcd_s3c2410_drv_resume	NULL
535#endif
536
537static const struct dev_pm_ops ohci_hcd_s3c2410_pm_ops = {
538	.suspend	= ohci_hcd_s3c2410_drv_suspend,
539	.resume		= ohci_hcd_s3c2410_drv_resume,
540};
541
 
 
 
 
 
 
 
542static struct platform_driver ohci_hcd_s3c2410_driver = {
543	.probe		= ohci_hcd_s3c2410_drv_probe,
544	.remove		= __devexit_p(ohci_hcd_s3c2410_drv_remove),
545	.shutdown	= usb_hcd_platform_shutdown,
546	.driver		= {
547		.owner	= THIS_MODULE,
548		.name	= "s3c2410-ohci",
549		.pm	= &ohci_hcd_s3c2410_pm_ops,
 
550	},
551};
552
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
553MODULE_ALIAS("platform:s3c2410-ohci");