core.c 18.7 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38
/**
 * core.c - DesignWare USB3 DRD Controller Core file
 *
 * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com
 *
 * Authors: Felipe Balbi <balbi@ti.com>,
 *	    Sebastian Andrzej Siewior <bigeasy@linutronix.de>
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions, and the following disclaimer,
 *    without modification.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. The names of the above-listed copyright holders may not be used
 *    to endorse or promote products derived from this software without
 *    specific prior written permission.
 *
 * ALTERNATIVELY, this software may be distributed under the terms of the
 * GNU General Public License ("GPL") version 2, as published by the Free
 * Software Foundation.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

39
#include <linux/module.h>
40 41 42 43 44 45 46 47 48 49 50
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/spinlock.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <linux/interrupt.h>
#include <linux/ioport.h>
#include <linux/io.h>
#include <linux/list.h>
#include <linux/delay.h>
#include <linux/dma-mapping.h>
51
#include <linux/of.h>
52

F
Felipe Balbi 已提交
53
#include <linux/usb/otg.h>
54 55 56 57 58 59 60 61 62
#include <linux/usb/ch9.h>
#include <linux/usb/gadget.h>

#include "core.h"
#include "gadget.h"
#include "io.h"

#include "debug.h"

63 64 65 66
static char *maximum_speed = "super";
module_param(maximum_speed, charp, 0);
MODULE_PARM_DESC(maximum_speed, "Maximum supported speed.");

67 68
/* -------------------------------------------------------------------------- */

69 70 71 72 73 74 75 76 77
void dwc3_set_mode(struct dwc3 *dwc, u32 mode)
{
	u32 reg;

	reg = dwc3_readl(dwc->regs, DWC3_GCTL);
	reg &= ~(DWC3_GCTL_PRTCAPDIR(DWC3_GCTL_PRTCAP_OTG));
	reg |= DWC3_GCTL_PRTCAPDIR(mode);
	dwc3_writel(dwc->regs, DWC3_GCTL, reg);
}
78

79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101
/**
 * dwc3_core_soft_reset - Issues core soft reset and PHY reset
 * @dwc: pointer to our context structure
 */
static void dwc3_core_soft_reset(struct dwc3 *dwc)
{
	u32		reg;

	/* Before Resetting PHY, put Core in Reset */
	reg = dwc3_readl(dwc->regs, DWC3_GCTL);
	reg |= DWC3_GCTL_CORESOFTRESET;
	dwc3_writel(dwc->regs, DWC3_GCTL, reg);

	/* Assert USB3 PHY reset */
	reg = dwc3_readl(dwc->regs, DWC3_GUSB3PIPECTL(0));
	reg |= DWC3_GUSB3PIPECTL_PHYSOFTRST;
	dwc3_writel(dwc->regs, DWC3_GUSB3PIPECTL(0), reg);

	/* Assert USB2 PHY reset */
	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
	reg |= DWC3_GUSB2PHYCFG_PHYSOFTRST;
	dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);

F
Felipe Balbi 已提交
102 103
	usb_phy_init(dwc->usb2_phy);
	usb_phy_init(dwc->usb3_phy);
104 105 106 107 108 109 110 111 112 113 114 115
	mdelay(100);

	/* Clear USB3 PHY reset */
	reg = dwc3_readl(dwc->regs, DWC3_GUSB3PIPECTL(0));
	reg &= ~DWC3_GUSB3PIPECTL_PHYSOFTRST;
	dwc3_writel(dwc->regs, DWC3_GUSB3PIPECTL(0), reg);

	/* Clear USB2 PHY reset */
	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
	reg &= ~DWC3_GUSB2PHYCFG_PHYSOFTRST;
	dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);

116 117
	mdelay(100);

118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135
	/* After PHYs are stable we can take Core out of reset state */
	reg = dwc3_readl(dwc->regs, DWC3_GCTL);
	reg &= ~DWC3_GCTL_CORESOFTRESET;
	dwc3_writel(dwc->regs, DWC3_GCTL, reg);
}

/**
 * dwc3_free_one_event_buffer - Frees one event buffer
 * @dwc: Pointer to our controller context structure
 * @evt: Pointer to event buffer to be freed
 */
static void dwc3_free_one_event_buffer(struct dwc3 *dwc,
		struct dwc3_event_buffer *evt)
{
	dma_free_coherent(dwc->dev, evt->length, evt->buf, evt->dma);
}

/**
136
 * dwc3_alloc_one_event_buffer - Allocates one event buffer structure
137 138 139
 * @dwc: Pointer to our controller context structure
 * @length: size of the event buffer
 *
140
 * Returns a pointer to the allocated event buffer structure on success
141 142
 * otherwise ERR_PTR(errno).
 */
143 144
static struct dwc3_event_buffer *dwc3_alloc_one_event_buffer(struct dwc3 *dwc,
		unsigned length)
145 146 147
{
	struct dwc3_event_buffer	*evt;

148
	evt = devm_kzalloc(dwc->dev, sizeof(*evt), GFP_KERNEL);
149 150 151 152 153 154 155
	if (!evt)
		return ERR_PTR(-ENOMEM);

	evt->dwc	= dwc;
	evt->length	= length;
	evt->buf	= dma_alloc_coherent(dwc->dev, length,
			&evt->dma, GFP_KERNEL);
156
	if (!evt->buf)
157 158 159 160 161 162 163 164 165 166 167 168 169 170
		return ERR_PTR(-ENOMEM);

	return evt;
}

/**
 * dwc3_free_event_buffers - frees all allocated event buffers
 * @dwc: Pointer to our controller context structure
 */
static void dwc3_free_event_buffers(struct dwc3 *dwc)
{
	struct dwc3_event_buffer	*evt;
	int i;

171
	for (i = 0; i < dwc->num_event_buffers; i++) {
172
		evt = dwc->ev_buffs[i];
173
		if (evt)
174 175 176 177 178 179
			dwc3_free_one_event_buffer(dwc, evt);
	}
}

/**
 * dwc3_alloc_event_buffers - Allocates @num event buffers of size @length
180
 * @dwc: pointer to our controller context structure
181 182
 * @length: size of event buffer
 *
183
 * Returns 0 on success otherwise negative errno. In the error case, dwc
184 185
 * may contain some buffers allocated but not all which were requested.
 */
B
Bill Pemberton 已提交
186
static int dwc3_alloc_event_buffers(struct dwc3 *dwc, unsigned length)
187
{
188
	int			num;
189 190
	int			i;

191 192 193
	num = DWC3_NUM_INT(dwc->hwparams.hwparams1);
	dwc->num_event_buffers = num;

194 195
	dwc->ev_buffs = devm_kzalloc(dwc->dev, sizeof(*dwc->ev_buffs) * num,
			GFP_KERNEL);
196 197 198 199 200
	if (!dwc->ev_buffs) {
		dev_err(dwc->dev, "can't allocate event buffers array\n");
		return -ENOMEM;
	}

201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216
	for (i = 0; i < num; i++) {
		struct dwc3_event_buffer	*evt;

		evt = dwc3_alloc_one_event_buffer(dwc, length);
		if (IS_ERR(evt)) {
			dev_err(dwc->dev, "can't allocate event buffer\n");
			return PTR_ERR(evt);
		}
		dwc->ev_buffs[i] = evt;
	}

	return 0;
}

/**
 * dwc3_event_buffers_setup - setup our allocated event buffers
217
 * @dwc: pointer to our controller context structure
218 219 220
 *
 * Returns 0 on success otherwise negative errno.
 */
221
static int dwc3_event_buffers_setup(struct dwc3 *dwc)
222 223 224 225
{
	struct dwc3_event_buffer	*evt;
	int				n;

226
	for (n = 0; n < dwc->num_event_buffers; n++) {
227 228 229 230 231
		evt = dwc->ev_buffs[n];
		dev_dbg(dwc->dev, "Event buf %p dma %08llx length %d\n",
				evt->buf, (unsigned long long) evt->dma,
				evt->length);

232 233
		evt->lpos = 0;

234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250
		dwc3_writel(dwc->regs, DWC3_GEVNTADRLO(n),
				lower_32_bits(evt->dma));
		dwc3_writel(dwc->regs, DWC3_GEVNTADRHI(n),
				upper_32_bits(evt->dma));
		dwc3_writel(dwc->regs, DWC3_GEVNTSIZ(n),
				evt->length & 0xffff);
		dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT(n), 0);
	}

	return 0;
}

static void dwc3_event_buffers_cleanup(struct dwc3 *dwc)
{
	struct dwc3_event_buffer	*evt;
	int				n;

251
	for (n = 0; n < dwc->num_event_buffers; n++) {
252
		evt = dwc->ev_buffs[n];
253 254 255

		evt->lpos = 0;

256 257 258 259 260 261 262
		dwc3_writel(dwc->regs, DWC3_GEVNTADRLO(n), 0);
		dwc3_writel(dwc->regs, DWC3_GEVNTADRHI(n), 0);
		dwc3_writel(dwc->regs, DWC3_GEVNTSIZ(n), 0);
		dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT(n), 0);
	}
}

263 264 265 266 267 268 269 270 271 272 273
static void dwc3_core_num_eps(struct dwc3 *dwc)
{
	struct dwc3_hwparams	*parms = &dwc->hwparams;

	dwc->num_in_eps = DWC3_NUM_IN_EPS(parms);
	dwc->num_out_eps = DWC3_NUM_EPS(parms) - dwc->num_in_eps;

	dev_vdbg(dwc->dev, "found %d IN and %d OUT endpoints\n",
			dwc->num_in_eps, dwc->num_out_eps);
}

B
Bill Pemberton 已提交
274
static void dwc3_cache_hwparams(struct dwc3 *dwc)
275 276 277 278 279 280 281 282 283 284 285 286 287 288
{
	struct dwc3_hwparams	*parms = &dwc->hwparams;

	parms->hwparams0 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS0);
	parms->hwparams1 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS1);
	parms->hwparams2 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS2);
	parms->hwparams3 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS3);
	parms->hwparams4 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS4);
	parms->hwparams5 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS5);
	parms->hwparams6 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS6);
	parms->hwparams7 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS7);
	parms->hwparams8 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS8);
}

289 290 291 292 293 294
/**
 * dwc3_core_init - Low-level initialization of DWC3 Core
 * @dwc: Pointer to our controller context structure
 *
 * Returns 0 on success otherwise negative errno.
 */
B
Bill Pemberton 已提交
295
static int dwc3_core_init(struct dwc3 *dwc)
296 297 298 299 300
{
	unsigned long		timeout;
	u32			reg;
	int			ret;

301 302 303 304 305 306 307
	reg = dwc3_readl(dwc->regs, DWC3_GSNPSID);
	/* This should read as U3 followed by revision number */
	if ((reg & DWC3_GSNPSID_MASK) != 0x55330000) {
		dev_err(dwc->dev, "this is not a DesignWare USB3 DRD Core\n");
		ret = -ENODEV;
		goto err0;
	}
308
	dwc->revision = reg;
309

310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326
	/* issue device SoftReset too */
	timeout = jiffies + msecs_to_jiffies(500);
	dwc3_writel(dwc->regs, DWC3_DCTL, DWC3_DCTL_CSFTRST);
	do {
		reg = dwc3_readl(dwc->regs, DWC3_DCTL);
		if (!(reg & DWC3_DCTL_CSFTRST))
			break;

		if (time_after(jiffies, timeout)) {
			dev_err(dwc->dev, "Reset Timed Out\n");
			ret = -ETIMEDOUT;
			goto err0;
		}

		cpu_relax();
	} while (true);

327 328
	dwc3_core_soft_reset(dwc);

329
	reg = dwc3_readl(dwc->regs, DWC3_GCTL);
330
	reg &= ~DWC3_GCTL_SCALEDOWN_MASK;
331 332
	reg &= ~DWC3_GCTL_DISSCRAMBLE;

333
	switch (DWC3_GHWPARAMS1_EN_PWROPT(dwc->hwparams.hwparams1)) {
334 335 336 337 338 339 340 341 342
	case DWC3_GHWPARAMS1_EN_PWROPT_CLK:
		reg &= ~DWC3_GCTL_DSBLCLKGTNG;
		break;
	default:
		dev_dbg(dwc->dev, "No power optimization available\n");
	}

	/*
	 * WORKAROUND: DWC3 revisions <1.90a have a bug
343
	 * where the device can fail to connect at SuperSpeed
344
	 * and falls back to high-speed mode which causes
345
	 * the device to enter a Connect/Disconnect loop
346 347 348 349
	 */
	if (dwc->revision < DWC3_REVISION_190A)
		reg |= DWC3_GCTL_U2RSTECN;

350 351
	dwc3_core_num_eps(dwc);

352 353
	dwc3_writel(dwc->regs, DWC3_GCTL, reg);

354 355 356 357 358 359 360 361
	return 0;

err0:
	return ret;
}

static void dwc3_core_exit(struct dwc3 *dwc)
{
362 363
	usb_phy_shutdown(dwc->usb2_phy);
	usb_phy_shutdown(dwc->usb3_phy);
364 365 366 367
}

#define DWC3_ALIGN_MASK		(16 - 1)

B
Bill Pemberton 已提交
368
static int dwc3_probe(struct platform_device *pdev)
369
{
370
	struct device_node	*node = pdev->dev.of_node;
371 372
	struct resource		*res;
	struct dwc3		*dwc;
C
Chanho Park 已提交
373
	struct device		*dev = &pdev->dev;
374

375
	int			ret = -ENOMEM;
376 377

	void __iomem		*regs;
378 379
	void			*mem;

380 381
	u8			mode;

C
Chanho Park 已提交
382
	mem = devm_kzalloc(dev, sizeof(*dwc) + DWC3_ALIGN_MASK, GFP_KERNEL);
383
	if (!mem) {
C
Chanho Park 已提交
384 385
		dev_err(dev, "not enough memory\n");
		return -ENOMEM;
386 387 388 389
	}
	dwc = PTR_ALIGN(mem, DWC3_ALIGN_MASK + 1);
	dwc->mem = mem;

390
	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
391
	if (!res) {
392
		dev_err(dev, "missing IRQ\n");
C
Chanho Park 已提交
393
		return -ENODEV;
394
	}
395 396 397 398
	dwc->xhci_resources[1].start = res->start;
	dwc->xhci_resources[1].end = res->end;
	dwc->xhci_resources[1].flags = res->flags;
	dwc->xhci_resources[1].name = res->name;
399

400 401 402 403 404
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		dev_err(dev, "missing memory resource\n");
		return -ENODEV;
	}
405
	dwc->xhci_resources[0].start = res->start;
406 407
	dwc->xhci_resources[0].end = dwc->xhci_resources[0].start +
					DWC3_XHCI_REGS_END;
408 409
	dwc->xhci_resources[0].flags = res->flags;
	dwc->xhci_resources[0].name = res->name;
410 411 412 413 414 415 416

	 /*
	  * Request memory region but exclude xHCI regs,
	  * since it will be requested by the xhci-plat driver.
	  */
	res = devm_request_mem_region(dev, res->start + DWC3_GLOBALS_REGS_START,
			resource_size(res) - DWC3_GLOBALS_REGS_START,
C
Chanho Park 已提交
417
			dev_name(dev));
418
	if (!res) {
C
Chanho Park 已提交
419 420
		dev_err(dev, "can't request mem region\n");
		return -ENOMEM;
421 422
	}

423
	regs = devm_ioremap_nocache(dev, res->start, resource_size(res));
424
	if (!regs) {
C
Chanho Park 已提交
425 426
		dev_err(dev, "ioremap failed\n");
		return -ENOMEM;
427 428
	}

429 430 431 432 433 434 435 436
	if (node) {
		dwc->usb2_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 0);
		dwc->usb3_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 1);
	} else {
		dwc->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
		dwc->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3);
	}

F
Felipe Balbi 已提交
437 438 439 440 441 442 443 444 445 446 447
	if (IS_ERR(dwc->usb2_phy)) {
		ret = PTR_ERR(dwc->usb2_phy);

		/*
		 * if -ENXIO is returned, it means PHY layer wasn't
		 * enabled, so it makes no sense to return -EPROBE_DEFER
		 * in that case, since no PHY driver will ever probe.
		 */
		if (ret == -ENXIO)
			return ret;

F
Felipe Balbi 已提交
448 449 450 451
		dev_err(dev, "no usb2 phy configured\n");
		return -EPROBE_DEFER;
	}

F
Felipe Balbi 已提交
452
	if (IS_ERR(dwc->usb3_phy)) {
453
		ret = PTR_ERR(dwc->usb3_phy);
F
Felipe Balbi 已提交
454 455 456 457 458 459 460 461 462

		/*
		 * if -ENXIO is returned, it means PHY layer wasn't
		 * enabled, so it makes no sense to return -EPROBE_DEFER
		 * in that case, since no PHY driver will ever probe.
		 */
		if (ret == -ENXIO)
			return ret;

F
Felipe Balbi 已提交
463 464 465 466
		dev_err(dev, "no usb3 phy configured\n");
		return -EPROBE_DEFER;
	}

467 468 469
	usb_phy_set_suspend(dwc->usb2_phy, 0);
	usb_phy_set_suspend(dwc->usb3_phy, 0);

470 471 472 473 474
	spin_lock_init(&dwc->lock);
	platform_set_drvdata(pdev, dwc);

	dwc->regs	= regs;
	dwc->regs_size	= resource_size(res);
C
Chanho Park 已提交
475
	dwc->dev	= dev;
476

477 478 479 480
	dev->dma_mask	= dev->parent->dma_mask;
	dev->dma_parms	= dev->parent->dma_parms;
	dma_set_coherent_mask(dev, dev->parent->coherent_dma_mask);

481 482 483 484 485 486 487 488 489 490 491
	if (!strncmp("super", maximum_speed, 5))
		dwc->maximum_speed = DWC3_DCFG_SUPERSPEED;
	else if (!strncmp("high", maximum_speed, 4))
		dwc->maximum_speed = DWC3_DCFG_HIGHSPEED;
	else if (!strncmp("full", maximum_speed, 4))
		dwc->maximum_speed = DWC3_DCFG_FULLSPEED1;
	else if (!strncmp("low", maximum_speed, 3))
		dwc->maximum_speed = DWC3_DCFG_LOWSPEED;
	else
		dwc->maximum_speed = DWC3_DCFG_SUPERSPEED;

492
	dwc->needs_fifo_resize = of_property_read_bool(node, "tx-fifo-resize");
493

C
Chanho Park 已提交
494 495 496
	pm_runtime_enable(dev);
	pm_runtime_get_sync(dev);
	pm_runtime_forbid(dev);
497

498 499
	dwc3_cache_hwparams(dwc);

500 501 502 503 504 505 506
	ret = dwc3_alloc_event_buffers(dwc, DWC3_EVENT_BUFFERS_SIZE);
	if (ret) {
		dev_err(dwc->dev, "failed to allocate event buffers\n");
		ret = -ENOMEM;
		goto err0;
	}

507 508
	ret = dwc3_core_init(dwc);
	if (ret) {
C
Chanho Park 已提交
509
		dev_err(dev, "failed to initialize core\n");
510
		goto err0;
511 512
	}

513 514 515 516 517 518
	ret = dwc3_event_buffers_setup(dwc);
	if (ret) {
		dev_err(dwc->dev, "failed to setup event buffers\n");
		goto err1;
	}

519 520 521 522 523 524
	if (IS_ENABLED(CONFIG_USB_DWC3_HOST))
		mode = DWC3_MODE_HOST;
	else if (IS_ENABLED(CONFIG_USB_DWC3_GADGET))
		mode = DWC3_MODE_DEVICE;
	else
		mode = DWC3_MODE_DRD;
525 526 527

	switch (mode) {
	case DWC3_MODE_DEVICE:
528
		dwc3_set_mode(dwc, DWC3_GCTL_PRTCAP_DEVICE);
529 530
		ret = dwc3_gadget_init(dwc);
		if (ret) {
C
Chanho Park 已提交
531
			dev_err(dev, "failed to initialize gadget\n");
532
			goto err2;
533
		}
F
Felipe Balbi 已提交
534 535
		break;
	case DWC3_MODE_HOST:
536
		dwc3_set_mode(dwc, DWC3_GCTL_PRTCAP_HOST);
F
Felipe Balbi 已提交
537 538
		ret = dwc3_host_init(dwc);
		if (ret) {
C
Chanho Park 已提交
539
			dev_err(dev, "failed to initialize host\n");
540
			goto err2;
F
Felipe Balbi 已提交
541 542 543
		}
		break;
	case DWC3_MODE_DRD:
544
		dwc3_set_mode(dwc, DWC3_GCTL_PRTCAP_OTG);
F
Felipe Balbi 已提交
545 546
		ret = dwc3_host_init(dwc);
		if (ret) {
C
Chanho Park 已提交
547
			dev_err(dev, "failed to initialize host\n");
548
			goto err2;
F
Felipe Balbi 已提交
549 550
		}

551 552
		ret = dwc3_gadget_init(dwc);
		if (ret) {
C
Chanho Park 已提交
553
			dev_err(dev, "failed to initialize gadget\n");
554
			goto err2;
555
		}
556 557
		break;
	default:
C
Chanho Park 已提交
558
		dev_err(dev, "Unsupported mode of operation %d\n", mode);
559
		goto err2;
560
	}
561
	dwc->mode = mode;
562 563 564

	ret = dwc3_debugfs_init(dwc);
	if (ret) {
C
Chanho Park 已提交
565
		dev_err(dev, "failed to initialize debugfs\n");
566
		goto err3;
567 568
	}

C
Chanho Park 已提交
569
	pm_runtime_allow(dev);
570 571 572

	return 0;

573
err3:
574 575
	switch (mode) {
	case DWC3_MODE_DEVICE:
576
		dwc3_gadget_exit(dwc);
577
		break;
F
Felipe Balbi 已提交
578 579 580 581 582
	case DWC3_MODE_HOST:
		dwc3_host_exit(dwc);
		break;
	case DWC3_MODE_DRD:
		dwc3_host_exit(dwc);
583
		dwc3_gadget_exit(dwc);
F
Felipe Balbi 已提交
584
		break;
585 586 587 588
	default:
		/* do nothing */
		break;
	}
589

590 591 592
err2:
	dwc3_event_buffers_cleanup(dwc);

593
err1:
C
Chanho Park 已提交
594
	dwc3_core_exit(dwc);
595

596 597 598
err0:
	dwc3_free_event_buffers(dwc);

599 600 601
	return ret;
}

B
Bill Pemberton 已提交
602
static int dwc3_remove(struct platform_device *pdev)
603 604 605
{
	struct dwc3	*dwc = platform_get_drvdata(pdev);

606 607 608
	usb_phy_set_suspend(dwc->usb2_phy, 1);
	usb_phy_set_suspend(dwc->usb3_phy, 1);

609 610 611 612 613
	pm_runtime_put(&pdev->dev);
	pm_runtime_disable(&pdev->dev);

	dwc3_debugfs_exit(dwc);

614 615
	switch (dwc->mode) {
	case DWC3_MODE_DEVICE:
616
		dwc3_gadget_exit(dwc);
617
		break;
F
Felipe Balbi 已提交
618 619 620 621 622
	case DWC3_MODE_HOST:
		dwc3_host_exit(dwc);
		break;
	case DWC3_MODE_DRD:
		dwc3_host_exit(dwc);
623
		dwc3_gadget_exit(dwc);
F
Felipe Balbi 已提交
624
		break;
625 626 627 628
	default:
		/* do nothing */
		break;
	}
629

630
	dwc3_event_buffers_cleanup(dwc);
631
	dwc3_free_event_buffers(dwc);
632 633 634 635 636
	dwc3_core_exit(dwc);

	return 0;
}

637
#ifdef CONFIG_PM_SLEEP
638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753
static int dwc3_prepare(struct device *dev)
{
	struct dwc3	*dwc = dev_get_drvdata(dev);
	unsigned long	flags;

	spin_lock_irqsave(&dwc->lock, flags);

	switch (dwc->mode) {
	case DWC3_MODE_DEVICE:
	case DWC3_MODE_DRD:
		dwc3_gadget_prepare(dwc);
		/* FALLTHROUGH */
	case DWC3_MODE_HOST:
	default:
		dwc3_event_buffers_cleanup(dwc);
		break;
	}

	spin_unlock_irqrestore(&dwc->lock, flags);

	return 0;
}

static void dwc3_complete(struct device *dev)
{
	struct dwc3	*dwc = dev_get_drvdata(dev);
	unsigned long	flags;

	spin_lock_irqsave(&dwc->lock, flags);

	switch (dwc->mode) {
	case DWC3_MODE_DEVICE:
	case DWC3_MODE_DRD:
		dwc3_gadget_complete(dwc);
		/* FALLTHROUGH */
	case DWC3_MODE_HOST:
	default:
		dwc3_event_buffers_setup(dwc);
		break;
	}

	spin_unlock_irqrestore(&dwc->lock, flags);
}

static int dwc3_suspend(struct device *dev)
{
	struct dwc3	*dwc = dev_get_drvdata(dev);
	unsigned long	flags;

	spin_lock_irqsave(&dwc->lock, flags);

	switch (dwc->mode) {
	case DWC3_MODE_DEVICE:
	case DWC3_MODE_DRD:
		dwc3_gadget_suspend(dwc);
		/* FALLTHROUGH */
	case DWC3_MODE_HOST:
	default:
		/* do nothing */
		break;
	}

	dwc->gctl = dwc3_readl(dwc->regs, DWC3_GCTL);
	spin_unlock_irqrestore(&dwc->lock, flags);

	usb_phy_shutdown(dwc->usb3_phy);
	usb_phy_shutdown(dwc->usb2_phy);

	return 0;
}

static int dwc3_resume(struct device *dev)
{
	struct dwc3	*dwc = dev_get_drvdata(dev);
	unsigned long	flags;

	usb_phy_init(dwc->usb3_phy);
	usb_phy_init(dwc->usb2_phy);
	msleep(100);

	spin_lock_irqsave(&dwc->lock, flags);

	dwc3_writel(dwc->regs, DWC3_GCTL, dwc->gctl);

	switch (dwc->mode) {
	case DWC3_MODE_DEVICE:
	case DWC3_MODE_DRD:
		dwc3_gadget_resume(dwc);
		/* FALLTHROUGH */
	case DWC3_MODE_HOST:
	default:
		/* do nothing */
		break;
	}

	spin_unlock_irqrestore(&dwc->lock, flags);

	pm_runtime_disable(dev);
	pm_runtime_set_active(dev);
	pm_runtime_enable(dev);

	return 0;
}

static const struct dev_pm_ops dwc3_dev_pm_ops = {
	.prepare	= dwc3_prepare,
	.complete	= dwc3_complete,

	SET_SYSTEM_SLEEP_PM_OPS(dwc3_suspend, dwc3_resume)
};

#define DWC3_PM_OPS	&(dwc3_dev_pm_ops)
#else
#define DWC3_PM_OPS	NULL
#endif

754 755 756 757 758 759 760 761 762 763
#ifdef CONFIG_OF
static const struct of_device_id of_dwc3_match[] = {
	{
		.compatible = "synopsys,dwc3"
	},
	{ },
};
MODULE_DEVICE_TABLE(of, of_dwc3_match);
#endif

764 765
static struct platform_driver dwc3_driver = {
	.probe		= dwc3_probe,
B
Bill Pemberton 已提交
766
	.remove		= dwc3_remove,
767 768
	.driver		= {
		.name	= "dwc3",
769
		.of_match_table	= of_match_ptr(of_dwc3_match),
770
		.pm	= DWC3_PM_OPS,
771 772 773
	},
};

774 775
module_platform_driver(dwc3_driver);

776
MODULE_ALIAS("platform:dwc3");
777 778 779
MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
MODULE_LICENSE("Dual BSD/GPL");
MODULE_DESCRIPTION("DesignWare USB3 DRD Controller Driver");