esp.c: move esp_select() to ESP selection commands from get_cmd()
Since the DREQ value depends upon the result of the selection process, add a workaround to each esp_select() to manually assert DREQ durring the MESSAGE OUT and COMMAND phases. 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-6-mark.cave-ayland@ilande.co.uk> Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk>
This commit is contained in:
parent
6fcae98b2c
commit
1bcaf71b41
@ -263,10 +263,6 @@ static uint32_t get_cmd(ESPState *s, uint32_t maxlen)
|
|||||||
dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen);
|
dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen);
|
||||||
fifo8_push_all(&s->cmdfifo, buf, dmalen);
|
fifo8_push_all(&s->cmdfifo, buf, dmalen);
|
||||||
} else {
|
} else {
|
||||||
if (esp_select(s) < 0) {
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
esp_raise_drq(s);
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
@ -280,9 +276,6 @@ static uint32_t get_cmd(ESPState *s, uint32_t maxlen)
|
|||||||
}
|
}
|
||||||
trace_esp_get_cmd(dmalen, target);
|
trace_esp_get_cmd(dmalen, target);
|
||||||
|
|
||||||
if (esp_select(s) < 0) {
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
return dmalen;
|
return dmalen;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -380,12 +373,18 @@ static void handle_satn(ESPState *s)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
esp_set_pdma_cb(s, SATN_PDMA_CB);
|
esp_set_pdma_cb(s, SATN_PDMA_CB);
|
||||||
|
if (esp_select(s) < 0) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
|
cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
|
||||||
if (cmdlen > 0) {
|
if (cmdlen > 0) {
|
||||||
s->cmdfifo_cdb_offset = 1;
|
s->cmdfifo_cdb_offset = 1;
|
||||||
s->do_cmd = 0;
|
s->do_cmd = 0;
|
||||||
do_cmd(s);
|
do_cmd(s);
|
||||||
} else if (cmdlen == 0) {
|
} else if (cmdlen == 0) {
|
||||||
|
if (s->dma) {
|
||||||
|
esp_raise_drq(s);
|
||||||
|
}
|
||||||
s->do_cmd = 1;
|
s->do_cmd = 1;
|
||||||
/* Target present, but no cmd yet - switch to command phase */
|
/* Target present, but no cmd yet - switch to command phase */
|
||||||
s->rregs[ESP_RSEQ] = SEQ_CD;
|
s->rregs[ESP_RSEQ] = SEQ_CD;
|
||||||
@ -411,12 +410,18 @@ static void handle_s_without_atn(ESPState *s)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
esp_set_pdma_cb(s, S_WITHOUT_SATN_PDMA_CB);
|
esp_set_pdma_cb(s, S_WITHOUT_SATN_PDMA_CB);
|
||||||
|
if (esp_select(s) < 0) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
|
cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
|
||||||
if (cmdlen > 0) {
|
if (cmdlen > 0) {
|
||||||
s->cmdfifo_cdb_offset = 0;
|
s->cmdfifo_cdb_offset = 0;
|
||||||
s->do_cmd = 0;
|
s->do_cmd = 0;
|
||||||
do_cmd(s);
|
do_cmd(s);
|
||||||
} else if (cmdlen == 0) {
|
} else if (cmdlen == 0) {
|
||||||
|
if (s->dma) {
|
||||||
|
esp_raise_drq(s);
|
||||||
|
}
|
||||||
s->do_cmd = 1;
|
s->do_cmd = 1;
|
||||||
/* Target present, but no cmd yet - switch to command phase */
|
/* Target present, but no cmd yet - switch to command phase */
|
||||||
s->rregs[ESP_RSEQ] = SEQ_CD;
|
s->rregs[ESP_RSEQ] = SEQ_CD;
|
||||||
@ -446,6 +451,9 @@ static void handle_satn_stop(ESPState *s)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
esp_set_pdma_cb(s, SATN_STOP_PDMA_CB);
|
esp_set_pdma_cb(s, SATN_STOP_PDMA_CB);
|
||||||
|
if (esp_select(s) < 0) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
cmdlen = get_cmd(s, 1);
|
cmdlen = get_cmd(s, 1);
|
||||||
if (cmdlen > 0) {
|
if (cmdlen > 0) {
|
||||||
trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
|
trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
|
||||||
@ -456,6 +464,9 @@ static void handle_satn_stop(ESPState *s)
|
|||||||
s->rregs[ESP_RSEQ] = SEQ_MO;
|
s->rregs[ESP_RSEQ] = SEQ_MO;
|
||||||
esp_raise_irq(s);
|
esp_raise_irq(s);
|
||||||
} else if (cmdlen == 0) {
|
} else if (cmdlen == 0) {
|
||||||
|
if (s->dma) {
|
||||||
|
esp_raise_drq(s);
|
||||||
|
}
|
||||||
s->do_cmd = 1;
|
s->do_cmd = 1;
|
||||||
/* Target present, switch to message out phase */
|
/* Target present, switch to message out phase */
|
||||||
s->rregs[ESP_RSEQ] = SEQ_MO;
|
s->rregs[ESP_RSEQ] = SEQ_MO;
|
||||||
|
Loading…
Reference in New Issue
Block a user