1 /* 2 * SD Association Host Standard Specification v2.0 controller emulation 3 * 4 * Datasheet: PartA2_SD_Host_Controller_Simplified_Specification_Ver2.00.pdf 5 * 6 * Copyright (c) 2011 Samsung Electronics Co., Ltd. 7 * Mitsyanko Igor <i.mitsyanko@samsung.com> 8 * Peter A.G. Crosthwaite <peter.crosthwaite@petalogix.com> 9 * 10 * Based on MMC controller for Samsung S5PC1xx-based board emulation 11 * by Alexey Merkulov and Vladimir Monakhov. 12 * 13 * This program is free software; you can redistribute it and/or modify it 14 * under the terms of the GNU General Public License as published by the 15 * Free Software Foundation; either version 2 of the License, or (at your 16 * option) any later version. 17 * 18 * This program is distributed in the hope that it will be useful, 19 * but WITHOUT ANY WARRANTY; without even the implied warranty of 20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. 21 * See the GNU General Public License for more details. 22 * 23 * You should have received a copy of the GNU General Public License along 24 * with this program; if not, see <http://www.gnu.org/licenses/>. 25 */ 26 27 #include "qemu/osdep.h" 28 #include "qemu/units.h" 29 #include "qemu/error-report.h" 30 #include "qapi/error.h" 31 #include "hw/irq.h" 32 #include "hw/qdev-properties.h" 33 #include "sysemu/dma.h" 34 #include "qemu/timer.h" 35 #include "qemu/bitops.h" 36 #include "hw/sd/sdhci.h" 37 #include "migration/vmstate.h" 38 #include "sdhci-internal.h" 39 #include "qemu/log.h" 40 #include "qemu/module.h" 41 #include "trace.h" 42 #include "qom/object.h" 43 44 #define TYPE_SDHCI_BUS "sdhci-bus" 45 /* This is reusing the SDBus typedef from SD_BUS */ 46 DECLARE_INSTANCE_CHECKER(SDBus, SDHCI_BUS, 47 TYPE_SDHCI_BUS) 48 49 #define MASKED_WRITE(reg, mask, val) (reg = (reg & (mask)) | (val)) 50 51 static inline unsigned int sdhci_get_fifolen(SDHCIState *s) 52 { 53 return 1 << (9 + FIELD_EX32(s->capareg, SDHC_CAPAB, MAXBLOCKLENGTH)); 54 } 55 56 /* return true on error */ 57 static bool sdhci_check_capab_freq_range(SDHCIState *s, const char *desc, 58 uint8_t freq, Error **errp) 59 { 60 if (s->sd_spec_version >= 3) { 61 return false; 62 } 63 switch (freq) { 64 case 0: 65 case 10 ... 63: 66 break; 67 default: 68 error_setg(errp, "SD %s clock frequency can have value" 69 "in range 0-63 only", desc); 70 return true; 71 } 72 return false; 73 } 74 75 static void sdhci_check_capareg(SDHCIState *s, Error **errp) 76 { 77 uint64_t msk = s->capareg; 78 uint32_t val; 79 bool y; 80 81 switch (s->sd_spec_version) { 82 case 4: 83 val = FIELD_EX64(s->capareg, SDHC_CAPAB, BUS64BIT_V4); 84 trace_sdhci_capareg("64-bit system bus (v4)", val); 85 msk = FIELD_DP64(msk, SDHC_CAPAB, BUS64BIT_V4, 0); 86 87 val = FIELD_EX64(s->capareg, SDHC_CAPAB, UHS_II); 88 trace_sdhci_capareg("UHS-II", val); 89 msk = FIELD_DP64(msk, SDHC_CAPAB, UHS_II, 0); 90 91 val = FIELD_EX64(s->capareg, SDHC_CAPAB, ADMA3); 92 trace_sdhci_capareg("ADMA3", val); 93 msk = FIELD_DP64(msk, SDHC_CAPAB, ADMA3, 0); 94 95 /* fallthrough */ 96 case 3: 97 val = FIELD_EX64(s->capareg, SDHC_CAPAB, ASYNC_INT); 98 trace_sdhci_capareg("async interrupt", val); 99 msk = FIELD_DP64(msk, SDHC_CAPAB, ASYNC_INT, 0); 100 101 val = FIELD_EX64(s->capareg, SDHC_CAPAB, SLOT_TYPE); 102 if (val) { 103 error_setg(errp, "slot-type not supported"); 104 return; 105 } 106 trace_sdhci_capareg("slot type", val); 107 msk = FIELD_DP64(msk, SDHC_CAPAB, SLOT_TYPE, 0); 108 109 if (val != 2) { 110 val = FIELD_EX64(s->capareg, SDHC_CAPAB, EMBEDDED_8BIT); 111 trace_sdhci_capareg("8-bit bus", val); 112 } 113 msk = FIELD_DP64(msk, SDHC_CAPAB, EMBEDDED_8BIT, 0); 114 115 val = FIELD_EX64(s->capareg, SDHC_CAPAB, BUS_SPEED); 116 trace_sdhci_capareg("bus speed mask", val); 117 msk = FIELD_DP64(msk, SDHC_CAPAB, BUS_SPEED, 0); 118 119 val = FIELD_EX64(s->capareg, SDHC_CAPAB, DRIVER_STRENGTH); 120 trace_sdhci_capareg("driver strength mask", val); 121 msk = FIELD_DP64(msk, SDHC_CAPAB, DRIVER_STRENGTH, 0); 122 123 val = FIELD_EX64(s->capareg, SDHC_CAPAB, TIMER_RETUNING); 124 trace_sdhci_capareg("timer re-tuning", val); 125 msk = FIELD_DP64(msk, SDHC_CAPAB, TIMER_RETUNING, 0); 126 127 val = FIELD_EX64(s->capareg, SDHC_CAPAB, SDR50_TUNING); 128 trace_sdhci_capareg("use SDR50 tuning", val); 129 msk = FIELD_DP64(msk, SDHC_CAPAB, SDR50_TUNING, 0); 130 131 val = FIELD_EX64(s->capareg, SDHC_CAPAB, RETUNING_MODE); 132 trace_sdhci_capareg("re-tuning mode", val); 133 msk = FIELD_DP64(msk, SDHC_CAPAB, RETUNING_MODE, 0); 134 135 val = FIELD_EX64(s->capareg, SDHC_CAPAB, CLOCK_MULT); 136 trace_sdhci_capareg("clock multiplier", val); 137 msk = FIELD_DP64(msk, SDHC_CAPAB, CLOCK_MULT, 0); 138 139 /* fallthrough */ 140 case 2: /* default version */ 141 val = FIELD_EX64(s->capareg, SDHC_CAPAB, ADMA2); 142 trace_sdhci_capareg("ADMA2", val); 143 msk = FIELD_DP64(msk, SDHC_CAPAB, ADMA2, 0); 144 145 val = FIELD_EX64(s->capareg, SDHC_CAPAB, ADMA1); 146 trace_sdhci_capareg("ADMA1", val); 147 msk = FIELD_DP64(msk, SDHC_CAPAB, ADMA1, 0); 148 149 val = FIELD_EX64(s->capareg, SDHC_CAPAB, BUS64BIT); 150 trace_sdhci_capareg("64-bit system bus (v3)", val); 151 msk = FIELD_DP64(msk, SDHC_CAPAB, BUS64BIT, 0); 152 153 /* fallthrough */ 154 case 1: 155 y = FIELD_EX64(s->capareg, SDHC_CAPAB, TOUNIT); 156 msk = FIELD_DP64(msk, SDHC_CAPAB, TOUNIT, 0); 157 158 val = FIELD_EX64(s->capareg, SDHC_CAPAB, TOCLKFREQ); 159 trace_sdhci_capareg(y ? "timeout (MHz)" : "Timeout (KHz)", val); 160 if (sdhci_check_capab_freq_range(s, "timeout", val, errp)) { 161 return; 162 } 163 msk = FIELD_DP64(msk, SDHC_CAPAB, TOCLKFREQ, 0); 164 165 val = FIELD_EX64(s->capareg, SDHC_CAPAB, BASECLKFREQ); 166 trace_sdhci_capareg(y ? "base (MHz)" : "Base (KHz)", val); 167 if (sdhci_check_capab_freq_range(s, "base", val, errp)) { 168 return; 169 } 170 msk = FIELD_DP64(msk, SDHC_CAPAB, BASECLKFREQ, 0); 171 172 val = FIELD_EX64(s->capareg, SDHC_CAPAB, MAXBLOCKLENGTH); 173 if (val >= 3) { 174 error_setg(errp, "block size can be 512, 1024 or 2048 only"); 175 return; 176 } 177 trace_sdhci_capareg("max block length", sdhci_get_fifolen(s)); 178 msk = FIELD_DP64(msk, SDHC_CAPAB, MAXBLOCKLENGTH, 0); 179 180 val = FIELD_EX64(s->capareg, SDHC_CAPAB, HIGHSPEED); 181 trace_sdhci_capareg("high speed", val); 182 msk = FIELD_DP64(msk, SDHC_CAPAB, HIGHSPEED, 0); 183 184 val = FIELD_EX64(s->capareg, SDHC_CAPAB, SDMA); 185 trace_sdhci_capareg("SDMA", val); 186 msk = FIELD_DP64(msk, SDHC_CAPAB, SDMA, 0); 187 188 val = FIELD_EX64(s->capareg, SDHC_CAPAB, SUSPRESUME); 189 trace_sdhci_capareg("suspend/resume", val); 190 msk = FIELD_DP64(msk, SDHC_CAPAB, SUSPRESUME, 0); 191 192 val = FIELD_EX64(s->capareg, SDHC_CAPAB, V33); 193 trace_sdhci_capareg("3.3v", val); 194 msk = FIELD_DP64(msk, SDHC_CAPAB, V33, 0); 195 196 val = FIELD_EX64(s->capareg, SDHC_CAPAB, V30); 197 trace_sdhci_capareg("3.0v", val); 198 msk = FIELD_DP64(msk, SDHC_CAPAB, V30, 0); 199 200 val = FIELD_EX64(s->capareg, SDHC_CAPAB, V18); 201 trace_sdhci_capareg("1.8v", val); 202 msk = FIELD_DP64(msk, SDHC_CAPAB, V18, 0); 203 break; 204 205 default: 206 error_setg(errp, "Unsupported spec version: %u", s->sd_spec_version); 207 } 208 if (msk) { 209 qemu_log_mask(LOG_UNIMP, 210 "SDHCI: unknown CAPAB mask: 0x%016" PRIx64 "\n", msk); 211 } 212 } 213 214 static uint8_t sdhci_slotint(SDHCIState *s) 215 { 216 return (s->norintsts & s->norintsigen) || (s->errintsts & s->errintsigen) || 217 ((s->norintsts & SDHC_NIS_INSERT) && (s->wakcon & SDHC_WKUP_ON_INS)) || 218 ((s->norintsts & SDHC_NIS_REMOVE) && (s->wakcon & SDHC_WKUP_ON_RMV)); 219 } 220 221 static inline void sdhci_update_irq(SDHCIState *s) 222 { 223 qemu_set_irq(s->irq, sdhci_slotint(s)); 224 } 225 226 static void sdhci_raise_insertion_irq(void *opaque) 227 { 228 SDHCIState *s = (SDHCIState *)opaque; 229 230 if (s->norintsts & SDHC_NIS_REMOVE) { 231 timer_mod(s->insert_timer, 232 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + SDHC_INSERTION_DELAY); 233 } else { 234 s->prnsts = 0x1ff0000; 235 if (s->norintstsen & SDHC_NISEN_INSERT) { 236 s->norintsts |= SDHC_NIS_INSERT; 237 } 238 sdhci_update_irq(s); 239 } 240 } 241 242 static void sdhci_set_inserted(DeviceState *dev, bool level) 243 { 244 SDHCIState *s = (SDHCIState *)dev; 245 246 trace_sdhci_set_inserted(level ? "insert" : "eject"); 247 if ((s->norintsts & SDHC_NIS_REMOVE) && level) { 248 /* Give target some time to notice card ejection */ 249 timer_mod(s->insert_timer, 250 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + SDHC_INSERTION_DELAY); 251 } else { 252 if (level) { 253 s->prnsts = 0x1ff0000; 254 if (s->norintstsen & SDHC_NISEN_INSERT) { 255 s->norintsts |= SDHC_NIS_INSERT; 256 } 257 } else { 258 s->prnsts = 0x1fa0000; 259 s->pwrcon &= ~SDHC_POWER_ON; 260 s->clkcon &= ~SDHC_CLOCK_SDCLK_EN; 261 if (s->norintstsen & SDHC_NISEN_REMOVE) { 262 s->norintsts |= SDHC_NIS_REMOVE; 263 } 264 } 265 sdhci_update_irq(s); 266 } 267 } 268 269 static void sdhci_set_readonly(DeviceState *dev, bool level) 270 { 271 SDHCIState *s = (SDHCIState *)dev; 272 273 if (level) { 274 s->prnsts &= ~SDHC_WRITE_PROTECT; 275 } else { 276 /* Write enabled */ 277 s->prnsts |= SDHC_WRITE_PROTECT; 278 } 279 } 280 281 static void sdhci_reset(SDHCIState *s) 282 { 283 DeviceState *dev = DEVICE(s); 284 285 timer_del(s->insert_timer); 286 timer_del(s->transfer_timer); 287 288 /* Set all registers to 0. Capabilities/Version registers are not cleared 289 * and assumed to always preserve their value, given to them during 290 * initialization */ 291 memset(&s->sdmasysad, 0, (uintptr_t)&s->capareg - (uintptr_t)&s->sdmasysad); 292 293 /* Reset other state based on current card insertion/readonly status */ 294 sdhci_set_inserted(dev, sdbus_get_inserted(&s->sdbus)); 295 sdhci_set_readonly(dev, sdbus_get_readonly(&s->sdbus)); 296 297 s->data_count = 0; 298 s->stopped_state = sdhc_not_stopped; 299 s->pending_insert_state = false; 300 } 301 302 static void sdhci_poweron_reset(DeviceState *dev) 303 { 304 /* QOM (ie power-on) reset. This is identical to reset 305 * commanded via device register apart from handling of the 306 * 'pending insert on powerup' quirk. 307 */ 308 SDHCIState *s = (SDHCIState *)dev; 309 310 sdhci_reset(s); 311 312 if (s->pending_insert_quirk) { 313 s->pending_insert_state = true; 314 } 315 } 316 317 static void sdhci_data_transfer(void *opaque); 318 319 static void sdhci_send_command(SDHCIState *s) 320 { 321 SDRequest request; 322 uint8_t response[16]; 323 int rlen; 324 325 s->errintsts = 0; 326 s->acmd12errsts = 0; 327 request.cmd = s->cmdreg >> 8; 328 request.arg = s->argument; 329 330 trace_sdhci_send_command(request.cmd, request.arg); 331 rlen = sdbus_do_command(&s->sdbus, &request, response); 332 333 if (s->cmdreg & SDHC_CMD_RESPONSE) { 334 if (rlen == 4) { 335 s->rspreg[0] = ldl_be_p(response); 336 s->rspreg[1] = s->rspreg[2] = s->rspreg[3] = 0; 337 trace_sdhci_response4(s->rspreg[0]); 338 } else if (rlen == 16) { 339 s->rspreg[0] = ldl_be_p(&response[11]); 340 s->rspreg[1] = ldl_be_p(&response[7]); 341 s->rspreg[2] = ldl_be_p(&response[3]); 342 s->rspreg[3] = (response[0] << 16) | (response[1] << 8) | 343 response[2]; 344 trace_sdhci_response16(s->rspreg[3], s->rspreg[2], 345 s->rspreg[1], s->rspreg[0]); 346 } else { 347 trace_sdhci_error("timeout waiting for command response"); 348 if (s->errintstsen & SDHC_EISEN_CMDTIMEOUT) { 349 s->errintsts |= SDHC_EIS_CMDTIMEOUT; 350 s->norintsts |= SDHC_NIS_ERR; 351 } 352 } 353 354 if (!(s->quirks & SDHCI_QUIRK_NO_BUSY_IRQ) && 355 (s->norintstsen & SDHC_NISEN_TRSCMP) && 356 (s->cmdreg & SDHC_CMD_RESPONSE) == SDHC_CMD_RSP_WITH_BUSY) { 357 s->norintsts |= SDHC_NIS_TRSCMP; 358 } 359 } 360 361 if (s->norintstsen & SDHC_NISEN_CMDCMP) { 362 s->norintsts |= SDHC_NIS_CMDCMP; 363 } 364 365 sdhci_update_irq(s); 366 367 if (s->blksize && (s->cmdreg & SDHC_CMD_DATA_PRESENT)) { 368 s->data_count = 0; 369 sdhci_data_transfer(s); 370 } 371 } 372 373 static void sdhci_end_transfer(SDHCIState *s) 374 { 375 /* Automatically send CMD12 to stop transfer if AutoCMD12 enabled */ 376 if ((s->trnmod & SDHC_TRNS_ACMD12) != 0) { 377 SDRequest request; 378 uint8_t response[16]; 379 380 request.cmd = 0x0C; 381 request.arg = 0; 382 trace_sdhci_end_transfer(request.cmd, request.arg); 383 sdbus_do_command(&s->sdbus, &request, response); 384 /* Auto CMD12 response goes to the upper Response register */ 385 s->rspreg[3] = ldl_be_p(response); 386 } 387 388 s->prnsts &= ~(SDHC_DOING_READ | SDHC_DOING_WRITE | 389 SDHC_DAT_LINE_ACTIVE | SDHC_DATA_INHIBIT | 390 SDHC_SPACE_AVAILABLE | SDHC_DATA_AVAILABLE); 391 392 if (s->norintstsen & SDHC_NISEN_TRSCMP) { 393 s->norintsts |= SDHC_NIS_TRSCMP; 394 } 395 396 sdhci_update_irq(s); 397 } 398 399 /* 400 * Programmed i/o data transfer 401 */ 402 #define BLOCK_SIZE_MASK (4 * KiB - 1) 403 404 /* Fill host controller's read buffer with BLKSIZE bytes of data from card */ 405 static void sdhci_read_block_from_card(SDHCIState *s) 406 { 407 const uint16_t blk_size = s->blksize & BLOCK_SIZE_MASK; 408 409 if ((s->trnmod & SDHC_TRNS_MULTI) && 410 (s->trnmod & SDHC_TRNS_BLK_CNT_EN) && (s->blkcnt == 0)) { 411 return; 412 } 413 414 if (!FIELD_EX32(s->hostctl2, SDHC_HOSTCTL2, EXECUTE_TUNING)) { 415 /* Device is not in tuning */ 416 sdbus_read_data(&s->sdbus, s->fifo_buffer, blk_size); 417 } 418 419 if (FIELD_EX32(s->hostctl2, SDHC_HOSTCTL2, EXECUTE_TUNING)) { 420 /* Device is in tuning */ 421 s->hostctl2 &= ~R_SDHC_HOSTCTL2_EXECUTE_TUNING_MASK; 422 s->hostctl2 |= R_SDHC_HOSTCTL2_SAMPLING_CLKSEL_MASK; 423 s->prnsts &= ~(SDHC_DAT_LINE_ACTIVE | SDHC_DOING_READ | 424 SDHC_DATA_INHIBIT); 425 goto read_done; 426 } 427 428 /* New data now available for READ through Buffer Port Register */ 429 s->prnsts |= SDHC_DATA_AVAILABLE; 430 if (s->norintstsen & SDHC_NISEN_RBUFRDY) { 431 s->norintsts |= SDHC_NIS_RBUFRDY; 432 } 433 434 /* Clear DAT line active status if that was the last block */ 435 if ((s->trnmod & SDHC_TRNS_MULTI) == 0 || 436 ((s->trnmod & SDHC_TRNS_MULTI) && s->blkcnt == 1)) { 437 s->prnsts &= ~SDHC_DAT_LINE_ACTIVE; 438 } 439 440 /* If stop at block gap request was set and it's not the last block of 441 * data - generate Block Event interrupt */ 442 if (s->stopped_state == sdhc_gap_read && (s->trnmod & SDHC_TRNS_MULTI) && 443 s->blkcnt != 1) { 444 s->prnsts &= ~SDHC_DAT_LINE_ACTIVE; 445 if (s->norintstsen & SDHC_EISEN_BLKGAP) { 446 s->norintsts |= SDHC_EIS_BLKGAP; 447 } 448 } 449 450 read_done: 451 sdhci_update_irq(s); 452 } 453 454 /* Read @size byte of data from host controller @s BUFFER DATA PORT register */ 455 static uint32_t sdhci_read_dataport(SDHCIState *s, unsigned size) 456 { 457 uint32_t value = 0; 458 int i; 459 460 /* first check that a valid data exists in host controller input buffer */ 461 if ((s->prnsts & SDHC_DATA_AVAILABLE) == 0) { 462 trace_sdhci_error("read from empty buffer"); 463 return 0; 464 } 465 466 for (i = 0; i < size; i++) { 467 value |= s->fifo_buffer[s->data_count] << i * 8; 468 s->data_count++; 469 /* check if we've read all valid data (blksize bytes) from buffer */ 470 if ((s->data_count) >= (s->blksize & BLOCK_SIZE_MASK)) { 471 trace_sdhci_read_dataport(s->data_count); 472 s->prnsts &= ~SDHC_DATA_AVAILABLE; /* no more data in a buffer */ 473 s->data_count = 0; /* next buff read must start at position [0] */ 474 475 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) { 476 s->blkcnt--; 477 } 478 479 /* if that was the last block of data */ 480 if ((s->trnmod & SDHC_TRNS_MULTI) == 0 || 481 ((s->trnmod & SDHC_TRNS_BLK_CNT_EN) && (s->blkcnt == 0)) || 482 /* stop at gap request */ 483 (s->stopped_state == sdhc_gap_read && 484 !(s->prnsts & SDHC_DAT_LINE_ACTIVE))) { 485 sdhci_end_transfer(s); 486 } else { /* if there are more data, read next block from card */ 487 sdhci_read_block_from_card(s); 488 } 489 break; 490 } 491 } 492 493 return value; 494 } 495 496 /* Write data from host controller FIFO to card */ 497 static void sdhci_write_block_to_card(SDHCIState *s) 498 { 499 if (s->prnsts & SDHC_SPACE_AVAILABLE) { 500 if (s->norintstsen & SDHC_NISEN_WBUFRDY) { 501 s->norintsts |= SDHC_NIS_WBUFRDY; 502 } 503 sdhci_update_irq(s); 504 return; 505 } 506 507 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) { 508 if (s->blkcnt == 0) { 509 return; 510 } else { 511 s->blkcnt--; 512 } 513 } 514 515 sdbus_write_data(&s->sdbus, s->fifo_buffer, s->blksize & BLOCK_SIZE_MASK); 516 517 /* Next data can be written through BUFFER DATORT register */ 518 s->prnsts |= SDHC_SPACE_AVAILABLE; 519 520 /* Finish transfer if that was the last block of data */ 521 if ((s->trnmod & SDHC_TRNS_MULTI) == 0 || 522 ((s->trnmod & SDHC_TRNS_MULTI) && 523 (s->trnmod & SDHC_TRNS_BLK_CNT_EN) && (s->blkcnt == 0))) { 524 sdhci_end_transfer(s); 525 } else if (s->norintstsen & SDHC_NISEN_WBUFRDY) { 526 s->norintsts |= SDHC_NIS_WBUFRDY; 527 } 528 529 /* Generate Block Gap Event if requested and if not the last block */ 530 if (s->stopped_state == sdhc_gap_write && (s->trnmod & SDHC_TRNS_MULTI) && 531 s->blkcnt > 0) { 532 s->prnsts &= ~SDHC_DOING_WRITE; 533 if (s->norintstsen & SDHC_EISEN_BLKGAP) { 534 s->norintsts |= SDHC_EIS_BLKGAP; 535 } 536 sdhci_end_transfer(s); 537 } 538 539 sdhci_update_irq(s); 540 } 541 542 /* Write @size bytes of @value data to host controller @s Buffer Data Port 543 * register */ 544 static void sdhci_write_dataport(SDHCIState *s, uint32_t value, unsigned size) 545 { 546 unsigned i; 547 548 /* Check that there is free space left in a buffer */ 549 if (!(s->prnsts & SDHC_SPACE_AVAILABLE)) { 550 trace_sdhci_error("Can't write to data buffer: buffer full"); 551 return; 552 } 553 554 for (i = 0; i < size; i++) { 555 s->fifo_buffer[s->data_count] = value & 0xFF; 556 s->data_count++; 557 value >>= 8; 558 if (s->data_count >= (s->blksize & BLOCK_SIZE_MASK)) { 559 trace_sdhci_write_dataport(s->data_count); 560 s->data_count = 0; 561 s->prnsts &= ~SDHC_SPACE_AVAILABLE; 562 if (s->prnsts & SDHC_DOING_WRITE) { 563 sdhci_write_block_to_card(s); 564 } 565 } 566 } 567 } 568 569 /* 570 * Single DMA data transfer 571 */ 572 573 /* Multi block SDMA transfer */ 574 static void sdhci_sdma_transfer_multi_blocks(SDHCIState *s) 575 { 576 bool page_aligned = false; 577 unsigned int begin; 578 const uint16_t block_size = s->blksize & BLOCK_SIZE_MASK; 579 uint32_t boundary_chk = 1 << (((s->blksize & ~BLOCK_SIZE_MASK) >> 12) + 12); 580 uint32_t boundary_count = boundary_chk - (s->sdmasysad % boundary_chk); 581 582 if (!(s->trnmod & SDHC_TRNS_BLK_CNT_EN) || !s->blkcnt) { 583 qemu_log_mask(LOG_UNIMP, "infinite transfer is not supported\n"); 584 return; 585 } 586 587 /* XXX: Some sd/mmc drivers (for example, u-boot-slp) do not account for 588 * possible stop at page boundary if initial address is not page aligned, 589 * allow them to work properly */ 590 if ((s->sdmasysad % boundary_chk) == 0) { 591 page_aligned = true; 592 } 593 594 if (s->trnmod & SDHC_TRNS_READ) { 595 s->prnsts |= SDHC_DOING_READ | SDHC_DATA_INHIBIT | 596 SDHC_DAT_LINE_ACTIVE; 597 while (s->blkcnt) { 598 if (s->data_count == 0) { 599 sdbus_read_data(&s->sdbus, s->fifo_buffer, block_size); 600 } 601 begin = s->data_count; 602 if (((boundary_count + begin) < block_size) && page_aligned) { 603 s->data_count = boundary_count + begin; 604 boundary_count = 0; 605 } else { 606 s->data_count = block_size; 607 boundary_count -= block_size - begin; 608 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) { 609 s->blkcnt--; 610 } 611 } 612 dma_memory_write(s->dma_as, s->sdmasysad, 613 &s->fifo_buffer[begin], s->data_count - begin); 614 s->sdmasysad += s->data_count - begin; 615 if (s->data_count == block_size) { 616 s->data_count = 0; 617 } 618 if (page_aligned && boundary_count == 0) { 619 break; 620 } 621 } 622 } else { 623 s->prnsts |= SDHC_DOING_WRITE | SDHC_DATA_INHIBIT | 624 SDHC_DAT_LINE_ACTIVE; 625 while (s->blkcnt) { 626 begin = s->data_count; 627 if (((boundary_count + begin) < block_size) && page_aligned) { 628 s->data_count = boundary_count + begin; 629 boundary_count = 0; 630 } else { 631 s->data_count = block_size; 632 boundary_count -= block_size - begin; 633 } 634 dma_memory_read(s->dma_as, s->sdmasysad, 635 &s->fifo_buffer[begin], s->data_count - begin); 636 s->sdmasysad += s->data_count - begin; 637 if (s->data_count == block_size) { 638 sdbus_write_data(&s->sdbus, s->fifo_buffer, block_size); 639 s->data_count = 0; 640 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) { 641 s->blkcnt--; 642 } 643 } 644 if (page_aligned && boundary_count == 0) { 645 break; 646 } 647 } 648 } 649 650 if (s->blkcnt == 0) { 651 sdhci_end_transfer(s); 652 } else { 653 if (s->norintstsen & SDHC_NISEN_DMA) { 654 s->norintsts |= SDHC_NIS_DMA; 655 } 656 sdhci_update_irq(s); 657 } 658 } 659 660 /* single block SDMA transfer */ 661 static void sdhci_sdma_transfer_single_block(SDHCIState *s) 662 { 663 uint32_t datacnt = s->blksize & BLOCK_SIZE_MASK; 664 665 if (s->trnmod & SDHC_TRNS_READ) { 666 sdbus_read_data(&s->sdbus, s->fifo_buffer, datacnt); 667 dma_memory_write(s->dma_as, s->sdmasysad, s->fifo_buffer, datacnt); 668 } else { 669 dma_memory_read(s->dma_as, s->sdmasysad, s->fifo_buffer, datacnt); 670 sdbus_write_data(&s->sdbus, s->fifo_buffer, datacnt); 671 } 672 s->blkcnt--; 673 674 sdhci_end_transfer(s); 675 } 676 677 typedef struct ADMADescr { 678 hwaddr addr; 679 uint16_t length; 680 uint8_t attr; 681 uint8_t incr; 682 } ADMADescr; 683 684 static void get_adma_description(SDHCIState *s, ADMADescr *dscr) 685 { 686 uint32_t adma1 = 0; 687 uint64_t adma2 = 0; 688 hwaddr entry_addr = (hwaddr)s->admasysaddr; 689 switch (SDHC_DMA_TYPE(s->hostctl1)) { 690 case SDHC_CTRL_ADMA2_32: 691 dma_memory_read(s->dma_as, entry_addr, &adma2, sizeof(adma2)); 692 adma2 = le64_to_cpu(adma2); 693 /* The spec does not specify endianness of descriptor table. 694 * We currently assume that it is LE. 695 */ 696 dscr->addr = (hwaddr)extract64(adma2, 32, 32) & ~0x3ull; 697 dscr->length = (uint16_t)extract64(adma2, 16, 16); 698 dscr->attr = (uint8_t)extract64(adma2, 0, 7); 699 dscr->incr = 8; 700 break; 701 case SDHC_CTRL_ADMA1_32: 702 dma_memory_read(s->dma_as, entry_addr, &adma1, sizeof(adma1)); 703 adma1 = le32_to_cpu(adma1); 704 dscr->addr = (hwaddr)(adma1 & 0xFFFFF000); 705 dscr->attr = (uint8_t)extract32(adma1, 0, 7); 706 dscr->incr = 4; 707 if ((dscr->attr & SDHC_ADMA_ATTR_ACT_MASK) == SDHC_ADMA_ATTR_SET_LEN) { 708 dscr->length = (uint16_t)extract32(adma1, 12, 16); 709 } else { 710 dscr->length = 4 * KiB; 711 } 712 break; 713 case SDHC_CTRL_ADMA2_64: 714 dma_memory_read(s->dma_as, entry_addr, &dscr->attr, 1); 715 dma_memory_read(s->dma_as, entry_addr + 2, &dscr->length, 2); 716 dscr->length = le16_to_cpu(dscr->length); 717 dma_memory_read(s->dma_as, entry_addr + 4, &dscr->addr, 8); 718 dscr->addr = le64_to_cpu(dscr->addr); 719 dscr->attr &= (uint8_t) ~0xC0; 720 dscr->incr = 12; 721 break; 722 } 723 } 724 725 /* Advanced DMA data transfer */ 726 727 static void sdhci_do_adma(SDHCIState *s) 728 { 729 unsigned int begin, length; 730 const uint16_t block_size = s->blksize & BLOCK_SIZE_MASK; 731 ADMADescr dscr = {}; 732 int i; 733 734 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN && !s->blkcnt) { 735 /* Stop Multiple Transfer */ 736 sdhci_end_transfer(s); 737 return; 738 } 739 740 for (i = 0; i < SDHC_ADMA_DESCS_PER_DELAY; ++i) { 741 s->admaerr &= ~SDHC_ADMAERR_LENGTH_MISMATCH; 742 743 get_adma_description(s, &dscr); 744 trace_sdhci_adma_loop(dscr.addr, dscr.length, dscr.attr); 745 746 if ((dscr.attr & SDHC_ADMA_ATTR_VALID) == 0) { 747 /* Indicate that error occurred in ST_FDS state */ 748 s->admaerr &= ~SDHC_ADMAERR_STATE_MASK; 749 s->admaerr |= SDHC_ADMAERR_STATE_ST_FDS; 750 751 /* Generate ADMA error interrupt */ 752 if (s->errintstsen & SDHC_EISEN_ADMAERR) { 753 s->errintsts |= SDHC_EIS_ADMAERR; 754 s->norintsts |= SDHC_NIS_ERR; 755 } 756 757 sdhci_update_irq(s); 758 return; 759 } 760 761 length = dscr.length ? dscr.length : 64 * KiB; 762 763 switch (dscr.attr & SDHC_ADMA_ATTR_ACT_MASK) { 764 case SDHC_ADMA_ATTR_ACT_TRAN: /* data transfer */ 765 if (s->trnmod & SDHC_TRNS_READ) { 766 while (length) { 767 if (s->data_count == 0) { 768 sdbus_read_data(&s->sdbus, s->fifo_buffer, block_size); 769 } 770 begin = s->data_count; 771 if ((length + begin) < block_size) { 772 s->data_count = length + begin; 773 length = 0; 774 } else { 775 s->data_count = block_size; 776 length -= block_size - begin; 777 } 778 dma_memory_write(s->dma_as, dscr.addr, 779 &s->fifo_buffer[begin], 780 s->data_count - begin); 781 dscr.addr += s->data_count - begin; 782 if (s->data_count == block_size) { 783 s->data_count = 0; 784 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) { 785 s->blkcnt--; 786 if (s->blkcnt == 0) { 787 break; 788 } 789 } 790 } 791 } 792 } else { 793 while (length) { 794 begin = s->data_count; 795 if ((length + begin) < block_size) { 796 s->data_count = length + begin; 797 length = 0; 798 } else { 799 s->data_count = block_size; 800 length -= block_size - begin; 801 } 802 dma_memory_read(s->dma_as, dscr.addr, 803 &s->fifo_buffer[begin], 804 s->data_count - begin); 805 dscr.addr += s->data_count - begin; 806 if (s->data_count == block_size) { 807 sdbus_write_data(&s->sdbus, s->fifo_buffer, block_size); 808 s->data_count = 0; 809 if (s->trnmod & SDHC_TRNS_BLK_CNT_EN) { 810 s->blkcnt--; 811 if (s->blkcnt == 0) { 812 break; 813 } 814 } 815 } 816 } 817 } 818 s->admasysaddr += dscr.incr; 819 break; 820 case SDHC_ADMA_ATTR_ACT_LINK: /* link to next descriptor table */ 821 s->admasysaddr = dscr.addr; 822 trace_sdhci_adma("link", s->admasysaddr); 823 break; 824 default: 825 s->admasysaddr += dscr.incr; 826 break; 827 } 828 829 if (dscr.attr & SDHC_ADMA_ATTR_INT) { 830 trace_sdhci_adma("interrupt", s->admasysaddr); 831 if (s->norintstsen & SDHC_NISEN_DMA) { 832 s->norintsts |= SDHC_NIS_DMA; 833 } 834 835 sdhci_update_irq(s); 836 } 837 838 /* ADMA transfer terminates if blkcnt == 0 or by END attribute */ 839 if (((s->trnmod & SDHC_TRNS_BLK_CNT_EN) && 840 (s->blkcnt == 0)) || (dscr.attr & SDHC_ADMA_ATTR_END)) { 841 trace_sdhci_adma_transfer_completed(); 842 if (length || ((dscr.attr & SDHC_ADMA_ATTR_END) && 843 (s->trnmod & SDHC_TRNS_BLK_CNT_EN) && 844 s->blkcnt != 0)) { 845 trace_sdhci_error("SD/MMC host ADMA length mismatch"); 846 s->admaerr |= SDHC_ADMAERR_LENGTH_MISMATCH | 847 SDHC_ADMAERR_STATE_ST_TFR; 848 if (s->errintstsen & SDHC_EISEN_ADMAERR) { 849 trace_sdhci_error("Set ADMA error flag"); 850 s->errintsts |= SDHC_EIS_ADMAERR; 851 s->norintsts |= SDHC_NIS_ERR; 852 } 853 854 sdhci_update_irq(s); 855 } 856 sdhci_end_transfer(s); 857 return; 858 } 859 860 } 861 862 /* we have unfinished business - reschedule to continue ADMA */ 863 timer_mod(s->transfer_timer, 864 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + SDHC_TRANSFER_DELAY); 865 } 866 867 /* Perform data transfer according to controller configuration */ 868 869 static void sdhci_data_transfer(void *opaque) 870 { 871 SDHCIState *s = (SDHCIState *)opaque; 872 873 if (s->trnmod & SDHC_TRNS_DMA) { 874 switch (SDHC_DMA_TYPE(s->hostctl1)) { 875 case SDHC_CTRL_SDMA: 876 if ((s->blkcnt == 1) || !(s->trnmod & SDHC_TRNS_MULTI)) { 877 sdhci_sdma_transfer_single_block(s); 878 } else { 879 sdhci_sdma_transfer_multi_blocks(s); 880 } 881 882 break; 883 case SDHC_CTRL_ADMA1_32: 884 if (!(s->capareg & R_SDHC_CAPAB_ADMA1_MASK)) { 885 trace_sdhci_error("ADMA1 not supported"); 886 break; 887 } 888 889 sdhci_do_adma(s); 890 break; 891 case SDHC_CTRL_ADMA2_32: 892 if (!(s->capareg & R_SDHC_CAPAB_ADMA2_MASK)) { 893 trace_sdhci_error("ADMA2 not supported"); 894 break; 895 } 896 897 sdhci_do_adma(s); 898 break; 899 case SDHC_CTRL_ADMA2_64: 900 if (!(s->capareg & R_SDHC_CAPAB_ADMA2_MASK) || 901 !(s->capareg & R_SDHC_CAPAB_BUS64BIT_MASK)) { 902 trace_sdhci_error("64 bit ADMA not supported"); 903 break; 904 } 905 906 sdhci_do_adma(s); 907 break; 908 default: 909 trace_sdhci_error("Unsupported DMA type"); 910 break; 911 } 912 } else { 913 if ((s->trnmod & SDHC_TRNS_READ) && sdbus_data_ready(&s->sdbus)) { 914 s->prnsts |= SDHC_DOING_READ | SDHC_DATA_INHIBIT | 915 SDHC_DAT_LINE_ACTIVE; 916 sdhci_read_block_from_card(s); 917 } else { 918 s->prnsts |= SDHC_DOING_WRITE | SDHC_DAT_LINE_ACTIVE | 919 SDHC_SPACE_AVAILABLE | SDHC_DATA_INHIBIT; 920 sdhci_write_block_to_card(s); 921 } 922 } 923 } 924 925 static bool sdhci_can_issue_command(SDHCIState *s) 926 { 927 if (!SDHC_CLOCK_IS_ON(s->clkcon) || 928 (((s->prnsts & SDHC_DATA_INHIBIT) || s->stopped_state) && 929 ((s->cmdreg & SDHC_CMD_DATA_PRESENT) || 930 ((s->cmdreg & SDHC_CMD_RESPONSE) == SDHC_CMD_RSP_WITH_BUSY && 931 !(SDHC_COMMAND_TYPE(s->cmdreg) == SDHC_CMD_ABORT))))) { 932 return false; 933 } 934 935 return true; 936 } 937 938 /* The Buffer Data Port register must be accessed in sequential and 939 * continuous manner */ 940 static inline bool 941 sdhci_buff_access_is_sequential(SDHCIState *s, unsigned byte_num) 942 { 943 if ((s->data_count & 0x3) != byte_num) { 944 trace_sdhci_error("Non-sequential access to Buffer Data Port register" 945 "is prohibited\n"); 946 return false; 947 } 948 return true; 949 } 950 951 static void sdhci_resume_pending_transfer(SDHCIState *s) 952 { 953 timer_del(s->transfer_timer); 954 sdhci_data_transfer(s); 955 } 956 957 static uint64_t sdhci_read(void *opaque, hwaddr offset, unsigned size) 958 { 959 SDHCIState *s = (SDHCIState *)opaque; 960 uint32_t ret = 0; 961 962 if (timer_pending(s->transfer_timer)) { 963 sdhci_resume_pending_transfer(s); 964 } 965 966 switch (offset & ~0x3) { 967 case SDHC_SYSAD: 968 ret = s->sdmasysad; 969 break; 970 case SDHC_BLKSIZE: 971 ret = s->blksize | (s->blkcnt << 16); 972 break; 973 case SDHC_ARGUMENT: 974 ret = s->argument; 975 break; 976 case SDHC_TRNMOD: 977 ret = s->trnmod | (s->cmdreg << 16); 978 break; 979 case SDHC_RSPREG0 ... SDHC_RSPREG3: 980 ret = s->rspreg[((offset & ~0x3) - SDHC_RSPREG0) >> 2]; 981 break; 982 case SDHC_BDATA: 983 if (sdhci_buff_access_is_sequential(s, offset - SDHC_BDATA)) { 984 ret = sdhci_read_dataport(s, size); 985 trace_sdhci_access("rd", size << 3, offset, "->", ret, ret); 986 return ret; 987 } 988 break; 989 case SDHC_PRNSTS: 990 ret = s->prnsts; 991 ret = FIELD_DP32(ret, SDHC_PRNSTS, DAT_LVL, 992 sdbus_get_dat_lines(&s->sdbus)); 993 ret = FIELD_DP32(ret, SDHC_PRNSTS, CMD_LVL, 994 sdbus_get_cmd_line(&s->sdbus)); 995 break; 996 case SDHC_HOSTCTL: 997 ret = s->hostctl1 | (s->pwrcon << 8) | (s->blkgap << 16) | 998 (s->wakcon << 24); 999 break; 1000 case SDHC_CLKCON: 1001 ret = s->clkcon | (s->timeoutcon << 16); 1002 break; 1003 case SDHC_NORINTSTS: 1004 ret = s->norintsts | (s->errintsts << 16); 1005 break; 1006 case SDHC_NORINTSTSEN: 1007 ret = s->norintstsen | (s->errintstsen << 16); 1008 break; 1009 case SDHC_NORINTSIGEN: 1010 ret = s->norintsigen | (s->errintsigen << 16); 1011 break; 1012 case SDHC_ACMD12ERRSTS: 1013 ret = s->acmd12errsts | (s->hostctl2 << 16); 1014 break; 1015 case SDHC_CAPAB: 1016 ret = (uint32_t)s->capareg; 1017 break; 1018 case SDHC_CAPAB + 4: 1019 ret = (uint32_t)(s->capareg >> 32); 1020 break; 1021 case SDHC_MAXCURR: 1022 ret = (uint32_t)s->maxcurr; 1023 break; 1024 case SDHC_MAXCURR + 4: 1025 ret = (uint32_t)(s->maxcurr >> 32); 1026 break; 1027 case SDHC_ADMAERR: 1028 ret = s->admaerr; 1029 break; 1030 case SDHC_ADMASYSADDR: 1031 ret = (uint32_t)s->admasysaddr; 1032 break; 1033 case SDHC_ADMASYSADDR + 4: 1034 ret = (uint32_t)(s->admasysaddr >> 32); 1035 break; 1036 case SDHC_SLOT_INT_STATUS: 1037 ret = (s->version << 16) | sdhci_slotint(s); 1038 break; 1039 default: 1040 qemu_log_mask(LOG_UNIMP, "SDHC rd_%ub @0x%02" HWADDR_PRIx " " 1041 "not implemented\n", size, offset); 1042 break; 1043 } 1044 1045 ret >>= (offset & 0x3) * 8; 1046 ret &= (1ULL << (size * 8)) - 1; 1047 trace_sdhci_access("rd", size << 3, offset, "->", ret, ret); 1048 return ret; 1049 } 1050 1051 static inline void sdhci_blkgap_write(SDHCIState *s, uint8_t value) 1052 { 1053 if ((value & SDHC_STOP_AT_GAP_REQ) && (s->blkgap & SDHC_STOP_AT_GAP_REQ)) { 1054 return; 1055 } 1056 s->blkgap = value & SDHC_STOP_AT_GAP_REQ; 1057 1058 if ((value & SDHC_CONTINUE_REQ) && s->stopped_state && 1059 (s->blkgap & SDHC_STOP_AT_GAP_REQ) == 0) { 1060 if (s->stopped_state == sdhc_gap_read) { 1061 s->prnsts |= SDHC_DAT_LINE_ACTIVE | SDHC_DOING_READ; 1062 sdhci_read_block_from_card(s); 1063 } else { 1064 s->prnsts |= SDHC_DAT_LINE_ACTIVE | SDHC_DOING_WRITE; 1065 sdhci_write_block_to_card(s); 1066 } 1067 s->stopped_state = sdhc_not_stopped; 1068 } else if (!s->stopped_state && (value & SDHC_STOP_AT_GAP_REQ)) { 1069 if (s->prnsts & SDHC_DOING_READ) { 1070 s->stopped_state = sdhc_gap_read; 1071 } else if (s->prnsts & SDHC_DOING_WRITE) { 1072 s->stopped_state = sdhc_gap_write; 1073 } 1074 } 1075 } 1076 1077 static inline void sdhci_reset_write(SDHCIState *s, uint8_t value) 1078 { 1079 switch (value) { 1080 case SDHC_RESET_ALL: 1081 sdhci_reset(s); 1082 break; 1083 case SDHC_RESET_CMD: 1084 s->prnsts &= ~SDHC_CMD_INHIBIT; 1085 s->norintsts &= ~SDHC_NIS_CMDCMP; 1086 break; 1087 case SDHC_RESET_DATA: 1088 s->data_count = 0; 1089 s->prnsts &= ~(SDHC_SPACE_AVAILABLE | SDHC_DATA_AVAILABLE | 1090 SDHC_DOING_READ | SDHC_DOING_WRITE | 1091 SDHC_DATA_INHIBIT | SDHC_DAT_LINE_ACTIVE); 1092 s->blkgap &= ~(SDHC_STOP_AT_GAP_REQ | SDHC_CONTINUE_REQ); 1093 s->stopped_state = sdhc_not_stopped; 1094 s->norintsts &= ~(SDHC_NIS_WBUFRDY | SDHC_NIS_RBUFRDY | 1095 SDHC_NIS_DMA | SDHC_NIS_TRSCMP | SDHC_NIS_BLKGAP); 1096 break; 1097 } 1098 } 1099 1100 static void 1101 sdhci_write(void *opaque, hwaddr offset, uint64_t val, unsigned size) 1102 { 1103 SDHCIState *s = (SDHCIState *)opaque; 1104 unsigned shift = 8 * (offset & 0x3); 1105 uint32_t mask = ~(((1ULL << (size * 8)) - 1) << shift); 1106 uint32_t value = val; 1107 value <<= shift; 1108 1109 if (timer_pending(s->transfer_timer)) { 1110 sdhci_resume_pending_transfer(s); 1111 } 1112 1113 switch (offset & ~0x3) { 1114 case SDHC_SYSAD: 1115 s->sdmasysad = (s->sdmasysad & mask) | value; 1116 MASKED_WRITE(s->sdmasysad, mask, value); 1117 /* Writing to last byte of sdmasysad might trigger transfer */ 1118 if (!(mask & 0xFF000000) && TRANSFERRING_DATA(s->prnsts) && s->blkcnt && 1119 s->blksize && SDHC_DMA_TYPE(s->hostctl1) == SDHC_CTRL_SDMA) { 1120 if (s->trnmod & SDHC_TRNS_MULTI) { 1121 sdhci_sdma_transfer_multi_blocks(s); 1122 } else { 1123 sdhci_sdma_transfer_single_block(s); 1124 } 1125 } 1126 break; 1127 case SDHC_BLKSIZE: 1128 if (!TRANSFERRING_DATA(s->prnsts)) { 1129 MASKED_WRITE(s->blksize, mask, extract32(value, 0, 12)); 1130 MASKED_WRITE(s->blkcnt, mask >> 16, value >> 16); 1131 } 1132 1133 /* Limit block size to the maximum buffer size */ 1134 if (extract32(s->blksize, 0, 12) > s->buf_maxsz) { 1135 qemu_log_mask(LOG_GUEST_ERROR, "%s: Size 0x%x is larger than " 1136 "the maximum buffer 0x%x\n", __func__, s->blksize, 1137 s->buf_maxsz); 1138 1139 s->blksize = deposit32(s->blksize, 0, 12, s->buf_maxsz); 1140 } 1141 1142 break; 1143 case SDHC_ARGUMENT: 1144 MASKED_WRITE(s->argument, mask, value); 1145 break; 1146 case SDHC_TRNMOD: 1147 /* DMA can be enabled only if it is supported as indicated by 1148 * capabilities register */ 1149 if (!(s->capareg & R_SDHC_CAPAB_SDMA_MASK)) { 1150 value &= ~SDHC_TRNS_DMA; 1151 } 1152 MASKED_WRITE(s->trnmod, mask, value & SDHC_TRNMOD_MASK); 1153 MASKED_WRITE(s->cmdreg, mask >> 16, value >> 16); 1154 1155 /* Writing to the upper byte of CMDREG triggers SD command generation */ 1156 if ((mask & 0xFF000000) || !sdhci_can_issue_command(s)) { 1157 break; 1158 } 1159 1160 sdhci_send_command(s); 1161 break; 1162 case SDHC_BDATA: 1163 if (sdhci_buff_access_is_sequential(s, offset - SDHC_BDATA)) { 1164 sdhci_write_dataport(s, value >> shift, size); 1165 } 1166 break; 1167 case SDHC_HOSTCTL: 1168 if (!(mask & 0xFF0000)) { 1169 sdhci_blkgap_write(s, value >> 16); 1170 } 1171 MASKED_WRITE(s->hostctl1, mask, value); 1172 MASKED_WRITE(s->pwrcon, mask >> 8, value >> 8); 1173 MASKED_WRITE(s->wakcon, mask >> 24, value >> 24); 1174 if (!(s->prnsts & SDHC_CARD_PRESENT) || ((s->pwrcon >> 1) & 0x7) < 5 || 1175 !(s->capareg & (1 << (31 - ((s->pwrcon >> 1) & 0x7))))) { 1176 s->pwrcon &= ~SDHC_POWER_ON; 1177 } 1178 break; 1179 case SDHC_CLKCON: 1180 if (!(mask & 0xFF000000)) { 1181 sdhci_reset_write(s, value >> 24); 1182 } 1183 MASKED_WRITE(s->clkcon, mask, value); 1184 MASKED_WRITE(s->timeoutcon, mask >> 16, value >> 16); 1185 if (s->clkcon & SDHC_CLOCK_INT_EN) { 1186 s->clkcon |= SDHC_CLOCK_INT_STABLE; 1187 } else { 1188 s->clkcon &= ~SDHC_CLOCK_INT_STABLE; 1189 } 1190 break; 1191 case SDHC_NORINTSTS: 1192 if (s->norintstsen & SDHC_NISEN_CARDINT) { 1193 value &= ~SDHC_NIS_CARDINT; 1194 } 1195 s->norintsts &= mask | ~value; 1196 s->errintsts &= (mask >> 16) | ~(value >> 16); 1197 if (s->errintsts) { 1198 s->norintsts |= SDHC_NIS_ERR; 1199 } else { 1200 s->norintsts &= ~SDHC_NIS_ERR; 1201 } 1202 sdhci_update_irq(s); 1203 break; 1204 case SDHC_NORINTSTSEN: 1205 MASKED_WRITE(s->norintstsen, mask, value); 1206 MASKED_WRITE(s->errintstsen, mask >> 16, value >> 16); 1207 s->norintsts &= s->norintstsen; 1208 s->errintsts &= s->errintstsen; 1209 if (s->errintsts) { 1210 s->norintsts |= SDHC_NIS_ERR; 1211 } else { 1212 s->norintsts &= ~SDHC_NIS_ERR; 1213 } 1214 /* Quirk for Raspberry Pi: pending card insert interrupt 1215 * appears when first enabled after power on */ 1216 if ((s->norintstsen & SDHC_NISEN_INSERT) && s->pending_insert_state) { 1217 assert(s->pending_insert_quirk); 1218 s->norintsts |= SDHC_NIS_INSERT; 1219 s->pending_insert_state = false; 1220 } 1221 sdhci_update_irq(s); 1222 break; 1223 case SDHC_NORINTSIGEN: 1224 MASKED_WRITE(s->norintsigen, mask, value); 1225 MASKED_WRITE(s->errintsigen, mask >> 16, value >> 16); 1226 sdhci_update_irq(s); 1227 break; 1228 case SDHC_ADMAERR: 1229 MASKED_WRITE(s->admaerr, mask, value); 1230 break; 1231 case SDHC_ADMASYSADDR: 1232 s->admasysaddr = (s->admasysaddr & (0xFFFFFFFF00000000ULL | 1233 (uint64_t)mask)) | (uint64_t)value; 1234 break; 1235 case SDHC_ADMASYSADDR + 4: 1236 s->admasysaddr = (s->admasysaddr & (0x00000000FFFFFFFFULL | 1237 ((uint64_t)mask << 32))) | ((uint64_t)value << 32); 1238 break; 1239 case SDHC_FEAER: 1240 s->acmd12errsts |= value; 1241 s->errintsts |= (value >> 16) & s->errintstsen; 1242 if (s->acmd12errsts) { 1243 s->errintsts |= SDHC_EIS_CMD12ERR; 1244 } 1245 if (s->errintsts) { 1246 s->norintsts |= SDHC_NIS_ERR; 1247 } 1248 sdhci_update_irq(s); 1249 break; 1250 case SDHC_ACMD12ERRSTS: 1251 MASKED_WRITE(s->acmd12errsts, mask, value & UINT16_MAX); 1252 if (s->uhs_mode >= UHS_I) { 1253 MASKED_WRITE(s->hostctl2, mask >> 16, value >> 16); 1254 1255 if (FIELD_EX32(s->hostctl2, SDHC_HOSTCTL2, V18_ENA)) { 1256 sdbus_set_voltage(&s->sdbus, SD_VOLTAGE_1_8V); 1257 } else { 1258 sdbus_set_voltage(&s->sdbus, SD_VOLTAGE_3_3V); 1259 } 1260 } 1261 break; 1262 1263 case SDHC_CAPAB: 1264 case SDHC_CAPAB + 4: 1265 case SDHC_MAXCURR: 1266 case SDHC_MAXCURR + 4: 1267 qemu_log_mask(LOG_GUEST_ERROR, "SDHC wr_%ub @0x%02" HWADDR_PRIx 1268 " <- 0x%08x read-only\n", size, offset, value >> shift); 1269 break; 1270 1271 default: 1272 qemu_log_mask(LOG_UNIMP, "SDHC wr_%ub @0x%02" HWADDR_PRIx " <- 0x%08x " 1273 "not implemented\n", size, offset, value >> shift); 1274 break; 1275 } 1276 trace_sdhci_access("wr", size << 3, offset, "<-", 1277 value >> shift, value >> shift); 1278 } 1279 1280 static const MemoryRegionOps sdhci_mmio_ops = { 1281 .read = sdhci_read, 1282 .write = sdhci_write, 1283 .valid = { 1284 .min_access_size = 1, 1285 .max_access_size = 4, 1286 .unaligned = false 1287 }, 1288 .endianness = DEVICE_LITTLE_ENDIAN, 1289 }; 1290 1291 static void sdhci_init_readonly_registers(SDHCIState *s, Error **errp) 1292 { 1293 ERRP_GUARD(); 1294 1295 switch (s->sd_spec_version) { 1296 case 2 ... 3: 1297 break; 1298 default: 1299 error_setg(errp, "Only Spec v2/v3 are supported"); 1300 return; 1301 } 1302 s->version = (SDHC_HCVER_VENDOR << 8) | (s->sd_spec_version - 1); 1303 1304 sdhci_check_capareg(s, errp); 1305 if (*errp) { 1306 return; 1307 } 1308 } 1309 1310 /* --- qdev common --- */ 1311 1312 void sdhci_initfn(SDHCIState *s) 1313 { 1314 qbus_create_inplace(&s->sdbus, sizeof(s->sdbus), 1315 TYPE_SDHCI_BUS, DEVICE(s), "sd-bus"); 1316 1317 s->insert_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, sdhci_raise_insertion_irq, s); 1318 s->transfer_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, sdhci_data_transfer, s); 1319 1320 s->io_ops = &sdhci_mmio_ops; 1321 } 1322 1323 void sdhci_uninitfn(SDHCIState *s) 1324 { 1325 timer_del(s->insert_timer); 1326 timer_free(s->insert_timer); 1327 timer_del(s->transfer_timer); 1328 timer_free(s->transfer_timer); 1329 1330 g_free(s->fifo_buffer); 1331 s->fifo_buffer = NULL; 1332 } 1333 1334 void sdhci_common_realize(SDHCIState *s, Error **errp) 1335 { 1336 ERRP_GUARD(); 1337 1338 sdhci_init_readonly_registers(s, errp); 1339 if (*errp) { 1340 return; 1341 } 1342 s->buf_maxsz = sdhci_get_fifolen(s); 1343 s->fifo_buffer = g_malloc0(s->buf_maxsz); 1344 1345 memory_region_init_io(&s->iomem, OBJECT(s), s->io_ops, s, "sdhci", 1346 SDHC_REGISTERS_MAP_SIZE); 1347 } 1348 1349 void sdhci_common_unrealize(SDHCIState *s) 1350 { 1351 /* This function is expected to be called only once for each class: 1352 * - SysBus: via DeviceClass->unrealize(), 1353 * - PCI: via PCIDeviceClass->exit(). 1354 * However to avoid double-free and/or use-after-free we still nullify 1355 * this variable (better safe than sorry!). */ 1356 g_free(s->fifo_buffer); 1357 s->fifo_buffer = NULL; 1358 } 1359 1360 static bool sdhci_pending_insert_vmstate_needed(void *opaque) 1361 { 1362 SDHCIState *s = opaque; 1363 1364 return s->pending_insert_state; 1365 } 1366 1367 static const VMStateDescription sdhci_pending_insert_vmstate = { 1368 .name = "sdhci/pending-insert", 1369 .version_id = 1, 1370 .minimum_version_id = 1, 1371 .needed = sdhci_pending_insert_vmstate_needed, 1372 .fields = (VMStateField[]) { 1373 VMSTATE_BOOL(pending_insert_state, SDHCIState), 1374 VMSTATE_END_OF_LIST() 1375 }, 1376 }; 1377 1378 const VMStateDescription sdhci_vmstate = { 1379 .name = "sdhci", 1380 .version_id = 1, 1381 .minimum_version_id = 1, 1382 .fields = (VMStateField[]) { 1383 VMSTATE_UINT32(sdmasysad, SDHCIState), 1384 VMSTATE_UINT16(blksize, SDHCIState), 1385 VMSTATE_UINT16(blkcnt, SDHCIState), 1386 VMSTATE_UINT32(argument, SDHCIState), 1387 VMSTATE_UINT16(trnmod, SDHCIState), 1388 VMSTATE_UINT16(cmdreg, SDHCIState), 1389 VMSTATE_UINT32_ARRAY(rspreg, SDHCIState, 4), 1390 VMSTATE_UINT32(prnsts, SDHCIState), 1391 VMSTATE_UINT8(hostctl1, SDHCIState), 1392 VMSTATE_UINT8(pwrcon, SDHCIState), 1393 VMSTATE_UINT8(blkgap, SDHCIState), 1394 VMSTATE_UINT8(wakcon, SDHCIState), 1395 VMSTATE_UINT16(clkcon, SDHCIState), 1396 VMSTATE_UINT8(timeoutcon, SDHCIState), 1397 VMSTATE_UINT8(admaerr, SDHCIState), 1398 VMSTATE_UINT16(norintsts, SDHCIState), 1399 VMSTATE_UINT16(errintsts, SDHCIState), 1400 VMSTATE_UINT16(norintstsen, SDHCIState), 1401 VMSTATE_UINT16(errintstsen, SDHCIState), 1402 VMSTATE_UINT16(norintsigen, SDHCIState), 1403 VMSTATE_UINT16(errintsigen, SDHCIState), 1404 VMSTATE_UINT16(acmd12errsts, SDHCIState), 1405 VMSTATE_UINT16(data_count, SDHCIState), 1406 VMSTATE_UINT64(admasysaddr, SDHCIState), 1407 VMSTATE_UINT8(stopped_state, SDHCIState), 1408 VMSTATE_VBUFFER_UINT32(fifo_buffer, SDHCIState, 1, NULL, buf_maxsz), 1409 VMSTATE_TIMER_PTR(insert_timer, SDHCIState), 1410 VMSTATE_TIMER_PTR(transfer_timer, SDHCIState), 1411 VMSTATE_END_OF_LIST() 1412 }, 1413 .subsections = (const VMStateDescription*[]) { 1414 &sdhci_pending_insert_vmstate, 1415 NULL 1416 }, 1417 }; 1418 1419 void sdhci_common_class_init(ObjectClass *klass, void *data) 1420 { 1421 DeviceClass *dc = DEVICE_CLASS(klass); 1422 1423 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1424 dc->vmsd = &sdhci_vmstate; 1425 dc->reset = sdhci_poweron_reset; 1426 } 1427 1428 /* --- qdev SysBus --- */ 1429 1430 static Property sdhci_sysbus_properties[] = { 1431 DEFINE_SDHCI_COMMON_PROPERTIES(SDHCIState), 1432 DEFINE_PROP_BOOL("pending-insert-quirk", SDHCIState, pending_insert_quirk, 1433 false), 1434 DEFINE_PROP_LINK("dma", SDHCIState, 1435 dma_mr, TYPE_MEMORY_REGION, MemoryRegion *), 1436 DEFINE_PROP_END_OF_LIST(), 1437 }; 1438 1439 static void sdhci_sysbus_init(Object *obj) 1440 { 1441 SDHCIState *s = SYSBUS_SDHCI(obj); 1442 1443 sdhci_initfn(s); 1444 } 1445 1446 static void sdhci_sysbus_finalize(Object *obj) 1447 { 1448 SDHCIState *s = SYSBUS_SDHCI(obj); 1449 1450 if (s->dma_mr) { 1451 object_unparent(OBJECT(s->dma_mr)); 1452 } 1453 1454 sdhci_uninitfn(s); 1455 } 1456 1457 static void sdhci_sysbus_realize(DeviceState *dev, Error **errp) 1458 { 1459 ERRP_GUARD(); 1460 SDHCIState *s = SYSBUS_SDHCI(dev); 1461 SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 1462 1463 sdhci_common_realize(s, errp); 1464 if (*errp) { 1465 return; 1466 } 1467 1468 if (s->dma_mr) { 1469 s->dma_as = &s->sysbus_dma_as; 1470 address_space_init(s->dma_as, s->dma_mr, "sdhci-dma"); 1471 } else { 1472 /* use system_memory() if property "dma" not set */ 1473 s->dma_as = &address_space_memory; 1474 } 1475 1476 sysbus_init_irq(sbd, &s->irq); 1477 1478 sysbus_init_mmio(sbd, &s->iomem); 1479 } 1480 1481 static void sdhci_sysbus_unrealize(DeviceState *dev) 1482 { 1483 SDHCIState *s = SYSBUS_SDHCI(dev); 1484 1485 sdhci_common_unrealize(s); 1486 1487 if (s->dma_mr) { 1488 address_space_destroy(s->dma_as); 1489 } 1490 } 1491 1492 static void sdhci_sysbus_class_init(ObjectClass *klass, void *data) 1493 { 1494 DeviceClass *dc = DEVICE_CLASS(klass); 1495 1496 device_class_set_props(dc, sdhci_sysbus_properties); 1497 dc->realize = sdhci_sysbus_realize; 1498 dc->unrealize = sdhci_sysbus_unrealize; 1499 1500 sdhci_common_class_init(klass, data); 1501 } 1502 1503 static const TypeInfo sdhci_sysbus_info = { 1504 .name = TYPE_SYSBUS_SDHCI, 1505 .parent = TYPE_SYS_BUS_DEVICE, 1506 .instance_size = sizeof(SDHCIState), 1507 .instance_init = sdhci_sysbus_init, 1508 .instance_finalize = sdhci_sysbus_finalize, 1509 .class_init = sdhci_sysbus_class_init, 1510 }; 1511 1512 /* --- qdev bus master --- */ 1513 1514 static void sdhci_bus_class_init(ObjectClass *klass, void *data) 1515 { 1516 SDBusClass *sbc = SD_BUS_CLASS(klass); 1517 1518 sbc->set_inserted = sdhci_set_inserted; 1519 sbc->set_readonly = sdhci_set_readonly; 1520 } 1521 1522 static const TypeInfo sdhci_bus_info = { 1523 .name = TYPE_SDHCI_BUS, 1524 .parent = TYPE_SD_BUS, 1525 .instance_size = sizeof(SDBus), 1526 .class_init = sdhci_bus_class_init, 1527 }; 1528 1529 /* --- qdev i.MX eSDHC --- */ 1530 1531 static uint64_t usdhc_read(void *opaque, hwaddr offset, unsigned size) 1532 { 1533 SDHCIState *s = SYSBUS_SDHCI(opaque); 1534 uint32_t ret; 1535 uint16_t hostctl1; 1536 1537 switch (offset) { 1538 default: 1539 return sdhci_read(opaque, offset, size); 1540 1541 case SDHC_HOSTCTL: 1542 /* 1543 * For a detailed explanation on the following bit 1544 * manipulation code see comments in a similar part of 1545 * usdhc_write() 1546 */ 1547 hostctl1 = SDHC_DMA_TYPE(s->hostctl1) << (8 - 3); 1548 1549 if (s->hostctl1 & SDHC_CTRL_8BITBUS) { 1550 hostctl1 |= ESDHC_CTRL_8BITBUS; 1551 } 1552 1553 if (s->hostctl1 & SDHC_CTRL_4BITBUS) { 1554 hostctl1 |= ESDHC_CTRL_4BITBUS; 1555 } 1556 1557 ret = hostctl1; 1558 ret |= (uint32_t)s->blkgap << 16; 1559 ret |= (uint32_t)s->wakcon << 24; 1560 1561 break; 1562 1563 case SDHC_PRNSTS: 1564 /* Add SDSTB (SD Clock Stable) bit to PRNSTS */ 1565 ret = sdhci_read(opaque, offset, size) & ~ESDHC_PRNSTS_SDSTB; 1566 if (s->clkcon & SDHC_CLOCK_INT_STABLE) { 1567 ret |= ESDHC_PRNSTS_SDSTB; 1568 } 1569 break; 1570 1571 case ESDHC_VENDOR_SPEC: 1572 ret = s->vendor_spec; 1573 break; 1574 case ESDHC_DLL_CTRL: 1575 case ESDHC_TUNE_CTRL_STATUS: 1576 case ESDHC_UNDOCUMENTED_REG27: 1577 case ESDHC_TUNING_CTRL: 1578 case ESDHC_MIX_CTRL: 1579 case ESDHC_WTMK_LVL: 1580 ret = 0; 1581 break; 1582 } 1583 1584 return ret; 1585 } 1586 1587 static void 1588 usdhc_write(void *opaque, hwaddr offset, uint64_t val, unsigned size) 1589 { 1590 SDHCIState *s = SYSBUS_SDHCI(opaque); 1591 uint8_t hostctl1; 1592 uint32_t value = (uint32_t)val; 1593 1594 switch (offset) { 1595 case ESDHC_DLL_CTRL: 1596 case ESDHC_TUNE_CTRL_STATUS: 1597 case ESDHC_UNDOCUMENTED_REG27: 1598 case ESDHC_TUNING_CTRL: 1599 case ESDHC_WTMK_LVL: 1600 break; 1601 1602 case ESDHC_VENDOR_SPEC: 1603 s->vendor_spec = value; 1604 switch (s->vendor) { 1605 case SDHCI_VENDOR_IMX: 1606 if (value & ESDHC_IMX_FRC_SDCLK_ON) { 1607 s->prnsts &= ~SDHC_IMX_CLOCK_GATE_OFF; 1608 } else { 1609 s->prnsts |= SDHC_IMX_CLOCK_GATE_OFF; 1610 } 1611 break; 1612 default: 1613 break; 1614 } 1615 break; 1616 1617 case SDHC_HOSTCTL: 1618 /* 1619 * Here's What ESDHCI has at offset 0x28 (SDHC_HOSTCTL) 1620 * 1621 * 7 6 5 4 3 2 1 0 1622 * |-----------+--------+--------+-----------+----------+---------| 1623 * | Card | Card | Endian | DATA3 | Data | Led | 1624 * | Detect | Detect | Mode | as Card | Transfer | Control | 1625 * | Signal | Test | | Detection | Width | | 1626 * | Selection | Level | | Pin | | | 1627 * |-----------+--------+--------+-----------+----------+---------| 1628 * 1629 * and 0x29 1630 * 1631 * 15 10 9 8 1632 * |----------+------| 1633 * | Reserved | DMA | 1634 * | | Sel. | 1635 * | | | 1636 * |----------+------| 1637 * 1638 * and here's what SDCHI spec expects those offsets to be: 1639 * 1640 * 0x28 (Host Control Register) 1641 * 1642 * 7 6 5 4 3 2 1 0 1643 * |--------+--------+----------+------+--------+----------+---------| 1644 * | Card | Card | Extended | DMA | High | Data | LED | 1645 * | Detect | Detect | Data | Sel. | Speed | Transfer | Control | 1646 * | Signal | Test | Transfer | | Enable | Width | | 1647 * | Sel. | Level | Width | | | | | 1648 * |--------+--------+----------+------+--------+----------+---------| 1649 * 1650 * and 0x29 (Power Control Register) 1651 * 1652 * |----------------------------------| 1653 * | Power Control Register | 1654 * | | 1655 * | Description omitted, | 1656 * | since it has no analog in ESDHCI | 1657 * | | 1658 * |----------------------------------| 1659 * 1660 * Since offsets 0x2A and 0x2B should be compatible between 1661 * both IP specs we only need to reconcile least 16-bit of the 1662 * word we've been given. 1663 */ 1664 1665 /* 1666 * First, save bits 7 6 and 0 since they are identical 1667 */ 1668 hostctl1 = value & (SDHC_CTRL_LED | 1669 SDHC_CTRL_CDTEST_INS | 1670 SDHC_CTRL_CDTEST_EN); 1671 /* 1672 * Second, split "Data Transfer Width" from bits 2 and 1 in to 1673 * bits 5 and 1 1674 */ 1675 if (value & ESDHC_CTRL_8BITBUS) { 1676 hostctl1 |= SDHC_CTRL_8BITBUS; 1677 } 1678 1679 if (value & ESDHC_CTRL_4BITBUS) { 1680 hostctl1 |= ESDHC_CTRL_4BITBUS; 1681 } 1682 1683 /* 1684 * Third, move DMA select from bits 9 and 8 to bits 4 and 3 1685 */ 1686 hostctl1 |= SDHC_DMA_TYPE(value >> (8 - 3)); 1687 1688 /* 1689 * Now place the corrected value into low 16-bit of the value 1690 * we are going to give standard SDHCI write function 1691 * 1692 * NOTE: This transformation should be the inverse of what can 1693 * be found in drivers/mmc/host/sdhci-esdhc-imx.c in Linux 1694 * kernel 1695 */ 1696 value &= ~UINT16_MAX; 1697 value |= hostctl1; 1698 value |= (uint16_t)s->pwrcon << 8; 1699 1700 sdhci_write(opaque, offset, value, size); 1701 break; 1702 1703 case ESDHC_MIX_CTRL: 1704 /* 1705 * So, when SD/MMC stack in Linux tries to write to "Transfer 1706 * Mode Register", ESDHC i.MX quirk code will translate it 1707 * into a write to ESDHC_MIX_CTRL, so we do the opposite in 1708 * order to get where we started 1709 * 1710 * Note that Auto CMD23 Enable bit is located in a wrong place 1711 * on i.MX, but since it is not used by QEMU we do not care. 1712 * 1713 * We don't want to call sdhci_write(.., SDHC_TRNMOD, ...) 1714 * here becuase it will result in a call to 1715 * sdhci_send_command(s) which we don't want. 1716 * 1717 */ 1718 s->trnmod = value & UINT16_MAX; 1719 break; 1720 case SDHC_TRNMOD: 1721 /* 1722 * Similar to above, but this time a write to "Command 1723 * Register" will be translated into a 4-byte write to 1724 * "Transfer Mode register" where lower 16-bit of value would 1725 * be set to zero. So what we do is fill those bits with 1726 * cached value from s->trnmod and let the SDHCI 1727 * infrastructure handle the rest 1728 */ 1729 sdhci_write(opaque, offset, val | s->trnmod, size); 1730 break; 1731 case SDHC_BLKSIZE: 1732 /* 1733 * ESDHCI does not implement "Host SDMA Buffer Boundary", and 1734 * Linux driver will try to zero this field out which will 1735 * break the rest of SDHCI emulation. 1736 * 1737 * Linux defaults to maximum possible setting (512K boundary) 1738 * and it seems to be the only option that i.MX IP implements, 1739 * so we artificially set it to that value. 1740 */ 1741 val |= 0x7 << 12; 1742 /* FALLTHROUGH */ 1743 default: 1744 sdhci_write(opaque, offset, val, size); 1745 break; 1746 } 1747 } 1748 1749 static const MemoryRegionOps usdhc_mmio_ops = { 1750 .read = usdhc_read, 1751 .write = usdhc_write, 1752 .valid = { 1753 .min_access_size = 1, 1754 .max_access_size = 4, 1755 .unaligned = false 1756 }, 1757 .endianness = DEVICE_LITTLE_ENDIAN, 1758 }; 1759 1760 static void imx_usdhc_init(Object *obj) 1761 { 1762 SDHCIState *s = SYSBUS_SDHCI(obj); 1763 1764 s->io_ops = &usdhc_mmio_ops; 1765 s->quirks = SDHCI_QUIRK_NO_BUSY_IRQ; 1766 } 1767 1768 static const TypeInfo imx_usdhc_info = { 1769 .name = TYPE_IMX_USDHC, 1770 .parent = TYPE_SYSBUS_SDHCI, 1771 .instance_init = imx_usdhc_init, 1772 }; 1773 1774 /* --- qdev Samsung s3c --- */ 1775 1776 #define S3C_SDHCI_CONTROL2 0x80 1777 #define S3C_SDHCI_CONTROL3 0x84 1778 #define S3C_SDHCI_CONTROL4 0x8c 1779 1780 static uint64_t sdhci_s3c_read(void *opaque, hwaddr offset, unsigned size) 1781 { 1782 uint64_t ret; 1783 1784 switch (offset) { 1785 case S3C_SDHCI_CONTROL2: 1786 case S3C_SDHCI_CONTROL3: 1787 case S3C_SDHCI_CONTROL4: 1788 /* ignore */ 1789 ret = 0; 1790 break; 1791 default: 1792 ret = sdhci_read(opaque, offset, size); 1793 break; 1794 } 1795 1796 return ret; 1797 } 1798 1799 static void sdhci_s3c_write(void *opaque, hwaddr offset, uint64_t val, 1800 unsigned size) 1801 { 1802 switch (offset) { 1803 case S3C_SDHCI_CONTROL2: 1804 case S3C_SDHCI_CONTROL3: 1805 case S3C_SDHCI_CONTROL4: 1806 /* ignore */ 1807 break; 1808 default: 1809 sdhci_write(opaque, offset, val, size); 1810 break; 1811 } 1812 } 1813 1814 static const MemoryRegionOps sdhci_s3c_mmio_ops = { 1815 .read = sdhci_s3c_read, 1816 .write = sdhci_s3c_write, 1817 .valid = { 1818 .min_access_size = 1, 1819 .max_access_size = 4, 1820 .unaligned = false 1821 }, 1822 .endianness = DEVICE_LITTLE_ENDIAN, 1823 }; 1824 1825 static void sdhci_s3c_init(Object *obj) 1826 { 1827 SDHCIState *s = SYSBUS_SDHCI(obj); 1828 1829 s->io_ops = &sdhci_s3c_mmio_ops; 1830 } 1831 1832 static const TypeInfo sdhci_s3c_info = { 1833 .name = TYPE_S3C_SDHCI , 1834 .parent = TYPE_SYSBUS_SDHCI, 1835 .instance_init = sdhci_s3c_init, 1836 }; 1837 1838 static void sdhci_register_types(void) 1839 { 1840 type_register_static(&sdhci_sysbus_info); 1841 type_register_static(&sdhci_bus_info); 1842 type_register_static(&imx_usdhc_info); 1843 type_register_static(&sdhci_s3c_info); 1844 } 1845 1846 type_init(sdhci_register_types) 1847