1
2
3
4
5
6
7
8
9
10
11
12#include <linux/slab.h>
13#include <linux/types.h>
14#include <linux/export.h>
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
25int mmc_app_cmd(struct mmc_host *host, struct mmc_card *card)
26{
27 int err;
28 struct mmc_command cmd = {};
29
30 if (WARN_ON(card && card->host != host))
31 return -EINVAL;
32
33 cmd.opcode = MMC_APP_CMD;
34
35 if (card) {
36 cmd.arg = card->rca << 16;
37 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
38 } else {
39 cmd.arg = 0;
40 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_BCR;
41 }
42
43 err = mmc_wait_for_cmd(host, &cmd, 0);
44 if (err)
45 return err;
46
47
48 if (!mmc_host_is_spi(host) && !(cmd.resp[0] & R1_APP_CMD))
49 return -EOPNOTSUPP;
50
51 return 0;
52}
53EXPORT_SYMBOL_GPL(mmc_app_cmd);
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68int mmc_wait_for_app_cmd(struct mmc_host *host, struct mmc_card *card,
69 struct mmc_command *cmd, int retries)
70{
71 struct mmc_request mrq = {};
72
73 int i, err;
74
75 if (retries < 0)
76 retries = MMC_CMD_RETRIES;
77
78 err = -EIO;
79
80
81
82
83
84 for (i = 0;i <= retries;i++) {
85 err = mmc_app_cmd(host, card);
86 if (err) {
87
88 if (mmc_host_is_spi(host)) {
89 if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND)
90 break;
91 }
92 continue;
93 }
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;
106 if (!cmd->error)
107 break;
108
109
110 if (mmc_host_is_spi(host)) {
111 if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND)
112 break;
113 }
114 }
115
116 return err;
117}
118
119EXPORT_SYMBOL(mmc_wait_for_app_cmd);
120
121int mmc_app_set_bus_width(struct mmc_card *card, int width)
122{
123 struct mmc_command cmd = {};
124
125 cmd.opcode = SD_APP_SET_BUS_WIDTH;
126 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
127
128 switch (width) {
129 case MMC_BUS_WIDTH_1:
130 cmd.arg = SD_BUS_WIDTH_1;
131 break;
132 case MMC_BUS_WIDTH_4:
133 cmd.arg = SD_BUS_WIDTH_4;
134 break;
135 default:
136 return -EINVAL;
137 }
138
139 return mmc_wait_for_app_cmd(card->host, card, &cmd, MMC_CMD_RETRIES);
140}
141
142int mmc_send_app_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
143{
144 struct mmc_command cmd = {};
145 int i, err = 0;
146
147 cmd.opcode = SD_APP_OP_COND;
148 if (mmc_host_is_spi(host))
149 cmd.arg = ocr & (1 << 30);
150 else
151 cmd.arg = ocr;
152 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR;
153
154 for (i = 100; i; i--) {
155 err = mmc_wait_for_app_cmd(host, NULL, &cmd, MMC_CMD_RETRIES);
156 if (err)
157 break;
158
159
160 if (ocr == 0)
161 break;
162
163
164 if (mmc_host_is_spi(host)) {
165 if (!(cmd.resp[0] & R1_SPI_IDLE))
166 break;
167 } else {
168 if (cmd.resp[0] & MMC_CARD_BUSY)
169 break;
170 }
171
172 err = -ETIMEDOUT;
173
174 mmc_delay(10);
175 }
176
177 if (!i)
178 pr_err("%s: card never left busy state\n", mmc_hostname(host));
179
180 if (rocr && !mmc_host_is_spi(host))
181 *rocr = cmd.resp[0];
182
183 return err;
184}
185
186int mmc_send_if_cond(struct mmc_host *host, u32 ocr)
187{
188 struct mmc_command cmd = {};
189 int err;
190 static const u8 test_pattern = 0xAA;
191 u8 result_pattern;
192
193
194
195
196
197
198 cmd.opcode = SD_SEND_IF_COND;
199 cmd.arg = ((ocr & 0xFF8000) != 0) << 8 | test_pattern;
200 cmd.flags = MMC_RSP_SPI_R7 | MMC_RSP_R7 | MMC_CMD_BCR;
201
202 err = mmc_wait_for_cmd(host, &cmd, 0);
203 if (err)
204 return err;
205
206 if (mmc_host_is_spi(host))
207 result_pattern = cmd.resp[1] & 0xFF;
208 else
209 result_pattern = cmd.resp[0] & 0xFF;
210
211 if (result_pattern != test_pattern)
212 return -EIO;
213
214 return 0;
215}
216
217int mmc_send_relative_addr(struct mmc_host *host, unsigned int *rca)
218{
219 int err;
220 struct mmc_command cmd = {};
221
222 cmd.opcode = SD_SEND_RELATIVE_ADDR;
223 cmd.arg = 0;
224 cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR;
225
226 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
227 if (err)
228 return err;
229
230 *rca = cmd.resp[0] >> 16;
231
232 return 0;
233}
234
235int mmc_app_send_scr(struct mmc_card *card, u32 *scr)
236{
237 int err;
238 struct mmc_request mrq = {};
239 struct mmc_command cmd = {};
240 struct mmc_data data = {};
241 struct scatterlist sg;
242 void *data_buf;
243
244
245
246 err = mmc_app_cmd(card->host, card);
247 if (err)
248 return err;
249
250
251
252
253 data_buf = kmalloc(sizeof(card->raw_scr), GFP_KERNEL);
254 if (data_buf == NULL)
255 return -ENOMEM;
256
257 mrq.cmd = &cmd;
258 mrq.data = &data;
259
260 cmd.opcode = SD_APP_SEND_SCR;
261 cmd.arg = 0;
262 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
263
264 data.blksz = 8;
265 data.blocks = 1;
266 data.flags = MMC_DATA_READ;
267 data.sg = &sg;
268 data.sg_len = 1;
269
270 sg_init_one(&sg, data_buf, 8);
271
272 mmc_set_data_timeout(&data, card);
273
274 mmc_wait_for_req(card->host, &mrq);
275
276 memcpy(scr, data_buf, sizeof(card->raw_scr));
277 kfree(data_buf);
278
279 if (cmd.error)
280 return cmd.error;
281 if (data.error)
282 return data.error;
283
284 scr[0] = be32_to_cpu(scr[0]);
285 scr[1] = be32_to_cpu(scr[1]);
286
287 return 0;
288}
289
290int mmc_sd_switch(struct mmc_card *card, int mode, int group,
291 u8 value, u8 *resp)
292{
293 struct mmc_request mrq = {};
294 struct mmc_command cmd = {};
295 struct mmc_data data = {};
296 struct scatterlist sg;
297
298
299
300 mode = !!mode;
301 value &= 0xF;
302
303 mrq.cmd = &cmd;
304 mrq.data = &data;
305
306 cmd.opcode = SD_SWITCH;
307 cmd.arg = mode << 31 | 0x00FFFFFF;
308 cmd.arg &= ~(0xF << (group * 4));
309 cmd.arg |= value << (group * 4);
310 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
311
312 data.blksz = 64;
313 data.blocks = 1;
314 data.flags = MMC_DATA_READ;
315 data.sg = &sg;
316 data.sg_len = 1;
317
318 sg_init_one(&sg, resp, 64);
319
320 mmc_set_data_timeout(&data, card);
321
322 mmc_wait_for_req(card->host, &mrq);
323
324 if (cmd.error)
325 return cmd.error;
326 if (data.error)
327 return data.error;
328
329 return 0;
330}
331
332int mmc_app_sd_status(struct mmc_card *card, void *ssr)
333{
334 int err;
335 struct mmc_request mrq = {};
336 struct mmc_command cmd = {};
337 struct mmc_data data = {};
338 struct scatterlist sg;
339
340
341
342 err = mmc_app_cmd(card->host, card);
343 if (err)
344 return err;
345
346 mrq.cmd = &cmd;
347 mrq.data = &data;
348
349 cmd.opcode = SD_APP_SD_STATUS;
350 cmd.arg = 0;
351 cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_ADTC;
352
353 data.blksz = 64;
354 data.blocks = 1;
355 data.flags = MMC_DATA_READ;
356 data.sg = &sg;
357 data.sg_len = 1;
358
359 sg_init_one(&sg, ssr, 64);
360
361 mmc_set_data_timeout(&data, card);
362
363 mmc_wait_for_req(card->host, &mrq);
364
365 if (cmd.error)
366 return cmd.error;
367 if (data.error)
368 return data.error;
369
370 return 0;
371}
372