[mirror_ubuntu-focal-kernel.git] / drivers / usb / host / ohci-tmio.c

// SPDX-License-Identifier: GPL-2.0
/*
 * OHCI HCD(Host Controller Driver) for USB.
 *
 *(C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
 *(C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net>
 *(C) Copyright 2002 Hewlett-Packard Company
 *
 * Bus glue for Toshiba Mobile IO(TMIO) Controller's OHCI core
 * (C) Copyright 2005 Chris Humbert <mahadri-usb@drigon.com>
 * (C) Copyright 2007, 2008 Dmitry Baryshkov <dbaryshkov@gmail.com>
 *
 * This is known to work with the following variants:
 *	TC6393XB revision 3	(32kB SRAM)
 *
 * The TMIO's OHCI core DMAs through a small internal buffer that
 * is directly addressable by the CPU.
 *
 * Written from sparse documentation from Toshiba and Sharp's driver
 * for the 2.4 kernel,
 *	usb-ohci-tc6393.c(C) Copyright 2004 Lineo Solutions, Inc.
 */

/*#include <linux/fs.h>
#include <linux/mount.h>
#include <linux/pagemap.h>
#include <linux/namei.h>
#include <linux/sched.h>*/
#include <linux/platform_device.h>
#include <linux/mfd/core.h>
#include <linux/mfd/tmio.h>
#include <linux/dma-mapping.h>

/*-------------------------------------------------------------------------*/

/*
 * USB Host Controller Configuration Register
 */
#define CCR_REVID	0x08	/* b Revision ID				*/
#define CCR_BASE	0x10	/* l USB Control Register Base Address Low	*/
#define CCR_ILME	0x40	/* b Internal Local Memory Enable		*/
#define CCR_PM		0x4c	/* w Power Management			*/
#define CCR_INTC	0x50	/* b INT Control				*/
#define CCR_LMW1L	0x54	/* w Local Memory Window 1 LMADRS Low	*/
#define CCR_LMW1H	0x56	/* w Local Memory Window 1 LMADRS High	*/
#define CCR_LMW1BL	0x58	/* w Local Memory Window 1 Base Address Low	*/
#define CCR_LMW1BH	0x5A	/* w Local Memory Window 1 Base Address High	*/
#define CCR_LMW2L	0x5C	/* w Local Memory Window 2 LMADRS Low	*/
#define CCR_LMW2H	0x5E	/* w Local Memory Window 2 LMADRS High	*/
#define CCR_LMW2BL	0x60	/* w Local Memory Window 2 Base Address Low	*/
#define CCR_LMW2BH	0x62	/* w Local Memory Window 2 Base Address High	*/
#define CCR_MISC	0xFC	/* b MISC					*/

#define CCR_PM_GKEN      0x0001
#define CCR_PM_CKRNEN    0x0002
#define CCR_PM_USBPW1    0x0004
#define CCR_PM_USBPW2    0x0008
#define CCR_PM_USBPW3    0x0010
#define CCR_PM_PMEE      0x0100
#define CCR_PM_PMES      0x8000

/*-------------------------------------------------------------------------*/

struct tmio_hcd {
	void __iomem		*ccr;
	spinlock_t		lock; /* protects RMW cycles */
};

#define hcd_to_tmio(hcd)	((struct tmio_hcd *)(hcd_to_ohci(hcd) + 1))

/*-------------------------------------------------------------------------*/

static void tmio_write_pm(struct platform_device *dev)
{
	struct usb_hcd *hcd = platform_get_drvdata(dev);
	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	u16 pm;
	unsigned long flags;

	spin_lock_irqsave(&tmio->lock, flags);

	pm = CCR_PM_GKEN | CCR_PM_CKRNEN |
	     CCR_PM_PMEE | CCR_PM_PMES;

	tmio_iowrite16(pm, tmio->ccr + CCR_PM);
	spin_unlock_irqrestore(&tmio->lock, flags);
}

static void tmio_stop_hc(struct platform_device *dev)
{
	struct usb_hcd *hcd = platform_get_drvdata(dev);
	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	u16 pm;

	pm = CCR_PM_GKEN | CCR_PM_CKRNEN;
	switch (ohci->num_ports) {
		default:
			dev_err(&dev->dev, "Unsupported amount of ports: %d\n", ohci->num_ports);
		case 3:
			pm |= CCR_PM_USBPW3;
		case 2:
			pm |= CCR_PM_USBPW2;
		case 1:
			pm |= CCR_PM_USBPW1;
	}
	tmio_iowrite8(0, tmio->ccr + CCR_INTC);
	tmio_iowrite8(0, tmio->ccr + CCR_ILME);
	tmio_iowrite16(0, tmio->ccr + CCR_BASE);
	tmio_iowrite16(0, tmio->ccr + CCR_BASE + 2);
	tmio_iowrite16(pm, tmio->ccr + CCR_PM);
}

static void tmio_start_hc(struct platform_device *dev)
{
	struct usb_hcd *hcd = platform_get_drvdata(dev);
	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	unsigned long base = hcd->rsrc_start;

	tmio_write_pm(dev);
	tmio_iowrite16(base, tmio->ccr + CCR_BASE);
	tmio_iowrite16(base >> 16, tmio->ccr + CCR_BASE + 2);
	tmio_iowrite8(1, tmio->ccr + CCR_ILME);
	tmio_iowrite8(2, tmio->ccr + CCR_INTC);

	dev_info(&dev->dev, "revision %d @ 0x%08llx, irq %d\n",
			tmio_ioread8(tmio->ccr + CCR_REVID),
			(u64) hcd->rsrc_start, hcd->irq);
}

static int ohci_tmio_start(struct usb_hcd *hcd)
{
	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	int ret;

	if ((ret = ohci_init(ohci)) < 0)
		return ret;

	if ((ret = ohci_run(ohci)) < 0) {
		dev_err(hcd->self.controller, "can't start %s\n",
			hcd->self.bus_name);
		ohci_stop(hcd);
		return ret;
	}

	return 0;
}

static const struct hc_driver ohci_tmio_hc_driver = {
	.description =		hcd_name,
	.product_desc =		"TMIO OHCI USB Host Controller",
	.hcd_priv_size =	sizeof(struct ohci_hcd) + sizeof (struct tmio_hcd),

	/* generic hardware linkage */
	.irq =			ohci_irq,
	.flags =		HCD_USB11 | HCD_MEMORY,

	/* basic lifecycle operations */
	.start =		ohci_tmio_start,
	.stop =			ohci_stop,
	.shutdown =		ohci_shutdown,

	/* managing i/o requests and associated device resources */
	.urb_enqueue =		ohci_urb_enqueue,
	.urb_dequeue =		ohci_urb_dequeue,
	.endpoint_disable =	ohci_endpoint_disable,

	/* scheduling support */
	.get_frame_number =	ohci_get_frame,

	/* root hub support */
	.hub_status_data =	ohci_hub_status_data,
	.hub_control =		ohci_hub_control,
#ifdef	CONFIG_PM
	.bus_suspend =		ohci_bus_suspend,
	.bus_resume =		ohci_bus_resume,
#endif
	.start_port_reset =	ohci_start_port_reset,
};

/*-------------------------------------------------------------------------*/
static struct platform_driver ohci_hcd_tmio_driver;

static int ohci_hcd_tmio_drv_probe(struct platform_device *dev)
{
	const struct mfd_cell *cell = mfd_get_cell(dev);
	struct resource *regs = platform_get_resource(dev, IORESOURCE_MEM, 0);
	struct resource *config = platform_get_resource(dev, IORESOURCE_MEM, 1);
	struct resource *sram = platform_get_resource(dev, IORESOURCE_MEM, 2);
	int irq = platform_get_irq(dev, 0);
	struct tmio_hcd *tmio;
	struct ohci_hcd *ohci;
	struct usb_hcd *hcd;
	int ret;

	if (usb_disabled())
		return -ENODEV;

	if (!cell)
		return -EINVAL;

	hcd = usb_create_hcd(&ohci_tmio_hc_driver, &dev->dev, dev_name(&dev->dev));
	if (!hcd) {
		ret = -ENOMEM;
		goto err_usb_create_hcd;
	}

	hcd->rsrc_start = regs->start;
	hcd->rsrc_len = resource_size(regs);

	tmio = hcd_to_tmio(hcd);

	spin_lock_init(&tmio->lock);

	tmio->ccr = ioremap(config->start, resource_size(config));
	if (!tmio->ccr) {
		ret = -ENOMEM;
		goto err_ioremap_ccr;
	}

	hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
	if (!hcd->regs) {
		ret = -ENOMEM;
		goto err_ioremap_regs;
	}

	if (cell->enable) {
		ret = cell->enable(dev);
		if (ret)
			goto err_enable;
	}

	tmio_start_hc(dev);
	ohci = hcd_to_ohci(hcd);
	ohci_hcd_init(ohci);

	ret = usb_hcd_setup_local_mem(hcd, sram->start, sram->start,
				      resource_size(sram));
	if (ret < 0)
		goto err_enable;

	ret = usb_add_hcd(hcd, irq, 0);
	if (ret)
		goto err_add_hcd;

	device_wakeup_enable(hcd->self.controller);
	if (ret == 0)
		return ret;

	usb_remove_hcd(hcd);

err_add_hcd:
	tmio_stop_hc(dev);
	if (cell->disable)
		cell->disable(dev);
err_enable:
	iounmap(hcd->regs);
err_ioremap_regs:
	iounmap(tmio->ccr);
err_ioremap_ccr:
	usb_put_hcd(hcd);
err_usb_create_hcd:

	return ret;
}

static int ohci_hcd_tmio_drv_remove(struct platform_device *dev)
{
	struct usb_hcd *hcd = platform_get_drvdata(dev);
	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	const struct mfd_cell *cell = mfd_get_cell(dev);

	usb_remove_hcd(hcd);
	tmio_stop_hc(dev);
	if (cell->disable)
		cell->disable(dev);
	iounmap(hcd->regs);
	iounmap(tmio->ccr);
	usb_put_hcd(hcd);

	return 0;
}

#ifdef CONFIG_PM
static int ohci_hcd_tmio_drv_suspend(struct platform_device *dev, pm_message_t state)
{
	const struct mfd_cell *cell = mfd_get_cell(dev);
	struct usb_hcd *hcd = platform_get_drvdata(dev);
	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	unsigned long flags;
	u8 misc;
	int ret;

	if (time_before(jiffies, ohci->next_statechange))
		msleep(5);
	ohci->next_statechange = jiffies;

	spin_lock_irqsave(&tmio->lock, flags);

	misc = tmio_ioread8(tmio->ccr + CCR_MISC);
	misc |= 1 << 3; /* USSUSP */
	tmio_iowrite8(misc, tmio->ccr + CCR_MISC);

	spin_unlock_irqrestore(&tmio->lock, flags);

	if (cell->suspend) {
		ret = cell->suspend(dev);
		if (ret)
			return ret;
	}
	return 0;
}

static int ohci_hcd_tmio_drv_resume(struct platform_device *dev)
{
	const struct mfd_cell *cell = mfd_get_cell(dev);
	struct usb_hcd *hcd = platform_get_drvdata(dev);
	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	unsigned long flags;
	u8 misc;
	int ret;

	if (time_before(jiffies, ohci->next_statechange))
		msleep(5);
	ohci->next_statechange = jiffies;

	if (cell->resume) {
		ret = cell->resume(dev);
		if (ret)
			return ret;
	}

	tmio_start_hc(dev);

	spin_lock_irqsave(&tmio->lock, flags);

	misc = tmio_ioread8(tmio->ccr + CCR_MISC);
	misc &= ~(1 << 3); /* USSUSP */
	tmio_iowrite8(misc, tmio->ccr + CCR_MISC);

	spin_unlock_irqrestore(&tmio->lock, flags);

	ohci_resume(hcd, false);

	return 0;
}
#else
#define ohci_hcd_tmio_drv_suspend NULL
#define ohci_hcd_tmio_drv_resume NULL
#endif

static struct platform_driver ohci_hcd_tmio_driver = {
	.probe		= ohci_hcd_tmio_drv_probe,
	.remove		= ohci_hcd_tmio_drv_remove,
	.shutdown	= usb_hcd_platform_shutdown,
	.suspend	= ohci_hcd_tmio_drv_suspend,
	.resume		= ohci_hcd_tmio_drv_resume,
	.driver		= {
		.name	= "tmio-ohci",
	},
};
Commit	Line	Data
5fd54ace	1	// SPDX-License-Identifier: GPL-2.0
78c73414 DES	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 Toshiba Mobile IO(TMIO) Controller's OHCI core
	10	* (C) Copyright 2005 Chris Humbert <mahadri-usb@drigon.com>
	11	* (C) Copyright 2007, 2008 Dmitry Baryshkov <dbaryshkov@gmail.com>
	12	*
	13	* This is known to work with the following variants:
	14	* TC6393XB revision 3 (32kB SRAM)
	15	*
	16	* The TMIO's OHCI core DMAs through a small internal buffer that
	17	* is directly addressable by the CPU.
	18	*
	19	* Written from sparse documentation from Toshiba and Sharp's driver
	20	* for the 2.4 kernel,
	21	* usb-ohci-tc6393.c(C) Copyright 2004 Lineo Solutions, Inc.
78c73414 DES	22	*/
	23
	24	/*#include <linux/fs.h>
	25	#include <linux/mount.h>
	26	#include <linux/pagemap.h>
78c73414 DES	27	#include <linux/namei.h>
	28	#include <linux/sched.h>*/
	29	#include <linux/platform_device.h>
	30	#include <linux/mfd/core.h>
	31	#include <linux/mfd/tmio.h>
	32	#include <linux/dma-mapping.h>
	33
	34	/-------------------------------------------------------------------------/
	35
	36	/*
	37	* USB Host Controller Configuration Register
	38	*/
	39	#define CCR_REVID 0x08 /* b Revision ID */
	40	#define CCR_BASE 0x10 /* l USB Control Register Base Address Low */
	41	#define CCR_ILME 0x40 /* b Internal Local Memory Enable */
	42	#define CCR_PM 0x4c /* w Power Management */
	43	#define CCR_INTC 0x50 /* b INT Control */
	44	#define CCR_LMW1L 0x54 /* w Local Memory Window 1 LMADRS Low */
	45	#define CCR_LMW1H 0x56 /* w Local Memory Window 1 LMADRS High */
	46	#define CCR_LMW1BL 0x58 /* w Local Memory Window 1 Base Address Low */
	47	#define CCR_LMW1BH 0x5A /* w Local Memory Window 1 Base Address High */
	48	#define CCR_LMW2L 0x5C /* w Local Memory Window 2 LMADRS Low */
	49	#define CCR_LMW2H 0x5E /* w Local Memory Window 2 LMADRS High */
	50	#define CCR_LMW2BL 0x60 /* w Local Memory Window 2 Base Address Low */
	51	#define CCR_LMW2BH 0x62 /* w Local Memory Window 2 Base Address High */
	52	#define CCR_MISC 0xFC /* b MISC */
	53
	54	#define CCR_PM_GKEN 0x0001
	55	#define CCR_PM_CKRNEN 0x0002
	56	#define CCR_PM_USBPW1 0x0004
	57	#define CCR_PM_USBPW2 0x0008
1209544d	58	#define CCR_PM_USBPW3 0x0010
78c73414 DES	59	#define CCR_PM_PMEE 0x0100
	60	#define CCR_PM_PMES 0x8000
	61
	62	/-------------------------------------------------------------------------/
	63
	64	struct tmio_hcd {
	65	void __iomem *ccr;
	66	spinlock_t lock; /* protects RMW cycles */
	67	};
	68
	69	#define hcd_to_tmio(hcd) ((struct tmio_hcd *)(hcd_to_ohci(hcd) + 1))
	70
	71	/-------------------------------------------------------------------------/
	72
	73	static void tmio_write_pm(struct platform_device *dev)
	74	{
	75	struct usb_hcd *hcd = platform_get_drvdata(dev);
	76	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	77	u16 pm;
	78	unsigned long flags;
	79
	80	spin_lock_irqsave(&tmio->lock, flags);
	81
	82	pm = CCR_PM_GKEN \| CCR_PM_CKRNEN \|
	83	CCR_PM_PMEE \| CCR_PM_PMES;
	84
	85	tmio_iowrite16(pm, tmio->ccr + CCR_PM);
	86	spin_unlock_irqrestore(&tmio->lock, flags);
	87	}
	88
	89	static void tmio_stop_hc(struct platform_device *dev)
	90	{
	91	struct usb_hcd *hcd = platform_get_drvdata(dev);
	92	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	93	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	94	u16 pm;
	95
	96	pm = CCR_PM_GKEN \| CCR_PM_CKRNEN;
	97	switch (ohci->num_ports) {
	98	default:
	99	dev_err(&dev->dev, "Unsupported amount of ports: %d\n", ohci->num_ports);
	100	case 3:
	101	pm \|= CCR_PM_USBPW3;
	102	case 2:
	103	pm \|= CCR_PM_USBPW2;
	104	case 1:
	105	pm \|= CCR_PM_USBPW1;
	106	}
	107	tmio_iowrite8(0, tmio->ccr + CCR_INTC);
	108	tmio_iowrite8(0, tmio->ccr + CCR_ILME);
	109	tmio_iowrite16(0, tmio->ccr + CCR_BASE);
	110	tmio_iowrite16(0, tmio->ccr + CCR_BASE + 2);
	111	tmio_iowrite16(pm, tmio->ccr + CCR_PM);
	112	}
	113
	114	static void tmio_start_hc(struct platform_device *dev)
	115	{
	116	struct usb_hcd *hcd = platform_get_drvdata(dev);
	117	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	118	unsigned long base = hcd->rsrc_start;
	119
	120	tmio_write_pm(dev);
	121	tmio_iowrite16(base, tmio->ccr + CCR_BASE);
	122	tmio_iowrite16(base >> 16, tmio->ccr + CCR_BASE + 2);
123	tmio_iowrite8(1, tmio->ccr + CCR_ILME);
124	tmio_iowrite8(2, tmio->ccr + CCR_INTC);
125
126	dev_info(&dev->dev, "revision %d @ 0x%08llx, irq %d\n",
8e8de5ab FB	127	tmio_ioread8(tmio->ccr + CCR_REVID),
8e8de5ab FB	128	(u64) hcd->rsrc_start, hcd->irq);
78c73414 DES	129	}
	130
	131	static int ohci_tmio_start(struct usb_hcd *hcd)
	132	{
	133	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	134	int ret;
	135
	136	if ((ret = ohci_init(ohci)) < 0)
	137	return ret;
	138
	139	if ((ret = ohci_run(ohci)) < 0) {
3b8ca26f GKH	140	dev_err(hcd->self.controller, "can't start %s\n",
3b8ca26f GKH	141	hcd->self.bus_name);
78c73414 DES	142	ohci_stop(hcd);
	143	return ret;
	144	}
	145
	146	return 0;
	147	}
	148
	149	static const struct hc_driver ohci_tmio_hc_driver = {
	150	.description = hcd_name,
	151	.product_desc = "TMIO OHCI USB Host Controller",
	152	.hcd_priv_size = sizeof(struct ohci_hcd) + sizeof (struct tmio_hcd),
	153
	154	/* generic hardware linkage */
	155	.irq = ohci_irq,
2d7a3dc3	156	.flags = HCD_USB11 \| HCD_MEMORY,
78c73414 DES	157
	158	/* basic lifecycle operations */
	159	.start = ohci_tmio_start,
	160	.stop = ohci_stop,
	161	.shutdown = ohci_shutdown,
	162
	163	/* managing i/o requests and associated device resources */
	164	.urb_enqueue = ohci_urb_enqueue,
	165	.urb_dequeue = ohci_urb_dequeue,
	166	.endpoint_disable = ohci_endpoint_disable,
	167
	168	/* scheduling support */
	169	.get_frame_number = ohci_get_frame,
	170
	171	/* root hub support */
	172	.hub_status_data = ohci_hub_status_data,
	173	.hub_control = ohci_hub_control,
	174	#ifdef CONFIG_PM
	175	.bus_suspend = ohci_bus_suspend,
	176	.bus_resume = ohci_bus_resume,
	177	#endif
	178	.start_port_reset = ohci_start_port_reset,
	179	};
	180
	181	/-------------------------------------------------------------------------/
	182	static struct platform_driver ohci_hcd_tmio_driver;
	183
41ac7b3a	184	static int ohci_hcd_tmio_drv_probe(struct platform_device *dev)
78c73414	185	{
944dc035	186	const struct mfd_cell *cell = mfd_get_cell(dev);
78c73414 DES	187	struct resource *regs = platform_get_resource(dev, IORESOURCE_MEM, 0);
	188	struct resource *config = platform_get_resource(dev, IORESOURCE_MEM, 1);
	189	struct resource *sram = platform_get_resource(dev, IORESOURCE_MEM, 2);
	190	int irq = platform_get_irq(dev, 0);
	191	struct tmio_hcd *tmio;
	192	struct ohci_hcd *ohci;
	193	struct usb_hcd *hcd;
	194	int ret;
	195
	196	if (usb_disabled())
	197	return -ENODEV;
	198
	199	if (!cell)
	200	return -EINVAL;
	201
427c4f33	202	hcd = usb_create_hcd(&ohci_tmio_hc_driver, &dev->dev, dev_name(&dev->dev));
78c73414 DES	203	if (!hcd) {
	204	ret = -ENOMEM;
	205	goto err_usb_create_hcd;
	206	}
	207
	208	hcd->rsrc_start = regs->start;
28f65c11	209	hcd->rsrc_len = resource_size(regs);
78c73414 DES	210
	211	tmio = hcd_to_tmio(hcd);
	212
	213	spin_lock_init(&tmio->lock);
	214
28f65c11	215	tmio->ccr = ioremap(config->start, resource_size(config));
78c73414 DES	216	if (!tmio->ccr) {
	217	ret = -ENOMEM;
	218	goto err_ioremap_ccr;
	219	}
	220
	221	hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
	222	if (!hcd->regs) {
	223	ret = -ENOMEM;
	224	goto err_ioremap_regs;
	225	}
	226
78c73414 DES	227	if (cell->enable) {
	228	ret = cell->enable(dev);
	229	if (ret)
	230	goto err_enable;
	231	}
	232
	233	tmio_start_hc(dev);
	234	ohci = hcd_to_ohci(hcd);
	235	ohci_hcd_init(ohci);
	236
7d995329 LT	237	ret = usb_hcd_setup_local_mem(hcd, sram->start, sram->start,
	238	resource_size(sram));
	239	if (ret < 0)
	240	goto err_enable;
	241
b5dd18d8	242	ret = usb_add_hcd(hcd, irq, 0);
78c73414 DES	243	if (ret)
	244	goto err_add_hcd;
	245
3c9740a1	246	device_wakeup_enable(hcd->self.controller);
78c73414 DES	247	if (ret == 0)
	248	return ret;
	249
	250	usb_remove_hcd(hcd);
	251
	252	err_add_hcd:
	253	tmio_stop_hc(dev);
	254	if (cell->disable)
	255	cell->disable(dev);
	256	err_enable:
78c73414 DES	257	iounmap(hcd->regs);
	258	err_ioremap_regs:
	259	iounmap(tmio->ccr);
	260	err_ioremap_ccr:
	261	usb_put_hcd(hcd);
	262	err_usb_create_hcd:
	263
	264	return ret;
	265	}
	266
fb4e98ab	267	static int ohci_hcd_tmio_drv_remove(struct platform_device *dev)
78c73414 DES	268	{
	269	struct usb_hcd *hcd = platform_get_drvdata(dev);
	270	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
944dc035	271	const struct mfd_cell *cell = mfd_get_cell(dev);
78c73414 DES	272
	273	usb_remove_hcd(hcd);
	274	tmio_stop_hc(dev);
	275	if (cell->disable)
	276	cell->disable(dev);
78c73414 DES	277	iounmap(hcd->regs);
	278	iounmap(tmio->ccr);
	279	usb_put_hcd(hcd);
	280
78c73414 DES	281	return 0;
	282	}
	283
	284	#ifdef CONFIG_PM
	285	static int ohci_hcd_tmio_drv_suspend(struct platform_device *dev, pm_message_t state)
	286	{
944dc035	287	const struct mfd_cell *cell = mfd_get_cell(dev);
78c73414 DES	288	struct usb_hcd *hcd = platform_get_drvdata(dev);
	289	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	290	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	291	unsigned long flags;
	292	u8 misc;
	293	int ret;
	294
	295	if (time_before(jiffies, ohci->next_statechange))
	296	msleep(5);
	297	ohci->next_statechange = jiffies;
	298
	299	spin_lock_irqsave(&tmio->lock, flags);
	300
	301	misc = tmio_ioread8(tmio->ccr + CCR_MISC);
	302	misc \|= 1 << 3; /* USSUSP */
	303	tmio_iowrite8(misc, tmio->ccr + CCR_MISC);
	304
	305	spin_unlock_irqrestore(&tmio->lock, flags);
	306
	307	if (cell->suspend) {
	308	ret = cell->suspend(dev);
	309	if (ret)
	310	return ret;
	311	}
78c73414 DES	312	return 0;
	313	}
	314
	315	static int ohci_hcd_tmio_drv_resume(struct platform_device *dev)
	316	{
944dc035	317	const struct mfd_cell *cell = mfd_get_cell(dev);
78c73414 DES	318	struct usb_hcd *hcd = platform_get_drvdata(dev);
	319	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
	320	struct tmio_hcd *tmio = hcd_to_tmio(hcd);
	321	unsigned long flags;
	322	u8 misc;
	323	int ret;
	324
	325	if (time_before(jiffies, ohci->next_statechange))
	326	msleep(5);
	327	ohci->next_statechange = jiffies;
	328
	329	if (cell->resume) {
	330	ret = cell->resume(dev);
	331	if (ret)
	332	return ret;
	333	}
	334
	335	tmio_start_hc(dev);
	336
	337	spin_lock_irqsave(&tmio->lock, flags);
	338
	339	misc = tmio_ioread8(tmio->ccr + CCR_MISC);
	340	misc &= ~(1 << 3); /* USSUSP */
	341	tmio_iowrite8(misc, tmio->ccr + CCR_MISC);
	342
	343	spin_unlock_irqrestore(&tmio->lock, flags);
	344
cfa49b4b	345	ohci_resume(hcd, false);
78c73414 DES	346
	347	return 0;
	348	}
	349	#else
	350	#define ohci_hcd_tmio_drv_suspend NULL
	351	#define ohci_hcd_tmio_drv_resume NULL
	352	#endif
	353
	354	static struct platform_driver ohci_hcd_tmio_driver = {
	355	.probe = ohci_hcd_tmio_drv_probe,
7690417d	356	.remove = ohci_hcd_tmio_drv_remove,
78c73414 DES	357	.shutdown = usb_hcd_platform_shutdown,
	358	.suspend = ohci_hcd_tmio_drv_suspend,
	359	.resume = ohci_hcd_tmio_drv_resume,
	360	.driver = {
	361	.name = "tmio-ohci",
78c73414 DES	362	},
78c73414 DES	363	};