xref: /qemu/hw/sd/sdhci.c (revision be9c5ddeabb73e9dee2d6922c03ffee4e1f4c8ec)
1d7dfca08SIgor Mitsyanko /*
2d7dfca08SIgor Mitsyanko  * SD Association Host Standard Specification v2.0 controller emulation
3d7dfca08SIgor Mitsyanko  *
4d7dfca08SIgor Mitsyanko  * Copyright (c) 2011 Samsung Electronics Co., Ltd.
5d7dfca08SIgor Mitsyanko  * Mitsyanko Igor <i.mitsyanko@samsung.com>
6d7dfca08SIgor Mitsyanko  * Peter A.G. Crosthwaite <peter.crosthwaite@petalogix.com>
7d7dfca08SIgor Mitsyanko  *
8d7dfca08SIgor Mitsyanko  * Based on MMC controller for Samsung S5PC1xx-based board emulation
9d7dfca08SIgor Mitsyanko  * by Alexey Merkulov and Vladimir Monakhov.
10d7dfca08SIgor Mitsyanko  *
11d7dfca08SIgor Mitsyanko  * This program is free software; you can redistribute it and/or modify it
12d7dfca08SIgor Mitsyanko  * under the terms of the GNU General Public License as published by the
13d7dfca08SIgor Mitsyanko  * Free Software Foundation; either version 2 of the License, or (at your
14d7dfca08SIgor Mitsyanko  * option) any later version.
15d7dfca08SIgor Mitsyanko  *
16d7dfca08SIgor Mitsyanko  * This program is distributed in the hope that it will be useful,
17d7dfca08SIgor Mitsyanko  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18d7dfca08SIgor Mitsyanko  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
19d7dfca08SIgor Mitsyanko  * See the GNU General Public License for more details.
20d7dfca08SIgor Mitsyanko  *
21d7dfca08SIgor Mitsyanko  * You should have received a copy of the GNU General Public License along
22d7dfca08SIgor Mitsyanko  * with this program; if not, see <http://www.gnu.org/licenses/>.
23d7dfca08SIgor Mitsyanko  */
24d7dfca08SIgor Mitsyanko 
25*be9c5ddeSSai Pavan Boddu #include <inttypes.h>
2683c9f4caSPaolo Bonzini #include "hw/hw.h"
27fa1d36dfSMarkus Armbruster #include "sysemu/block-backend.h"
28d7dfca08SIgor Mitsyanko #include "sysemu/blockdev.h"
29d7dfca08SIgor Mitsyanko #include "sysemu/dma.h"
30d7dfca08SIgor Mitsyanko #include "qemu/timer.h"
31d7dfca08SIgor Mitsyanko #include "qemu/bitops.h"
32d7dfca08SIgor Mitsyanko 
3347b43a1fSPaolo Bonzini #include "sdhci.h"
34d7dfca08SIgor Mitsyanko 
35d7dfca08SIgor Mitsyanko /* host controller debug messages */
36d7dfca08SIgor Mitsyanko #ifndef SDHC_DEBUG
37d7dfca08SIgor Mitsyanko #define SDHC_DEBUG                        0
38d7dfca08SIgor Mitsyanko #endif
39d7dfca08SIgor Mitsyanko 
40d7dfca08SIgor Mitsyanko #if SDHC_DEBUG == 0
41d7dfca08SIgor Mitsyanko     #define DPRINT_L1(fmt, args...)       do { } while (0)
42d7dfca08SIgor Mitsyanko     #define DPRINT_L2(fmt, args...)       do { } while (0)
43d7dfca08SIgor Mitsyanko     #define ERRPRINT(fmt, args...)        do { } while (0)
44d7dfca08SIgor Mitsyanko #elif SDHC_DEBUG == 1
45d7dfca08SIgor Mitsyanko     #define DPRINT_L1(fmt, args...)       \
46d7dfca08SIgor Mitsyanko         do {fprintf(stderr, "QEMU SDHC: "fmt, ## args); } while (0)
47d7dfca08SIgor Mitsyanko     #define DPRINT_L2(fmt, args...)       do { } while (0)
48d7dfca08SIgor Mitsyanko     #define ERRPRINT(fmt, args...)        \
49d7dfca08SIgor Mitsyanko         do {fprintf(stderr, "QEMU SDHC ERROR: "fmt, ## args); } while (0)
50d7dfca08SIgor Mitsyanko #else
51d7dfca08SIgor Mitsyanko     #define DPRINT_L1(fmt, args...)       \
52d7dfca08SIgor Mitsyanko         do {fprintf(stderr, "QEMU SDHC: "fmt, ## args); } while (0)
53d7dfca08SIgor Mitsyanko     #define DPRINT_L2(fmt, args...)       \
54d7dfca08SIgor Mitsyanko         do {fprintf(stderr, "QEMU SDHC: "fmt, ## args); } while (0)
55d7dfca08SIgor Mitsyanko     #define ERRPRINT(fmt, args...)        \
56d7dfca08SIgor Mitsyanko         do {fprintf(stderr, "QEMU SDHC ERROR: "fmt, ## args); } while (0)
57d7dfca08SIgor Mitsyanko #endif
58d7dfca08SIgor Mitsyanko 
59d7dfca08SIgor Mitsyanko /* Default SD/MMC host controller features information, which will be
60d7dfca08SIgor Mitsyanko  * presented in CAPABILITIES register of generic SD host controller at reset.
61d7dfca08SIgor Mitsyanko  * If not stated otherwise:
62d7dfca08SIgor Mitsyanko  * 0 - not supported, 1 - supported, other - prohibited.
63d7dfca08SIgor Mitsyanko  */
64d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_64BITBUS       0ul        /* 64-bit System Bus Support */
65d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_18V            1ul        /* Voltage support 1.8v */
66d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_30V            0ul        /* Voltage support 3.0v */
67d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_33V            1ul        /* Voltage support 3.3v */
68d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_SUSPRESUME     0ul        /* Suspend/resume support */
69d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_SDMA           1ul        /* SDMA support */
70d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_HIGHSPEED      1ul        /* High speed support */
71d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_ADMA1          1ul        /* ADMA1 support */
72d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_ADMA2          1ul        /* ADMA2 support */
73d7dfca08SIgor Mitsyanko /* Maximum host controller R/W buffers size
74d7dfca08SIgor Mitsyanko  * Possible values: 512, 1024, 2048 bytes */
75d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_MAXBLOCKLENGTH 512ul
76d7dfca08SIgor Mitsyanko /* Maximum clock frequency for SDclock in MHz
77d7dfca08SIgor Mitsyanko  * value in range 10-63 MHz, 0 - not defined */
78c7ff8daaSKevin O'Connor #define SDHC_CAPAB_BASECLKFREQ    52ul
79d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_TOUNIT         1ul  /* Timeout clock unit 0 - kHz, 1 - MHz */
80d7dfca08SIgor Mitsyanko /* Timeout clock frequency 1-63, 0 - not defined */
81c7ff8daaSKevin O'Connor #define SDHC_CAPAB_TOCLKFREQ      52ul
82d7dfca08SIgor Mitsyanko 
83d7dfca08SIgor Mitsyanko /* Now check all parameters and calculate CAPABILITIES REGISTER value */
84d7dfca08SIgor Mitsyanko #if SDHC_CAPAB_64BITBUS > 1 || SDHC_CAPAB_18V > 1 || SDHC_CAPAB_30V > 1 ||     \
85d7dfca08SIgor Mitsyanko     SDHC_CAPAB_33V > 1 || SDHC_CAPAB_SUSPRESUME > 1 || SDHC_CAPAB_SDMA > 1 ||  \
86d7dfca08SIgor Mitsyanko     SDHC_CAPAB_HIGHSPEED > 1 || SDHC_CAPAB_ADMA2 > 1 || SDHC_CAPAB_ADMA1 > 1 ||\
87d7dfca08SIgor Mitsyanko     SDHC_CAPAB_TOUNIT > 1
88d7dfca08SIgor Mitsyanko #error Capabilities features can have value 0 or 1 only!
89d7dfca08SIgor Mitsyanko #endif
90d7dfca08SIgor Mitsyanko 
91d7dfca08SIgor Mitsyanko #if SDHC_CAPAB_MAXBLOCKLENGTH == 512
92d7dfca08SIgor Mitsyanko #define MAX_BLOCK_LENGTH 0ul
93d7dfca08SIgor Mitsyanko #elif SDHC_CAPAB_MAXBLOCKLENGTH == 1024
94d7dfca08SIgor Mitsyanko #define MAX_BLOCK_LENGTH 1ul
95d7dfca08SIgor Mitsyanko #elif SDHC_CAPAB_MAXBLOCKLENGTH == 2048
96d7dfca08SIgor Mitsyanko #define MAX_BLOCK_LENGTH 2ul
97d7dfca08SIgor Mitsyanko #else
98d7dfca08SIgor Mitsyanko #error Max host controller block size can have value 512, 1024 or 2048 only!
99d7dfca08SIgor Mitsyanko #endif
100d7dfca08SIgor Mitsyanko 
101d7dfca08SIgor Mitsyanko #if (SDHC_CAPAB_BASECLKFREQ > 0 && SDHC_CAPAB_BASECLKFREQ < 10) || \
102d7dfca08SIgor Mitsyanko     SDHC_CAPAB_BASECLKFREQ > 63
103d7dfca08SIgor Mitsyanko #error SDclock frequency can have value in range 0, 10-63 only!
104d7dfca08SIgor Mitsyanko #endif
105d7dfca08SIgor Mitsyanko 
106d7dfca08SIgor Mitsyanko #if SDHC_CAPAB_TOCLKFREQ > 63
107d7dfca08SIgor Mitsyanko #error Timeout clock frequency can have value in range 0-63 only!
108d7dfca08SIgor Mitsyanko #endif
109d7dfca08SIgor Mitsyanko 
110d7dfca08SIgor Mitsyanko #define SDHC_CAPAB_REG_DEFAULT                                 \
111d7dfca08SIgor Mitsyanko    ((SDHC_CAPAB_64BITBUS << 28) | (SDHC_CAPAB_18V << 26) |     \
112d7dfca08SIgor Mitsyanko     (SDHC_CAPAB_30V << 25) | (SDHC_CAPAB_33V << 24) |          \
113d7dfca08SIgor Mitsyanko     (SDHC_CAPAB_SUSPRESUME << 23) | (SDHC_CAPAB_SDMA << 22) |  \
114d7dfca08SIgor Mitsyanko     (SDHC_CAPAB_HIGHSPEED << 21) | (SDHC_CAPAB_ADMA1 << 20) |  \
115d7dfca08SIgor Mitsyanko     (SDHC_CAPAB_ADMA2 << 19) | (MAX_BLOCK_LENGTH << 16) |      \
116d7dfca08SIgor Mitsyanko     (SDHC_CAPAB_BASECLKFREQ << 8) | (SDHC_CAPAB_TOUNIT << 7) | \
117d7dfca08SIgor Mitsyanko     (SDHC_CAPAB_TOCLKFREQ))
118d7dfca08SIgor Mitsyanko 
119d7dfca08SIgor Mitsyanko #define MASKED_WRITE(reg, mask, val)  (reg = (reg & (mask)) | (val))
120d7dfca08SIgor Mitsyanko 
121d7dfca08SIgor Mitsyanko static uint8_t sdhci_slotint(SDHCIState *s)
122d7dfca08SIgor Mitsyanko {
123d7dfca08SIgor Mitsyanko     return (s->norintsts & s->norintsigen) || (s->errintsts & s->errintsigen) ||
124d7dfca08SIgor Mitsyanko          ((s->norintsts & SDHC_NIS_INSERT) && (s->wakcon & SDHC_WKUP_ON_INS)) ||
125d7dfca08SIgor Mitsyanko          ((s->norintsts & SDHC_NIS_REMOVE) && (s->wakcon & SDHC_WKUP_ON_RMV));
126d7dfca08SIgor Mitsyanko }
127d7dfca08SIgor Mitsyanko 
128d7dfca08SIgor Mitsyanko static inline void sdhci_update_irq(SDHCIState *s)
129d7dfca08SIgor Mitsyanko {
130d7dfca08SIgor Mitsyanko     qemu_set_irq(s->irq, sdhci_slotint(s));
131d7dfca08SIgor Mitsyanko }
132d7dfca08SIgor Mitsyanko 
133d7dfca08SIgor Mitsyanko static void sdhci_raise_insertion_irq(void *opaque)
134d7dfca08SIgor Mitsyanko {
135d7dfca08SIgor Mitsyanko     SDHCIState *s = (SDHCIState *)opaque;
136d7dfca08SIgor Mitsyanko 
137d7dfca08SIgor Mitsyanko     if (s->norintsts & SDHC_NIS_REMOVE) {
138bc72ad67SAlex Bligh         timer_mod(s->insert_timer,
139bc72ad67SAlex Bligh                        qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + SDHC_INSERTION_DELAY);
140d7dfca08SIgor Mitsyanko     } else {
141d7dfca08SIgor Mitsyanko         s->prnsts = 0x1ff0000;
142d7dfca08SIgor Mitsyanko         if (s->norintstsen & SDHC_NISEN_INSERT) {
143d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_INSERT;
144d7dfca08SIgor Mitsyanko         }
145d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
146d7dfca08SIgor Mitsyanko     }
147d7dfca08SIgor Mitsyanko }
148d7dfca08SIgor Mitsyanko 
149d7dfca08SIgor Mitsyanko static void sdhci_insert_eject_cb(void *opaque, int irq, int level)
150d7dfca08SIgor Mitsyanko {
151d7dfca08SIgor Mitsyanko     SDHCIState *s = (SDHCIState *)opaque;
152d7dfca08SIgor Mitsyanko     DPRINT_L1("Card state changed: %s!\n", level ? "insert" : "eject");
153d7dfca08SIgor Mitsyanko 
154d7dfca08SIgor Mitsyanko     if ((s->norintsts & SDHC_NIS_REMOVE) && level) {
155d7dfca08SIgor Mitsyanko         /* Give target some time to notice card ejection */
156bc72ad67SAlex Bligh         timer_mod(s->insert_timer,
157bc72ad67SAlex Bligh                        qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + SDHC_INSERTION_DELAY);
158d7dfca08SIgor Mitsyanko     } else {
159d7dfca08SIgor Mitsyanko         if (level) {
160d7dfca08SIgor Mitsyanko             s->prnsts = 0x1ff0000;
161d7dfca08SIgor Mitsyanko             if (s->norintstsen & SDHC_NISEN_INSERT) {
162d7dfca08SIgor Mitsyanko                 s->norintsts |= SDHC_NIS_INSERT;
163d7dfca08SIgor Mitsyanko             }
164d7dfca08SIgor Mitsyanko         } else {
165d7dfca08SIgor Mitsyanko             s->prnsts = 0x1fa0000;
166d7dfca08SIgor Mitsyanko             s->pwrcon &= ~SDHC_POWER_ON;
167d7dfca08SIgor Mitsyanko             s->clkcon &= ~SDHC_CLOCK_SDCLK_EN;
168d7dfca08SIgor Mitsyanko             if (s->norintstsen & SDHC_NISEN_REMOVE) {
169d7dfca08SIgor Mitsyanko                 s->norintsts |= SDHC_NIS_REMOVE;
170d7dfca08SIgor Mitsyanko             }
171d7dfca08SIgor Mitsyanko         }
172d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
173d7dfca08SIgor Mitsyanko     }
174d7dfca08SIgor Mitsyanko }
175d7dfca08SIgor Mitsyanko 
176d7dfca08SIgor Mitsyanko static void sdhci_card_readonly_cb(void *opaque, int irq, int level)
177d7dfca08SIgor Mitsyanko {
178d7dfca08SIgor Mitsyanko     SDHCIState *s = (SDHCIState *)opaque;
179d7dfca08SIgor Mitsyanko 
180d7dfca08SIgor Mitsyanko     if (level) {
181d7dfca08SIgor Mitsyanko         s->prnsts &= ~SDHC_WRITE_PROTECT;
182d7dfca08SIgor Mitsyanko     } else {
183d7dfca08SIgor Mitsyanko         /* Write enabled */
184d7dfca08SIgor Mitsyanko         s->prnsts |= SDHC_WRITE_PROTECT;
185d7dfca08SIgor Mitsyanko     }
186d7dfca08SIgor Mitsyanko }
187d7dfca08SIgor Mitsyanko 
188d7dfca08SIgor Mitsyanko static void sdhci_reset(SDHCIState *s)
189d7dfca08SIgor Mitsyanko {
190bc72ad67SAlex Bligh     timer_del(s->insert_timer);
191bc72ad67SAlex Bligh     timer_del(s->transfer_timer);
192d7dfca08SIgor Mitsyanko     /* Set all registers to 0. Capabilities registers are not cleared
193d7dfca08SIgor Mitsyanko      * and assumed to always preserve their value, given to them during
194d7dfca08SIgor Mitsyanko      * initialization */
195d7dfca08SIgor Mitsyanko     memset(&s->sdmasysad, 0, (uintptr_t)&s->capareg - (uintptr_t)&s->sdmasysad);
196d7dfca08SIgor Mitsyanko 
197d7dfca08SIgor Mitsyanko     sd_set_cb(s->card, s->ro_cb, s->eject_cb);
198d7dfca08SIgor Mitsyanko     s->data_count = 0;
199d7dfca08SIgor Mitsyanko     s->stopped_state = sdhc_not_stopped;
200d7dfca08SIgor Mitsyanko }
201d7dfca08SIgor Mitsyanko 
202d368ba43SKevin O'Connor static void sdhci_data_transfer(void *opaque);
203d7dfca08SIgor Mitsyanko 
204d7dfca08SIgor Mitsyanko static void sdhci_send_command(SDHCIState *s)
205d7dfca08SIgor Mitsyanko {
206d7dfca08SIgor Mitsyanko     SDRequest request;
207d7dfca08SIgor Mitsyanko     uint8_t response[16];
208d7dfca08SIgor Mitsyanko     int rlen;
209d7dfca08SIgor Mitsyanko 
210d7dfca08SIgor Mitsyanko     s->errintsts = 0;
211d7dfca08SIgor Mitsyanko     s->acmd12errsts = 0;
212d7dfca08SIgor Mitsyanko     request.cmd = s->cmdreg >> 8;
213d7dfca08SIgor Mitsyanko     request.arg = s->argument;
214d7dfca08SIgor Mitsyanko     DPRINT_L1("sending CMD%u ARG[0x%08x]\n", request.cmd, request.arg);
215d7dfca08SIgor Mitsyanko     rlen = sd_do_command(s->card, &request, response);
216d7dfca08SIgor Mitsyanko 
217d7dfca08SIgor Mitsyanko     if (s->cmdreg & SDHC_CMD_RESPONSE) {
218d7dfca08SIgor Mitsyanko         if (rlen == 4) {
219d7dfca08SIgor Mitsyanko             s->rspreg[0] = (response[0] << 24) | (response[1] << 16) |
220d7dfca08SIgor Mitsyanko                            (response[2] << 8)  |  response[3];
221d7dfca08SIgor Mitsyanko             s->rspreg[1] = s->rspreg[2] = s->rspreg[3] = 0;
222d7dfca08SIgor Mitsyanko             DPRINT_L1("Response: RSPREG[31..0]=0x%08x\n", s->rspreg[0]);
223d7dfca08SIgor Mitsyanko         } else if (rlen == 16) {
224d7dfca08SIgor Mitsyanko             s->rspreg[0] = (response[11] << 24) | (response[12] << 16) |
225d7dfca08SIgor Mitsyanko                            (response[13] << 8) |  response[14];
226d7dfca08SIgor Mitsyanko             s->rspreg[1] = (response[7] << 24) | (response[8] << 16) |
227d7dfca08SIgor Mitsyanko                            (response[9] << 8)  |  response[10];
228d7dfca08SIgor Mitsyanko             s->rspreg[2] = (response[3] << 24) | (response[4] << 16) |
229d7dfca08SIgor Mitsyanko                            (response[5] << 8)  |  response[6];
230d7dfca08SIgor Mitsyanko             s->rspreg[3] = (response[0] << 16) | (response[1] << 8) |
231d7dfca08SIgor Mitsyanko                             response[2];
232d7dfca08SIgor Mitsyanko             DPRINT_L1("Response received:\n RSPREG[127..96]=0x%08x, RSPREG[95.."
233d7dfca08SIgor Mitsyanko                   "64]=0x%08x,\n RSPREG[63..32]=0x%08x, RSPREG[31..0]=0x%08x\n",
234d7dfca08SIgor Mitsyanko                   s->rspreg[3], s->rspreg[2], s->rspreg[1], s->rspreg[0]);
235d7dfca08SIgor Mitsyanko         } else {
236d7dfca08SIgor Mitsyanko             ERRPRINT("Timeout waiting for command response\n");
237d7dfca08SIgor Mitsyanko             if (s->errintstsen & SDHC_EISEN_CMDTIMEOUT) {
238d7dfca08SIgor Mitsyanko                 s->errintsts |= SDHC_EIS_CMDTIMEOUT;
239d7dfca08SIgor Mitsyanko                 s->norintsts |= SDHC_NIS_ERR;
240d7dfca08SIgor Mitsyanko             }
241d7dfca08SIgor Mitsyanko         }
242d7dfca08SIgor Mitsyanko 
243d7dfca08SIgor Mitsyanko         if ((s->norintstsen & SDHC_NISEN_TRSCMP) &&
244d7dfca08SIgor Mitsyanko             (s->cmdreg & SDHC_CMD_RESPONSE) == SDHC_CMD_RSP_WITH_BUSY) {
245d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_TRSCMP;
246d7dfca08SIgor Mitsyanko         }
247d7dfca08SIgor Mitsyanko     } else if (rlen != 0 && (s->errintstsen & SDHC_EISEN_CMDIDX)) {
248d7dfca08SIgor Mitsyanko         s->errintsts |= SDHC_EIS_CMDIDX;
249d7dfca08SIgor Mitsyanko         s->norintsts |= SDHC_NIS_ERR;
250d7dfca08SIgor Mitsyanko     }
251d7dfca08SIgor Mitsyanko 
252d7dfca08SIgor Mitsyanko     if (s->norintstsen & SDHC_NISEN_CMDCMP) {
253d7dfca08SIgor Mitsyanko         s->norintsts |= SDHC_NIS_CMDCMP;
254d7dfca08SIgor Mitsyanko     }
255d7dfca08SIgor Mitsyanko 
256d7dfca08SIgor Mitsyanko     sdhci_update_irq(s);
257d7dfca08SIgor Mitsyanko 
258d7dfca08SIgor Mitsyanko     if (s->blksize && (s->cmdreg & SDHC_CMD_DATA_PRESENT)) {
259656f416cSPeter Crosthwaite         s->data_count = 0;
260d368ba43SKevin O'Connor         sdhci_data_transfer(s);
261d7dfca08SIgor Mitsyanko     }
262d7dfca08SIgor Mitsyanko }
263d7dfca08SIgor Mitsyanko 
264d7dfca08SIgor Mitsyanko static void sdhci_end_transfer(SDHCIState *s)
265d7dfca08SIgor Mitsyanko {
266d7dfca08SIgor Mitsyanko     /* Automatically send CMD12 to stop transfer if AutoCMD12 enabled */
267d7dfca08SIgor Mitsyanko     if ((s->trnmod & SDHC_TRNS_ACMD12) != 0) {
268d7dfca08SIgor Mitsyanko         SDRequest request;
269d7dfca08SIgor Mitsyanko         uint8_t response[16];
270d7dfca08SIgor Mitsyanko 
271d7dfca08SIgor Mitsyanko         request.cmd = 0x0C;
272d7dfca08SIgor Mitsyanko         request.arg = 0;
273d7dfca08SIgor Mitsyanko         DPRINT_L1("Automatically issue CMD%d %08x\n", request.cmd, request.arg);
274d7dfca08SIgor Mitsyanko         sd_do_command(s->card, &request, response);
275d7dfca08SIgor Mitsyanko         /* Auto CMD12 response goes to the upper Response register */
276d7dfca08SIgor Mitsyanko         s->rspreg[3] = (response[0] << 24) | (response[1] << 16) |
277d7dfca08SIgor Mitsyanko                 (response[2] << 8) | response[3];
278d7dfca08SIgor Mitsyanko     }
279d7dfca08SIgor Mitsyanko 
280d7dfca08SIgor Mitsyanko     s->prnsts &= ~(SDHC_DOING_READ | SDHC_DOING_WRITE |
281d7dfca08SIgor Mitsyanko             SDHC_DAT_LINE_ACTIVE | SDHC_DATA_INHIBIT |
282d7dfca08SIgor Mitsyanko             SDHC_SPACE_AVAILABLE | SDHC_DATA_AVAILABLE);
283d7dfca08SIgor Mitsyanko 
284d7dfca08SIgor Mitsyanko     if (s->norintstsen & SDHC_NISEN_TRSCMP) {
285d7dfca08SIgor Mitsyanko         s->norintsts |= SDHC_NIS_TRSCMP;
286d7dfca08SIgor Mitsyanko     }
287d7dfca08SIgor Mitsyanko 
288d7dfca08SIgor Mitsyanko     sdhci_update_irq(s);
289d7dfca08SIgor Mitsyanko }
290d7dfca08SIgor Mitsyanko 
291d7dfca08SIgor Mitsyanko /*
292d7dfca08SIgor Mitsyanko  * Programmed i/o data transfer
293d7dfca08SIgor Mitsyanko  */
294d7dfca08SIgor Mitsyanko 
295d7dfca08SIgor Mitsyanko /* Fill host controller's read buffer with BLKSIZE bytes of data from card */
296d7dfca08SIgor Mitsyanko static void sdhci_read_block_from_card(SDHCIState *s)
297d7dfca08SIgor Mitsyanko {
298d7dfca08SIgor Mitsyanko     int index = 0;
299d7dfca08SIgor Mitsyanko 
300d7dfca08SIgor Mitsyanko     if ((s->trnmod & SDHC_TRNS_MULTI) &&
301d7dfca08SIgor Mitsyanko             (s->trnmod & SDHC_TRNS_BLK_CNT_EN) && (s->blkcnt == 0)) {
302d7dfca08SIgor Mitsyanko         return;
303d7dfca08SIgor Mitsyanko     }
304d7dfca08SIgor Mitsyanko 
305d7dfca08SIgor Mitsyanko     for (index = 0; index < (s->blksize & 0x0fff); index++) {
306d7dfca08SIgor Mitsyanko         s->fifo_buffer[index] = sd_read_data(s->card);
307d7dfca08SIgor Mitsyanko     }
308d7dfca08SIgor Mitsyanko 
309d7dfca08SIgor Mitsyanko     /* New data now available for READ through Buffer Port Register */
310d7dfca08SIgor Mitsyanko     s->prnsts |= SDHC_DATA_AVAILABLE;
311d7dfca08SIgor Mitsyanko     if (s->norintstsen & SDHC_NISEN_RBUFRDY) {
312d7dfca08SIgor Mitsyanko         s->norintsts |= SDHC_NIS_RBUFRDY;
313d7dfca08SIgor Mitsyanko     }
314d7dfca08SIgor Mitsyanko 
315d7dfca08SIgor Mitsyanko     /* Clear DAT line active status if that was the last block */
316d7dfca08SIgor Mitsyanko     if ((s->trnmod & SDHC_TRNS_MULTI) == 0 ||
317d7dfca08SIgor Mitsyanko             ((s->trnmod & SDHC_TRNS_MULTI) && s->blkcnt == 1)) {
318d7dfca08SIgor Mitsyanko         s->prnsts &= ~SDHC_DAT_LINE_ACTIVE;
319d7dfca08SIgor Mitsyanko     }
320d7dfca08SIgor Mitsyanko 
321d7dfca08SIgor Mitsyanko     /* If stop at block gap request was set and it's not the last block of
322d7dfca08SIgor Mitsyanko      * data - generate Block Event interrupt */
323d7dfca08SIgor Mitsyanko     if (s->stopped_state == sdhc_gap_read && (s->trnmod & SDHC_TRNS_MULTI) &&
324d7dfca08SIgor Mitsyanko             s->blkcnt != 1)    {
325d7dfca08SIgor Mitsyanko         s->prnsts &= ~SDHC_DAT_LINE_ACTIVE;
326d7dfca08SIgor Mitsyanko         if (s->norintstsen & SDHC_EISEN_BLKGAP) {
327d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_EIS_BLKGAP;
328d7dfca08SIgor Mitsyanko         }
329d7dfca08SIgor Mitsyanko     }
330d7dfca08SIgor Mitsyanko 
331d7dfca08SIgor Mitsyanko     sdhci_update_irq(s);
332d7dfca08SIgor Mitsyanko }
333d7dfca08SIgor Mitsyanko 
334d7dfca08SIgor Mitsyanko /* Read @size byte of data from host controller @s BUFFER DATA PORT register */
335d7dfca08SIgor Mitsyanko static uint32_t sdhci_read_dataport(SDHCIState *s, unsigned size)
336d7dfca08SIgor Mitsyanko {
337d7dfca08SIgor Mitsyanko     uint32_t value = 0;
338d7dfca08SIgor Mitsyanko     int i;
339d7dfca08SIgor Mitsyanko 
340d7dfca08SIgor Mitsyanko     /* first check that a valid data exists in host controller input buffer */
341d7dfca08SIgor Mitsyanko     if ((s->prnsts & SDHC_DATA_AVAILABLE) == 0) {
342d7dfca08SIgor Mitsyanko         ERRPRINT("Trying to read from empty buffer\n");
343d7dfca08SIgor Mitsyanko         return 0;
344d7dfca08SIgor Mitsyanko     }
345d7dfca08SIgor Mitsyanko 
346d7dfca08SIgor Mitsyanko     for (i = 0; i < size; i++) {
347d7dfca08SIgor Mitsyanko         value |= s->fifo_buffer[s->data_count] << i * 8;
348d7dfca08SIgor Mitsyanko         s->data_count++;
349d7dfca08SIgor Mitsyanko         /* check if we've read all valid data (blksize bytes) from buffer */
350d7dfca08SIgor Mitsyanko         if ((s->data_count) >= (s->blksize & 0x0fff)) {
351d7dfca08SIgor Mitsyanko             DPRINT_L2("All %u bytes of data have been read from input buffer\n",
352d7dfca08SIgor Mitsyanko                     s->data_count);
353d7dfca08SIgor Mitsyanko             s->prnsts &= ~SDHC_DATA_AVAILABLE; /* no more data in a buffer */
354d7dfca08SIgor Mitsyanko             s->data_count = 0;  /* next buff read must start at position [0] */
355d7dfca08SIgor Mitsyanko 
356d7dfca08SIgor Mitsyanko             if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
357d7dfca08SIgor Mitsyanko                 s->blkcnt--;
358d7dfca08SIgor Mitsyanko             }
359d7dfca08SIgor Mitsyanko 
360d7dfca08SIgor Mitsyanko             /* if that was the last block of data */
361d7dfca08SIgor Mitsyanko             if ((s->trnmod & SDHC_TRNS_MULTI) == 0 ||
362d7dfca08SIgor Mitsyanko                 ((s->trnmod & SDHC_TRNS_BLK_CNT_EN) && (s->blkcnt == 0)) ||
363d7dfca08SIgor Mitsyanko                  /* stop at gap request */
364d7dfca08SIgor Mitsyanko                 (s->stopped_state == sdhc_gap_read &&
365d7dfca08SIgor Mitsyanko                  !(s->prnsts & SDHC_DAT_LINE_ACTIVE))) {
366d368ba43SKevin O'Connor                 sdhci_end_transfer(s);
367d7dfca08SIgor Mitsyanko             } else { /* if there are more data, read next block from card */
368d368ba43SKevin O'Connor                 sdhci_read_block_from_card(s);
369d7dfca08SIgor Mitsyanko             }
370d7dfca08SIgor Mitsyanko             break;
371d7dfca08SIgor Mitsyanko         }
372d7dfca08SIgor Mitsyanko     }
373d7dfca08SIgor Mitsyanko 
374d7dfca08SIgor Mitsyanko     return value;
375d7dfca08SIgor Mitsyanko }
376d7dfca08SIgor Mitsyanko 
377d7dfca08SIgor Mitsyanko /* Write data from host controller FIFO to card */
378d7dfca08SIgor Mitsyanko static void sdhci_write_block_to_card(SDHCIState *s)
379d7dfca08SIgor Mitsyanko {
380d7dfca08SIgor Mitsyanko     int index = 0;
381d7dfca08SIgor Mitsyanko 
382d7dfca08SIgor Mitsyanko     if (s->prnsts & SDHC_SPACE_AVAILABLE) {
383d7dfca08SIgor Mitsyanko         if (s->norintstsen & SDHC_NISEN_WBUFRDY) {
384d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_WBUFRDY;
385d7dfca08SIgor Mitsyanko         }
386d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
387d7dfca08SIgor Mitsyanko         return;
388d7dfca08SIgor Mitsyanko     }
389d7dfca08SIgor Mitsyanko 
390d7dfca08SIgor Mitsyanko     if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
391d7dfca08SIgor Mitsyanko         if (s->blkcnt == 0) {
392d7dfca08SIgor Mitsyanko             return;
393d7dfca08SIgor Mitsyanko         } else {
394d7dfca08SIgor Mitsyanko             s->blkcnt--;
395d7dfca08SIgor Mitsyanko         }
396d7dfca08SIgor Mitsyanko     }
397d7dfca08SIgor Mitsyanko 
398d7dfca08SIgor Mitsyanko     for (index = 0; index < (s->blksize & 0x0fff); index++) {
399d7dfca08SIgor Mitsyanko         sd_write_data(s->card, s->fifo_buffer[index]);
400d7dfca08SIgor Mitsyanko     }
401d7dfca08SIgor Mitsyanko 
402d7dfca08SIgor Mitsyanko     /* Next data can be written through BUFFER DATORT register */
403d7dfca08SIgor Mitsyanko     s->prnsts |= SDHC_SPACE_AVAILABLE;
404d7dfca08SIgor Mitsyanko 
405d7dfca08SIgor Mitsyanko     /* Finish transfer if that was the last block of data */
406d7dfca08SIgor Mitsyanko     if ((s->trnmod & SDHC_TRNS_MULTI) == 0 ||
407d7dfca08SIgor Mitsyanko             ((s->trnmod & SDHC_TRNS_MULTI) &&
408d7dfca08SIgor Mitsyanko             (s->trnmod & SDHC_TRNS_BLK_CNT_EN) && (s->blkcnt == 0))) {
409d368ba43SKevin O'Connor         sdhci_end_transfer(s);
410dcdb4cd8SPeter Crosthwaite     } else if (s->norintstsen & SDHC_NISEN_WBUFRDY) {
411dcdb4cd8SPeter Crosthwaite         s->norintsts |= SDHC_NIS_WBUFRDY;
412d7dfca08SIgor Mitsyanko     }
413d7dfca08SIgor Mitsyanko 
414d7dfca08SIgor Mitsyanko     /* Generate Block Gap Event if requested and if not the last block */
415d7dfca08SIgor Mitsyanko     if (s->stopped_state == sdhc_gap_write && (s->trnmod & SDHC_TRNS_MULTI) &&
416d7dfca08SIgor Mitsyanko             s->blkcnt > 0) {
417d7dfca08SIgor Mitsyanko         s->prnsts &= ~SDHC_DOING_WRITE;
418d7dfca08SIgor Mitsyanko         if (s->norintstsen & SDHC_EISEN_BLKGAP) {
419d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_EIS_BLKGAP;
420d7dfca08SIgor Mitsyanko         }
421d368ba43SKevin O'Connor         sdhci_end_transfer(s);
422d7dfca08SIgor Mitsyanko     }
423d7dfca08SIgor Mitsyanko 
424d7dfca08SIgor Mitsyanko     sdhci_update_irq(s);
425d7dfca08SIgor Mitsyanko }
426d7dfca08SIgor Mitsyanko 
427d7dfca08SIgor Mitsyanko /* Write @size bytes of @value data to host controller @s Buffer Data Port
428d7dfca08SIgor Mitsyanko  * register */
429d7dfca08SIgor Mitsyanko static void sdhci_write_dataport(SDHCIState *s, uint32_t value, unsigned size)
430d7dfca08SIgor Mitsyanko {
431d7dfca08SIgor Mitsyanko     unsigned i;
432d7dfca08SIgor Mitsyanko 
433d7dfca08SIgor Mitsyanko     /* Check that there is free space left in a buffer */
434d7dfca08SIgor Mitsyanko     if (!(s->prnsts & SDHC_SPACE_AVAILABLE)) {
435d7dfca08SIgor Mitsyanko         ERRPRINT("Can't write to data buffer: buffer full\n");
436d7dfca08SIgor Mitsyanko         return;
437d7dfca08SIgor Mitsyanko     }
438d7dfca08SIgor Mitsyanko 
439d7dfca08SIgor Mitsyanko     for (i = 0; i < size; i++) {
440d7dfca08SIgor Mitsyanko         s->fifo_buffer[s->data_count] = value & 0xFF;
441d7dfca08SIgor Mitsyanko         s->data_count++;
442d7dfca08SIgor Mitsyanko         value >>= 8;
443d7dfca08SIgor Mitsyanko         if (s->data_count >= (s->blksize & 0x0fff)) {
444d7dfca08SIgor Mitsyanko             DPRINT_L2("write buffer filled with %u bytes of data\n",
445d7dfca08SIgor Mitsyanko                     s->data_count);
446d7dfca08SIgor Mitsyanko             s->data_count = 0;
447d7dfca08SIgor Mitsyanko             s->prnsts &= ~SDHC_SPACE_AVAILABLE;
448d7dfca08SIgor Mitsyanko             if (s->prnsts & SDHC_DOING_WRITE) {
449d368ba43SKevin O'Connor                 sdhci_write_block_to_card(s);
450d7dfca08SIgor Mitsyanko             }
451d7dfca08SIgor Mitsyanko         }
452d7dfca08SIgor Mitsyanko     }
453d7dfca08SIgor Mitsyanko }
454d7dfca08SIgor Mitsyanko 
455d7dfca08SIgor Mitsyanko /*
456d7dfca08SIgor Mitsyanko  * Single DMA data transfer
457d7dfca08SIgor Mitsyanko  */
458d7dfca08SIgor Mitsyanko 
459d7dfca08SIgor Mitsyanko /* Multi block SDMA transfer */
460d7dfca08SIgor Mitsyanko static void sdhci_sdma_transfer_multi_blocks(SDHCIState *s)
461d7dfca08SIgor Mitsyanko {
462d7dfca08SIgor Mitsyanko     bool page_aligned = false;
463d7dfca08SIgor Mitsyanko     unsigned int n, begin;
464d7dfca08SIgor Mitsyanko     const uint16_t block_size = s->blksize & 0x0fff;
465d7dfca08SIgor Mitsyanko     uint32_t boundary_chk = 1 << (((s->blksize & 0xf000) >> 12) + 12);
466d7dfca08SIgor Mitsyanko     uint32_t boundary_count = boundary_chk - (s->sdmasysad % boundary_chk);
467d7dfca08SIgor Mitsyanko 
468d7dfca08SIgor Mitsyanko     /* XXX: Some sd/mmc drivers (for example, u-boot-slp) do not account for
469d7dfca08SIgor Mitsyanko      * possible stop at page boundary if initial address is not page aligned,
470d7dfca08SIgor Mitsyanko      * allow them to work properly */
471d7dfca08SIgor Mitsyanko     if ((s->sdmasysad % boundary_chk) == 0) {
472d7dfca08SIgor Mitsyanko         page_aligned = true;
473d7dfca08SIgor Mitsyanko     }
474d7dfca08SIgor Mitsyanko 
475d7dfca08SIgor Mitsyanko     if (s->trnmod & SDHC_TRNS_READ) {
476d7dfca08SIgor Mitsyanko         s->prnsts |= SDHC_DOING_READ | SDHC_DATA_INHIBIT |
477d7dfca08SIgor Mitsyanko                 SDHC_DAT_LINE_ACTIVE;
478d7dfca08SIgor Mitsyanko         while (s->blkcnt) {
479d7dfca08SIgor Mitsyanko             if (s->data_count == 0) {
480d7dfca08SIgor Mitsyanko                 for (n = 0; n < block_size; n++) {
481d7dfca08SIgor Mitsyanko                     s->fifo_buffer[n] = sd_read_data(s->card);
482d7dfca08SIgor Mitsyanko                 }
483d7dfca08SIgor Mitsyanko             }
484d7dfca08SIgor Mitsyanko             begin = s->data_count;
485d7dfca08SIgor Mitsyanko             if (((boundary_count + begin) < block_size) && page_aligned) {
486d7dfca08SIgor Mitsyanko                 s->data_count = boundary_count + begin;
487d7dfca08SIgor Mitsyanko                 boundary_count = 0;
488d7dfca08SIgor Mitsyanko              } else {
489d7dfca08SIgor Mitsyanko                 s->data_count = block_size;
490d7dfca08SIgor Mitsyanko                 boundary_count -= block_size - begin;
491d7dfca08SIgor Mitsyanko                 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
492d7dfca08SIgor Mitsyanko                     s->blkcnt--;
493d7dfca08SIgor Mitsyanko                 }
494d7dfca08SIgor Mitsyanko             }
495df32fd1cSPaolo Bonzini             dma_memory_write(&address_space_memory, s->sdmasysad,
496d7dfca08SIgor Mitsyanko                              &s->fifo_buffer[begin], s->data_count - begin);
497d7dfca08SIgor Mitsyanko             s->sdmasysad += s->data_count - begin;
498d7dfca08SIgor Mitsyanko             if (s->data_count == block_size) {
499d7dfca08SIgor Mitsyanko                 s->data_count = 0;
500d7dfca08SIgor Mitsyanko             }
501d7dfca08SIgor Mitsyanko             if (page_aligned && boundary_count == 0) {
502d7dfca08SIgor Mitsyanko                 break;
503d7dfca08SIgor Mitsyanko             }
504d7dfca08SIgor Mitsyanko         }
505d7dfca08SIgor Mitsyanko     } else {
506d7dfca08SIgor Mitsyanko         s->prnsts |= SDHC_DOING_WRITE | SDHC_DATA_INHIBIT |
507d7dfca08SIgor Mitsyanko                 SDHC_DAT_LINE_ACTIVE;
508d7dfca08SIgor Mitsyanko         while (s->blkcnt) {
509d7dfca08SIgor Mitsyanko             begin = s->data_count;
510d7dfca08SIgor Mitsyanko             if (((boundary_count + begin) < block_size) && page_aligned) {
511d7dfca08SIgor Mitsyanko                 s->data_count = boundary_count + begin;
512d7dfca08SIgor Mitsyanko                 boundary_count = 0;
513d7dfca08SIgor Mitsyanko              } else {
514d7dfca08SIgor Mitsyanko                 s->data_count = block_size;
515d7dfca08SIgor Mitsyanko                 boundary_count -= block_size - begin;
516d7dfca08SIgor Mitsyanko             }
517df32fd1cSPaolo Bonzini             dma_memory_read(&address_space_memory, s->sdmasysad,
518d7dfca08SIgor Mitsyanko                             &s->fifo_buffer[begin], s->data_count);
519d7dfca08SIgor Mitsyanko             s->sdmasysad += s->data_count - begin;
520d7dfca08SIgor Mitsyanko             if (s->data_count == block_size) {
521d7dfca08SIgor Mitsyanko                 for (n = 0; n < block_size; n++) {
522d7dfca08SIgor Mitsyanko                     sd_write_data(s->card, s->fifo_buffer[n]);
523d7dfca08SIgor Mitsyanko                 }
524d7dfca08SIgor Mitsyanko                 s->data_count = 0;
525d7dfca08SIgor Mitsyanko                 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
526d7dfca08SIgor Mitsyanko                     s->blkcnt--;
527d7dfca08SIgor Mitsyanko                 }
528d7dfca08SIgor Mitsyanko             }
529d7dfca08SIgor Mitsyanko             if (page_aligned && boundary_count == 0) {
530d7dfca08SIgor Mitsyanko                 break;
531d7dfca08SIgor Mitsyanko             }
532d7dfca08SIgor Mitsyanko         }
533d7dfca08SIgor Mitsyanko     }
534d7dfca08SIgor Mitsyanko 
535d7dfca08SIgor Mitsyanko     if (s->blkcnt == 0) {
536d368ba43SKevin O'Connor         sdhci_end_transfer(s);
537d7dfca08SIgor Mitsyanko     } else {
538d7dfca08SIgor Mitsyanko         if (s->norintstsen & SDHC_NISEN_DMA) {
539d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_DMA;
540d7dfca08SIgor Mitsyanko         }
541d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
542d7dfca08SIgor Mitsyanko     }
543d7dfca08SIgor Mitsyanko }
544d7dfca08SIgor Mitsyanko 
545d7dfca08SIgor Mitsyanko /* single block SDMA transfer */
546d7dfca08SIgor Mitsyanko 
547d7dfca08SIgor Mitsyanko static void sdhci_sdma_transfer_single_block(SDHCIState *s)
548d7dfca08SIgor Mitsyanko {
549d7dfca08SIgor Mitsyanko     int n;
550d7dfca08SIgor Mitsyanko     uint32_t datacnt = s->blksize & 0x0fff;
551d7dfca08SIgor Mitsyanko 
552d7dfca08SIgor Mitsyanko     if (s->trnmod & SDHC_TRNS_READ) {
553d7dfca08SIgor Mitsyanko         for (n = 0; n < datacnt; n++) {
554d7dfca08SIgor Mitsyanko             s->fifo_buffer[n] = sd_read_data(s->card);
555d7dfca08SIgor Mitsyanko         }
556df32fd1cSPaolo Bonzini         dma_memory_write(&address_space_memory, s->sdmasysad, s->fifo_buffer,
557d7dfca08SIgor Mitsyanko                          datacnt);
558d7dfca08SIgor Mitsyanko     } else {
559df32fd1cSPaolo Bonzini         dma_memory_read(&address_space_memory, s->sdmasysad, s->fifo_buffer,
560d7dfca08SIgor Mitsyanko                         datacnt);
561d7dfca08SIgor Mitsyanko         for (n = 0; n < datacnt; n++) {
562d7dfca08SIgor Mitsyanko             sd_write_data(s->card, s->fifo_buffer[n]);
563d7dfca08SIgor Mitsyanko         }
564d7dfca08SIgor Mitsyanko     }
565d7dfca08SIgor Mitsyanko 
566d7dfca08SIgor Mitsyanko     if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
567d7dfca08SIgor Mitsyanko         s->blkcnt--;
568d7dfca08SIgor Mitsyanko     }
569d7dfca08SIgor Mitsyanko 
570d368ba43SKevin O'Connor     sdhci_end_transfer(s);
571d7dfca08SIgor Mitsyanko }
572d7dfca08SIgor Mitsyanko 
573d7dfca08SIgor Mitsyanko typedef struct ADMADescr {
574d7dfca08SIgor Mitsyanko     hwaddr addr;
575d7dfca08SIgor Mitsyanko     uint16_t length;
576d7dfca08SIgor Mitsyanko     uint8_t attr;
577d7dfca08SIgor Mitsyanko     uint8_t incr;
578d7dfca08SIgor Mitsyanko } ADMADescr;
579d7dfca08SIgor Mitsyanko 
580d7dfca08SIgor Mitsyanko static void get_adma_description(SDHCIState *s, ADMADescr *dscr)
581d7dfca08SIgor Mitsyanko {
582d7dfca08SIgor Mitsyanko     uint32_t adma1 = 0;
583d7dfca08SIgor Mitsyanko     uint64_t adma2 = 0;
584d7dfca08SIgor Mitsyanko     hwaddr entry_addr = (hwaddr)s->admasysaddr;
585d7dfca08SIgor Mitsyanko     switch (SDHC_DMA_TYPE(s->hostctl)) {
586d7dfca08SIgor Mitsyanko     case SDHC_CTRL_ADMA2_32:
587df32fd1cSPaolo Bonzini         dma_memory_read(&address_space_memory, entry_addr, (uint8_t *)&adma2,
588d7dfca08SIgor Mitsyanko                         sizeof(adma2));
589d7dfca08SIgor Mitsyanko         adma2 = le64_to_cpu(adma2);
590d7dfca08SIgor Mitsyanko         /* The spec does not specify endianness of descriptor table.
591d7dfca08SIgor Mitsyanko          * We currently assume that it is LE.
592d7dfca08SIgor Mitsyanko          */
593d7dfca08SIgor Mitsyanko         dscr->addr = (hwaddr)extract64(adma2, 32, 32) & ~0x3ull;
594d7dfca08SIgor Mitsyanko         dscr->length = (uint16_t)extract64(adma2, 16, 16);
595d7dfca08SIgor Mitsyanko         dscr->attr = (uint8_t)extract64(adma2, 0, 7);
596d7dfca08SIgor Mitsyanko         dscr->incr = 8;
597d7dfca08SIgor Mitsyanko         break;
598d7dfca08SIgor Mitsyanko     case SDHC_CTRL_ADMA1_32:
599df32fd1cSPaolo Bonzini         dma_memory_read(&address_space_memory, entry_addr, (uint8_t *)&adma1,
600d7dfca08SIgor Mitsyanko                         sizeof(adma1));
601d7dfca08SIgor Mitsyanko         adma1 = le32_to_cpu(adma1);
602d7dfca08SIgor Mitsyanko         dscr->addr = (hwaddr)(adma1 & 0xFFFFF000);
603d7dfca08SIgor Mitsyanko         dscr->attr = (uint8_t)extract32(adma1, 0, 7);
604d7dfca08SIgor Mitsyanko         dscr->incr = 4;
605d7dfca08SIgor Mitsyanko         if ((dscr->attr & SDHC_ADMA_ATTR_ACT_MASK) == SDHC_ADMA_ATTR_SET_LEN) {
606d7dfca08SIgor Mitsyanko             dscr->length = (uint16_t)extract32(adma1, 12, 16);
607d7dfca08SIgor Mitsyanko         } else {
608d7dfca08SIgor Mitsyanko             dscr->length = 4096;
609d7dfca08SIgor Mitsyanko         }
610d7dfca08SIgor Mitsyanko         break;
611d7dfca08SIgor Mitsyanko     case SDHC_CTRL_ADMA2_64:
612df32fd1cSPaolo Bonzini         dma_memory_read(&address_space_memory, entry_addr,
613d7dfca08SIgor Mitsyanko                         (uint8_t *)(&dscr->attr), 1);
614df32fd1cSPaolo Bonzini         dma_memory_read(&address_space_memory, entry_addr + 2,
615d7dfca08SIgor Mitsyanko                         (uint8_t *)(&dscr->length), 2);
616d7dfca08SIgor Mitsyanko         dscr->length = le16_to_cpu(dscr->length);
617df32fd1cSPaolo Bonzini         dma_memory_read(&address_space_memory, entry_addr + 4,
618d7dfca08SIgor Mitsyanko                         (uint8_t *)(&dscr->addr), 8);
619d7dfca08SIgor Mitsyanko         dscr->attr = le64_to_cpu(dscr->attr);
620d7dfca08SIgor Mitsyanko         dscr->attr &= 0xfffffff8;
621d7dfca08SIgor Mitsyanko         dscr->incr = 12;
622d7dfca08SIgor Mitsyanko         break;
623d7dfca08SIgor Mitsyanko     }
624d7dfca08SIgor Mitsyanko }
625d7dfca08SIgor Mitsyanko 
626d7dfca08SIgor Mitsyanko /* Advanced DMA data transfer */
627d7dfca08SIgor Mitsyanko 
628d7dfca08SIgor Mitsyanko static void sdhci_do_adma(SDHCIState *s)
629d7dfca08SIgor Mitsyanko {
630d7dfca08SIgor Mitsyanko     unsigned int n, begin, length;
631d7dfca08SIgor Mitsyanko     const uint16_t block_size = s->blksize & 0x0fff;
632d7dfca08SIgor Mitsyanko     ADMADescr dscr;
633d7dfca08SIgor Mitsyanko     int i;
634d7dfca08SIgor Mitsyanko 
635d7dfca08SIgor Mitsyanko     for (i = 0; i < SDHC_ADMA_DESCS_PER_DELAY; ++i) {
636d7dfca08SIgor Mitsyanko         s->admaerr &= ~SDHC_ADMAERR_LENGTH_MISMATCH;
637d7dfca08SIgor Mitsyanko 
638d7dfca08SIgor Mitsyanko         get_adma_description(s, &dscr);
639d7dfca08SIgor Mitsyanko         DPRINT_L2("ADMA loop: addr=" TARGET_FMT_plx ", len=%d, attr=%x\n",
640d7dfca08SIgor Mitsyanko                 dscr.addr, dscr.length, dscr.attr);
641d7dfca08SIgor Mitsyanko 
642d7dfca08SIgor Mitsyanko         if ((dscr.attr & SDHC_ADMA_ATTR_VALID) == 0) {
643d7dfca08SIgor Mitsyanko             /* Indicate that error occurred in ST_FDS state */
644d7dfca08SIgor Mitsyanko             s->admaerr &= ~SDHC_ADMAERR_STATE_MASK;
645d7dfca08SIgor Mitsyanko             s->admaerr |= SDHC_ADMAERR_STATE_ST_FDS;
646d7dfca08SIgor Mitsyanko 
647d7dfca08SIgor Mitsyanko             /* Generate ADMA error interrupt */
648d7dfca08SIgor Mitsyanko             if (s->errintstsen & SDHC_EISEN_ADMAERR) {
649d7dfca08SIgor Mitsyanko                 s->errintsts |= SDHC_EIS_ADMAERR;
650d7dfca08SIgor Mitsyanko                 s->norintsts |= SDHC_NIS_ERR;
651d7dfca08SIgor Mitsyanko             }
652d7dfca08SIgor Mitsyanko 
653d7dfca08SIgor Mitsyanko             sdhci_update_irq(s);
654d7dfca08SIgor Mitsyanko             return;
655d7dfca08SIgor Mitsyanko         }
656d7dfca08SIgor Mitsyanko 
657d7dfca08SIgor Mitsyanko         length = dscr.length ? dscr.length : 65536;
658d7dfca08SIgor Mitsyanko 
659d7dfca08SIgor Mitsyanko         switch (dscr.attr & SDHC_ADMA_ATTR_ACT_MASK) {
660d7dfca08SIgor Mitsyanko         case SDHC_ADMA_ATTR_ACT_TRAN:  /* data transfer */
661d7dfca08SIgor Mitsyanko 
662d7dfca08SIgor Mitsyanko             if (s->trnmod & SDHC_TRNS_READ) {
663d7dfca08SIgor Mitsyanko                 while (length) {
664d7dfca08SIgor Mitsyanko                     if (s->data_count == 0) {
665d7dfca08SIgor Mitsyanko                         for (n = 0; n < block_size; n++) {
666d7dfca08SIgor Mitsyanko                             s->fifo_buffer[n] = sd_read_data(s->card);
667d7dfca08SIgor Mitsyanko                         }
668d7dfca08SIgor Mitsyanko                     }
669d7dfca08SIgor Mitsyanko                     begin = s->data_count;
670d7dfca08SIgor Mitsyanko                     if ((length + begin) < block_size) {
671d7dfca08SIgor Mitsyanko                         s->data_count = length + begin;
672d7dfca08SIgor Mitsyanko                         length = 0;
673d7dfca08SIgor Mitsyanko                      } else {
674d7dfca08SIgor Mitsyanko                         s->data_count = block_size;
675d7dfca08SIgor Mitsyanko                         length -= block_size - begin;
676d7dfca08SIgor Mitsyanko                     }
677df32fd1cSPaolo Bonzini                     dma_memory_write(&address_space_memory, dscr.addr,
678d7dfca08SIgor Mitsyanko                                      &s->fifo_buffer[begin],
679d7dfca08SIgor Mitsyanko                                      s->data_count - begin);
680d7dfca08SIgor Mitsyanko                     dscr.addr += s->data_count - begin;
681d7dfca08SIgor Mitsyanko                     if (s->data_count == block_size) {
682d7dfca08SIgor Mitsyanko                         s->data_count = 0;
683d7dfca08SIgor Mitsyanko                         if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
684d7dfca08SIgor Mitsyanko                             s->blkcnt--;
685d7dfca08SIgor Mitsyanko                             if (s->blkcnt == 0) {
686d7dfca08SIgor Mitsyanko                                 break;
687d7dfca08SIgor Mitsyanko                             }
688d7dfca08SIgor Mitsyanko                         }
689d7dfca08SIgor Mitsyanko                     }
690d7dfca08SIgor Mitsyanko                 }
691d7dfca08SIgor Mitsyanko             } else {
692d7dfca08SIgor Mitsyanko                 while (length) {
693d7dfca08SIgor Mitsyanko                     begin = s->data_count;
694d7dfca08SIgor Mitsyanko                     if ((length + begin) < block_size) {
695d7dfca08SIgor Mitsyanko                         s->data_count = length + begin;
696d7dfca08SIgor Mitsyanko                         length = 0;
697d7dfca08SIgor Mitsyanko                      } else {
698d7dfca08SIgor Mitsyanko                         s->data_count = block_size;
699d7dfca08SIgor Mitsyanko                         length -= block_size - begin;
700d7dfca08SIgor Mitsyanko                     }
701df32fd1cSPaolo Bonzini                     dma_memory_read(&address_space_memory, dscr.addr,
7029db11cefSPeter Crosthwaite                                     &s->fifo_buffer[begin],
7039db11cefSPeter Crosthwaite                                     s->data_count - begin);
704d7dfca08SIgor Mitsyanko                     dscr.addr += s->data_count - begin;
705d7dfca08SIgor Mitsyanko                     if (s->data_count == block_size) {
706d7dfca08SIgor Mitsyanko                         for (n = 0; n < block_size; n++) {
707d7dfca08SIgor Mitsyanko                             sd_write_data(s->card, s->fifo_buffer[n]);
708d7dfca08SIgor Mitsyanko                         }
709d7dfca08SIgor Mitsyanko                         s->data_count = 0;
710d7dfca08SIgor Mitsyanko                         if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) {
711d7dfca08SIgor Mitsyanko                             s->blkcnt--;
712d7dfca08SIgor Mitsyanko                             if (s->blkcnt == 0) {
713d7dfca08SIgor Mitsyanko                                 break;
714d7dfca08SIgor Mitsyanko                             }
715d7dfca08SIgor Mitsyanko                         }
716d7dfca08SIgor Mitsyanko                     }
717d7dfca08SIgor Mitsyanko                 }
718d7dfca08SIgor Mitsyanko             }
719d7dfca08SIgor Mitsyanko             s->admasysaddr += dscr.incr;
720d7dfca08SIgor Mitsyanko             break;
721d7dfca08SIgor Mitsyanko         case SDHC_ADMA_ATTR_ACT_LINK:   /* link to next descriptor table */
722d7dfca08SIgor Mitsyanko             s->admasysaddr = dscr.addr;
723*be9c5ddeSSai Pavan Boddu             DPRINT_L1("ADMA link: admasysaddr=0x%" PRIx64 "\n",
724*be9c5ddeSSai Pavan Boddu                       s->admasysaddr);
725d7dfca08SIgor Mitsyanko             break;
726d7dfca08SIgor Mitsyanko         default:
727d7dfca08SIgor Mitsyanko             s->admasysaddr += dscr.incr;
728d7dfca08SIgor Mitsyanko             break;
729d7dfca08SIgor Mitsyanko         }
730d7dfca08SIgor Mitsyanko 
7311d32c26fSPeter Crosthwaite         if (dscr.attr & SDHC_ADMA_ATTR_INT) {
732*be9c5ddeSSai Pavan Boddu             DPRINT_L1("ADMA interrupt: admasysaddr=0x%" PRIx64 "\n",
733*be9c5ddeSSai Pavan Boddu                       s->admasysaddr);
7341d32c26fSPeter Crosthwaite             if (s->norintstsen & SDHC_NISEN_DMA) {
7351d32c26fSPeter Crosthwaite                 s->norintsts |= SDHC_NIS_DMA;
7361d32c26fSPeter Crosthwaite             }
7371d32c26fSPeter Crosthwaite 
7381d32c26fSPeter Crosthwaite             sdhci_update_irq(s);
7391d32c26fSPeter Crosthwaite         }
7401d32c26fSPeter Crosthwaite 
741d7dfca08SIgor Mitsyanko         /* ADMA transfer terminates if blkcnt == 0 or by END attribute */
742d7dfca08SIgor Mitsyanko         if (((s->trnmod & SDHC_TRNS_BLK_CNT_EN) &&
743d7dfca08SIgor Mitsyanko                     (s->blkcnt == 0)) || (dscr.attr & SDHC_ADMA_ATTR_END)) {
744d7dfca08SIgor Mitsyanko             DPRINT_L2("ADMA transfer completed\n");
745d7dfca08SIgor Mitsyanko             if (length || ((dscr.attr & SDHC_ADMA_ATTR_END) &&
746d7dfca08SIgor Mitsyanko                 (s->trnmod & SDHC_TRNS_BLK_CNT_EN) &&
747d7dfca08SIgor Mitsyanko                 s->blkcnt != 0)) {
748d7dfca08SIgor Mitsyanko                 ERRPRINT("SD/MMC host ADMA length mismatch\n");
749d7dfca08SIgor Mitsyanko                 s->admaerr |= SDHC_ADMAERR_LENGTH_MISMATCH |
750d7dfca08SIgor Mitsyanko                         SDHC_ADMAERR_STATE_ST_TFR;
751d7dfca08SIgor Mitsyanko                 if (s->errintstsen & SDHC_EISEN_ADMAERR) {
752d7dfca08SIgor Mitsyanko                     ERRPRINT("Set ADMA error flag\n");
753d7dfca08SIgor Mitsyanko                     s->errintsts |= SDHC_EIS_ADMAERR;
754d7dfca08SIgor Mitsyanko                     s->norintsts |= SDHC_NIS_ERR;
755d7dfca08SIgor Mitsyanko                 }
756d7dfca08SIgor Mitsyanko 
757d7dfca08SIgor Mitsyanko                 sdhci_update_irq(s);
758d7dfca08SIgor Mitsyanko             }
759d368ba43SKevin O'Connor             sdhci_end_transfer(s);
760d7dfca08SIgor Mitsyanko             return;
761d7dfca08SIgor Mitsyanko         }
762d7dfca08SIgor Mitsyanko 
763d7dfca08SIgor Mitsyanko     }
764d7dfca08SIgor Mitsyanko 
765085d8134SPeter Maydell     /* we have unfinished business - reschedule to continue ADMA */
766bc72ad67SAlex Bligh     timer_mod(s->transfer_timer,
767bc72ad67SAlex Bligh                    qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + SDHC_TRANSFER_DELAY);
768d7dfca08SIgor Mitsyanko }
769d7dfca08SIgor Mitsyanko 
770d7dfca08SIgor Mitsyanko /* Perform data transfer according to controller configuration */
771d7dfca08SIgor Mitsyanko 
772d368ba43SKevin O'Connor static void sdhci_data_transfer(void *opaque)
773d7dfca08SIgor Mitsyanko {
774d368ba43SKevin O'Connor     SDHCIState *s = (SDHCIState *)opaque;
775d7dfca08SIgor Mitsyanko 
776d7dfca08SIgor Mitsyanko     if (s->trnmod & SDHC_TRNS_DMA) {
777d7dfca08SIgor Mitsyanko         switch (SDHC_DMA_TYPE(s->hostctl)) {
778d7dfca08SIgor Mitsyanko         case SDHC_CTRL_SDMA:
779d7dfca08SIgor Mitsyanko             if ((s->trnmod & SDHC_TRNS_MULTI) &&
780d7dfca08SIgor Mitsyanko                     (!(s->trnmod & SDHC_TRNS_BLK_CNT_EN) || s->blkcnt == 0)) {
781d7dfca08SIgor Mitsyanko                 break;
782d7dfca08SIgor Mitsyanko             }
783d7dfca08SIgor Mitsyanko 
784d7dfca08SIgor Mitsyanko             if ((s->blkcnt == 1) || !(s->trnmod & SDHC_TRNS_MULTI)) {
785d368ba43SKevin O'Connor                 sdhci_sdma_transfer_single_block(s);
786d7dfca08SIgor Mitsyanko             } else {
787d368ba43SKevin O'Connor                 sdhci_sdma_transfer_multi_blocks(s);
788d7dfca08SIgor Mitsyanko             }
789d7dfca08SIgor Mitsyanko 
790d7dfca08SIgor Mitsyanko             break;
791d7dfca08SIgor Mitsyanko         case SDHC_CTRL_ADMA1_32:
792d7dfca08SIgor Mitsyanko             if (!(s->capareg & SDHC_CAN_DO_ADMA1)) {
793d7dfca08SIgor Mitsyanko                 ERRPRINT("ADMA1 not supported\n");
794d7dfca08SIgor Mitsyanko                 break;
795d7dfca08SIgor Mitsyanko             }
796d7dfca08SIgor Mitsyanko 
797d368ba43SKevin O'Connor             sdhci_do_adma(s);
798d7dfca08SIgor Mitsyanko             break;
799d7dfca08SIgor Mitsyanko         case SDHC_CTRL_ADMA2_32:
800d7dfca08SIgor Mitsyanko             if (!(s->capareg & SDHC_CAN_DO_ADMA2)) {
801d7dfca08SIgor Mitsyanko                 ERRPRINT("ADMA2 not supported\n");
802d7dfca08SIgor Mitsyanko                 break;
803d7dfca08SIgor Mitsyanko             }
804d7dfca08SIgor Mitsyanko 
805d368ba43SKevin O'Connor             sdhci_do_adma(s);
806d7dfca08SIgor Mitsyanko             break;
807d7dfca08SIgor Mitsyanko         case SDHC_CTRL_ADMA2_64:
808d7dfca08SIgor Mitsyanko             if (!(s->capareg & SDHC_CAN_DO_ADMA2) ||
809d7dfca08SIgor Mitsyanko                     !(s->capareg & SDHC_64_BIT_BUS_SUPPORT)) {
810d7dfca08SIgor Mitsyanko                 ERRPRINT("64 bit ADMA not supported\n");
811d7dfca08SIgor Mitsyanko                 break;
812d7dfca08SIgor Mitsyanko             }
813d7dfca08SIgor Mitsyanko 
814d368ba43SKevin O'Connor             sdhci_do_adma(s);
815d7dfca08SIgor Mitsyanko             break;
816d7dfca08SIgor Mitsyanko         default:
817d7dfca08SIgor Mitsyanko             ERRPRINT("Unsupported DMA type\n");
818d7dfca08SIgor Mitsyanko             break;
819d7dfca08SIgor Mitsyanko         }
820d7dfca08SIgor Mitsyanko     } else {
821d7dfca08SIgor Mitsyanko         if ((s->trnmod & SDHC_TRNS_READ) && sd_data_ready(s->card)) {
822d7dfca08SIgor Mitsyanko             s->prnsts |= SDHC_DOING_READ | SDHC_DATA_INHIBIT |
823d7dfca08SIgor Mitsyanko                     SDHC_DAT_LINE_ACTIVE;
824d368ba43SKevin O'Connor             sdhci_read_block_from_card(s);
825d7dfca08SIgor Mitsyanko         } else {
826d7dfca08SIgor Mitsyanko             s->prnsts |= SDHC_DOING_WRITE | SDHC_DAT_LINE_ACTIVE |
827d7dfca08SIgor Mitsyanko                     SDHC_SPACE_AVAILABLE | SDHC_DATA_INHIBIT;
828d368ba43SKevin O'Connor             sdhci_write_block_to_card(s);
829d7dfca08SIgor Mitsyanko         }
830d7dfca08SIgor Mitsyanko     }
831d7dfca08SIgor Mitsyanko }
832d7dfca08SIgor Mitsyanko 
833d7dfca08SIgor Mitsyanko static bool sdhci_can_issue_command(SDHCIState *s)
834d7dfca08SIgor Mitsyanko {
835d7dfca08SIgor Mitsyanko     if (!SDHC_CLOCK_IS_ON(s->clkcon) || !(s->pwrcon & SDHC_POWER_ON) ||
836d7dfca08SIgor Mitsyanko         (((s->prnsts & SDHC_DATA_INHIBIT) || s->stopped_state) &&
837d7dfca08SIgor Mitsyanko         ((s->cmdreg & SDHC_CMD_DATA_PRESENT) ||
838d7dfca08SIgor Mitsyanko         ((s->cmdreg & SDHC_CMD_RESPONSE) == SDHC_CMD_RSP_WITH_BUSY &&
839d7dfca08SIgor Mitsyanko         !(SDHC_COMMAND_TYPE(s->cmdreg) == SDHC_CMD_ABORT))))) {
840d7dfca08SIgor Mitsyanko         return false;
841d7dfca08SIgor Mitsyanko     }
842d7dfca08SIgor Mitsyanko 
843d7dfca08SIgor Mitsyanko     return true;
844d7dfca08SIgor Mitsyanko }
845d7dfca08SIgor Mitsyanko 
846d7dfca08SIgor Mitsyanko /* The Buffer Data Port register must be accessed in sequential and
847d7dfca08SIgor Mitsyanko  * continuous manner */
848d7dfca08SIgor Mitsyanko static inline bool
849d7dfca08SIgor Mitsyanko sdhci_buff_access_is_sequential(SDHCIState *s, unsigned byte_num)
850d7dfca08SIgor Mitsyanko {
851d7dfca08SIgor Mitsyanko     if ((s->data_count & 0x3) != byte_num) {
852d7dfca08SIgor Mitsyanko         ERRPRINT("Non-sequential access to Buffer Data Port register"
853d7dfca08SIgor Mitsyanko                 "is prohibited\n");
854d7dfca08SIgor Mitsyanko         return false;
855d7dfca08SIgor Mitsyanko     }
856d7dfca08SIgor Mitsyanko     return true;
857d7dfca08SIgor Mitsyanko }
858d7dfca08SIgor Mitsyanko 
859d368ba43SKevin O'Connor static uint64_t sdhci_read(void *opaque, hwaddr offset, unsigned size)
860d7dfca08SIgor Mitsyanko {
861d368ba43SKevin O'Connor     SDHCIState *s = (SDHCIState *)opaque;
862d7dfca08SIgor Mitsyanko     uint32_t ret = 0;
863d7dfca08SIgor Mitsyanko 
864d7dfca08SIgor Mitsyanko     switch (offset & ~0x3) {
865d7dfca08SIgor Mitsyanko     case SDHC_SYSAD:
866d7dfca08SIgor Mitsyanko         ret = s->sdmasysad;
867d7dfca08SIgor Mitsyanko         break;
868d7dfca08SIgor Mitsyanko     case SDHC_BLKSIZE:
869d7dfca08SIgor Mitsyanko         ret = s->blksize | (s->blkcnt << 16);
870d7dfca08SIgor Mitsyanko         break;
871d7dfca08SIgor Mitsyanko     case SDHC_ARGUMENT:
872d7dfca08SIgor Mitsyanko         ret = s->argument;
873d7dfca08SIgor Mitsyanko         break;
874d7dfca08SIgor Mitsyanko     case SDHC_TRNMOD:
875d7dfca08SIgor Mitsyanko         ret = s->trnmod | (s->cmdreg << 16);
876d7dfca08SIgor Mitsyanko         break;
877d7dfca08SIgor Mitsyanko     case SDHC_RSPREG0 ... SDHC_RSPREG3:
878d7dfca08SIgor Mitsyanko         ret = s->rspreg[((offset & ~0x3) - SDHC_RSPREG0) >> 2];
879d7dfca08SIgor Mitsyanko         break;
880d7dfca08SIgor Mitsyanko     case  SDHC_BDATA:
881d7dfca08SIgor Mitsyanko         if (sdhci_buff_access_is_sequential(s, offset - SDHC_BDATA)) {
882d368ba43SKevin O'Connor             ret = sdhci_read_dataport(s, size);
883d368ba43SKevin O'Connor             DPRINT_L2("read %ub: addr[0x%04x] -> %u(0x%x)\n", size, (int)offset,
884677ff2aeSPeter Crosthwaite                       ret, ret);
885d7dfca08SIgor Mitsyanko             return ret;
886d7dfca08SIgor Mitsyanko         }
887d7dfca08SIgor Mitsyanko         break;
888d7dfca08SIgor Mitsyanko     case SDHC_PRNSTS:
889d7dfca08SIgor Mitsyanko         ret = s->prnsts;
890d7dfca08SIgor Mitsyanko         break;
891d7dfca08SIgor Mitsyanko     case SDHC_HOSTCTL:
892d7dfca08SIgor Mitsyanko         ret = s->hostctl | (s->pwrcon << 8) | (s->blkgap << 16) |
893d7dfca08SIgor Mitsyanko               (s->wakcon << 24);
894d7dfca08SIgor Mitsyanko         break;
895d7dfca08SIgor Mitsyanko     case SDHC_CLKCON:
896d7dfca08SIgor Mitsyanko         ret = s->clkcon | (s->timeoutcon << 16);
897d7dfca08SIgor Mitsyanko         break;
898d7dfca08SIgor Mitsyanko     case SDHC_NORINTSTS:
899d7dfca08SIgor Mitsyanko         ret = s->norintsts | (s->errintsts << 16);
900d7dfca08SIgor Mitsyanko         break;
901d7dfca08SIgor Mitsyanko     case SDHC_NORINTSTSEN:
902d7dfca08SIgor Mitsyanko         ret = s->norintstsen | (s->errintstsen << 16);
903d7dfca08SIgor Mitsyanko         break;
904d7dfca08SIgor Mitsyanko     case SDHC_NORINTSIGEN:
905d7dfca08SIgor Mitsyanko         ret = s->norintsigen | (s->errintsigen << 16);
906d7dfca08SIgor Mitsyanko         break;
907d7dfca08SIgor Mitsyanko     case SDHC_ACMD12ERRSTS:
908d7dfca08SIgor Mitsyanko         ret = s->acmd12errsts;
909d7dfca08SIgor Mitsyanko         break;
910d7dfca08SIgor Mitsyanko     case SDHC_CAPAREG:
911d7dfca08SIgor Mitsyanko         ret = s->capareg;
912d7dfca08SIgor Mitsyanko         break;
913d7dfca08SIgor Mitsyanko     case SDHC_MAXCURR:
914d7dfca08SIgor Mitsyanko         ret = s->maxcurr;
915d7dfca08SIgor Mitsyanko         break;
916d7dfca08SIgor Mitsyanko     case SDHC_ADMAERR:
917d7dfca08SIgor Mitsyanko         ret =  s->admaerr;
918d7dfca08SIgor Mitsyanko         break;
919d7dfca08SIgor Mitsyanko     case SDHC_ADMASYSADDR:
920d7dfca08SIgor Mitsyanko         ret = (uint32_t)s->admasysaddr;
921d7dfca08SIgor Mitsyanko         break;
922d7dfca08SIgor Mitsyanko     case SDHC_ADMASYSADDR + 4:
923d7dfca08SIgor Mitsyanko         ret = (uint32_t)(s->admasysaddr >> 32);
924d7dfca08SIgor Mitsyanko         break;
925d7dfca08SIgor Mitsyanko     case SDHC_SLOT_INT_STATUS:
926d7dfca08SIgor Mitsyanko         ret = (SD_HOST_SPECv2_VERS << 16) | sdhci_slotint(s);
927d7dfca08SIgor Mitsyanko         break;
928d7dfca08SIgor Mitsyanko     default:
929d368ba43SKevin O'Connor         ERRPRINT("bad %ub read: addr[0x%04x]\n", size, (int)offset);
930d7dfca08SIgor Mitsyanko         break;
931d7dfca08SIgor Mitsyanko     }
932d7dfca08SIgor Mitsyanko 
933d7dfca08SIgor Mitsyanko     ret >>= (offset & 0x3) * 8;
934d7dfca08SIgor Mitsyanko     ret &= (1ULL << (size * 8)) - 1;
935d368ba43SKevin O'Connor     DPRINT_L2("read %ub: addr[0x%04x] -> %u(0x%x)\n", size, (int)offset, ret, ret);
936d7dfca08SIgor Mitsyanko     return ret;
937d7dfca08SIgor Mitsyanko }
938d7dfca08SIgor Mitsyanko 
939d7dfca08SIgor Mitsyanko static inline void sdhci_blkgap_write(SDHCIState *s, uint8_t value)
940d7dfca08SIgor Mitsyanko {
941d7dfca08SIgor Mitsyanko     if ((value & SDHC_STOP_AT_GAP_REQ) && (s->blkgap & SDHC_STOP_AT_GAP_REQ)) {
942d7dfca08SIgor Mitsyanko         return;
943d7dfca08SIgor Mitsyanko     }
944d7dfca08SIgor Mitsyanko     s->blkgap = value & SDHC_STOP_AT_GAP_REQ;
945d7dfca08SIgor Mitsyanko 
946d7dfca08SIgor Mitsyanko     if ((value & SDHC_CONTINUE_REQ) && s->stopped_state &&
947d7dfca08SIgor Mitsyanko             (s->blkgap & SDHC_STOP_AT_GAP_REQ) == 0) {
948d7dfca08SIgor Mitsyanko         if (s->stopped_state == sdhc_gap_read) {
949d7dfca08SIgor Mitsyanko             s->prnsts |= SDHC_DAT_LINE_ACTIVE | SDHC_DOING_READ;
950d368ba43SKevin O'Connor             sdhci_read_block_from_card(s);
951d7dfca08SIgor Mitsyanko         } else {
952d7dfca08SIgor Mitsyanko             s->prnsts |= SDHC_DAT_LINE_ACTIVE | SDHC_DOING_WRITE;
953d368ba43SKevin O'Connor             sdhci_write_block_to_card(s);
954d7dfca08SIgor Mitsyanko         }
955d7dfca08SIgor Mitsyanko         s->stopped_state = sdhc_not_stopped;
956d7dfca08SIgor Mitsyanko     } else if (!s->stopped_state && (value & SDHC_STOP_AT_GAP_REQ)) {
957d7dfca08SIgor Mitsyanko         if (s->prnsts & SDHC_DOING_READ) {
958d7dfca08SIgor Mitsyanko             s->stopped_state = sdhc_gap_read;
959d7dfca08SIgor Mitsyanko         } else if (s->prnsts & SDHC_DOING_WRITE) {
960d7dfca08SIgor Mitsyanko             s->stopped_state = sdhc_gap_write;
961d7dfca08SIgor Mitsyanko         }
962d7dfca08SIgor Mitsyanko     }
963d7dfca08SIgor Mitsyanko }
964d7dfca08SIgor Mitsyanko 
965d7dfca08SIgor Mitsyanko static inline void sdhci_reset_write(SDHCIState *s, uint8_t value)
966d7dfca08SIgor Mitsyanko {
967d7dfca08SIgor Mitsyanko     switch (value) {
968d7dfca08SIgor Mitsyanko     case SDHC_RESET_ALL:
969d368ba43SKevin O'Connor         sdhci_reset(s);
970d7dfca08SIgor Mitsyanko         break;
971d7dfca08SIgor Mitsyanko     case SDHC_RESET_CMD:
972d7dfca08SIgor Mitsyanko         s->prnsts &= ~SDHC_CMD_INHIBIT;
973d7dfca08SIgor Mitsyanko         s->norintsts &= ~SDHC_NIS_CMDCMP;
974d7dfca08SIgor Mitsyanko         break;
975d7dfca08SIgor Mitsyanko     case SDHC_RESET_DATA:
976d7dfca08SIgor Mitsyanko         s->data_count = 0;
977d7dfca08SIgor Mitsyanko         s->prnsts &= ~(SDHC_SPACE_AVAILABLE | SDHC_DATA_AVAILABLE |
978d7dfca08SIgor Mitsyanko                 SDHC_DOING_READ | SDHC_DOING_WRITE |
979d7dfca08SIgor Mitsyanko                 SDHC_DATA_INHIBIT | SDHC_DAT_LINE_ACTIVE);
980d7dfca08SIgor Mitsyanko         s->blkgap &= ~(SDHC_STOP_AT_GAP_REQ | SDHC_CONTINUE_REQ);
981d7dfca08SIgor Mitsyanko         s->stopped_state = sdhc_not_stopped;
982d7dfca08SIgor Mitsyanko         s->norintsts &= ~(SDHC_NIS_WBUFRDY | SDHC_NIS_RBUFRDY |
983d7dfca08SIgor Mitsyanko                 SDHC_NIS_DMA | SDHC_NIS_TRSCMP | SDHC_NIS_BLKGAP);
984d7dfca08SIgor Mitsyanko         break;
985d7dfca08SIgor Mitsyanko     }
986d7dfca08SIgor Mitsyanko }
987d7dfca08SIgor Mitsyanko 
988d7dfca08SIgor Mitsyanko static void
989d368ba43SKevin O'Connor sdhci_write(void *opaque, hwaddr offset, uint64_t val, unsigned size)
990d7dfca08SIgor Mitsyanko {
991d368ba43SKevin O'Connor     SDHCIState *s = (SDHCIState *)opaque;
992d7dfca08SIgor Mitsyanko     unsigned shift =  8 * (offset & 0x3);
993d7dfca08SIgor Mitsyanko     uint32_t mask = ~(((1ULL << (size * 8)) - 1) << shift);
994d368ba43SKevin O'Connor     uint32_t value = val;
995d7dfca08SIgor Mitsyanko     value <<= shift;
996d7dfca08SIgor Mitsyanko 
997d7dfca08SIgor Mitsyanko     switch (offset & ~0x3) {
998d7dfca08SIgor Mitsyanko     case SDHC_SYSAD:
999d7dfca08SIgor Mitsyanko         s->sdmasysad = (s->sdmasysad & mask) | value;
1000d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->sdmasysad, mask, value);
1001d7dfca08SIgor Mitsyanko         /* Writing to last byte of sdmasysad might trigger transfer */
1002d7dfca08SIgor Mitsyanko         if (!(mask & 0xFF000000) && TRANSFERRING_DATA(s->prnsts) && s->blkcnt &&
1003d7dfca08SIgor Mitsyanko                 s->blksize && SDHC_DMA_TYPE(s->hostctl) == SDHC_CTRL_SDMA) {
1004d368ba43SKevin O'Connor             sdhci_sdma_transfer_multi_blocks(s);
1005d7dfca08SIgor Mitsyanko         }
1006d7dfca08SIgor Mitsyanko         break;
1007d7dfca08SIgor Mitsyanko     case SDHC_BLKSIZE:
1008d7dfca08SIgor Mitsyanko         if (!TRANSFERRING_DATA(s->prnsts)) {
1009d7dfca08SIgor Mitsyanko             MASKED_WRITE(s->blksize, mask, value);
1010d7dfca08SIgor Mitsyanko             MASKED_WRITE(s->blkcnt, mask >> 16, value >> 16);
1011d7dfca08SIgor Mitsyanko         }
1012d7dfca08SIgor Mitsyanko         break;
1013d7dfca08SIgor Mitsyanko     case SDHC_ARGUMENT:
1014d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->argument, mask, value);
1015d7dfca08SIgor Mitsyanko         break;
1016d7dfca08SIgor Mitsyanko     case SDHC_TRNMOD:
1017d7dfca08SIgor Mitsyanko         /* DMA can be enabled only if it is supported as indicated by
1018d7dfca08SIgor Mitsyanko          * capabilities register */
1019d7dfca08SIgor Mitsyanko         if (!(s->capareg & SDHC_CAN_DO_DMA)) {
1020d7dfca08SIgor Mitsyanko             value &= ~SDHC_TRNS_DMA;
1021d7dfca08SIgor Mitsyanko         }
1022d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->trnmod, mask, value);
1023d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->cmdreg, mask >> 16, value >> 16);
1024d7dfca08SIgor Mitsyanko 
1025d7dfca08SIgor Mitsyanko         /* Writing to the upper byte of CMDREG triggers SD command generation */
1026d368ba43SKevin O'Connor         if ((mask & 0xFF000000) || !sdhci_can_issue_command(s)) {
1027d7dfca08SIgor Mitsyanko             break;
1028d7dfca08SIgor Mitsyanko         }
1029d7dfca08SIgor Mitsyanko 
1030d368ba43SKevin O'Connor         sdhci_send_command(s);
1031d7dfca08SIgor Mitsyanko         break;
1032d7dfca08SIgor Mitsyanko     case  SDHC_BDATA:
1033d7dfca08SIgor Mitsyanko         if (sdhci_buff_access_is_sequential(s, offset - SDHC_BDATA)) {
1034d368ba43SKevin O'Connor             sdhci_write_dataport(s, value >> shift, size);
1035d7dfca08SIgor Mitsyanko         }
1036d7dfca08SIgor Mitsyanko         break;
1037d7dfca08SIgor Mitsyanko     case SDHC_HOSTCTL:
1038d7dfca08SIgor Mitsyanko         if (!(mask & 0xFF0000)) {
1039d7dfca08SIgor Mitsyanko             sdhci_blkgap_write(s, value >> 16);
1040d7dfca08SIgor Mitsyanko         }
1041d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->hostctl, mask, value);
1042d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->pwrcon, mask >> 8, value >> 8);
1043d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->wakcon, mask >> 24, value >> 24);
1044d7dfca08SIgor Mitsyanko         if (!(s->prnsts & SDHC_CARD_PRESENT) || ((s->pwrcon >> 1) & 0x7) < 5 ||
1045d7dfca08SIgor Mitsyanko                 !(s->capareg & (1 << (31 - ((s->pwrcon >> 1) & 0x7))))) {
1046d7dfca08SIgor Mitsyanko             s->pwrcon &= ~SDHC_POWER_ON;
1047d7dfca08SIgor Mitsyanko         }
1048d7dfca08SIgor Mitsyanko         break;
1049d7dfca08SIgor Mitsyanko     case SDHC_CLKCON:
1050d7dfca08SIgor Mitsyanko         if (!(mask & 0xFF000000)) {
1051d7dfca08SIgor Mitsyanko             sdhci_reset_write(s, value >> 24);
1052d7dfca08SIgor Mitsyanko         }
1053d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->clkcon, mask, value);
1054d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->timeoutcon, mask >> 16, value >> 16);
1055d7dfca08SIgor Mitsyanko         if (s->clkcon & SDHC_CLOCK_INT_EN) {
1056d7dfca08SIgor Mitsyanko             s->clkcon |= SDHC_CLOCK_INT_STABLE;
1057d7dfca08SIgor Mitsyanko         } else {
1058d7dfca08SIgor Mitsyanko             s->clkcon &= ~SDHC_CLOCK_INT_STABLE;
1059d7dfca08SIgor Mitsyanko         }
1060d7dfca08SIgor Mitsyanko         break;
1061d7dfca08SIgor Mitsyanko     case SDHC_NORINTSTS:
1062d7dfca08SIgor Mitsyanko         if (s->norintstsen & SDHC_NISEN_CARDINT) {
1063d7dfca08SIgor Mitsyanko             value &= ~SDHC_NIS_CARDINT;
1064d7dfca08SIgor Mitsyanko         }
1065d7dfca08SIgor Mitsyanko         s->norintsts &= mask | ~value;
1066d7dfca08SIgor Mitsyanko         s->errintsts &= (mask >> 16) | ~(value >> 16);
1067d7dfca08SIgor Mitsyanko         if (s->errintsts) {
1068d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_ERR;
1069d7dfca08SIgor Mitsyanko         } else {
1070d7dfca08SIgor Mitsyanko             s->norintsts &= ~SDHC_NIS_ERR;
1071d7dfca08SIgor Mitsyanko         }
1072d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
1073d7dfca08SIgor Mitsyanko         break;
1074d7dfca08SIgor Mitsyanko     case SDHC_NORINTSTSEN:
1075d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->norintstsen, mask, value);
1076d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->errintstsen, mask >> 16, value >> 16);
1077d7dfca08SIgor Mitsyanko         s->norintsts &= s->norintstsen;
1078d7dfca08SIgor Mitsyanko         s->errintsts &= s->errintstsen;
1079d7dfca08SIgor Mitsyanko         if (s->errintsts) {
1080d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_ERR;
1081d7dfca08SIgor Mitsyanko         } else {
1082d7dfca08SIgor Mitsyanko             s->norintsts &= ~SDHC_NIS_ERR;
1083d7dfca08SIgor Mitsyanko         }
1084d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
1085d7dfca08SIgor Mitsyanko         break;
1086d7dfca08SIgor Mitsyanko     case SDHC_NORINTSIGEN:
1087d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->norintsigen, mask, value);
1088d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->errintsigen, mask >> 16, value >> 16);
1089d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
1090d7dfca08SIgor Mitsyanko         break;
1091d7dfca08SIgor Mitsyanko     case SDHC_ADMAERR:
1092d7dfca08SIgor Mitsyanko         MASKED_WRITE(s->admaerr, mask, value);
1093d7dfca08SIgor Mitsyanko         break;
1094d7dfca08SIgor Mitsyanko     case SDHC_ADMASYSADDR:
1095d7dfca08SIgor Mitsyanko         s->admasysaddr = (s->admasysaddr & (0xFFFFFFFF00000000ULL |
1096d7dfca08SIgor Mitsyanko                 (uint64_t)mask)) | (uint64_t)value;
1097d7dfca08SIgor Mitsyanko         break;
1098d7dfca08SIgor Mitsyanko     case SDHC_ADMASYSADDR + 4:
1099d7dfca08SIgor Mitsyanko         s->admasysaddr = (s->admasysaddr & (0x00000000FFFFFFFFULL |
1100d7dfca08SIgor Mitsyanko                 ((uint64_t)mask << 32))) | ((uint64_t)value << 32);
1101d7dfca08SIgor Mitsyanko         break;
1102d7dfca08SIgor Mitsyanko     case SDHC_FEAER:
1103d7dfca08SIgor Mitsyanko         s->acmd12errsts |= value;
1104d7dfca08SIgor Mitsyanko         s->errintsts |= (value >> 16) & s->errintstsen;
1105d7dfca08SIgor Mitsyanko         if (s->acmd12errsts) {
1106d7dfca08SIgor Mitsyanko             s->errintsts |= SDHC_EIS_CMD12ERR;
1107d7dfca08SIgor Mitsyanko         }
1108d7dfca08SIgor Mitsyanko         if (s->errintsts) {
1109d7dfca08SIgor Mitsyanko             s->norintsts |= SDHC_NIS_ERR;
1110d7dfca08SIgor Mitsyanko         }
1111d7dfca08SIgor Mitsyanko         sdhci_update_irq(s);
1112d7dfca08SIgor Mitsyanko         break;
1113d7dfca08SIgor Mitsyanko     default:
1114d7dfca08SIgor Mitsyanko         ERRPRINT("bad %ub write offset: addr[0x%04x] <- %u(0x%x)\n",
1115d368ba43SKevin O'Connor                  size, (int)offset, value >> shift, value >> shift);
1116d7dfca08SIgor Mitsyanko         break;
1117d7dfca08SIgor Mitsyanko     }
1118d7dfca08SIgor Mitsyanko     DPRINT_L2("write %ub: addr[0x%04x] <- %u(0x%x)\n",
1119d368ba43SKevin O'Connor               size, (int)offset, value >> shift, value >> shift);
1120d7dfca08SIgor Mitsyanko }
1121d7dfca08SIgor Mitsyanko 
1122d7dfca08SIgor Mitsyanko static const MemoryRegionOps sdhci_mmio_ops = {
1123d368ba43SKevin O'Connor     .read = sdhci_read,
1124d368ba43SKevin O'Connor     .write = sdhci_write,
1125d7dfca08SIgor Mitsyanko     .valid = {
1126d7dfca08SIgor Mitsyanko         .min_access_size = 1,
1127d7dfca08SIgor Mitsyanko         .max_access_size = 4,
1128d7dfca08SIgor Mitsyanko         .unaligned = false
1129d7dfca08SIgor Mitsyanko     },
1130d7dfca08SIgor Mitsyanko     .endianness = DEVICE_LITTLE_ENDIAN,
1131d7dfca08SIgor Mitsyanko };
1132d7dfca08SIgor Mitsyanko 
1133d7dfca08SIgor Mitsyanko static inline unsigned int sdhci_get_fifolen(SDHCIState *s)
1134d7dfca08SIgor Mitsyanko {
1135d7dfca08SIgor Mitsyanko     switch (SDHC_CAPAB_BLOCKSIZE(s->capareg)) {
1136d7dfca08SIgor Mitsyanko     case 0:
1137d7dfca08SIgor Mitsyanko         return 512;
1138d7dfca08SIgor Mitsyanko     case 1:
1139d7dfca08SIgor Mitsyanko         return 1024;
1140d7dfca08SIgor Mitsyanko     case 2:
1141d7dfca08SIgor Mitsyanko         return 2048;
1142d7dfca08SIgor Mitsyanko     default:
1143d7dfca08SIgor Mitsyanko         hw_error("SDHC: unsupported value for maximum block size\n");
1144d7dfca08SIgor Mitsyanko         return 0;
1145d7dfca08SIgor Mitsyanko     }
1146d7dfca08SIgor Mitsyanko }
1147d7dfca08SIgor Mitsyanko 
11487302dcd6SKevin O'Connor static void sdhci_initfn(SDHCIState *s)
1149d7dfca08SIgor Mitsyanko {
1150d7dfca08SIgor Mitsyanko     DriveInfo *di;
1151d7dfca08SIgor Mitsyanko 
1152af9e40aaSMarkus Armbruster     /* FIXME use a qdev drive property instead of drive_get_next() */
1153d7dfca08SIgor Mitsyanko     di = drive_get_next(IF_SD);
11544be74634SMarkus Armbruster     s->card = sd_init(di ? blk_by_legacy_dinfo(di) : NULL, false);
11554f8a066bSKevin Wolf     if (s->card == NULL) {
11564f8a066bSKevin Wolf         exit(1);
11574f8a066bSKevin Wolf     }
1158f3c7d038SAndreas Färber     s->eject_cb = qemu_allocate_irq(sdhci_insert_eject_cb, s, 0);
1159f3c7d038SAndreas Färber     s->ro_cb = qemu_allocate_irq(sdhci_card_readonly_cb, s, 0);
1160d7dfca08SIgor Mitsyanko     sd_set_cb(s->card, s->ro_cb, s->eject_cb);
1161d7dfca08SIgor Mitsyanko 
1162bc72ad67SAlex Bligh     s->insert_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, sdhci_raise_insertion_irq, s);
1163d368ba43SKevin O'Connor     s->transfer_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, sdhci_data_transfer, s);
1164d7dfca08SIgor Mitsyanko }
1165d7dfca08SIgor Mitsyanko 
11667302dcd6SKevin O'Connor static void sdhci_uninitfn(SDHCIState *s)
1167d7dfca08SIgor Mitsyanko {
1168bc72ad67SAlex Bligh     timer_del(s->insert_timer);
1169bc72ad67SAlex Bligh     timer_free(s->insert_timer);
1170bc72ad67SAlex Bligh     timer_del(s->transfer_timer);
1171bc72ad67SAlex Bligh     timer_free(s->transfer_timer);
1172127a4e1aSAndreas Färber     qemu_free_irq(s->eject_cb);
1173127a4e1aSAndreas Färber     qemu_free_irq(s->ro_cb);
1174d7dfca08SIgor Mitsyanko 
1175d7dfca08SIgor Mitsyanko     g_free(s->fifo_buffer);
1176d7dfca08SIgor Mitsyanko     s->fifo_buffer = NULL;
1177d7dfca08SIgor Mitsyanko }
1178d7dfca08SIgor Mitsyanko 
1179d7dfca08SIgor Mitsyanko const VMStateDescription sdhci_vmstate = {
1180d7dfca08SIgor Mitsyanko     .name = "sdhci",
1181d7dfca08SIgor Mitsyanko     .version_id = 1,
1182d7dfca08SIgor Mitsyanko     .minimum_version_id = 1,
1183d7dfca08SIgor Mitsyanko     .fields = (VMStateField[]) {
1184d7dfca08SIgor Mitsyanko         VMSTATE_UINT32(sdmasysad, SDHCIState),
1185d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(blksize, SDHCIState),
1186d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(blkcnt, SDHCIState),
1187d7dfca08SIgor Mitsyanko         VMSTATE_UINT32(argument, SDHCIState),
1188d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(trnmod, SDHCIState),
1189d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(cmdreg, SDHCIState),
1190d7dfca08SIgor Mitsyanko         VMSTATE_UINT32_ARRAY(rspreg, SDHCIState, 4),
1191d7dfca08SIgor Mitsyanko         VMSTATE_UINT32(prnsts, SDHCIState),
1192d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(hostctl, SDHCIState),
1193d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(pwrcon, SDHCIState),
1194d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(blkgap, SDHCIState),
1195d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(wakcon, SDHCIState),
1196d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(clkcon, SDHCIState),
1197d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(timeoutcon, SDHCIState),
1198d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(admaerr, SDHCIState),
1199d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(norintsts, SDHCIState),
1200d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(errintsts, SDHCIState),
1201d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(norintstsen, SDHCIState),
1202d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(errintstsen, SDHCIState),
1203d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(norintsigen, SDHCIState),
1204d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(errintsigen, SDHCIState),
1205d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(acmd12errsts, SDHCIState),
1206d7dfca08SIgor Mitsyanko         VMSTATE_UINT16(data_count, SDHCIState),
1207d7dfca08SIgor Mitsyanko         VMSTATE_UINT64(admasysaddr, SDHCIState),
1208d7dfca08SIgor Mitsyanko         VMSTATE_UINT8(stopped_state, SDHCIState),
1209d7dfca08SIgor Mitsyanko         VMSTATE_VBUFFER_UINT32(fifo_buffer, SDHCIState, 1, NULL, 0, buf_maxsz),
1210e720677eSPaolo Bonzini         VMSTATE_TIMER_PTR(insert_timer, SDHCIState),
1211e720677eSPaolo Bonzini         VMSTATE_TIMER_PTR(transfer_timer, SDHCIState),
1212d7dfca08SIgor Mitsyanko         VMSTATE_END_OF_LIST()
1213d7dfca08SIgor Mitsyanko     }
1214d7dfca08SIgor Mitsyanko };
1215d7dfca08SIgor Mitsyanko 
1216d7dfca08SIgor Mitsyanko /* Capabilities registers provide information on supported features of this
1217d7dfca08SIgor Mitsyanko  * specific host controller implementation */
1218d7dfca08SIgor Mitsyanko static Property sdhci_properties[] = {
1219c7bcc85dSPaolo Bonzini     DEFINE_PROP_UINT32("capareg", SDHCIState, capareg,
1220d7dfca08SIgor Mitsyanko             SDHC_CAPAB_REG_DEFAULT),
1221c7bcc85dSPaolo Bonzini     DEFINE_PROP_UINT32("maxcurr", SDHCIState, maxcurr, 0),
1222d7dfca08SIgor Mitsyanko     DEFINE_PROP_END_OF_LIST(),
1223d7dfca08SIgor Mitsyanko };
1224d7dfca08SIgor Mitsyanko 
12259af21dbeSMarkus Armbruster static void sdhci_pci_realize(PCIDevice *dev, Error **errp)
1226224d10ffSKevin O'Connor {
1227224d10ffSKevin O'Connor     SDHCIState *s = PCI_SDHCI(dev);
1228224d10ffSKevin O'Connor     dev->config[PCI_CLASS_PROG] = 0x01; /* Standard Host supported DMA */
1229224d10ffSKevin O'Connor     dev->config[PCI_INTERRUPT_PIN] = 0x01; /* interrupt pin A */
1230224d10ffSKevin O'Connor     sdhci_initfn(s);
1231224d10ffSKevin O'Connor     s->buf_maxsz = sdhci_get_fifolen(s);
1232224d10ffSKevin O'Connor     s->fifo_buffer = g_malloc0(s->buf_maxsz);
1233224d10ffSKevin O'Connor     s->irq = pci_allocate_irq(dev);
1234224d10ffSKevin O'Connor     memory_region_init_io(&s->iomem, OBJECT(s), &sdhci_mmio_ops, s, "sdhci",
1235224d10ffSKevin O'Connor             SDHC_REGISTERS_MAP_SIZE);
1236224d10ffSKevin O'Connor     pci_register_bar(dev, 0, 0, &s->iomem);
1237224d10ffSKevin O'Connor }
1238224d10ffSKevin O'Connor 
1239224d10ffSKevin O'Connor static void sdhci_pci_exit(PCIDevice *dev)
1240224d10ffSKevin O'Connor {
1241224d10ffSKevin O'Connor     SDHCIState *s = PCI_SDHCI(dev);
1242224d10ffSKevin O'Connor     sdhci_uninitfn(s);
1243224d10ffSKevin O'Connor }
1244224d10ffSKevin O'Connor 
1245224d10ffSKevin O'Connor static void sdhci_pci_class_init(ObjectClass *klass, void *data)
1246224d10ffSKevin O'Connor {
1247224d10ffSKevin O'Connor     DeviceClass *dc = DEVICE_CLASS(klass);
1248224d10ffSKevin O'Connor     PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
1249224d10ffSKevin O'Connor 
12509af21dbeSMarkus Armbruster     k->realize = sdhci_pci_realize;
1251224d10ffSKevin O'Connor     k->exit = sdhci_pci_exit;
1252224d10ffSKevin O'Connor     k->vendor_id = PCI_VENDOR_ID_REDHAT;
1253224d10ffSKevin O'Connor     k->device_id = PCI_DEVICE_ID_REDHAT_SDHCI;
1254224d10ffSKevin O'Connor     k->class_id = PCI_CLASS_SYSTEM_SDHCI;
1255224d10ffSKevin O'Connor     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
1256224d10ffSKevin O'Connor     dc->vmsd = &sdhci_vmstate;
1257224d10ffSKevin O'Connor     dc->props = sdhci_properties;
125819109131SMarkus Armbruster     /* Reason: realize() method uses drive_get_next() */
125919109131SMarkus Armbruster     dc->cannot_instantiate_with_device_add_yet = true;
1260224d10ffSKevin O'Connor }
1261224d10ffSKevin O'Connor 
1262224d10ffSKevin O'Connor static const TypeInfo sdhci_pci_info = {
1263224d10ffSKevin O'Connor     .name = TYPE_PCI_SDHCI,
1264224d10ffSKevin O'Connor     .parent = TYPE_PCI_DEVICE,
1265224d10ffSKevin O'Connor     .instance_size = sizeof(SDHCIState),
1266224d10ffSKevin O'Connor     .class_init = sdhci_pci_class_init,
1267224d10ffSKevin O'Connor };
1268224d10ffSKevin O'Connor 
12697302dcd6SKevin O'Connor static void sdhci_sysbus_init(Object *obj)
1270d7dfca08SIgor Mitsyanko {
12717302dcd6SKevin O'Connor     SDHCIState *s = SYSBUS_SDHCI(obj);
12727302dcd6SKevin O'Connor     sdhci_initfn(s);
12737302dcd6SKevin O'Connor }
12747302dcd6SKevin O'Connor 
12757302dcd6SKevin O'Connor static void sdhci_sysbus_finalize(Object *obj)
12767302dcd6SKevin O'Connor {
12777302dcd6SKevin O'Connor     SDHCIState *s = SYSBUS_SDHCI(obj);
12787302dcd6SKevin O'Connor     sdhci_uninitfn(s);
12797302dcd6SKevin O'Connor }
12807302dcd6SKevin O'Connor 
12817302dcd6SKevin O'Connor static void sdhci_sysbus_realize(DeviceState *dev, Error ** errp)
12827302dcd6SKevin O'Connor {
12837302dcd6SKevin O'Connor     SDHCIState *s = SYSBUS_SDHCI(dev);
1284d7dfca08SIgor Mitsyanko     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
1285d7dfca08SIgor Mitsyanko 
1286d7dfca08SIgor Mitsyanko     s->buf_maxsz = sdhci_get_fifolen(s);
1287d7dfca08SIgor Mitsyanko     s->fifo_buffer = g_malloc0(s->buf_maxsz);
1288d7dfca08SIgor Mitsyanko     sysbus_init_irq(sbd, &s->irq);
128929776739SPaolo Bonzini     memory_region_init_io(&s->iomem, OBJECT(s), &sdhci_mmio_ops, s, "sdhci",
1290d7dfca08SIgor Mitsyanko             SDHC_REGISTERS_MAP_SIZE);
1291d7dfca08SIgor Mitsyanko     sysbus_init_mmio(sbd, &s->iomem);
1292d7dfca08SIgor Mitsyanko }
1293d7dfca08SIgor Mitsyanko 
12947302dcd6SKevin O'Connor static void sdhci_sysbus_class_init(ObjectClass *klass, void *data)
1295d7dfca08SIgor Mitsyanko {
1296d7dfca08SIgor Mitsyanko     DeviceClass *dc = DEVICE_CLASS(klass);
1297d7dfca08SIgor Mitsyanko 
1298d7dfca08SIgor Mitsyanko     dc->vmsd = &sdhci_vmstate;
1299d7dfca08SIgor Mitsyanko     dc->props = sdhci_properties;
13007302dcd6SKevin O'Connor     dc->realize = sdhci_sysbus_realize;
13019f9bdf43SMarkus Armbruster     /* Reason: instance_init() method uses drive_get_next() */
13029f9bdf43SMarkus Armbruster     dc->cannot_instantiate_with_device_add_yet = true;
1303d7dfca08SIgor Mitsyanko }
1304d7dfca08SIgor Mitsyanko 
13057302dcd6SKevin O'Connor static const TypeInfo sdhci_sysbus_info = {
13067302dcd6SKevin O'Connor     .name = TYPE_SYSBUS_SDHCI,
1307d7dfca08SIgor Mitsyanko     .parent = TYPE_SYS_BUS_DEVICE,
1308d7dfca08SIgor Mitsyanko     .instance_size = sizeof(SDHCIState),
13097302dcd6SKevin O'Connor     .instance_init = sdhci_sysbus_init,
13107302dcd6SKevin O'Connor     .instance_finalize = sdhci_sysbus_finalize,
13117302dcd6SKevin O'Connor     .class_init = sdhci_sysbus_class_init,
1312d7dfca08SIgor Mitsyanko };
1313d7dfca08SIgor Mitsyanko 
1314d7dfca08SIgor Mitsyanko static void sdhci_register_types(void)
1315d7dfca08SIgor Mitsyanko {
1316224d10ffSKevin O'Connor     type_register_static(&sdhci_pci_info);
13177302dcd6SKevin O'Connor     type_register_static(&sdhci_sysbus_info);
1318d7dfca08SIgor Mitsyanko }
1319d7dfca08SIgor Mitsyanko 
1320d7dfca08SIgor Mitsyanko type_init(sdhci_register_types)
1321