Linux Audio

Check our new training course

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