]>
Commit | Line | Data |
---|---|---|
a171fe39 AZ |
1 | /* |
2 | * Intel XScale PXA255/270 MultiMediaCard/SD/SDIO Controller emulation. | |
3 | * | |
4 | * Copyright (c) 2006 Openedhand Ltd. | |
5 | * Written by Andrzej Zaborowski <[email protected]> | |
6 | * | |
7 | * This code is licensed under the GPLv2. | |
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. | |
a171fe39 AZ |
11 | */ |
12 | ||
8ef94f0b | 13 | #include "qemu/osdep.h" |
da34e65c | 14 | #include "qapi/error.h" |
83c9f4ca | 15 | #include "hw/hw.h" |
7a9468c9 | 16 | #include "hw/sysbus.h" |
0d09e41a | 17 | #include "hw/arm/pxa.h" |
e3382ef0 | 18 | #include "hw/sd/sd.h" |
83c9f4ca | 19 | #include "hw/qdev.h" |
7a9468c9 | 20 | #include "hw/qdev-properties.h" |
a9563e75 | 21 | #include "qemu/error-report.h" |
487b406a PMD |
22 | #include "qemu/log.h" |
23 | #include "trace.h" | |
7a9468c9 PM |
24 | |
25 | #define TYPE_PXA2XX_MMCI "pxa2xx-mmci" | |
26 | #define PXA2XX_MMCI(obj) OBJECT_CHECK(PXA2xxMMCIState, (obj), TYPE_PXA2XX_MMCI) | |
a171fe39 | 27 | |
a9563e75 PM |
28 | #define TYPE_PXA2XX_MMCI_BUS "pxa2xx-mmci-bus" |
29 | #define PXA2XX_MMCI_BUS(obj) OBJECT_CHECK(SDBus, (obj), TYPE_PXA2XX_MMCI_BUS) | |
30 | ||
bc24a225 | 31 | struct PXA2xxMMCIState { |
7a9468c9 PM |
32 | SysBusDevice parent_obj; |
33 | ||
2bf90458 | 34 | MemoryRegion iomem; |
a171fe39 | 35 | qemu_irq irq; |
2115c019 AZ |
36 | qemu_irq rx_dma; |
37 | qemu_irq tx_dma; | |
a9563e75 PM |
38 | qemu_irq inserted; |
39 | qemu_irq readonly; | |
a171fe39 | 40 | |
7a9468c9 | 41 | BlockBackend *blk; |
a9563e75 | 42 | SDBus sdbus; |
a171fe39 AZ |
43 | |
44 | uint32_t status; | |
45 | uint32_t clkrt; | |
46 | uint32_t spi; | |
47 | uint32_t cmdat; | |
48 | uint32_t resp_tout; | |
49 | uint32_t read_tout; | |
19d25e0a PM |
50 | int32_t blklen; |
51 | int32_t numblk; | |
a171fe39 AZ |
52 | uint32_t intmask; |
53 | uint32_t intreq; | |
19d25e0a | 54 | int32_t cmd; |
a171fe39 AZ |
55 | uint32_t arg; |
56 | ||
19d25e0a PM |
57 | int32_t active; |
58 | int32_t bytesleft; | |
a171fe39 | 59 | uint8_t tx_fifo[64]; |
19d25e0a PM |
60 | uint32_t tx_start; |
61 | uint32_t tx_len; | |
a171fe39 | 62 | uint8_t rx_fifo[32]; |
19d25e0a PM |
63 | uint32_t rx_start; |
64 | uint32_t rx_len; | |
a171fe39 | 65 | uint16_t resp_fifo[9]; |
19d25e0a | 66 | uint32_t resp_len; |
a171fe39 | 67 | |
19d25e0a PM |
68 | int32_t cmdreq; |
69 | }; | |
70 | ||
71 | static bool pxa2xx_mmci_vmstate_validate(void *opaque, int version_id) | |
72 | { | |
73 | PXA2xxMMCIState *s = opaque; | |
74 | ||
75 | return s->tx_start < ARRAY_SIZE(s->tx_fifo) | |
76 | && s->rx_start < ARRAY_SIZE(s->rx_fifo) | |
77 | && s->tx_len <= ARRAY_SIZE(s->tx_fifo) | |
78 | && s->rx_len <= ARRAY_SIZE(s->rx_fifo) | |
79 | && s->resp_len <= ARRAY_SIZE(s->resp_fifo); | |
80 | } | |
81 | ||
82 | ||
83 | static const VMStateDescription vmstate_pxa2xx_mmci = { | |
84 | .name = "pxa2xx-mmci", | |
85 | .version_id = 2, | |
86 | .minimum_version_id = 2, | |
87 | .fields = (VMStateField[]) { | |
88 | VMSTATE_UINT32(status, PXA2xxMMCIState), | |
89 | VMSTATE_UINT32(clkrt, PXA2xxMMCIState), | |
90 | VMSTATE_UINT32(spi, PXA2xxMMCIState), | |
91 | VMSTATE_UINT32(cmdat, PXA2xxMMCIState), | |
92 | VMSTATE_UINT32(resp_tout, PXA2xxMMCIState), | |
93 | VMSTATE_UINT32(read_tout, PXA2xxMMCIState), | |
94 | VMSTATE_INT32(blklen, PXA2xxMMCIState), | |
95 | VMSTATE_INT32(numblk, PXA2xxMMCIState), | |
96 | VMSTATE_UINT32(intmask, PXA2xxMMCIState), | |
97 | VMSTATE_UINT32(intreq, PXA2xxMMCIState), | |
98 | VMSTATE_INT32(cmd, PXA2xxMMCIState), | |
99 | VMSTATE_UINT32(arg, PXA2xxMMCIState), | |
100 | VMSTATE_INT32(cmdreq, PXA2xxMMCIState), | |
101 | VMSTATE_INT32(active, PXA2xxMMCIState), | |
102 | VMSTATE_INT32(bytesleft, PXA2xxMMCIState), | |
103 | VMSTATE_UINT32(tx_start, PXA2xxMMCIState), | |
104 | VMSTATE_UINT32(tx_len, PXA2xxMMCIState), | |
105 | VMSTATE_UINT32(rx_start, PXA2xxMMCIState), | |
106 | VMSTATE_UINT32(rx_len, PXA2xxMMCIState), | |
107 | VMSTATE_UINT32(resp_len, PXA2xxMMCIState), | |
108 | VMSTATE_VALIDATE("fifo size incorrect", pxa2xx_mmci_vmstate_validate), | |
109 | VMSTATE_UINT8_ARRAY(tx_fifo, PXA2xxMMCIState, 64), | |
110 | VMSTATE_UINT8_ARRAY(rx_fifo, PXA2xxMMCIState, 32), | |
111 | VMSTATE_UINT16_ARRAY(resp_fifo, PXA2xxMMCIState, 9), | |
112 | VMSTATE_END_OF_LIST() | |
113 | } | |
a171fe39 AZ |
114 | }; |
115 | ||
116 | #define MMC_STRPCL 0x00 /* MMC Clock Start/Stop register */ | |
117 | #define MMC_STAT 0x04 /* MMC Status register */ | |
118 | #define MMC_CLKRT 0x08 /* MMC Clock Rate register */ | |
119 | #define MMC_SPI 0x0c /* MMC SPI Mode register */ | |
120 | #define MMC_CMDAT 0x10 /* MMC Command/Data register */ | |
121 | #define MMC_RESTO 0x14 /* MMC Response Time-Out register */ | |
122 | #define MMC_RDTO 0x18 /* MMC Read Time-Out register */ | |
123 | #define MMC_BLKLEN 0x1c /* MMC Block Length register */ | |
124 | #define MMC_NUMBLK 0x20 /* MMC Number of Blocks register */ | |
125 | #define MMC_PRTBUF 0x24 /* MMC Buffer Partly Full register */ | |
126 | #define MMC_I_MASK 0x28 /* MMC Interrupt Mask register */ | |
127 | #define MMC_I_REG 0x2c /* MMC Interrupt Request register */ | |
128 | #define MMC_CMD 0x30 /* MMC Command register */ | |
129 | #define MMC_ARGH 0x34 /* MMC Argument High register */ | |
130 | #define MMC_ARGL 0x38 /* MMC Argument Low register */ | |
131 | #define MMC_RES 0x3c /* MMC Response FIFO */ | |
132 | #define MMC_RXFIFO 0x40 /* MMC Receive FIFO */ | |
133 | #define MMC_TXFIFO 0x44 /* MMC Transmit FIFO */ | |
134 | #define MMC_RDWAIT 0x48 /* MMC RD_WAIT register */ | |
135 | #define MMC_BLKS_REM 0x4c /* MMC Blocks Remaining register */ | |
136 | ||
137 | /* Bitfield masks */ | |
138 | #define STRPCL_STOP_CLK (1 << 0) | |
139 | #define STRPCL_STRT_CLK (1 << 1) | |
140 | #define STAT_TOUT_RES (1 << 1) | |
141 | #define STAT_CLK_EN (1 << 8) | |
142 | #define STAT_DATA_DONE (1 << 11) | |
143 | #define STAT_PRG_DONE (1 << 12) | |
144 | #define STAT_END_CMDRES (1 << 13) | |
145 | #define SPI_SPI_MODE (1 << 0) | |
146 | #define CMDAT_RES_TYPE (3 << 0) | |
147 | #define CMDAT_DATA_EN (1 << 2) | |
148 | #define CMDAT_WR_RD (1 << 3) | |
149 | #define CMDAT_DMA_EN (1 << 7) | |
150 | #define CMDAT_STOP_TRAN (1 << 10) | |
151 | #define INT_DATA_DONE (1 << 0) | |
152 | #define INT_PRG_DONE (1 << 1) | |
153 | #define INT_END_CMD (1 << 2) | |
154 | #define INT_STOP_CMD (1 << 3) | |
155 | #define INT_CLK_OFF (1 << 4) | |
156 | #define INT_RXFIFO_REQ (1 << 5) | |
157 | #define INT_TXFIFO_REQ (1 << 6) | |
158 | #define INT_TINT (1 << 7) | |
159 | #define INT_DAT_ERR (1 << 8) | |
160 | #define INT_RES_ERR (1 << 9) | |
161 | #define INT_RD_STALLED (1 << 10) | |
162 | #define INT_SDIO_INT (1 << 11) | |
163 | #define INT_SDIO_SACK (1 << 12) | |
164 | #define PRTBUF_PRT_BUF (1 << 0) | |
165 | ||
166 | /* Route internal interrupt lines to the global IC and DMA */ | |
bc24a225 | 167 | static void pxa2xx_mmci_int_update(PXA2xxMMCIState *s) |
a171fe39 AZ |
168 | { |
169 | uint32_t mask = s->intmask; | |
170 | if (s->cmdat & CMDAT_DMA_EN) { | |
171 | mask |= INT_RXFIFO_REQ | INT_TXFIFO_REQ; | |
172 | ||
2115c019 AZ |
173 | qemu_set_irq(s->rx_dma, !!(s->intreq & INT_RXFIFO_REQ)); |
174 | qemu_set_irq(s->tx_dma, !!(s->intreq & INT_TXFIFO_REQ)); | |
a171fe39 AZ |
175 | } |
176 | ||
177 | qemu_set_irq(s->irq, !!(s->intreq & ~mask)); | |
178 | } | |
179 | ||
bc24a225 | 180 | static void pxa2xx_mmci_fifo_update(PXA2xxMMCIState *s) |
a171fe39 AZ |
181 | { |
182 | if (!s->active) | |
183 | return; | |
184 | ||
185 | if (s->cmdat & CMDAT_WR_RD) { | |
186 | while (s->bytesleft && s->tx_len) { | |
a9563e75 | 187 | sdbus_write_data(&s->sdbus, s->tx_fifo[s->tx_start++]); |
a171fe39 AZ |
188 | s->tx_start &= 0x1f; |
189 | s->tx_len --; | |
190 | s->bytesleft --; | |
191 | } | |
192 | if (s->bytesleft) | |
193 | s->intreq |= INT_TXFIFO_REQ; | |
194 | } else | |
195 | while (s->bytesleft && s->rx_len < 32) { | |
196 | s->rx_fifo[(s->rx_start + (s->rx_len ++)) & 0x1f] = | |
a9563e75 | 197 | sdbus_read_data(&s->sdbus); |
a171fe39 AZ |
198 | s->bytesleft --; |
199 | s->intreq |= INT_RXFIFO_REQ; | |
200 | } | |
201 | ||
202 | if (!s->bytesleft) { | |
203 | s->active = 0; | |
204 | s->intreq |= INT_DATA_DONE; | |
205 | s->status |= STAT_DATA_DONE; | |
206 | ||
207 | if (s->cmdat & CMDAT_WR_RD) { | |
208 | s->intreq |= INT_PRG_DONE; | |
209 | s->status |= STAT_PRG_DONE; | |
210 | } | |
211 | } | |
212 | ||
213 | pxa2xx_mmci_int_update(s); | |
214 | } | |
215 | ||
bc24a225 | 216 | static void pxa2xx_mmci_wakequeues(PXA2xxMMCIState *s) |
a171fe39 AZ |
217 | { |
218 | int rsplen, i; | |
bc24a225 | 219 | SDRequest request; |
a171fe39 AZ |
220 | uint8_t response[16]; |
221 | ||
222 | s->active = 1; | |
223 | s->rx_len = 0; | |
224 | s->tx_len = 0; | |
225 | s->cmdreq = 0; | |
226 | ||
227 | request.cmd = s->cmd; | |
228 | request.arg = s->arg; | |
229 | request.crc = 0; /* FIXME */ | |
230 | ||
a9563e75 | 231 | rsplen = sdbus_do_command(&s->sdbus, &request, response); |
a171fe39 AZ |
232 | s->intreq |= INT_END_CMD; |
233 | ||
234 | memset(s->resp_fifo, 0, sizeof(s->resp_fifo)); | |
235 | switch (s->cmdat & CMDAT_RES_TYPE) { | |
236 | #define PXAMMCI_RESP(wd, value0, value1) \ | |
237 | s->resp_fifo[(wd) + 0] |= (value0); \ | |
238 | s->resp_fifo[(wd) + 1] |= (value1) << 8; | |
239 | case 0: /* No response */ | |
240 | goto complete; | |
241 | ||
242 | case 1: /* R1, R4, R5 or R6 */ | |
243 | if (rsplen < 4) | |
244 | goto timeout; | |
245 | goto complete; | |
246 | ||
247 | case 2: /* R2 */ | |
248 | if (rsplen < 16) | |
249 | goto timeout; | |
250 | goto complete; | |
251 | ||
252 | case 3: /* R3 */ | |
253 | if (rsplen < 4) | |
254 | goto timeout; | |
255 | goto complete; | |
256 | ||
257 | complete: | |
258 | for (i = 0; rsplen > 0; i ++, rsplen -= 2) { | |
259 | PXAMMCI_RESP(i, response[i * 2], response[i * 2 + 1]); | |
260 | } | |
261 | s->status |= STAT_END_CMDRES; | |
262 | ||
263 | if (!(s->cmdat & CMDAT_DATA_EN)) | |
264 | s->active = 0; | |
265 | else | |
266 | s->bytesleft = s->numblk * s->blklen; | |
267 | ||
268 | s->resp_len = 0; | |
269 | break; | |
270 | ||
271 | timeout: | |
272 | s->active = 0; | |
273 | s->status |= STAT_TOUT_RES; | |
274 | break; | |
275 | } | |
276 | ||
277 | pxa2xx_mmci_fifo_update(s); | |
278 | } | |
279 | ||
13e1e476 | 280 | static uint64_t pxa2xx_mmci_read(void *opaque, hwaddr offset, unsigned size) |
a171fe39 | 281 | { |
bc24a225 | 282 | PXA2xxMMCIState *s = (PXA2xxMMCIState *) opaque; |
487b406a | 283 | uint32_t ret = 0; |
a171fe39 AZ |
284 | |
285 | switch (offset) { | |
286 | case MMC_STRPCL: | |
487b406a | 287 | break; |
a171fe39 | 288 | case MMC_STAT: |
487b406a PMD |
289 | ret = s->status; |
290 | break; | |
a171fe39 | 291 | case MMC_CLKRT: |
487b406a PMD |
292 | ret = s->clkrt; |
293 | break; | |
a171fe39 | 294 | case MMC_SPI: |
487b406a PMD |
295 | ret = s->spi; |
296 | break; | |
a171fe39 | 297 | case MMC_CMDAT: |
487b406a PMD |
298 | ret = s->cmdat; |
299 | break; | |
a171fe39 | 300 | case MMC_RESTO: |
487b406a PMD |
301 | ret = s->resp_tout; |
302 | break; | |
a171fe39 | 303 | case MMC_RDTO: |
487b406a PMD |
304 | ret = s->read_tout; |
305 | break; | |
a171fe39 | 306 | case MMC_BLKLEN: |
487b406a PMD |
307 | ret = s->blklen; |
308 | break; | |
a171fe39 | 309 | case MMC_NUMBLK: |
487b406a PMD |
310 | ret = s->numblk; |
311 | break; | |
a171fe39 | 312 | case MMC_PRTBUF: |
487b406a | 313 | break; |
a171fe39 | 314 | case MMC_I_MASK: |
487b406a PMD |
315 | ret = s->intmask; |
316 | break; | |
a171fe39 | 317 | case MMC_I_REG: |
487b406a PMD |
318 | ret = s->intreq; |
319 | break; | |
a171fe39 | 320 | case MMC_CMD: |
487b406a PMD |
321 | ret = s->cmd | 0x40; |
322 | break; | |
a171fe39 | 323 | case MMC_ARGH: |
487b406a PMD |
324 | ret = s->arg >> 16; |
325 | break; | |
a171fe39 | 326 | case MMC_ARGL: |
487b406a PMD |
327 | ret = s->arg & 0xffff; |
328 | break; | |
a171fe39 | 329 | case MMC_RES: |
487b406a PMD |
330 | ret = (s->resp_len < 9) ? s->resp_fifo[s->resp_len++] : 0; |
331 | break; | |
a171fe39 | 332 | case MMC_RXFIFO: |
13e1e476 PM |
333 | while (size-- && s->rx_len) { |
334 | ret |= s->rx_fifo[s->rx_start++] << (size << 3); | |
a171fe39 AZ |
335 | s->rx_start &= 0x1f; |
336 | s->rx_len --; | |
337 | } | |
338 | s->intreq &= ~INT_RXFIFO_REQ; | |
339 | pxa2xx_mmci_fifo_update(s); | |
487b406a | 340 | break; |
a171fe39 | 341 | case MMC_RDWAIT: |
487b406a | 342 | break; |
a171fe39 | 343 | case MMC_BLKS_REM: |
487b406a PMD |
344 | ret = s->numblk; |
345 | break; | |
a171fe39 | 346 | default: |
487b406a PMD |
347 | qemu_log_mask(LOG_GUEST_ERROR, |
348 | "%s: incorrect register 0x%02" HWADDR_PRIx "\n", | |
349 | __func__, offset); | |
a171fe39 | 350 | } |
487b406a | 351 | trace_pxa2xx_mmci_read(size, offset, ret); |
a171fe39 | 352 | |
487b406a | 353 | return ret; |
a171fe39 AZ |
354 | } |
355 | ||
356 | static void pxa2xx_mmci_write(void *opaque, | |
13e1e476 | 357 | hwaddr offset, uint64_t value, unsigned size) |
a171fe39 | 358 | { |
bc24a225 | 359 | PXA2xxMMCIState *s = (PXA2xxMMCIState *) opaque; |
a171fe39 | 360 | |
487b406a | 361 | trace_pxa2xx_mmci_write(size, offset, value); |
a171fe39 AZ |
362 | switch (offset) { |
363 | case MMC_STRPCL: | |
364 | if (value & STRPCL_STRT_CLK) { | |
365 | s->status |= STAT_CLK_EN; | |
366 | s->intreq &= ~INT_CLK_OFF; | |
367 | ||
368 | if (s->cmdreq && !(s->cmdat & CMDAT_STOP_TRAN)) { | |
369 | s->status &= STAT_CLK_EN; | |
370 | pxa2xx_mmci_wakequeues(s); | |
371 | } | |
372 | } | |
373 | ||
374 | if (value & STRPCL_STOP_CLK) { | |
375 | s->status &= ~STAT_CLK_EN; | |
376 | s->intreq |= INT_CLK_OFF; | |
377 | s->active = 0; | |
378 | } | |
379 | ||
380 | pxa2xx_mmci_int_update(s); | |
381 | break; | |
382 | ||
383 | case MMC_CLKRT: | |
384 | s->clkrt = value & 7; | |
385 | break; | |
386 | ||
387 | case MMC_SPI: | |
388 | s->spi = value & 0xf; | |
487b406a PMD |
389 | if (value & SPI_SPI_MODE) { |
390 | qemu_log_mask(LOG_GUEST_ERROR, | |
391 | "%s: attempted to use card in SPI mode\n", __func__); | |
392 | } | |
a171fe39 AZ |
393 | break; |
394 | ||
395 | case MMC_CMDAT: | |
396 | s->cmdat = value & 0x3dff; | |
397 | s->active = 0; | |
398 | s->cmdreq = 1; | |
399 | if (!(value & CMDAT_STOP_TRAN)) { | |
400 | s->status &= STAT_CLK_EN; | |
401 | ||
402 | if (s->status & STAT_CLK_EN) | |
403 | pxa2xx_mmci_wakequeues(s); | |
404 | } | |
405 | ||
406 | pxa2xx_mmci_int_update(s); | |
407 | break; | |
408 | ||
409 | case MMC_RESTO: | |
410 | s->resp_tout = value & 0x7f; | |
411 | break; | |
412 | ||
413 | case MMC_RDTO: | |
414 | s->read_tout = value & 0xffff; | |
415 | break; | |
416 | ||
417 | case MMC_BLKLEN: | |
418 | s->blklen = value & 0xfff; | |
419 | break; | |
420 | ||
421 | case MMC_NUMBLK: | |
422 | s->numblk = value & 0xffff; | |
423 | break; | |
424 | ||
425 | case MMC_PRTBUF: | |
426 | if (value & PRTBUF_PRT_BUF) { | |
427 | s->tx_start ^= 32; | |
428 | s->tx_len = 0; | |
429 | } | |
430 | pxa2xx_mmci_fifo_update(s); | |
431 | break; | |
432 | ||
433 | case MMC_I_MASK: | |
434 | s->intmask = value & 0x1fff; | |
435 | pxa2xx_mmci_int_update(s); | |
436 | break; | |
437 | ||
438 | case MMC_CMD: | |
439 | s->cmd = value & 0x3f; | |
440 | break; | |
441 | ||
442 | case MMC_ARGH: | |
443 | s->arg &= 0x0000ffff; | |
444 | s->arg |= value << 16; | |
445 | break; | |
446 | ||
447 | case MMC_ARGL: | |
448 | s->arg &= 0xffff0000; | |
449 | s->arg |= value & 0x0000ffff; | |
450 | break; | |
451 | ||
452 | case MMC_TXFIFO: | |
13e1e476 | 453 | while (size-- && s->tx_len < 0x20) |
a171fe39 | 454 | s->tx_fifo[(s->tx_start + (s->tx_len ++)) & 0x1f] = |
13e1e476 | 455 | (value >> (size << 3)) & 0xff; |
a171fe39 AZ |
456 | s->intreq &= ~INT_TXFIFO_REQ; |
457 | pxa2xx_mmci_fifo_update(s); | |
458 | break; | |
459 | ||
460 | case MMC_RDWAIT: | |
461 | case MMC_BLKS_REM: | |
462 | break; | |
463 | ||
464 | default: | |
487b406a PMD |
465 | qemu_log_mask(LOG_GUEST_ERROR, |
466 | "%s: incorrect reg 0x%02" HWADDR_PRIx " " | |
467 | "(value 0x%08" PRIx64 ")\n", __func__, offset, value); | |
a171fe39 AZ |
468 | } |
469 | } | |
470 | ||
2bf90458 | 471 | static const MemoryRegionOps pxa2xx_mmci_ops = { |
13e1e476 PM |
472 | .read = pxa2xx_mmci_read, |
473 | .write = pxa2xx_mmci_write, | |
2bf90458 | 474 | .endianness = DEVICE_NATIVE_ENDIAN, |
a171fe39 AZ |
475 | }; |
476 | ||
2bf90458 | 477 | PXA2xxMMCIState *pxa2xx_mmci_init(MemoryRegion *sysmem, |
a8170e5e | 478 | hwaddr base, |
4be74634 | 479 | BlockBackend *blk, qemu_irq irq, |
2115c019 | 480 | qemu_irq rx_dma, qemu_irq tx_dma) |
a171fe39 | 481 | { |
a9563e75 | 482 | DeviceState *dev, *carddev; |
7a9468c9 | 483 | SysBusDevice *sbd; |
bc24a225 | 484 | PXA2xxMMCIState *s; |
a9563e75 | 485 | Error *err = NULL; |
a171fe39 | 486 | |
7a9468c9 PM |
487 | dev = qdev_create(NULL, TYPE_PXA2XX_MMCI); |
488 | s = PXA2XX_MMCI(dev); | |
7a9468c9 PM |
489 | sbd = SYS_BUS_DEVICE(dev); |
490 | sysbus_mmio_map(sbd, 0, base); | |
491 | sysbus_connect_irq(sbd, 0, irq); | |
492 | qdev_connect_gpio_out_named(dev, "rx-dma", 0, rx_dma); | |
493 | qdev_connect_gpio_out_named(dev, "tx-dma", 0, tx_dma); | |
a9563e75 PM |
494 | |
495 | /* Create and plug in the sd card */ | |
496 | carddev = qdev_create(qdev_get_child_bus(dev, "sd-bus"), TYPE_SD_CARD); | |
497 | qdev_prop_set_drive(carddev, "drive", blk, &err); | |
498 | if (err) { | |
499 | error_report("failed to init SD card: %s", error_get_pretty(err)); | |
500 | return NULL; | |
501 | } | |
502 | object_property_set_bool(OBJECT(carddev), true, "realized", &err); | |
503 | if (err) { | |
504 | error_report("failed to init SD card: %s", error_get_pretty(err)); | |
505 | return NULL; | |
506 | } | |
507 | ||
a171fe39 AZ |
508 | return s; |
509 | } | |
510 | ||
a9563e75 PM |
511 | static void pxa2xx_mmci_set_inserted(DeviceState *dev, bool inserted) |
512 | { | |
513 | PXA2xxMMCIState *s = PXA2XX_MMCI(dev); | |
514 | ||
515 | qemu_set_irq(s->inserted, inserted); | |
516 | } | |
517 | ||
518 | static void pxa2xx_mmci_set_readonly(DeviceState *dev, bool readonly) | |
519 | { | |
520 | PXA2xxMMCIState *s = PXA2XX_MMCI(dev); | |
521 | ||
522 | qemu_set_irq(s->readonly, readonly); | |
523 | } | |
524 | ||
bc24a225 | 525 | void pxa2xx_mmci_handlers(PXA2xxMMCIState *s, qemu_irq readonly, |
7a9468c9 | 526 | qemu_irq coverswitch) |
a171fe39 | 527 | { |
a9563e75 PM |
528 | DeviceState *dev = DEVICE(s); |
529 | ||
530 | s->readonly = readonly; | |
531 | s->inserted = coverswitch; | |
532 | ||
533 | pxa2xx_mmci_set_inserted(dev, sdbus_get_inserted(&s->sdbus)); | |
534 | pxa2xx_mmci_set_readonly(dev, sdbus_get_readonly(&s->sdbus)); | |
a171fe39 | 535 | } |
7a9468c9 | 536 | |
6002915e PM |
537 | static void pxa2xx_mmci_reset(DeviceState *d) |
538 | { | |
539 | PXA2xxMMCIState *s = PXA2XX_MMCI(d); | |
540 | ||
541 | s->status = 0; | |
542 | s->clkrt = 0; | |
543 | s->spi = 0; | |
544 | s->cmdat = 0; | |
545 | s->resp_tout = 0; | |
546 | s->read_tout = 0; | |
547 | s->blklen = 0; | |
548 | s->numblk = 0; | |
549 | s->intmask = 0; | |
550 | s->intreq = 0; | |
551 | s->cmd = 0; | |
552 | s->arg = 0; | |
553 | s->active = 0; | |
554 | s->bytesleft = 0; | |
555 | s->tx_start = 0; | |
556 | s->tx_len = 0; | |
557 | s->rx_start = 0; | |
558 | s->rx_len = 0; | |
559 | s->resp_len = 0; | |
560 | s->cmdreq = 0; | |
561 | memset(s->tx_fifo, 0, sizeof(s->tx_fifo)); | |
562 | memset(s->rx_fifo, 0, sizeof(s->rx_fifo)); | |
563 | memset(s->resp_fifo, 0, sizeof(s->resp_fifo)); | |
564 | } | |
565 | ||
7a9468c9 PM |
566 | static void pxa2xx_mmci_instance_init(Object *obj) |
567 | { | |
568 | PXA2xxMMCIState *s = PXA2XX_MMCI(obj); | |
569 | SysBusDevice *sbd = SYS_BUS_DEVICE(obj); | |
570 | DeviceState *dev = DEVICE(obj); | |
571 | ||
572 | memory_region_init_io(&s->iomem, obj, &pxa2xx_mmci_ops, s, | |
573 | "pxa2xx-mmci", 0x00100000); | |
574 | sysbus_init_mmio(sbd, &s->iomem); | |
575 | sysbus_init_irq(sbd, &s->irq); | |
576 | qdev_init_gpio_out_named(dev, &s->rx_dma, "rx-dma", 1); | |
577 | qdev_init_gpio_out_named(dev, &s->tx_dma, "tx-dma", 1); | |
578 | ||
a9563e75 PM |
579 | qbus_create_inplace(&s->sdbus, sizeof(s->sdbus), |
580 | TYPE_PXA2XX_MMCI_BUS, DEVICE(obj), "sd-bus"); | |
581 | } | |
582 | ||
19d25e0a PM |
583 | static void pxa2xx_mmci_class_init(ObjectClass *klass, void *data) |
584 | { | |
585 | DeviceClass *dc = DEVICE_CLASS(klass); | |
586 | ||
587 | dc->vmsd = &vmstate_pxa2xx_mmci; | |
6002915e | 588 | dc->reset = pxa2xx_mmci_reset; |
19d25e0a PM |
589 | } |
590 | ||
a9563e75 PM |
591 | static void pxa2xx_mmci_bus_class_init(ObjectClass *klass, void *data) |
592 | { | |
593 | SDBusClass *sbc = SD_BUS_CLASS(klass); | |
594 | ||
595 | sbc->set_inserted = pxa2xx_mmci_set_inserted; | |
596 | sbc->set_readonly = pxa2xx_mmci_set_readonly; | |
7a9468c9 PM |
597 | } |
598 | ||
599 | static const TypeInfo pxa2xx_mmci_info = { | |
600 | .name = TYPE_PXA2XX_MMCI, | |
601 | .parent = TYPE_SYS_BUS_DEVICE, | |
602 | .instance_size = sizeof(PXA2xxMMCIState), | |
603 | .instance_init = pxa2xx_mmci_instance_init, | |
19d25e0a | 604 | .class_init = pxa2xx_mmci_class_init, |
7a9468c9 PM |
605 | }; |
606 | ||
a9563e75 PM |
607 | static const TypeInfo pxa2xx_mmci_bus_info = { |
608 | .name = TYPE_PXA2XX_MMCI_BUS, | |
609 | .parent = TYPE_SD_BUS, | |
610 | .instance_size = sizeof(SDBus), | |
611 | .class_init = pxa2xx_mmci_bus_class_init, | |
612 | }; | |
613 | ||
7a9468c9 PM |
614 | static void pxa2xx_mmci_register_types(void) |
615 | { | |
616 | type_register_static(&pxa2xx_mmci_info); | |
a9563e75 | 617 | type_register_static(&pxa2xx_mmci_bus_info); |
7a9468c9 PM |
618 | } |
619 | ||
620 | type_init(pxa2xx_mmci_register_types) |