motorhead/qemu
1
0
Fork 0
mirror of https://github.com/Motorhead1991/qemu.git synced 2025-09-09 00:07:57 -06:00
Code Issues Projects Releases Packages Wiki Activity Actions

esp: introduce esp_pdma_read() and esp_pdma_write() functions

Browse source 
Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk>
Reviewed-by: Laurent Vivier <laurent@vivier.eu>
Message-Id: <20210304221103.6369-16-mark.cave-ayland@ilande.co.uk>
This commit is contained in:
Mark Cave-Ayland 2021-03-04 22:10:36 +00:00
parent b76624de50
commit 761bef75dd
1 changed files with 20 additions and 8 deletions
Download patch file Download diff file Expand all files Collapse all files

28
hw/scsi/esp.c
View file

@ -151,6 +151,20 @@ static uint8_t *get_pdma_buf(ESPState *s)
return NULL; return NULL;
} }
static uint8_t esp_pdma_read(ESPState *s)
{
uint8_t *buf = get_pdma_buf(s);
return buf[s->pdma_cur++];
}
static void esp_pdma_write(ESPState *s, uint8_t val)
{
uint8_t *buf = get_pdma_buf(s);
buf[s->pdma_cur++] = val;
}
static int get_cmd_cb(ESPState *s) static int get_cmd_cb(ESPState *s)
{ {
int target; int target;
@ -909,7 +923,6 @@ static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
SysBusESPState *sysbus = opaque; SysBusESPState *sysbus = opaque;
ESPState *s = ESP(&sysbus->esp); ESPState *s = ESP(&sysbus->esp);
uint32_t dmalen = esp_get_tc(s); uint32_t dmalen = esp_get_tc(s);
uint8_t *buf = get_pdma_buf(s);
trace_esp_pdma_write(size); trace_esp_pdma_write(size);
@ -918,13 +931,13 @@ static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
} }
switch (size) { switch (size) {
case 1: case 1:
buf[s->pdma_cur++] = val; esp_pdma_write(s, val);
s->pdma_len--; s->pdma_len--;
dmalen--; dmalen--;
break; break;
case 2: case 2:
buf[s->pdma_cur++] = val >> 8; esp_pdma_write(s, val >> 8);
buf[s->pdma_cur++] = val; esp_pdma_write(s, val);
s->pdma_len -= 2; s->pdma_len -= 2;
dmalen -= 2; dmalen -= 2;
break; break;
@ -943,7 +956,6 @@ static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
SysBusESPState *sysbus = opaque; SysBusESPState *sysbus = opaque;
ESPState *s = ESP(&sysbus->esp); ESPState *s = ESP(&sysbus->esp);
uint32_t dmalen = esp_get_tc(s); uint32_t dmalen = esp_get_tc(s);
uint8_t *buf = get_pdma_buf(s);
uint64_t val = 0; uint64_t val = 0;
trace_esp_pdma_read(size); trace_esp_pdma_read(size);
@ -953,13 +965,13 @@ static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
} }
switch (size) { switch (size) {
case 1: case 1:
val = buf[s->pdma_cur++]; val = esp_pdma_read(s);
s->pdma_len--; s->pdma_len--;
dmalen--; dmalen--;
break; break;
case 2: case 2:
val = buf[s->pdma_cur++]; val = esp_pdma_read(s);
val = (val << 8) | buf[s->pdma_cur++]; val = (val << 8) | esp_pdma_read(s);
s->pdma_len -= 2; s->pdma_len -= 2;
dmalen -= 2; dmalen -= 2;
break; break;