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 | { |
| 123 | int err; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 124 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 125 | |
| 126 | BUG_ON(!card); |
| 127 | BUG_ON(!card->host); |
| 128 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 129 | cmd.opcode = SD_APP_SET_BUS_WIDTH; |
| 130 | cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; |
| 131 | |
| 132 | switch (width) { |
| 133 | case MMC_BUS_WIDTH_1: |
| 134 | cmd.arg = SD_BUS_WIDTH_1; |
| 135 | break; |
| 136 | case MMC_BUS_WIDTH_4: |
| 137 | cmd.arg = SD_BUS_WIDTH_4; |
| 138 | break; |
| 139 | default: |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 140 | return -EINVAL; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 141 | } |
| 142 | |
| 143 | err = mmc_wait_for_app_cmd(card->host, card, &cmd, MMC_CMD_RETRIES); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 144 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 145 | return err; |
| 146 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 147 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 148 | } |
| 149 | |
| 150 | int mmc_send_app_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr) |
| 151 | { |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 152 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 153 | int i, err = 0; |
| 154 | |
| 155 | BUG_ON(!host); |
| 156 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 157 | cmd.opcode = SD_APP_OP_COND; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 158 | if (mmc_host_is_spi(host)) |
| 159 | cmd.arg = ocr & (1 << 30); /* SPI only defines one bit */ |
| 160 | else |
| 161 | cmd.arg = ocr; |
| 162 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 163 | |
| 164 | for (i = 100; i; i--) { |
| 165 | err = mmc_wait_for_app_cmd(host, NULL, &cmd, MMC_CMD_RETRIES); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 166 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 167 | break; |
| 168 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 169 | /* if we're just probing, do a single pass */ |
| 170 | if (ocr == 0) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 171 | break; |
| 172 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 173 | /* otherwise wait until reset completes */ |
| 174 | if (mmc_host_is_spi(host)) { |
| 175 | if (!(cmd.resp[0] & R1_SPI_IDLE)) |
| 176 | break; |
| 177 | } else { |
| 178 | if (cmd.resp[0] & MMC_CARD_BUSY) |
| 179 | break; |
| 180 | } |
| 181 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 182 | err = -ETIMEDOUT; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 183 | |
| 184 | mmc_delay(10); |
| 185 | } |
| 186 | |
Johan Rudholm | 5e86366 | 2014-05-23 16:15:03 +0200 | [diff] [blame] | 187 | if (!i) |
| 188 | pr_err("%s: card never left busy state\n", mmc_hostname(host)); |
| 189 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 190 | if (rocr && !mmc_host_is_spi(host)) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 191 | *rocr = cmd.resp[0]; |
| 192 | |
| 193 | return err; |
| 194 | } |
| 195 | |
| 196 | int mmc_send_if_cond(struct mmc_host *host, u32 ocr) |
| 197 | { |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 198 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 199 | int err; |
| 200 | static const u8 test_pattern = 0xAA; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 201 | u8 result_pattern; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 202 | |
| 203 | /* |
| 204 | * To support SD 2.0 cards, we must always invoke SD_SEND_IF_COND |
| 205 | * before SD_APP_OP_COND. This command will harmlessly fail for |
| 206 | * SD 1.0 cards. |
| 207 | */ |
| 208 | cmd.opcode = SD_SEND_IF_COND; |
| 209 | cmd.arg = ((ocr & 0xFF8000) != 0) << 8 | test_pattern; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 210 | cmd.flags = MMC_RSP_SPI_R7 | MMC_RSP_R7 | MMC_CMD_BCR; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 211 | |
| 212 | err = mmc_wait_for_cmd(host, &cmd, 0); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 213 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 214 | return err; |
| 215 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 216 | if (mmc_host_is_spi(host)) |
| 217 | result_pattern = cmd.resp[1] & 0xFF; |
| 218 | else |
| 219 | result_pattern = cmd.resp[0] & 0xFF; |
| 220 | |
| 221 | if (result_pattern != test_pattern) |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 222 | return -EIO; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 223 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 224 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 225 | } |
| 226 | |
| 227 | int mmc_send_relative_addr(struct mmc_host *host, unsigned int *rca) |
| 228 | { |
| 229 | int err; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 230 | struct mmc_command cmd = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 231 | |
| 232 | BUG_ON(!host); |
| 233 | BUG_ON(!rca); |
| 234 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 235 | cmd.opcode = SD_SEND_RELATIVE_ADDR; |
| 236 | cmd.arg = 0; |
| 237 | cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR; |
| 238 | |
| 239 | err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 240 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 241 | return err; |
| 242 | |
| 243 | *rca = cmd.resp[0] >> 16; |
| 244 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 245 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 246 | } |
| 247 | |
| 248 | int mmc_app_send_scr(struct mmc_card *card, u32 *scr) |
| 249 | { |
| 250 | int err; |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 251 | struct mmc_request mrq = {NULL}; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 252 | struct mmc_command cmd = {0}; |
Chris Ball | a61ad2b | 2011-04-13 23:46:05 -0400 | [diff] [blame] | 253 | struct mmc_data data = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 254 | struct scatterlist sg; |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 255 | void *data_buf; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 256 | |
| 257 | BUG_ON(!card); |
| 258 | BUG_ON(!card->host); |
| 259 | BUG_ON(!scr); |
| 260 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 261 | /* NOTE: caller guarantees scr is heap-allocated */ |
| 262 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 263 | err = mmc_app_cmd(card->host, card); |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 264 | if (err) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 265 | return err; |
| 266 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 267 | /* dma onto stack is unsafe/nonportable, but callers to this |
| 268 | * routine normally provide temporary on-stack buffers ... |
| 269 | */ |
| 270 | data_buf = kmalloc(sizeof(card->raw_scr), GFP_KERNEL); |
| 271 | if (data_buf == NULL) |
| 272 | return -ENOMEM; |
| 273 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 274 | mrq.cmd = &cmd; |
| 275 | mrq.data = &data; |
| 276 | |
| 277 | cmd.opcode = SD_APP_SEND_SCR; |
| 278 | cmd.arg = 0; |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 279 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 280 | |
| 281 | data.blksz = 8; |
| 282 | data.blocks = 1; |
| 283 | data.flags = MMC_DATA_READ; |
| 284 | data.sg = &sg; |
| 285 | data.sg_len = 1; |
| 286 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 287 | sg_init_one(&sg, data_buf, 8); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 288 | |
Pierre Ossman | b146d26 | 2007-07-24 19:16:54 +0200 | [diff] [blame] | 289 | mmc_set_data_timeout(&data, card); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 290 | |
| 291 | mmc_wait_for_req(card->host, &mrq); |
| 292 | |
Yoshihiro Shimoda | 4f665cb | 2011-03-25 15:06:19 +0900 | [diff] [blame] | 293 | memcpy(scr, data_buf, sizeof(card->raw_scr)); |
| 294 | kfree(data_buf); |
| 295 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 296 | if (cmd.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 297 | return cmd.error; |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 298 | if (data.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 299 | return data.error; |
| 300 | |
Pierre Ossman | 1fa8dd1 | 2007-10-27 14:41:04 +0200 | [diff] [blame] | 301 | scr[0] = be32_to_cpu(scr[0]); |
| 302 | scr[1] = be32_to_cpu(scr[1]); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 303 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 304 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 305 | } |
| 306 | |
| 307 | int mmc_sd_switch(struct mmc_card *card, int mode, int group, |
| 308 | u8 value, u8 *resp) |
| 309 | { |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 310 | struct mmc_request mrq = {NULL}; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 311 | struct mmc_command cmd = {0}; |
Chris Ball | a61ad2b | 2011-04-13 23:46:05 -0400 | [diff] [blame] | 312 | struct mmc_data data = {0}; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 313 | struct scatterlist sg; |
| 314 | |
| 315 | BUG_ON(!card); |
| 316 | BUG_ON(!card->host); |
| 317 | |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 318 | /* NOTE: caller guarantees resp is heap-allocated */ |
| 319 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 320 | mode = !!mode; |
| 321 | value &= 0xF; |
| 322 | |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 323 | mrq.cmd = &cmd; |
| 324 | mrq.data = &data; |
| 325 | |
| 326 | cmd.opcode = SD_SWITCH; |
| 327 | cmd.arg = mode << 31 | 0x00FFFFFF; |
| 328 | cmd.arg &= ~(0xF << (group * 4)); |
| 329 | cmd.arg |= value << (group * 4); |
David Brownell | af51715 | 2007-08-08 09:11:32 -0700 | [diff] [blame] | 330 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 331 | |
| 332 | data.blksz = 64; |
| 333 | data.blocks = 1; |
| 334 | data.flags = MMC_DATA_READ; |
| 335 | data.sg = &sg; |
| 336 | data.sg_len = 1; |
| 337 | |
| 338 | sg_init_one(&sg, resp, 64); |
| 339 | |
Pierre Ossman | b146d26 | 2007-07-24 19:16:54 +0200 | [diff] [blame] | 340 | mmc_set_data_timeout(&data, card); |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 341 | |
| 342 | mmc_wait_for_req(card->host, &mrq); |
| 343 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 344 | if (cmd.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 345 | return cmd.error; |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 346 | if (data.error) |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 347 | return data.error; |
| 348 | |
Pierre Ossman | 17b0429 | 2007-07-22 22:18:46 +0200 | [diff] [blame] | 349 | return 0; |
Pierre Ossman | da7fbe5 | 2006-12-24 22:46:55 +0100 | [diff] [blame] | 350 | } |
| 351 | |
Adrian Hunter | dfe86cb | 2010-08-11 14:17:46 -0700 | [diff] [blame] | 352 | int mmc_app_sd_status(struct mmc_card *card, void *ssr) |
| 353 | { |
| 354 | int err; |
Venkatraman S | ad5fd97 | 2011-08-25 00:30:50 +0530 | [diff] [blame] | 355 | struct mmc_request mrq = {NULL}; |
Chris Ball | 1278dba | 2011-04-13 23:40:30 -0400 | [diff] [blame] | 356 | struct mmc_command cmd = {0}; |
Chris Ball | a61ad2b | 2011-04-13 23:46:05 -0400 | [diff] [blame] | 357 | struct mmc_data data = {0}; |
Adrian Hunter | dfe86cb | 2010-08-11 14:17:46 -0700 | [diff] [blame] | 358 | struct scatterlist sg; |
| 359 | |
| 360 | BUG_ON(!card); |
| 361 | BUG_ON(!card->host); |
| 362 | BUG_ON(!ssr); |
| 363 | |
| 364 | /* NOTE: caller guarantees ssr is heap-allocated */ |
| 365 | |
| 366 | err = mmc_app_cmd(card->host, card); |
| 367 | if (err) |
| 368 | return err; |
| 369 | |
Adrian Hunter | dfe86cb | 2010-08-11 14:17:46 -0700 | [diff] [blame] | 370 | mrq.cmd = &cmd; |
| 371 | mrq.data = &data; |
| 372 | |
| 373 | cmd.opcode = SD_APP_SD_STATUS; |
| 374 | cmd.arg = 0; |
| 375 | cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_ADTC; |
| 376 | |
| 377 | data.blksz = 64; |
| 378 | data.blocks = 1; |
| 379 | data.flags = MMC_DATA_READ; |
| 380 | data.sg = &sg; |
| 381 | data.sg_len = 1; |
| 382 | |
| 383 | sg_init_one(&sg, ssr, 64); |
| 384 | |
| 385 | mmc_set_data_timeout(&data, card); |
| 386 | |
| 387 | mmc_wait_for_req(card->host, &mrq); |
| 388 | |
| 389 | if (cmd.error) |
| 390 | return cmd.error; |
| 391 | if (data.error) |
| 392 | return data.error; |
| 393 | |
| 394 | return 0; |
| 395 | } |