drivers/mmc/core/mmc_ops.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  *  linux/drivers/mmc/core/mmc_ops.h
   4  *
   5  *  Copyright 2006-2007 Pierre Ossman
   6  */
   7
   8 #include <linux/slab.h>
   9 #include <linux/export.h>
  10 #include <linux/types.h>
  11 #include <linux/scatterlist.h>
  12
  13 #include <linux/mmc/host.h>
  14 #include <linux/mmc/card.h>
  15 #include <linux/mmc/mmc.h>
  16
  17 #include "core.h"
  18 #include "card.h"
  19 #include "host.h"
  20 #include "mmc_ops.h"
  21
  22 #define MMC_BKOPS_TIMEOUT_MS            (120 * 1000) /* 120s */
  23 #define MMC_CACHE_FLUSH_TIMEOUT_MS      (30 * 1000) /* 30s */
  24
  25 static const u8 tuning_blk_pattern_4bit[] = {
  26         0xff, 0x0f, 0xff, 0x00, 0xff, 0xcc, 0xc3, 0xcc,
  27         0xc3, 0x3c, 0xcc, 0xff, 0xfe, 0xff, 0xfe, 0xef,
  28         0xff, 0xdf, 0xff, 0xdd, 0xff, 0xfb, 0xff, 0xfb,
  29         0xbf, 0xff, 0x7f, 0xff, 0x77, 0xf7, 0xbd, 0xef,
  30         0xff, 0xf0, 0xff, 0xf0, 0x0f, 0xfc, 0xcc, 0x3c,
  31         0xcc, 0x33, 0xcc, 0xcf, 0xff, 0xef, 0xff, 0xee,
  32         0xff, 0xfd, 0xff, 0xfd, 0xdf, 0xff, 0xbf, 0xff,
  33         0xbb, 0xff, 0xf7, 0xff, 0xf7, 0x7f, 0x7b, 0xde,
  34 };
  35
  36 static const u8 tuning_blk_pattern_8bit[] = {
  37         0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00, 0x00,
  38         0xff, 0xff, 0xcc, 0xcc, 0xcc, 0x33, 0xcc, 0xcc,
  39         0xcc, 0x33, 0x33, 0xcc, 0xcc, 0xcc, 0xff, 0xff,
  40         0xff, 0xee, 0xff, 0xff, 0xff, 0xee, 0xee, 0xff,
  41         0xff, 0xff, 0xdd, 0xff, 0xff, 0xff, 0xdd, 0xdd,
  42         0xff, 0xff, 0xff, 0xbb, 0xff, 0xff, 0xff, 0xbb,
  43         0xbb, 0xff, 0xff, 0xff, 0x77, 0xff, 0xff, 0xff,
  44         0x77, 0x77, 0xff, 0x77, 0xbb, 0xdd, 0xee, 0xff,
  45         0xff, 0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00,
  46         0x00, 0xff, 0xff, 0xcc, 0xcc, 0xcc, 0x33, 0xcc,
  47         0xcc, 0xcc, 0x33, 0x33, 0xcc, 0xcc, 0xcc, 0xff,
  48         0xff, 0xff, 0xee, 0xff, 0xff, 0xff, 0xee, 0xee,
  49         0xff, 0xff, 0xff, 0xdd, 0xff, 0xff, 0xff, 0xdd,
  50         0xdd, 0xff, 0xff, 0xff, 0xbb, 0xff, 0xff, 0xff,
  51         0xbb, 0xbb, 0xff, 0xff, 0xff, 0x77, 0xff, 0xff,
  52         0xff, 0x77, 0x77, 0xff, 0x77, 0xbb, 0xdd, 0xee,
  53 };
  54
  55 int __mmc_send_status(struct mmc_card *card, u32 *status, unsigned int retries)
  56 {
  57         int err;
  58         struct mmc_command cmd = {};
  59
  60         cmd.opcode = MMC_SEND_STATUS;
  61         if (!mmc_host_is_spi(card->host))
  62                 cmd.arg = card->rca << 16;
  63         cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC;
  64
  65         err = mmc_wait_for_cmd(card->host, &cmd, retries);
  66         if (err)
  67                 return err;
  68
  69         /* NOTE: callers are required to understand the difference
  70          * between "native" and SPI format status words!
  71          */
  72         if (status)
  73                 *status = cmd.resp[0];
  74
  75         return 0;
  76 }
  77 EXPORT_SYMBOL_GPL(__mmc_send_status);
  78
  79 int mmc_send_status(struct mmc_card *card, u32 *status)
  80 {
  81         return __mmc_send_status(card, status, MMC_CMD_RETRIES);
  82 }
  83 EXPORT_SYMBOL_GPL(mmc_send_status);
  84
  85 static int _mmc_select_card(struct mmc_host *host, struct mmc_card *card)
  86 {
  87         struct mmc_command cmd = {};
  88
  89         cmd.opcode = MMC_SELECT_CARD;
  90
  91         if (card) {
  92                 cmd.arg = card->rca << 16;
  93                 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  94         } else {
  95                 cmd.arg = 0;
  96                 cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
  97         }
  98
  99         return mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
 100 }
 101
 102 int mmc_select_card(struct mmc_card *card)
 103 {
 104
 105         return _mmc_select_card(card->host, card);
 106 }
 107
 108 int mmc_deselect_cards(struct mmc_host *host)
 109 {
 110         return _mmc_select_card(host, NULL);
 111 }
 112
 113 /*
 114  * Write the value specified in the device tree or board code into the optional
 115  * 16 bit Driver Stage Register. This can be used to tune raise/fall times and
 116  * drive strength of the DAT and CMD outputs. The actual meaning of a given
 117  * value is hardware dependant.
 118  * The presence of the DSR register can be determined from the CSD register,
 119  * bit 76.
 120  */
 121 int mmc_set_dsr(struct mmc_host *host)
 122 {
 123         struct mmc_command cmd = {};
 124
 125         cmd.opcode = MMC_SET_DSR;
 126
 127         cmd.arg = (host->dsr << 16) | 0xffff;
 128         cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
 129
 130         return mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
 131 }
 132
 133 int mmc_go_idle(struct mmc_host *host)
 134 {
 135         int err;
 136         struct mmc_command cmd = {};
 137
 138         /*
 139          * Non-SPI hosts need to prevent chipselect going active during
 140          * GO_IDLE; that would put chips into SPI mode.  Remind them of
 141          * that in case of hardware that won't pull up DAT3/nCS otherwise.
 142          *
 143          * SPI hosts ignore ios.chip_select; it's managed according to
 144          * rules that must accommodate non-MMC slaves which this layer
 145          * won't even know about.
 146          */
 147         if (!mmc_host_is_spi(host)) {
 148                 mmc_set_chip_select(host, MMC_CS_HIGH);
 149                 mmc_delay(1);
 150         }
 151
 152         cmd.opcode = MMC_GO_IDLE_STATE;
 153         cmd.arg = 0;
 154         cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_NONE | MMC_CMD_BC;
 155
 156         err = mmc_wait_for_cmd(host, &cmd, 0);
 157
 158         mmc_delay(1);
 159
 160         if (!mmc_host_is_spi(host)) {
 161                 mmc_set_chip_select(host, MMC_CS_DONTCARE);
 162                 mmc_delay(1);
 163         }
 164
 165         host->use_spi_crc = 0;
 166
 167         return err;
 168 }
 169
 170 int mmc_send_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
 171 {
 172         struct mmc_command cmd = {};
 173         int i, err = 0;
 174
 175         cmd.opcode = MMC_SEND_OP_COND;
 176         cmd.arg = mmc_host_is_spi(host) ? 0 : ocr;
 177         cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR;
 178
 179         for (i = 100; i; i--) {
 180                 err = mmc_wait_for_cmd(host, &cmd, 0);
 181                 if (err)
 182                         break;
 183
 184                 /* wait until reset completes */
 185                 if (mmc_host_is_spi(host)) {
 186                         if (!(cmd.resp[0] & R1_SPI_IDLE))
 187                                 break;
 188                 } else {
 189                         if (cmd.resp[0] & MMC_CARD_BUSY)
 190                                 break;
 191                 }
 192
 193                 err = -ETIMEDOUT;
 194
 195                 mmc_delay(10);
 196
 197                 /*
 198                  * According to eMMC specification v5.1 section 6.4.3, we
 199                  * should issue CMD1 repeatedly in the idle state until
 200                  * the eMMC is ready. Otherwise some eMMC devices seem to enter
 201                  * the inactive mode after mmc_init_card() issued CMD0 when
 202                  * the eMMC device is busy.
 203                  */
 204                 if (!ocr && !mmc_host_is_spi(host))
 205                         cmd.arg = cmd.resp[0] | BIT(30);
 206         }
 207
 208         if (rocr && !mmc_host_is_spi(host))
 209                 *rocr = cmd.resp[0];
 210
 211         return err;
 212 }
 213
 214 int mmc_set_relative_addr(struct mmc_card *card)
 215 {
 216         struct mmc_command cmd = {};
 217
 218         cmd.opcode = MMC_SET_RELATIVE_ADDR;
 219         cmd.arg = card->rca << 16;
 220         cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
 221
 222         return mmc_wait_for_cmd(card->host, &cmd, MMC_CMD_RETRIES);
 223 }
 224
 225 static int
 226 mmc_send_cxd_native(struct mmc_host *host, u32 arg, u32 *cxd, int opcode)
 227 {
 228         int err;
 229         struct mmc_command cmd = {};
 230
 231         cmd.opcode = opcode;
 232         cmd.arg = arg;
 233         cmd.flags = MMC_RSP_R2 | MMC_CMD_AC;
 234
 235         err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
 236         if (err)
 237                 return err;
 238
 239         memcpy(cxd, cmd.resp, sizeof(u32) * 4);
 240
 241         return 0;
 242 }
 243
 244 /*
 245  * NOTE: void *buf, caller for the buf is required to use DMA-capable
 246  * buffer or on-stack buffer (with some overhead in callee).
 247  */
 248 static int
 249 mmc_send_cxd_data(struct mmc_card *card, struct mmc_host *host,
 250                 u32 opcode, void *buf, unsigned len)
 251 {
 252         struct mmc_request mrq = {};
 253         struct mmc_command cmd = {};
 254         struct mmc_data data = {};
 255         struct scatterlist sg;
 256
 257         mrq.cmd = &cmd;
 258         mrq.data = &data;
 259
 260         cmd.opcode = opcode;
 261         cmd.arg = 0;
 262
 263         /* NOTE HACK:  the MMC_RSP_SPI_R1 is always correct here, but we
 264          * rely on callers to never use this with "native" calls for reading
 265          * CSD or CID.  Native versions of those commands use the R2 type,
 266          * not R1 plus a data block.
 267          */
 268         cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
 269
 270         data.blksz = len;
 271         data.blocks = 1;
 272         data.flags = MMC_DATA_READ;
 273         data.sg = &sg;
 274         data.sg_len = 1;
 275
 276         sg_init_one(&sg, buf, len);
 277
 278         if (opcode == MMC_SEND_CSD || opcode == MMC_SEND_CID) {
 279                 /*
 280                  * The spec states that CSR and CID accesses have a timeout
 281                  * of 64 clock cycles.
 282                  */
 283                 data.timeout_ns = 0;
 284                 data.timeout_clks = 64;
 285         } else
 286                 mmc_set_data_timeout(&data, card);
 287
 288         mmc_wait_for_req(host, &mrq);
 289
 290         if (cmd.error)
 291                 return cmd.error;
 292         if (data.error)
 293                 return data.error;
 294
 295         return 0;
 296 }
 297
 298 static int mmc_spi_send_csd(struct mmc_card *card, u32 *csd)
 299 {
 300         int ret, i;
 301         __be32 *csd_tmp;
 302
 303         csd_tmp = kzalloc(16, GFP_KERNEL);
 304         if (!csd_tmp)
 305                 return -ENOMEM;
 306
 307         ret = mmc_send_cxd_data(card, card->host, MMC_SEND_CSD, csd_tmp, 16);
 308         if (ret)
 309                 goto err;
 310
 311         for (i = 0; i < 4; i++)
 312                 csd[i] = be32_to_cpu(csd_tmp[i]);
 313
 314 err:
 315         kfree(csd_tmp);
 316         return ret;
 317 }
 318
 319 int mmc_send_csd(struct mmc_card *card, u32 *csd)
 320 {
 321         if (mmc_host_is_spi(card->host))
 322                 return mmc_spi_send_csd(card, csd);
 323
 324         return mmc_send_cxd_native(card->host, card->rca << 16, csd,
 325                                 MMC_SEND_CSD);
 326 }
 327
 328 static int mmc_spi_send_cid(struct mmc_host *host, u32 *cid)
 329 {
 330         int ret, i;
 331         __be32 *cid_tmp;
 332
 333         cid_tmp = kzalloc(16, GFP_KERNEL);
 334         if (!cid_tmp)
 335                 return -ENOMEM;
 336
 337         ret = mmc_send_cxd_data(NULL, host, MMC_SEND_CID, cid_tmp, 16);
 338         if (ret)
 339                 goto err;
 340
 341         for (i = 0; i < 4; i++)
 342                 cid[i] = be32_to_cpu(cid_tmp[i]);
 343
 344 err:
 345         kfree(cid_tmp);
 346         return ret;
 347 }
 348
 349 int mmc_send_cid(struct mmc_host *host, u32 *cid)
 350 {
 351         if (mmc_host_is_spi(host))
 352                 return mmc_spi_send_cid(host, cid);
 353
 354         return mmc_send_cxd_native(host, 0, cid, MMC_ALL_SEND_CID);
 355 }
 356
 357 int mmc_get_ext_csd(struct mmc_card *card, u8 **new_ext_csd)
 358 {
 359         int err;
 360         u8 *ext_csd;
 361
 362         if (!card || !new_ext_csd)
 363                 return -EINVAL;
 364
 365         if (!mmc_can_ext_csd(card))
 366                 return -EOPNOTSUPP;
 367
 368         /*
 369          * As the ext_csd is so large and mostly unused, we don't store the
 370          * raw block in mmc_card.
 371          */
 372         ext_csd = kzalloc(512, GFP_KERNEL);
 373         if (!ext_csd)
 374                 return -ENOMEM;
 375
 376         err = mmc_send_cxd_data(card, card->host, MMC_SEND_EXT_CSD, ext_csd,
 377                                 512);
 378         if (err)
 379                 kfree(ext_csd);
 380         else
 381                 *new_ext_csd = ext_csd;
 382
 383         return err;
 384 }
 385 EXPORT_SYMBOL_GPL(mmc_get_ext_csd);
 386
 387 int mmc_spi_read_ocr(struct mmc_host *host, int highcap, u32 *ocrp)
 388 {
 389         struct mmc_command cmd = {};
 390         int err;
 391
 392         cmd.opcode = MMC_SPI_READ_OCR;
 393         cmd.arg = highcap ? (1 << 30) : 0;
 394         cmd.flags = MMC_RSP_SPI_R3;
 395
 396         err = mmc_wait_for_cmd(host, &cmd, 0);
 397
 398         *ocrp = cmd.resp[1];
 399         return err;
 400 }
 401
 402 int mmc_spi_set_crc(struct mmc_host *host, int use_crc)
 403 {
 404         struct mmc_command cmd = {};
 405         int err;
 406
 407         cmd.opcode = MMC_SPI_CRC_ON_OFF;
 408         cmd.flags = MMC_RSP_SPI_R1;
 409         cmd.arg = use_crc;
 410
 411         err = mmc_wait_for_cmd(host, &cmd, 0);
 412         if (!err)
 413                 host->use_spi_crc = use_crc;
 414         return err;
 415 }
 416
 417 static int mmc_switch_status_error(struct mmc_host *host, u32 status)
 418 {
 419         if (mmc_host_is_spi(host)) {
 420                 if (status & R1_SPI_ILLEGAL_COMMAND)
 421                         return -EBADMSG;
 422         } else {
 423                 if (R1_STATUS(status))
 424                         pr_warn("%s: unexpected status %#x after switch\n",
 425                                 mmc_hostname(host), status);
 426                 if (status & R1_SWITCH_ERROR)
 427                         return -EBADMSG;
 428         }
 429         return 0;
 430 }
 431
 432 /* Caller must hold re-tuning */
 433 int mmc_switch_status(struct mmc_card *card, bool crc_err_fatal)
 434 {
 435         u32 status;
 436         int err;
 437
 438         err = mmc_send_status(card, &status);
 439         if (!crc_err_fatal && err == -EILSEQ)
 440                 return 0;
 441         if (err)
 442                 return err;
 443
 444         return mmc_switch_status_error(card->host, status);
 445 }
 446
 447 static int mmc_busy_status(struct mmc_card *card, bool retry_crc_err,
 448                            bool *busy)
 449 {
 450         struct mmc_host *host = card->host;
 451         u32 status = 0;
 452         int err;
 453
 454         if (host->ops->card_busy) {
 455                 *busy = host->ops->card_busy(host);
 456                 return 0;
 457         }
 458
 459         err = mmc_send_status(card, &status);
 460         if (retry_crc_err && err == -EILSEQ) {
 461                 *busy = true;
 462                 return 0;
 463         }
 464         if (err)
 465                 return err;
 466
 467         err = mmc_switch_status_error(card->host, status);
 468         if (err)
 469                 return err;
 470
 471         *busy = !mmc_ready_for_data(status);
 472         return 0;
 473 }
 474
 475 static int mmc_poll_for_busy(struct mmc_card *card, unsigned int timeout_ms,
 476                         bool send_status, bool retry_crc_err)
 477 {
 478         struct mmc_host *host = card->host;
 479         int err;
 480         unsigned long timeout;
 481         unsigned int udelay = 32, udelay_max = 32768;
 482         bool expired = false;
 483         bool busy = false;
 484
 485         /*
 486          * In cases when not allowed to poll by using CMD13 or because we aren't
 487          * capable of polling by using ->card_busy(), then rely on waiting the
 488          * stated timeout to be sufficient.
 489          */
 490         if (!send_status && !host->ops->card_busy) {
 491                 mmc_delay(timeout_ms);
 492                 return 0;
 493         }
 494
 495         timeout = jiffies + msecs_to_jiffies(timeout_ms) + 1;
 496         do {
 497                 /*
 498                  * Due to the possibility of being preempted while polling,
 499                  * check the expiration time first.
 500                  */
 501                 expired = time_after(jiffies, timeout);
 502
 503                 err = mmc_busy_status(card, retry_crc_err, &busy);
 504                 if (err)
 505                         return err;
 506
 507                 /* Timeout if the device still remains busy. */
 508                 if (expired && busy) {
 509                         pr_err("%s: Card stuck being busy! %s\n",
 510                                 mmc_hostname(host), __func__);
 511                         return -ETIMEDOUT;
 512                 }
 513
 514                 /* Throttle the polling rate to avoid hogging the CPU. */
 515                 if (busy) {
 516                         usleep_range(udelay, udelay * 2);
 517                         if (udelay < udelay_max)
 518                                 udelay *= 2;
 519                 }
 520         } while (busy);
 521
 522         return 0;
 523 }
 524
 525 /**
 526  *      __mmc_switch - modify EXT_CSD register
 527  *      @card: the MMC card associated with the data transfer
 528  *      @set: cmd set values
 529  *      @index: EXT_CSD register index
 530  *      @value: value to program into EXT_CSD register
 531  *      @timeout_ms: timeout (ms) for operation performed by register write,
 532  *                   timeout of zero implies maximum possible timeout
 533  *      @timing: new timing to change to
 534  *      @send_status: send status cmd to poll for busy
 535  *      @retry_crc_err: retry when CRC errors when polling with CMD13 for busy
 536  *
 537  *      Modifies the EXT_CSD register for selected card.
 538  */
 539 int __mmc_switch(struct mmc_card *card, u8 set, u8 index, u8 value,
 540                 unsigned int timeout_ms, unsigned char timing,
 541                 bool send_status, bool retry_crc_err)
 542 {
 543         struct mmc_host *host = card->host;
 544         int err;
 545         struct mmc_command cmd = {};
 546         bool use_r1b_resp = true;
 547         unsigned char old_timing = host->ios.timing;
 548
 549         mmc_retune_hold(host);
 550
 551         if (!timeout_ms) {
 552                 pr_warn("%s: unspecified timeout for CMD6 - use generic\n",
 553                         mmc_hostname(host));
 554                 timeout_ms = card->ext_csd.generic_cmd6_time;
 555         }
 556
 557         /*
 558          * If the max_busy_timeout of the host is specified, make sure it's
 559          * enough to fit the used timeout_ms. In case it's not, let's instruct
 560          * the host to avoid HW busy detection, by converting to a R1 response
 561          * instead of a R1B. Note, some hosts requires R1B, which also means
 562          * they are on their own when it comes to deal with the busy timeout.
 563          */
 564         if (!(host->caps & MMC_CAP_NEED_RSP_BUSY) && host->max_busy_timeout &&
 565             (timeout_ms > host->max_busy_timeout))
 566                 use_r1b_resp = false;
 567
 568         cmd.opcode = MMC_SWITCH;
 569         cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
 570                   (index << 16) |
 571                   (value << 8) |
 572                   set;
 573         cmd.flags = MMC_CMD_AC;
 574         if (use_r1b_resp) {
 575                 cmd.flags |= MMC_RSP_SPI_R1B | MMC_RSP_R1B;
 576                 cmd.busy_timeout = timeout_ms;
 577         } else {
 578                 cmd.flags |= MMC_RSP_SPI_R1 | MMC_RSP_R1;
 579         }
 580
 581         if (index == EXT_CSD_SANITIZE_START)
 582                 cmd.sanitize_busy = true;
 583
 584         err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
 585         if (err)
 586                 goto out;
 587
 588         /*If SPI or used HW busy detection above, then we don't need to poll. */
 589         if (((host->caps & MMC_CAP_WAIT_WHILE_BUSY) && use_r1b_resp) ||
 590                 mmc_host_is_spi(host))
 591                 goto out_tim;
 592
 593         /* Let's try to poll to find out when the command is completed. */
 594         err = mmc_poll_for_busy(card, timeout_ms, send_status, retry_crc_err);
 595         if (err)
 596                 goto out;
 597
 598 out_tim:
 599         /* Switch to new timing before check switch status. */
 600         if (timing)
 601                 mmc_set_timing(host, timing);
 602
 603         if (send_status) {
 604                 err = mmc_switch_status(card, true);
 605                 if (err && timing)
 606                         mmc_set_timing(host, old_timing);
 607         }
 608 out:
 609         mmc_retune_release(host);
 610
 611         return err;
 612 }
 613
 614 int mmc_switch(struct mmc_card *card, u8 set, u8 index, u8 value,
 615                 unsigned int timeout_ms)
 616 {
 617         return __mmc_switch(card, set, index, value, timeout_ms, 0,
 618                             true, false);
 619 }
 620 EXPORT_SYMBOL_GPL(mmc_switch);
 621
 622 int mmc_send_tuning(struct mmc_host *host, u32 opcode, int *cmd_error)
 623 {
 624         struct mmc_request mrq = {};
 625         struct mmc_command cmd = {};
 626         struct mmc_data data = {};
 627         struct scatterlist sg;
 628         struct mmc_ios *ios = &host->ios;
 629         const u8 *tuning_block_pattern;
 630         int size, err = 0;
 631         u8 *data_buf;
 632
 633         if (ios->bus_width == MMC_BUS_WIDTH_8) {
 634                 tuning_block_pattern = tuning_blk_pattern_8bit;
 635                 size = sizeof(tuning_blk_pattern_8bit);
 636         } else if (ios->bus_width == MMC_BUS_WIDTH_4) {
 637                 tuning_block_pattern = tuning_blk_pattern_4bit;
 638                 size = sizeof(tuning_blk_pattern_4bit);
 639         } else
 640                 return -EINVAL;
 641
 642         data_buf = kzalloc(size, GFP_KERNEL);
 643         if (!data_buf)
 644                 return -ENOMEM;
 645
 646         mrq.cmd = &cmd;
 647         mrq.data = &data;
 648
 649         cmd.opcode = opcode;
 650         cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
 651
 652         data.blksz = size;
 653         data.blocks = 1;
 654         data.flags = MMC_DATA_READ;
 655
 656         /*
 657          * According to the tuning specs, Tuning process
 658          * is normally shorter 40 executions of CMD19,
 659          * and timeout value should be shorter than 150 ms
 660          */
 661         data.timeout_ns = 150 * NSEC_PER_MSEC;
 662
 663         data.sg = &sg;
 664         data.sg_len = 1;
 665         sg_init_one(&sg, data_buf, size);
 666
 667         mmc_wait_for_req(host, &mrq);
 668
 669         if (cmd_error)
 670                 *cmd_error = cmd.error;
 671
 672         if (cmd.error) {
 673                 err = cmd.error;
 674                 goto out;
 675         }
 676
 677         if (data.error) {
 678                 err = data.error;
 679                 goto out;
 680         }
 681
 682         if (memcmp(data_buf, tuning_block_pattern, size))
 683                 err = -EIO;
 684
 685 out:
 686         kfree(data_buf);
 687         return err;
 688 }
 689 EXPORT_SYMBOL_GPL(mmc_send_tuning);
 690
 691 int mmc_abort_tuning(struct mmc_host *host, u32 opcode)
 692 {
 693         struct mmc_command cmd = {};
 694
 695         /*
 696          * eMMC specification specifies that CMD12 can be used to stop a tuning
 697          * command, but SD specification does not, so do nothing unless it is
 698          * eMMC.
 699          */
 700         if (opcode != MMC_SEND_TUNING_BLOCK_HS200)
 701                 return 0;
 702
 703         cmd.opcode = MMC_STOP_TRANSMISSION;
 704         cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
 705
 706         /*
 707          * For drivers that override R1 to R1b, set an arbitrary timeout based
 708          * on the tuning timeout i.e. 150ms.
 709          */
 710         cmd.busy_timeout = 150;
 711
 712         return mmc_wait_for_cmd(host, &cmd, 0);
 713 }
 714 EXPORT_SYMBOL_GPL(mmc_abort_tuning);
 715
 716 static int
 717 mmc_send_bus_test(struct mmc_card *card, struct mmc_host *host, u8 opcode,
 718                   u8 len)
 719 {
 720         struct mmc_request mrq = {};
 721         struct mmc_command cmd = {};
 722         struct mmc_data data = {};
 723         struct scatterlist sg;
 724         u8 *data_buf;
 725         u8 *test_buf;
 726         int i, err;
 727         static u8 testdata_8bit[8] = { 0x55, 0xaa, 0, 0, 0, 0, 0, 0 };
 728         static u8 testdata_4bit[4] = { 0x5a, 0, 0, 0 };
 729
 730         /* dma onto stack is unsafe/nonportable, but callers to this
 731          * routine normally provide temporary on-stack buffers ...
 732          */
 733         data_buf = kmalloc(len, GFP_KERNEL);
 734         if (!data_buf)
 735                 return -ENOMEM;
 736
 737         if (len == 8)
 738                 test_buf = testdata_8bit;
 739         else if (len == 4)
 740                 test_buf = testdata_4bit;
 741         else {
 742                 pr_err("%s: Invalid bus_width %d\n",
 743                        mmc_hostname(host), len);
 744                 kfree(data_buf);
 745                 return -EINVAL;
 746         }
 747
 748         if (opcode == MMC_BUS_TEST_W)
 749                 memcpy(data_buf, test_buf, len);
 750
 751         mrq.cmd = &cmd;
 752         mrq.data = &data;
 753         cmd.opcode = opcode;
 754         cmd.arg = 0;
 755
 756         /* NOTE HACK:  the MMC_RSP_SPI_R1 is always correct here, but we
 757          * rely on callers to never use this with "native" calls for reading
 758          * CSD or CID.  Native versions of those commands use the R2 type,
 759          * not R1 plus a data block.
 760          */
 761         cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
 762
 763         data.blksz = len;
 764         data.blocks = 1;
 765         if (opcode == MMC_BUS_TEST_R)
 766                 data.flags = MMC_DATA_READ;
 767         else
 768                 data.flags = MMC_DATA_WRITE;
 769
 770         data.sg = &sg;
 771         data.sg_len = 1;
 772         mmc_set_data_timeout(&data, card);
 773         sg_init_one(&sg, data_buf, len);
 774         mmc_wait_for_req(host, &mrq);
 775         err = 0;
 776         if (opcode == MMC_BUS_TEST_R) {
 777                 for (i = 0; i < len / 4; i++)
 778                         if ((test_buf[i] ^ data_buf[i]) != 0xff) {
 779                                 err = -EIO;
 780                                 break;
 781                         }
 782         }
 783         kfree(data_buf);
 784
 785         if (cmd.error)
 786                 return cmd.error;
 787         if (data.error)
 788                 return data.error;
 789
 790         return err;
 791 }
 792
 793 int mmc_bus_test(struct mmc_card *card, u8 bus_width)
 794 {
 795         int width;
 796
 797         if (bus_width == MMC_BUS_WIDTH_8)
 798                 width = 8;
 799         else if (bus_width == MMC_BUS_WIDTH_4)
 800                 width = 4;
 801         else if (bus_width == MMC_BUS_WIDTH_1)
 802                 return 0; /* no need for test */
 803         else
 804                 return -EINVAL;
 805
 806         /*
 807          * Ignore errors from BUS_TEST_W.  BUS_TEST_R will fail if there
 808          * is a problem.  This improves chances that the test will work.
 809          */
 810         mmc_send_bus_test(card, card->host, MMC_BUS_TEST_W, width);
 811         return mmc_send_bus_test(card, card->host, MMC_BUS_TEST_R, width);
 812 }
 813
 814 static int mmc_send_hpi_cmd(struct mmc_card *card, u32 *status)
 815 {
 816         struct mmc_command cmd = {};
 817         unsigned int opcode;
 818         int err;
 819
 820         opcode = card->ext_csd.hpi_cmd;
 821         if (opcode == MMC_STOP_TRANSMISSION)
 822                 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
 823         else if (opcode == MMC_SEND_STATUS)
 824                 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
 825
 826         cmd.opcode = opcode;
 827         cmd.arg = card->rca << 16 | 1;
 828
 829         err = mmc_wait_for_cmd(card->host, &cmd, 0);
 830         if (err) {
 831                 pr_warn("%s: error %d interrupting operation. "
 832                         "HPI command response %#x\n", mmc_hostname(card->host),
 833                         err, cmd.resp[0]);
 834                 return err;
 835         }
 836         if (status)
 837                 *status = cmd.resp[0];
 838
 839         return 0;
 840 }
 841
 842 /**
 843  *      mmc_interrupt_hpi - Issue for High priority Interrupt
 844  *      @card: the MMC card associated with the HPI transfer
 845  *
 846  *      Issued High Priority Interrupt, and check for card status
 847  *      until out-of prg-state.
 848  */
 849 int mmc_interrupt_hpi(struct mmc_card *card)
 850 {
 851         int err;
 852         u32 status;
 853         unsigned long prg_wait;
 854
 855         if (!card->ext_csd.hpi_en) {
 856                 pr_info("%s: HPI enable bit unset\n", mmc_hostname(card->host));
 857                 return 1;
 858         }
 859
 860         err = mmc_send_status(card, &status);
 861         if (err) {
 862                 pr_err("%s: Get card status fail\n", mmc_hostname(card->host));
 863                 goto out;
 864         }
 865
 866         switch (R1_CURRENT_STATE(status)) {
 867         case R1_STATE_IDLE:
 868         case R1_STATE_READY:
 869         case R1_STATE_STBY:
 870         case R1_STATE_TRAN:
 871                 /*
 872                  * In idle and transfer states, HPI is not needed and the caller
 873                  * can issue the next intended command immediately
 874                  */
 875                 goto out;
 876         case R1_STATE_PRG:
 877                 break;
 878         default:
 879                 /* In all other states, it's illegal to issue HPI */
 880                 pr_debug("%s: HPI cannot be sent. Card state=%d\n",
 881                         mmc_hostname(card->host), R1_CURRENT_STATE(status));
 882                 err = -EINVAL;
 883                 goto out;
 884         }
 885
 886         err = mmc_send_hpi_cmd(card, &status);
 887         if (err)
 888                 goto out;
 889
 890         prg_wait = jiffies + msecs_to_jiffies(card->ext_csd.out_of_int_time);
 891         do {
 892                 err = mmc_send_status(card, &status);
 893
 894                 if (!err && R1_CURRENT_STATE(status) == R1_STATE_TRAN)
 895                         break;
 896                 if (time_after(jiffies, prg_wait))
 897                         err = -ETIMEDOUT;
 898         } while (!err);
 899
 900 out:
 901         return err;
 902 }
 903
 904 int mmc_can_ext_csd(struct mmc_card *card)
 905 {
 906         return (card && card->csd.mmca_vsn > CSD_SPEC_VER_3);
 907 }
 908
 909 static int mmc_read_bkops_status(struct mmc_card *card)
 910 {
 911         int err;
 912         u8 *ext_csd;
 913
 914         err = mmc_get_ext_csd(card, &ext_csd);
 915         if (err)
 916                 return err;
 917
 918         card->ext_csd.raw_bkops_status = ext_csd[EXT_CSD_BKOPS_STATUS];
 919         card->ext_csd.raw_exception_status = ext_csd[EXT_CSD_EXP_EVENTS_STATUS];
 920         kfree(ext_csd);
 921         return 0;
 922 }
 923
 924 /**
 925  *      mmc_run_bkops - Run BKOPS for supported cards
 926  *      @card: MMC card to run BKOPS for
 927  *
 928  *      Run background operations synchronously for cards having manual BKOPS
 929  *      enabled and in case it reports urgent BKOPS level.
 930 */
 931 void mmc_run_bkops(struct mmc_card *card)
 932 {
 933         int err;
 934
 935         if (!card->ext_csd.man_bkops_en)
 936                 return;
 937
 938         err = mmc_read_bkops_status(card);
 939         if (err) {
 940                 pr_err("%s: Failed to read bkops status: %d\n",
 941                        mmc_hostname(card->host), err);
 942                 return;
 943         }
 944
 945         if (!card->ext_csd.raw_bkops_status ||
 946             card->ext_csd.raw_bkops_status < EXT_CSD_BKOPS_LEVEL_2)
 947                 return;
 948
 949         mmc_retune_hold(card->host);
 950
 951         /*
 952          * For urgent BKOPS status, LEVEL_2 and higher, let's execute
 953          * synchronously. Future wise, we may consider to start BKOPS, for less
 954          * urgent levels by using an asynchronous background task, when idle.
 955          */
 956         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
 957                          EXT_CSD_BKOPS_START, 1, MMC_BKOPS_TIMEOUT_MS);
 958         if (err)
 959                 pr_warn("%s: Error %d starting bkops\n",
 960                         mmc_hostname(card->host), err);
 961
 962         mmc_retune_release(card->host);
 963 }
 964 EXPORT_SYMBOL(mmc_run_bkops);
 965
 966 /*
 967  * Flush the cache to the non-volatile storage.
 968  */
 969 int mmc_flush_cache(struct mmc_card *card)
 970 {
 971         int err = 0;
 972
 973         if (mmc_card_mmc(card) &&
 974                         (card->ext_csd.cache_size > 0) &&
 975                         (card->ext_csd.cache_ctrl & 1)) {
 976                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
 977                                  EXT_CSD_FLUSH_CACHE, 1,
 978                                  MMC_CACHE_FLUSH_TIMEOUT_MS);
 979                 if (err)
 980                         pr_err("%s: cache flush error %d\n",
 981                                         mmc_hostname(card->host), err);
 982         }
 983
 984         return err;
 985 }
 986 EXPORT_SYMBOL(mmc_flush_cache);
 987
 988 static int mmc_cmdq_switch(struct mmc_card *card, bool enable)
 989 {
 990         u8 val = enable ? EXT_CSD_CMDQ_MODE_ENABLED : 0;
 991         int err;
 992
 993         if (!card->ext_csd.cmdq_support)
 994                 return -EOPNOTSUPP;
 995
 996         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_CMDQ_MODE_EN,
 997                          val, card->ext_csd.generic_cmd6_time);
 998         if (!err)
 999                 card->ext_csd.cmdq_en = enable;
1000
1001         return err;
1002 }
1003
1004 int mmc_cmdq_enable(struct mmc_card *card)
1005 {
1006         return mmc_cmdq_switch(card, true);
1007 }
1008 EXPORT_SYMBOL_GPL(mmc_cmdq_enable);
1009
1010 int mmc_cmdq_disable(struct mmc_card *card)
1011 {
1012         return mmc_cmdq_switch(card, false);
1013 }
1014 EXPORT_SYMBOL_GPL(mmc_cmdq_disable);