sd_ops.c 7.5 KB
Newer Older
P
Pierre Ossman 已提交
1
/*
P
Pierre Ossman 已提交
2
 *  linux/drivers/mmc/core/sd_ops.h
P
Pierre Ossman 已提交
3 4 5 6 7 8 9 10 11
 *
 *  Copyright 2006-2007 Pierre Ossman
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or (at
 * your option) any later version.
 */

12
#include <linux/slab.h>
P
Pierre Ossman 已提交
13
#include <linux/types.h>
14
#include <linux/export.h>
P
Pierre Ossman 已提交
15 16 17 18 19 20 21 22 23 24
#include <linux/scatterlist.h>

#include <linux/mmc/host.h>
#include <linux/mmc/card.h>
#include <linux/mmc/mmc.h>
#include <linux/mmc/sd.h>

#include "core.h"
#include "sd_ops.h"

25
int mmc_app_cmd(struct mmc_host *host, struct mmc_card *card)
26 27
{
	int err;
28
	struct mmc_command cmd = {0};
29

S
Shawn Lin 已提交
30 31
	if (WARN_ON(card && card->host != host))
		return -EINVAL;
32 33 34 35 36

	cmd.opcode = MMC_APP_CMD;

	if (card) {
		cmd.arg = card->rca << 16;
D
David Brownell 已提交
37
		cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
38 39
	} else {
		cmd.arg = 0;
D
David Brownell 已提交
40
		cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_BCR;
41 42 43
	}

	err = mmc_wait_for_cmd(host, &cmd, 0);
P
Pierre Ossman 已提交
44
	if (err)
45 46 47
		return err;

	/* Check that card supported application commands */
D
David Brownell 已提交
48
	if (!mmc_host_is_spi(host) && !(cmd.resp[0] & R1_APP_CMD))
P
Pierre Ossman 已提交
49
		return -EOPNOTSUPP;
50

P
Pierre Ossman 已提交
51
	return 0;
52
}
53
EXPORT_SYMBOL_GPL(mmc_app_cmd);
54

P
Pierre Ossman 已提交
55 56 57 58
/**
 *	mmc_wait_for_app_cmd - start an application command and wait for
 			       completion
 *	@host: MMC host to start command
P
Pierre Ossman 已提交
59
 *	@card: Card to send MMC_APP_CMD to
P
Pierre Ossman 已提交
60 61 62 63 64 65 66 67 68 69 70
 *	@cmd: MMC command to start
 *	@retries: maximum number of retries
 *
 *	Sends a MMC_APP_CMD, checks the card response, sends the command
 *	in the parameter and waits for it to complete. Return any error
 *	that occurred while the command was executing.  Do not attempt to
 *	parse the response.
 */
int mmc_wait_for_app_cmd(struct mmc_host *host, struct mmc_card *card,
	struct mmc_command *cmd, int retries)
{
71
	struct mmc_request mrq = {NULL};
P
Pierre Ossman 已提交
72 73 74

	int i, err;

S
Shawn Lin 已提交
75 76
	if (retries < 0)
		retries = MMC_CMD_RETRIES;
P
Pierre Ossman 已提交
77

P
Pierre Ossman 已提交
78
	err = -EIO;
P
Pierre Ossman 已提交
79 80 81 82 83 84 85

	/*
	 * We have to resend MMC_APP_CMD for each attempt so
	 * we cannot use the retries field in mmc_command.
	 */
	for (i = 0;i <= retries;i++) {
		err = mmc_app_cmd(host, card);
D
David Brownell 已提交
86 87 88 89 90 91
		if (err) {
			/* no point in retrying; no APP commands allowed */
			if (mmc_host_is_spi(host)) {
				if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND)
					break;
			}
P
Pierre Ossman 已提交
92
			continue;
D
David Brownell 已提交
93
		}
P
Pierre Ossman 已提交
94 95 96 97 98 99 100 101 102 103 104 105

		memset(&mrq, 0, sizeof(struct mmc_request));

		memset(cmd->resp, 0, sizeof(cmd->resp));
		cmd->retries = 0;

		mrq.cmd = cmd;
		cmd->data = NULL;

		mmc_wait_for_req(host, &mrq);

		err = cmd->error;
P
Pierre Ossman 已提交
106
		if (!cmd->error)
P
Pierre Ossman 已提交
107
			break;
D
David Brownell 已提交
108 109 110 111 112 113

		/* no point in retrying illegal APP commands */
		if (mmc_host_is_spi(host)) {
			if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND)
				break;
		}
P
Pierre Ossman 已提交
114 115 116 117 118 119 120 121 122
	}

	return err;
}

EXPORT_SYMBOL(mmc_wait_for_app_cmd);

int mmc_app_set_bus_width(struct mmc_card *card, int width)
{
123
	struct mmc_command cmd = {0};
P
Pierre Ossman 已提交
124 125 126 127 128 129 130 131 132 133 134 135

	cmd.opcode = SD_APP_SET_BUS_WIDTH;
	cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;

	switch (width) {
	case MMC_BUS_WIDTH_1:
		cmd.arg = SD_BUS_WIDTH_1;
		break;
	case MMC_BUS_WIDTH_4:
		cmd.arg = SD_BUS_WIDTH_4;
		break;
	default:
P
Pierre Ossman 已提交
136
		return -EINVAL;
P
Pierre Ossman 已提交
137 138
	}

139
	return mmc_wait_for_app_cmd(card->host, card, &cmd, MMC_CMD_RETRIES);
P
Pierre Ossman 已提交
140 141 142 143
}

int mmc_send_app_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
{
144
	struct mmc_command cmd = {0};
P
Pierre Ossman 已提交
145 146 147
	int i, err = 0;

	cmd.opcode = SD_APP_OP_COND;
D
David Brownell 已提交
148 149 150 151 152
	if (mmc_host_is_spi(host))
		cmd.arg = ocr & (1 << 30); /* SPI only defines one bit */
	else
		cmd.arg = ocr;
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR;
P
Pierre Ossman 已提交
153 154 155

	for (i = 100; i; i--) {
		err = mmc_wait_for_app_cmd(host, NULL, &cmd, MMC_CMD_RETRIES);
P
Pierre Ossman 已提交
156
		if (err)
P
Pierre Ossman 已提交
157 158
			break;

D
David Brownell 已提交
159 160
		/* if we're just probing, do a single pass */
		if (ocr == 0)
P
Pierre Ossman 已提交
161 162
			break;

D
David Brownell 已提交
163 164 165 166 167 168 169 170 171
		/* otherwise wait until reset completes */
		if (mmc_host_is_spi(host)) {
			if (!(cmd.resp[0] & R1_SPI_IDLE))
				break;
		} else {
			if (cmd.resp[0] & MMC_CARD_BUSY)
				break;
		}

P
Pierre Ossman 已提交
172
		err = -ETIMEDOUT;
P
Pierre Ossman 已提交
173 174 175 176

		mmc_delay(10);
	}

177 178 179
	if (!i)
		pr_err("%s: card never left busy state\n", mmc_hostname(host));

D
David Brownell 已提交
180
	if (rocr && !mmc_host_is_spi(host))
P
Pierre Ossman 已提交
181 182 183 184 185 186 187
		*rocr = cmd.resp[0];

	return err;
}

int mmc_send_if_cond(struct mmc_host *host, u32 ocr)
{
188
	struct mmc_command cmd = {0};
P
Pierre Ossman 已提交
189 190
	int err;
	static const u8 test_pattern = 0xAA;
D
David Brownell 已提交
191
	u8 result_pattern;
P
Pierre Ossman 已提交
192 193 194 195 196 197 198 199

	/*
	 * To support SD 2.0 cards, we must always invoke SD_SEND_IF_COND
	 * before SD_APP_OP_COND. This command will harmlessly fail for
	 * SD 1.0 cards.
	 */
	cmd.opcode = SD_SEND_IF_COND;
	cmd.arg = ((ocr & 0xFF8000) != 0) << 8 | test_pattern;
D
David Brownell 已提交
200
	cmd.flags = MMC_RSP_SPI_R7 | MMC_RSP_R7 | MMC_CMD_BCR;
P
Pierre Ossman 已提交
201 202

	err = mmc_wait_for_cmd(host, &cmd, 0);
P
Pierre Ossman 已提交
203
	if (err)
P
Pierre Ossman 已提交
204 205
		return err;

D
David Brownell 已提交
206 207 208 209 210 211
	if (mmc_host_is_spi(host))
		result_pattern = cmd.resp[1] & 0xFF;
	else
		result_pattern = cmd.resp[0] & 0xFF;

	if (result_pattern != test_pattern)
P
Pierre Ossman 已提交
212
		return -EIO;
P
Pierre Ossman 已提交
213

P
Pierre Ossman 已提交
214
	return 0;
P
Pierre Ossman 已提交
215 216 217 218 219
}

int mmc_send_relative_addr(struct mmc_host *host, unsigned int *rca)
{
	int err;
220
	struct mmc_command cmd = {0};
P
Pierre Ossman 已提交
221 222 223 224 225 226

	cmd.opcode = SD_SEND_RELATIVE_ADDR;
	cmd.arg = 0;
	cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR;

	err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
P
Pierre Ossman 已提交
227
	if (err)
P
Pierre Ossman 已提交
228 229 230 231
		return err;

	*rca = cmd.resp[0] >> 16;

P
Pierre Ossman 已提交
232
	return 0;
P
Pierre Ossman 已提交
233 234 235 236 237
}

int mmc_app_send_scr(struct mmc_card *card, u32 *scr)
{
	int err;
238
	struct mmc_request mrq = {NULL};
239
	struct mmc_command cmd = {0};
240
	struct mmc_data data = {0};
P
Pierre Ossman 已提交
241
	struct scatterlist sg;
242
	void *data_buf;
P
Pierre Ossman 已提交
243

D
David Brownell 已提交
244 245
	/* NOTE: caller guarantees scr is heap-allocated */

P
Pierre Ossman 已提交
246
	err = mmc_app_cmd(card->host, card);
P
Pierre Ossman 已提交
247
	if (err)
P
Pierre Ossman 已提交
248 249
		return err;

250 251 252 253 254 255 256
	/* dma onto stack is unsafe/nonportable, but callers to this
	 * routine normally provide temporary on-stack buffers ...
	 */
	data_buf = kmalloc(sizeof(card->raw_scr), GFP_KERNEL);
	if (data_buf == NULL)
		return -ENOMEM;

P
Pierre Ossman 已提交
257 258 259 260 261
	mrq.cmd = &cmd;
	mrq.data = &data;

	cmd.opcode = SD_APP_SEND_SCR;
	cmd.arg = 0;
D
David Brownell 已提交
262
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
P
Pierre Ossman 已提交
263 264 265 266 267 268 269

	data.blksz = 8;
	data.blocks = 1;
	data.flags = MMC_DATA_READ;
	data.sg = &sg;
	data.sg_len = 1;

270
	sg_init_one(&sg, data_buf, 8);
P
Pierre Ossman 已提交
271

272
	mmc_set_data_timeout(&data, card);
P
Pierre Ossman 已提交
273 274 275

	mmc_wait_for_req(card->host, &mrq);

276 277 278
	memcpy(scr, data_buf, sizeof(card->raw_scr));
	kfree(data_buf);

P
Pierre Ossman 已提交
279
	if (cmd.error)
P
Pierre Ossman 已提交
280
		return cmd.error;
P
Pierre Ossman 已提交
281
	if (data.error)
P
Pierre Ossman 已提交
282 283
		return data.error;

P
Pierre Ossman 已提交
284 285
	scr[0] = be32_to_cpu(scr[0]);
	scr[1] = be32_to_cpu(scr[1]);
P
Pierre Ossman 已提交
286

P
Pierre Ossman 已提交
287
	return 0;
P
Pierre Ossman 已提交
288 289 290 291 292
}

int mmc_sd_switch(struct mmc_card *card, int mode, int group,
	u8 value, u8 *resp)
{
293
	struct mmc_request mrq = {NULL};
294
	struct mmc_command cmd = {0};
295
	struct mmc_data data = {0};
P
Pierre Ossman 已提交
296 297
	struct scatterlist sg;

D
David Brownell 已提交
298 299
	/* NOTE: caller guarantees resp is heap-allocated */

P
Pierre Ossman 已提交
300 301 302 303 304 305 306 307 308 309
	mode = !!mode;
	value &= 0xF;

	mrq.cmd = &cmd;
	mrq.data = &data;

	cmd.opcode = SD_SWITCH;
	cmd.arg = mode << 31 | 0x00FFFFFF;
	cmd.arg &= ~(0xF << (group * 4));
	cmd.arg |= value << (group * 4);
D
David Brownell 已提交
310
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
P
Pierre Ossman 已提交
311 312 313 314 315 316 317 318 319

	data.blksz = 64;
	data.blocks = 1;
	data.flags = MMC_DATA_READ;
	data.sg = &sg;
	data.sg_len = 1;

	sg_init_one(&sg, resp, 64);

320
	mmc_set_data_timeout(&data, card);
P
Pierre Ossman 已提交
321 322 323

	mmc_wait_for_req(card->host, &mrq);

P
Pierre Ossman 已提交
324
	if (cmd.error)
P
Pierre Ossman 已提交
325
		return cmd.error;
P
Pierre Ossman 已提交
326
	if (data.error)
P
Pierre Ossman 已提交
327 328
		return data.error;

P
Pierre Ossman 已提交
329
	return 0;
P
Pierre Ossman 已提交
330 331
}

332 333 334
int mmc_app_sd_status(struct mmc_card *card, void *ssr)
{
	int err;
335
	struct mmc_request mrq = {NULL};
336
	struct mmc_command cmd = {0};
337
	struct mmc_data data = {0};
338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371
	struct scatterlist sg;

	/* NOTE: caller guarantees ssr is heap-allocated */

	err = mmc_app_cmd(card->host, card);
	if (err)
		return err;

	mrq.cmd = &cmd;
	mrq.data = &data;

	cmd.opcode = SD_APP_SD_STATUS;
	cmd.arg = 0;
	cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_ADTC;

	data.blksz = 64;
	data.blocks = 1;
	data.flags = MMC_DATA_READ;
	data.sg = &sg;
	data.sg_len = 1;

	sg_init_one(&sg, ssr, 64);

	mmc_set_data_timeout(&data, card);

	mmc_wait_for_req(card->host, &mrq);

	if (cmd.error)
		return cmd.error;
	if (data.error)
		return data.error;

	return 0;
}