omap_hsmmc.c 58.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
/*
 * drivers/mmc/host/omap_hsmmc.c
 *
 * Driver for OMAP2430/3430 MMC controller.
 *
 * Copyright (C) 2007 Texas Instruments.
 *
 * Authors:
 *	Syed Mohammed Khasim	<x0khasim@ti.com>
 *	Madhusudhan		<madhu.cr@ti.com>
 *	Mohit Jalori		<mjalori@ti.com>
 *
 * This file is licensed under the terms of the GNU General Public License
 * version 2. This program is licensed "as is" without any warranty of any
 * kind, whether express or implied.
 */

#include <linux/module.h>
#include <linux/init.h>
20 21
#include <linux/debugfs.h>
#include <linux/seq_file.h>
22 23 24 25 26 27 28 29
#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/dma-mapping.h>
#include <linux/platform_device.h>
#include <linux/workqueue.h>
#include <linux/timer.h>
#include <linux/clk.h>
#include <linux/mmc/host.h>
30
#include <linux/mmc/core.h>
31 32
#include <linux/io.h>
#include <linux/semaphore.h>
33 34
#include <linux/gpio.h>
#include <linux/regulator/consumer.h>
35
#include <plat/dma.h>
36
#include <mach/hardware.h>
37 38 39
#include <plat/board.h>
#include <plat/mmc.h>
#include <plat/cpu.h>
40 41 42

/* OMAP HSMMC Host Controller Registers */
#define OMAP_HSMMC_SYSCONFIG	0x0010
43
#define OMAP_HSMMC_SYSSTATUS	0x0014
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63
#define OMAP_HSMMC_CON		0x002C
#define OMAP_HSMMC_BLK		0x0104
#define OMAP_HSMMC_ARG		0x0108
#define OMAP_HSMMC_CMD		0x010C
#define OMAP_HSMMC_RSP10	0x0110
#define OMAP_HSMMC_RSP32	0x0114
#define OMAP_HSMMC_RSP54	0x0118
#define OMAP_HSMMC_RSP76	0x011C
#define OMAP_HSMMC_DATA		0x0120
#define OMAP_HSMMC_HCTL		0x0128
#define OMAP_HSMMC_SYSCTL	0x012C
#define OMAP_HSMMC_STAT		0x0130
#define OMAP_HSMMC_IE		0x0134
#define OMAP_HSMMC_ISE		0x0138
#define OMAP_HSMMC_CAPA		0x0140

#define VS18			(1 << 26)
#define VS30			(1 << 25)
#define SDVS18			(0x5 << 9)
#define SDVS30			(0x6 << 9)
64
#define SDVS33			(0x7 << 9)
65
#define SDVS_MASK		0x00000E00
66 67 68 69 70 71 72 73 74 75 76 77 78
#define SDVSCLR			0xFFFFF1FF
#define SDVSDET			0x00000400
#define AUTOIDLE		0x1
#define SDBP			(1 << 8)
#define DTO			0xe
#define ICE			0x1
#define ICS			0x2
#define CEN			(1 << 2)
#define CLKD_MASK		0x0000FFC0
#define CLKD_SHIFT		6
#define DTO_MASK		0x000F0000
#define DTO_SHIFT		16
#define INT_EN_MASK		0x307F0033
79 80
#define BWR_ENABLE		(1 << 4)
#define BRR_ENABLE		(1 << 5)
81 82 83 84 85 86 87
#define INIT_STREAM		(1 << 1)
#define DP_SELECT		(1 << 21)
#define DDIR			(1 << 4)
#define DMA_EN			0x1
#define MSBS			(1 << 5)
#define BCE			(1 << 1)
#define FOUR_BIT		(1 << 1)
88
#define DW8			(1 << 5)
89 90 91 92 93 94 95 96 97 98 99 100 101 102
#define CC			0x1
#define TC			0x02
#define OD			0x1
#define ERR			(1 << 15)
#define CMD_TIMEOUT		(1 << 16)
#define DATA_TIMEOUT		(1 << 20)
#define CMD_CRC			(1 << 17)
#define DATA_CRC		(1 << 21)
#define CARD_ERR		(1 << 28)
#define STAT_CLEAR		0xFFFFFFFF
#define INIT_STREAM_CMD		0x00000000
#define DUAL_VOLT_OCR_BIT	7
#define SRC			(1 << 25)
#define SRD			(1 << 26)
103 104
#define SOFTRESET		(1 << 1)
#define RESETDONE		(1 << 0)
105 106 107 108 109 110 111 112

/*
 * FIXME: Most likely all the data using these _DEVID defines should come
 * from the platform_data, or implemented in controller and slot specific
 * functions.
 */
#define OMAP_MMC1_DEVID		0
#define OMAP_MMC2_DEVID		1
G
Grazvydas Ignotas 已提交
113
#define OMAP_MMC3_DEVID		2
114 115
#define OMAP_MMC4_DEVID		3
#define OMAP_MMC5_DEVID		4
116 117 118 119 120

#define MMC_TIMEOUT_MS		20
#define OMAP_MMC_MASTER_CLOCK	96000000
#define DRIVER_NAME		"mmci-omap-hs"

121 122
/* Timeouts for entering power saving states on inactivity, msec */
#define OMAP_MMC_DISABLED_TIMEOUT	100
123 124
#define OMAP_MMC_SLEEP_TIMEOUT		1000
#define OMAP_MMC_OFF_TIMEOUT		8000
125

126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
/*
 * One controller can have multiple slots, like on some omap boards using
 * omap.c controller driver. Luckily this is not currently done on any known
 * omap_hsmmc.c device.
 */
#define mmc_slot(host)		(host->pdata->slots[host->slot_id])

/*
 * MMC Host controller read/write API's
 */
#define OMAP_HSMMC_READ(base, reg)	\
	__raw_readl((base) + OMAP_HSMMC_##reg)

#define OMAP_HSMMC_WRITE(base, reg, val) \
	__raw_writel((val), (base) + OMAP_HSMMC_##reg)

D
Denis Karpov 已提交
142
struct omap_hsmmc_host {
143 144 145 146 147 148 149 150
	struct	device		*dev;
	struct	mmc_host	*mmc;
	struct	mmc_request	*mrq;
	struct	mmc_command	*cmd;
	struct	mmc_data	*data;
	struct	clk		*fclk;
	struct	clk		*iclk;
	struct	clk		*dbclk;
151 152 153 154 155 156 157 158 159
	/*
	 * vcc == configured supply
	 * vcc_aux == optional
	 *   -	MMC1, supply for DAT4..DAT7
	 *   -	MMC2/MMC2, external level shifter voltage supply, for
	 *	chip (SDIO, eMMC, etc) or transceiver (MMC2 only)
	 */
	struct	regulator	*vcc;
	struct	regulator	*vcc_aux;
160 161 162 163
	struct	semaphore	sem;
	struct	work_struct	mmc_carddetect_work;
	void	__iomem		*base;
	resource_size_t		mapbase;
164 165
	spinlock_t		irq_lock; /* Prevent races with irq handler */
	unsigned long		flags;
166 167
	unsigned int		id;
	unsigned int		dma_len;
168
	unsigned int		dma_sg_idx;
169
	unsigned char		bus_mode;
170
	unsigned char		power_mode;
171 172 173 174 175
	u32			*buffer;
	u32			bytesleft;
	int			suspended;
	int			irq;
	int			use_dma, dma_ch;
G
Grazvydas Ignotas 已提交
176
	int			dma_line_tx, dma_line_rx;
177
	int			slot_id;
178
	int			got_dbclk;
179
	int			response_busy;
180
	int			context_loss;
181
	int			dpm_state;
182
	int			vdd;
183 184
	int			protect_card;
	int			reqs_blocked;
185
	int			use_reg;
186

187 188 189
	struct	omap_mmc_platform_data	*pdata;
};

190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
static int omap_hsmmc_card_detect(struct device *dev, int slot)
{
	struct omap_mmc_platform_data *mmc = dev->platform_data;

	/* NOTE: assumes card detect signal is active-low */
	return !gpio_get_value_cansleep(mmc->slots[0].switch_pin);
}

static int omap_hsmmc_get_wp(struct device *dev, int slot)
{
	struct omap_mmc_platform_data *mmc = dev->platform_data;

	/* NOTE: assumes write protect signal is active-high */
	return gpio_get_value_cansleep(mmc->slots[0].gpio_wp);
}

static int omap_hsmmc_get_cover_state(struct device *dev, int slot)
{
	struct omap_mmc_platform_data *mmc = dev->platform_data;

	/* NOTE: assumes card detect signal is active-low */
	return !gpio_get_value_cansleep(mmc->slots[0].switch_pin);
}

#ifdef CONFIG_PM

static int omap_hsmmc_suspend_cdirq(struct device *dev, int slot)
{
	struct omap_mmc_platform_data *mmc = dev->platform_data;

	disable_irq(mmc->slots[0].card_detect_irq);
	return 0;
}

static int omap_hsmmc_resume_cdirq(struct device *dev, int slot)
{
	struct omap_mmc_platform_data *mmc = dev->platform_data;

	enable_irq(mmc->slots[0].card_detect_irq);
	return 0;
}

#else

#define omap_hsmmc_suspend_cdirq	NULL
#define omap_hsmmc_resume_cdirq		NULL

#endif

239 240
#ifdef CONFIG_REGULATOR

241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300
static int omap_hsmmc_1_set_power(struct device *dev, int slot, int power_on,
				  int vdd)
{
	struct omap_hsmmc_host *host =
		platform_get_drvdata(to_platform_device(dev));
	int ret;

	if (mmc_slot(host).before_set_reg)
		mmc_slot(host).before_set_reg(dev, slot, power_on, vdd);

	if (power_on)
		ret = mmc_regulator_set_ocr(host->vcc, vdd);
	else
		ret = mmc_regulator_set_ocr(host->vcc, 0);

	if (mmc_slot(host).after_set_reg)
		mmc_slot(host).after_set_reg(dev, slot, power_on, vdd);

	return ret;
}

static int omap_hsmmc_23_set_power(struct device *dev, int slot, int power_on,
				   int vdd)
{
	struct omap_hsmmc_host *host =
		platform_get_drvdata(to_platform_device(dev));
	int ret = 0;

	/*
	 * If we don't see a Vcc regulator, assume it's a fixed
	 * voltage always-on regulator.
	 */
	if (!host->vcc)
		return 0;

	if (mmc_slot(host).before_set_reg)
		mmc_slot(host).before_set_reg(dev, slot, power_on, vdd);

	/*
	 * Assume Vcc regulator is used only to power the card ... OMAP
	 * VDDS is used to power the pins, optionally with a transceiver to
	 * support cards using voltages other than VDDS (1.8V nominal).  When a
	 * transceiver is used, DAT3..7 are muxed as transceiver control pins.
	 *
	 * In some cases this regulator won't support enable/disable;
	 * e.g. it's a fixed rail for a WLAN chip.
	 *
	 * In other cases vcc_aux switches interface power.  Example, for
	 * eMMC cards it represents VccQ.  Sometimes transceivers or SDIO
	 * chips/cards need an interface voltage rail too.
	 */
	if (power_on) {
		ret = mmc_regulator_set_ocr(host->vcc, vdd);
		/* Enable interface voltage rail, if needed */
		if (ret == 0 && host->vcc_aux) {
			ret = regulator_enable(host->vcc_aux);
			if (ret < 0)
				ret = mmc_regulator_set_ocr(host->vcc, 0);
		}
	} else {
301 302
		if (host->vcc_aux)
			ret = regulator_disable(host->vcc_aux);
303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351
		if (ret == 0)
			ret = mmc_regulator_set_ocr(host->vcc, 0);
	}

	if (mmc_slot(host).after_set_reg)
		mmc_slot(host).after_set_reg(dev, slot, power_on, vdd);

	return ret;
}

static int omap_hsmmc_1_set_sleep(struct device *dev, int slot, int sleep,
				  int vdd, int cardsleep)
{
	struct omap_hsmmc_host *host =
		platform_get_drvdata(to_platform_device(dev));
	int mode = sleep ? REGULATOR_MODE_STANDBY : REGULATOR_MODE_NORMAL;

	return regulator_set_mode(host->vcc, mode);
}

static int omap_hsmmc_23_set_sleep(struct device *dev, int slot, int sleep,
				   int vdd, int cardsleep)
{
	struct omap_hsmmc_host *host =
		platform_get_drvdata(to_platform_device(dev));
	int err, mode;

	/*
	 * If we don't see a Vcc regulator, assume it's a fixed
	 * voltage always-on regulator.
	 */
	if (!host->vcc)
		return 0;

	mode = sleep ? REGULATOR_MODE_STANDBY : REGULATOR_MODE_NORMAL;

	if (!host->vcc_aux)
		return regulator_set_mode(host->vcc, mode);

	if (cardsleep) {
		/* VCC can be turned off if card is asleep */
		if (sleep)
			err = mmc_regulator_set_ocr(host->vcc, 0);
		else
			err = mmc_regulator_set_ocr(host->vcc, vdd);
	} else
		err = regulator_set_mode(host->vcc, mode);
	if (err)
		return err;
352 353 354 355 356 357 358 359

	if (!mmc_slot(host).vcc_aux_disable_is_sleep)
		return regulator_set_mode(host->vcc_aux, mode);

	if (sleep)
		return regulator_disable(host->vcc_aux);
	else
		return regulator_enable(host->vcc_aux);
360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439
}

static int omap_hsmmc_reg_get(struct omap_hsmmc_host *host)
{
	struct regulator *reg;
	int ret = 0;

	switch (host->id) {
	case OMAP_MMC1_DEVID:
		/* On-chip level shifting via PBIAS0/PBIAS1 */
		mmc_slot(host).set_power = omap_hsmmc_1_set_power;
		mmc_slot(host).set_sleep = omap_hsmmc_1_set_sleep;
		break;
	case OMAP_MMC2_DEVID:
	case OMAP_MMC3_DEVID:
		/* Off-chip level shifting, or none */
		mmc_slot(host).set_power = omap_hsmmc_23_set_power;
		mmc_slot(host).set_sleep = omap_hsmmc_23_set_sleep;
		break;
	default:
		pr_err("MMC%d configuration not supported!\n", host->id);
		return -EINVAL;
	}

	reg = regulator_get(host->dev, "vmmc");
	if (IS_ERR(reg)) {
		dev_dbg(host->dev, "vmmc regulator missing\n");
		/*
		* HACK: until fixed.c regulator is usable,
		* we don't require a main regulator
		* for MMC2 or MMC3
		*/
		if (host->id == OMAP_MMC1_DEVID) {
			ret = PTR_ERR(reg);
			goto err;
		}
	} else {
		host->vcc = reg;
		mmc_slot(host).ocr_mask = mmc_regulator_get_ocrmask(reg);

		/* Allow an aux regulator */
		reg = regulator_get(host->dev, "vmmc_aux");
		host->vcc_aux = IS_ERR(reg) ? NULL : reg;

		/*
		* UGLY HACK:  workaround regulator framework bugs.
		* When the bootloader leaves a supply active, it's
		* initialized with zero usecount ... and we can't
		* disable it without first enabling it.  Until the
		* framework is fixed, we need a workaround like this
		* (which is safe for MMC, but not in general).
		*/
		if (regulator_is_enabled(host->vcc) > 0) {
			regulator_enable(host->vcc);
			regulator_disable(host->vcc);
		}
		if (host->vcc_aux) {
			if (regulator_is_enabled(reg) > 0) {
				regulator_enable(reg);
				regulator_disable(reg);
			}
		}
	}

	return 0;

err:
	mmc_slot(host).set_power = NULL;
	mmc_slot(host).set_sleep = NULL;
	return ret;
}

static void omap_hsmmc_reg_put(struct omap_hsmmc_host *host)
{
	regulator_put(host->vcc);
	regulator_put(host->vcc_aux);
	mmc_slot(host).set_power = NULL;
	mmc_slot(host).set_sleep = NULL;
}

440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515
static inline int omap_hsmmc_have_reg(void)
{
	return 1;
}

#else

static inline int omap_hsmmc_reg_get(struct omap_hsmmc_host *host)
{
	return -EINVAL;
}

static inline void omap_hsmmc_reg_put(struct omap_hsmmc_host *host)
{
}

static inline int omap_hsmmc_have_reg(void)
{
	return 0;
}

#endif

static int omap_hsmmc_gpio_init(struct omap_mmc_platform_data *pdata)
{
	int ret;

	if (gpio_is_valid(pdata->slots[0].switch_pin)) {
		pdata->suspend = omap_hsmmc_suspend_cdirq;
		pdata->resume = omap_hsmmc_resume_cdirq;
		if (pdata->slots[0].cover)
			pdata->slots[0].get_cover_state =
					omap_hsmmc_get_cover_state;
		else
			pdata->slots[0].card_detect = omap_hsmmc_card_detect;
		pdata->slots[0].card_detect_irq =
				gpio_to_irq(pdata->slots[0].switch_pin);
		ret = gpio_request(pdata->slots[0].switch_pin, "mmc_cd");
		if (ret)
			return ret;
		ret = gpio_direction_input(pdata->slots[0].switch_pin);
		if (ret)
			goto err_free_sp;
	} else
		pdata->slots[0].switch_pin = -EINVAL;

	if (gpio_is_valid(pdata->slots[0].gpio_wp)) {
		pdata->slots[0].get_ro = omap_hsmmc_get_wp;
		ret = gpio_request(pdata->slots[0].gpio_wp, "mmc_wp");
		if (ret)
			goto err_free_cd;
		ret = gpio_direction_input(pdata->slots[0].gpio_wp);
		if (ret)
			goto err_free_wp;
	} else
		pdata->slots[0].gpio_wp = -EINVAL;

	return 0;

err_free_wp:
	gpio_free(pdata->slots[0].gpio_wp);
err_free_cd:
	if (gpio_is_valid(pdata->slots[0].switch_pin))
err_free_sp:
		gpio_free(pdata->slots[0].switch_pin);
	return ret;
}

static void omap_hsmmc_gpio_free(struct omap_mmc_platform_data *pdata)
{
	if (gpio_is_valid(pdata->slots[0].gpio_wp))
		gpio_free(pdata->slots[0].gpio_wp);
	if (gpio_is_valid(pdata->slots[0].switch_pin))
		gpio_free(pdata->slots[0].switch_pin);
}

516 517 518
/*
 * Stop clock to the card
 */
D
Denis Karpov 已提交
519
static void omap_hsmmc_stop_clock(struct omap_hsmmc_host *host)
520 521 522 523 524 525 526
{
	OMAP_HSMMC_WRITE(host->base, SYSCTL,
		OMAP_HSMMC_READ(host->base, SYSCTL) & ~CEN);
	if ((OMAP_HSMMC_READ(host->base, SYSCTL) & CEN) != 0x0)
		dev_dbg(mmc_dev(host->mmc), "MMC Clock is not stoped\n");
}

527 528 529 530 531 532
#ifdef CONFIG_PM

/*
 * Restore the MMC host context, if it was lost as result of a
 * power state change.
 */
D
Denis Karpov 已提交
533
static int omap_hsmmc_context_restore(struct omap_hsmmc_host *host)
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660
{
	struct mmc_ios *ios = &host->mmc->ios;
	struct omap_mmc_platform_data *pdata = host->pdata;
	int context_loss = 0;
	u32 hctl, capa, con;
	u16 dsor = 0;
	unsigned long timeout;

	if (pdata->get_context_loss_count) {
		context_loss = pdata->get_context_loss_count(host->dev);
		if (context_loss < 0)
			return 1;
	}

	dev_dbg(mmc_dev(host->mmc), "context was %slost\n",
		context_loss == host->context_loss ? "not " : "");
	if (host->context_loss == context_loss)
		return 1;

	/* Wait for hardware reset */
	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS);
	while ((OMAP_HSMMC_READ(host->base, SYSSTATUS) & RESETDONE) != RESETDONE
		&& time_before(jiffies, timeout))
		;

	/* Do software reset */
	OMAP_HSMMC_WRITE(host->base, SYSCONFIG, SOFTRESET);
	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS);
	while ((OMAP_HSMMC_READ(host->base, SYSSTATUS) & RESETDONE) != RESETDONE
		&& time_before(jiffies, timeout))
		;

	OMAP_HSMMC_WRITE(host->base, SYSCONFIG,
			OMAP_HSMMC_READ(host->base, SYSCONFIG) | AUTOIDLE);

	if (host->id == OMAP_MMC1_DEVID) {
		if (host->power_mode != MMC_POWER_OFF &&
		    (1 << ios->vdd) <= MMC_VDD_23_24)
			hctl = SDVS18;
		else
			hctl = SDVS30;
		capa = VS30 | VS18;
	} else {
		hctl = SDVS18;
		capa = VS18;
	}

	OMAP_HSMMC_WRITE(host->base, HCTL,
			OMAP_HSMMC_READ(host->base, HCTL) | hctl);

	OMAP_HSMMC_WRITE(host->base, CAPA,
			OMAP_HSMMC_READ(host->base, CAPA) | capa);

	OMAP_HSMMC_WRITE(host->base, HCTL,
			OMAP_HSMMC_READ(host->base, HCTL) | SDBP);

	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS);
	while ((OMAP_HSMMC_READ(host->base, HCTL) & SDBP) != SDBP
		&& time_before(jiffies, timeout))
		;

	OMAP_HSMMC_WRITE(host->base, STAT, STAT_CLEAR);
	OMAP_HSMMC_WRITE(host->base, ISE, INT_EN_MASK);
	OMAP_HSMMC_WRITE(host->base, IE, INT_EN_MASK);

	/* Do not initialize card-specific things if the power is off */
	if (host->power_mode == MMC_POWER_OFF)
		goto out;

	con = OMAP_HSMMC_READ(host->base, CON);
	switch (ios->bus_width) {
	case MMC_BUS_WIDTH_8:
		OMAP_HSMMC_WRITE(host->base, CON, con | DW8);
		break;
	case MMC_BUS_WIDTH_4:
		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8);
		OMAP_HSMMC_WRITE(host->base, HCTL,
			OMAP_HSMMC_READ(host->base, HCTL) | FOUR_BIT);
		break;
	case MMC_BUS_WIDTH_1:
		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8);
		OMAP_HSMMC_WRITE(host->base, HCTL,
			OMAP_HSMMC_READ(host->base, HCTL) & ~FOUR_BIT);
		break;
	}

	if (ios->clock) {
		dsor = OMAP_MMC_MASTER_CLOCK / ios->clock;
		if (dsor < 1)
			dsor = 1;

		if (OMAP_MMC_MASTER_CLOCK / dsor > ios->clock)
			dsor++;

		if (dsor > 250)
			dsor = 250;
	}

	OMAP_HSMMC_WRITE(host->base, SYSCTL,
		OMAP_HSMMC_READ(host->base, SYSCTL) & ~CEN);
	OMAP_HSMMC_WRITE(host->base, SYSCTL, (dsor << 6) | (DTO << 16));
	OMAP_HSMMC_WRITE(host->base, SYSCTL,
		OMAP_HSMMC_READ(host->base, SYSCTL) | ICE);

	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS);
	while ((OMAP_HSMMC_READ(host->base, SYSCTL) & ICS) != ICS
		&& time_before(jiffies, timeout))
		;

	OMAP_HSMMC_WRITE(host->base, SYSCTL,
		OMAP_HSMMC_READ(host->base, SYSCTL) | CEN);

	con = OMAP_HSMMC_READ(host->base, CON);
	if (ios->bus_mode == MMC_BUSMODE_OPENDRAIN)
		OMAP_HSMMC_WRITE(host->base, CON, con | OD);
	else
		OMAP_HSMMC_WRITE(host->base, CON, con & ~OD);
out:
	host->context_loss = context_loss;

	dev_dbg(mmc_dev(host->mmc), "context is restored\n");
	return 0;
}

/*
 * Save the MMC host context (store the number of power state changes so far).
 */
D
Denis Karpov 已提交
661
static void omap_hsmmc_context_save(struct omap_hsmmc_host *host)
662 663 664 665 666 667 668 669 670 671 672 673 674 675
{
	struct omap_mmc_platform_data *pdata = host->pdata;
	int context_loss;

	if (pdata->get_context_loss_count) {
		context_loss = pdata->get_context_loss_count(host->dev);
		if (context_loss < 0)
			return;
		host->context_loss = context_loss;
	}
}

#else

D
Denis Karpov 已提交
676
static int omap_hsmmc_context_restore(struct omap_hsmmc_host *host)
677 678 679 680
{
	return 0;
}

D
Denis Karpov 已提交
681
static void omap_hsmmc_context_save(struct omap_hsmmc_host *host)
682 683 684 685 686
{
}

#endif

687 688 689 690
/*
 * Send init stream sequence to card
 * before sending IDLE command
 */
D
Denis Karpov 已提交
691
static void send_init_stream(struct omap_hsmmc_host *host)
692 693 694 695
{
	int reg = 0;
	unsigned long timeout;

696 697 698
	if (host->protect_card)
		return;

699 700 701 702 703 704 705 706 707 708 709
	disable_irq(host->irq);
	OMAP_HSMMC_WRITE(host->base, CON,
		OMAP_HSMMC_READ(host->base, CON) | INIT_STREAM);
	OMAP_HSMMC_WRITE(host->base, CMD, INIT_STREAM_CMD);

	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS);
	while ((reg != CC) && time_before(jiffies, timeout))
		reg = OMAP_HSMMC_READ(host->base, STAT) & CC;

	OMAP_HSMMC_WRITE(host->base, CON,
		OMAP_HSMMC_READ(host->base, CON) & ~INIT_STREAM);
710 711 712 713

	OMAP_HSMMC_WRITE(host->base, STAT, STAT_CLEAR);
	OMAP_HSMMC_READ(host->base, STAT);

714 715 716 717
	enable_irq(host->irq);
}

static inline
D
Denis Karpov 已提交
718
int omap_hsmmc_cover_is_closed(struct omap_hsmmc_host *host)
719 720 721
{
	int r = 1;

D
Denis Karpov 已提交
722 723
	if (mmc_slot(host).get_cover_state)
		r = mmc_slot(host).get_cover_state(host->dev, host->slot_id);
724 725 726 727
	return r;
}

static ssize_t
D
Denis Karpov 已提交
728
omap_hsmmc_show_cover_switch(struct device *dev, struct device_attribute *attr,
729 730 731
			   char *buf)
{
	struct mmc_host *mmc = container_of(dev, struct mmc_host, class_dev);
D
Denis Karpov 已提交
732
	struct omap_hsmmc_host *host = mmc_priv(mmc);
733

D
Denis Karpov 已提交
734 735
	return sprintf(buf, "%s\n",
			omap_hsmmc_cover_is_closed(host) ? "closed" : "open");
736 737
}

D
Denis Karpov 已提交
738
static DEVICE_ATTR(cover_switch, S_IRUGO, omap_hsmmc_show_cover_switch, NULL);
739 740

static ssize_t
D
Denis Karpov 已提交
741
omap_hsmmc_show_slot_name(struct device *dev, struct device_attribute *attr,
742 743 744
			char *buf)
{
	struct mmc_host *mmc = container_of(dev, struct mmc_host, class_dev);
D
Denis Karpov 已提交
745
	struct omap_hsmmc_host *host = mmc_priv(mmc);
746

D
Denis Karpov 已提交
747
	return sprintf(buf, "%s\n", mmc_slot(host).name);
748 749
}

D
Denis Karpov 已提交
750
static DEVICE_ATTR(slot_name, S_IRUGO, omap_hsmmc_show_slot_name, NULL);
751 752 753 754 755

/*
 * Configure the response type and send the cmd.
 */
static void
D
Denis Karpov 已提交
756
omap_hsmmc_start_command(struct omap_hsmmc_host *host, struct mmc_command *cmd,
757 758 759 760 761 762 763 764 765 766 767 768 769
	struct mmc_data *data)
{
	int cmdreg = 0, resptype = 0, cmdtype = 0;

	dev_dbg(mmc_dev(host->mmc), "%s: CMD%d, argument 0x%08x\n",
		mmc_hostname(host->mmc), cmd->opcode, cmd->arg);
	host->cmd = cmd;

	/*
	 * Clear status bits and enable interrupts
	 */
	OMAP_HSMMC_WRITE(host->base, STAT, STAT_CLEAR);
	OMAP_HSMMC_WRITE(host->base, ISE, INT_EN_MASK);
770 771 772 773 774 775

	if (host->use_dma)
		OMAP_HSMMC_WRITE(host->base, IE,
				 INT_EN_MASK & ~(BRR_ENABLE | BWR_ENABLE));
	else
		OMAP_HSMMC_WRITE(host->base, IE, INT_EN_MASK);
776

777
	host->response_busy = 0;
778 779 780
	if (cmd->flags & MMC_RSP_PRESENT) {
		if (cmd->flags & MMC_RSP_136)
			resptype = 1;
781 782 783 784
		else if (cmd->flags & MMC_RSP_BUSY) {
			resptype = 3;
			host->response_busy = 1;
		} else
785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808
			resptype = 2;
	}

	/*
	 * Unlike OMAP1 controller, the cmdtype does not seem to be based on
	 * ac, bc, adtc, bcr. Only commands ending an open ended transfer need
	 * a val of 0x3, rest 0x0.
	 */
	if (cmd == host->mrq->stop)
		cmdtype = 0x3;

	cmdreg = (cmd->opcode << 24) | (resptype << 16) | (cmdtype << 22);

	if (data) {
		cmdreg |= DP_SELECT | MSBS | BCE;
		if (data->flags & MMC_DATA_READ)
			cmdreg |= DDIR;
		else
			cmdreg &= ~(DDIR);
	}

	if (host->use_dma)
		cmdreg |= DMA_EN;

809 810 811 812 813 814 815 816
	/*
	 * In an interrupt context (i.e. STOP command), the spinlock is unlocked
	 * by the interrupt handler, otherwise (i.e. for a new request) it is
	 * unlocked here.
	 */
	if (!in_interrupt())
		spin_unlock_irqrestore(&host->irq_lock, host->flags);

817 818 819 820
	OMAP_HSMMC_WRITE(host->base, ARG, cmd->arg);
	OMAP_HSMMC_WRITE(host->base, CMD, cmdreg);
}

821
static int
D
Denis Karpov 已提交
822
omap_hsmmc_get_dma_dir(struct omap_hsmmc_host *host, struct mmc_data *data)
823 824 825 826 827 828 829
{
	if (data->flags & MMC_DATA_WRITE)
		return DMA_TO_DEVICE;
	else
		return DMA_FROM_DEVICE;
}

830 831 832 833
/*
 * Notify the transfer complete to MMC core
 */
static void
D
Denis Karpov 已提交
834
omap_hsmmc_xfer_done(struct omap_hsmmc_host *host, struct mmc_data *data)
835
{
836 837 838
	if (!data) {
		struct mmc_request *mrq = host->mrq;

839 840 841 842 843 844 845
		/* TC before CC from CMD6 - don't know why, but it happens */
		if (host->cmd && host->cmd->opcode == 6 &&
		    host->response_busy) {
			host->response_busy = 0;
			return;
		}

846 847 848 849 850
		host->mrq = NULL;
		mmc_request_done(host->mmc, mrq);
		return;
	}

851 852 853 854
	host->data = NULL;

	if (host->use_dma && host->dma_ch != -1)
		dma_unmap_sg(mmc_dev(host->mmc), data->sg, host->dma_len,
D
Denis Karpov 已提交
855
			omap_hsmmc_get_dma_dir(host, data));
856 857 858 859 860 861 862 863 864 865 866

	if (!data->error)
		data->bytes_xfered += data->blocks * (data->blksz);
	else
		data->bytes_xfered = 0;

	if (!data->stop) {
		host->mrq = NULL;
		mmc_request_done(host->mmc, data->mrq);
		return;
	}
D
Denis Karpov 已提交
867
	omap_hsmmc_start_command(host, data->stop, NULL);
868 869 870 871 872 873
}

/*
 * Notify the core about command completion
 */
static void
D
Denis Karpov 已提交
874
omap_hsmmc_cmd_done(struct omap_hsmmc_host *host, struct mmc_command *cmd)
875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
{
	host->cmd = NULL;

	if (cmd->flags & MMC_RSP_PRESENT) {
		if (cmd->flags & MMC_RSP_136) {
			/* response type 2 */
			cmd->resp[3] = OMAP_HSMMC_READ(host->base, RSP10);
			cmd->resp[2] = OMAP_HSMMC_READ(host->base, RSP32);
			cmd->resp[1] = OMAP_HSMMC_READ(host->base, RSP54);
			cmd->resp[0] = OMAP_HSMMC_READ(host->base, RSP76);
		} else {
			/* response types 1, 1b, 3, 4, 5, 6 */
			cmd->resp[0] = OMAP_HSMMC_READ(host->base, RSP10);
		}
	}
890
	if ((host->data == NULL && !host->response_busy) || cmd->error) {
891 892 893 894 895 896 897 898
		host->mrq = NULL;
		mmc_request_done(host->mmc, cmd->mrq);
	}
}

/*
 * DMA clean up for command errors
 */
D
Denis Karpov 已提交
899
static void omap_hsmmc_dma_cleanup(struct omap_hsmmc_host *host, int errno)
900
{
901
	host->data->error = errno;
902 903 904

	if (host->use_dma && host->dma_ch != -1) {
		dma_unmap_sg(mmc_dev(host->mmc), host->data->sg, host->dma_len,
D
Denis Karpov 已提交
905
			omap_hsmmc_get_dma_dir(host, host->data));
906 907 908 909 910 911 912 913 914 915 916
		omap_free_dma(host->dma_ch);
		host->dma_ch = -1;
		up(&host->sem);
	}
	host->data = NULL;
}

/*
 * Readable error output
 */
#ifdef CONFIG_MMC_DEBUG
D
Denis Karpov 已提交
917
static void omap_hsmmc_report_irq(struct omap_hsmmc_host *host, u32 status)
918 919
{
	/* --- means reserved bit without definition at documentation */
D
Denis Karpov 已提交
920
	static const char *omap_hsmmc_status_bits[] = {
921 922 923 924 925 926 927 928 929 930 931 932
		"CC", "TC", "BGE", "---", "BWR", "BRR", "---", "---", "CIRQ",
		"OBI", "---", "---", "---", "---", "---", "ERRI", "CTO", "CCRC",
		"CEB", "CIE", "DTO", "DCRC", "DEB", "---", "ACE", "---",
		"---", "---", "---", "CERR", "CERR", "BADA", "---", "---", "---"
	};
	char res[256];
	char *buf = res;
	int len, i;

	len = sprintf(buf, "MMC IRQ 0x%x :", status);
	buf += len;

D
Denis Karpov 已提交
933
	for (i = 0; i < ARRAY_SIZE(omap_hsmmc_status_bits); i++)
934
		if (status & (1 << i)) {
D
Denis Karpov 已提交
935
			len = sprintf(buf, " %s", omap_hsmmc_status_bits[i]);
936 937 938 939 940 941 942
			buf += len;
		}

	dev_dbg(mmc_dev(host->mmc), "%s\n", res);
}
#endif  /* CONFIG_MMC_DEBUG */

943 944 945 946 947 948 949
/*
 * MMC controller internal state machines reset
 *
 * Used to reset command or data internal state machines, using respectively
 *  SRC or SRD bit of SYSCTL register
 * Can be called from interrupt context
 */
D
Denis Karpov 已提交
950 951
static inline void omap_hsmmc_reset_controller_fsm(struct omap_hsmmc_host *host,
						   unsigned long bit)
952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968
{
	unsigned long i = 0;
	unsigned long limit = (loops_per_jiffy *
				msecs_to_jiffies(MMC_TIMEOUT_MS));

	OMAP_HSMMC_WRITE(host->base, SYSCTL,
			 OMAP_HSMMC_READ(host->base, SYSCTL) | bit);

	while ((OMAP_HSMMC_READ(host->base, SYSCTL) & bit) &&
		(i++ < limit))
		cpu_relax();

	if (OMAP_HSMMC_READ(host->base, SYSCTL) & bit)
		dev_err(mmc_dev(host->mmc),
			"Timeout waiting on controller reset in %s\n",
			__func__);
}
969 970 971 972

/*
 * MMC controller IRQ handler
 */
D
Denis Karpov 已提交
973
static irqreturn_t omap_hsmmc_irq(int irq, void *dev_id)
974
{
D
Denis Karpov 已提交
975
	struct omap_hsmmc_host *host = dev_id;
976 977 978
	struct mmc_data *data;
	int end_cmd = 0, end_trans = 0, status;

979 980
	spin_lock(&host->irq_lock);

981
	if (host->mrq == NULL) {
982 983
		OMAP_HSMMC_WRITE(host->base, STAT,
			OMAP_HSMMC_READ(host->base, STAT));
984 985
		/* Flush posted write */
		OMAP_HSMMC_READ(host->base, STAT);
986
		spin_unlock(&host->irq_lock);
987 988 989 990 991 992 993 994 995
		return IRQ_HANDLED;
	}

	data = host->data;
	status = OMAP_HSMMC_READ(host->base, STAT);
	dev_dbg(mmc_dev(host->mmc), "IRQ Status is %x\n", status);

	if (status & ERR) {
#ifdef CONFIG_MMC_DEBUG
D
Denis Karpov 已提交
996
		omap_hsmmc_report_irq(host, status);
997 998 999 1000 1001
#endif
		if ((status & CMD_TIMEOUT) ||
			(status & CMD_CRC)) {
			if (host->cmd) {
				if (status & CMD_TIMEOUT) {
D
Denis Karpov 已提交
1002 1003
					omap_hsmmc_reset_controller_fsm(host,
									SRC);
1004 1005 1006 1007 1008 1009
					host->cmd->error = -ETIMEDOUT;
				} else {
					host->cmd->error = -EILSEQ;
				}
				end_cmd = 1;
			}
1010 1011
			if (host->data || host->response_busy) {
				if (host->data)
D
Denis Karpov 已提交
1012 1013
					omap_hsmmc_dma_cleanup(host,
								-ETIMEDOUT);
1014
				host->response_busy = 0;
D
Denis Karpov 已提交
1015
				omap_hsmmc_reset_controller_fsm(host, SRD);
1016
			}
1017 1018 1019
		}
		if ((status & DATA_TIMEOUT) ||
			(status & DATA_CRC)) {
1020 1021 1022 1023 1024
			if (host->data || host->response_busy) {
				int err = (status & DATA_TIMEOUT) ?
						-ETIMEDOUT : -EILSEQ;

				if (host->data)
D
Denis Karpov 已提交
1025
					omap_hsmmc_dma_cleanup(host, err);
1026
				else
1027 1028
					host->mrq->cmd->error = err;
				host->response_busy = 0;
D
Denis Karpov 已提交
1029
				omap_hsmmc_reset_controller_fsm(host, SRD);
1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043
				end_trans = 1;
			}
		}
		if (status & CARD_ERR) {
			dev_dbg(mmc_dev(host->mmc),
				"Ignoring card err CMD%d\n", host->cmd->opcode);
			if (host->cmd)
				end_cmd = 1;
			if (host->data)
				end_trans = 1;
		}
	}

	OMAP_HSMMC_WRITE(host->base, STAT, status);
1044 1045
	/* Flush posted write */
	OMAP_HSMMC_READ(host->base, STAT);
1046

1047
	if (end_cmd || ((status & CC) && host->cmd))
D
Denis Karpov 已提交
1048
		omap_hsmmc_cmd_done(host, host->cmd);
1049
	if ((end_trans || (status & TC)) && host->mrq)
D
Denis Karpov 已提交
1050
		omap_hsmmc_xfer_done(host, data);
1051

1052 1053
	spin_unlock(&host->irq_lock);

1054 1055 1056
	return IRQ_HANDLED;
}

D
Denis Karpov 已提交
1057
static void set_sd_bus_power(struct omap_hsmmc_host *host)
A
Adrian Hunter 已提交
1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069
{
	unsigned long i;

	OMAP_HSMMC_WRITE(host->base, HCTL,
			 OMAP_HSMMC_READ(host->base, HCTL) | SDBP);
	for (i = 0; i < loops_per_jiffy; i++) {
		if (OMAP_HSMMC_READ(host->base, HCTL) & SDBP)
			break;
		cpu_relax();
	}
}

1070
/*
1071 1072 1073 1074 1075
 * Switch MMC interface voltage ... only relevant for MMC1.
 *
 * MMC2 and MMC3 use fixed 1.8V levels, and maybe a transceiver.
 * The MMC2 transceiver controls are used instead of DAT4..DAT7.
 * Some chips, like eMMC ones, use internal transceivers.
1076
 */
D
Denis Karpov 已提交
1077
static int omap_hsmmc_switch_opcond(struct omap_hsmmc_host *host, int vdd)
1078 1079 1080 1081 1082 1083 1084
{
	u32 reg_val = 0;
	int ret;

	/* Disable the clocks */
	clk_disable(host->fclk);
	clk_disable(host->iclk);
1085 1086
	if (host->got_dbclk)
		clk_disable(host->dbclk);
1087 1088 1089 1090 1091

	/* Turn the power off */
	ret = mmc_slot(host).set_power(host->dev, host->slot_id, 0, 0);

	/* Turn the power ON with given VDD 1.8 or 3.0v */
1092 1093 1094 1095 1096 1097 1098 1099
	if (!ret)
		ret = mmc_slot(host).set_power(host->dev, host->slot_id, 1,
					       vdd);
	clk_enable(host->iclk);
	clk_enable(host->fclk);
	if (host->got_dbclk)
		clk_enable(host->dbclk);

1100 1101 1102 1103 1104 1105
	if (ret != 0)
		goto err;

	OMAP_HSMMC_WRITE(host->base, HCTL,
		OMAP_HSMMC_READ(host->base, HCTL) & SDVSCLR);
	reg_val = OMAP_HSMMC_READ(host->base, HCTL);
1106

1107 1108 1109
	/*
	 * If a MMC dual voltage card is detected, the set_ios fn calls
	 * this fn with VDD bit set for 1.8V. Upon card removal from the
D
Denis Karpov 已提交
1110
	 * slot, omap_hsmmc_set_ios sets the VDD back to 3V on MMC_POWER_OFF.
1111
	 *
1112 1113 1114 1115 1116 1117 1118 1119 1120
	 * Cope with a bit of slop in the range ... per data sheets:
	 *  - "1.8V" for vdds_mmc1/vdds_mmc1a can be up to 2.45V max,
	 *    but recommended values are 1.71V to 1.89V
	 *  - "3.0V" for vdds_mmc1/vdds_mmc1a can be up to 3.5V max,
	 *    but recommended values are 2.7V to 3.3V
	 *
	 * Board setup code shouldn't permit anything very out-of-range.
	 * TWL4030-family VMMC1 and VSIM regulators are fine (avoiding the
	 * middle range) but VSIM can't power DAT4..DAT7 at more than 3V.
1121
	 */
1122
	if ((1 << vdd) <= MMC_VDD_23_24)
1123
		reg_val |= SDVS18;
1124 1125
	else
		reg_val |= SDVS30;
1126 1127

	OMAP_HSMMC_WRITE(host->base, HCTL, reg_val);
A
Adrian Hunter 已提交
1128
	set_sd_bus_power(host);
1129 1130 1131 1132 1133 1134 1135

	return 0;
err:
	dev_dbg(mmc_dev(host->mmc), "Unable to switch operating voltage\n");
	return ret;
}

1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159
/* Protect the card while the cover is open */
static void omap_hsmmc_protect_card(struct omap_hsmmc_host *host)
{
	if (!mmc_slot(host).get_cover_state)
		return;

	host->reqs_blocked = 0;
	if (mmc_slot(host).get_cover_state(host->dev, host->slot_id)) {
		if (host->protect_card) {
			printk(KERN_INFO "%s: cover is closed, "
					 "card is now accessible\n",
					 mmc_hostname(host->mmc));
			host->protect_card = 0;
		}
	} else {
		if (!host->protect_card) {
			printk(KERN_INFO "%s: cover is open, "
					 "card is now inaccessible\n",
					 mmc_hostname(host->mmc));
			host->protect_card = 1;
		}
	}
}

1160 1161 1162
/*
 * Work Item to notify the core about card insertion/removal
 */
D
Denis Karpov 已提交
1163
static void omap_hsmmc_detect(struct work_struct *work)
1164
{
D
Denis Karpov 已提交
1165 1166
	struct omap_hsmmc_host *host =
		container_of(work, struct omap_hsmmc_host, mmc_carddetect_work);
1167
	struct omap_mmc_slot_data *slot = &mmc_slot(host);
1168 1169 1170 1171 1172 1173
	int carddetect;

	if (host->suspended)
		return;

	sysfs_notify(&host->mmc->class_dev.kobj, NULL, "cover_switch");
1174

D
Denis Karpov 已提交
1175
	if (slot->card_detect)
1176
		carddetect = slot->card_detect(host->dev, host->slot_id);
1177 1178
	else {
		omap_hsmmc_protect_card(host);
1179
		carddetect = -ENOSYS;
1180
	}
1181

1182
	if (carddetect) {
1183 1184
		mmc_detect_change(host->mmc, (HZ * 200) / 1000);
	} else {
1185
		mmc_host_enable(host->mmc);
D
Denis Karpov 已提交
1186
		omap_hsmmc_reset_controller_fsm(host, SRD);
1187
		mmc_host_lazy_disable(host->mmc);
D
Denis Karpov 已提交
1188

1189 1190 1191 1192 1193 1194 1195
		mmc_detect_change(host->mmc, (HZ * 50) / 1000);
	}
}

/*
 * ISR for handling card insertion and removal
 */
D
Denis Karpov 已提交
1196
static irqreturn_t omap_hsmmc_cd_handler(int irq, void *dev_id)
1197
{
D
Denis Karpov 已提交
1198
	struct omap_hsmmc_host *host = (struct omap_hsmmc_host *)dev_id;
1199

1200 1201
	if (host->suspended)
		return IRQ_HANDLED;
1202 1203 1204 1205 1206
	schedule_work(&host->mmc_carddetect_work);

	return IRQ_HANDLED;
}

D
Denis Karpov 已提交
1207
static int omap_hsmmc_get_dma_sync_dev(struct omap_hsmmc_host *host,
1208 1209 1210 1211
				     struct mmc_data *data)
{
	int sync_dev;

G
Grazvydas Ignotas 已提交
1212 1213 1214 1215
	if (data->flags & MMC_DATA_WRITE)
		sync_dev = host->dma_line_tx;
	else
		sync_dev = host->dma_line_rx;
1216 1217 1218
	return sync_dev;
}

D
Denis Karpov 已提交
1219
static void omap_hsmmc_config_dma_params(struct omap_hsmmc_host *host,
1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
				       struct mmc_data *data,
				       struct scatterlist *sgl)
{
	int blksz, nblk, dma_ch;

	dma_ch = host->dma_ch;
	if (data->flags & MMC_DATA_WRITE) {
		omap_set_dma_dest_params(dma_ch, 0, OMAP_DMA_AMODE_CONSTANT,
			(host->mapbase + OMAP_HSMMC_DATA), 0, 0);
		omap_set_dma_src_params(dma_ch, 0, OMAP_DMA_AMODE_POST_INC,
			sg_dma_address(sgl), 0, 0);
	} else {
		omap_set_dma_src_params(dma_ch, 0, OMAP_DMA_AMODE_CONSTANT,
D
Denis Karpov 已提交
1233
			(host->mapbase + OMAP_HSMMC_DATA), 0, 0);
1234 1235 1236 1237 1238 1239 1240 1241 1242
		omap_set_dma_dest_params(dma_ch, 0, OMAP_DMA_AMODE_POST_INC,
			sg_dma_address(sgl), 0, 0);
	}

	blksz = host->data->blksz;
	nblk = sg_dma_len(sgl) / blksz;

	omap_set_dma_transfer_params(dma_ch, OMAP_DMA_DATA_TYPE_S32,
			blksz / 4, nblk, OMAP_DMA_SYNC_FRAME,
D
Denis Karpov 已提交
1243
			omap_hsmmc_get_dma_sync_dev(host, data),
1244 1245 1246 1247 1248
			!(data->flags & MMC_DATA_WRITE));

	omap_start_dma(dma_ch);
}

1249 1250 1251
/*
 * DMA call back function
 */
D
Denis Karpov 已提交
1252
static void omap_hsmmc_dma_cb(int lch, u16 ch_status, void *data)
1253
{
D
Denis Karpov 已提交
1254
	struct omap_hsmmc_host *host = data;
1255 1256 1257 1258 1259 1260 1261

	if (ch_status & OMAP2_DMA_MISALIGNED_ERR_IRQ)
		dev_dbg(mmc_dev(host->mmc), "MISALIGNED_ADRS_ERR\n");

	if (host->dma_ch < 0)
		return;

1262 1263 1264
	host->dma_sg_idx++;
	if (host->dma_sg_idx < host->dma_len) {
		/* Fire up the next transfer. */
D
Denis Karpov 已提交
1265
		omap_hsmmc_config_dma_params(host, host->data,
1266 1267 1268 1269
					   host->data->sg + host->dma_sg_idx);
		return;
	}

1270 1271 1272 1273
	omap_free_dma(host->dma_ch);
	host->dma_ch = -1;
	/*
	 * DMA Callback: run in interrupt context.
1274
	 * mutex_unlock will throw a kernel warning if used.
1275 1276 1277 1278 1279 1280 1281
	 */
	up(&host->sem);
}

/*
 * Routine to configure and start DMA for the MMC card
 */
D
Denis Karpov 已提交
1282 1283
static int omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host,
					struct mmc_request *req)
1284
{
1285
	int dma_ch = 0, ret = 0, err = 1, i;
1286 1287
	struct mmc_data *data = req->data;

1288
	/* Sanity check: all the SG entries must be aligned by block size. */
1289
	for (i = 0; i < data->sg_len; i++) {
1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301
		struct scatterlist *sgl;

		sgl = data->sg + i;
		if (sgl->length % data->blksz)
			return -EINVAL;
	}
	if ((data->blksz % 4) != 0)
		/* REVISIT: The MMC buffer increments only when MSB is written.
		 * Return error for blksz which is non multiple of four.
		 */
		return -EINVAL;

1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
	/*
	 * If for some reason the DMA transfer is still active,
	 * we wait for timeout period and free the dma
	 */
	if (host->dma_ch != -1) {
		set_current_state(TASK_UNINTERRUPTIBLE);
		schedule_timeout(100);
		if (down_trylock(&host->sem)) {
			omap_free_dma(host->dma_ch);
			host->dma_ch = -1;
			up(&host->sem);
			return err;
		}
	} else {
		if (down_trylock(&host->sem))
			return err;
	}

D
Denis Karpov 已提交
1320 1321
	ret = omap_request_dma(omap_hsmmc_get_dma_sync_dev(host, data),
			       "MMC/SD", omap_hsmmc_dma_cb, host, &dma_ch);
1322
	if (ret != 0) {
1323
		dev_err(mmc_dev(host->mmc),
1324 1325 1326 1327 1328 1329
			"%s: omap_request_dma() failed with %d\n",
			mmc_hostname(host->mmc), ret);
		return ret;
	}

	host->dma_len = dma_map_sg(mmc_dev(host->mmc), data->sg,
D
Denis Karpov 已提交
1330
			data->sg_len, omap_hsmmc_get_dma_dir(host, data));
1331
	host->dma_ch = dma_ch;
1332
	host->dma_sg_idx = 0;
1333

D
Denis Karpov 已提交
1334
	omap_hsmmc_config_dma_params(host, data, data->sg);
1335 1336 1337 1338

	return 0;
}

D
Denis Karpov 已提交
1339
static void set_data_timeout(struct omap_hsmmc_host *host,
1340 1341
			     unsigned int timeout_ns,
			     unsigned int timeout_clks)
1342 1343 1344 1345 1346 1347 1348 1349 1350 1351
{
	unsigned int timeout, cycle_ns;
	uint32_t reg, clkd, dto = 0;

	reg = OMAP_HSMMC_READ(host->base, SYSCTL);
	clkd = (reg & CLKD_MASK) >> CLKD_SHIFT;
	if (clkd == 0)
		clkd = 1;

	cycle_ns = 1000000000 / (clk_get_rate(host->fclk) / clkd);
1352 1353
	timeout = timeout_ns / cycle_ns;
	timeout += timeout_clks;
1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
	if (timeout) {
		while ((timeout & 0x80000000) == 0) {
			dto += 1;
			timeout <<= 1;
		}
		dto = 31 - dto;
		timeout <<= 1;
		if (timeout && dto)
			dto += 1;
		if (dto >= 13)
			dto -= 13;
		else
			dto = 0;
		if (dto > 14)
			dto = 14;
	}

	reg &= ~DTO_MASK;
	reg |= dto << DTO_SHIFT;
	OMAP_HSMMC_WRITE(host->base, SYSCTL, reg);
}

/*
 * Configure block length for MMC/SD cards and initiate the transfer.
 */
static int
D
Denis Karpov 已提交
1380
omap_hsmmc_prepare_data(struct omap_hsmmc_host *host, struct mmc_request *req)
1381 1382 1383 1384 1385 1386
{
	int ret;
	host->data = req->data;

	if (req->data == NULL) {
		OMAP_HSMMC_WRITE(host->base, BLK, 0);
1387 1388 1389 1390 1391 1392
		/*
		 * Set an arbitrary 100ms data timeout for commands with
		 * busy signal.
		 */
		if (req->cmd->flags & MMC_RSP_BUSY)
			set_data_timeout(host, 100000000U, 0);
1393 1394 1395 1396 1397
		return 0;
	}

	OMAP_HSMMC_WRITE(host->base, BLK, (req->data->blksz)
					| (req->data->blocks << 16));
1398
	set_data_timeout(host, req->data->timeout_ns, req->data->timeout_clks);
1399 1400

	if (host->use_dma) {
D
Denis Karpov 已提交
1401
		ret = omap_hsmmc_start_dma_transfer(host, req);
1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412
		if (ret != 0) {
			dev_dbg(mmc_dev(host->mmc), "MMC start dma failure\n");
			return ret;
		}
	}
	return 0;
}

/*
 * Request function. for read/write operation
 */
D
Denis Karpov 已提交
1413
static void omap_hsmmc_request(struct mmc_host *mmc, struct mmc_request *req)
1414
{
D
Denis Karpov 已提交
1415
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1416
	int err;
1417

1418 1419 1420 1421 1422
	/*
	 * Prevent races with the interrupt handler because of unexpected
	 * interrupts, but not if we are already in interrupt context i.e.
	 * retries.
	 */
1423
	if (!in_interrupt()) {
1424
		spin_lock_irqsave(&host->irq_lock, host->flags);
1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
		/*
		 * Protect the card from I/O if there is a possibility
		 * it can be removed.
		 */
		if (host->protect_card) {
			if (host->reqs_blocked < 3) {
				/*
				 * Ensure the controller is left in a consistent
				 * state by resetting the command and data state
				 * machines.
				 */
				omap_hsmmc_reset_controller_fsm(host, SRD);
				omap_hsmmc_reset_controller_fsm(host, SRC);
				host->reqs_blocked += 1;
			}
			req->cmd->error = -EBADF;
			if (req->data)
				req->data->error = -EBADF;
			spin_unlock_irqrestore(&host->irq_lock, host->flags);
			mmc_request_done(mmc, req);
			return;
		} else if (host->reqs_blocked)
			host->reqs_blocked = 0;
	}
1449 1450
	WARN_ON(host->mrq != NULL);
	host->mrq = req;
D
Denis Karpov 已提交
1451
	err = omap_hsmmc_prepare_data(host, req);
1452 1453 1454 1455 1456
	if (err) {
		req->cmd->error = err;
		if (req->data)
			req->data->error = err;
		host->mrq = NULL;
1457 1458
		if (!in_interrupt())
			spin_unlock_irqrestore(&host->irq_lock, host->flags);
1459 1460 1461 1462
		mmc_request_done(mmc, req);
		return;
	}

D
Denis Karpov 已提交
1463
	omap_hsmmc_start_command(host, req->cmd, req->data);
1464 1465 1466
}

/* Routine to configure clock values. Exposed API to core */
D
Denis Karpov 已提交
1467
static void omap_hsmmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
1468
{
D
Denis Karpov 已提交
1469
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1470 1471 1472
	u16 dsor = 0;
	unsigned long regval;
	unsigned long timeout;
1473
	u32 con;
1474
	int do_send_init_stream = 0;
1475

1476 1477
	mmc_host_enable(host->mmc);

1478 1479 1480 1481 1482
	if (ios->power_mode != host->power_mode) {
		switch (ios->power_mode) {
		case MMC_POWER_OFF:
			mmc_slot(host).set_power(host->dev, host->slot_id,
						 0, 0);
1483
			host->vdd = 0;
1484 1485 1486 1487
			break;
		case MMC_POWER_UP:
			mmc_slot(host).set_power(host->dev, host->slot_id,
						 1, ios->vdd);
1488
			host->vdd = ios->vdd;
1489 1490 1491 1492 1493 1494
			break;
		case MMC_POWER_ON:
			do_send_init_stream = 1;
			break;
		}
		host->power_mode = ios->power_mode;
1495 1496
	}

1497 1498
	/* FIXME: set registers based only on changes to ios */

1499
	con = OMAP_HSMMC_READ(host->base, CON);
1500
	switch (mmc->ios.bus_width) {
1501 1502 1503
	case MMC_BUS_WIDTH_8:
		OMAP_HSMMC_WRITE(host->base, CON, con | DW8);
		break;
1504
	case MMC_BUS_WIDTH_4:
1505
		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8);
1506 1507 1508 1509
		OMAP_HSMMC_WRITE(host->base, HCTL,
			OMAP_HSMMC_READ(host->base, HCTL) | FOUR_BIT);
		break;
	case MMC_BUS_WIDTH_1:
1510
		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8);
1511 1512 1513 1514 1515 1516
		OMAP_HSMMC_WRITE(host->base, HCTL,
			OMAP_HSMMC_READ(host->base, HCTL) & ~FOUR_BIT);
		break;
	}

	if (host->id == OMAP_MMC1_DEVID) {
1517 1518 1519
		/* Only MMC1 can interface at 3V without some flavor
		 * of external transceiver; but they all handle 1.8V.
		 */
1520 1521 1522 1523 1524 1525 1526 1527
		if ((OMAP_HSMMC_READ(host->base, HCTL) & SDVSDET) &&
			(ios->vdd == DUAL_VOLT_OCR_BIT)) {
				/*
				 * The mmc_select_voltage fn of the core does
				 * not seem to set the power_mode to
				 * MMC_POWER_UP upon recalculating the voltage.
				 * vdd 1.8v.
				 */
D
Denis Karpov 已提交
1528 1529
			if (omap_hsmmc_switch_opcond(host, ios->vdd) != 0)
				dev_dbg(mmc_dev(host->mmc),
1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544
						"Switch operation failed\n");
		}
	}

	if (ios->clock) {
		dsor = OMAP_MMC_MASTER_CLOCK / ios->clock;
		if (dsor < 1)
			dsor = 1;

		if (OMAP_MMC_MASTER_CLOCK / dsor > ios->clock)
			dsor++;

		if (dsor > 250)
			dsor = 250;
	}
D
Denis Karpov 已提交
1545
	omap_hsmmc_stop_clock(host);
1546 1547 1548 1549 1550 1551 1552 1553 1554
	regval = OMAP_HSMMC_READ(host->base, SYSCTL);
	regval = regval & ~(CLKD_MASK);
	regval = regval | (dsor << 6) | (DTO << 16);
	OMAP_HSMMC_WRITE(host->base, SYSCTL, regval);
	OMAP_HSMMC_WRITE(host->base, SYSCTL,
		OMAP_HSMMC_READ(host->base, SYSCTL) | ICE);

	/* Wait till the ICS bit is set */
	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS);
1555
	while ((OMAP_HSMMC_READ(host->base, SYSCTL) & ICS) != ICS
1556 1557 1558 1559 1560 1561
		&& time_before(jiffies, timeout))
		msleep(1);

	OMAP_HSMMC_WRITE(host->base, SYSCTL,
		OMAP_HSMMC_READ(host->base, SYSCTL) | CEN);

1562
	if (do_send_init_stream)
1563 1564
		send_init_stream(host);

1565
	con = OMAP_HSMMC_READ(host->base, CON);
1566
	if (ios->bus_mode == MMC_BUSMODE_OPENDRAIN)
1567 1568 1569
		OMAP_HSMMC_WRITE(host->base, CON, con | OD);
	else
		OMAP_HSMMC_WRITE(host->base, CON, con & ~OD);
1570

1571 1572 1573 1574
	if (host->power_mode == MMC_POWER_OFF)
		mmc_host_disable(host->mmc);
	else
		mmc_host_lazy_disable(host->mmc);
1575 1576 1577 1578
}

static int omap_hsmmc_get_cd(struct mmc_host *mmc)
{
D
Denis Karpov 已提交
1579
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1580

D
Denis Karpov 已提交
1581
	if (!mmc_slot(host).card_detect)
1582
		return -ENOSYS;
1583
	return mmc_slot(host).card_detect(host->dev, host->slot_id);
1584 1585 1586 1587
}

static int omap_hsmmc_get_ro(struct mmc_host *mmc)
{
D
Denis Karpov 已提交
1588
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1589

D
Denis Karpov 已提交
1590
	if (!mmc_slot(host).get_ro)
1591
		return -ENOSYS;
D
Denis Karpov 已提交
1592
	return mmc_slot(host).get_ro(host->dev, 0);
1593 1594
}

D
Denis Karpov 已提交
1595
static void omap_hsmmc_conf_bus_power(struct omap_hsmmc_host *host)
1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618
{
	u32 hctl, capa, value;

	/* Only MMC1 supports 3.0V */
	if (host->id == OMAP_MMC1_DEVID) {
		hctl = SDVS30;
		capa = VS30 | VS18;
	} else {
		hctl = SDVS18;
		capa = VS18;
	}

	value = OMAP_HSMMC_READ(host->base, HCTL) & ~SDVS_MASK;
	OMAP_HSMMC_WRITE(host->base, HCTL, value | hctl);

	value = OMAP_HSMMC_READ(host->base, CAPA);
	OMAP_HSMMC_WRITE(host->base, CAPA, value | capa);

	/* Set the controller to AUTO IDLE mode */
	value = OMAP_HSMMC_READ(host->base, SYSCONFIG);
	OMAP_HSMMC_WRITE(host->base, SYSCONFIG, value | AUTOIDLE);

	/* Set SD bus power bit */
A
Adrian Hunter 已提交
1619
	set_sd_bus_power(host);
1620 1621
}

1622 1623
/*
 * Dynamic power saving handling, FSM:
1624 1625 1626
 *   ENABLED -> DISABLED -> CARDSLEEP / REGSLEEP -> OFF
 *     ^___________|          |                      |
 *     |______________________|______________________|
1627 1628 1629
 *
 * ENABLED:   mmc host is fully functional
 * DISABLED:  fclk is off
1630 1631 1632
 * CARDSLEEP: fclk is off, card is asleep, voltage regulator is asleep
 * REGSLEEP:  fclk is off, voltage regulator is asleep
 * OFF:       fclk is off, voltage regulator is off
1633 1634 1635 1636 1637
 *
 * Transition handlers return the timeout for the next state transition
 * or negative error.
 */

1638
enum {ENABLED = 0, DISABLED, CARDSLEEP, REGSLEEP, OFF};
1639 1640

/* Handler for [ENABLED -> DISABLED] transition */
D
Denis Karpov 已提交
1641
static int omap_hsmmc_enabled_to_disabled(struct omap_hsmmc_host *host)
1642
{
D
Denis Karpov 已提交
1643
	omap_hsmmc_context_save(host);
1644 1645 1646 1647 1648 1649 1650 1651
	clk_disable(host->fclk);
	host->dpm_state = DISABLED;

	dev_dbg(mmc_dev(host->mmc), "ENABLED -> DISABLED\n");

	if (host->power_mode == MMC_POWER_OFF)
		return 0;

A
Adrian Hunter 已提交
1652
	return OMAP_MMC_SLEEP_TIMEOUT;
1653 1654
}

1655
/* Handler for [DISABLED -> REGSLEEP / CARDSLEEP] transition */
D
Denis Karpov 已提交
1656
static int omap_hsmmc_disabled_to_sleep(struct omap_hsmmc_host *host)
1657
{
1658
	int err, new_state;
1659 1660 1661 1662 1663

	if (!mmc_try_claim_host(host->mmc))
		return 0;

	clk_enable(host->fclk);
D
Denis Karpov 已提交
1664
	omap_hsmmc_context_restore(host);
1665 1666 1667 1668 1669 1670 1671 1672
	if (mmc_card_can_sleep(host->mmc)) {
		err = mmc_card_sleep(host->mmc);
		if (err < 0) {
			clk_disable(host->fclk);
			mmc_release_host(host->mmc);
			return err;
		}
		new_state = CARDSLEEP;
D
Denis Karpov 已提交
1673
	} else {
1674
		new_state = REGSLEEP;
D
Denis Karpov 已提交
1675
	}
1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686
	if (mmc_slot(host).set_sleep)
		mmc_slot(host).set_sleep(host->dev, host->slot_id, 1, 0,
					 new_state == CARDSLEEP);
	/* FIXME: turn off bus power and perhaps interrupts too */
	clk_disable(host->fclk);
	host->dpm_state = new_state;

	mmc_release_host(host->mmc);

	dev_dbg(mmc_dev(host->mmc), "DISABLED -> %s\n",
		host->dpm_state == CARDSLEEP ? "CARDSLEEP" : "REGSLEEP");
1687

1688 1689 1690
	if (mmc_slot(host).no_off)
		return 0;

1691 1692 1693
	if ((host->mmc->caps & MMC_CAP_NONREMOVABLE) ||
	    mmc_slot(host).card_detect ||
	    (mmc_slot(host).get_cover_state &&
1694
	     mmc_slot(host).get_cover_state(host->dev, host->slot_id)))
A
Adrian Hunter 已提交
1695
		return OMAP_MMC_OFF_TIMEOUT;
1696 1697 1698 1699 1700

	return 0;
}

/* Handler for [REGSLEEP / CARDSLEEP -> OFF] transition */
D
Denis Karpov 已提交
1701
static int omap_hsmmc_sleep_to_off(struct omap_hsmmc_host *host)
1702 1703 1704 1705
{
	if (!mmc_try_claim_host(host->mmc))
		return 0;

1706 1707 1708
	if (mmc_slot(host).no_off)
		return 0;

1709 1710 1711 1712 1713 1714
	if (!((host->mmc->caps & MMC_CAP_NONREMOVABLE) ||
	      mmc_slot(host).card_detect ||
	      (mmc_slot(host).get_cover_state &&
	       mmc_slot(host).get_cover_state(host->dev, host->slot_id)))) {
		mmc_release_host(host->mmc);
		return 0;
1715
	}
1716

1717 1718 1719
	mmc_slot(host).set_power(host->dev, host->slot_id, 0, 0);
	host->vdd = 0;
	host->power_mode = MMC_POWER_OFF;
1720

1721 1722
	dev_dbg(mmc_dev(host->mmc), "%s -> OFF\n",
		host->dpm_state == CARDSLEEP ? "CARDSLEEP" : "REGSLEEP");
1723

1724
	host->dpm_state = OFF;
1725 1726 1727 1728 1729 1730 1731

	mmc_release_host(host->mmc);

	return 0;
}

/* Handler for [DISABLED -> ENABLED] transition */
D
Denis Karpov 已提交
1732
static int omap_hsmmc_disabled_to_enabled(struct omap_hsmmc_host *host)
1733 1734 1735 1736 1737 1738 1739
{
	int err;

	err = clk_enable(host->fclk);
	if (err < 0)
		return err;

D
Denis Karpov 已提交
1740
	omap_hsmmc_context_restore(host);
1741 1742 1743 1744 1745 1746 1747
	host->dpm_state = ENABLED;

	dev_dbg(mmc_dev(host->mmc), "DISABLED -> ENABLED\n");

	return 0;
}

1748
/* Handler for [SLEEP -> ENABLED] transition */
D
Denis Karpov 已提交
1749
static int omap_hsmmc_sleep_to_enabled(struct omap_hsmmc_host *host)
1750
{
1751 1752
	if (!mmc_try_claim_host(host->mmc))
		return 0;
1753

1754
	clk_enable(host->fclk);
D
Denis Karpov 已提交
1755
	omap_hsmmc_context_restore(host);
1756 1757 1758 1759 1760 1761 1762 1763
	if (mmc_slot(host).set_sleep)
		mmc_slot(host).set_sleep(host->dev, host->slot_id, 0,
			 host->vdd, host->dpm_state == CARDSLEEP);
	if (mmc_card_can_sleep(host->mmc))
		mmc_card_awake(host->mmc);

	dev_dbg(mmc_dev(host->mmc), "%s -> ENABLED\n",
		host->dpm_state == CARDSLEEP ? "CARDSLEEP" : "REGSLEEP");
1764 1765 1766

	host->dpm_state = ENABLED;

1767
	mmc_release_host(host->mmc);
1768 1769 1770 1771

	return 0;
}

1772
/* Handler for [OFF -> ENABLED] transition */
D
Denis Karpov 已提交
1773
static int omap_hsmmc_off_to_enabled(struct omap_hsmmc_host *host)
1774 1775 1776
{
	clk_enable(host->fclk);

D
Denis Karpov 已提交
1777 1778
	omap_hsmmc_context_restore(host);
	omap_hsmmc_conf_bus_power(host);
1779
	mmc_power_restore_host(host->mmc);
1780 1781 1782

	host->dpm_state = ENABLED;

1783 1784
	dev_dbg(mmc_dev(host->mmc), "OFF -> ENABLED\n");

1785 1786 1787
	return 0;
}

1788 1789 1790
/*
 * Bring MMC host to ENABLED from any other PM state.
 */
D
Denis Karpov 已提交
1791
static int omap_hsmmc_enable(struct mmc_host *mmc)
1792
{
D
Denis Karpov 已提交
1793
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1794 1795 1796

	switch (host->dpm_state) {
	case DISABLED:
D
Denis Karpov 已提交
1797
		return omap_hsmmc_disabled_to_enabled(host);
1798
	case CARDSLEEP:
1799
	case REGSLEEP:
D
Denis Karpov 已提交
1800
		return omap_hsmmc_sleep_to_enabled(host);
1801
	case OFF:
D
Denis Karpov 已提交
1802
		return omap_hsmmc_off_to_enabled(host);
1803 1804 1805 1806 1807 1808 1809 1810 1811
	default:
		dev_dbg(mmc_dev(host->mmc), "UNKNOWN state\n");
		return -EINVAL;
	}
}

/*
 * Bring MMC host in PM state (one level deeper).
 */
D
Denis Karpov 已提交
1812
static int omap_hsmmc_disable(struct mmc_host *mmc, int lazy)
1813
{
D
Denis Karpov 已提交
1814
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1815 1816 1817 1818 1819

	switch (host->dpm_state) {
	case ENABLED: {
		int delay;

D
Denis Karpov 已提交
1820
		delay = omap_hsmmc_enabled_to_disabled(host);
1821 1822 1823 1824 1825
		if (lazy || delay < 0)
			return delay;
		return 0;
	}
	case DISABLED:
D
Denis Karpov 已提交
1826
		return omap_hsmmc_disabled_to_sleep(host);
1827 1828
	case CARDSLEEP:
	case REGSLEEP:
D
Denis Karpov 已提交
1829
		return omap_hsmmc_sleep_to_off(host);
1830 1831 1832 1833 1834 1835
	default:
		dev_dbg(mmc_dev(host->mmc), "UNKNOWN state\n");
		return -EINVAL;
	}
}

D
Denis Karpov 已提交
1836
static int omap_hsmmc_enable_fclk(struct mmc_host *mmc)
1837
{
D
Denis Karpov 已提交
1838
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1839 1840 1841 1842 1843 1844
	int err;

	err = clk_enable(host->fclk);
	if (err)
		return err;
	dev_dbg(mmc_dev(host->mmc), "mmc_fclk: enabled\n");
D
Denis Karpov 已提交
1845
	omap_hsmmc_context_restore(host);
1846 1847 1848
	return 0;
}

D
Denis Karpov 已提交
1849
static int omap_hsmmc_disable_fclk(struct mmc_host *mmc, int lazy)
1850
{
D
Denis Karpov 已提交
1851
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1852

D
Denis Karpov 已提交
1853
	omap_hsmmc_context_save(host);
1854 1855 1856 1857 1858
	clk_disable(host->fclk);
	dev_dbg(mmc_dev(host->mmc), "mmc_fclk: disabled\n");
	return 0;
}

D
Denis Karpov 已提交
1859 1860 1861 1862 1863
static const struct mmc_host_ops omap_hsmmc_ops = {
	.enable = omap_hsmmc_enable_fclk,
	.disable = omap_hsmmc_disable_fclk,
	.request = omap_hsmmc_request,
	.set_ios = omap_hsmmc_set_ios,
1864 1865 1866 1867 1868
	.get_cd = omap_hsmmc_get_cd,
	.get_ro = omap_hsmmc_get_ro,
	/* NYET -- enable_sdio_irq */
};

D
Denis Karpov 已提交
1869 1870 1871 1872 1873
static const struct mmc_host_ops omap_hsmmc_ps_ops = {
	.enable = omap_hsmmc_enable,
	.disable = omap_hsmmc_disable,
	.request = omap_hsmmc_request,
	.set_ios = omap_hsmmc_set_ios,
1874 1875 1876 1877 1878
	.get_cd = omap_hsmmc_get_cd,
	.get_ro = omap_hsmmc_get_ro,
	/* NYET -- enable_sdio_irq */
};

1879 1880
#ifdef CONFIG_DEBUG_FS

D
Denis Karpov 已提交
1881
static int omap_hsmmc_regs_show(struct seq_file *s, void *data)
1882 1883
{
	struct mmc_host *mmc = s->private;
D
Denis Karpov 已提交
1884
	struct omap_hsmmc_host *host = mmc_priv(mmc);
1885 1886
	int context_loss = 0;

D
Denis Karpov 已提交
1887 1888
	if (host->pdata->get_context_loss_count)
		context_loss = host->pdata->get_context_loss_count(host->dev);
1889

1890 1891
	seq_printf(s, "mmc%d:\n"
			" enabled:\t%d\n"
1892
			" dpm_state:\t%d\n"
1893
			" nesting_cnt:\t%d\n"
1894
			" ctx_loss:\t%d:%d\n"
1895
			"\nregs:\n",
1896 1897
			mmc->index, mmc->enabled ? 1 : 0,
			host->dpm_state, mmc->nesting_cnt,
1898
			host->context_loss, context_loss);
1899

1900
	if (host->suspended || host->dpm_state == OFF) {
1901 1902 1903 1904
		seq_printf(s, "host suspended, can't read registers\n");
		return 0;
	}

1905 1906
	if (clk_enable(host->fclk) != 0) {
		seq_printf(s, "can't read the regs\n");
1907
		return 0;
1908
	}
1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923

	seq_printf(s, "SYSCONFIG:\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, SYSCONFIG));
	seq_printf(s, "CON:\t\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, CON));
	seq_printf(s, "HCTL:\t\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, HCTL));
	seq_printf(s, "SYSCTL:\t\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, SYSCTL));
	seq_printf(s, "IE:\t\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, IE));
	seq_printf(s, "ISE:\t\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, ISE));
	seq_printf(s, "CAPA:\t\t0x%08x\n",
			OMAP_HSMMC_READ(host->base, CAPA));
1924 1925

	clk_disable(host->fclk);
1926

1927 1928 1929
	return 0;
}

D
Denis Karpov 已提交
1930
static int omap_hsmmc_regs_open(struct inode *inode, struct file *file)
1931
{
D
Denis Karpov 已提交
1932
	return single_open(file, omap_hsmmc_regs_show, inode->i_private);
1933 1934 1935
}

static const struct file_operations mmc_regs_fops = {
D
Denis Karpov 已提交
1936
	.open           = omap_hsmmc_regs_open,
1937 1938 1939 1940 1941
	.read           = seq_read,
	.llseek         = seq_lseek,
	.release        = single_release,
};

D
Denis Karpov 已提交
1942
static void omap_hsmmc_debugfs(struct mmc_host *mmc)
1943 1944 1945 1946 1947 1948 1949 1950
{
	if (mmc->debugfs_root)
		debugfs_create_file("regs", S_IRUSR, mmc->debugfs_root,
			mmc, &mmc_regs_fops);
}

#else

D
Denis Karpov 已提交
1951
static void omap_hsmmc_debugfs(struct mmc_host *mmc)
1952 1953 1954 1955 1956
{
}

#endif

D
Denis Karpov 已提交
1957
static int __init omap_hsmmc_probe(struct platform_device *pdev)
1958 1959 1960
{
	struct omap_mmc_platform_data *pdata = pdev->dev.platform_data;
	struct mmc_host *mmc;
D
Denis Karpov 已提交
1961
	struct omap_hsmmc_host *host = NULL;
1962
	struct resource *res;
1963
	int ret, irq;
1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984

	if (pdata == NULL) {
		dev_err(&pdev->dev, "Platform Data is missing\n");
		return -ENXIO;
	}

	if (pdata->nr_slots == 0) {
		dev_err(&pdev->dev, "No Slots\n");
		return -ENXIO;
	}

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	irq = platform_get_irq(pdev, 0);
	if (res == NULL || irq < 0)
		return -ENXIO;

	res = request_mem_region(res->start, res->end - res->start + 1,
							pdev->name);
	if (res == NULL)
		return -EBUSY;

1985 1986 1987 1988
	ret = omap_hsmmc_gpio_init(pdata);
	if (ret)
		goto err;

D
Denis Karpov 已提交
1989
	mmc = mmc_alloc_host(sizeof(struct omap_hsmmc_host), &pdev->dev);
1990 1991
	if (!mmc) {
		ret = -ENOMEM;
1992
		goto err_alloc;
1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006
	}

	host		= mmc_priv(mmc);
	host->mmc	= mmc;
	host->pdata	= pdata;
	host->dev	= &pdev->dev;
	host->use_dma	= 1;
	host->dev->dma_mask = &pdata->dma_mask;
	host->dma_ch	= -1;
	host->irq	= irq;
	host->id	= pdev->id;
	host->slot_id	= 0;
	host->mapbase	= res->start;
	host->base	= ioremap(host->mapbase, SZ_4K);
2007
	host->power_mode = MMC_POWER_OFF;
2008 2009

	platform_set_drvdata(pdev, host);
D
Denis Karpov 已提交
2010
	INIT_WORK(&host->mmc_carddetect_work, omap_hsmmc_detect);
2011

D
Denis Karpov 已提交
2012
	if (mmc_slot(host).power_saving)
D
Denis Karpov 已提交
2013
		mmc->ops	= &omap_hsmmc_ps_ops;
2014
	else
D
Denis Karpov 已提交
2015
		mmc->ops	= &omap_hsmmc_ops;
2016

2017 2018 2019 2020 2021 2022 2023
	/*
	 * If regulator_disable can only put vcc_aux to sleep then there is
	 * no off state.
	 */
	if (mmc_slot(host).vcc_aux_disable_is_sleep)
		mmc_slot(host).no_off = 1;

2024 2025 2026 2027
	mmc->f_min	= 400000;
	mmc->f_max	= 52000000;

	sema_init(&host->sem, 1);
2028
	spin_lock_init(&host->irq_lock);
2029

2030
	host->iclk = clk_get(&pdev->dev, "ick");
2031 2032 2033 2034 2035
	if (IS_ERR(host->iclk)) {
		ret = PTR_ERR(host->iclk);
		host->iclk = NULL;
		goto err1;
	}
2036
	host->fclk = clk_get(&pdev->dev, "fck");
2037 2038 2039 2040 2041 2042 2043
	if (IS_ERR(host->fclk)) {
		ret = PTR_ERR(host->fclk);
		host->fclk = NULL;
		clk_put(host->iclk);
		goto err1;
	}

D
Denis Karpov 已提交
2044
	omap_hsmmc_context_save(host);
2045

2046
	mmc->caps |= MMC_CAP_DISABLE;
2047 2048 2049 2050
	mmc_set_disable_delay(mmc, OMAP_MMC_DISABLED_TIMEOUT);
	/* we start off in DISABLED state */
	host->dpm_state = DISABLED;

2051
	if (mmc_host_enable(host->mmc) != 0) {
2052 2053 2054 2055 2056 2057
		clk_put(host->iclk);
		clk_put(host->fclk);
		goto err1;
	}

	if (clk_enable(host->iclk) != 0) {
2058
		mmc_host_disable(host->mmc);
2059 2060 2061 2062 2063
		clk_put(host->iclk);
		clk_put(host->fclk);
		goto err1;
	}

2064 2065 2066 2067 2068 2069 2070 2071
	if (cpu_is_omap2430()) {
		host->dbclk = clk_get(&pdev->dev, "mmchsdb_fck");
		/*
		 * MMC can still work without debounce clock.
		 */
		if (IS_ERR(host->dbclk))
			dev_warn(mmc_dev(host->mmc),
				"Failed to get debounce clock\n");
2072
		else
2073 2074 2075 2076 2077 2078 2079
			host->got_dbclk = 1;

		if (host->got_dbclk)
			if (clk_enable(host->dbclk) != 0)
				dev_dbg(mmc_dev(host->mmc), "Enabling debounce"
							" clk failed\n");
	}
2080

2081 2082 2083 2084 2085
	/* Since we do only SG emulation, we can have as many segs
	 * as we want. */
	mmc->max_phys_segs = 1024;
	mmc->max_hw_segs = 1024;

2086 2087 2088 2089 2090
	mmc->max_blk_size = 512;       /* Block Length at max can be 1024 */
	mmc->max_blk_count = 0xFFFF;    /* No. of Blocks is 16 bits */
	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
	mmc->max_seg_size = mmc->max_req_size;

2091 2092
	mmc->caps |= MMC_CAP_MMC_HIGHSPEED | MMC_CAP_SD_HIGHSPEED |
		     MMC_CAP_WAIT_WHILE_BUSY;
2093

D
Denis Karpov 已提交
2094
	if (mmc_slot(host).wires >= 8)
2095
		mmc->caps |= MMC_CAP_8_BIT_DATA;
D
Denis Karpov 已提交
2096
	else if (mmc_slot(host).wires >= 4)
2097 2098
		mmc->caps |= MMC_CAP_4_BIT_DATA;

D
Denis Karpov 已提交
2099
	if (mmc_slot(host).nonremovable)
2100 2101
		mmc->caps |= MMC_CAP_NONREMOVABLE;

D
Denis Karpov 已提交
2102
	omap_hsmmc_conf_bus_power(host);
2103

G
Grazvydas Ignotas 已提交
2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117
	/* Select DMA lines */
	switch (host->id) {
	case OMAP_MMC1_DEVID:
		host->dma_line_tx = OMAP24XX_DMA_MMC1_TX;
		host->dma_line_rx = OMAP24XX_DMA_MMC1_RX;
		break;
	case OMAP_MMC2_DEVID:
		host->dma_line_tx = OMAP24XX_DMA_MMC2_TX;
		host->dma_line_rx = OMAP24XX_DMA_MMC2_RX;
		break;
	case OMAP_MMC3_DEVID:
		host->dma_line_tx = OMAP34XX_DMA_MMC3_TX;
		host->dma_line_rx = OMAP34XX_DMA_MMC3_RX;
		break;
2118 2119 2120 2121 2122 2123 2124 2125
	case OMAP_MMC4_DEVID:
		host->dma_line_tx = OMAP44XX_DMA_MMC4_TX;
		host->dma_line_rx = OMAP44XX_DMA_MMC4_RX;
		break;
	case OMAP_MMC5_DEVID:
		host->dma_line_tx = OMAP44XX_DMA_MMC5_TX;
		host->dma_line_rx = OMAP44XX_DMA_MMC5_RX;
		break;
G
Grazvydas Ignotas 已提交
2126 2127 2128 2129
	default:
		dev_err(mmc_dev(host->mmc), "Invalid MMC id\n");
		goto err_irq;
	}
2130 2131

	/* Request IRQ for MMC operations */
D
Denis Karpov 已提交
2132
	ret = request_irq(host->irq, omap_hsmmc_irq, IRQF_DISABLED,
2133 2134 2135 2136 2137 2138 2139 2140
			mmc_hostname(mmc), host);
	if (ret) {
		dev_dbg(mmc_dev(host->mmc), "Unable to grab HSMMC IRQ\n");
		goto err_irq;
	}

	if (pdata->init != NULL) {
		if (pdata->init(&pdev->dev) != 0) {
D
Denis Karpov 已提交
2141 2142
			dev_dbg(mmc_dev(host->mmc),
				"Unable to configure MMC IRQs\n");
2143 2144 2145
			goto err_irq_cd_init;
		}
	}
2146

2147
	if (omap_hsmmc_have_reg() && !mmc_slot(host).set_power) {
2148 2149 2150 2151 2152 2153
		ret = omap_hsmmc_reg_get(host);
		if (ret)
			goto err_reg;
		host->use_reg = 1;
	}

2154
	mmc->ocr_avail = mmc_slot(host).ocr_mask;
2155 2156

	/* Request IRQ for card detect */
2157
	if ((mmc_slot(host).card_detect_irq)) {
2158
		ret = request_irq(mmc_slot(host).card_detect_irq,
D
Denis Karpov 已提交
2159
				  omap_hsmmc_cd_handler,
2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172
				  IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING
					  | IRQF_DISABLED,
				  mmc_hostname(mmc), host);
		if (ret) {
			dev_dbg(mmc_dev(host->mmc),
				"Unable to grab MMC CD IRQ\n");
			goto err_irq_cd;
		}
	}

	OMAP_HSMMC_WRITE(host->base, ISE, INT_EN_MASK);
	OMAP_HSMMC_WRITE(host->base, IE, INT_EN_MASK);

2173 2174
	mmc_host_lazy_disable(host->mmc);

2175 2176
	omap_hsmmc_protect_card(host);

2177 2178
	mmc_add_host(mmc);

D
Denis Karpov 已提交
2179
	if (mmc_slot(host).name != NULL) {
2180 2181 2182 2183
		ret = device_create_file(&mmc->class_dev, &dev_attr_slot_name);
		if (ret < 0)
			goto err_slot_name;
	}
D
Denis Karpov 已提交
2184
	if (mmc_slot(host).card_detect_irq && mmc_slot(host).get_cover_state) {
2185 2186 2187
		ret = device_create_file(&mmc->class_dev,
					&dev_attr_cover_switch);
		if (ret < 0)
2188
			goto err_slot_name;
2189 2190
	}

D
Denis Karpov 已提交
2191
	omap_hsmmc_debugfs(mmc);
2192

2193 2194 2195 2196 2197
	return 0;

err_slot_name:
	mmc_remove_host(mmc);
	free_irq(mmc_slot(host).card_detect_irq, host);
2198 2199 2200 2201 2202 2203
err_irq_cd:
	if (host->use_reg)
		omap_hsmmc_reg_put(host);
err_reg:
	if (host->pdata->cleanup)
		host->pdata->cleanup(&pdev->dev);
2204 2205 2206
err_irq_cd_init:
	free_irq(host->irq, host);
err_irq:
2207
	mmc_host_disable(host->mmc);
2208 2209 2210
	clk_disable(host->iclk);
	clk_put(host->fclk);
	clk_put(host->iclk);
2211
	if (host->got_dbclk) {
2212 2213 2214 2215 2216
		clk_disable(host->dbclk);
		clk_put(host->dbclk);
	}
err1:
	iounmap(host->base);
2217 2218 2219 2220
	platform_set_drvdata(pdev, NULL);
	mmc_free_host(mmc);
err_alloc:
	omap_hsmmc_gpio_free(pdata);
2221 2222 2223 2224 2225
err:
	release_mem_region(res->start, res->end - res->start + 1);
	return ret;
}

D
Denis Karpov 已提交
2226
static int omap_hsmmc_remove(struct platform_device *pdev)
2227
{
D
Denis Karpov 已提交
2228
	struct omap_hsmmc_host *host = platform_get_drvdata(pdev);
2229 2230 2231
	struct resource *res;

	if (host) {
2232
		mmc_host_enable(host->mmc);
2233
		mmc_remove_host(host->mmc);
2234 2235
		if (host->use_reg)
			omap_hsmmc_reg_put(host);
2236 2237 2238 2239 2240 2241 2242
		if (host->pdata->cleanup)
			host->pdata->cleanup(&pdev->dev);
		free_irq(host->irq, host);
		if (mmc_slot(host).card_detect_irq)
			free_irq(mmc_slot(host).card_detect_irq, host);
		flush_scheduled_work();

2243
		mmc_host_disable(host->mmc);
2244 2245 2246
		clk_disable(host->iclk);
		clk_put(host->fclk);
		clk_put(host->iclk);
2247
		if (host->got_dbclk) {
2248 2249 2250 2251 2252 2253
			clk_disable(host->dbclk);
			clk_put(host->dbclk);
		}

		mmc_free_host(host->mmc);
		iounmap(host->base);
2254
		omap_hsmmc_gpio_free(pdev->dev.platform_data);
2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265
	}

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (res)
		release_mem_region(res->start, res->end - res->start + 1);
	platform_set_drvdata(pdev, NULL);

	return 0;
}

#ifdef CONFIG_PM
D
Denis Karpov 已提交
2266
static int omap_hsmmc_suspend(struct platform_device *pdev, pm_message_t state)
2267 2268
{
	int ret = 0;
D
Denis Karpov 已提交
2269
	struct omap_hsmmc_host *host = platform_get_drvdata(pdev);
2270 2271 2272 2273 2274

	if (host && host->suspended)
		return 0;

	if (host) {
2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287
		host->suspended = 1;
		if (host->pdata->suspend) {
			ret = host->pdata->suspend(&pdev->dev,
							host->slot_id);
			if (ret) {
				dev_dbg(mmc_dev(host->mmc),
					"Unable to handle MMC board"
					" level suspend\n");
				host->suspended = 0;
				return ret;
			}
		}
		cancel_work_sync(&host->mmc_carddetect_work);
2288
		mmc_host_enable(host->mmc);
2289 2290 2291 2292 2293 2294
		ret = mmc_suspend_host(host->mmc, state);
		if (ret == 0) {
			OMAP_HSMMC_WRITE(host->base, ISE, 0);
			OMAP_HSMMC_WRITE(host->base, IE, 0);


2295
			OMAP_HSMMC_WRITE(host->base, HCTL,
D
Denis Karpov 已提交
2296
				OMAP_HSMMC_READ(host->base, HCTL) & ~SDBP);
2297
			mmc_host_disable(host->mmc);
2298
			clk_disable(host->iclk);
2299 2300
			if (host->got_dbclk)
				clk_disable(host->dbclk);
2301 2302 2303 2304 2305 2306 2307 2308 2309
		} else {
			host->suspended = 0;
			if (host->pdata->resume) {
				ret = host->pdata->resume(&pdev->dev,
							  host->slot_id);
				if (ret)
					dev_dbg(mmc_dev(host->mmc),
						"Unmask interrupt failed\n");
			}
2310
			mmc_host_disable(host->mmc);
2311
		}
2312 2313 2314 2315 2316 2317

	}
	return ret;
}

/* Routine to resume the MMC device */
D
Denis Karpov 已提交
2318
static int omap_hsmmc_resume(struct platform_device *pdev)
2319 2320
{
	int ret = 0;
D
Denis Karpov 已提交
2321
	struct omap_hsmmc_host *host = platform_get_drvdata(pdev);
2322 2323 2324 2325 2326 2327

	if (host && !host->suspended)
		return 0;

	if (host) {
		ret = clk_enable(host->iclk);
2328
		if (ret)
2329 2330
			goto clk_en_err;

2331 2332 2333 2334 2335
		if (mmc_host_enable(host->mmc) != 0) {
			clk_disable(host->iclk);
			goto clk_en_err;
		}

2336 2337 2338
		if (host->got_dbclk)
			clk_enable(host->dbclk);

D
Denis Karpov 已提交
2339
		omap_hsmmc_conf_bus_power(host);
2340

2341 2342 2343 2344 2345 2346 2347
		if (host->pdata->resume) {
			ret = host->pdata->resume(&pdev->dev, host->slot_id);
			if (ret)
				dev_dbg(mmc_dev(host->mmc),
					"Unmask interrupt failed\n");
		}

2348 2349
		omap_hsmmc_protect_card(host);

2350 2351 2352 2353
		/* Notify the core to resume the host */
		ret = mmc_resume_host(host->mmc);
		if (ret == 0)
			host->suspended = 0;
D
Denis Karpov 已提交
2354

2355
		mmc_host_lazy_disable(host->mmc);
2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366
	}

	return ret;

clk_en_err:
	dev_dbg(mmc_dev(host->mmc),
		"Failed to enable MMC clocks during resume\n");
	return ret;
}

#else
D
Denis Karpov 已提交
2367 2368
#define omap_hsmmc_suspend	NULL
#define omap_hsmmc_resume		NULL
2369 2370
#endif

D
Denis Karpov 已提交
2371 2372 2373 2374
static struct platform_driver omap_hsmmc_driver = {
	.remove		= omap_hsmmc_remove,
	.suspend	= omap_hsmmc_suspend,
	.resume		= omap_hsmmc_resume,
2375 2376 2377 2378 2379 2380
	.driver		= {
		.name = DRIVER_NAME,
		.owner = THIS_MODULE,
	},
};

D
Denis Karpov 已提交
2381
static int __init omap_hsmmc_init(void)
2382 2383
{
	/* Register the MMC driver */
2384
	return platform_driver_probe(&omap_hsmmc_driver, omap_hsmmc_probe);
2385 2386
}

D
Denis Karpov 已提交
2387
static void __exit omap_hsmmc_cleanup(void)
2388 2389
{
	/* Unregister MMC driver */
D
Denis Karpov 已提交
2390
	platform_driver_unregister(&omap_hsmmc_driver);
2391 2392
}

D
Denis Karpov 已提交
2393 2394
module_init(omap_hsmmc_init);
module_exit(omap_hsmmc_cleanup);
2395 2396 2397 2398 2399

MODULE_DESCRIPTION("OMAP High Speed Multimedia Card driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:" DRIVER_NAME);
MODULE_AUTHOR("Texas Instruments Inc");