hw/sd/sdcard: Factor sd_req_get_address() method out
Extract sd_cmd_get_address() so we can re-use it in various SDProto handlers. Use CARD_CAPACITY and HWBLOCK_SHIFT definitions instead of magic values. Signed-off-by: Philippe Mathieu-Daudé <philmd@linaro.org> Reviewed-by: Cédric Le Goater <clg@redhat.com> Tested-by: Cédric Le Goater <clg@redhat.com> Message-Id: <20240621080554.18986-17-philmd@linaro.org>
This commit is contained in:
parent
4a829730c8
commit
8b91a5613c
10
hw/sd/sd.c
10
hw/sd/sd.c
@ -582,6 +582,14 @@ static void sd_response_r7_make(SDState *sd, uint8_t *response)
|
||||
stl_be_p(response, sd->vhs);
|
||||
}
|
||||
|
||||
static uint64_t sd_req_get_address(SDState *sd, SDRequest req)
|
||||
{
|
||||
if (FIELD_EX32(sd->ocr, OCR, CARD_CAPACITY)) {
|
||||
return (uint64_t) req.arg << HWBLOCK_SHIFT;
|
||||
}
|
||||
return req.arg;
|
||||
}
|
||||
|
||||
static inline uint64_t sd_addr_to_wpnum(uint64_t addr)
|
||||
{
|
||||
return addr >> (HWBLOCK_SHIFT + SECTOR_SHIFT + WPGROUP_SHIFT);
|
||||
@ -1106,7 +1114,7 @@ static sd_rsp_type_t sd_cmd_SET_BLOCK_COUNT(SDState *sd, SDRequest req)
|
||||
static sd_rsp_type_t sd_normal_command(SDState *sd, SDRequest req)
|
||||
{
|
||||
uint16_t rca;
|
||||
uint64_t addr = (sd->ocr & (1 << 30)) ? (uint64_t) req.arg << 9 : req.arg;
|
||||
uint64_t addr = sd_req_get_address(sd, req);
|
||||
|
||||
/* CMD55 precedes an ACMD, so we are not interested in tracing it.
|
||||
* However there is no ACMD55, so we want to trace this particular case.
|
||||
|
Loading…
Reference in New Issue
Block a user