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