openkylin
/
qemu
mirror of https://gitee.com/openkylin/qemu.git
9
0
Fork 0
Code Issues Projects Releases Wiki Activity

hw/ide/atapi: Use the ldst API 

The big-endian load/store functions are already provided
by "qemu/bswap.h".
Avoid code duplication, use the generic API.

Signed-off-by: Philippe Mathieu-Daudé <philmd@redhat.com>
Message-id: 20190808130454.9930-1-philmd@redhat.com
Signed-off-by: John Snow <jsnow@redhat.com>
This commit is contained in:
Philippe Mathieu-Daudé 2019-08-08 15:04:54 +02:00 committed by John Snow
parent 8ec41c4265
commit 614ab7d127
1 changed files with 28 additions and 52 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

80
hw/ide/atapi.c
View File

@ -45,30 +45,6 @@ static void padstr8(uint8_t *buf, int buf_size, const char *src)
} }
} }
static inline void cpu_to_ube16(uint8_t *buf, int val)
{
buf[0] = val >> 8;
buf[1] = val & 0xff;
}
static inline void cpu_to_ube32(uint8_t *buf, unsigned int val)
{
buf[0] = val >> 24;
buf[1] = val >> 16;
buf[2] = val >> 8;
buf[3] = val & 0xff;
}
static inline int ube16_to_cpu(const uint8_t *buf)
{
return (buf[0] << 8) | buf[1];
}
static inline int ube32_to_cpu(const uint8_t *buf)
{
return (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
}
static void lba_to_msf(uint8_t *buf, int lba) static void lba_to_msf(uint8_t *buf, int lba)
{ {
lba += 150; lba += 150;
@ -485,7 +461,7 @@ static inline uint8_t ide_atapi_set_profile(uint8_t *buf, uint8_t *index,
uint8_t *buf_profile = buf + 12; /* start of profiles */ uint8_t *buf_profile = buf + 12; /* start of profiles */
buf_profile += ((*index) * 4); /* start of indexed profile */ buf_profile += ((*index) * 4); /* start of indexed profile */
cpu_to_ube16 (buf_profile, profile); stw_be_p(buf_profile, profile);
buf_profile[2] = ((buf_profile[0] == buf[6]) && (buf_profile[1] == buf[7])); buf_profile[2] = ((buf_profile[0] == buf[6]) && (buf_profile[1] == buf[7]));
/* each profile adds 4 bytes to the response */ /* each profile adds 4 bytes to the response */
@ -518,9 +494,9 @@ static int ide_dvd_read_structure(IDEState *s, int format,
buf[7] = 0; /* default densities */ buf[7] = 0; /* default densities */
/* FIXME: 0x30000 per spec? */ /* FIXME: 0x30000 per spec? */
cpu_to_ube32(buf + 8, 0); /* start sector */ stl_be_p(buf + 8, 0); /* start sector */
cpu_to_ube32(buf + 12, total_sectors - 1); /* end sector */ stl_be_p(buf + 12, total_sectors - 1); /* end sector */
cpu_to_ube32(buf + 16, total_sectors - 1); /* l0 end sector */ stl_be_p(buf + 16, total_sectors - 1); /* l0 end sector */
/* Size of buffer, not including 2 byte size field */ /* Size of buffer, not including 2 byte size field */
stw_be_p(buf, 2048 + 2); stw_be_p(buf, 2048 + 2);
@ -839,7 +815,7 @@ static void cmd_get_configuration(IDEState *s, uint8_t *buf)
} }
/* XXX: could result in alignment problems in some architectures */ /* XXX: could result in alignment problems in some architectures */
max_len = ube16_to_cpu(buf + 7); max_len = lduw_be_p(buf + 7);
/* /*
* XXX: avoid overflow for io_buffer if max_len is bigger than * XXX: avoid overflow for io_buffer if max_len is bigger than
@ -859,16 +835,16 @@ static void cmd_get_configuration(IDEState *s, uint8_t *buf)
* to use as current. 0 means there is no media * to use as current. 0 means there is no media
*/ */
if (media_is_dvd(s)) { if (media_is_dvd(s)) {
cpu_to_ube16(buf + 6, MMC_PROFILE_DVD_ROM); stw_be_p(buf + 6, MMC_PROFILE_DVD_ROM);
} else if (media_is_cd(s)) { } else if (media_is_cd(s)) {
cpu_to_ube16(buf + 6, MMC_PROFILE_CD_ROM); stw_be_p(buf + 6, MMC_PROFILE_CD_ROM);
} }
buf[10] = 0x02 | 0x01; /* persistent and current */ buf[10] = 0x02 | 0x01; /* persistent and current */
len = 12; /* headers: 8 + 4 */ len = 12; /* headers: 8 + 4 */
len += ide_atapi_set_profile(buf, &index, MMC_PROFILE_DVD_ROM); len += ide_atapi_set_profile(buf, &index, MMC_PROFILE_DVD_ROM);
len += ide_atapi_set_profile(buf, &index, MMC_PROFILE_CD_ROM); len += ide_atapi_set_profile(buf, &index, MMC_PROFILE_CD_ROM);
cpu_to_ube32(buf, len - 4); /* data length */ stl_be_p(buf, len - 4); /* data length */
ide_atapi_cmd_reply(s, len, max_len); ide_atapi_cmd_reply(s, len, max_len);
} }
@ -878,7 +854,7 @@ static void cmd_mode_sense(IDEState *s, uint8_t *buf)
int action, code; int action, code;
int max_len; int max_len;
max_len = ube16_to_cpu(buf + 7); max_len = lduw_be_p(buf + 7);
action = buf[2] >> 6; action = buf[2] >> 6;
code = buf[2] & 0x3f; code = buf[2] & 0x3f;
@ -886,7 +862,7 @@ static void cmd_mode_sense(IDEState *s, uint8_t *buf)
case 0: /* current values */ case 0: /* current values */
switch(code) { switch(code) {
case MODE_PAGE_R_W_ERROR: /* error recovery */ case MODE_PAGE_R_W_ERROR: /* error recovery */
cpu_to_ube16(&buf[0], 16 - 2); stw_be_p(&buf[0], 16 - 2);
buf[2] = 0x70; buf[2] = 0x70;
buf[3] = 0; buf[3] = 0;
buf[4] = 0; buf[4] = 0;
@ -905,7 +881,7 @@ static void cmd_mode_sense(IDEState *s, uint8_t *buf)
ide_atapi_cmd_reply(s, 16, max_len); ide_atapi_cmd_reply(s, 16, max_len);
break; break;
case MODE_PAGE_AUDIO_CTL: case MODE_PAGE_AUDIO_CTL:
cpu_to_ube16(&buf[0], 24 - 2); stw_be_p(&buf[0], 24 - 2);
buf[2] = 0x70; buf[2] = 0x70;
buf[3] = 0; buf[3] = 0;
buf[4] = 0; buf[4] = 0;
@ -924,7 +900,7 @@ static void cmd_mode_sense(IDEState *s, uint8_t *buf)
ide_atapi_cmd_reply(s, 24, max_len); ide_atapi_cmd_reply(s, 24, max_len);
break; break;
case MODE_PAGE_CAPABILITIES: case MODE_PAGE_CAPABILITIES:
cpu_to_ube16(&buf[0], 30 - 2); stw_be_p(&buf[0], 30 - 2);
buf[2] = 0x70; buf[2] = 0x70;
buf[3] = 0; buf[3] = 0;
buf[4] = 0; buf[4] = 0;
@ -946,11 +922,11 @@ static void cmd_mode_sense(IDEState *s, uint8_t *buf)
buf[14] |= 1 << 1; buf[14] |= 1 << 1;
} }
buf[15] = 0x00; /* No volume & mute control, no changer */ buf[15] = 0x00; /* No volume & mute control, no changer */
cpu_to_ube16(&buf[16], 704); /* 4x read speed */ stw_be_p(&buf[16], 704); /* 4x read speed */
buf[18] = 0; /* Two volume levels */ buf[18] = 0; /* Two volume levels */
buf[19] = 2; buf[19] = 2;
cpu_to_ube16(&buf[20], 512); /* 512k buffer */ stw_be_p(&buf[20], 512); /* 512k buffer */
cpu_to_ube16(&buf[22], 704); /* 4x read speed current */ stw_be_p(&buf[22], 704); /* 4x read speed current */
buf[24] = 0; buf[24] = 0;
buf[25] = 0; buf[25] = 0;
buf[26] = 0; buf[26] = 0;
@ -998,12 +974,12 @@ static void cmd_read(IDEState *s, uint8_t* buf)
int nb_sectors, lba; int nb_sectors, lba;
if (buf[0] == GPCMD_READ_10) { if (buf[0] == GPCMD_READ_10) {
nb_sectors = ube16_to_cpu(buf + 7); nb_sectors = lduw_be_p(buf + 7);
} else { } else {
nb_sectors = ube32_to_cpu(buf + 6); nb_sectors = ldl_be_p(buf + 6);
} }
lba = ube32_to_cpu(buf + 2); lba = ldl_be_p(buf + 2);
if (nb_sectors == 0) { if (nb_sectors == 0) {
ide_atapi_cmd_ok(s); ide_atapi_cmd_ok(s);
return; return;
@ -1017,7 +993,7 @@ static void cmd_read_cd(IDEState *s, uint8_t* buf)
int nb_sectors, lba, transfer_request; int nb_sectors, lba, transfer_request;
nb_sectors = (buf[6] << 16) | (buf[7] << 8) | buf[8]; nb_sectors = (buf[6] << 16) | (buf[7] << 8) | buf[8];
lba = ube32_to_cpu(buf + 2); lba = ldl_be_p(buf + 2);
if (nb_sectors == 0) { if (nb_sectors == 0) {
ide_atapi_cmd_ok(s); ide_atapi_cmd_ok(s);
@ -1057,7 +1033,7 @@ static void cmd_seek(IDEState *s, uint8_t* buf)
unsigned int lba; unsigned int lba;
uint64_t total_sectors = s->nb_sectors >> 2; uint64_t total_sectors = s->nb_sectors >> 2;
lba = ube32_to_cpu(buf + 2); lba = ldl_be_p(buf + 2);
if (lba >= total_sectors) { if (lba >= total_sectors) {
ide_atapi_cmd_error(s, ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR); ide_atapi_cmd_error(s, ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR);
return; return;
@ -1098,15 +1074,15 @@ static void cmd_start_stop_unit(IDEState *s, uint8_t* buf)
static void cmd_mechanism_status(IDEState *s, uint8_t* buf) static void cmd_mechanism_status(IDEState *s, uint8_t* buf)
{ {
int max_len = ube16_to_cpu(buf + 8); int max_len = lduw_be_p(buf + 8);
cpu_to_ube16(buf, 0); stw_be_p(buf, 0);
/* no current LBA */ /* no current LBA */
buf[2] = 0; buf[2] = 0;
buf[3] = 0; buf[3] = 0;
buf[4] = 0; buf[4] = 0;
buf[5] = 1; buf[5] = 1;
cpu_to_ube16(buf + 6, 0); stw_be_p(buf + 6, 0);
ide_atapi_cmd_reply(s, 8, max_len); ide_atapi_cmd_reply(s, 8, max_len);
} }
@ -1116,7 +1092,7 @@ static void cmd_read_toc_pma_atip(IDEState *s, uint8_t* buf)
int max_len; int max_len;
uint64_t total_sectors = s->nb_sectors >> 2; uint64_t total_sectors = s->nb_sectors >> 2;
max_len = ube16_to_cpu(buf + 7); max_len = lduw_be_p(buf + 7);
format = buf[9] >> 6; format = buf[9] >> 6;
msf = (buf[1] >> 1) & 1; msf = (buf[1] >> 1) & 1;
start_track = buf[6]; start_track = buf[6];
@ -1154,15 +1130,15 @@ static void cmd_read_cdvd_capacity(IDEState *s, uint8_t* buf)
uint64_t total_sectors = s->nb_sectors >> 2; uint64_t total_sectors = s->nb_sectors >> 2;
/* NOTE: it is really the number of sectors minus 1 */ /* NOTE: it is really the number of sectors minus 1 */
cpu_to_ube32(buf, total_sectors - 1); stl_be_p(buf, total_sectors - 1);
cpu_to_ube32(buf + 4, 2048); stl_be_p(buf + 4, 2048);
ide_atapi_cmd_reply(s, 8, 8); ide_atapi_cmd_reply(s, 8, 8);
} }
static void cmd_read_disc_information(IDEState *s, uint8_t* buf) static void cmd_read_disc_information(IDEState *s, uint8_t* buf)
{ {
uint8_t type = buf[1] & 7; uint8_t type = buf[1] & 7;
uint32_t max_len = ube16_to_cpu(buf + 7); uint32_t max_len = lduw_be_p(buf + 7);
/* Types 1/2 are only defined for Blu-Ray. */ /* Types 1/2 are only defined for Blu-Ray. */
if (type != 0) { if (type != 0) {
@ -1196,7 +1172,7 @@ static void cmd_read_dvd_structure(IDEState *s, uint8_t* buf)
int format = buf[7]; int format = buf[7];
int ret; int ret;
max_len = ube16_to_cpu(buf + 8); max_len = lduw_be_p(buf + 8);
if (format < 0xff) { if (format < 0xff) {
if (media_is_cd(s)) { if (media_is_cd(s)) {