Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 1 | /* |
Pierre Ossman | 70f1048 | 2007-07-11 20:04:50 +0200 | [diff] [blame] | 2 | * linux/drivers/mmc/core/sd_ops.h |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 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 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 12 | #include <linux/slab.h> |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 13 | #include <linux/types.h> |
Paul Gortmaker | 3ef77af | 2011-07-10 12:42:00 -0400 | [diff] [blame] | 14 | #include <linux/export.h> |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 15 | #include <linux/scatterlist.h> |
| 16 | |
| 17 | #include <linux/mmc/host.h> |
| 18 | #include <linux/mmc/card.h> |
| 19 | #include <linux/mmc/mmc.h> |
| 20 | #include <linux/mmc/sd.h> |
| 21 | |
| 22 | #include "core.h" |
| 23 | #include "sd_ops.h" |
| 24 | |
John Calixto | cb87ea2 | 2011-04-26 18:56:29 -0400 | [diff] [blame] | 25 | int mmc_app_cmd(struct mmc_host *host, struct mmc_card *card) |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 26 | { |
| 27 | int err; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 28 | struct mmc_command cmd = {0}; |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 29 | |
| 30 | BUG_ON(!host); |
| 31 | BUG_ON(card && (card->host != host)); |
| 32 | |
| 33 | cmd.opcode = MMC_APP_CMD; |
| 34 | |
| 35 | if (card) { |
| 36 | cmd.arg = card->rca << 16; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 37 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC; |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 38 | } else { |
| 39 | cmd.arg = 0; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 40 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_BCR; |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 41 | } |
| 42 | |
| 43 | err = mmc_wait_for_cmd(host, &cmd, 0); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 44 | if (err) |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 45 | return err; |
| 46 | |
| 47 | /* Check that card supported application commands */ |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 48 | if (!mmc_host_is_spi(host) && !(cmd.resp[0] & R1_APP_CMD)) |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 49 | return -EOPNOTSUPP; |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 50 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 51 | return 0; |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 52 | } |
John Calixto | cb87ea2 | 2011-04-26 18:56:29 -0400 | [diff] [blame] | 53 | EXPORT_SYMBOL_GPL(mmc_app_cmd); |
Adrian Bunk | 3936185 | 2007-07-25 00:40:58 +0200 | [diff] [blame] | 54 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 55 | /** |
| 56 | * mmc_wait_for_app_cmd - start an application command and wait for |
| 57 | completion |
| 58 | * @host: MMC host to start command |
Pierre Ossman | 67a61c4 | 2007-07-11 20:22:11 +0200 | [diff] [blame] | 59 | * @card: Card to send MMC_APP_CMD to |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 60 | * @cmd: MMC command to start |
| 61 | * @retries: maximum number of retries |
| 62 | * |
| 63 | * Sends a MMC_APP_CMD, checks the card response, sends the command |
| 64 | * in the parameter and waits for it to complete. Return any error |
| 65 | * that occurred while the command was executing. Do not attempt to |
| 66 | * parse the response. |
| 67 | */ |
| 68 | int mmc_wait_for_app_cmd(struct mmc_host *host, struct mmc_card *card, |
| 69 | struct mmc_command *cmd, int retries) |
| 70 | { |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 71 | struct mmc_request mrq = {NULL}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 72 | |
| 73 | int i, err; |
| 74 | |
| 75 | BUG_ON(!cmd); |
| 76 | BUG_ON(retries < 0); |
| 77 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 78 | err = -EIO; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 79 | |
| 80 | /* |
| 81 | * We have to resend MMC_APP_CMD for each attempt so |
| 82 | * we cannot use the retries field in mmc_command. |
| 83 | */ |
| 84 | for (i = 0;i <= retries;i++) { |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 85 | err = mmc_app_cmd(host, card); |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 86 | if (err) { |
| 87 | /* no point in retrying; no APP commands allowed */ |
| 88 | if (mmc_host_is_spi(host)) { |
| 89 | if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND) |
| 90 | break; |
| 91 | } |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 92 | continue; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 93 | } |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 94 | |
| 95 | memset(&mrq, 0, sizeof(struct mmc_request)); |
| 96 | |
| 97 | memset(cmd->resp, 0, sizeof(cmd->resp)); |
| 98 | cmd->retries = 0; |
| 99 | |
| 100 | mrq.cmd = cmd; |
| 101 | cmd->data = NULL; |
| 102 | |
| 103 | mmc_wait_for_req(host, &mrq); |
| 104 | |
| 105 | err = cmd->error; |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 106 | if (!cmd->error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 107 | break; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 108 | |
| 109 | /* no point in retrying illegal APP commands */ |
| 110 | if (mmc_host_is_spi(host)) { |
| 111 | if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND) |
| 112 | break; |
| 113 | } |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 114 | } |
| 115 | |
| 116 | return err; |
| 117 | } |
| 118 | |
| 119 | EXPORT_SYMBOL(mmc_wait_for_app_cmd); |
| 120 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 121 | int mmc_app_set_bus_width(struct mmc_card *card, int width) |
| 122 | { |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 123 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 124 | |
| 125 | BUG_ON(!card); |
| 126 | BUG_ON(!card->host); |
| 127 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 128 | cmd.opcode = SD_APP_SET_BUS_WIDTH; |
| 129 | cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; |
| 130 | |
| 131 | switch (width) { |
| 132 | case MMC_BUS_WIDTH_1: |
| 133 | cmd.arg = SD_BUS_WIDTH_1; |
| 134 | break; |
| 135 | case MMC_BUS_WIDTH_4: |
| 136 | cmd.arg = SD_BUS_WIDTH_4; |
| 137 | break; |
| 138 | default: |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 139 | return -EINVAL; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 140 | } |
| 141 | |
Masahiro Yamada | 0899e74 | 2016-01-08 11:15:25 +0900 | [diff] [blame] | 142 | return mmc_wait_for_app_cmd(card->host, card, &cmd, MMC_CMD_RETRIES); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 143 | } |
| 144 | |
| 145 | int mmc_send_app_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr) |
| 146 | { |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 147 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 148 | int i, err = 0; |
| 149 | |
| 150 | BUG_ON(!host); |
| 151 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 152 | cmd.opcode = SD_APP_OP_COND; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 153 | if (mmc_host_is_spi(host)) |
| 154 | cmd.arg = ocr & (1 << 30); /* SPI only defines one bit */ |
| 155 | else |
| 156 | cmd.arg = ocr; |
| 157 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 158 | |
| 159 | for (i = 100; i; i--) { |
| 160 | err = mmc_wait_for_app_cmd(host, NULL, &cmd, MMC_CMD_RETRIES); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 161 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 162 | break; |
| 163 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 164 | /* if we're just probing, do a single pass */ |
| 165 | if (ocr == 0) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 166 | break; |
| 167 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 168 | /* otherwise wait until reset completes */ |
| 169 | if (mmc_host_is_spi(host)) { |
| 170 | if (!(cmd.resp[0] & R1_SPI_IDLE)) |
| 171 | break; |
| 172 | } else { |
| 173 | if (cmd.resp[0] & MMC_CARD_BUSY) |
| 174 | break; |
| 175 | } |
| 176 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 177 | err = -ETIMEDOUT; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 178 | |
| 179 | mmc_delay(10); |
| 180 | } |
| 181 | |
Johan Rudholm | 5e86366 | 2014-05-23 16:15:03 +0200 | [diff] [blame] | 182 | if (!i) |
| 183 | pr_err("%s: card never left busy state\n", mmc_hostname(host)); |
| 184 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 185 | if (rocr && !mmc_host_is_spi(host)) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 186 | *rocr = cmd.resp[0]; |
| 187 | |
| 188 | return err; |
| 189 | } |
| 190 | |
| 191 | int mmc_send_if_cond(struct mmc_host *host, u32 ocr) |
| 192 | { |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 193 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 194 | int err; |
| 195 | static const u8 test_pattern = 0xAA; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 196 | u8 result_pattern; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 197 | |
| 198 | /* |
| 199 | * To support SD 2.0 cards, we must always invoke SD_SEND_IF_COND |
| 200 | * before SD_APP_OP_COND. This command will harmlessly fail for |
| 201 | * SD 1.0 cards. |
| 202 | */ |
| 203 | cmd.opcode = SD_SEND_IF_COND; |
| 204 | cmd.arg = ((ocr & 0xFF8000) != 0) << 8 | test_pattern; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 205 | cmd.flags = MMC_RSP_SPI_R7 | MMC_RSP_R7 | MMC_CMD_BCR; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 206 | |
| 207 | err = mmc_wait_for_cmd(host, &cmd, 0); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 208 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 209 | return err; |
| 210 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 211 | if (mmc_host_is_spi(host)) |
| 212 | result_pattern = cmd.resp[1] & 0xFF; |
| 213 | else |
| 214 | result_pattern = cmd.resp[0] & 0xFF; |
| 215 | |
| 216 | if (result_pattern != test_pattern) |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 217 | return -EIO; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 218 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 219 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 220 | } |
| 221 | |
| 222 | int mmc_send_relative_addr(struct mmc_host *host, unsigned int *rca) |
| 223 | { |
| 224 | int err; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 225 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 226 | |
| 227 | BUG_ON(!host); |
| 228 | BUG_ON(!rca); |
| 229 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 230 | cmd.opcode = SD_SEND_RELATIVE_ADDR; |
| 231 | cmd.arg = 0; |
| 232 | cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR; |
| 233 | |
| 234 | err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 235 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 236 | return err; |
| 237 | |
| 238 | *rca = cmd.resp[0] >> 16; |
| 239 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 240 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 241 | } |
| 242 | |
| 243 | int mmc_app_send_scr(struct mmc_card *card, u32 *scr) |
| 244 | { |
| 245 | int err; |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 246 | struct mmc_request mrq = {NULL}; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 247 | struct mmc_command cmd = {0}; |
Chris Ball | a61ad2b | 2011-04-13 23:46:05 -0400 | [diff] [blame] | 248 | struct mmc_data data = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 249 | struct scatterlist sg; |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 250 | void *data_buf; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 251 | |
| 252 | BUG_ON(!card); |
| 253 | BUG_ON(!card->host); |
| 254 | BUG_ON(!scr); |
| 255 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 256 | /* NOTE: caller guarantees scr is heap-allocated */ |
| 257 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 258 | err = mmc_app_cmd(card->host, card); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 259 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 260 | return err; |
| 261 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 262 | /* dma onto stack is unsafe/nonportable, but callers to this |
| 263 | * routine normally provide temporary on-stack buffers ... |
| 264 | */ |
| 265 | data_buf = kmalloc(sizeof(card->raw_scr), GFP_KERNEL); |
| 266 | if (data_buf == NULL) |
| 267 | return -ENOMEM; |
| 268 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 269 | mrq.cmd = &cmd; |
| 270 | mrq.data = &data; |
| 271 | |
| 272 | cmd.opcode = SD_APP_SEND_SCR; |
| 273 | cmd.arg = 0; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 274 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 275 | |
| 276 | data.blksz = 8; |
| 277 | data.blocks = 1; |
| 278 | data.flags = MMC_DATA_READ; |
| 279 | data.sg = &sg; |
| 280 | data.sg_len = 1; |
| 281 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 282 | sg_init_one(&sg, data_buf, 8); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 283 | |
Pierre Ossman | b146d26 | 2007-07-24 19:16:54 +0200 | [diff] [blame] | 284 | mmc_set_data_timeout(&data, card); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 285 | |
| 286 | mmc_wait_for_req(card->host, &mrq); |
| 287 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 288 | memcpy(scr, data_buf, sizeof(card->raw_scr)); |
| 289 | kfree(data_buf); |
| 290 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 291 | if (cmd.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 292 | return cmd.error; |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 293 | if (data.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 294 | return data.error; |
| 295 | |
Pierre Ossman | 1fa8dd1 | 2007-10-27 14:41:04 +0200 | [diff] [blame] | 296 | scr[0] = be32_to_cpu(scr[0]); |
| 297 | scr[1] = be32_to_cpu(scr[1]); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 298 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 299 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 300 | } |
| 301 | |
| 302 | int mmc_sd_switch(struct mmc_card *card, int mode, int group, |
| 303 | u8 value, u8 *resp) |
| 304 | { |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 305 | struct mmc_request mrq = {NULL}; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 306 | struct mmc_command cmd = {0}; |
Chris Ball | a61ad2b | 2011-04-13 23:46:05 -0400 | [diff] [blame] | 307 | struct mmc_data data = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 308 | struct scatterlist sg; |
| 309 | |
| 310 | BUG_ON(!card); |
| 311 | BUG_ON(!card->host); |
| 312 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 313 | /* NOTE: caller guarantees resp is heap-allocated */ |
| 314 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 315 | mode = !!mode; |
| 316 | value &= 0xF; |
| 317 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 318 | mrq.cmd = &cmd; |
| 319 | mrq.data = &data; |
| 320 | |
| 321 | cmd.opcode = SD_SWITCH; |
| 322 | cmd.arg = mode << 31 | 0x00FFFFFF; |
| 323 | cmd.arg &= ~(0xF << (group * 4)); |
| 324 | cmd.arg |= value << (group * 4); |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 325 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 326 | |
| 327 | data.blksz = 64; |
| 328 | data.blocks = 1; |
| 329 | data.flags = MMC_DATA_READ; |
| 330 | data.sg = &sg; |
| 331 | data.sg_len = 1; |
| 332 | |
| 333 | sg_init_one(&sg, resp, 64); |
| 334 | |
Pierre Ossman | b146d26 | 2007-07-24 19:16:54 +0200 | [diff] [blame] | 335 | mmc_set_data_timeout(&data, card); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 336 | |
| 337 | mmc_wait_for_req(card->host, &mrq); |
| 338 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 339 | if (cmd.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 340 | return cmd.error; |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 341 | if (data.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 342 | return data.error; |
| 343 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 344 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 345 | } |
| 346 | |
Adrian Hunter | dfe86cb | 2010-08-11 14:17:46 -0700 | [diff] [blame] | 347 | int mmc_app_sd_status(struct mmc_card *card, void *ssr) |
| 348 | { |
| 349 | int err; |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 350 | struct mmc_request mrq = {NULL}; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 351 | struct mmc_command cmd = {0}; |
Chris Ball | a61ad2b | 2011-04-13 23:46:05 -0400 | [diff] [blame] | 352 | struct mmc_data data = {0}; |
Adrian Hunter | dfe86cb | 2010-08-11 14:17:46 -0700 | [diff] [blame] | 353 | struct scatterlist sg; |
| 354 | |
| 355 | BUG_ON(!card); |
| 356 | BUG_ON(!card->host); |
| 357 | BUG_ON(!ssr); |
| 358 | |
| 359 | /* NOTE: caller guarantees ssr is heap-allocated */ |
| 360 | |
| 361 | err = mmc_app_cmd(card->host, card); |
| 362 | if (err) |
| 363 | return err; |
| 364 | |
Adrian Hunter | dfe86cb | 2010-08-11 14:17:46 -0700 | [diff] [blame] | 365 | mrq.cmd = &cmd; |
| 366 | mrq.data = &data; |
| 367 | |
| 368 | cmd.opcode = SD_APP_SD_STATUS; |
| 369 | cmd.arg = 0; |
| 370 | cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_ADTC; |
| 371 | |
| 372 | data.blksz = 64; |
| 373 | data.blocks = 1; |
| 374 | data.flags = MMC_DATA_READ; |
| 375 | data.sg = &sg; |
| 376 | data.sg_len = 1; |
| 377 | |
| 378 | sg_init_one(&sg, ssr, 64); |
| 379 | |
| 380 | mmc_set_data_timeout(&data, card); |
| 381 | |
| 382 | mmc_wait_for_req(card->host, &mrq); |
| 383 | |
| 384 | if (cmd.error) |
| 385 | return cmd.error; |
| 386 | if (data.error) |
| 387 | return data.error; |
| 388 | |
| 389 | return 0; |
| 390 | } |