mirror of https://github.com/xemu-project/xemu.git
hw/sd/sdcard: Add sd_cmd_SET_BLOCKLEN handler (CMD16)
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-56-philmd@linaro.org>
This commit is contained in:
parent
9318be0605
commit
6d4e6424a6
37
hw/sd/sd.c
37
hw/sd/sd.c
|
@ -237,7 +237,7 @@ static const char *sd_response_name(sd_rsp_type_t rsp)
|
||||||
static const char *sd_cmd_name(SDState *sd, uint8_t cmd)
|
static const char *sd_cmd_name(SDState *sd, uint8_t cmd)
|
||||||
{
|
{
|
||||||
static const char *cmd_abbrev[SDMMC_CMD_MAX] = {
|
static const char *cmd_abbrev[SDMMC_CMD_MAX] = {
|
||||||
[16] = "SET_BLOCKLEN", [17] = "READ_SINGLE_BLOCK",
|
[17] = "READ_SINGLE_BLOCK",
|
||||||
[18] = "READ_MULTIPLE_BLOCK",
|
[18] = "READ_MULTIPLE_BLOCK",
|
||||||
[21] = "DPS_spec",
|
[21] = "DPS_spec",
|
||||||
[24] = "WRITE_BLOCK", [25] = "WRITE_MULTIPLE_BLOCK",
|
[24] = "WRITE_BLOCK", [25] = "WRITE_MULTIPLE_BLOCK",
|
||||||
|
@ -1417,6 +1417,22 @@ static sd_rsp_type_t sd_cmd_GO_INACTIVE_STATE(SDState *sd, SDRequest req)
|
||||||
return sd_r0;
|
return sd_r0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* CMD16 */
|
||||||
|
static sd_rsp_type_t sd_cmd_SET_BLOCKLEN(SDState *sd, SDRequest req)
|
||||||
|
{
|
||||||
|
if (sd->state != sd_transfer_state) {
|
||||||
|
return sd_invalid_state_for_cmd(sd, req);
|
||||||
|
}
|
||||||
|
if (req.arg > (1 << HWBLOCK_SHIFT)) {
|
||||||
|
sd->card_status |= BLOCK_LEN_ERROR;
|
||||||
|
} else {
|
||||||
|
trace_sdcard_set_blocklen(req.arg);
|
||||||
|
sd->blk_len = req.arg;
|
||||||
|
}
|
||||||
|
|
||||||
|
return sd_r1;
|
||||||
|
}
|
||||||
|
|
||||||
/* CMD19 */
|
/* CMD19 */
|
||||||
static sd_rsp_type_t sd_cmd_SEND_TUNING_BLOCK(SDState *sd, SDRequest req)
|
static sd_rsp_type_t sd_cmd_SEND_TUNING_BLOCK(SDState *sd, SDRequest req)
|
||||||
{
|
{
|
||||||
|
@ -1483,23 +1499,6 @@ static sd_rsp_type_t sd_normal_command(SDState *sd, SDRequest req)
|
||||||
|
|
||||||
switch (req.cmd) {
|
switch (req.cmd) {
|
||||||
/* Block read commands (Class 2) */
|
/* Block read commands (Class 2) */
|
||||||
case 16: /* CMD16: SET_BLOCKLEN */
|
|
||||||
switch (sd->state) {
|
|
||||||
case sd_transfer_state:
|
|
||||||
if (req.arg > (1 << HWBLOCK_SHIFT)) {
|
|
||||||
sd->card_status |= BLOCK_LEN_ERROR;
|
|
||||||
} else {
|
|
||||||
trace_sdcard_set_blocklen(req.arg);
|
|
||||||
sd->blk_len = req.arg;
|
|
||||||
}
|
|
||||||
|
|
||||||
return sd_r1;
|
|
||||||
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case 17: /* CMD17: READ_SINGLE_BLOCK */
|
case 17: /* CMD17: READ_SINGLE_BLOCK */
|
||||||
addr = sd_req_get_address(sd, req);
|
addr = sd_req_get_address(sd, req);
|
||||||
switch (sd->state) {
|
switch (sd->state) {
|
||||||
|
@ -2308,6 +2307,7 @@ static const SDProto sd_proto_spi = {
|
||||||
[10] = {0, sd_spi, "SEND_CID", spi_cmd_SEND_CID},
|
[10] = {0, sd_spi, "SEND_CID", spi_cmd_SEND_CID},
|
||||||
[12] = {0, sd_spi, "STOP_TRANSMISSION", sd_cmd_STOP_TRANSMISSION},
|
[12] = {0, sd_spi, "STOP_TRANSMISSION", sd_cmd_STOP_TRANSMISSION},
|
||||||
[13] = {0, sd_spi, "SEND_STATUS", sd_cmd_SEND_STATUS},
|
[13] = {0, sd_spi, "SEND_STATUS", sd_cmd_SEND_STATUS},
|
||||||
|
[16] = {2, sd_spi, "SET_BLOCKLEN", sd_cmd_SET_BLOCKLEN},
|
||||||
[34] = {10, sd_spi, "READ_SEC_CMD", sd_cmd_optional},
|
[34] = {10, sd_spi, "READ_SEC_CMD", sd_cmd_optional},
|
||||||
[35] = {10, sd_spi, "WRITE_SEC_CMD", sd_cmd_optional},
|
[35] = {10, sd_spi, "WRITE_SEC_CMD", sd_cmd_optional},
|
||||||
[36] = {10, sd_spi, "SEND_PSI", sd_cmd_optional},
|
[36] = {10, sd_spi, "SEND_PSI", sd_cmd_optional},
|
||||||
|
@ -2339,6 +2339,7 @@ static const SDProto sd_proto_sd = {
|
||||||
[12] = {0, sd_ac, "STOP_TRANSMISSION", sd_cmd_STOP_TRANSMISSION},
|
[12] = {0, sd_ac, "STOP_TRANSMISSION", sd_cmd_STOP_TRANSMISSION},
|
||||||
[13] = {0, sd_ac, "SEND_STATUS", sd_cmd_SEND_STATUS},
|
[13] = {0, sd_ac, "SEND_STATUS", sd_cmd_SEND_STATUS},
|
||||||
[15] = {0, sd_ac, "GO_INACTIVE_STATE", sd_cmd_GO_INACTIVE_STATE},
|
[15] = {0, sd_ac, "GO_INACTIVE_STATE", sd_cmd_GO_INACTIVE_STATE},
|
||||||
|
[16] = {2, sd_ac, "SET_BLOCKLEN", sd_cmd_SET_BLOCKLEN},
|
||||||
[19] = {2, sd_adtc, "SEND_TUNING_BLOCK", sd_cmd_SEND_TUNING_BLOCK},
|
[19] = {2, sd_adtc, "SEND_TUNING_BLOCK", sd_cmd_SEND_TUNING_BLOCK},
|
||||||
[20] = {2, sd_ac, "SPEED_CLASS_CONTROL", sd_cmd_optional},
|
[20] = {2, sd_ac, "SPEED_CLASS_CONTROL", sd_cmd_optional},
|
||||||
[23] = {2, sd_ac, "SET_BLOCK_COUNT", sd_cmd_SET_BLOCK_COUNT},
|
[23] = {2, sd_ac, "SET_BLOCK_COUNT", sd_cmd_SET_BLOCK_COUNT},
|
||||||
|
|
Loading…
Reference in New Issue