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)
236{
237 int err;
238 struct mmc_request mrq = {};
239 struct mmc_command cmd = {};
240 struct mmc_data data = {};
241 struct scatterlist sg;
242 __be32 *scr;
243
244
245
246 err = mmc_app_cmd(card->host, card);
247 if (err)
248 return err;
249
250
251
252
253 scr = kmalloc(sizeof(card->raw_scr), GFP_KERNEL);
254 if (!scr)
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, scr, 8);
271
272 mmc_set_data_timeout(&data, card);
273
274 mmc_wait_for_req(card->host, &mrq);
275
276 card->raw_scr[0] = be32_to_cpu(scr[0]);
277 card->raw_scr[1] = be32_to_cpu(scr[1]);
278
279 kfree(scr);
280
281 if (cmd.error)
282 return cmd.error;
283 if (data.error)
284 return data.error;
285
286 return 0;
287}
288
289int mmc_sd_switch(struct mmc_card *card, int mode, int group,
290 u8 value, u8 *resp)
291{
292 struct mmc_request mrq = {};
293 struct mmc_command cmd = {};
294 struct mmc_data data = {};
295 struct scatterlist sg;
296
297
298
299 mode = !!mode;
300 value &= 0xF;
301
302 mrq.cmd = &cmd;
303 mrq.data = &data;
304
305 cmd.opcode = SD_SWITCH;
306 cmd.arg = mode << 31 | 0x00FFFFFF;
307 cmd.arg &= ~(0xF << (group * 4));
308 cmd.arg |= value << (group * 4);
309 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
310
311 data.blksz = 64;
312 data.blocks = 1;
313 data.flags = MMC_DATA_READ;
314 data.sg = &sg;
315 data.sg_len = 1;
316
317 sg_init_one(&sg, resp, 64);
318
319 mmc_set_data_timeout(&data, card);
320
321 mmc_wait_for_req(card->host, &mrq);
322
323 if (cmd.error)
324 return cmd.error;
325 if (data.error)
326 return data.error;
327
328 return 0;
329}
330
331int mmc_app_sd_status(struct mmc_card *card, void *ssr)
332{
333 int err;
334 struct mmc_request mrq = {};
335 struct mmc_command cmd = {};
336 struct mmc_data data = {};
337 struct scatterlist sg;
338
339
340
341 err = mmc_app_cmd(card->host, card);
342 if (err)
343 return err;
344
345 mrq.cmd = &cmd;
346 mrq.data = &data;
347
348 cmd.opcode = SD_APP_SD_STATUS;
349 cmd.arg = 0;
350 cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_ADTC;
351
352 data.blksz = 64;
353 data.blocks = 1;
354 data.flags = MMC_DATA_READ;
355 data.sg = &sg;
356 data.sg_len = 1;
357
358 sg_init_one(&sg, ssr, 64);
359
360 mmc_set_data_timeout(&data, card);
361
362 mmc_wait_for_req(card->host, &mrq);
363
364 if (cmd.error)
365 return cmd.error;
366 if (data.error)
367 return data.error;
368
369 return 0;
370}
371