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