Linux Audio

Check our new training course

Loading...
v4.6
   1/*
   2 *  linux/drivers/mmc/sdio.c
   3 *
   4 *  Copyright 2006-2007 Pierre Ossman
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License as published by
   8 * the Free Software Foundation; either version 2 of the License, or (at
   9 * your option) any later version.
  10 */
  11
  12#include <linux/err.h>
  13#include <linux/pm_runtime.h>
  14
  15#include <linux/mmc/host.h>
  16#include <linux/mmc/card.h>
  17#include <linux/mmc/mmc.h>
  18#include <linux/mmc/sdio.h>
  19#include <linux/mmc/sdio_func.h>
  20#include <linux/mmc/sdio_ids.h>
  21
  22#include "core.h"
  23#include "bus.h"
  24#include "sd.h"
  25#include "sdio_bus.h"
  26#include "mmc_ops.h"
  27#include "sd_ops.h"
  28#include "sdio_ops.h"
  29#include "sdio_cis.h"
  30
  31static int sdio_read_fbr(struct sdio_func *func)
  32{
  33	int ret;
  34	unsigned char data;
  35
  36	if (mmc_card_nonstd_func_interface(func->card)) {
  37		func->class = SDIO_CLASS_NONE;
  38		return 0;
  39	}
  40
  41	ret = mmc_io_rw_direct(func->card, 0, 0,
  42		SDIO_FBR_BASE(func->num) + SDIO_FBR_STD_IF, 0, &data);
  43	if (ret)
  44		goto out;
  45
  46	data &= 0x0f;
  47
  48	if (data == 0x0f) {
  49		ret = mmc_io_rw_direct(func->card, 0, 0,
  50			SDIO_FBR_BASE(func->num) + SDIO_FBR_STD_IF_EXT, 0, &data);
  51		if (ret)
  52			goto out;
  53	}
  54
  55	func->class = data;
  56
  57out:
  58	return ret;
  59}
  60
  61static int sdio_init_func(struct mmc_card *card, unsigned int fn)
  62{
  63	int ret;
  64	struct sdio_func *func;
  65
  66	BUG_ON(fn > SDIO_MAX_FUNCS);
  67
  68	func = sdio_alloc_func(card);
  69	if (IS_ERR(func))
  70		return PTR_ERR(func);
  71
  72	func->num = fn;
  73
  74	if (!(card->quirks & MMC_QUIRK_NONSTD_SDIO)) {
  75		ret = sdio_read_fbr(func);
  76		if (ret)
  77			goto fail;
  78
  79		ret = sdio_read_func_cis(func);
  80		if (ret)
  81			goto fail;
  82	} else {
  83		func->vendor = func->card->cis.vendor;
  84		func->device = func->card->cis.device;
  85		func->max_blksize = func->card->cis.blksize;
  86	}
  87
  88	card->sdio_func[fn - 1] = func;
  89
  90	return 0;
  91
  92fail:
  93	/*
  94	 * It is okay to remove the function here even though we hold
  95	 * the host lock as we haven't registered the device yet.
  96	 */
  97	sdio_remove_func(func);
  98	return ret;
  99}
 100
 101static int sdio_read_cccr(struct mmc_card *card, u32 ocr)
 102{
 103	int ret;
 104	int cccr_vsn;
 105	int uhs = ocr & R4_18V_PRESENT;
 106	unsigned char data;
 107	unsigned char speed;
 
 108
 109	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_CCCR, 0, &data);
 110	if (ret)
 111		goto out;
 112
 113	cccr_vsn = data & 0x0f;
 114
 115	if (cccr_vsn > SDIO_CCCR_REV_3_00) {
 116		pr_err("%s: unrecognised CCCR structure version %d\n",
 117			mmc_hostname(card->host), cccr_vsn);
 118		return -EINVAL;
 119	}
 120
 121	card->cccr.sdio_vsn = (data & 0xf0) >> 4;
 122
 123	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_CAPS, 0, &data);
 124	if (ret)
 125		goto out;
 126
 127	if (data & SDIO_CCCR_CAP_SMB)
 128		card->cccr.multi_block = 1;
 129	if (data & SDIO_CCCR_CAP_LSC)
 130		card->cccr.low_speed = 1;
 131	if (data & SDIO_CCCR_CAP_4BLS)
 132		card->cccr.wide_bus = 1;
 133
 134	if (cccr_vsn >= SDIO_CCCR_REV_1_10) {
 135		ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_POWER, 0, &data);
 136		if (ret)
 137			goto out;
 138
 139		if (data & SDIO_POWER_SMPC)
 140			card->cccr.high_power = 1;
 141	}
 142
 143	if (cccr_vsn >= SDIO_CCCR_REV_1_20) {
 144		ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
 145		if (ret)
 146			goto out;
 147
 148		card->scr.sda_spec3 = 0;
 149		card->sw_caps.sd3_bus_mode = 0;
 150		card->sw_caps.sd3_drv_type = 0;
 151		if (cccr_vsn >= SDIO_CCCR_REV_3_00 && uhs) {
 152			card->scr.sda_spec3 = 1;
 153			ret = mmc_io_rw_direct(card, 0, 0,
 154				SDIO_CCCR_UHS, 0, &data);
 155			if (ret)
 156				goto out;
 157
 158			if (mmc_host_uhs(card->host)) {
 159				if (data & SDIO_UHS_DDR50)
 160					card->sw_caps.sd3_bus_mode
 161						|= SD_MODE_UHS_DDR50;
 162
 163				if (data & SDIO_UHS_SDR50)
 164					card->sw_caps.sd3_bus_mode
 165						|= SD_MODE_UHS_SDR50;
 166
 167				if (data & SDIO_UHS_SDR104)
 168					card->sw_caps.sd3_bus_mode
 169						|= SD_MODE_UHS_SDR104;
 170			}
 171
 172			ret = mmc_io_rw_direct(card, 0, 0,
 173				SDIO_CCCR_DRIVE_STRENGTH, 0, &data);
 174			if (ret)
 175				goto out;
 176
 177			if (data & SDIO_DRIVE_SDTA)
 178				card->sw_caps.sd3_drv_type |= SD_DRIVER_TYPE_A;
 179			if (data & SDIO_DRIVE_SDTC)
 180				card->sw_caps.sd3_drv_type |= SD_DRIVER_TYPE_C;
 181			if (data & SDIO_DRIVE_SDTD)
 182				card->sw_caps.sd3_drv_type |= SD_DRIVER_TYPE_D;
 183		}
 184
 185		/* if no uhs mode ensure we check for high speed */
 186		if (!card->sw_caps.sd3_bus_mode) {
 187			if (speed & SDIO_SPEED_SHS) {
 188				card->cccr.high_speed = 1;
 189				card->sw_caps.hs_max_dtr = 50000000;
 190			} else {
 191				card->cccr.high_speed = 0;
 192				card->sw_caps.hs_max_dtr = 25000000;
 193			}
 194		}
 195	}
 196
 197out:
 198	return ret;
 199}
 200
 201static int sdio_enable_wide(struct mmc_card *card)
 202{
 203	int ret;
 204	u8 ctrl;
 205
 206	if (!(card->host->caps & MMC_CAP_4_BIT_DATA))
 207		return 0;
 208
 209	if (card->cccr.low_speed && !card->cccr.wide_bus)
 210		return 0;
 211
 212	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
 213	if (ret)
 214		return ret;
 215
 216	if ((ctrl & SDIO_BUS_WIDTH_MASK) == SDIO_BUS_WIDTH_RESERVED)
 217		pr_warn("%s: SDIO_CCCR_IF is invalid: 0x%02x\n",
 218			mmc_hostname(card->host), ctrl);
 219
 220	/* set as 4-bit bus width */
 221	ctrl &= ~SDIO_BUS_WIDTH_MASK;
 222	ctrl |= SDIO_BUS_WIDTH_4BIT;
 223
 224	ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
 225	if (ret)
 226		return ret;
 227
 228	return 1;
 229}
 230
 231/*
 232 * If desired, disconnect the pull-up resistor on CD/DAT[3] (pin 1)
 233 * of the card. This may be required on certain setups of boards,
 234 * controllers and embedded sdio device which do not need the card's
 235 * pull-up. As a result, card detection is disabled and power is saved.
 236 */
 237static int sdio_disable_cd(struct mmc_card *card)
 238{
 239	int ret;
 240	u8 ctrl;
 241
 242	if (!mmc_card_disable_cd(card))
 243		return 0;
 244
 245	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
 246	if (ret)
 247		return ret;
 248
 249	ctrl |= SDIO_BUS_CD_DISABLE;
 250
 251	return mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
 252}
 253
 254/*
 255 * Devices that remain active during a system suspend are
 256 * put back into 1-bit mode.
 257 */
 258static int sdio_disable_wide(struct mmc_card *card)
 259{
 260	int ret;
 261	u8 ctrl;
 262
 263	if (!(card->host->caps & MMC_CAP_4_BIT_DATA))
 264		return 0;
 265
 266	if (card->cccr.low_speed && !card->cccr.wide_bus)
 267		return 0;
 268
 269	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
 270	if (ret)
 271		return ret;
 272
 273	if (!(ctrl & SDIO_BUS_WIDTH_4BIT))
 274		return 0;
 275
 276	ctrl &= ~SDIO_BUS_WIDTH_4BIT;
 277	ctrl |= SDIO_BUS_ASYNC_INT;
 278
 279	ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
 280	if (ret)
 281		return ret;
 282
 283	mmc_set_bus_width(card->host, MMC_BUS_WIDTH_1);
 284
 285	return 0;
 286}
 287
 288
 289static int sdio_enable_4bit_bus(struct mmc_card *card)
 290{
 291	int err;
 292
 293	if (card->type == MMC_TYPE_SDIO)
 294		err = sdio_enable_wide(card);
 295	else if ((card->host->caps & MMC_CAP_4_BIT_DATA) &&
 296		 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
 
 297		err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
 298		if (err)
 299			return err;
 300		err = sdio_enable_wide(card);
 301		if (err <= 0)
 302			mmc_app_set_bus_width(card, MMC_BUS_WIDTH_1);
 303	} else
 304		return 0;
 305
 306	if (err > 0) {
 307		mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
 308		err = 0;
 309	}
 310
 311	return err;
 312}
 313
 314
 315/*
 316 * Test if the card supports high-speed mode and, if so, switch to it.
 317 */
 318static int mmc_sdio_switch_hs(struct mmc_card *card, int enable)
 319{
 320	int ret;
 321	u8 speed;
 322
 323	if (!(card->host->caps & MMC_CAP_SD_HIGHSPEED))
 324		return 0;
 325
 326	if (!card->cccr.high_speed)
 327		return 0;
 328
 329	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
 330	if (ret)
 331		return ret;
 332
 333	if (enable)
 334		speed |= SDIO_SPEED_EHS;
 335	else
 336		speed &= ~SDIO_SPEED_EHS;
 337
 338	ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
 339	if (ret)
 340		return ret;
 341
 342	return 1;
 343}
 344
 345/*
 346 * Enable SDIO/combo card's high-speed mode. Return 0/1 if [not]supported.
 347 */
 348static int sdio_enable_hs(struct mmc_card *card)
 349{
 350	int ret;
 351
 352	ret = mmc_sdio_switch_hs(card, true);
 353	if (ret <= 0 || card->type == MMC_TYPE_SDIO)
 354		return ret;
 355
 356	ret = mmc_sd_switch_hs(card);
 357	if (ret <= 0)
 358		mmc_sdio_switch_hs(card, false);
 359
 360	return ret;
 361}
 362
 363static unsigned mmc_sdio_get_max_clock(struct mmc_card *card)
 364{
 365	unsigned max_dtr;
 366
 367	if (mmc_card_hs(card)) {
 368		/*
 369		 * The SDIO specification doesn't mention how
 370		 * the CIS transfer speed register relates to
 371		 * high-speed, but it seems that 50 MHz is
 372		 * mandatory.
 373		 */
 374		max_dtr = 50000000;
 375	} else {
 376		max_dtr = card->cis.max_dtr;
 377	}
 378
 379	if (card->type == MMC_TYPE_SD_COMBO)
 380		max_dtr = min(max_dtr, mmc_sd_get_max_clock(card));
 381
 382	return max_dtr;
 383}
 384
 385static unsigned char host_drive_to_sdio_drive(int host_strength)
 386{
 387	switch (host_strength) {
 388	case MMC_SET_DRIVER_TYPE_A:
 389		return SDIO_DTSx_SET_TYPE_A;
 390	case MMC_SET_DRIVER_TYPE_B:
 391		return SDIO_DTSx_SET_TYPE_B;
 392	case MMC_SET_DRIVER_TYPE_C:
 393		return SDIO_DTSx_SET_TYPE_C;
 394	case MMC_SET_DRIVER_TYPE_D:
 395		return SDIO_DTSx_SET_TYPE_D;
 396	default:
 397		return SDIO_DTSx_SET_TYPE_B;
 398	}
 399}
 400
 401static void sdio_select_driver_type(struct mmc_card *card)
 402{
 403	int card_drv_type, drive_strength, drv_type;
 404	unsigned char card_strength;
 405	int err;
 406
 407	card->drive_strength = 0;
 408
 409	card_drv_type = card->sw_caps.sd3_drv_type | SD_DRIVER_TYPE_B;
 410
 411	drive_strength = mmc_select_drive_strength(card,
 412						   card->sw_caps.uhs_max_dtr,
 413						   card_drv_type, &drv_type);
 414
 415	if (drive_strength) {
 416		/* if error just use default for drive strength B */
 417		err = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_DRIVE_STRENGTH, 0,
 418				       &card_strength);
 419		if (err)
 420			return;
 421
 422		card_strength &= ~(SDIO_DRIVE_DTSx_MASK<<SDIO_DRIVE_DTSx_SHIFT);
 423		card_strength |= host_drive_to_sdio_drive(drive_strength);
 424
 425		/* if error default to drive strength B */
 426		err = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_DRIVE_STRENGTH,
 427				       card_strength, NULL);
 428		if (err)
 429			return;
 430		card->drive_strength = drive_strength;
 431	}
 432
 433	if (drv_type)
 434		mmc_set_driver_type(card->host, drv_type);
 435}
 436
 437
 438static int sdio_set_bus_speed_mode(struct mmc_card *card)
 439{
 440	unsigned int bus_speed, timing;
 441	int err;
 442	unsigned char speed;
 443
 444	/*
 445	 * If the host doesn't support any of the UHS-I modes, fallback on
 446	 * default speed.
 447	 */
 448	if (!mmc_host_uhs(card->host))
 449		return 0;
 450
 451	bus_speed = SDIO_SPEED_SDR12;
 452	timing = MMC_TIMING_UHS_SDR12;
 453	if ((card->host->caps & MMC_CAP_UHS_SDR104) &&
 454	    (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR104)) {
 455			bus_speed = SDIO_SPEED_SDR104;
 456			timing = MMC_TIMING_UHS_SDR104;
 457			card->sw_caps.uhs_max_dtr = UHS_SDR104_MAX_DTR;
 458			card->sd_bus_speed = UHS_SDR104_BUS_SPEED;
 459	} else if ((card->host->caps & MMC_CAP_UHS_DDR50) &&
 460		   (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_DDR50)) {
 461			bus_speed = SDIO_SPEED_DDR50;
 462			timing = MMC_TIMING_UHS_DDR50;
 463			card->sw_caps.uhs_max_dtr = UHS_DDR50_MAX_DTR;
 464			card->sd_bus_speed = UHS_DDR50_BUS_SPEED;
 465	} else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
 466		    MMC_CAP_UHS_SDR50)) && (card->sw_caps.sd3_bus_mode &
 467		    SD_MODE_UHS_SDR50)) {
 468			bus_speed = SDIO_SPEED_SDR50;
 469			timing = MMC_TIMING_UHS_SDR50;
 470			card->sw_caps.uhs_max_dtr = UHS_SDR50_MAX_DTR;
 471			card->sd_bus_speed = UHS_SDR50_BUS_SPEED;
 472	} else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
 473		    MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25)) &&
 474		   (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR25)) {
 475			bus_speed = SDIO_SPEED_SDR25;
 476			timing = MMC_TIMING_UHS_SDR25;
 477			card->sw_caps.uhs_max_dtr = UHS_SDR25_MAX_DTR;
 478			card->sd_bus_speed = UHS_SDR25_BUS_SPEED;
 479	} else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
 480		    MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25 |
 481		    MMC_CAP_UHS_SDR12)) && (card->sw_caps.sd3_bus_mode &
 482		    SD_MODE_UHS_SDR12)) {
 483			bus_speed = SDIO_SPEED_SDR12;
 484			timing = MMC_TIMING_UHS_SDR12;
 485			card->sw_caps.uhs_max_dtr = UHS_SDR12_MAX_DTR;
 486			card->sd_bus_speed = UHS_SDR12_BUS_SPEED;
 487	}
 488
 489	err = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
 490	if (err)
 491		return err;
 492
 493	speed &= ~SDIO_SPEED_BSS_MASK;
 494	speed |= bus_speed;
 495	err = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
 496	if (err)
 497		return err;
 498
 499	if (bus_speed) {
 500		mmc_set_timing(card->host, timing);
 501		mmc_set_clock(card->host, card->sw_caps.uhs_max_dtr);
 502	}
 503
 504	return 0;
 505}
 506
 507/*
 508 * UHS-I specific initialization procedure
 509 */
 510static int mmc_sdio_init_uhs_card(struct mmc_card *card)
 511{
 512	int err;
 513
 514	if (!card->scr.sda_spec3)
 515		return 0;
 516
 517	/*
 518	 * Switch to wider bus (if supported).
 519	 */
 520	if (card->host->caps & MMC_CAP_4_BIT_DATA)
 521		err = sdio_enable_4bit_bus(card);
 522
 523	/* Set the driver strength for the card */
 524	sdio_select_driver_type(card);
 525
 526	/* Set bus speed mode of the card */
 527	err = sdio_set_bus_speed_mode(card);
 528	if (err)
 529		goto out;
 530
 531	/*
 532	 * SPI mode doesn't define CMD19 and tuning is only valid for SDR50 and
 533	 * SDR104 mode SD-cards. Note that tuning is mandatory for SDR104.
 534	 */
 535	if (!mmc_host_is_spi(card->host) &&
 536	    ((card->host->ios.timing == MMC_TIMING_UHS_SDR50) ||
 537	      (card->host->ios.timing == MMC_TIMING_UHS_SDR104)))
 538		err = mmc_execute_tuning(card);
 539out:
 540	return err;
 541}
 542
 543/*
 544 * Handle the detection and initialisation of a card.
 545 *
 546 * In the case of a resume, "oldcard" will contain the card
 547 * we're trying to reinitialise.
 548 */
 549static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
 550			      struct mmc_card *oldcard, int powered_resume)
 551{
 552	struct mmc_card *card;
 553	int err;
 554	int retries = 10;
 555	u32 rocr = 0;
 556	u32 ocr_card = ocr;
 557
 558	BUG_ON(!host);
 559	WARN_ON(!host->claimed);
 560
 561	/* to query card if 1.8V signalling is supported */
 562	if (mmc_host_uhs(host))
 563		ocr |= R4_18V_PRESENT;
 564
 565try_again:
 566	if (!retries) {
 567		pr_warn("%s: Skipping voltage switch\n", mmc_hostname(host));
 568		ocr &= ~R4_18V_PRESENT;
 569	}
 570
 571	/*
 572	 * Inform the card of the voltage
 573	 */
 574	if (!powered_resume) {
 575		err = mmc_send_io_op_cond(host, ocr, &rocr);
 576		if (err)
 577			goto err;
 578	}
 579
 580	/*
 581	 * For SPI, enable CRC as appropriate.
 582	 */
 583	if (mmc_host_is_spi(host)) {
 584		err = mmc_spi_set_crc(host, use_spi_crc);
 585		if (err)
 586			goto err;
 587	}
 588
 589	/*
 590	 * Allocate card structure.
 591	 */
 592	card = mmc_alloc_card(host, NULL);
 593	if (IS_ERR(card)) {
 594		err = PTR_ERR(card);
 595		goto err;
 596	}
 597
 598	if ((rocr & R4_MEMORY_PRESENT) &&
 599	    mmc_sd_get_cid(host, ocr & rocr, card->raw_cid, NULL) == 0) {
 600		card->type = MMC_TYPE_SD_COMBO;
 601
 602		if (oldcard && (oldcard->type != MMC_TYPE_SD_COMBO ||
 603		    memcmp(card->raw_cid, oldcard->raw_cid, sizeof(card->raw_cid)) != 0)) {
 604			mmc_remove_card(card);
 605			return -ENOENT;
 606		}
 607	} else {
 608		card->type = MMC_TYPE_SDIO;
 609
 610		if (oldcard && oldcard->type != MMC_TYPE_SDIO) {
 611			mmc_remove_card(card);
 612			return -ENOENT;
 613		}
 614	}
 615
 616	/*
 617	 * Call the optional HC's init_card function to handle quirks.
 618	 */
 619	if (host->ops->init_card)
 620		host->ops->init_card(host, card);
 621
 622	/*
 623	 * If the host and card support UHS-I mode request the card
 624	 * to switch to 1.8V signaling level.  No 1.8v signalling if
 625	 * UHS mode is not enabled to maintain compatibility and some
 626	 * systems that claim 1.8v signalling in fact do not support
 627	 * it.
 628	 */
 629	if (!powered_resume && (rocr & ocr & R4_18V_PRESENT)) {
 630		err = mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180,
 631					ocr_card);
 632		if (err == -EAGAIN) {
 633			sdio_reset(host);
 634			mmc_go_idle(host);
 635			mmc_send_if_cond(host, host->ocr_avail);
 636			mmc_remove_card(card);
 637			retries--;
 638			goto try_again;
 639		} else if (err) {
 640			ocr &= ~R4_18V_PRESENT;
 641		}
 642		err = 0;
 643	} else {
 644		ocr &= ~R4_18V_PRESENT;
 645	}
 646
 647	/*
 648	 * For native busses:  set card RCA and quit open drain mode.
 649	 */
 650	if (!powered_resume && !mmc_host_is_spi(host)) {
 651		err = mmc_send_relative_addr(host, &card->rca);
 652		if (err)
 653			goto remove;
 654
 655		/*
 656		 * Update oldcard with the new RCA received from the SDIO
 657		 * device -- we're doing this so that it's updated in the
 658		 * "card" struct when oldcard overwrites that later.
 659		 */
 660		if (oldcard)
 661			oldcard->rca = card->rca;
 
 
 662	}
 663
 664	/*
 665	 * Read CSD, before selecting the card
 666	 */
 667	if (!oldcard && card->type == MMC_TYPE_SD_COMBO) {
 668		err = mmc_sd_get_csd(host, card);
 669		if (err)
 670			return err;
 671
 672		mmc_decode_cid(card);
 673	}
 674
 675	/*
 676	 * Select card, as all following commands rely on that.
 677	 */
 678	if (!powered_resume && !mmc_host_is_spi(host)) {
 679		err = mmc_select_card(card);
 680		if (err)
 681			goto remove;
 682	}
 683
 684	if (card->quirks & MMC_QUIRK_NONSTD_SDIO) {
 685		/*
 686		 * This is non-standard SDIO device, meaning it doesn't
 687		 * have any CIA (Common I/O area) registers present.
 688		 * It's host's responsibility to fill cccr and cis
 689		 * structures in init_card().
 690		 */
 691		mmc_set_clock(host, card->cis.max_dtr);
 692
 693		if (card->cccr.high_speed) {
 
 694			mmc_set_timing(card->host, MMC_TIMING_SD_HS);
 695		}
 696
 697		goto finish;
 698	}
 699
 700	/*
 701	 * Read the common registers.
 702	 */
 703	err = sdio_read_cccr(card, ocr);
 704	if (err)
 705		goto remove;
 706
 707	/*
 708	 * Read the common CIS tuples.
 709	 */
 710	err = sdio_read_common_cis(card);
 711	if (err)
 712		goto remove;
 713
 714	if (oldcard) {
 715		int same = (card->cis.vendor == oldcard->cis.vendor &&
 716			    card->cis.device == oldcard->cis.device);
 717		mmc_remove_card(card);
 718		if (!same)
 719			return -ENOENT;
 720
 721		card = oldcard;
 722	}
 723	card->ocr = ocr_card;
 724	mmc_fixup_device(card, NULL);
 725
 726	if (card->type == MMC_TYPE_SD_COMBO) {
 727		err = mmc_sd_setup_card(host, card, oldcard != NULL);
 728		/* handle as SDIO-only card if memory init failed */
 729		if (err) {
 730			mmc_go_idle(host);
 731			if (mmc_host_is_spi(host))
 732				/* should not fail, as it worked previously */
 733				mmc_spi_set_crc(host, use_spi_crc);
 734			card->type = MMC_TYPE_SDIO;
 735		} else
 736			card->dev.type = &sd_type;
 737	}
 738
 739	/*
 740	 * If needed, disconnect card detection pull-up resistor.
 741	 */
 742	err = sdio_disable_cd(card);
 743	if (err)
 744		goto remove;
 745
 746	/* Initialization sequence for UHS-I cards */
 747	/* Only if card supports 1.8v and UHS signaling */
 748	if ((ocr & R4_18V_PRESENT) && card->sw_caps.sd3_bus_mode) {
 749		err = mmc_sdio_init_uhs_card(card);
 750		if (err)
 751			goto remove;
 752	} else {
 753		/*
 754		 * Switch to high-speed (if supported).
 755		 */
 756		err = sdio_enable_hs(card);
 757		if (err > 0)
 758			mmc_set_timing(card->host, MMC_TIMING_SD_HS);
 759		else if (err)
 760			goto remove;
 761
 762		/*
 763		 * Change to the card's maximum speed.
 764		 */
 765		mmc_set_clock(host, mmc_sdio_get_max_clock(card));
 
 
 
 
 
 
 
 
 
 766
 767		/*
 768		 * Switch to wider bus (if supported).
 769		 */
 770		err = sdio_enable_4bit_bus(card);
 771		if (err)
 772			goto remove;
 773	}
 774finish:
 775	if (!oldcard)
 776		host->card = card;
 777	return 0;
 778
 779remove:
 780	if (!oldcard)
 781		mmc_remove_card(card);
 782
 783err:
 784	return err;
 785}
 786
 787/*
 788 * Host is being removed. Free up the current card.
 789 */
 790static void mmc_sdio_remove(struct mmc_host *host)
 791{
 792	int i;
 793
 794	BUG_ON(!host);
 795	BUG_ON(!host->card);
 796
 797	for (i = 0;i < host->card->sdio_funcs;i++) {
 798		if (host->card->sdio_func[i]) {
 799			sdio_remove_func(host->card->sdio_func[i]);
 800			host->card->sdio_func[i] = NULL;
 801		}
 802	}
 803
 804	mmc_remove_card(host->card);
 805	host->card = NULL;
 806}
 807
 808/*
 809 * Card detection - card is alive.
 810 */
 811static int mmc_sdio_alive(struct mmc_host *host)
 812{
 813	return mmc_select_card(host->card);
 814}
 815
 816/*
 817 * Card detection callback from host.
 818 */
 819static void mmc_sdio_detect(struct mmc_host *host)
 820{
 821	int err;
 822
 823	BUG_ON(!host);
 824	BUG_ON(!host->card);
 825
 826	/* Make sure card is powered before detecting it */
 827	if (host->caps & MMC_CAP_POWER_OFF_CARD) {
 828		err = pm_runtime_get_sync(&host->card->dev);
 829		if (err < 0) {
 830			pm_runtime_put_noidle(&host->card->dev);
 831			goto out;
 832		}
 833	}
 834
 835	mmc_claim_host(host);
 836
 837	/*
 838	 * Just check if our card has been removed.
 839	 */
 840	err = _mmc_detect_card_removed(host);
 841
 842	mmc_release_host(host);
 843
 844	/*
 845	 * Tell PM core it's OK to power off the card now.
 846	 *
 847	 * The _sync variant is used in order to ensure that the card
 848	 * is left powered off in case an error occurred, and the card
 849	 * is going to be removed.
 850	 *
 851	 * Since there is no specific reason to believe a new user
 852	 * is about to show up at this point, the _sync variant is
 853	 * desirable anyway.
 854	 */
 855	if (host->caps & MMC_CAP_POWER_OFF_CARD)
 856		pm_runtime_put_sync(&host->card->dev);
 857
 858out:
 859	if (err) {
 860		mmc_sdio_remove(host);
 861
 862		mmc_claim_host(host);
 863		mmc_detach_bus(host);
 864		mmc_power_off(host);
 865		mmc_release_host(host);
 866	}
 867}
 868
 869/*
 870 * SDIO pre_suspend.  We need to suspend all functions separately.
 871 * Therefore all registered functions must have drivers with suspend
 872 * and resume methods.  Failing that we simply remove the whole card.
 873 */
 874static int mmc_sdio_pre_suspend(struct mmc_host *host)
 875{
 876	int i, err = 0;
 877
 878	for (i = 0; i < host->card->sdio_funcs; i++) {
 879		struct sdio_func *func = host->card->sdio_func[i];
 880		if (func && sdio_func_present(func) && func->dev.driver) {
 881			const struct dev_pm_ops *pmops = func->dev.driver->pm;
 882			if (!pmops || !pmops->suspend || !pmops->resume) {
 883				/* force removal of entire card in that case */
 884				err = -ENOSYS;
 
 
 
 885				break;
 886			}
 
 
 
 
 
 
 887		}
 888	}
 889
 890	return err;
 891}
 892
 893/*
 894 * SDIO suspend.  Suspend all functions separately.
 895 */
 896static int mmc_sdio_suspend(struct mmc_host *host)
 897{
 898	mmc_claim_host(host);
 899
 900	if (mmc_card_keep_power(host) && mmc_card_wake_sdio_irq(host))
 901		sdio_disable_wide(host->card);
 902
 903	if (!mmc_card_keep_power(host)) {
 904		mmc_power_off(host);
 905	} else if (host->retune_period) {
 906		mmc_retune_timer_stop(host);
 907		mmc_retune_needed(host);
 908	}
 909
 910	mmc_release_host(host);
 911
 912	return 0;
 913}
 914
 915static int mmc_sdio_resume(struct mmc_host *host)
 916{
 917	int err = 0;
 918
 919	BUG_ON(!host);
 920	BUG_ON(!host->card);
 921
 922	/* Basic card reinitialization. */
 923	mmc_claim_host(host);
 924
 925	/* Restore power if needed */
 926	if (!mmc_card_keep_power(host)) {
 927		mmc_power_up(host, host->card->ocr);
 928		/*
 929		 * Tell runtime PM core we just powered up the card,
 930		 * since it still believes the card is powered off.
 931		 * Note that currently runtime PM is only enabled
 932		 * for SDIO cards that are MMC_CAP_POWER_OFF_CARD
 933		 */
 934		if (host->caps & MMC_CAP_POWER_OFF_CARD) {
 935			pm_runtime_disable(&host->card->dev);
 936			pm_runtime_set_active(&host->card->dev);
 937			pm_runtime_enable(&host->card->dev);
 938		}
 939	}
 940
 941	/* No need to reinitialize powered-resumed nonremovable cards */
 942	if (mmc_card_is_removable(host) || !mmc_card_keep_power(host)) {
 943		sdio_reset(host);
 944		mmc_go_idle(host);
 945		mmc_send_if_cond(host, host->card->ocr);
 946		err = mmc_send_io_op_cond(host, 0, NULL);
 947		if (!err)
 948			err = mmc_sdio_init_card(host, host->card->ocr,
 949						 host->card,
 950						 mmc_card_keep_power(host));
 951	} else if (mmc_card_keep_power(host) && mmc_card_wake_sdio_irq(host)) {
 952		/* We may have switched to 1-bit mode during suspend */
 953		err = sdio_enable_4bit_bus(host->card);
 
 
 
 
 954	}
 955
 956	if (!err && host->sdio_irqs) {
 957		if (!(host->caps2 & MMC_CAP2_SDIO_IRQ_NOTHREAD))
 958			wake_up_process(host->sdio_irq_thread);
 959		else if (host->caps & MMC_CAP_SDIO_IRQ)
 960			host->ops->enable_sdio_irq(host, 1);
 961	}
 962
 963	mmc_release_host(host);
 964
 965	host->pm_flags &= ~MMC_PM_KEEP_POWER;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 966	return err;
 967}
 968
 969static int mmc_sdio_power_restore(struct mmc_host *host)
 970{
 971	int ret;
 
 972
 973	BUG_ON(!host);
 974	BUG_ON(!host->card);
 975
 976	mmc_claim_host(host);
 977
 978	/*
 979	 * Reset the card by performing the same steps that are taken by
 980	 * mmc_rescan_try_freq() and mmc_attach_sdio() during a "normal" probe.
 981	 *
 982	 * sdio_reset() is technically not needed. Having just powered up the
 983	 * hardware, it should already be in reset state. However, some
 984	 * platforms (such as SD8686 on OLPC) do not instantly cut power,
 985	 * meaning that a reset is required when restoring power soon after
 986	 * powering off. It is harmless in other cases.
 987	 *
 988	 * The CMD5 reset (mmc_send_io_op_cond()), according to the SDIO spec,
 989	 * is not necessary for non-removable cards. However, it is required
 990	 * for OLPC SD8686 (which expects a [CMD5,5,3,7] init sequence), and
 991	 * harmless in other situations.
 992	 *
 
 
 993	 */
 994
 995	sdio_reset(host);
 996	mmc_go_idle(host);
 997	mmc_send_if_cond(host, host->card->ocr);
 998
 999	ret = mmc_send_io_op_cond(host, 0, NULL);
1000	if (ret)
1001		goto out;
1002
1003	ret = mmc_sdio_init_card(host, host->card->ocr, host->card,
 
 
 
 
 
 
 
 
 
1004				mmc_card_keep_power(host));
1005	if (!ret && host->sdio_irqs)
1006		mmc_signal_sdio_irq(host);
1007
1008out:
1009	mmc_release_host(host);
1010
1011	return ret;
1012}
1013
1014static int mmc_sdio_runtime_suspend(struct mmc_host *host)
1015{
1016	/* No references to the card, cut the power to it. */
1017	mmc_claim_host(host);
1018	mmc_power_off(host);
1019	mmc_release_host(host);
1020
1021	return 0;
1022}
1023
1024static int mmc_sdio_runtime_resume(struct mmc_host *host)
1025{
1026	int ret;
1027
1028	/* Restore power and re-initialize. */
1029	mmc_claim_host(host);
1030	mmc_power_up(host, host->card->ocr);
1031	ret = mmc_sdio_power_restore(host);
1032	mmc_release_host(host);
1033
1034	return ret;
1035}
1036
1037static int mmc_sdio_reset(struct mmc_host *host)
1038{
1039	mmc_power_cycle(host, host->card->ocr);
1040	return mmc_sdio_power_restore(host);
1041}
1042
1043static const struct mmc_bus_ops mmc_sdio_ops = {
1044	.remove = mmc_sdio_remove,
1045	.detect = mmc_sdio_detect,
1046	.pre_suspend = mmc_sdio_pre_suspend,
1047	.suspend = mmc_sdio_suspend,
1048	.resume = mmc_sdio_resume,
1049	.runtime_suspend = mmc_sdio_runtime_suspend,
1050	.runtime_resume = mmc_sdio_runtime_resume,
1051	.power_restore = mmc_sdio_power_restore,
1052	.alive = mmc_sdio_alive,
1053	.reset = mmc_sdio_reset,
1054};
1055
1056
1057/*
1058 * Starting point for SDIO card init.
1059 */
1060int mmc_attach_sdio(struct mmc_host *host)
1061{
1062	int err, i, funcs;
1063	u32 ocr, rocr;
1064	struct mmc_card *card;
1065
1066	BUG_ON(!host);
1067	WARN_ON(!host->claimed);
1068
1069	err = mmc_send_io_op_cond(host, 0, &ocr);
1070	if (err)
1071		return err;
1072
1073	mmc_attach_bus(host, &mmc_sdio_ops);
1074	if (host->ocr_avail_sdio)
1075		host->ocr_avail = host->ocr_avail_sdio;
1076
 
 
 
 
 
 
 
 
 
 
1077
1078	rocr = mmc_select_voltage(host, ocr);
1079
1080	/*
1081	 * Can we support the voltage(s) of the card(s)?
1082	 */
1083	if (!rocr) {
1084		err = -EINVAL;
1085		goto err;
1086	}
1087
1088	/*
1089	 * Detect and init the card.
1090	 */
1091	err = mmc_sdio_init_card(host, rocr, NULL, 0);
1092	if (err)
1093		goto err;
1094
1095	card = host->card;
1096
1097	/*
1098	 * Enable runtime PM only if supported by host+card+board
1099	 */
1100	if (host->caps & MMC_CAP_POWER_OFF_CARD) {
1101		/*
1102		 * Let runtime PM core know our card is active
1103		 */
1104		err = pm_runtime_set_active(&card->dev);
1105		if (err)
1106			goto remove;
1107
1108		/*
1109		 * Enable runtime PM for this card
1110		 */
1111		pm_runtime_enable(&card->dev);
1112	}
1113
1114	/*
1115	 * The number of functions on the card is encoded inside
1116	 * the ocr.
1117	 */
1118	funcs = (ocr & 0x70000000) >> 28;
1119	card->sdio_funcs = 0;
1120
1121	/*
1122	 * Initialize (but don't add) all present functions.
1123	 */
1124	for (i = 0; i < funcs; i++, card->sdio_funcs++) {
1125		err = sdio_init_func(host->card, i + 1);
1126		if (err)
1127			goto remove;
1128
1129		/*
1130		 * Enable Runtime PM for this func (if supported)
1131		 */
1132		if (host->caps & MMC_CAP_POWER_OFF_CARD)
1133			pm_runtime_enable(&card->sdio_func[i]->dev);
1134	}
1135
1136	/*
1137	 * First add the card to the driver model...
1138	 */
1139	mmc_release_host(host);
1140	err = mmc_add_card(host->card);
1141	if (err)
1142		goto remove_added;
1143
1144	/*
1145	 * ...then the SDIO functions.
1146	 */
1147	for (i = 0;i < funcs;i++) {
1148		err = sdio_add_func(host->card->sdio_func[i]);
1149		if (err)
1150			goto remove_added;
1151	}
1152
1153	mmc_claim_host(host);
1154	return 0;
1155
1156
1157remove_added:
1158	/* Remove without lock if the device has been added. */
1159	mmc_sdio_remove(host);
1160	mmc_claim_host(host);
1161remove:
1162	/* And with lock if it hasn't been added. */
1163	mmc_release_host(host);
1164	if (host->card)
1165		mmc_sdio_remove(host);
1166	mmc_claim_host(host);
1167err:
1168	mmc_detach_bus(host);
1169
1170	pr_err("%s: error %d whilst initialising SDIO card\n",
1171		mmc_hostname(host), err);
1172
1173	return err;
1174}
1175
v3.1
  1/*
  2 *  linux/drivers/mmc/sdio.c
  3 *
  4 *  Copyright 2006-2007 Pierre Ossman
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License, or (at
  9 * your option) any later version.
 10 */
 11
 12#include <linux/err.h>
 13#include <linux/pm_runtime.h>
 14
 15#include <linux/mmc/host.h>
 16#include <linux/mmc/card.h>
 
 17#include <linux/mmc/sdio.h>
 18#include <linux/mmc/sdio_func.h>
 19#include <linux/mmc/sdio_ids.h>
 20
 21#include "core.h"
 22#include "bus.h"
 23#include "sd.h"
 24#include "sdio_bus.h"
 25#include "mmc_ops.h"
 26#include "sd_ops.h"
 27#include "sdio_ops.h"
 28#include "sdio_cis.h"
 29
 30static int sdio_read_fbr(struct sdio_func *func)
 31{
 32	int ret;
 33	unsigned char data;
 34
 35	if (mmc_card_nonstd_func_interface(func->card)) {
 36		func->class = SDIO_CLASS_NONE;
 37		return 0;
 38	}
 39
 40	ret = mmc_io_rw_direct(func->card, 0, 0,
 41		SDIO_FBR_BASE(func->num) + SDIO_FBR_STD_IF, 0, &data);
 42	if (ret)
 43		goto out;
 44
 45	data &= 0x0f;
 46
 47	if (data == 0x0f) {
 48		ret = mmc_io_rw_direct(func->card, 0, 0,
 49			SDIO_FBR_BASE(func->num) + SDIO_FBR_STD_IF_EXT, 0, &data);
 50		if (ret)
 51			goto out;
 52	}
 53
 54	func->class = data;
 55
 56out:
 57	return ret;
 58}
 59
 60static int sdio_init_func(struct mmc_card *card, unsigned int fn)
 61{
 62	int ret;
 63	struct sdio_func *func;
 64
 65	BUG_ON(fn > SDIO_MAX_FUNCS);
 66
 67	func = sdio_alloc_func(card);
 68	if (IS_ERR(func))
 69		return PTR_ERR(func);
 70
 71	func->num = fn;
 72
 73	if (!(card->quirks & MMC_QUIRK_NONSTD_SDIO)) {
 74		ret = sdio_read_fbr(func);
 75		if (ret)
 76			goto fail;
 77
 78		ret = sdio_read_func_cis(func);
 79		if (ret)
 80			goto fail;
 81	} else {
 82		func->vendor = func->card->cis.vendor;
 83		func->device = func->card->cis.device;
 84		func->max_blksize = func->card->cis.blksize;
 85	}
 86
 87	card->sdio_func[fn - 1] = func;
 88
 89	return 0;
 90
 91fail:
 92	/*
 93	 * It is okay to remove the function here even though we hold
 94	 * the host lock as we haven't registered the device yet.
 95	 */
 96	sdio_remove_func(func);
 97	return ret;
 98}
 99
100static int sdio_read_cccr(struct mmc_card *card)
101{
102	int ret;
103	int cccr_vsn;
 
104	unsigned char data;
105
106	memset(&card->cccr, 0, sizeof(struct sdio_cccr));
107
108	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_CCCR, 0, &data);
109	if (ret)
110		goto out;
111
112	cccr_vsn = data & 0x0f;
113
114	if (cccr_vsn > SDIO_CCCR_REV_1_20) {
115		printk(KERN_ERR "%s: unrecognised CCCR structure version %d\n",
116			mmc_hostname(card->host), cccr_vsn);
117		return -EINVAL;
118	}
119
120	card->cccr.sdio_vsn = (data & 0xf0) >> 4;
121
122	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_CAPS, 0, &data);
123	if (ret)
124		goto out;
125
126	if (data & SDIO_CCCR_CAP_SMB)
127		card->cccr.multi_block = 1;
128	if (data & SDIO_CCCR_CAP_LSC)
129		card->cccr.low_speed = 1;
130	if (data & SDIO_CCCR_CAP_4BLS)
131		card->cccr.wide_bus = 1;
132
133	if (cccr_vsn >= SDIO_CCCR_REV_1_10) {
134		ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_POWER, 0, &data);
135		if (ret)
136			goto out;
137
138		if (data & SDIO_POWER_SMPC)
139			card->cccr.high_power = 1;
140	}
141
142	if (cccr_vsn >= SDIO_CCCR_REV_1_20) {
143		ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &data);
144		if (ret)
145			goto out;
146
147		if (data & SDIO_SPEED_SHS)
148			card->cccr.high_speed = 1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
149	}
150
151out:
152	return ret;
153}
154
155static int sdio_enable_wide(struct mmc_card *card)
156{
157	int ret;
158	u8 ctrl;
159
160	if (!(card->host->caps & MMC_CAP_4_BIT_DATA))
161		return 0;
162
163	if (card->cccr.low_speed && !card->cccr.wide_bus)
164		return 0;
165
166	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
167	if (ret)
168		return ret;
169
 
 
 
 
 
 
170	ctrl |= SDIO_BUS_WIDTH_4BIT;
171
172	ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
173	if (ret)
174		return ret;
175
176	return 1;
177}
178
179/*
180 * If desired, disconnect the pull-up resistor on CD/DAT[3] (pin 1)
181 * of the card. This may be required on certain setups of boards,
182 * controllers and embedded sdio device which do not need the card's
183 * pull-up. As a result, card detection is disabled and power is saved.
184 */
185static int sdio_disable_cd(struct mmc_card *card)
186{
187	int ret;
188	u8 ctrl;
189
190	if (!mmc_card_disable_cd(card))
191		return 0;
192
193	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
194	if (ret)
195		return ret;
196
197	ctrl |= SDIO_BUS_CD_DISABLE;
198
199	return mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
200}
201
202/*
203 * Devices that remain active during a system suspend are
204 * put back into 1-bit mode.
205 */
206static int sdio_disable_wide(struct mmc_card *card)
207{
208	int ret;
209	u8 ctrl;
210
211	if (!(card->host->caps & MMC_CAP_4_BIT_DATA))
212		return 0;
213
214	if (card->cccr.low_speed && !card->cccr.wide_bus)
215		return 0;
216
217	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
218	if (ret)
219		return ret;
220
221	if (!(ctrl & SDIO_BUS_WIDTH_4BIT))
222		return 0;
223
224	ctrl &= ~SDIO_BUS_WIDTH_4BIT;
225	ctrl |= SDIO_BUS_ASYNC_INT;
226
227	ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
228	if (ret)
229		return ret;
230
231	mmc_set_bus_width(card->host, MMC_BUS_WIDTH_1);
232
233	return 0;
234}
235
236
237static int sdio_enable_4bit_bus(struct mmc_card *card)
238{
239	int err;
240
241	if (card->type == MMC_TYPE_SDIO)
242		return sdio_enable_wide(card);
243
244	if ((card->host->caps & MMC_CAP_4_BIT_DATA) &&
245		(card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
246		err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
247		if (err)
248			return err;
 
 
 
249	} else
250		return 0;
251
252	err = sdio_enable_wide(card);
253	if (err <= 0)
254		mmc_app_set_bus_width(card, MMC_BUS_WIDTH_1);
 
255
256	return err;
257}
258
259
260/*
261 * Test if the card supports high-speed mode and, if so, switch to it.
262 */
263static int mmc_sdio_switch_hs(struct mmc_card *card, int enable)
264{
265	int ret;
266	u8 speed;
267
268	if (!(card->host->caps & MMC_CAP_SD_HIGHSPEED))
269		return 0;
270
271	if (!card->cccr.high_speed)
272		return 0;
273
274	ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
275	if (ret)
276		return ret;
277
278	if (enable)
279		speed |= SDIO_SPEED_EHS;
280	else
281		speed &= ~SDIO_SPEED_EHS;
282
283	ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
284	if (ret)
285		return ret;
286
287	return 1;
288}
289
290/*
291 * Enable SDIO/combo card's high-speed mode. Return 0/1 if [not]supported.
292 */
293static int sdio_enable_hs(struct mmc_card *card)
294{
295	int ret;
296
297	ret = mmc_sdio_switch_hs(card, true);
298	if (ret <= 0 || card->type == MMC_TYPE_SDIO)
299		return ret;
300
301	ret = mmc_sd_switch_hs(card);
302	if (ret <= 0)
303		mmc_sdio_switch_hs(card, false);
304
305	return ret;
306}
307
308static unsigned mmc_sdio_get_max_clock(struct mmc_card *card)
309{
310	unsigned max_dtr;
311
312	if (mmc_card_highspeed(card)) {
313		/*
314		 * The SDIO specification doesn't mention how
315		 * the CIS transfer speed register relates to
316		 * high-speed, but it seems that 50 MHz is
317		 * mandatory.
318		 */
319		max_dtr = 50000000;
320	} else {
321		max_dtr = card->cis.max_dtr;
322	}
323
324	if (card->type == MMC_TYPE_SD_COMBO)
325		max_dtr = min(max_dtr, mmc_sd_get_max_clock(card));
326
327	return max_dtr;
328}
329
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
330/*
331 * Handle the detection and initialisation of a card.
332 *
333 * In the case of a resume, "oldcard" will contain the card
334 * we're trying to reinitialise.
335 */
336static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
337			      struct mmc_card *oldcard, int powered_resume)
338{
339	struct mmc_card *card;
340	int err;
 
 
 
341
342	BUG_ON(!host);
343	WARN_ON(!host->claimed);
344
 
 
 
 
 
 
 
 
 
 
345	/*
346	 * Inform the card of the voltage
347	 */
348	if (!powered_resume) {
349		err = mmc_send_io_op_cond(host, host->ocr, &ocr);
350		if (err)
351			goto err;
352	}
353
354	/*
355	 * For SPI, enable CRC as appropriate.
356	 */
357	if (mmc_host_is_spi(host)) {
358		err = mmc_spi_set_crc(host, use_spi_crc);
359		if (err)
360			goto err;
361	}
362
363	/*
364	 * Allocate card structure.
365	 */
366	card = mmc_alloc_card(host, NULL);
367	if (IS_ERR(card)) {
368		err = PTR_ERR(card);
369		goto err;
370	}
371
372	if ((ocr & R4_MEMORY_PRESENT) &&
373	    mmc_sd_get_cid(host, host->ocr & ocr, card->raw_cid, NULL) == 0) {
374		card->type = MMC_TYPE_SD_COMBO;
375
376		if (oldcard && (oldcard->type != MMC_TYPE_SD_COMBO ||
377		    memcmp(card->raw_cid, oldcard->raw_cid, sizeof(card->raw_cid)) != 0)) {
378			mmc_remove_card(card);
379			return -ENOENT;
380		}
381	} else {
382		card->type = MMC_TYPE_SDIO;
383
384		if (oldcard && oldcard->type != MMC_TYPE_SDIO) {
385			mmc_remove_card(card);
386			return -ENOENT;
387		}
388	}
389
390	/*
391	 * Call the optional HC's init_card function to handle quirks.
392	 */
393	if (host->ops->init_card)
394		host->ops->init_card(host, card);
395
396	/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
397	 * For native busses:  set card RCA and quit open drain mode.
398	 */
399	if (!powered_resume && !mmc_host_is_spi(host)) {
400		err = mmc_send_relative_addr(host, &card->rca);
401		if (err)
402			goto remove;
403
404		/*
405		 * Update oldcard with the new RCA received from the SDIO
406		 * device -- we're doing this so that it's updated in the
407		 * "card" struct when oldcard overwrites that later.
408		 */
409		if (oldcard)
410			oldcard->rca = card->rca;
411
412		mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
413	}
414
415	/*
416	 * Read CSD, before selecting the card
417	 */
418	if (!oldcard && card->type == MMC_TYPE_SD_COMBO) {
419		err = mmc_sd_get_csd(host, card);
420		if (err)
421			return err;
422
423		mmc_decode_cid(card);
424	}
425
426	/*
427	 * Select card, as all following commands rely on that.
428	 */
429	if (!powered_resume && !mmc_host_is_spi(host)) {
430		err = mmc_select_card(card);
431		if (err)
432			goto remove;
433	}
434
435	if (card->quirks & MMC_QUIRK_NONSTD_SDIO) {
436		/*
437		 * This is non-standard SDIO device, meaning it doesn't
438		 * have any CIA (Common I/O area) registers present.
439		 * It's host's responsibility to fill cccr and cis
440		 * structures in init_card().
441		 */
442		mmc_set_clock(host, card->cis.max_dtr);
443
444		if (card->cccr.high_speed) {
445			mmc_card_set_highspeed(card);
446			mmc_set_timing(card->host, MMC_TIMING_SD_HS);
447		}
448
449		goto finish;
450	}
451
452	/*
453	 * Read the common registers.
454	 */
455	err = sdio_read_cccr(card);
456	if (err)
457		goto remove;
458
459	/*
460	 * Read the common CIS tuples.
461	 */
462	err = sdio_read_common_cis(card);
463	if (err)
464		goto remove;
465
466	if (oldcard) {
467		int same = (card->cis.vendor == oldcard->cis.vendor &&
468			    card->cis.device == oldcard->cis.device);
469		mmc_remove_card(card);
470		if (!same)
471			return -ENOENT;
472
473		card = oldcard;
474	}
 
475	mmc_fixup_device(card, NULL);
476
477	if (card->type == MMC_TYPE_SD_COMBO) {
478		err = mmc_sd_setup_card(host, card, oldcard != NULL);
479		/* handle as SDIO-only card if memory init failed */
480		if (err) {
481			mmc_go_idle(host);
482			if (mmc_host_is_spi(host))
483				/* should not fail, as it worked previously */
484				mmc_spi_set_crc(host, use_spi_crc);
485			card->type = MMC_TYPE_SDIO;
486		} else
487			card->dev.type = &sd_type;
488	}
489
490	/*
491	 * If needed, disconnect card detection pull-up resistor.
492	 */
493	err = sdio_disable_cd(card);
494	if (err)
495		goto remove;
496
497	/*
498	 * Switch to high-speed (if supported).
499	 */
500	err = sdio_enable_hs(card);
501	if (err > 0)
502		mmc_sd_go_highspeed(card);
503	else if (err)
504		goto remove;
 
 
 
 
 
 
 
505
506	/*
507	 * Change to the card's maximum speed.
508	 */
509	mmc_set_clock(host, mmc_sdio_get_max_clock(card));
510
511	/*
512	 * Switch to wider bus (if supported).
513	 */
514	err = sdio_enable_4bit_bus(card);
515	if (err > 0)
516		mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
517	else if (err)
518		goto remove;
519
 
 
 
 
 
 
 
520finish:
521	if (!oldcard)
522		host->card = card;
523	return 0;
524
525remove:
526	if (!oldcard)
527		mmc_remove_card(card);
528
529err:
530	return err;
531}
532
533/*
534 * Host is being removed. Free up the current card.
535 */
536static void mmc_sdio_remove(struct mmc_host *host)
537{
538	int i;
539
540	BUG_ON(!host);
541	BUG_ON(!host->card);
542
543	for (i = 0;i < host->card->sdio_funcs;i++) {
544		if (host->card->sdio_func[i]) {
545			sdio_remove_func(host->card->sdio_func[i]);
546			host->card->sdio_func[i] = NULL;
547		}
548	}
549
550	mmc_remove_card(host->card);
551	host->card = NULL;
552}
553
554/*
 
 
 
 
 
 
 
 
555 * Card detection callback from host.
556 */
557static void mmc_sdio_detect(struct mmc_host *host)
558{
559	int err;
560
561	BUG_ON(!host);
562	BUG_ON(!host->card);
563
564	/* Make sure card is powered before detecting it */
565	if (host->caps & MMC_CAP_POWER_OFF_CARD) {
566		err = pm_runtime_get_sync(&host->card->dev);
567		if (err < 0)
 
568			goto out;
 
569	}
570
571	mmc_claim_host(host);
572
573	/*
574	 * Just check if our card has been removed.
575	 */
576	err = mmc_select_card(host->card);
577
578	mmc_release_host(host);
579
580	/*
581	 * Tell PM core it's OK to power off the card now.
582	 *
583	 * The _sync variant is used in order to ensure that the card
584	 * is left powered off in case an error occurred, and the card
585	 * is going to be removed.
586	 *
587	 * Since there is no specific reason to believe a new user
588	 * is about to show up at this point, the _sync variant is
589	 * desirable anyway.
590	 */
591	if (host->caps & MMC_CAP_POWER_OFF_CARD)
592		pm_runtime_put_sync(&host->card->dev);
593
594out:
595	if (err) {
596		mmc_sdio_remove(host);
597
598		mmc_claim_host(host);
599		mmc_detach_bus(host);
 
600		mmc_release_host(host);
601	}
602}
603
604/*
605 * SDIO suspend.  We need to suspend all functions separately.
606 * Therefore all registered functions must have drivers with suspend
607 * and resume methods.  Failing that we simply remove the whole card.
608 */
609static int mmc_sdio_suspend(struct mmc_host *host)
610{
611	int i, err = 0;
612
613	for (i = 0; i < host->card->sdio_funcs; i++) {
614		struct sdio_func *func = host->card->sdio_func[i];
615		if (func && sdio_func_present(func) && func->dev.driver) {
616			const struct dev_pm_ops *pmops = func->dev.driver->pm;
617			if (!pmops || !pmops->suspend || !pmops->resume) {
618				/* force removal of entire card in that case */
619				err = -ENOSYS;
620			} else
621				err = pmops->suspend(&func->dev);
622			if (err)
623				break;
624		}
625	}
626	while (err && --i >= 0) {
627		struct sdio_func *func = host->card->sdio_func[i];
628		if (func && sdio_func_present(func) && func->dev.driver) {
629			const struct dev_pm_ops *pmops = func->dev.driver->pm;
630			pmops->resume(&func->dev);
631		}
632	}
633
634	if (!err && mmc_card_keep_power(host) && mmc_card_wake_sdio_irq(host)) {
635		mmc_claim_host(host);
 
 
 
 
 
 
 
 
 
636		sdio_disable_wide(host->card);
637		mmc_release_host(host);
 
 
 
 
 
638	}
639
640	return err;
 
 
641}
642
643static int mmc_sdio_resume(struct mmc_host *host)
644{
645	int i, err = 0;
646
647	BUG_ON(!host);
648	BUG_ON(!host->card);
649
650	/* Basic card reinitialization. */
651	mmc_claim_host(host);
652
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
653	/* No need to reinitialize powered-resumed nonremovable cards */
654	if (mmc_card_is_removable(host) || !mmc_card_keep_power(host))
655		err = mmc_sdio_init_card(host, host->ocr, host->card,
656					mmc_card_keep_power(host));
657	else if (mmc_card_keep_power(host) && mmc_card_wake_sdio_irq(host)) {
 
 
 
 
 
 
658		/* We may have switched to 1-bit mode during suspend */
659		err = sdio_enable_4bit_bus(host->card);
660		if (err > 0) {
661			mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
662			err = 0;
663		}
664	}
665
666	if (!err && host->sdio_irqs)
667		mmc_signal_sdio_irq(host);
 
 
 
 
 
668	mmc_release_host(host);
669
670	/*
671	 * If the card looked to be the same as before suspending, then
672	 * we proceed to resume all card functions.  If one of them returns
673	 * an error then we simply return that error to the core and the
674	 * card will be redetected as new.  It is the responsibility of
675	 * the function driver to perform further tests with the extra
676	 * knowledge it has of the card to confirm the card is indeed the
677	 * same as before suspending (same MAC address for network cards,
678	 * etc.) and return an error otherwise.
679	 */
680	for (i = 0; !err && i < host->card->sdio_funcs; i++) {
681		struct sdio_func *func = host->card->sdio_func[i];
682		if (func && sdio_func_present(func) && func->dev.driver) {
683			const struct dev_pm_ops *pmops = func->dev.driver->pm;
684			err = pmops->resume(&func->dev);
685		}
686	}
687
688	return err;
689}
690
691static int mmc_sdio_power_restore(struct mmc_host *host)
692{
693	int ret;
694	u32 ocr;
695
696	BUG_ON(!host);
697	BUG_ON(!host->card);
698
699	mmc_claim_host(host);
700
701	/*
702	 * Reset the card by performing the same steps that are taken by
703	 * mmc_rescan_try_freq() and mmc_attach_sdio() during a "normal" probe.
704	 *
705	 * sdio_reset() is technically not needed. Having just powered up the
706	 * hardware, it should already be in reset state. However, some
707	 * platforms (such as SD8686 on OLPC) do not instantly cut power,
708	 * meaning that a reset is required when restoring power soon after
709	 * powering off. It is harmless in other cases.
710	 *
711	 * The CMD5 reset (mmc_send_io_op_cond()), according to the SDIO spec,
712	 * is not necessary for non-removable cards. However, it is required
713	 * for OLPC SD8686 (which expects a [CMD5,5,3,7] init sequence), and
714	 * harmless in other situations.
715	 *
716	 * With these steps taken, mmc_select_voltage() is also required to
717	 * restore the correct voltage setting of the card.
718	 */
 
719	sdio_reset(host);
720	mmc_go_idle(host);
721	mmc_send_if_cond(host, host->ocr_avail);
722
723	ret = mmc_send_io_op_cond(host, 0, &ocr);
724	if (ret)
725		goto out;
726
727	if (host->ocr_avail_sdio)
728		host->ocr_avail = host->ocr_avail_sdio;
729
730	host->ocr = mmc_select_voltage(host, ocr & ~0x7F);
731	if (!host->ocr) {
732		ret = -EINVAL;
733		goto out;
734	}
735
736	ret = mmc_sdio_init_card(host, host->ocr, host->card,
737				mmc_card_keep_power(host));
738	if (!ret && host->sdio_irqs)
739		mmc_signal_sdio_irq(host);
740
741out:
742	mmc_release_host(host);
743
744	return ret;
745}
746
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
747static const struct mmc_bus_ops mmc_sdio_ops = {
748	.remove = mmc_sdio_remove,
749	.detect = mmc_sdio_detect,
 
750	.suspend = mmc_sdio_suspend,
751	.resume = mmc_sdio_resume,
 
 
752	.power_restore = mmc_sdio_power_restore,
 
 
753};
754
755
756/*
757 * Starting point for SDIO card init.
758 */
759int mmc_attach_sdio(struct mmc_host *host)
760{
761	int err, i, funcs;
762	u32 ocr;
763	struct mmc_card *card;
764
765	BUG_ON(!host);
766	WARN_ON(!host->claimed);
767
768	err = mmc_send_io_op_cond(host, 0, &ocr);
769	if (err)
770		return err;
771
772	mmc_attach_bus(host, &mmc_sdio_ops);
773	if (host->ocr_avail_sdio)
774		host->ocr_avail = host->ocr_avail_sdio;
775
776	/*
777	 * Sanity check the voltages that the card claims to
778	 * support.
779	 */
780	if (ocr & 0x7F) {
781		printk(KERN_WARNING "%s: card claims to support voltages "
782		       "below the defined range. These will be ignored.\n",
783		       mmc_hostname(host));
784		ocr &= ~0x7F;
785	}
786
787	host->ocr = mmc_select_voltage(host, ocr);
788
789	/*
790	 * Can we support the voltage(s) of the card(s)?
791	 */
792	if (!host->ocr) {
793		err = -EINVAL;
794		goto err;
795	}
796
797	/*
798	 * Detect and init the card.
799	 */
800	err = mmc_sdio_init_card(host, host->ocr, NULL, 0);
801	if (err)
802		goto err;
 
803	card = host->card;
804
805	/*
806	 * Enable runtime PM only if supported by host+card+board
807	 */
808	if (host->caps & MMC_CAP_POWER_OFF_CARD) {
809		/*
810		 * Let runtime PM core know our card is active
811		 */
812		err = pm_runtime_set_active(&card->dev);
813		if (err)
814			goto remove;
815
816		/*
817		 * Enable runtime PM for this card
818		 */
819		pm_runtime_enable(&card->dev);
820	}
821
822	/*
823	 * The number of functions on the card is encoded inside
824	 * the ocr.
825	 */
826	funcs = (ocr & 0x70000000) >> 28;
827	card->sdio_funcs = 0;
828
829	/*
830	 * Initialize (but don't add) all present functions.
831	 */
832	for (i = 0; i < funcs; i++, card->sdio_funcs++) {
833		err = sdio_init_func(host->card, i + 1);
834		if (err)
835			goto remove;
836
837		/*
838		 * Enable Runtime PM for this func (if supported)
839		 */
840		if (host->caps & MMC_CAP_POWER_OFF_CARD)
841			pm_runtime_enable(&card->sdio_func[i]->dev);
842	}
843
844	/*
845	 * First add the card to the driver model...
846	 */
847	mmc_release_host(host);
848	err = mmc_add_card(host->card);
849	if (err)
850		goto remove_added;
851
852	/*
853	 * ...then the SDIO functions.
854	 */
855	for (i = 0;i < funcs;i++) {
856		err = sdio_add_func(host->card->sdio_func[i]);
857		if (err)
858			goto remove_added;
859	}
860
861	mmc_claim_host(host);
862	return 0;
863
864
865remove_added:
866	/* Remove without lock if the device has been added. */
867	mmc_sdio_remove(host);
868	mmc_claim_host(host);
869remove:
870	/* And with lock if it hasn't been added. */
871	mmc_release_host(host);
872	if (host->card)
873		mmc_sdio_remove(host);
874	mmc_claim_host(host);
875err:
876	mmc_detach_bus(host);
877
878	printk(KERN_ERR "%s: error %d whilst initialising SDIO card\n",
879		mmc_hostname(host), err);
880
881	return err;
882}
883