hw/sd/sdcard: Add sd_acmd_SD_APP_OP_COND handler (ACMD41)
Signed-off-by: Philippe Mathieu-Daudé <philmd@linaro.org> Tested-by: Cédric Le Goater <clg@redhat.com> Reviewed-by: Cédric Le Goater <clg@redhat.com> Message-Id: <20240628070216.92609-73-philmd@linaro.org>
This commit is contained in:
parent
f443003ff4
commit
c79cbe44ec
82
hw/sd/sd.c
82
hw/sd/sd.c
@ -1685,6 +1685,50 @@ static sd_rsp_type_t sd_acmd_SET_WR_BLK_ERASE_COUNT(SDState *sd, SDRequest req)
|
|||||||
return sd_r1;
|
return sd_r1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* ACMD41 */
|
||||||
|
static sd_rsp_type_t sd_acmd_SD_APP_OP_COND(SDState *sd, SDRequest req)
|
||||||
|
{
|
||||||
|
if (sd->state != sd_idle_state) {
|
||||||
|
return sd_invalid_state_for_cmd(sd, req);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* If it's the first ACMD41 since reset, we need to decide
|
||||||
|
* whether to power up. If this is not an enquiry ACMD41,
|
||||||
|
* we immediately report power on and proceed below to the
|
||||||
|
* ready state, but if it is, we set a timer to model a
|
||||||
|
* delay for power up. This works around a bug in EDK2
|
||||||
|
* UEFI, which sends an initial enquiry ACMD41, but
|
||||||
|
* assumes that the card is in ready state as soon as it
|
||||||
|
* sees the power up bit set.
|
||||||
|
*/
|
||||||
|
if (!FIELD_EX32(sd->ocr, OCR, CARD_POWER_UP)) {
|
||||||
|
if ((req.arg & ACMD41_ENQUIRY_MASK) != 0) {
|
||||||
|
timer_del(sd->ocr_power_timer);
|
||||||
|
sd_ocr_powerup(sd);
|
||||||
|
} else {
|
||||||
|
trace_sdcard_inquiry_cmd41();
|
||||||
|
if (!timer_pending(sd->ocr_power_timer)) {
|
||||||
|
timer_mod_ns(sd->ocr_power_timer,
|
||||||
|
(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
|
||||||
|
+ OCR_POWER_DELAY_NS));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (FIELD_EX32(sd->ocr & req.arg, OCR, VDD_VOLTAGE_WINDOW)) {
|
||||||
|
/*
|
||||||
|
* We accept any voltage. 10000 V is nothing.
|
||||||
|
*
|
||||||
|
* Once we're powered up, we advance straight to ready state
|
||||||
|
* unless it's an enquiry ACMD41 (bits 23:0 == 0).
|
||||||
|
*/
|
||||||
|
sd->state = sd_ready_state;
|
||||||
|
}
|
||||||
|
|
||||||
|
return sd_r3;
|
||||||
|
}
|
||||||
|
|
||||||
static sd_rsp_type_t sd_normal_command(SDState *sd, SDRequest req)
|
static sd_rsp_type_t sd_normal_command(SDState *sd, SDRequest req)
|
||||||
{
|
{
|
||||||
uint64_t addr;
|
uint64_t addr;
|
||||||
@ -1809,43 +1853,6 @@ static sd_rsp_type_t sd_app_command(SDState *sd,
|
|||||||
}
|
}
|
||||||
|
|
||||||
switch (req.cmd) {
|
switch (req.cmd) {
|
||||||
case 41: /* ACMD41: SD_APP_OP_COND */
|
|
||||||
if (sd->state != sd_idle_state) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
/* If it's the first ACMD41 since reset, we need to decide
|
|
||||||
* whether to power up. If this is not an enquiry ACMD41,
|
|
||||||
* we immediately report power on and proceed below to the
|
|
||||||
* ready state, but if it is, we set a timer to model a
|
|
||||||
* delay for power up. This works around a bug in EDK2
|
|
||||||
* UEFI, which sends an initial enquiry ACMD41, but
|
|
||||||
* assumes that the card is in ready state as soon as it
|
|
||||||
* sees the power up bit set. */
|
|
||||||
if (!FIELD_EX32(sd->ocr, OCR, CARD_POWER_UP)) {
|
|
||||||
if ((req.arg & ACMD41_ENQUIRY_MASK) != 0) {
|
|
||||||
timer_del(sd->ocr_power_timer);
|
|
||||||
sd_ocr_powerup(sd);
|
|
||||||
} else {
|
|
||||||
trace_sdcard_inquiry_cmd41();
|
|
||||||
if (!timer_pending(sd->ocr_power_timer)) {
|
|
||||||
timer_mod_ns(sd->ocr_power_timer,
|
|
||||||
(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
|
|
||||||
+ OCR_POWER_DELAY_NS));
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (FIELD_EX32(sd->ocr & req.arg, OCR, VDD_VOLTAGE_WINDOW)) {
|
|
||||||
/* We accept any voltage. 10000 V is nothing.
|
|
||||||
*
|
|
||||||
* Once we're powered up, we advance straight to ready state
|
|
||||||
* unless it's an enquiry ACMD41 (bits 23:0 == 0).
|
|
||||||
*/
|
|
||||||
sd->state = sd_ready_state;
|
|
||||||
}
|
|
||||||
|
|
||||||
return sd_r3;
|
|
||||||
|
|
||||||
case 42: /* ACMD42: SET_CLR_CARD_DETECT */
|
case 42: /* ACMD42: SET_CLR_CARD_DETECT */
|
||||||
switch (sd->state) {
|
switch (sd->state) {
|
||||||
case sd_transfer_state:
|
case sd_transfer_state:
|
||||||
@ -2384,6 +2391,7 @@ static const SDProto sd_proto_sd = {
|
|||||||
[13] = {8, sd_adtc, "SD_STATUS", sd_acmd_SD_STATUS},
|
[13] = {8, sd_adtc, "SD_STATUS", sd_acmd_SD_STATUS},
|
||||||
[22] = {8, sd_adtc, "SEND_NUM_WR_BLOCKS", sd_acmd_SEND_NUM_WR_BLOCKS},
|
[22] = {8, sd_adtc, "SEND_NUM_WR_BLOCKS", sd_acmd_SEND_NUM_WR_BLOCKS},
|
||||||
[23] = {8, sd_ac, "SET_WR_BLK_ERASE_COUNT", sd_acmd_SET_WR_BLK_ERASE_COUNT},
|
[23] = {8, sd_ac, "SET_WR_BLK_ERASE_COUNT", sd_acmd_SET_WR_BLK_ERASE_COUNT},
|
||||||
|
[41] = {8, sd_bcr, "SD_APP_OP_COND", sd_acmd_SD_APP_OP_COND},
|
||||||
},
|
},
|
||||||
};
|
};
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user