musb_dsps.c 27.5 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
/*
 * Texas Instruments DSPS platforms "glue layer"
 *
 * Copyright (C) 2012, by Texas Instruments
 *
 * Based on the am35x "glue layer" code.
 *
 * This file is part of the Inventra Controller Driver for Linux.
 *
 * The Inventra Controller Driver for Linux is free software; you
 * can redistribute it and/or modify it under the terms of the GNU
 * General Public License version 2 as published by the Free Software
 * Foundation.
 *
 * The Inventra Controller Driver for Linux is distributed in
 * the hope that it will be useful, but WITHOUT ANY WARRANTY;
 * without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public
 * License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with The Inventra Controller Driver for Linux ; if not,
 * write to the Free Software Foundation, Inc., 59 Temple Place,
 * Suite 330, Boston, MA  02111-1307  USA
 *
 * musb_dsps.c will be a common file for all the TI DSPS platforms
 * such as dm64x, dm36x, dm35x, da8x, am35x and ti81x.
 * For now only ti81x is using this and in future davinci.c, am35x.c
 * da8xx.c would be merged to this file after testing.
 */

#include <linux/io.h>
33
#include <linux/err.h>
34 35 36 37
#include <linux/platform_device.h>
#include <linux/dma-mapping.h>
#include <linux/pm_runtime.h>
#include <linux/module.h>
38
#include <linux/usb/usb_phy_generic.h>
39
#include <linux/platform_data/usb-omap.h>
40
#include <linux/sizes.h>
41 42 43 44

#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/of_address.h>
45
#include <linux/of_irq.h>
46
#include <linux/usb/of.h>
47

M
Markus Pargmann 已提交
48 49
#include <linux/debugfs.h>

50 51
#include "musb_core.h"

52 53
static const struct of_device_id musb_dsps_of_match[];

54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70
/**
 * DSPS musb wrapper register offset.
 * FIXME: This should be expanded to have all the wrapper registers from TI DSPS
 * musb ips.
 */
struct dsps_musb_wrapper {
	u16	revision;
	u16	control;
	u16	status;
	u16	epintr_set;
	u16	epintr_clear;
	u16	epintr_status;
	u16	coreintr_set;
	u16	coreintr_clear;
	u16	coreintr_status;
	u16	phy_utmi;
	u16	mode;
71 72
	u16	tx_mode;
	u16	rx_mode;
73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95

	/* bit positions for control */
	unsigned	reset:5;

	/* bit positions for interrupt */
	unsigned	usb_shift:5;
	u32		usb_mask;
	u32		usb_bitmap;
	unsigned	drvvbus:5;

	unsigned	txep_shift:5;
	u32		txep_mask;
	u32		txep_bitmap;

	unsigned	rxep_shift:5;
	u32		rxep_mask;
	u32		rxep_bitmap;

	/* bit positions for phy_utmi */
	unsigned	otg_disable:5;

	/* bit positions for mode */
	unsigned	iddig:5;
96
	unsigned	iddig_mux:5;
97
	/* miscellaneous stuff */
98
	unsigned	poll_timeout;
99 100
};

101 102 103 104 105 106 107 108 109 110 111 112 113
/*
 * register shadow for suspend
 */
struct dsps_context {
	u32 control;
	u32 epintr;
	u32 coreintr;
	u32 phy_utmi;
	u32 mode;
	u32 tx_mode;
	u32 rx_mode;
};

114 115 116 117 118
/**
 * DSPS glue structure.
 */
struct dsps_glue {
	struct device *dev;
119
	struct platform_device *musb;	/* child musb pdev */
120
	const struct dsps_musb_wrapper *wrp; /* wrapper register offsets */
121
	int vbus_irq;			/* optional vbus irq */
122 123
	struct timer_list timer;	/* otg_workaround timer */
	unsigned long last_timer;    /* last timer data for each instance */
124
	bool sw_babble_enabled;
125
	void __iomem *usbss_base;
126 127

	struct dsps_context context;
M
Markus Pargmann 已提交
128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147
	struct debugfs_regset32 regset;
	struct dentry *dbgfs_root;
};

static const struct debugfs_reg32 dsps_musb_regs[] = {
	{ "revision",		0x00 },
	{ "control",		0x14 },
	{ "status",		0x18 },
	{ "eoi",		0x24 },
	{ "intr0_stat",		0x30 },
	{ "intr1_stat",		0x34 },
	{ "intr0_set",		0x38 },
	{ "intr1_set",		0x3c },
	{ "txmode",		0x70 },
	{ "rxmode",		0x74 },
	{ "autoreq",		0xd0 },
	{ "srpfixtime",		0xd4 },
	{ "tdown",		0xd8 },
	{ "phy_utmi",		0xe0 },
	{ "mode",		0xe8 },
148 149
};

150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172
static void dsps_mod_timer(struct dsps_glue *glue, int wait_ms)
{
	int wait;

	if (wait_ms < 0)
		wait = msecs_to_jiffies(glue->wrp->poll_timeout);
	else
		wait = msecs_to_jiffies(wait_ms);

	mod_timer(&glue->timer, jiffies + wait);
}

/*
 * If no vbus irq from the PMIC is configured, we need to poll VBUS status.
 */
static void dsps_mod_timer_optional(struct dsps_glue *glue)
{
	if (glue->vbus_irq)
		return;

	dsps_mod_timer(glue, -1);
}

173 174 175 176 177 178 179
/* USBSS  / USB AM335x */
#define USBSS_IRQ_STATUS	0x28
#define USBSS_IRQ_ENABLER	0x2c
#define USBSS_IRQ_CLEARR	0x30

#define USBSS_IRQ_PD_COMP	(1 << 2)

180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196
/**
 * dsps_musb_enable - enable interrupts
 */
static void dsps_musb_enable(struct musb *musb)
{
	struct device *dev = musb->controller;
	struct platform_device *pdev = to_platform_device(dev->parent);
	struct dsps_glue *glue = platform_get_drvdata(pdev);
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	void __iomem *reg_base = musb->ctrl_base;
	u32 epmask, coremask;

	/* Workaround: setup IRQs through both register sets. */
	epmask = ((musb->epmask & wrp->txep_mask) << wrp->txep_shift) |
	       ((musb->epmask & wrp->rxep_mask) << wrp->rxep_shift);
	coremask = (wrp->usb_bitmap & ~MUSB_INTR_SOF);

197 198
	musb_writel(reg_base, wrp->epintr_set, epmask);
	musb_writel(reg_base, wrp->coreintr_set, coremask);
199 200 201
	/* start polling for ID change in dual-role idle mode */
	if (musb->xceiv->otg->state == OTG_STATE_B_IDLE &&
			musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
202
		dsps_mod_timer(glue, -1);
203 204 205 206 207 208 209 210 211 212 213 214 215
}

/**
 * dsps_musb_disable - disable HDRC and flush interrupts
 */
static void dsps_musb_disable(struct musb *musb)
{
	struct device *dev = musb->controller;
	struct platform_device *pdev = to_platform_device(dev->parent);
	struct dsps_glue *glue = platform_get_drvdata(pdev);
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	void __iomem *reg_base = musb->ctrl_base;

216 217
	musb_writel(reg_base, wrp->coreintr_clear, wrp->usb_bitmap);
	musb_writel(reg_base, wrp->epintr_clear,
218
			 wrp->txep_bitmap | wrp->rxep_bitmap);
219
	del_timer_sync(&glue->timer);
220 221
}

222 223
/* Caller must take musb->lock */
static int dsps_check_status(struct musb *musb, void *unused)
224 225 226
{
	void __iomem *mregs = musb->mregs;
	struct device *dev = musb->controller;
227
	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
228 229
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	u8 devctl;
230
	int skip_session = 0;
231

232 233 234
	if (glue->vbus_irq)
		del_timer(&glue->timer);

235 236 237 238
	/*
	 * We poll because DSPS IP's won't expose several OTG-critical
	 * status change events (from the transceiver) otherwise.
	 */
239
	devctl = musb_readb(mregs, MUSB_DEVCTL);
240
	dev_dbg(musb->controller, "Poll devctl %02x (%s)\n", devctl,
241
				usb_otg_state_string(musb->xceiv->otg->state));
242

243
	switch (musb->xceiv->otg->state) {
244
	case OTG_STATE_A_WAIT_VRISE:
245
		dsps_mod_timer_optional(glue);
246
		break;
247
	case OTG_STATE_A_WAIT_BCON:
248 249 250 251 252
		/* keep VBUS on for host-only mode */
		if (musb->port_mode == MUSB_PORT_MODE_HOST) {
			dsps_mod_timer_optional(glue);
			break;
		}
253
		musb_writeb(musb->mregs, MUSB_DEVCTL, 0);
254 255
		skip_session = 1;
		/* fall */
256

257 258
	case OTG_STATE_A_IDLE:
	case OTG_STATE_B_IDLE:
259 260 261 262 263 264 265 266 267 268 269
		if (!glue->vbus_irq) {
			if (devctl & MUSB_DEVCTL_BDEVICE) {
				musb->xceiv->otg->state = OTG_STATE_B_IDLE;
				MUSB_DEV_MODE(musb);
			} else {
				musb->xceiv->otg->state = OTG_STATE_A_IDLE;
				MUSB_HST_MODE(musb);
			}
			if (!(devctl & MUSB_DEVCTL_SESSION) && !skip_session)
				musb_writeb(mregs, MUSB_DEVCTL,
					    MUSB_DEVCTL_SESSION);
270
		}
271
		dsps_mod_timer_optional(glue);
272 273
		break;
	case OTG_STATE_A_WAIT_VFALL:
274
		musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
275
		musb_writel(musb->ctrl_base, wrp->coreintr_set,
276 277 278 279 280
			    MUSB_INTR_VBUSERROR << wrp->usb_shift);
		break;
	default:
		break;
	}
281

282 283 284
	return 0;
}

285
static void otg_timer(struct timer_list *t)
286
{
287 288
	struct dsps_glue *glue = from_timer(glue, t, timer);
	struct musb *musb = platform_get_drvdata(glue->musb);
289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
	struct device *dev = musb->controller;
	unsigned long flags;
	int err;

	err = pm_runtime_get(dev);
	if ((err != -EINPROGRESS) && err < 0) {
		dev_err(dev, "Poll could not pm_runtime_get: %i\n", err);
		pm_runtime_put_noidle(dev);

		return;
	}

	spin_lock_irqsave(&musb->lock, flags);
	err = musb_queue_resume_work(musb, dsps_check_status, NULL);
	if (err < 0)
		dev_err(dev, "%s resume work: %i\n", __func__, err);
	spin_unlock_irqrestore(&musb->lock, flags);
306 307
	pm_runtime_mark_last_busy(dev);
	pm_runtime_put_autosuspend(dev);
308 309
}

310
static void dsps_musb_clear_ep_rxintr(struct musb *musb, int epnum)
311 312 313 314 315 316 317 318 319 320
{
	u32 epintr;
	struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
	const struct dsps_musb_wrapper *wrp = glue->wrp;

	/* musb->lock might already been held */
	epintr = (1 << epnum) << wrp->rxep_shift;
	musb_writel(musb->ctrl_base, wrp->epintr_status, epintr);
}

321 322 323 324 325
static irqreturn_t dsps_interrupt(int irq, void *hci)
{
	struct musb  *musb = hci;
	void __iomem *reg_base = musb->ctrl_base;
	struct device *dev = musb->controller;
326
	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
327 328 329 330 331 332 333 334
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	unsigned long flags;
	irqreturn_t ret = IRQ_NONE;
	u32 epintr, usbintr;

	spin_lock_irqsave(&musb->lock, flags);

	/* Get endpoint interrupts */
335
	epintr = musb_readl(reg_base, wrp->epintr_status);
336 337 338 339
	musb->int_rx = (epintr & wrp->rxep_bitmap) >> wrp->rxep_shift;
	musb->int_tx = (epintr & wrp->txep_bitmap) >> wrp->txep_shift;

	if (epintr)
340
		musb_writel(reg_base, wrp->epintr_status, epintr);
341 342

	/* Get usb core interrupts */
343
	usbintr = musb_readl(reg_base, wrp->coreintr_status);
344
	if (!usbintr && !epintr)
345
		goto out;
346 347 348

	musb->int_usb =	(usbintr & wrp->usb_bitmap) >> wrp->usb_shift;
	if (usbintr)
349
		musb_writel(reg_base, wrp->coreintr_status, usbintr);
350 351 352

	dev_dbg(musb->controller, "usbintr (%x) epintr(%x)\n",
			usbintr, epintr);
353

354
	if (usbintr & ((1 << wrp->drvvbus) << wrp->usb_shift)) {
355
		int drvvbus = musb_readl(reg_base, wrp->status);
356
		void __iomem *mregs = musb->mregs;
357
		u8 devctl = musb_readb(mregs, MUSB_DEVCTL);
358 359
		int err;

360
		err = musb->int_usb & MUSB_INTR_VBUSERROR;
361 362 363 364 365 366 367 368 369 370 371 372 373
		if (err) {
			/*
			 * The Mentor core doesn't debounce VBUS as needed
			 * to cope with device connect current spikes. This
			 * means it's not uncommon for bus-powered devices
			 * to get VBUS errors during enumeration.
			 *
			 * This is a workaround, but newer RTL from Mentor
			 * seems to allow a better one: "re"-starting sessions
			 * without waiting for VBUS to stop registering in
			 * devctl.
			 */
			musb->int_usb &= ~MUSB_INTR_VBUSERROR;
374
			musb->xceiv->otg->state = OTG_STATE_A_WAIT_VFALL;
375
			dsps_mod_timer_optional(glue);
376
			WARNING("VBUS error workaround (delay coming)\n");
377
		} else if (drvvbus) {
378 379
			MUSB_HST_MODE(musb);
			musb->xceiv->otg->default_a = 1;
380
			musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
381
			dsps_mod_timer_optional(glue);
382 383 384 385
		} else {
			musb->is_active = 0;
			MUSB_DEV_MODE(musb);
			musb->xceiv->otg->default_a = 0;
386
			musb->xceiv->otg->state = OTG_STATE_B_IDLE;
387 388 389 390 391
		}

		/* NOTE: this must complete power-on within 100 ms. */
		dev_dbg(musb->controller, "VBUS %s (%s)%s, devctl %02x\n",
				drvvbus ? "on" : "off",
392
				usb_otg_state_string(musb->xceiv->otg->state),
393 394 395 396 397 398 399 400
				err ? " ERROR" : "",
				devctl);
		ret = IRQ_HANDLED;
	}

	if (musb->int_tx || musb->int_rx || musb->int_usb)
		ret |= musb_interrupt(musb);

401 402 403 404
	/* Poll for ID change and connect */
	switch (musb->xceiv->otg->state) {
	case OTG_STATE_B_IDLE:
	case OTG_STATE_A_WAIT_BCON:
405
		dsps_mod_timer_optional(glue);
406 407 408 409 410
		break;
	default:
		break;
	}

411
out:
412 413 414 415 416
	spin_unlock_irqrestore(&musb->lock, flags);

	return ret;
}

M
Markus Pargmann 已提交
417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440
static int dsps_musb_dbg_init(struct musb *musb, struct dsps_glue *glue)
{
	struct dentry *root;
	struct dentry *file;
	char buf[128];

	sprintf(buf, "%s.dsps", dev_name(musb->controller));
	root = debugfs_create_dir(buf, NULL);
	if (!root)
		return -ENOMEM;
	glue->dbgfs_root = root;

	glue->regset.regs = dsps_musb_regs;
	glue->regset.nregs = ARRAY_SIZE(dsps_musb_regs);
	glue->regset.base = musb->ctrl_base;

	file = debugfs_create_regset32("regdump", S_IRUGO, root, &glue->regset);
	if (!file) {
		debugfs_remove_recursive(root);
		return -ENOMEM;
	}
	return 0;
}

441 442 443
static int dsps_musb_init(struct musb *musb)
{
	struct device *dev = musb->controller;
444
	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
445
	struct platform_device *parent = to_platform_device(dev->parent);
446
	const struct dsps_musb_wrapper *wrp = glue->wrp;
447 448
	void __iomem *reg_base;
	struct resource *r;
449
	u32 rev, val;
M
Markus Pargmann 已提交
450
	int ret;
451

452 453
	r = platform_get_resource_byname(parent, IORESOURCE_MEM, "control");
	reg_base = devm_ioremap_resource(dev, r);
454 455
	if (IS_ERR(reg_base))
		return PTR_ERR(reg_base);
456
	musb->ctrl_base = reg_base;
457

458
	/* NOP driver needs change if supporting dual instance */
459
	musb->xceiv = devm_usb_get_phy_by_phandle(dev->parent, "phys", 0);
460 461
	if (IS_ERR(musb->xceiv))
		return PTR_ERR(musb->xceiv);
462

463 464
	musb->phy = devm_phy_get(dev->parent, "usb2-phy");

465
	/* Returns zero if e.g. not clocked */
466
	rev = musb_readl(reg_base, wrp->revision);
467 468
	if (!rev)
		return -ENODEV;
469

470
	usb_phy_init(musb->xceiv);
471 472 473 474 475 476 477 478 479 480 481 482 483
	if (IS_ERR(musb->phy))  {
		musb->phy = NULL;
	} else {
		ret = phy_init(musb->phy);
		if (ret < 0)
			return ret;
		ret = phy_power_on(musb->phy);
		if (ret) {
			phy_exit(musb->phy);
			return ret;
		}
	}

484
	timer_setup(&glue->timer, otg_timer, 0);
485 486

	/* Reset the musb */
487
	musb_writel(reg_base, wrp->control, (1 << wrp->reset));
488 489 490 491

	musb->isr = dsps_interrupt;

	/* reset the otgdisable bit, needed for host mode to work */
492
	val = musb_readl(reg_base, wrp->phy_utmi);
493
	val &= ~(1 << wrp->otg_disable);
494
	musb_writel(musb->ctrl_base, wrp->phy_utmi, val);
495

496 497 498 499 500 501
	/*
	 *  Check whether the dsps version has babble control enabled.
	 * In latest silicon revision the babble control logic is enabled.
	 * If MUSB_BABBLE_CTL returns 0x4 then we have the babble control
	 * logic enabled.
	 */
502
	val = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
503
	if (val & MUSB_BABBLE_RCV_DISABLE) {
504 505
		glue->sw_babble_enabled = true;
		val |= MUSB_BABBLE_SW_SESSION_CTRL;
506
		musb_writeb(musb->mregs, MUSB_BABBLE_CTL, val);
507 508
	}

509
	dsps_mod_timer(glue, -1);
510

511
	return dsps_musb_dbg_init(musb, glue);
512 513 514 515 516
}

static int dsps_musb_exit(struct musb *musb)
{
	struct device *dev = musb->controller;
517
	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
518

519
	del_timer_sync(&glue->timer);
520
	usb_phy_shutdown(musb->xceiv);
521 522
	phy_power_off(musb->phy);
	phy_exit(musb->phy);
523 524
	debugfs_remove_recursive(glue->dbgfs_root);

525 526 527
	return 0;
}

528 529 530 531 532 533 534 535
static int dsps_musb_set_mode(struct musb *musb, u8 mode)
{
	struct device *dev = musb->controller;
	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	void __iomem *ctrl_base = musb->ctrl_base;
	u32 reg;

536
	reg = musb_readl(ctrl_base, wrp->mode);
537 538 539 540 541 542 543 544 545 546 547 548

	switch (mode) {
	case MUSB_HOST:
		reg &= ~(1 << wrp->iddig);

		/*
		 * if we're setting mode to host-only or device-only, we're
		 * going to ignore whatever the PHY sends us and just force
		 * ID pin status by SW
		 */
		reg |= (1 << wrp->iddig_mux);

549 550
		musb_writel(ctrl_base, wrp->mode, reg);
		musb_writel(ctrl_base, wrp->phy_utmi, 0x02);
551 552 553 554 555 556 557 558 559 560 561
		break;
	case MUSB_PERIPHERAL:
		reg |= (1 << wrp->iddig);

		/*
		 * if we're setting mode to host-only or device-only, we're
		 * going to ignore whatever the PHY sends us and just force
		 * ID pin status by SW
		 */
		reg |= (1 << wrp->iddig_mux);

562
		musb_writel(ctrl_base, wrp->mode, reg);
563 564
		break;
	case MUSB_OTG:
565
		musb_writel(ctrl_base, wrp->phy_utmi, 0x02);
566 567 568 569 570 571 572 573 574
		break;
	default:
		dev_err(glue->dev, "unsupported mode %d\n", mode);
		return -EINVAL;
	}

	return 0;
}

575
static bool dsps_sw_babble_control(struct musb *musb)
576 577 578 579
{
	u8 babble_ctl;
	bool session_restart =  false;

580
	babble_ctl = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596
	dev_dbg(musb->controller, "babble: MUSB_BABBLE_CTL value %x\n",
		babble_ctl);
	/*
	 * check line monitor flag to check whether babble is
	 * due to noise
	 */
	dev_dbg(musb->controller, "STUCK_J is %s\n",
		babble_ctl & MUSB_BABBLE_STUCK_J ? "set" : "reset");

	if (babble_ctl & MUSB_BABBLE_STUCK_J) {
		int timeout = 10;

		/*
		 * babble is due to noise, then set transmit idle (d7 bit)
		 * to resume normal operation
		 */
597
		babble_ctl = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
598
		babble_ctl |= MUSB_BABBLE_FORCE_TXIDLE;
599
		musb_writeb(musb->mregs, MUSB_BABBLE_CTL, babble_ctl);
600 601 602 603

		/* wait till line monitor flag cleared */
		dev_dbg(musb->controller, "Set TXIDLE, wait J to clear\n");
		do {
604
			babble_ctl = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625
			udelay(1);
		} while ((babble_ctl & MUSB_BABBLE_STUCK_J) && timeout--);

		/* check whether stuck_at_j bit cleared */
		if (babble_ctl & MUSB_BABBLE_STUCK_J) {
			/*
			 * real babble condition has occurred
			 * restart the controller to start the
			 * session again
			 */
			dev_dbg(musb->controller, "J not cleared, misc (%x)\n",
				babble_ctl);
			session_restart = true;
		}
	} else {
		session_restart = true;
	}

	return session_restart;
}

626
static int dsps_musb_recover(struct musb *musb)
627 628 629
{
	struct device *dev = musb->controller;
	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
630
	int session_restart = 0;
631

632
	if (glue->sw_babble_enabled)
633
		session_restart = dsps_sw_babble_control(musb);
634
	else
635
		session_restart = 1;
636

637
	return session_restart ? 0 : -EPIPE;
638 639
}

640 641 642 643 644 645
/* Similar to am35x, dm81xx support only 32-bit read operation */
static void dsps_read_fifo32(struct musb_hw_ep *hw_ep, u16 len, u8 *dst)
{
	void __iomem *fifo = hw_ep->fifo;

	if (len >= 4) {
646
		ioread32_rep(fifo, dst, len >> 2);
647 648 649 650 651 652 653 654 655 656 657
		dst += len & ~0x03;
		len &= 0x03;
	}

	/* Read any remaining 1 to 3 bytes */
	if (len > 0) {
		u32 val = musb_readl(fifo, 0);
		memcpy(dst, &val, len);
	}
}

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
#ifdef CONFIG_USB_TI_CPPI41_DMA
static void dsps_dma_controller_callback(struct dma_controller *c)
{
	struct musb *musb = c->musb;
	struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
	void __iomem *usbss_base = glue->usbss_base;
	u32 status;

	status = musb_readl(usbss_base, USBSS_IRQ_STATUS);
	if (status & USBSS_IRQ_PD_COMP)
		musb_writel(usbss_base, USBSS_IRQ_STATUS, USBSS_IRQ_PD_COMP);
}

static struct dma_controller *
dsps_dma_controller_create(struct musb *musb, void __iomem *base)
{
	struct dma_controller *controller;
	struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
	void __iomem *usbss_base = glue->usbss_base;

	controller = cppi41_dma_controller_create(musb, base);
	if (IS_ERR_OR_NULL(controller))
		return controller;

	musb_writel(usbss_base, USBSS_IRQ_ENABLER, USBSS_IRQ_PD_COMP);
	controller->dma_callback = dsps_dma_controller_callback;

	return controller;
}

static void dsps_dma_controller_destroy(struct dma_controller *c)
{
	struct musb *musb = c->musb;
	struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
	void __iomem *usbss_base = glue->usbss_base;

	musb_writel(usbss_base, USBSS_IRQ_CLEARR, USBSS_IRQ_PD_COMP);
	cppi41_dma_controller_destroy(c);
}

#ifdef CONFIG_PM_SLEEP
static void dsps_dma_controller_suspend(struct dsps_glue *glue)
{
	void __iomem *usbss_base = glue->usbss_base;

	musb_writel(usbss_base, USBSS_IRQ_CLEARR, USBSS_IRQ_PD_COMP);
}

static void dsps_dma_controller_resume(struct dsps_glue *glue)
{
	void __iomem *usbss_base = glue->usbss_base;

	musb_writel(usbss_base, USBSS_IRQ_ENABLER, USBSS_IRQ_PD_COMP);
}
#endif
#else /* CONFIG_USB_TI_CPPI41_DMA */
#ifdef CONFIG_PM_SLEEP
static void dsps_dma_controller_suspend(struct dsps_glue *glue) {}
static void dsps_dma_controller_resume(struct dsps_glue *glue) {}
#endif
#endif /* CONFIG_USB_TI_CPPI41_DMA */

720
static struct musb_platform_ops dsps_ops = {
721
	.quirks		= MUSB_DMA_CPPI41 | MUSB_INDEXED_EP,
722 723 724
	.init		= dsps_musb_init,
	.exit		= dsps_musb_exit,

725
#ifdef CONFIG_USB_TI_CPPI41_DMA
726 727
	.dma_init	= dsps_dma_controller_create,
	.dma_exit	= dsps_dma_controller_destroy,
728
#endif
729 730 731
	.enable		= dsps_musb_enable,
	.disable	= dsps_musb_disable,

732
	.set_mode	= dsps_musb_set_mode,
733
	.recover	= dsps_musb_recover,
734
	.clear_ep_rxintr = dsps_musb_clear_ep_rxintr,
735 736 737 738
};

static u64 musb_dmamask = DMA_BIT_MASK(32);

739
static int get_int_prop(struct device_node *dn, const char *s)
740
{
741 742 743 744 745 746 747 748 749
	int ret;
	u32 val;

	ret = of_property_read_u32(dn, s, &val);
	if (ret)
		return 0;
	return val;
}

750 751 752 753
static int get_musb_port_mode(struct device *dev)
{
	enum usb_dr_mode mode;

754
	mode = usb_get_dr_mode(dev);
755 756 757 758 759 760 761 762 763 764 765
	switch (mode) {
	case USB_DR_MODE_HOST:
		return MUSB_PORT_MODE_HOST;

	case USB_DR_MODE_PERIPHERAL:
		return MUSB_PORT_MODE_GADGET;

	case USB_DR_MODE_UNKNOWN:
	case USB_DR_MODE_OTG:
	default:
		return MUSB_PORT_MODE_DUAL_ROLE;
J
Joe Perches 已提交
766
	}
767 768
}

769 770 771 772
static int dsps_create_musb_pdev(struct dsps_glue *glue,
		struct platform_device *parent)
{
	struct musb_hdrc_platform_data pdata;
773
	struct resource	resources[2];
774
	struct resource	*res;
775 776 777 778
	struct device *dev = &parent->dev;
	struct musb_hdrc_config	*config;
	struct platform_device *musb;
	struct device_node *dn = parent->dev.of_node;
779
	int ret, val;
780

781
	memset(resources, 0, sizeof(resources));
782 783
	res = platform_get_resource_byname(parent, IORESOURCE_MEM, "mc");
	if (!res) {
784
		dev_err(dev, "failed to get memory.\n");
785
		return -EINVAL;
786
	}
787
	resources[0] = *res;
788

789 790
	res = platform_get_resource_byname(parent, IORESOURCE_IRQ, "mc");
	if (!res) {
791
		dev_err(dev, "failed to get irq.\n");
792
		return -EINVAL;
793
	}
794
	resources[1] = *res;
795 796

	/* allocate the child platform device */
797 798
	musb = platform_device_alloc("musb-hdrc",
			(resources[0].start & 0xFFF) == 0x400 ? 0 : 1);
799 800
	if (!musb) {
		dev_err(dev, "failed to allocate musb device\n");
801
		return -ENOMEM;
802 803 804 805 806 807
	}

	musb->dev.parent		= dev;
	musb->dev.dma_mask		= &musb_dmamask;
	musb->dev.coherent_dma_mask	= musb_dmamask;

808
	glue->musb = musb;
809

810 811
	ret = platform_device_add_resources(musb, resources,
			ARRAY_SIZE(resources));
812 813
	if (ret) {
		dev_err(dev, "failed to add resources\n");
814
		goto err;
815 816
	}

817 818 819 820
	config = devm_kzalloc(&parent->dev, sizeof(*config), GFP_KERNEL);
	if (!config) {
		ret = -ENOMEM;
		goto err;
821
	}
822 823
	pdata.config = config;
	pdata.platform_ops = &dsps_ops;
824

825 826
	config->num_eps = get_int_prop(dn, "mentor,num-eps");
	config->ram_bits = get_int_prop(dn, "mentor,ram-bits");
827
	config->host_port_deassert_reset_at_resume = 1;
828 829 830
	pdata.mode = get_musb_port_mode(dev);
	/* DT keeps this entry in mA, musb expects it as per USB spec */
	pdata.power = get_int_prop(dn, "mentor,power") / 2;
831 832 833 834

	ret = of_property_read_u32(dn, "mentor,multipoint", &val);
	if (!ret && val)
		config->multipoint = true;
835

836
	config->maximum_speed = usb_get_maximum_speed(&parent->dev);
837 838 839 840 841 842 843 844 845 846 847 848
	switch (config->maximum_speed) {
	case USB_SPEED_LOW:
	case USB_SPEED_FULL:
		break;
	case USB_SPEED_SUPER:
		dev_warn(dev, "ignore incorrect maximum_speed "
				"(super-speed) setting in dts");
		/* fall through */
	default:
		config->maximum_speed = USB_SPEED_HIGH;
	}

849
	ret = platform_device_add_data(musb, &pdata, sizeof(pdata));
850 851
	if (ret) {
		dev_err(dev, "failed to add platform_data\n");
852
		goto err;
853 854 855 856 857
	}

	ret = platform_device_add(musb);
	if (ret) {
		dev_err(dev, "failed to register musb device\n");
858
		goto err;
859 860 861
	}
	return 0;

862
err:
863 864 865 866
	platform_device_put(musb);
	return ret;
}

867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907
static irqreturn_t dsps_vbus_threaded_irq(int irq, void *priv)
{
	struct dsps_glue *glue = priv;
	struct musb *musb = platform_get_drvdata(glue->musb);

	if (!musb)
		return IRQ_NONE;

	dev_dbg(glue->dev, "VBUS interrupt\n");
	dsps_mod_timer(glue, 0);

	return IRQ_HANDLED;
}

static int dsps_setup_optional_vbus_irq(struct platform_device *pdev,
					struct dsps_glue *glue)
{
	int error;

	glue->vbus_irq = platform_get_irq_byname(pdev, "vbus");
	if (glue->vbus_irq == -EPROBE_DEFER)
		return -EPROBE_DEFER;

	if (glue->vbus_irq <= 0) {
		glue->vbus_irq = 0;
		return 0;
	}

	error = devm_request_threaded_irq(glue->dev, glue->vbus_irq,
					  NULL, dsps_vbus_threaded_irq,
					  IRQF_ONESHOT,
					  "vbus", glue);
	if (error) {
		glue->vbus_irq = 0;
		return error;
	}
	dev_dbg(glue->dev, "VBUS irq %i configured\n", glue->vbus_irq);

	return 0;
}

B
Bill Pemberton 已提交
908
static int dsps_probe(struct platform_device *pdev)
909
{
910 911
	const struct of_device_id *match;
	const struct dsps_musb_wrapper *wrp;
912
	struct dsps_glue *glue;
913
	int ret;
914

915 916 917
	if (!strcmp(pdev->name, "musb-hdrc"))
		return -ENODEV;

918
	match = of_match_node(musb_dsps_of_match, pdev->dev.of_node);
919 920
	if (!match) {
		dev_err(&pdev->dev, "fail to get matching of_match struct\n");
921
		return -EINVAL;
922 923
	}
	wrp = match->data;
924

925 926 927
	if (of_device_is_compatible(pdev->dev.of_node, "ti,musb-dm816"))
		dsps_ops.read_fifo = dsps_read_fifo32;

928
	/* allocate glue */
929
	glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
930
	if (!glue)
931
		return -ENOMEM;
932 933

	glue->dev = &pdev->dev;
934
	glue->wrp = wrp;
935 936 937
	glue->usbss_base = of_iomap(pdev->dev.parent->of_node, 0);
	if (!glue->usbss_base)
		return -ENXIO;
938

939 940 941
	if (usb_get_dr_mode(&pdev->dev) == USB_DR_MODE_PERIPHERAL) {
		ret = dsps_setup_optional_vbus_irq(pdev, glue);
		if (ret)
942
			goto err_iounmap;
943 944
	}

945 946
	platform_set_drvdata(pdev, glue);
	pm_runtime_enable(&pdev->dev);
947 948
	ret = dsps_create_musb_pdev(glue, pdev);
	if (ret)
949
		goto err;
950

951 952
	return 0;

953
err:
954
	pm_runtime_disable(&pdev->dev);
955 956
err_iounmap:
	iounmap(glue->usbss_base);
957 958
	return ret;
}
959

B
Bill Pemberton 已提交
960
static int dsps_remove(struct platform_device *pdev)
961 962 963
{
	struct dsps_glue *glue = platform_get_drvdata(pdev);

964
	platform_device_unregister(glue->musb);
965 966

	pm_runtime_disable(&pdev->dev);
967
	iounmap(glue->usbss_base);
M
Markus Pargmann 已提交
968

969 970 971
	return 0;
}

972
static const struct dsps_musb_wrapper am33xx_driver_data = {
973 974 975 976 977 978 979 980 981 982 983
	.revision		= 0x00,
	.control		= 0x14,
	.status			= 0x18,
	.epintr_set		= 0x38,
	.epintr_clear		= 0x40,
	.epintr_status		= 0x30,
	.coreintr_set		= 0x3c,
	.coreintr_clear		= 0x44,
	.coreintr_status	= 0x34,
	.phy_utmi		= 0xe0,
	.mode			= 0xe8,
984 985
	.tx_mode		= 0x70,
	.rx_mode		= 0x74,
986 987 988
	.reset			= 0,
	.otg_disable		= 21,
	.iddig			= 8,
989
	.iddig_mux		= 7,
990 991 992 993 994 995 996 997 998 999
	.usb_shift		= 0,
	.usb_mask		= 0x1ff,
	.usb_bitmap		= (0x1ff << 0),
	.drvvbus		= 8,
	.txep_shift		= 0,
	.txep_mask		= 0xffff,
	.txep_bitmap		= (0xffff << 0),
	.rxep_shift		= 16,
	.rxep_mask		= 0xfffe,
	.rxep_bitmap		= (0xfffe << 16),
1000
	.poll_timeout		= 2000, /* ms */
1001 1002
};

B
Bill Pemberton 已提交
1003
static const struct of_device_id musb_dsps_of_match[] = {
1004
	{ .compatible = "ti,musb-am33xx",
1005 1006 1007
		.data = &am33xx_driver_data, },
	{ .compatible = "ti,musb-dm816",
		.data = &am33xx_driver_data, },
1008 1009 1010 1011
	{  },
};
MODULE_DEVICE_TABLE(of, musb_dsps_of_match);

1012
#ifdef CONFIG_PM_SLEEP
1013 1014 1015 1016 1017
static int dsps_suspend(struct device *dev)
{
	struct dsps_glue *glue = dev_get_drvdata(dev);
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	struct musb *musb = platform_get_drvdata(glue->musb);
1018
	void __iomem *mbase;
1019
	int ret;
1020 1021 1022 1023 1024

	if (!musb)
		/* This can happen if the musb device is in -EPROBE_DEFER */
		return 0;

1025 1026 1027 1028 1029 1030 1031 1032
	ret = pm_runtime_get_sync(dev);
	if (ret < 0) {
		pm_runtime_put_noidle(dev);
		return ret;
	}

	del_timer_sync(&glue->timer);

1033
	mbase = musb->ctrl_base;
1034 1035 1036 1037 1038 1039 1040
	glue->context.control = musb_readl(mbase, wrp->control);
	glue->context.epintr = musb_readl(mbase, wrp->epintr_set);
	glue->context.coreintr = musb_readl(mbase, wrp->coreintr_set);
	glue->context.phy_utmi = musb_readl(mbase, wrp->phy_utmi);
	glue->context.mode = musb_readl(mbase, wrp->mode);
	glue->context.tx_mode = musb_readl(mbase, wrp->tx_mode);
	glue->context.rx_mode = musb_readl(mbase, wrp->rx_mode);
1041

1042 1043
	dsps_dma_controller_suspend(glue);

1044 1045 1046 1047 1048 1049 1050 1051
	return 0;
}

static int dsps_resume(struct device *dev)
{
	struct dsps_glue *glue = dev_get_drvdata(dev);
	const struct dsps_musb_wrapper *wrp = glue->wrp;
	struct musb *musb = platform_get_drvdata(glue->musb);
1052 1053 1054 1055
	void __iomem *mbase;

	if (!musb)
		return 0;
1056

1057 1058
	dsps_dma_controller_resume(glue);

1059
	mbase = musb->ctrl_base;
1060 1061 1062 1063 1064 1065 1066
	musb_writel(mbase, wrp->control, glue->context.control);
	musb_writel(mbase, wrp->epintr_set, glue->context.epintr);
	musb_writel(mbase, wrp->coreintr_set, glue->context.coreintr);
	musb_writel(mbase, wrp->phy_utmi, glue->context.phy_utmi);
	musb_writel(mbase, wrp->mode, glue->context.mode);
	musb_writel(mbase, wrp->tx_mode, glue->context.tx_mode);
	musb_writel(mbase, wrp->rx_mode, glue->context.rx_mode);
1067
	if (musb->xceiv->otg->state == OTG_STATE_B_IDLE &&
1068
	    musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
1069
		dsps_mod_timer(glue, -1);
1070

1071 1072
	pm_runtime_put(dev);

1073 1074 1075 1076 1077 1078
	return 0;
}
#endif

static SIMPLE_DEV_PM_OPS(dsps_pm_ops, dsps_suspend, dsps_resume);

1079 1080
static struct platform_driver dsps_usbss_driver = {
	.probe		= dsps_probe,
B
Bill Pemberton 已提交
1081
	.remove         = dsps_remove,
1082 1083
	.driver         = {
		.name   = "musb-dsps",
1084
		.pm	= &dsps_pm_ops,
1085
		.of_match_table	= musb_dsps_of_match,
1086 1087 1088 1089 1090 1091 1092 1093
	},
};

MODULE_DESCRIPTION("TI DSPS MUSB Glue Layer");
MODULE_AUTHOR("Ravi B <ravibabu@ti.com>");
MODULE_AUTHOR("Ajay Kumar Gupta <ajay.gupta@ti.com>");
MODULE_LICENSE("GPL v2");

1094
module_platform_driver(dsps_usbss_driver);