mirror of https://github.com/xemu-project/xemu.git
esp.c: move CMD_ICCS command logic to esp_do_dma()
The special logic in write_response_pdma_cb() is now no longer required since esp_do_dma() can be used as a direct replacement. Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk> Tested-by: Helge Deller <deller@gmx.de> Tested-by: Thomas Huth <thuth@redhat.com> Message-Id: <20240112125420.514425-55-mark.cave-ayland@ilande.co.uk> Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk>
This commit is contained in:
parent
bb272e245b
commit
8baa14728b
|
@ -446,40 +446,23 @@ static void handle_satn_stop(ESPState *s)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void write_response_pdma_cb(ESPState *s)
|
|
||||||
{
|
|
||||||
esp_set_phase(s, STAT_ST);
|
|
||||||
s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
|
|
||||||
s->rregs[ESP_RSEQ] = SEQ_CD;
|
|
||||||
esp_raise_irq(s);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void write_response(ESPState *s)
|
static void write_response(ESPState *s)
|
||||||
{
|
{
|
||||||
uint8_t buf[2];
|
uint8_t buf[2];
|
||||||
|
|
||||||
trace_esp_write_response(s->status);
|
trace_esp_write_response(s->status);
|
||||||
|
|
||||||
buf[0] = s->status;
|
|
||||||
buf[1] = 0;
|
|
||||||
|
|
||||||
if (s->dma) {
|
if (s->dma) {
|
||||||
if (s->dma_memory_write) {
|
esp_do_dma(s);
|
||||||
s->dma_memory_write(s->dma_opaque, buf, 2);
|
|
||||||
esp_set_phase(s, STAT_ST);
|
|
||||||
s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
|
|
||||||
s->rregs[ESP_RSEQ] = SEQ_CD;
|
|
||||||
} else {
|
|
||||||
esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB);
|
|
||||||
esp_raise_drq(s);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
} else {
|
} else {
|
||||||
|
buf[0] = s->status;
|
||||||
|
buf[1] = 0;
|
||||||
|
|
||||||
fifo8_reset(&s->fifo);
|
fifo8_reset(&s->fifo);
|
||||||
fifo8_push_all(&s->fifo, buf, 2);
|
fifo8_push_all(&s->fifo, buf, 2);
|
||||||
s->rregs[ESP_RFLAGS] = 2;
|
s->rregs[ESP_RFLAGS] = 2;
|
||||||
|
esp_raise_irq(s);
|
||||||
}
|
}
|
||||||
esp_raise_irq(s);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void esp_dma_ti_check(ESPState *s)
|
static void esp_dma_ti_check(ESPState *s)
|
||||||
|
@ -673,6 +656,58 @@ static void esp_do_dma(ESPState *s)
|
||||||
esp_dma_ti_check(s);
|
esp_dma_ti_check(s);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case STAT_ST:
|
||||||
|
switch (s->rregs[ESP_CMD]) {
|
||||||
|
case CMD_ICCS | CMD_DMA:
|
||||||
|
len = MIN(len, 1);
|
||||||
|
|
||||||
|
if (len) {
|
||||||
|
buf[0] = s->status;
|
||||||
|
|
||||||
|
if (s->dma_memory_write) {
|
||||||
|
s->dma_memory_write(s->dma_opaque, buf, len);
|
||||||
|
esp_set_tc(s, esp_get_tc(s) - len);
|
||||||
|
} else {
|
||||||
|
fifo8_push_all(&s->fifo, buf, len);
|
||||||
|
esp_set_tc(s, esp_get_tc(s) - len);
|
||||||
|
}
|
||||||
|
|
||||||
|
esp_set_phase(s, STAT_MI);
|
||||||
|
|
||||||
|
if (esp_get_tc(s) > 0) {
|
||||||
|
/* Process any message in phase data */
|
||||||
|
esp_do_dma(s);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case STAT_MI:
|
||||||
|
switch (s->rregs[ESP_CMD]) {
|
||||||
|
case CMD_ICCS | CMD_DMA:
|
||||||
|
len = MIN(len, 1);
|
||||||
|
|
||||||
|
if (len) {
|
||||||
|
buf[0] = 0;
|
||||||
|
|
||||||
|
if (s->dma_memory_write) {
|
||||||
|
s->dma_memory_write(s->dma_opaque, buf, len);
|
||||||
|
esp_set_tc(s, esp_get_tc(s) - len);
|
||||||
|
} else {
|
||||||
|
fifo8_push_all(&s->fifo, buf, len);
|
||||||
|
esp_set_tc(s, esp_get_tc(s) - len);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Raise end of command interrupt */
|
||||||
|
s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
|
||||||
|
s->rregs[ESP_RSEQ] = SEQ_CD;
|
||||||
|
esp_raise_irq(s);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -773,9 +808,6 @@ static void esp_do_nodma(ESPState *s)
|
||||||
static void esp_pdma_cb(ESPState *s)
|
static void esp_pdma_cb(ESPState *s)
|
||||||
{
|
{
|
||||||
switch (s->pdma_cb) {
|
switch (s->pdma_cb) {
|
||||||
case WRITE_RESPONSE_PDMA_CB:
|
|
||||||
write_response_pdma_cb(s);
|
|
||||||
break;
|
|
||||||
case DO_DMA_PDMA_CB:
|
case DO_DMA_PDMA_CB:
|
||||||
esp_do_dma(s);
|
esp_do_dma(s);
|
||||||
break;
|
break;
|
||||||
|
|
|
@ -152,7 +152,6 @@ struct SysBusESPState {
|
||||||
|
|
||||||
/* PDMA callbacks */
|
/* PDMA callbacks */
|
||||||
enum pdma_cb {
|
enum pdma_cb {
|
||||||
WRITE_RESPONSE_PDMA_CB = 3,
|
|
||||||
DO_DMA_PDMA_CB = 4
|
DO_DMA_PDMA_CB = 4
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue