]> Git Repo - qemu.git/blame - hw/sd/ssi-sd.c
Merge remote-tracking branch 'remotes/jnsnow/tags/ide-pull-request' into staging
[qemu.git] / hw / sd / ssi-sd.c
CommitLineData
775616c3
PB
1/*
2 * SSI to SD card adapter.
3 *
5493e33f 4 * Copyright (c) 2007-2009 CodeSourcery.
775616c3
PB
5 * Written by Paul Brook
6 *
8e31bf38 7 * This code is licensed under the GNU GPL v2.
6b620ca3
PB
8 *
9 * Contributions after 2012-01-13 are licensed under the terms of the
10 * GNU GPL, version 2 or (at your option) any later version.
775616c3
PB
11 */
12
0430891c 13#include "qemu/osdep.h"
fa1d36df 14#include "sysemu/block-backend.h"
9c17d615 15#include "sysemu/blockdev.h"
8fd06719 16#include "hw/ssi/ssi.h"
e3382ef0 17#include "hw/sd/sd.h"
775616c3
PB
18
19//#define DEBUG_SSI_SD 1
20
21#ifdef DEBUG_SSI_SD
001faf32
BS
22#define DPRINTF(fmt, ...) \
23do { printf("ssi_sd: " fmt , ## __VA_ARGS__); } while (0)
24#define BADF(fmt, ...) \
25do { fprintf(stderr, "ssi_sd: error: " fmt , ## __VA_ARGS__); exit(1);} while (0)
775616c3 26#else
001faf32
BS
27#define DPRINTF(fmt, ...) do {} while(0)
28#define BADF(fmt, ...) \
29do { fprintf(stderr, "ssi_sd: error: " fmt , ## __VA_ARGS__);} while (0)
775616c3
PB
30#endif
31
32typedef enum {
33 SSI_SD_CMD,
34 SSI_SD_CMDARG,
35 SSI_SD_RESPONSE,
36 SSI_SD_DATA_START,
37 SSI_SD_DATA_READ,
38} ssi_sd_mode;
39
40typedef struct {
5493e33f 41 SSISlave ssidev;
775616c3
PB
42 ssi_sd_mode mode;
43 int cmd;
44 uint8_t cmdarg[4];
45 uint8_t response[5];
46 int arglen;
47 int response_pos;
48 int stopping;
49 SDState *sd;
50} ssi_sd_state;
51
52/* State word bits. */
53#define SSI_SDR_LOCKED 0x0001
54#define SSI_SDR_WP_ERASE 0x0002
55#define SSI_SDR_ERROR 0x0004
56#define SSI_SDR_CC_ERROR 0x0008
57#define SSI_SDR_ECC_FAILED 0x0010
58#define SSI_SDR_WP_VIOLATION 0x0020
59#define SSI_SDR_ERASE_PARAM 0x0040
60#define SSI_SDR_OUT_OF_RANGE 0x0080
61#define SSI_SDR_IDLE 0x0100
62#define SSI_SDR_ERASE_RESET 0x0200
63#define SSI_SDR_ILLEGAL_COMMAND 0x0400
64#define SSI_SDR_COM_CRC_ERROR 0x0800
65#define SSI_SDR_ERASE_SEQ_ERROR 0x1000
66#define SSI_SDR_ADDRESS_ERROR 0x2000
67#define SSI_SDR_PARAMETER_ERROR 0x4000
68
5493e33f 69static uint32_t ssi_sd_transfer(SSISlave *dev, uint32_t val)
775616c3 70{
5493e33f 71 ssi_sd_state *s = FROM_SSI_SLAVE(ssi_sd_state, dev);
775616c3
PB
72
73 /* Special case: allow CMD12 (STOP TRANSMISSION) while reading data. */
74 if (s->mode == SSI_SD_DATA_READ && val == 0x4d) {
75 s->mode = SSI_SD_CMD;
76 /* There must be at least one byte delay before the card responds. */
77 s->stopping = 1;
78 }
79
80 switch (s->mode) {
81 case SSI_SD_CMD:
82 if (val == 0xff) {
83 DPRINTF("NULL command\n");
84 return 0xff;
85 }
86 s->cmd = val & 0x3f;
87 s->mode = SSI_SD_CMDARG;
88 s->arglen = 0;
89 return 0xff;
90 case SSI_SD_CMDARG:
91 if (s->arglen == 4) {
bc24a225 92 SDRequest request;
775616c3
PB
93 uint8_t longresp[16];
94 /* FIXME: Check CRC. */
95 request.cmd = s->cmd;
96 request.arg = (s->cmdarg[0] << 24) | (s->cmdarg[1] << 16)
97 | (s->cmdarg[2] << 8) | s->cmdarg[3];
98 DPRINTF("CMD%d arg 0x%08x\n", s->cmd, request.arg);
99 s->arglen = sd_do_command(s->sd, &request, longresp);
100 if (s->arglen <= 0) {
101 s->arglen = 1;
102 s->response[0] = 4;
103 DPRINTF("SD command failed\n");
104 } else if (s->cmd == 58) {
105 /* CMD58 returns R3 response (OCR) */
106 DPRINTF("Returned OCR\n");
107 s->arglen = 5;
108 s->response[0] = 1;
109 memcpy(&s->response[1], longresp, 4);
110 } else if (s->arglen != 4) {
111 BADF("Unexpected response to cmd %d\n", s->cmd);
112 /* Illegal command is about as near as we can get. */
113 s->arglen = 1;
114 s->response[0] = 4;
115 } else {
116 /* All other commands return status. */
117 uint32_t cardstatus;
118 uint16_t status;
119 /* CMD13 returns a 2-byte statuse work. Other commands
120 only return the first byte. */
121 s->arglen = (s->cmd == 13) ? 2 : 1;
122 cardstatus = (longresp[0] << 24) | (longresp[1] << 16)
123 | (longresp[2] << 8) | longresp[3];
124 status = 0;
125 if (((cardstatus >> 9) & 0xf) < 4)
126 status |= SSI_SDR_IDLE;
127 if (cardstatus & ERASE_RESET)
128 status |= SSI_SDR_ERASE_RESET;
129 if (cardstatus & ILLEGAL_COMMAND)
130 status |= SSI_SDR_ILLEGAL_COMMAND;
131 if (cardstatus & COM_CRC_ERROR)
132 status |= SSI_SDR_COM_CRC_ERROR;
133 if (cardstatus & ERASE_SEQ_ERROR)
134 status |= SSI_SDR_ERASE_SEQ_ERROR;
135 if (cardstatus & ADDRESS_ERROR)
136 status |= SSI_SDR_ADDRESS_ERROR;
137 if (cardstatus & CARD_IS_LOCKED)
138 status |= SSI_SDR_LOCKED;
139 if (cardstatus & (LOCK_UNLOCK_FAILED | WP_ERASE_SKIP))
140 status |= SSI_SDR_WP_ERASE;
141 if (cardstatus & SD_ERROR)
142 status |= SSI_SDR_ERROR;
143 if (cardstatus & CC_ERROR)
144 status |= SSI_SDR_CC_ERROR;
145 if (cardstatus & CARD_ECC_FAILED)
146 status |= SSI_SDR_ECC_FAILED;
147 if (cardstatus & WP_VIOLATION)
148 status |= SSI_SDR_WP_VIOLATION;
149 if (cardstatus & ERASE_PARAM)
150 status |= SSI_SDR_ERASE_PARAM;
151 if (cardstatus & (OUT_OF_RANGE | CID_CSD_OVERWRITE))
152 status |= SSI_SDR_OUT_OF_RANGE;
153 /* ??? Don't know what Parameter Error really means, so
154 assume it's set if the second byte is nonzero. */
155 if (status & 0xff)
156 status |= SSI_SDR_PARAMETER_ERROR;
157 s->response[0] = status >> 8;
158 s->response[1] = status;
159 DPRINTF("Card status 0x%02x\n", status);
160 }
161 s->mode = SSI_SD_RESPONSE;
162 s->response_pos = 0;
163 } else {
164 s->cmdarg[s->arglen++] = val;
165 }
166 return 0xff;
167 case SSI_SD_RESPONSE:
168 if (s->stopping) {
169 s->stopping = 0;
170 return 0xff;
171 }
172 if (s->response_pos < s->arglen) {
173 DPRINTF("Response 0x%02x\n", s->response[s->response_pos]);
174 return s->response[s->response_pos++];
175 }
176 if (sd_data_ready(s->sd)) {
177 DPRINTF("Data read\n");
178 s->mode = SSI_SD_DATA_START;
179 } else {
180 DPRINTF("End of command\n");
181 s->mode = SSI_SD_CMD;
182 }
183 return 0xff;
184 case SSI_SD_DATA_START:
185 DPRINTF("Start read block\n");
186 s->mode = SSI_SD_DATA_READ;
187 return 0xfe;
188 case SSI_SD_DATA_READ:
189 val = sd_read_data(s->sd);
190 if (!sd_data_ready(s->sd)) {
191 DPRINTF("Data read end\n");
192 s->mode = SSI_SD_CMD;
193 }
194 return val;
195 }
196 /* Should never happen. */
197 return 0xff;
198}
199
23e39294
PB
200static void ssi_sd_save(QEMUFile *f, void *opaque)
201{
66530953 202 SSISlave *ss = SSI_SLAVE(opaque);
23e39294
PB
203 ssi_sd_state *s = (ssi_sd_state *)opaque;
204 int i;
205
206 qemu_put_be32(f, s->mode);
207 qemu_put_be32(f, s->cmd);
208 for (i = 0; i < 4; i++)
209 qemu_put_be32(f, s->cmdarg[i]);
210 for (i = 0; i < 5; i++)
211 qemu_put_be32(f, s->response[i]);
212 qemu_put_be32(f, s->arglen);
213 qemu_put_be32(f, s->response_pos);
214 qemu_put_be32(f, s->stopping);
66530953
PC
215
216 qemu_put_be32(f, ss->cs);
23e39294
PB
217}
218
219static int ssi_sd_load(QEMUFile *f, void *opaque, int version_id)
220{
66530953 221 SSISlave *ss = SSI_SLAVE(opaque);
23e39294
PB
222 ssi_sd_state *s = (ssi_sd_state *)opaque;
223 int i;
224
225 if (version_id != 1)
226 return -EINVAL;
227
228 s->mode = qemu_get_be32(f);
229 s->cmd = qemu_get_be32(f);
230 for (i = 0; i < 4; i++)
231 s->cmdarg[i] = qemu_get_be32(f);
232 for (i = 0; i < 5; i++)
233 s->response[i] = qemu_get_be32(f);
234 s->arglen = qemu_get_be32(f);
a9c380db
MT
235 if (s->mode == SSI_SD_CMDARG &&
236 (s->arglen < 0 || s->arglen >= ARRAY_SIZE(s->cmdarg))) {
237 return -EINVAL;
238 }
23e39294
PB
239 s->response_pos = qemu_get_be32(f);
240 s->stopping = qemu_get_be32(f);
a9c380db
MT
241 if (s->mode == SSI_SD_RESPONSE &&
242 (s->response_pos < 0 || s->response_pos >= ARRAY_SIZE(s->response) ||
243 (!s->stopping && s->arglen > ARRAY_SIZE(s->response)))) {
244 return -EINVAL;
245 }
23e39294 246
66530953
PC
247 ss->cs = qemu_get_be32(f);
248
23e39294
PB
249 return 0;
250}
251
1a7d9ee6 252static int ssi_sd_init(SSISlave *d)
775616c3 253{
1a7d9ee6
PC
254 DeviceState *dev = DEVICE(d);
255 ssi_sd_state *s = FROM_SSI_SLAVE(ssi_sd_state, d);
13839974 256 DriveInfo *dinfo;
775616c3 257
775616c3 258 s->mode = SSI_SD_CMD;
af9e40aa 259 /* FIXME use a qdev drive property instead of drive_get_next() */
13839974 260 dinfo = drive_get_next(IF_SD);
4be74634 261 s->sd = sd_init(dinfo ? blk_by_legacy_dinfo(dinfo) : NULL, true);
4f8a066b
KW
262 if (s->sd == NULL) {
263 return -1;
264 }
1a7d9ee6 265 register_savevm(dev, "ssi_sd", -1, 1, ssi_sd_save, ssi_sd_load, s);
81a322d4 266 return 0;
775616c3 267}
5493e33f 268
cd6c4cf2
AL
269static void ssi_sd_class_init(ObjectClass *klass, void *data)
270{
271 SSISlaveClass *k = SSI_SLAVE_CLASS(klass);
272
273 k->init = ssi_sd_init;
274 k->transfer = ssi_sd_transfer;
8120e714 275 k->cs_polarity = SSI_CS_LOW;
cd6c4cf2
AL
276}
277
8c43a6f0 278static const TypeInfo ssi_sd_info = {
39bffca2
AL
279 .name = "ssi-sd",
280 .parent = TYPE_SSI_SLAVE,
281 .instance_size = sizeof(ssi_sd_state),
282 .class_init = ssi_sd_class_init,
5493e33f
PB
283};
284
83f7d43a 285static void ssi_sd_register_types(void)
5493e33f 286{
39bffca2 287 type_register_static(&ssi_sd_info);
5493e33f
PB
288}
289
83f7d43a 290type_init(ssi_sd_register_types)
This page took 0.862146 seconds and 4 git commands to generate.