xref: /qemu/hw/scsi/esp.c (revision 3c7f3c8b)
149ab747fSPaolo Bonzini /*
249ab747fSPaolo Bonzini  * QEMU ESP/NCR53C9x emulation
349ab747fSPaolo Bonzini  *
449ab747fSPaolo Bonzini  * Copyright (c) 2005-2006 Fabrice Bellard
549ab747fSPaolo Bonzini  * Copyright (c) 2012 Herve Poussineau
649ab747fSPaolo Bonzini  *
749ab747fSPaolo Bonzini  * Permission is hereby granted, free of charge, to any person obtaining a copy
849ab747fSPaolo Bonzini  * of this software and associated documentation files (the "Software"), to deal
949ab747fSPaolo Bonzini  * in the Software without restriction, including without limitation the rights
1049ab747fSPaolo Bonzini  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
1149ab747fSPaolo Bonzini  * copies of the Software, and to permit persons to whom the Software is
1249ab747fSPaolo Bonzini  * furnished to do so, subject to the following conditions:
1349ab747fSPaolo Bonzini  *
1449ab747fSPaolo Bonzini  * The above copyright notice and this permission notice shall be included in
1549ab747fSPaolo Bonzini  * all copies or substantial portions of the Software.
1649ab747fSPaolo Bonzini  *
1749ab747fSPaolo Bonzini  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
1849ab747fSPaolo Bonzini  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
1949ab747fSPaolo Bonzini  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
2049ab747fSPaolo Bonzini  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
2149ab747fSPaolo Bonzini  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
2249ab747fSPaolo Bonzini  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
2349ab747fSPaolo Bonzini  * THE SOFTWARE.
2449ab747fSPaolo Bonzini  */
2549ab747fSPaolo Bonzini 
26a4ab4792SPeter Maydell #include "qemu/osdep.h"
2749ab747fSPaolo Bonzini #include "hw/sysbus.h"
28d6454270SMarkus Armbruster #include "migration/vmstate.h"
2964552b6bSMarkus Armbruster #include "hw/irq.h"
3049ab747fSPaolo Bonzini #include "hw/scsi/esp.h"
3149ab747fSPaolo Bonzini #include "trace.h"
3249ab747fSPaolo Bonzini #include "qemu/log.h"
330b8fa32fSMarkus Armbruster #include "qemu/module.h"
3449ab747fSPaolo Bonzini 
3549ab747fSPaolo Bonzini /*
3649ab747fSPaolo Bonzini  * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O),
3749ab747fSPaolo Bonzini  * also produced as NCR89C100. See
3849ab747fSPaolo Bonzini  * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt
3949ab747fSPaolo Bonzini  * and
4049ab747fSPaolo Bonzini  * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt
4174d71ea1SLaurent Vivier  *
4274d71ea1SLaurent Vivier  * On Macintosh Quadra it is a NCR53C96.
4349ab747fSPaolo Bonzini  */
4449ab747fSPaolo Bonzini 
4549ab747fSPaolo Bonzini static void esp_raise_irq(ESPState *s)
4649ab747fSPaolo Bonzini {
4749ab747fSPaolo Bonzini     if (!(s->rregs[ESP_RSTAT] & STAT_INT)) {
4849ab747fSPaolo Bonzini         s->rregs[ESP_RSTAT] |= STAT_INT;
4949ab747fSPaolo Bonzini         qemu_irq_raise(s->irq);
5049ab747fSPaolo Bonzini         trace_esp_raise_irq();
5149ab747fSPaolo Bonzini     }
5249ab747fSPaolo Bonzini }
5349ab747fSPaolo Bonzini 
5449ab747fSPaolo Bonzini static void esp_lower_irq(ESPState *s)
5549ab747fSPaolo Bonzini {
5649ab747fSPaolo Bonzini     if (s->rregs[ESP_RSTAT] & STAT_INT) {
5749ab747fSPaolo Bonzini         s->rregs[ESP_RSTAT] &= ~STAT_INT;
5849ab747fSPaolo Bonzini         qemu_irq_lower(s->irq);
5949ab747fSPaolo Bonzini         trace_esp_lower_irq();
6049ab747fSPaolo Bonzini     }
6149ab747fSPaolo Bonzini }
6249ab747fSPaolo Bonzini 
6374d71ea1SLaurent Vivier static void esp_raise_drq(ESPState *s)
6474d71ea1SLaurent Vivier {
6574d71ea1SLaurent Vivier     qemu_irq_raise(s->irq_data);
66960ebfd9SMark Cave-Ayland     trace_esp_raise_drq();
6774d71ea1SLaurent Vivier }
6874d71ea1SLaurent Vivier 
6974d71ea1SLaurent Vivier static void esp_lower_drq(ESPState *s)
7074d71ea1SLaurent Vivier {
7174d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
72960ebfd9SMark Cave-Ayland     trace_esp_lower_drq();
7374d71ea1SLaurent Vivier }
7474d71ea1SLaurent Vivier 
7549ab747fSPaolo Bonzini void esp_dma_enable(ESPState *s, int irq, int level)
7649ab747fSPaolo Bonzini {
7749ab747fSPaolo Bonzini     if (level) {
7849ab747fSPaolo Bonzini         s->dma_enabled = 1;
7949ab747fSPaolo Bonzini         trace_esp_dma_enable();
8049ab747fSPaolo Bonzini         if (s->dma_cb) {
8149ab747fSPaolo Bonzini             s->dma_cb(s);
8249ab747fSPaolo Bonzini             s->dma_cb = NULL;
8349ab747fSPaolo Bonzini         }
8449ab747fSPaolo Bonzini     } else {
8549ab747fSPaolo Bonzini         trace_esp_dma_disable();
8649ab747fSPaolo Bonzini         s->dma_enabled = 0;
8749ab747fSPaolo Bonzini     }
8849ab747fSPaolo Bonzini }
8949ab747fSPaolo Bonzini 
9049ab747fSPaolo Bonzini void esp_request_cancelled(SCSIRequest *req)
9149ab747fSPaolo Bonzini {
9249ab747fSPaolo Bonzini     ESPState *s = req->hba_private;
9349ab747fSPaolo Bonzini 
9449ab747fSPaolo Bonzini     if (req == s->current_req) {
9549ab747fSPaolo Bonzini         scsi_req_unref(s->current_req);
9649ab747fSPaolo Bonzini         s->current_req = NULL;
9749ab747fSPaolo Bonzini         s->current_dev = NULL;
98324c8809SMark Cave-Ayland         s->async_len = 0;
9949ab747fSPaolo Bonzini     }
10049ab747fSPaolo Bonzini }
10149ab747fSPaolo Bonzini 
102e5455b8cSMark Cave-Ayland static void esp_fifo_push(Fifo8 *fifo, uint8_t val)
103042879fcSMark Cave-Ayland {
104e5455b8cSMark Cave-Ayland     if (fifo8_num_used(fifo) == fifo->capacity) {
105042879fcSMark Cave-Ayland         trace_esp_error_fifo_overrun();
106042879fcSMark Cave-Ayland         return;
107042879fcSMark Cave-Ayland     }
108042879fcSMark Cave-Ayland 
109e5455b8cSMark Cave-Ayland     fifo8_push(fifo, val);
110042879fcSMark Cave-Ayland }
111c5fef911SMark Cave-Ayland 
112c5fef911SMark Cave-Ayland static uint8_t esp_fifo_pop(Fifo8 *fifo)
113042879fcSMark Cave-Ayland {
114c5fef911SMark Cave-Ayland     if (fifo8_is_empty(fifo)) {
115042879fcSMark Cave-Ayland         return 0;
116042879fcSMark Cave-Ayland     }
117042879fcSMark Cave-Ayland 
118c5fef911SMark Cave-Ayland     return fifo8_pop(fifo);
119023666daSMark Cave-Ayland }
120023666daSMark Cave-Ayland 
1217b320a8eSMark Cave-Ayland static uint32_t esp_fifo_pop_buf(Fifo8 *fifo, uint8_t *dest, int maxlen)
1227b320a8eSMark Cave-Ayland {
1237b320a8eSMark Cave-Ayland     const uint8_t *buf;
12449c60d16SMark Cave-Ayland     uint32_t n, n2;
12549c60d16SMark Cave-Ayland     int len;
1267b320a8eSMark Cave-Ayland 
1277b320a8eSMark Cave-Ayland     if (maxlen == 0) {
1287b320a8eSMark Cave-Ayland         return 0;
1297b320a8eSMark Cave-Ayland     }
1307b320a8eSMark Cave-Ayland 
13149c60d16SMark Cave-Ayland     len = maxlen;
13249c60d16SMark Cave-Ayland     buf = fifo8_pop_buf(fifo, len, &n);
1337b320a8eSMark Cave-Ayland     if (dest) {
1347b320a8eSMark Cave-Ayland         memcpy(dest, buf, n);
1357b320a8eSMark Cave-Ayland     }
1367b320a8eSMark Cave-Ayland 
13749c60d16SMark Cave-Ayland     /* Add FIFO wraparound if needed */
13849c60d16SMark Cave-Ayland     len -= n;
13949c60d16SMark Cave-Ayland     len = MIN(len, fifo8_num_used(fifo));
14049c60d16SMark Cave-Ayland     if (len) {
14149c60d16SMark Cave-Ayland         buf = fifo8_pop_buf(fifo, len, &n2);
14249c60d16SMark Cave-Ayland         if (dest) {
14349c60d16SMark Cave-Ayland             memcpy(&dest[n], buf, n2);
14449c60d16SMark Cave-Ayland         }
14549c60d16SMark Cave-Ayland         n += n2;
14649c60d16SMark Cave-Ayland     }
14749c60d16SMark Cave-Ayland 
1487b320a8eSMark Cave-Ayland     return n;
1497b320a8eSMark Cave-Ayland }
1507b320a8eSMark Cave-Ayland 
151c47b5835SMark Cave-Ayland static uint32_t esp_get_tc(ESPState *s)
152c47b5835SMark Cave-Ayland {
153c47b5835SMark Cave-Ayland     uint32_t dmalen;
154c47b5835SMark Cave-Ayland 
155c47b5835SMark Cave-Ayland     dmalen = s->rregs[ESP_TCLO];
156c47b5835SMark Cave-Ayland     dmalen |= s->rregs[ESP_TCMID] << 8;
157c47b5835SMark Cave-Ayland     dmalen |= s->rregs[ESP_TCHI] << 16;
158c47b5835SMark Cave-Ayland 
159c47b5835SMark Cave-Ayland     return dmalen;
160c47b5835SMark Cave-Ayland }
161c47b5835SMark Cave-Ayland 
162c47b5835SMark Cave-Ayland static void esp_set_tc(ESPState *s, uint32_t dmalen)
163c47b5835SMark Cave-Ayland {
164c5d7df28SMark Cave-Ayland     uint32_t old_tc = esp_get_tc(s);
165c5d7df28SMark Cave-Ayland 
166c47b5835SMark Cave-Ayland     s->rregs[ESP_TCLO] = dmalen;
167c47b5835SMark Cave-Ayland     s->rregs[ESP_TCMID] = dmalen >> 8;
168c47b5835SMark Cave-Ayland     s->rregs[ESP_TCHI] = dmalen >> 16;
169c5d7df28SMark Cave-Ayland 
170c5d7df28SMark Cave-Ayland     if (old_tc && dmalen == 0) {
171c5d7df28SMark Cave-Ayland         s->rregs[ESP_RSTAT] |= STAT_TC;
172c5d7df28SMark Cave-Ayland     }
173c47b5835SMark Cave-Ayland }
174c47b5835SMark Cave-Ayland 
175c04ed569SMark Cave-Ayland static uint32_t esp_get_stc(ESPState *s)
176c04ed569SMark Cave-Ayland {
177c04ed569SMark Cave-Ayland     uint32_t dmalen;
178c04ed569SMark Cave-Ayland 
179c04ed569SMark Cave-Ayland     dmalen = s->wregs[ESP_TCLO];
180c04ed569SMark Cave-Ayland     dmalen |= s->wregs[ESP_TCMID] << 8;
181c04ed569SMark Cave-Ayland     dmalen |= s->wregs[ESP_TCHI] << 16;
182c04ed569SMark Cave-Ayland 
183c04ed569SMark Cave-Ayland     return dmalen;
184c04ed569SMark Cave-Ayland }
185c04ed569SMark Cave-Ayland 
186abc139cdSMark Cave-Ayland static const char *esp_phase_names[8] = {
187abc139cdSMark Cave-Ayland     "DATA OUT", "DATA IN", "COMMAND", "STATUS",
188abc139cdSMark Cave-Ayland     "(reserved)", "(reserved)", "MESSAGE OUT", "MESSAGE IN"
189abc139cdSMark Cave-Ayland };
190abc139cdSMark Cave-Ayland 
191abc139cdSMark Cave-Ayland static void esp_set_phase(ESPState *s, uint8_t phase)
192abc139cdSMark Cave-Ayland {
193abc139cdSMark Cave-Ayland     s->rregs[ESP_RSTAT] &= ~7;
194abc139cdSMark Cave-Ayland     s->rregs[ESP_RSTAT] |= phase;
195abc139cdSMark Cave-Ayland 
196abc139cdSMark Cave-Ayland     trace_esp_set_phase(esp_phase_names[phase]);
197abc139cdSMark Cave-Ayland }
198abc139cdSMark Cave-Ayland 
199761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s)
200761bef75SMark Cave-Ayland {
2018da90e81SMark Cave-Ayland     uint8_t val;
2028da90e81SMark Cave-Ayland 
203c5fef911SMark Cave-Ayland     val = esp_fifo_pop(&s->fifo);
2048da90e81SMark Cave-Ayland     return val;
205761bef75SMark Cave-Ayland }
206761bef75SMark Cave-Ayland 
207761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val)
208761bef75SMark Cave-Ayland {
2098da90e81SMark Cave-Ayland     uint32_t dmalen = esp_get_tc(s);
2108da90e81SMark Cave-Ayland 
2113c421400SMark Cave-Ayland     if (dmalen == 0) {
2128da90e81SMark Cave-Ayland         return;
2138da90e81SMark Cave-Ayland     }
2148da90e81SMark Cave-Ayland 
215e5455b8cSMark Cave-Ayland     esp_fifo_push(&s->fifo, val);
2168da90e81SMark Cave-Ayland 
2178da90e81SMark Cave-Ayland     dmalen--;
2188da90e81SMark Cave-Ayland     esp_set_tc(s, dmalen);
219761bef75SMark Cave-Ayland }
220761bef75SMark Cave-Ayland 
22177987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb)
2221e794c51SMark Cave-Ayland {
2231e794c51SMark Cave-Ayland     s->pdma_cb = cb;
2241e794c51SMark Cave-Ayland }
2251e794c51SMark Cave-Ayland 
226c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s)
2276130b188SLaurent Vivier {
2286130b188SLaurent Vivier     int target;
2296130b188SLaurent Vivier 
2306130b188SLaurent Vivier     target = s->wregs[ESP_WBUSID] & BUSID_DID;
2316130b188SLaurent Vivier 
2326130b188SLaurent Vivier     s->ti_size = 0;
2336130b188SLaurent Vivier 
234cf40a5e4SMark Cave-Ayland     if (s->current_req) {
235cf40a5e4SMark Cave-Ayland         /* Started a new command before the old one finished. Cancel it. */
236cf40a5e4SMark Cave-Ayland         scsi_req_cancel(s->current_req);
237cf40a5e4SMark Cave-Ayland     }
238cf40a5e4SMark Cave-Ayland 
2396130b188SLaurent Vivier     s->current_dev = scsi_device_find(&s->bus, 0, target, 0);
2406130b188SLaurent Vivier     if (!s->current_dev) {
2416130b188SLaurent Vivier         /* No such drive */
2426130b188SLaurent Vivier         s->rregs[ESP_RSTAT] = 0;
243cf1a7a9bSMark Cave-Ayland         s->rregs[ESP_RINTR] = INTR_DC;
2446130b188SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_0;
2456130b188SLaurent Vivier         esp_raise_irq(s);
2466130b188SLaurent Vivier         return -1;
2476130b188SLaurent Vivier     }
2484e78f3bfSMark Cave-Ayland 
2494e78f3bfSMark Cave-Ayland     /*
2504e78f3bfSMark Cave-Ayland      * Note that we deliberately don't raise the IRQ here: this will be done
2514eb86065SPaolo Bonzini      * either in do_command_phase() for DATA OUT transfers or by the deferred
2524e78f3bfSMark Cave-Ayland      * IRQ mechanism in esp_transfer_data() for DATA IN transfers
2534e78f3bfSMark Cave-Ayland      */
2544e78f3bfSMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_FC;
2554e78f3bfSMark Cave-Ayland     s->rregs[ESP_RSEQ] = SEQ_CD;
2566130b188SLaurent Vivier     return 0;
2576130b188SLaurent Vivier }
2586130b188SLaurent Vivier 
25920c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen)
26049ab747fSPaolo Bonzini {
261023666daSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
262042879fcSMark Cave-Ayland     uint32_t dmalen, n;
26349ab747fSPaolo Bonzini     int target;
26449ab747fSPaolo Bonzini 
26549ab747fSPaolo Bonzini     target = s->wregs[ESP_WBUSID] & BUSID_DID;
26649ab747fSPaolo Bonzini     if (s->dma) {
26720c8d2edSMark Cave-Ayland         dmalen = MIN(esp_get_tc(s), maxlen);
26820c8d2edSMark Cave-Ayland         if (dmalen == 0) {
2696c1fef6bSPrasad J Pandit             return 0;
2706c1fef6bSPrasad J Pandit         }
27174d71ea1SLaurent Vivier         if (s->dma_memory_read) {
27249ab747fSPaolo Bonzini             s->dma_memory_read(s->dma_opaque, buf, dmalen);
273fbc6510eSMark Cave-Ayland             dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen);
274023666daSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, dmalen);
275a0347651SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - dmalen);
27649ab747fSPaolo Bonzini         } else {
27774d71ea1SLaurent Vivier             return 0;
27874d71ea1SLaurent Vivier         }
27974d71ea1SLaurent Vivier     } else {
280023666daSMark Cave-Ayland         dmalen = MIN(fifo8_num_used(&s->fifo), maxlen);
28120c8d2edSMark Cave-Ayland         if (dmalen == 0) {
282d3cdc491SPrasad J Pandit             return 0;
283d3cdc491SPrasad J Pandit         }
2847b320a8eSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, dmalen);
285fbc6510eSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
2867b320a8eSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
28720c8d2edSMark Cave-Ayland     }
28849ab747fSPaolo Bonzini     trace_esp_get_cmd(dmalen, target);
28949ab747fSPaolo Bonzini 
29049ab747fSPaolo Bonzini     return dmalen;
29149ab747fSPaolo Bonzini }
29249ab747fSPaolo Bonzini 
2934eb86065SPaolo Bonzini static void do_command_phase(ESPState *s)
29449ab747fSPaolo Bonzini {
2957b320a8eSMark Cave-Ayland     uint32_t cmdlen;
29649ab747fSPaolo Bonzini     int32_t datalen;
29749ab747fSPaolo Bonzini     SCSIDevice *current_lun;
2987b320a8eSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
29949ab747fSPaolo Bonzini 
3004eb86065SPaolo Bonzini     trace_esp_do_command_phase(s->lun);
301023666daSMark Cave-Ayland     cmdlen = fifo8_num_used(&s->cmdfifo);
30299545751SMark Cave-Ayland     if (!cmdlen || !s->current_dev) {
30399545751SMark Cave-Ayland         return;
30499545751SMark Cave-Ayland     }
3057b320a8eSMark Cave-Ayland     esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen);
306023666daSMark Cave-Ayland 
3074eb86065SPaolo Bonzini     current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun);
308b22f83d8SAlexandra Diupina     if (!current_lun) {
309b22f83d8SAlexandra Diupina         /* No such drive */
310b22f83d8SAlexandra Diupina         s->rregs[ESP_RSTAT] = 0;
311b22f83d8SAlexandra Diupina         s->rregs[ESP_RINTR] = INTR_DC;
312b22f83d8SAlexandra Diupina         s->rregs[ESP_RSEQ] = SEQ_0;
313b22f83d8SAlexandra Diupina         esp_raise_irq(s);
314b22f83d8SAlexandra Diupina         return;
315b22f83d8SAlexandra Diupina     }
316b22f83d8SAlexandra Diupina 
317fe9d8927SJohn Millikin     s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s);
31849ab747fSPaolo Bonzini     datalen = scsi_req_enqueue(s->current_req);
31949ab747fSPaolo Bonzini     s->ti_size = datalen;
320023666daSMark Cave-Ayland     fifo8_reset(&s->cmdfifo);
32149ab747fSPaolo Bonzini     if (datalen != 0) {
3221b9e48a5SMark Cave-Ayland         s->ti_cmd = 0;
32349ab747fSPaolo Bonzini         if (datalen > 0) {
3244e78f3bfSMark Cave-Ayland             /*
3254e78f3bfSMark Cave-Ayland              * Switch to DATA IN phase but wait until initial data xfer is
3264e78f3bfSMark Cave-Ayland              * complete before raising the command completion interrupt
3274e78f3bfSMark Cave-Ayland              */
3284e78f3bfSMark Cave-Ayland             s->data_in_ready = false;
329abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_DI);
33049ab747fSPaolo Bonzini         } else {
331abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_DO);
332cf47a41eSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
33349ab747fSPaolo Bonzini             esp_raise_irq(s);
33482141c8bSMark Cave-Ayland             esp_lower_drq(s);
33549ab747fSPaolo Bonzini         }
3364e78f3bfSMark Cave-Ayland         scsi_req_continue(s->current_req);
3374e78f3bfSMark Cave-Ayland         return;
3384e78f3bfSMark Cave-Ayland     }
3394e78f3bfSMark Cave-Ayland }
34049ab747fSPaolo Bonzini 
3414eb86065SPaolo Bonzini static void do_message_phase(ESPState *s)
34249ab747fSPaolo Bonzini {
3434eb86065SPaolo Bonzini     if (s->cmdfifo_cdb_offset) {
3444eb86065SPaolo Bonzini         uint8_t message = esp_fifo_pop(&s->cmdfifo);
345023666daSMark Cave-Ayland 
3464eb86065SPaolo Bonzini         trace_esp_do_identify(message);
3474eb86065SPaolo Bonzini         s->lun = message & 7;
348023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset--;
3494eb86065SPaolo Bonzini     }
35049ab747fSPaolo Bonzini 
351799d90d8SMark Cave-Ayland     /* Ignore extended messages for now */
352023666daSMark Cave-Ayland     if (s->cmdfifo_cdb_offset) {
3534eb86065SPaolo Bonzini         int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo));
354fa7505c1SMark Cave-Ayland         esp_fifo_pop_buf(&s->cmdfifo, NULL, len);
355023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 0;
356023666daSMark Cave-Ayland     }
3574eb86065SPaolo Bonzini }
358023666daSMark Cave-Ayland 
3594eb86065SPaolo Bonzini static void do_cmd(ESPState *s)
3604eb86065SPaolo Bonzini {
3614eb86065SPaolo Bonzini     do_message_phase(s);
3624eb86065SPaolo Bonzini     assert(s->cmdfifo_cdb_offset == 0);
3634eb86065SPaolo Bonzini     do_command_phase(s);
36449ab747fSPaolo Bonzini }
36549ab747fSPaolo Bonzini 
36674d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s)
36774d71ea1SLaurent Vivier {
3682572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
3692572689bSMark Cave-Ayland     int n;
3702572689bSMark Cave-Ayland 
3712572689bSMark Cave-Ayland     /* Copy FIFO into cmdfifo */
3722572689bSMark Cave-Ayland     n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
3732572689bSMark Cave-Ayland     n = MIN(fifo8_num_free(&s->cmdfifo), n);
3742572689bSMark Cave-Ayland     fifo8_push_all(&s->cmdfifo, buf, n);
3752572689bSMark Cave-Ayland 
376e62a959aSMark Cave-Ayland     if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) {
377023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
378e62a959aSMark Cave-Ayland         s->do_cmd = 0;
379c959f218SMark Cave-Ayland         do_cmd(s);
38074d71ea1SLaurent Vivier     }
38174d71ea1SLaurent Vivier }
38274d71ea1SLaurent Vivier 
38349ab747fSPaolo Bonzini static void handle_satn(ESPState *s)
38449ab747fSPaolo Bonzini {
38549691315SMark Cave-Ayland     int32_t cmdlen;
38649691315SMark Cave-Ayland 
38749ab747fSPaolo Bonzini     if (s->dma && !s->dma_enabled) {
38849ab747fSPaolo Bonzini         s->dma_cb = handle_satn;
38949ab747fSPaolo Bonzini         return;
39049ab747fSPaolo Bonzini     }
39177987ef5SMark Cave-Ayland     esp_set_pdma_cb(s, SATN_PDMA_CB);
3921bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
3931bcaf71bSMark Cave-Ayland         return;
3941bcaf71bSMark Cave-Ayland     }
395023666daSMark Cave-Ayland     cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
39649691315SMark Cave-Ayland     if (cmdlen > 0) {
397023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
39860720694SMark Cave-Ayland         s->do_cmd = 0;
399c959f218SMark Cave-Ayland         do_cmd(s);
40049691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4011bcaf71bSMark Cave-Ayland         if (s->dma) {
4021bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4031bcaf71bSMark Cave-Ayland         }
404bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
40549691315SMark Cave-Ayland         /* Target present, but no cmd yet - switch to command phase */
40649691315SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_CD;
407abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
40849ab747fSPaolo Bonzini     }
40994d5c79dSMark Cave-Ayland }
41049ab747fSPaolo Bonzini 
41174d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s)
41274d71ea1SLaurent Vivier {
4132572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
4142572689bSMark Cave-Ayland     int n;
4152572689bSMark Cave-Ayland 
4162572689bSMark Cave-Ayland     /* Copy FIFO into cmdfifo */
4172572689bSMark Cave-Ayland     n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
4182572689bSMark Cave-Ayland     n = MIN(fifo8_num_free(&s->cmdfifo), n);
4192572689bSMark Cave-Ayland     fifo8_push_all(&s->cmdfifo, buf, n);
4202572689bSMark Cave-Ayland 
421e62a959aSMark Cave-Ayland     if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) {
422023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 0;
423e62a959aSMark Cave-Ayland         s->do_cmd = 0;
4244eb86065SPaolo Bonzini         do_cmd(s);
42574d71ea1SLaurent Vivier     }
42674d71ea1SLaurent Vivier }
42774d71ea1SLaurent Vivier 
42849ab747fSPaolo Bonzini static void handle_s_without_atn(ESPState *s)
42949ab747fSPaolo Bonzini {
43049691315SMark Cave-Ayland     int32_t cmdlen;
43149691315SMark Cave-Ayland 
43249ab747fSPaolo Bonzini     if (s->dma && !s->dma_enabled) {
43349ab747fSPaolo Bonzini         s->dma_cb = handle_s_without_atn;
43449ab747fSPaolo Bonzini         return;
43549ab747fSPaolo Bonzini     }
43677987ef5SMark Cave-Ayland     esp_set_pdma_cb(s, S_WITHOUT_SATN_PDMA_CB);
4371bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
4381bcaf71bSMark Cave-Ayland         return;
4391bcaf71bSMark Cave-Ayland     }
440023666daSMark Cave-Ayland     cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
44149691315SMark Cave-Ayland     if (cmdlen > 0) {
442023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 0;
44360720694SMark Cave-Ayland         s->do_cmd = 0;
4444eb86065SPaolo Bonzini         do_cmd(s);
44549691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4461bcaf71bSMark Cave-Ayland         if (s->dma) {
4471bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4481bcaf71bSMark Cave-Ayland         }
449bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
45049691315SMark Cave-Ayland         /* Target present, but no cmd yet - switch to command phase */
45149691315SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_CD;
452abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
45349ab747fSPaolo Bonzini     }
45449ab747fSPaolo Bonzini }
45549ab747fSPaolo Bonzini 
45674d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s)
45774d71ea1SLaurent Vivier {
4582572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
4592572689bSMark Cave-Ayland     int n;
4602572689bSMark Cave-Ayland 
4612572689bSMark Cave-Ayland     /* Copy FIFO into cmdfifo */
4622572689bSMark Cave-Ayland     n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
4632572689bSMark Cave-Ayland     n = MIN(fifo8_num_free(&s->cmdfifo), n);
4642572689bSMark Cave-Ayland     fifo8_push_all(&s->cmdfifo, buf, n);
4652572689bSMark Cave-Ayland 
466e62a959aSMark Cave-Ayland     if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) {
467023666daSMark Cave-Ayland         trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
46874d71ea1SLaurent Vivier         s->do_cmd = 1;
469023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
470abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
471abc139cdSMark Cave-Ayland         s->rregs[ESP_RSTAT] |= STAT_TC;
472cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
47374d71ea1SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_CD;
47474d71ea1SLaurent Vivier         esp_raise_irq(s);
47574d71ea1SLaurent Vivier     }
47674d71ea1SLaurent Vivier }
47774d71ea1SLaurent Vivier 
47849ab747fSPaolo Bonzini static void handle_satn_stop(ESPState *s)
47949ab747fSPaolo Bonzini {
48049691315SMark Cave-Ayland     int32_t cmdlen;
48149691315SMark Cave-Ayland 
48249ab747fSPaolo Bonzini     if (s->dma && !s->dma_enabled) {
48349ab747fSPaolo Bonzini         s->dma_cb = handle_satn_stop;
48449ab747fSPaolo Bonzini         return;
48549ab747fSPaolo Bonzini     }
48677987ef5SMark Cave-Ayland     esp_set_pdma_cb(s, SATN_STOP_PDMA_CB);
4871bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
4881bcaf71bSMark Cave-Ayland         return;
4891bcaf71bSMark Cave-Ayland     }
490799d90d8SMark Cave-Ayland     cmdlen = get_cmd(s, 1);
49149691315SMark Cave-Ayland     if (cmdlen > 0) {
492023666daSMark Cave-Ayland         trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
49349ab747fSPaolo Bonzini         s->do_cmd = 1;
494023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
495abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MO);
496cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
497799d90d8SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_MO;
49849ab747fSPaolo Bonzini         esp_raise_irq(s);
49949691315SMark Cave-Ayland     } else if (cmdlen == 0) {
5001bcaf71bSMark Cave-Ayland         if (s->dma) {
5011bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
5021bcaf71bSMark Cave-Ayland         }
503bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
504799d90d8SMark Cave-Ayland         /* Target present, switch to message out phase */
505799d90d8SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_MO;
506abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MO);
50749ab747fSPaolo Bonzini     }
50849ab747fSPaolo Bonzini }
50949ab747fSPaolo Bonzini 
51074d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s)
51174d71ea1SLaurent Vivier {
512abc139cdSMark Cave-Ayland     esp_set_phase(s, STAT_ST);
513cf47a41eSMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
51474d71ea1SLaurent Vivier     s->rregs[ESP_RSEQ] = SEQ_CD;
51574d71ea1SLaurent Vivier     esp_raise_irq(s);
51674d71ea1SLaurent Vivier }
51774d71ea1SLaurent Vivier 
51849ab747fSPaolo Bonzini static void write_response(ESPState *s)
51949ab747fSPaolo Bonzini {
520e3922557SMark Cave-Ayland     uint8_t buf[2];
521042879fcSMark Cave-Ayland 
52249ab747fSPaolo Bonzini     trace_esp_write_response(s->status);
523042879fcSMark Cave-Ayland 
524e3922557SMark Cave-Ayland     buf[0] = s->status;
525e3922557SMark Cave-Ayland     buf[1] = 0;
526042879fcSMark Cave-Ayland 
52749ab747fSPaolo Bonzini     if (s->dma) {
52874d71ea1SLaurent Vivier         if (s->dma_memory_write) {
529e3922557SMark Cave-Ayland             s->dma_memory_write(s->dma_opaque, buf, 2);
530abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_ST);
531cf47a41eSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
53249ab747fSPaolo Bonzini             s->rregs[ESP_RSEQ] = SEQ_CD;
53349ab747fSPaolo Bonzini         } else {
53477987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB);
53574d71ea1SLaurent Vivier             esp_raise_drq(s);
53674d71ea1SLaurent Vivier             return;
53774d71ea1SLaurent Vivier         }
53874d71ea1SLaurent Vivier     } else {
539e3922557SMark Cave-Ayland         fifo8_reset(&s->fifo);
540e3922557SMark Cave-Ayland         fifo8_push_all(&s->fifo, buf, 2);
54149ab747fSPaolo Bonzini         s->rregs[ESP_RFLAGS] = 2;
54249ab747fSPaolo Bonzini     }
54349ab747fSPaolo Bonzini     esp_raise_irq(s);
54449ab747fSPaolo Bonzini }
54549ab747fSPaolo Bonzini 
546004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s)
54749ab747fSPaolo Bonzini {
548af74b3c1SMark Cave-Ayland     if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) {
549cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
55049ab747fSPaolo Bonzini         esp_raise_irq(s);
551af74b3c1SMark Cave-Ayland         esp_lower_drq(s);
552af74b3c1SMark Cave-Ayland     }
55349ab747fSPaolo Bonzini }
55449ab747fSPaolo Bonzini 
55574d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s)
55674d71ea1SLaurent Vivier {
5574ca2ba6fSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
5582572689bSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
55982141c8bSMark Cave-Ayland     int len;
560042879fcSMark Cave-Ayland     uint32_t n;
5616cc88d6bSMark Cave-Ayland 
56274d71ea1SLaurent Vivier     if (s->do_cmd) {
5632572689bSMark Cave-Ayland         /* Copy FIFO into cmdfifo */
5642572689bSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
5652572689bSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
5662572689bSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
5672572689bSMark Cave-Ayland 
568e62a959aSMark Cave-Ayland         /* Ensure we have received complete command after SATN and stop */
569e62a959aSMark Cave-Ayland         if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) {
570e62a959aSMark Cave-Ayland             return;
571e62a959aSMark Cave-Ayland         }
572e62a959aSMark Cave-Ayland 
57374d71ea1SLaurent Vivier         s->ti_size = 0;
574c348458fSMark Cave-Ayland         if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) {
575c348458fSMark Cave-Ayland             /* No command received */
576c348458fSMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
577c348458fSMark Cave-Ayland                 return;
578c348458fSMark Cave-Ayland             }
579c348458fSMark Cave-Ayland 
580c348458fSMark Cave-Ayland             /* Command has been received */
58174d71ea1SLaurent Vivier             s->do_cmd = 0;
582c959f218SMark Cave-Ayland             do_cmd(s);
583c348458fSMark Cave-Ayland         } else {
584c348458fSMark Cave-Ayland             /*
585c348458fSMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
5862cb40d44SStefan Weil              * and then switch to command phase
587c348458fSMark Cave-Ayland              */
588c348458fSMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
589abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
590c348458fSMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
591c348458fSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
592c348458fSMark Cave-Ayland             esp_raise_irq(s);
593c348458fSMark Cave-Ayland         }
59474d71ea1SLaurent Vivier         return;
59574d71ea1SLaurent Vivier     }
59682141c8bSMark Cave-Ayland 
5970db89536SMark Cave-Ayland     if (!s->current_req) {
5980db89536SMark Cave-Ayland         return;
5990db89536SMark Cave-Ayland     }
6000db89536SMark Cave-Ayland 
60182141c8bSMark Cave-Ayland     if (to_device) {
60282141c8bSMark Cave-Ayland         /* Copy FIFO data to device */
6037aa6baeeSMark Cave-Ayland         len = MIN(s->async_len, ESP_FIFO_SZ);
6047aa6baeeSMark Cave-Ayland         len = MIN(len, fifo8_num_used(&s->fifo));
6057b320a8eSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
6067aa6baeeSMark Cave-Ayland         s->async_buf += n;
6077aa6baeeSMark Cave-Ayland         s->async_len -= n;
6087aa6baeeSMark Cave-Ayland         s->ti_size += n;
6097aa6baeeSMark Cave-Ayland 
610e4e166c8SMark Cave-Ayland         if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
611e4e166c8SMark Cave-Ayland             /* Defer until the scsi layer has completed */
61274d71ea1SLaurent Vivier             scsi_req_continue(s->current_req);
61382141c8bSMark Cave-Ayland             return;
61482141c8bSMark Cave-Ayland         }
61582141c8bSMark Cave-Ayland 
616004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
61782141c8bSMark Cave-Ayland     } else {
61868ef41fbSMark Cave-Ayland         if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
6194e78f3bfSMark Cave-Ayland             /* Defer until the scsi layer has completed */
62082141c8bSMark Cave-Ayland             scsi_req_continue(s->current_req);
6214e78f3bfSMark Cave-Ayland             s->data_in_ready = false;
62274d71ea1SLaurent Vivier             return;
62374d71ea1SLaurent Vivier         }
62474d71ea1SLaurent Vivier 
625004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
6260f2eb110SMark Cave-Ayland 
62782141c8bSMark Cave-Ayland         /* Copy device data to FIFO */
6287aa6baeeSMark Cave-Ayland         len = MIN(s->async_len, esp_get_tc(s));
6297aa6baeeSMark Cave-Ayland         len = MIN(len, fifo8_num_free(&s->fifo));
630042879fcSMark Cave-Ayland         fifo8_push_all(&s->fifo, s->async_buf, len);
63182141c8bSMark Cave-Ayland         s->async_buf += len;
63282141c8bSMark Cave-Ayland         s->async_len -= len;
63382141c8bSMark Cave-Ayland         s->ti_size -= len;
63482141c8bSMark Cave-Ayland         esp_set_tc(s, esp_get_tc(s) - len);
63574d71ea1SLaurent Vivier     }
63682141c8bSMark Cave-Ayland }
63774d71ea1SLaurent Vivier 
63849ab747fSPaolo Bonzini static void esp_do_dma(ESPState *s)
63949ab747fSPaolo Bonzini {
640023666daSMark Cave-Ayland     uint32_t len, cmdlen;
6414ca2ba6fSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
642023666daSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
64319e9afb1SMark Cave-Ayland     int n;
64449ab747fSPaolo Bonzini 
6456cc88d6bSMark Cave-Ayland     len = esp_get_tc(s);
64649ab747fSPaolo Bonzini     if (s->do_cmd) {
64715407433SLaurent Vivier         /*
64815407433SLaurent Vivier          * handle_ti_cmd() case: esp_do_dma() is called only from
64915407433SLaurent Vivier          * handle_ti_cmd() with do_cmd != NULL (see the assert())
65015407433SLaurent Vivier          */
651023666daSMark Cave-Ayland         cmdlen = fifo8_num_used(&s->cmdfifo);
652023666daSMark Cave-Ayland         trace_esp_do_dma(cmdlen, len);
65374d71ea1SLaurent Vivier         if (s->dma_memory_read) {
6540ebb5fd8SMark Cave-Ayland             len = MIN(len, fifo8_num_free(&s->cmdfifo));
655023666daSMark Cave-Ayland             s->dma_memory_read(s->dma_opaque, buf, len);
656023666daSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, len);
657a0347651SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
65874d71ea1SLaurent Vivier         } else {
659*3c7f3c8bSMark Cave-Ayland             n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
660*3c7f3c8bSMark Cave-Ayland             n = MIN(fifo8_num_free(&s->cmdfifo), n);
661*3c7f3c8bSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, n);
662*3c7f3c8bSMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - n);
663*3c7f3c8bSMark Cave-Ayland 
66477987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
66574d71ea1SLaurent Vivier             esp_raise_drq(s);
666*3c7f3c8bSMark Cave-Ayland 
667*3c7f3c8bSMark Cave-Ayland             /* Ensure we have received complete command after SATN and stop */
668*3c7f3c8bSMark Cave-Ayland             if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) {
66974d71ea1SLaurent Vivier                 return;
67074d71ea1SLaurent Vivier             }
671*3c7f3c8bSMark Cave-Ayland         }
672023666daSMark Cave-Ayland         trace_esp_handle_ti_cmd(cmdlen);
67315407433SLaurent Vivier         s->ti_size = 0;
674799d90d8SMark Cave-Ayland         if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) {
675799d90d8SMark Cave-Ayland             /* No command received */
676023666daSMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
677799d90d8SMark Cave-Ayland                 return;
678799d90d8SMark Cave-Ayland             }
679799d90d8SMark Cave-Ayland 
680799d90d8SMark Cave-Ayland             /* Command has been received */
68115407433SLaurent Vivier             s->do_cmd = 0;
682c959f218SMark Cave-Ayland             do_cmd(s);
683799d90d8SMark Cave-Ayland         } else {
684799d90d8SMark Cave-Ayland             /*
685023666daSMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
6862cb40d44SStefan Weil              * and then switch to command phase
687799d90d8SMark Cave-Ayland              */
688023666daSMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
689abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
690799d90d8SMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
691799d90d8SMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
692799d90d8SMark Cave-Ayland             esp_raise_irq(s);
693799d90d8SMark Cave-Ayland         }
69449ab747fSPaolo Bonzini         return;
69549ab747fSPaolo Bonzini     }
6960db89536SMark Cave-Ayland     if (!s->current_req) {
6970db89536SMark Cave-Ayland         return;
6980db89536SMark Cave-Ayland     }
69949ab747fSPaolo Bonzini     if (s->async_len == 0) {
70049ab747fSPaolo Bonzini         /* Defer until data is available.  */
70149ab747fSPaolo Bonzini         return;
70249ab747fSPaolo Bonzini     }
70349ab747fSPaolo Bonzini     if (len > s->async_len) {
70449ab747fSPaolo Bonzini         len = s->async_len;
70549ab747fSPaolo Bonzini     }
70649ab747fSPaolo Bonzini     if (to_device) {
70774d71ea1SLaurent Vivier         if (s->dma_memory_read) {
70849ab747fSPaolo Bonzini             s->dma_memory_read(s->dma_opaque, s->async_buf, len);
709f3666223SMark Cave-Ayland 
710f3666223SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
711f3666223SMark Cave-Ayland             s->async_buf += len;
712f3666223SMark Cave-Ayland             s->async_len -= len;
713f3666223SMark Cave-Ayland             s->ti_size += len;
714f3666223SMark Cave-Ayland 
715e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
716e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
717f3666223SMark Cave-Ayland                 scsi_req_continue(s->current_req);
718f3666223SMark Cave-Ayland                 return;
719f3666223SMark Cave-Ayland             }
720f3666223SMark Cave-Ayland 
721004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
72249ab747fSPaolo Bonzini         } else {
72319e9afb1SMark Cave-Ayland             /* Copy FIFO data to device */
72419e9afb1SMark Cave-Ayland             len = MIN(s->async_len, ESP_FIFO_SZ);
72519e9afb1SMark Cave-Ayland             len = MIN(len, fifo8_num_used(&s->fifo));
72619e9afb1SMark Cave-Ayland             n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
72719e9afb1SMark Cave-Ayland             s->async_buf += n;
72819e9afb1SMark Cave-Ayland             s->async_len -= n;
72919e9afb1SMark Cave-Ayland             s->ti_size += n;
73019e9afb1SMark Cave-Ayland 
73177987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
73274d71ea1SLaurent Vivier             esp_raise_drq(s);
733e4e166c8SMark Cave-Ayland 
734e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
735e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
736e4e166c8SMark Cave-Ayland                 scsi_req_continue(s->current_req);
737e4e166c8SMark Cave-Ayland                 return;
738e4e166c8SMark Cave-Ayland             }
739e4e166c8SMark Cave-Ayland 
740004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
74174d71ea1SLaurent Vivier         }
74274d71ea1SLaurent Vivier     } else {
74374d71ea1SLaurent Vivier         if (s->dma_memory_write) {
74449ab747fSPaolo Bonzini             s->dma_memory_write(s->dma_opaque, s->async_buf, len);
745f3666223SMark Cave-Ayland 
746f3666223SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
747f3666223SMark Cave-Ayland             s->async_buf += len;
748f3666223SMark Cave-Ayland             s->async_len -= len;
749f3666223SMark Cave-Ayland             s->ti_size -= len;
750f3666223SMark Cave-Ayland 
751e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
752e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
753f3666223SMark Cave-Ayland                 scsi_req_continue(s->current_req);
754fabcba49SMark Cave-Ayland                 return;
755f3666223SMark Cave-Ayland             }
756f3666223SMark Cave-Ayland 
757004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
75874d71ea1SLaurent Vivier         } else {
75982141c8bSMark Cave-Ayland             /* Copy device data to FIFO */
760042879fcSMark Cave-Ayland             len = MIN(len, fifo8_num_free(&s->fifo));
761042879fcSMark Cave-Ayland             fifo8_push_all(&s->fifo, s->async_buf, len);
76282141c8bSMark Cave-Ayland             s->async_buf += len;
76382141c8bSMark Cave-Ayland             s->async_len -= len;
76482141c8bSMark Cave-Ayland             s->ti_size -= len;
76582141c8bSMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
76677987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
76774d71ea1SLaurent Vivier             esp_raise_drq(s);
768e4e166c8SMark Cave-Ayland 
769e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
770e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
771e4e166c8SMark Cave-Ayland                 scsi_req_continue(s->current_req);
772e4e166c8SMark Cave-Ayland                 return;
773e4e166c8SMark Cave-Ayland             }
774e4e166c8SMark Cave-Ayland 
775004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
776e4e166c8SMark Cave-Ayland         }
77774d71ea1SLaurent Vivier     }
77849ab747fSPaolo Bonzini }
77949ab747fSPaolo Bonzini 
7801b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s)
7811b9e48a5SMark Cave-Ayland {
7821b9e48a5SMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
7832572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
7847b320a8eSMark Cave-Ayland     uint32_t cmdlen;
7852572689bSMark Cave-Ayland     int len, n;
7861b9e48a5SMark Cave-Ayland 
7871b9e48a5SMark Cave-Ayland     if (s->do_cmd) {
7882572689bSMark Cave-Ayland         /* Copy FIFO into cmdfifo */
7892572689bSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
7902572689bSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
7912572689bSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
7922572689bSMark Cave-Ayland 
7931b9e48a5SMark Cave-Ayland         cmdlen = fifo8_num_used(&s->cmdfifo);
7941b9e48a5SMark Cave-Ayland         trace_esp_handle_ti_cmd(cmdlen);
7951b9e48a5SMark Cave-Ayland         s->ti_size = 0;
7961b9e48a5SMark Cave-Ayland         if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) {
7971b9e48a5SMark Cave-Ayland             /* No command received */
7981b9e48a5SMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
7991b9e48a5SMark Cave-Ayland                 return;
8001b9e48a5SMark Cave-Ayland             }
8011b9e48a5SMark Cave-Ayland 
8021b9e48a5SMark Cave-Ayland             /* Command has been received */
8031b9e48a5SMark Cave-Ayland             s->do_cmd = 0;
8041b9e48a5SMark Cave-Ayland             do_cmd(s);
8051b9e48a5SMark Cave-Ayland         } else {
8061b9e48a5SMark Cave-Ayland             /*
8071b9e48a5SMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
8082cb40d44SStefan Weil              * and then switch to command phase
8091b9e48a5SMark Cave-Ayland              */
8101b9e48a5SMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
811abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
8121b9e48a5SMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
8131b9e48a5SMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
8141b9e48a5SMark Cave-Ayland             esp_raise_irq(s);
8151b9e48a5SMark Cave-Ayland         }
8161b9e48a5SMark Cave-Ayland         return;
8171b9e48a5SMark Cave-Ayland     }
8181b9e48a5SMark Cave-Ayland 
8190db89536SMark Cave-Ayland     if (!s->current_req) {
8200db89536SMark Cave-Ayland         return;
8210db89536SMark Cave-Ayland     }
8220db89536SMark Cave-Ayland 
8231b9e48a5SMark Cave-Ayland     if (s->async_len == 0) {
8241b9e48a5SMark Cave-Ayland         /* Defer until data is available.  */
8251b9e48a5SMark Cave-Ayland         return;
8261b9e48a5SMark Cave-Ayland     }
8271b9e48a5SMark Cave-Ayland 
8281b9e48a5SMark Cave-Ayland     if (to_device) {
82977668e4bSMark Cave-Ayland         len = MIN(s->async_len, ESP_FIFO_SZ);
83077668e4bSMark Cave-Ayland         len = MIN(len, fifo8_num_used(&s->fifo));
8317b320a8eSMark Cave-Ayland         esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
8321b9e48a5SMark Cave-Ayland         s->async_buf += len;
8331b9e48a5SMark Cave-Ayland         s->async_len -= len;
8341b9e48a5SMark Cave-Ayland         s->ti_size += len;
8351b9e48a5SMark Cave-Ayland     } else {
8366ef2cabcSMark Cave-Ayland         if (fifo8_is_empty(&s->fifo)) {
8376ef2cabcSMark Cave-Ayland             fifo8_push(&s->fifo, s->async_buf[0]);
8386ef2cabcSMark Cave-Ayland             s->async_buf++;
8396ef2cabcSMark Cave-Ayland             s->async_len--;
8406ef2cabcSMark Cave-Ayland             s->ti_size--;
8416ef2cabcSMark Cave-Ayland         }
8421b9e48a5SMark Cave-Ayland     }
8431b9e48a5SMark Cave-Ayland 
8441b9e48a5SMark Cave-Ayland     if (s->async_len == 0) {
8451b9e48a5SMark Cave-Ayland         scsi_req_continue(s->current_req);
8461b9e48a5SMark Cave-Ayland         return;
8471b9e48a5SMark Cave-Ayland     }
8481b9e48a5SMark Cave-Ayland 
8491b9e48a5SMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_BS;
8501b9e48a5SMark Cave-Ayland     esp_raise_irq(s);
8511b9e48a5SMark Cave-Ayland }
8521b9e48a5SMark Cave-Ayland 
85377987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s)
85477987ef5SMark Cave-Ayland {
85577987ef5SMark Cave-Ayland     switch (s->pdma_cb) {
85677987ef5SMark Cave-Ayland     case SATN_PDMA_CB:
85777987ef5SMark Cave-Ayland         satn_pdma_cb(s);
85877987ef5SMark Cave-Ayland         break;
85977987ef5SMark Cave-Ayland     case S_WITHOUT_SATN_PDMA_CB:
86077987ef5SMark Cave-Ayland         s_without_satn_pdma_cb(s);
86177987ef5SMark Cave-Ayland         break;
86277987ef5SMark Cave-Ayland     case SATN_STOP_PDMA_CB:
86377987ef5SMark Cave-Ayland         satn_stop_pdma_cb(s);
86477987ef5SMark Cave-Ayland         break;
86577987ef5SMark Cave-Ayland     case WRITE_RESPONSE_PDMA_CB:
86677987ef5SMark Cave-Ayland         write_response_pdma_cb(s);
86777987ef5SMark Cave-Ayland         break;
86877987ef5SMark Cave-Ayland     case DO_DMA_PDMA_CB:
86977987ef5SMark Cave-Ayland         do_dma_pdma_cb(s);
87077987ef5SMark Cave-Ayland         break;
87177987ef5SMark Cave-Ayland     default:
87277987ef5SMark Cave-Ayland         g_assert_not_reached();
87377987ef5SMark Cave-Ayland     }
87477987ef5SMark Cave-Ayland }
87577987ef5SMark Cave-Ayland 
8764aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid)
87749ab747fSPaolo Bonzini {
8784aaa6ac3SMark Cave-Ayland     ESPState *s = req->hba_private;
8796ef2cabcSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
8804aaa6ac3SMark Cave-Ayland 
88149ab747fSPaolo Bonzini     trace_esp_command_complete();
8826ef2cabcSMark Cave-Ayland 
8836ef2cabcSMark Cave-Ayland     /*
8846ef2cabcSMark Cave-Ayland      * Non-DMA transfers from the target will leave the last byte in
8856ef2cabcSMark Cave-Ayland      * the FIFO so don't reset ti_size in this case
8866ef2cabcSMark Cave-Ayland      */
8876ef2cabcSMark Cave-Ayland     if (s->dma || to_device) {
88849ab747fSPaolo Bonzini         if (s->ti_size != 0) {
88949ab747fSPaolo Bonzini             trace_esp_command_complete_unexpected();
89049ab747fSPaolo Bonzini         }
8916ef2cabcSMark Cave-Ayland     }
8926ef2cabcSMark Cave-Ayland 
89349ab747fSPaolo Bonzini     s->async_len = 0;
8944aaa6ac3SMark Cave-Ayland     if (req->status) {
89549ab747fSPaolo Bonzini         trace_esp_command_complete_fail();
89649ab747fSPaolo Bonzini     }
8974aaa6ac3SMark Cave-Ayland     s->status = req->status;
8986ef2cabcSMark Cave-Ayland 
8996ef2cabcSMark Cave-Ayland     /*
900cb988199SMark Cave-Ayland      * Switch to status phase. For non-DMA transfers from the target the last
901cb988199SMark Cave-Ayland      * byte is still in the FIFO
9026ef2cabcSMark Cave-Ayland      */
903abc139cdSMark Cave-Ayland     esp_set_phase(s, STAT_ST);
904cb988199SMark Cave-Ayland     if (s->ti_size == 0) {
905cb988199SMark Cave-Ayland         /*
906cb988199SMark Cave-Ayland          * Transfer complete: force TC to zero just in case a TI command was
907cb988199SMark Cave-Ayland          * requested for more data than the command returns (Solaris 8 does
908cb988199SMark Cave-Ayland          * this)
909cb988199SMark Cave-Ayland          */
910cb988199SMark Cave-Ayland         esp_set_tc(s, 0);
911004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
912cb988199SMark Cave-Ayland     } else {
913cb988199SMark Cave-Ayland         /*
914cb988199SMark Cave-Ayland          * Transfer truncated: raise INTR_BS to indicate early change of
915cb988199SMark Cave-Ayland          * phase
916cb988199SMark Cave-Ayland          */
917cb988199SMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
918cb988199SMark Cave-Ayland         esp_raise_irq(s);
919cb988199SMark Cave-Ayland         s->ti_size = 0;
9206ef2cabcSMark Cave-Ayland     }
9216ef2cabcSMark Cave-Ayland 
92249ab747fSPaolo Bonzini     if (s->current_req) {
92349ab747fSPaolo Bonzini         scsi_req_unref(s->current_req);
92449ab747fSPaolo Bonzini         s->current_req = NULL;
92549ab747fSPaolo Bonzini         s->current_dev = NULL;
92649ab747fSPaolo Bonzini     }
92749ab747fSPaolo Bonzini }
92849ab747fSPaolo Bonzini 
92949ab747fSPaolo Bonzini void esp_transfer_data(SCSIRequest *req, uint32_t len)
93049ab747fSPaolo Bonzini {
93149ab747fSPaolo Bonzini     ESPState *s = req->hba_private;
9324e78f3bfSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
9336cc88d6bSMark Cave-Ayland     uint32_t dmalen = esp_get_tc(s);
93449ab747fSPaolo Bonzini 
9357f0b6e11SPaolo Bonzini     assert(!s->do_cmd);
9366cc88d6bSMark Cave-Ayland     trace_esp_transfer_data(dmalen, s->ti_size);
93749ab747fSPaolo Bonzini     s->async_len = len;
93849ab747fSPaolo Bonzini     s->async_buf = scsi_req_get_buf(req);
9394e78f3bfSMark Cave-Ayland 
9404e78f3bfSMark Cave-Ayland     if (!to_device && !s->data_in_ready) {
9414e78f3bfSMark Cave-Ayland         /*
9424e78f3bfSMark Cave-Ayland          * Initial incoming data xfer is complete so raise command
9434e78f3bfSMark Cave-Ayland          * completion interrupt
9444e78f3bfSMark Cave-Ayland          */
9454e78f3bfSMark Cave-Ayland         s->data_in_ready = true;
9464e78f3bfSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
9474e78f3bfSMark Cave-Ayland         esp_raise_irq(s);
9484e78f3bfSMark Cave-Ayland     }
9494e78f3bfSMark Cave-Ayland 
9501b9e48a5SMark Cave-Ayland     /*
9511b9e48a5SMark Cave-Ayland      * Always perform the initial transfer upon reception of the next TI
9521b9e48a5SMark Cave-Ayland      * command to ensure the DMA/non-DMA status of the command is correct.
9531b9e48a5SMark Cave-Ayland      * It is not possible to use s->dma directly in the section below as
9541b9e48a5SMark Cave-Ayland      * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the
9551b9e48a5SMark Cave-Ayland      * async data transfer is delayed then s->dma is set incorrectly.
9561b9e48a5SMark Cave-Ayland      */
9571b9e48a5SMark Cave-Ayland 
958880d3089SMark Cave-Ayland     if (s->ti_cmd == (CMD_TI | CMD_DMA)) {
959a79e767aSMark Cave-Ayland         /* When the SCSI layer returns more data, raise deferred INTR_BS */
960004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
961a79e767aSMark Cave-Ayland 
962a79e767aSMark Cave-Ayland         esp_do_dma(s);
963880d3089SMark Cave-Ayland     } else if (s->ti_cmd == CMD_TI) {
9641b9e48a5SMark Cave-Ayland         esp_do_nodma(s);
9651b9e48a5SMark Cave-Ayland     }
96649ab747fSPaolo Bonzini }
96749ab747fSPaolo Bonzini 
96849ab747fSPaolo Bonzini static void handle_ti(ESPState *s)
96949ab747fSPaolo Bonzini {
9701b9e48a5SMark Cave-Ayland     uint32_t dmalen;
97149ab747fSPaolo Bonzini 
97249ab747fSPaolo Bonzini     if (s->dma && !s->dma_enabled) {
97349ab747fSPaolo Bonzini         s->dma_cb = handle_ti;
97449ab747fSPaolo Bonzini         return;
97549ab747fSPaolo Bonzini     }
97649ab747fSPaolo Bonzini 
9771b9e48a5SMark Cave-Ayland     s->ti_cmd = s->rregs[ESP_CMD];
97849ab747fSPaolo Bonzini     if (s->dma) {
9791b9e48a5SMark Cave-Ayland         dmalen = esp_get_tc(s);
980b76624deSMark Cave-Ayland         trace_esp_handle_ti(dmalen);
98149ab747fSPaolo Bonzini         esp_do_dma(s);
982799d90d8SMark Cave-Ayland     } else {
9831b9e48a5SMark Cave-Ayland         trace_esp_handle_ti(s->ti_size);
9841b9e48a5SMark Cave-Ayland         esp_do_nodma(s);
98549ab747fSPaolo Bonzini     }
98649ab747fSPaolo Bonzini }
98749ab747fSPaolo Bonzini 
98849ab747fSPaolo Bonzini void esp_hard_reset(ESPState *s)
98949ab747fSPaolo Bonzini {
99049ab747fSPaolo Bonzini     memset(s->rregs, 0, ESP_REGS);
99149ab747fSPaolo Bonzini     memset(s->wregs, 0, ESP_REGS);
992c9cf45c1SHannes Reinecke     s->tchi_written = 0;
99349ab747fSPaolo Bonzini     s->ti_size = 0;
9943f26c975SMark Cave-Ayland     s->async_len = 0;
995042879fcSMark Cave-Ayland     fifo8_reset(&s->fifo);
996023666daSMark Cave-Ayland     fifo8_reset(&s->cmdfifo);
99749ab747fSPaolo Bonzini     s->dma = 0;
99849ab747fSPaolo Bonzini     s->do_cmd = 0;
99949ab747fSPaolo Bonzini     s->dma_cb = NULL;
100049ab747fSPaolo Bonzini 
100149ab747fSPaolo Bonzini     s->rregs[ESP_CFG1] = 7;
100249ab747fSPaolo Bonzini }
100349ab747fSPaolo Bonzini 
100449ab747fSPaolo Bonzini static void esp_soft_reset(ESPState *s)
100549ab747fSPaolo Bonzini {
100649ab747fSPaolo Bonzini     qemu_irq_lower(s->irq);
100774d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
100849ab747fSPaolo Bonzini     esp_hard_reset(s);
100949ab747fSPaolo Bonzini }
101049ab747fSPaolo Bonzini 
1011c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s)
1012c6e51f1bSJohn Millikin {
10134a5fc890SPeter Maydell     bus_cold_reset(BUS(&s->bus));
1014c6e51f1bSJohn Millikin }
1015c6e51f1bSJohn Millikin 
101649ab747fSPaolo Bonzini static void parent_esp_reset(ESPState *s, int irq, int level)
101749ab747fSPaolo Bonzini {
101849ab747fSPaolo Bonzini     if (level) {
101949ab747fSPaolo Bonzini         esp_soft_reset(s);
102049ab747fSPaolo Bonzini     }
102149ab747fSPaolo Bonzini }
102249ab747fSPaolo Bonzini 
1023f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s)
1024f21fe39dSMark Cave-Ayland {
1025f21fe39dSMark Cave-Ayland     uint8_t cmd = s->rregs[ESP_CMD];
1026f21fe39dSMark Cave-Ayland 
1027f21fe39dSMark Cave-Ayland     if (cmd & CMD_DMA) {
1028f21fe39dSMark Cave-Ayland         s->dma = 1;
1029f21fe39dSMark Cave-Ayland         /* Reload DMA counter.  */
1030f21fe39dSMark Cave-Ayland         if (esp_get_stc(s) == 0) {
1031f21fe39dSMark Cave-Ayland             esp_set_tc(s, 0x10000);
1032f21fe39dSMark Cave-Ayland         } else {
1033f21fe39dSMark Cave-Ayland             esp_set_tc(s, esp_get_stc(s));
1034f21fe39dSMark Cave-Ayland         }
1035f21fe39dSMark Cave-Ayland     } else {
1036f21fe39dSMark Cave-Ayland         s->dma = 0;
1037f21fe39dSMark Cave-Ayland     }
1038f21fe39dSMark Cave-Ayland     switch (cmd & CMD_CMD) {
1039f21fe39dSMark Cave-Ayland     case CMD_NOP:
1040f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_nop(cmd);
1041f21fe39dSMark Cave-Ayland         break;
1042f21fe39dSMark Cave-Ayland     case CMD_FLUSH:
1043f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_flush(cmd);
1044f21fe39dSMark Cave-Ayland         fifo8_reset(&s->fifo);
1045f21fe39dSMark Cave-Ayland         break;
1046f21fe39dSMark Cave-Ayland     case CMD_RESET:
1047f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_reset(cmd);
1048f21fe39dSMark Cave-Ayland         esp_soft_reset(s);
1049f21fe39dSMark Cave-Ayland         break;
1050f21fe39dSMark Cave-Ayland     case CMD_BUSRESET:
1051f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_bus_reset(cmd);
1052f21fe39dSMark Cave-Ayland         esp_bus_reset(s);
1053f21fe39dSMark Cave-Ayland         if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) {
1054f21fe39dSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_RST;
1055f21fe39dSMark Cave-Ayland             esp_raise_irq(s);
1056f21fe39dSMark Cave-Ayland         }
1057f21fe39dSMark Cave-Ayland         break;
1058f21fe39dSMark Cave-Ayland     case CMD_TI:
1059f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_ti(cmd);
1060f21fe39dSMark Cave-Ayland         handle_ti(s);
1061f21fe39dSMark Cave-Ayland         break;
1062f21fe39dSMark Cave-Ayland     case CMD_ICCS:
1063f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_iccs(cmd);
1064f21fe39dSMark Cave-Ayland         write_response(s);
1065f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_FC;
1066abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MI);
1067f21fe39dSMark Cave-Ayland         break;
1068f21fe39dSMark Cave-Ayland     case CMD_MSGACC:
1069f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_msgacc(cmd);
1070f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_DC;
1071f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSEQ] = 0;
1072f21fe39dSMark Cave-Ayland         s->rregs[ESP_RFLAGS] = 0;
1073f21fe39dSMark Cave-Ayland         esp_raise_irq(s);
1074f21fe39dSMark Cave-Ayland         break;
1075f21fe39dSMark Cave-Ayland     case CMD_PAD:
1076f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_pad(cmd);
1077f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSTAT] = STAT_TC;
1078f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_FC;
1079f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSEQ] = 0;
1080f21fe39dSMark Cave-Ayland         break;
1081f21fe39dSMark Cave-Ayland     case CMD_SATN:
1082f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_satn(cmd);
1083f21fe39dSMark Cave-Ayland         break;
1084f21fe39dSMark Cave-Ayland     case CMD_RSTATN:
1085f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_rstatn(cmd);
1086f21fe39dSMark Cave-Ayland         break;
1087f21fe39dSMark Cave-Ayland     case CMD_SEL:
1088f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_sel(cmd);
1089f21fe39dSMark Cave-Ayland         handle_s_without_atn(s);
1090f21fe39dSMark Cave-Ayland         break;
1091f21fe39dSMark Cave-Ayland     case CMD_SELATN:
1092f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_selatn(cmd);
1093f21fe39dSMark Cave-Ayland         handle_satn(s);
1094f21fe39dSMark Cave-Ayland         break;
1095f21fe39dSMark Cave-Ayland     case CMD_SELATNS:
1096f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_selatns(cmd);
1097f21fe39dSMark Cave-Ayland         handle_satn_stop(s);
1098f21fe39dSMark Cave-Ayland         break;
1099f21fe39dSMark Cave-Ayland     case CMD_ENSEL:
1100f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_ensel(cmd);
1101f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] = 0;
1102f21fe39dSMark Cave-Ayland         break;
1103f21fe39dSMark Cave-Ayland     case CMD_DISSEL:
1104f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_dissel(cmd);
1105f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] = 0;
1106f21fe39dSMark Cave-Ayland         esp_raise_irq(s);
1107f21fe39dSMark Cave-Ayland         break;
1108f21fe39dSMark Cave-Ayland     default:
1109f21fe39dSMark Cave-Ayland         trace_esp_error_unhandled_command(cmd);
1110f21fe39dSMark Cave-Ayland         break;
1111f21fe39dSMark Cave-Ayland     }
1112f21fe39dSMark Cave-Ayland }
1113f21fe39dSMark Cave-Ayland 
111449ab747fSPaolo Bonzini uint64_t esp_reg_read(ESPState *s, uint32_t saddr)
111549ab747fSPaolo Bonzini {
1116b630c075SMark Cave-Ayland     uint32_t val;
111749ab747fSPaolo Bonzini 
111849ab747fSPaolo Bonzini     switch (saddr) {
111949ab747fSPaolo Bonzini     case ESP_FIFO:
11201b9e48a5SMark Cave-Ayland         if (s->dma_memory_read && s->dma_memory_write &&
11211b9e48a5SMark Cave-Ayland                 (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) {
112249ab747fSPaolo Bonzini             /* Data out.  */
1123ff589551SPrasad J Pandit             qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n");
112449ab747fSPaolo Bonzini             s->rregs[ESP_FIFO] = 0;
1125042879fcSMark Cave-Ayland         } else {
11266ef2cabcSMark Cave-Ayland             if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) {
11276ef2cabcSMark Cave-Ayland                 if (s->ti_size) {
11286ef2cabcSMark Cave-Ayland                     esp_do_nodma(s);
11296ef2cabcSMark Cave-Ayland                 } else {
11306ef2cabcSMark Cave-Ayland                     /*
11316ef2cabcSMark Cave-Ayland                      * The last byte of a non-DMA transfer has been read out
11326ef2cabcSMark Cave-Ayland                      * of the FIFO so switch to status phase
11336ef2cabcSMark Cave-Ayland                      */
1134abc139cdSMark Cave-Ayland                     esp_set_phase(s, STAT_ST);
11356ef2cabcSMark Cave-Ayland                 }
11366ef2cabcSMark Cave-Ayland             }
1137c5fef911SMark Cave-Ayland             s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo);
113849ab747fSPaolo Bonzini         }
1139b630c075SMark Cave-Ayland         val = s->rregs[ESP_FIFO];
114049ab747fSPaolo Bonzini         break;
114149ab747fSPaolo Bonzini     case ESP_RINTR:
114294d5c79dSMark Cave-Ayland         /*
114394d5c79dSMark Cave-Ayland          * Clear sequence step, interrupt register and all status bits
114494d5c79dSMark Cave-Ayland          * except TC
114594d5c79dSMark Cave-Ayland          */
1146b630c075SMark Cave-Ayland         val = s->rregs[ESP_RINTR];
114749ab747fSPaolo Bonzini         s->rregs[ESP_RINTR] = 0;
114849ab747fSPaolo Bonzini         s->rregs[ESP_RSTAT] &= ~STAT_TC;
1149af947a3dSMark Cave-Ayland         /*
1150af947a3dSMark Cave-Ayland          * According to the datasheet ESP_RSEQ should be cleared, but as the
1151af947a3dSMark Cave-Ayland          * emulation currently defers information transfers to the next TI
1152af947a3dSMark Cave-Ayland          * command leave it for now so that pedantic guests such as the old
1153af947a3dSMark Cave-Ayland          * Linux 2.6 driver see the correct flags before the next SCSI phase
1154af947a3dSMark Cave-Ayland          * transition.
1155af947a3dSMark Cave-Ayland          *
1156af947a3dSMark Cave-Ayland          * s->rregs[ESP_RSEQ] = SEQ_0;
1157af947a3dSMark Cave-Ayland          */
115849ab747fSPaolo Bonzini         esp_lower_irq(s);
1159b630c075SMark Cave-Ayland         break;
1160c9cf45c1SHannes Reinecke     case ESP_TCHI:
1161c9cf45c1SHannes Reinecke         /* Return the unique id if the value has never been written */
1162c9cf45c1SHannes Reinecke         if (!s->tchi_written) {
1163b630c075SMark Cave-Ayland             val = s->chip_id;
1164b630c075SMark Cave-Ayland         } else {
1165b630c075SMark Cave-Ayland             val = s->rregs[saddr];
1166c9cf45c1SHannes Reinecke         }
1167b630c075SMark Cave-Ayland         break;
1168238ec4d7SMark Cave-Ayland      case ESP_RFLAGS:
1169238ec4d7SMark Cave-Ayland         /* Bottom 5 bits indicate number of bytes in FIFO */
1170238ec4d7SMark Cave-Ayland         val = fifo8_num_used(&s->fifo);
1171238ec4d7SMark Cave-Ayland         break;
117249ab747fSPaolo Bonzini     default:
1173b630c075SMark Cave-Ayland         val = s->rregs[saddr];
117449ab747fSPaolo Bonzini         break;
117549ab747fSPaolo Bonzini     }
1176b630c075SMark Cave-Ayland 
1177b630c075SMark Cave-Ayland     trace_esp_mem_readb(saddr, val);
1178b630c075SMark Cave-Ayland     return val;
117949ab747fSPaolo Bonzini }
118049ab747fSPaolo Bonzini 
118149ab747fSPaolo Bonzini void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val)
118249ab747fSPaolo Bonzini {
118349ab747fSPaolo Bonzini     trace_esp_mem_writeb(saddr, s->wregs[saddr], val);
118449ab747fSPaolo Bonzini     switch (saddr) {
1185c9cf45c1SHannes Reinecke     case ESP_TCHI:
1186c9cf45c1SHannes Reinecke         s->tchi_written = true;
1187c9cf45c1SHannes Reinecke         /* fall through */
118849ab747fSPaolo Bonzini     case ESP_TCLO:
118949ab747fSPaolo Bonzini     case ESP_TCMID:
119049ab747fSPaolo Bonzini         s->rregs[ESP_RSTAT] &= ~STAT_TC;
119149ab747fSPaolo Bonzini         break;
119249ab747fSPaolo Bonzini     case ESP_FIFO:
119349ab747fSPaolo Bonzini         if (s->do_cmd) {
11942572689bSMark Cave-Ayland             if (!fifo8_is_full(&s->fifo)) {
11952572689bSMark Cave-Ayland                 esp_fifo_push(&s->fifo, val);
11962572689bSMark Cave-Ayland                 esp_fifo_push(&s->cmdfifo, fifo8_pop(&s->fifo));
11972572689bSMark Cave-Ayland             }
11986ef2cabcSMark Cave-Ayland 
11996ef2cabcSMark Cave-Ayland             /*
12006ef2cabcSMark Cave-Ayland              * If any unexpected message out/command phase data is
12016ef2cabcSMark Cave-Ayland              * transferred using non-DMA, raise the interrupt
12026ef2cabcSMark Cave-Ayland              */
12036ef2cabcSMark Cave-Ayland             if (s->rregs[ESP_CMD] == CMD_TI) {
12046ef2cabcSMark Cave-Ayland                 s->rregs[ESP_RINTR] |= INTR_BS;
12056ef2cabcSMark Cave-Ayland                 esp_raise_irq(s);
12066ef2cabcSMark Cave-Ayland             }
120749ab747fSPaolo Bonzini         } else {
1208e5455b8cSMark Cave-Ayland             esp_fifo_push(&s->fifo, val);
120949ab747fSPaolo Bonzini         }
121049ab747fSPaolo Bonzini         break;
121149ab747fSPaolo Bonzini     case ESP_CMD:
121249ab747fSPaolo Bonzini         s->rregs[saddr] = val;
1213f21fe39dSMark Cave-Ayland         esp_run_cmd(s);
121449ab747fSPaolo Bonzini         break;
121549ab747fSPaolo Bonzini     case ESP_WBUSID ... ESP_WSYNO:
121649ab747fSPaolo Bonzini         break;
121749ab747fSPaolo Bonzini     case ESP_CFG1:
121849ab747fSPaolo Bonzini     case ESP_CFG2: case ESP_CFG3:
121949ab747fSPaolo Bonzini     case ESP_RES3: case ESP_RES4:
122049ab747fSPaolo Bonzini         s->rregs[saddr] = val;
122149ab747fSPaolo Bonzini         break;
122249ab747fSPaolo Bonzini     case ESP_WCCF ... ESP_WTEST:
122349ab747fSPaolo Bonzini         break;
122449ab747fSPaolo Bonzini     default:
122549ab747fSPaolo Bonzini         trace_esp_error_invalid_write(val, saddr);
122649ab747fSPaolo Bonzini         return;
122749ab747fSPaolo Bonzini     }
122849ab747fSPaolo Bonzini     s->wregs[saddr] = val;
122949ab747fSPaolo Bonzini }
123049ab747fSPaolo Bonzini 
123149ab747fSPaolo Bonzini static bool esp_mem_accepts(void *opaque, hwaddr addr,
12328372d383SPeter Maydell                             unsigned size, bool is_write,
12338372d383SPeter Maydell                             MemTxAttrs attrs)
123449ab747fSPaolo Bonzini {
123549ab747fSPaolo Bonzini     return (size == 1) || (is_write && size == 4);
123649ab747fSPaolo Bonzini }
123749ab747fSPaolo Bonzini 
12386cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id)
12396cc88d6bSMark Cave-Ayland {
12406cc88d6bSMark Cave-Ayland     ESPState *s = ESP(opaque);
12416cc88d6bSMark Cave-Ayland 
12426cc88d6bSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12436cc88d6bSMark Cave-Ayland     return version_id < 5;
12446cc88d6bSMark Cave-Ayland }
12456cc88d6bSMark Cave-Ayland 
12464e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id)
12474e78f3bfSMark Cave-Ayland {
12484e78f3bfSMark Cave-Ayland     ESPState *s = ESP(opaque);
12494e78f3bfSMark Cave-Ayland 
12504e78f3bfSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12510bcd5a18SMark Cave-Ayland     return version_id >= 5;
12524e78f3bfSMark Cave-Ayland }
12534e78f3bfSMark Cave-Ayland 
12544eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id)
12554eb86065SPaolo Bonzini {
12564eb86065SPaolo Bonzini     ESPState *s = ESP(opaque);
12574eb86065SPaolo Bonzini 
12584eb86065SPaolo Bonzini     version_id = MIN(version_id, s->mig_version_id);
12594eb86065SPaolo Bonzini     return version_id >= 6;
12604eb86065SPaolo Bonzini }
12614eb86065SPaolo Bonzini 
1262ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque)
12630bd005beSMark Cave-Ayland {
1264ff4a1dabSMark Cave-Ayland     ESPState *s = ESP(object_resolve_path_component(
1265ff4a1dabSMark Cave-Ayland                       OBJECT(opaque), "esp"));
12660bd005beSMark Cave-Ayland 
12670bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
12680bd005beSMark Cave-Ayland     return 0;
12690bd005beSMark Cave-Ayland }
12700bd005beSMark Cave-Ayland 
12710bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id)
12720bd005beSMark Cave-Ayland {
12730bd005beSMark Cave-Ayland     ESPState *s = ESP(opaque);
1274042879fcSMark Cave-Ayland     int len, i;
12750bd005beSMark Cave-Ayland 
12766cc88d6bSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12776cc88d6bSMark Cave-Ayland 
12786cc88d6bSMark Cave-Ayland     if (version_id < 5) {
12796cc88d6bSMark Cave-Ayland         esp_set_tc(s, s->mig_dma_left);
1280042879fcSMark Cave-Ayland 
1281042879fcSMark Cave-Ayland         /* Migrate ti_buf to fifo */
1282042879fcSMark Cave-Ayland         len = s->mig_ti_wptr - s->mig_ti_rptr;
1283042879fcSMark Cave-Ayland         for (i = 0; i < len; i++) {
1284042879fcSMark Cave-Ayland             fifo8_push(&s->fifo, s->mig_ti_buf[i]);
1285042879fcSMark Cave-Ayland         }
1286023666daSMark Cave-Ayland 
1287023666daSMark Cave-Ayland         /* Migrate cmdbuf to cmdfifo */
1288023666daSMark Cave-Ayland         for (i = 0; i < s->mig_cmdlen; i++) {
1289023666daSMark Cave-Ayland             fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]);
1290023666daSMark Cave-Ayland         }
12916cc88d6bSMark Cave-Ayland     }
12926cc88d6bSMark Cave-Ayland 
12930bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
12940bd005beSMark Cave-Ayland     return 0;
12950bd005beSMark Cave-Ayland }
12960bd005beSMark Cave-Ayland 
1297eda59b39SMark Cave-Ayland /*
1298eda59b39SMark Cave-Ayland  * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the
1299eda59b39SMark Cave-Ayland  * guest CPU to perform the transfers between the SCSI bus and memory
1300eda59b39SMark Cave-Ayland  * itself. This is indicated by the dma_memory_read and dma_memory_write
1301eda59b39SMark Cave-Ayland  * functions being NULL (in contrast to the ESP PCI device) whilst
1302eda59b39SMark Cave-Ayland  * dma_enabled is still set.
1303eda59b39SMark Cave-Ayland  */
1304eda59b39SMark Cave-Ayland 
1305eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque)
1306eda59b39SMark Cave-Ayland {
1307eda59b39SMark Cave-Ayland     ESPState *s = ESP(opaque);
1308eda59b39SMark Cave-Ayland 
1309eda59b39SMark Cave-Ayland     return s->dma_memory_read == NULL && s->dma_memory_write == NULL &&
1310eda59b39SMark Cave-Ayland            s->dma_enabled;
1311eda59b39SMark Cave-Ayland }
1312eda59b39SMark Cave-Ayland 
1313eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = {
1314eda59b39SMark Cave-Ayland     .name = "esp/pdma",
1315eda59b39SMark Cave-Ayland     .version_id = 0,
1316eda59b39SMark Cave-Ayland     .minimum_version_id = 0,
1317eda59b39SMark Cave-Ayland     .needed = esp_pdma_needed,
13182d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
1319eda59b39SMark Cave-Ayland         VMSTATE_UINT8(pdma_cb, ESPState),
1320eda59b39SMark Cave-Ayland         VMSTATE_END_OF_LIST()
1321eda59b39SMark Cave-Ayland     }
1322eda59b39SMark Cave-Ayland };
1323eda59b39SMark Cave-Ayland 
132449ab747fSPaolo Bonzini const VMStateDescription vmstate_esp = {
132549ab747fSPaolo Bonzini     .name = "esp",
13264eb86065SPaolo Bonzini     .version_id = 6,
132749ab747fSPaolo Bonzini     .minimum_version_id = 3,
13280bd005beSMark Cave-Ayland     .post_load = esp_post_load,
13292d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
133049ab747fSPaolo Bonzini         VMSTATE_BUFFER(rregs, ESPState),
133149ab747fSPaolo Bonzini         VMSTATE_BUFFER(wregs, ESPState),
133249ab747fSPaolo Bonzini         VMSTATE_INT32(ti_size, ESPState),
1333042879fcSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5),
1334042879fcSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5),
1335042879fcSMark Cave-Ayland         VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5),
133649ab747fSPaolo Bonzini         VMSTATE_UINT32(status, ESPState),
13374aaa6ac3SMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_deferred_status, ESPState,
13384aaa6ac3SMark Cave-Ayland                             esp_is_before_version_5),
13394aaa6ac3SMark Cave-Ayland         VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState,
13404aaa6ac3SMark Cave-Ayland                           esp_is_before_version_5),
134149ab747fSPaolo Bonzini         VMSTATE_UINT32(dma, ESPState),
1342023666daSMark Cave-Ayland         VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0,
1343023666daSMark Cave-Ayland                               esp_is_before_version_5, 0, 16),
1344023666daSMark Cave-Ayland         VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4,
1345023666daSMark Cave-Ayland                               esp_is_before_version_5, 16,
1346023666daSMark Cave-Ayland                               sizeof(typeof_field(ESPState, mig_cmdbuf))),
1347023666daSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5),
134849ab747fSPaolo Bonzini         VMSTATE_UINT32(do_cmd, ESPState),
13496cc88d6bSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5),
13504e78f3bfSMark Cave-Ayland         VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5),
1351023666daSMark Cave-Ayland         VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5),
1352042879fcSMark Cave-Ayland         VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5),
1353023666daSMark Cave-Ayland         VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5),
13541b9e48a5SMark Cave-Ayland         VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5),
13554eb86065SPaolo Bonzini         VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6),
135649ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
135774d71ea1SLaurent Vivier     },
13582d7b39a6SRichard Henderson     .subsections = (const VMStateDescription * const []) {
1359eda59b39SMark Cave-Ayland         &vmstate_esp_pdma,
1360eda59b39SMark Cave-Ayland         NULL
1361eda59b39SMark Cave-Ayland     }
136249ab747fSPaolo Bonzini };
136349ab747fSPaolo Bonzini 
136449ab747fSPaolo Bonzini static void sysbus_esp_mem_write(void *opaque, hwaddr addr,
136549ab747fSPaolo Bonzini                                  uint64_t val, unsigned int size)
136649ab747fSPaolo Bonzini {
136749ab747fSPaolo Bonzini     SysBusESPState *sysbus = opaque;
1368eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
136949ab747fSPaolo Bonzini     uint32_t saddr;
137049ab747fSPaolo Bonzini 
137149ab747fSPaolo Bonzini     saddr = addr >> sysbus->it_shift;
1372eb169c76SMark Cave-Ayland     esp_reg_write(s, saddr, val);
137349ab747fSPaolo Bonzini }
137449ab747fSPaolo Bonzini 
137549ab747fSPaolo Bonzini static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr,
137649ab747fSPaolo Bonzini                                     unsigned int size)
137749ab747fSPaolo Bonzini {
137849ab747fSPaolo Bonzini     SysBusESPState *sysbus = opaque;
1379eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
138049ab747fSPaolo Bonzini     uint32_t saddr;
138149ab747fSPaolo Bonzini 
138249ab747fSPaolo Bonzini     saddr = addr >> sysbus->it_shift;
1383eb169c76SMark Cave-Ayland     return esp_reg_read(s, saddr);
138449ab747fSPaolo Bonzini }
138549ab747fSPaolo Bonzini 
138649ab747fSPaolo Bonzini static const MemoryRegionOps sysbus_esp_mem_ops = {
138749ab747fSPaolo Bonzini     .read = sysbus_esp_mem_read,
138849ab747fSPaolo Bonzini     .write = sysbus_esp_mem_write,
138949ab747fSPaolo Bonzini     .endianness = DEVICE_NATIVE_ENDIAN,
139049ab747fSPaolo Bonzini     .valid.accepts = esp_mem_accepts,
139149ab747fSPaolo Bonzini };
139249ab747fSPaolo Bonzini 
139374d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
139474d71ea1SLaurent Vivier                                   uint64_t val, unsigned int size)
139574d71ea1SLaurent Vivier {
139674d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
1397eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
139874d71ea1SLaurent Vivier 
1399960ebfd9SMark Cave-Ayland     trace_esp_pdma_write(size);
1400960ebfd9SMark Cave-Ayland 
140174d71ea1SLaurent Vivier     switch (size) {
140274d71ea1SLaurent Vivier     case 1:
1403761bef75SMark Cave-Ayland         esp_pdma_write(s, val);
140474d71ea1SLaurent Vivier         break;
140574d71ea1SLaurent Vivier     case 2:
1406761bef75SMark Cave-Ayland         esp_pdma_write(s, val >> 8);
1407761bef75SMark Cave-Ayland         esp_pdma_write(s, val);
140874d71ea1SLaurent Vivier         break;
140974d71ea1SLaurent Vivier     }
1410d0243b09SMark Cave-Ayland     esp_pdma_cb(s);
141174d71ea1SLaurent Vivier }
141274d71ea1SLaurent Vivier 
141374d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
141474d71ea1SLaurent Vivier                                      unsigned int size)
141574d71ea1SLaurent Vivier {
141674d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
1417eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
141874d71ea1SLaurent Vivier     uint64_t val = 0;
141974d71ea1SLaurent Vivier 
1420960ebfd9SMark Cave-Ayland     trace_esp_pdma_read(size);
1421960ebfd9SMark Cave-Ayland 
142274d71ea1SLaurent Vivier     switch (size) {
142374d71ea1SLaurent Vivier     case 1:
1424761bef75SMark Cave-Ayland         val = esp_pdma_read(s);
142574d71ea1SLaurent Vivier         break;
142674d71ea1SLaurent Vivier     case 2:
1427761bef75SMark Cave-Ayland         val = esp_pdma_read(s);
1428761bef75SMark Cave-Ayland         val = (val << 8) | esp_pdma_read(s);
142974d71ea1SLaurent Vivier         break;
143074d71ea1SLaurent Vivier     }
1431d0243b09SMark Cave-Ayland     esp_pdma_cb(s);
143274d71ea1SLaurent Vivier     return val;
143374d71ea1SLaurent Vivier }
143474d71ea1SLaurent Vivier 
1435a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req)
1436a7a22088SMark Cave-Ayland {
1437a7a22088SMark Cave-Ayland     ESPState *s = container_of(req->bus, ESPState, bus);
1438a7a22088SMark Cave-Ayland 
1439a7a22088SMark Cave-Ayland     scsi_req_ref(req);
1440a7a22088SMark Cave-Ayland     s->current_req = req;
1441a7a22088SMark Cave-Ayland     return s;
1442a7a22088SMark Cave-Ayland }
1443a7a22088SMark Cave-Ayland 
144474d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = {
144574d71ea1SLaurent Vivier     .read = sysbus_esp_pdma_read,
144674d71ea1SLaurent Vivier     .write = sysbus_esp_pdma_write,
144774d71ea1SLaurent Vivier     .endianness = DEVICE_NATIVE_ENDIAN,
144874d71ea1SLaurent Vivier     .valid.min_access_size = 1,
1449cf1b8286SMark Cave-Ayland     .valid.max_access_size = 4,
1450cf1b8286SMark Cave-Ayland     .impl.min_access_size = 1,
1451cf1b8286SMark Cave-Ayland     .impl.max_access_size = 2,
145274d71ea1SLaurent Vivier };
145374d71ea1SLaurent Vivier 
145449ab747fSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = {
145549ab747fSPaolo Bonzini     .tcq = false,
145649ab747fSPaolo Bonzini     .max_target = ESP_MAX_DEVS,
145749ab747fSPaolo Bonzini     .max_lun = 7,
145849ab747fSPaolo Bonzini 
1459a7a22088SMark Cave-Ayland     .load_request = esp_load_request,
146049ab747fSPaolo Bonzini     .transfer_data = esp_transfer_data,
146149ab747fSPaolo Bonzini     .complete = esp_command_complete,
146249ab747fSPaolo Bonzini     .cancel = esp_request_cancelled
146349ab747fSPaolo Bonzini };
146449ab747fSPaolo Bonzini 
146549ab747fSPaolo Bonzini static void sysbus_esp_gpio_demux(void *opaque, int irq, int level)
146649ab747fSPaolo Bonzini {
146784fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(opaque);
1468eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
146949ab747fSPaolo Bonzini 
147049ab747fSPaolo Bonzini     switch (irq) {
147149ab747fSPaolo Bonzini     case 0:
147249ab747fSPaolo Bonzini         parent_esp_reset(s, irq, level);
147349ab747fSPaolo Bonzini         break;
147449ab747fSPaolo Bonzini     case 1:
1475b86dc5cbSMark Cave-Ayland         esp_dma_enable(s, irq, level);
147649ab747fSPaolo Bonzini         break;
147749ab747fSPaolo Bonzini     }
147849ab747fSPaolo Bonzini }
147949ab747fSPaolo Bonzini 
1480b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp)
148149ab747fSPaolo Bonzini {
1482b09318caSHu Tao     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
148384fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1484eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1485eb169c76SMark Cave-Ayland 
1486eb169c76SMark Cave-Ayland     if (!qdev_realize(DEVICE(s), NULL, errp)) {
1487eb169c76SMark Cave-Ayland         return;
1488eb169c76SMark Cave-Ayland     }
148949ab747fSPaolo Bonzini 
1490b09318caSHu Tao     sysbus_init_irq(sbd, &s->irq);
149174d71ea1SLaurent Vivier     sysbus_init_irq(sbd, &s->irq_data);
149249ab747fSPaolo Bonzini     assert(sysbus->it_shift != -1);
149349ab747fSPaolo Bonzini 
149449ab747fSPaolo Bonzini     s->chip_id = TCHI_FAS100A;
149529776739SPaolo Bonzini     memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops,
149674d71ea1SLaurent Vivier                           sysbus, "esp-regs", ESP_REGS << sysbus->it_shift);
1497b09318caSHu Tao     sysbus_init_mmio(sbd, &sysbus->iomem);
149874d71ea1SLaurent Vivier     memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops,
1499cf1b8286SMark Cave-Ayland                           sysbus, "esp-pdma", 4);
150074d71ea1SLaurent Vivier     sysbus_init_mmio(sbd, &sysbus->pdma);
150149ab747fSPaolo Bonzini 
1502b09318caSHu Tao     qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2);
150349ab747fSPaolo Bonzini 
1504739e95f5SPeter Maydell     scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info);
150549ab747fSPaolo Bonzini }
150649ab747fSPaolo Bonzini 
150749ab747fSPaolo Bonzini static void sysbus_esp_hard_reset(DeviceState *dev)
150849ab747fSPaolo Bonzini {
150984fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1510eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1511eb169c76SMark Cave-Ayland 
1512eb169c76SMark Cave-Ayland     esp_hard_reset(s);
1513eb169c76SMark Cave-Ayland }
1514eb169c76SMark Cave-Ayland 
1515eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj)
1516eb169c76SMark Cave-Ayland {
1517eb169c76SMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(obj);
1518eb169c76SMark Cave-Ayland 
1519eb169c76SMark Cave-Ayland     object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP);
152049ab747fSPaolo Bonzini }
152149ab747fSPaolo Bonzini 
152249ab747fSPaolo Bonzini static const VMStateDescription vmstate_sysbus_esp_scsi = {
152349ab747fSPaolo Bonzini     .name = "sysbusespscsi",
15240bd005beSMark Cave-Ayland     .version_id = 2,
1525ea84a442SGuenter Roeck     .minimum_version_id = 1,
1526ff4a1dabSMark Cave-Ayland     .pre_save = esp_pre_save,
15272d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
15280bd005beSMark Cave-Ayland         VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2),
152949ab747fSPaolo Bonzini         VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState),
153049ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
153149ab747fSPaolo Bonzini     }
153249ab747fSPaolo Bonzini };
153349ab747fSPaolo Bonzini 
153449ab747fSPaolo Bonzini static void sysbus_esp_class_init(ObjectClass *klass, void *data)
153549ab747fSPaolo Bonzini {
153649ab747fSPaolo Bonzini     DeviceClass *dc = DEVICE_CLASS(klass);
153749ab747fSPaolo Bonzini 
1538b09318caSHu Tao     dc->realize = sysbus_esp_realize;
153949ab747fSPaolo Bonzini     dc->reset = sysbus_esp_hard_reset;
154049ab747fSPaolo Bonzini     dc->vmsd = &vmstate_sysbus_esp_scsi;
1541125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
154249ab747fSPaolo Bonzini }
154349ab747fSPaolo Bonzini 
154449ab747fSPaolo Bonzini static const TypeInfo sysbus_esp_info = {
154584fbefedSMark Cave-Ayland     .name          = TYPE_SYSBUS_ESP,
154649ab747fSPaolo Bonzini     .parent        = TYPE_SYS_BUS_DEVICE,
1547eb169c76SMark Cave-Ayland     .instance_init = sysbus_esp_init,
154849ab747fSPaolo Bonzini     .instance_size = sizeof(SysBusESPState),
154949ab747fSPaolo Bonzini     .class_init    = sysbus_esp_class_init,
155049ab747fSPaolo Bonzini };
155149ab747fSPaolo Bonzini 
1552042879fcSMark Cave-Ayland static void esp_finalize(Object *obj)
1553042879fcSMark Cave-Ayland {
1554042879fcSMark Cave-Ayland     ESPState *s = ESP(obj);
1555042879fcSMark Cave-Ayland 
1556042879fcSMark Cave-Ayland     fifo8_destroy(&s->fifo);
1557023666daSMark Cave-Ayland     fifo8_destroy(&s->cmdfifo);
1558042879fcSMark Cave-Ayland }
1559042879fcSMark Cave-Ayland 
1560042879fcSMark Cave-Ayland static void esp_init(Object *obj)
1561042879fcSMark Cave-Ayland {
1562042879fcSMark Cave-Ayland     ESPState *s = ESP(obj);
1563042879fcSMark Cave-Ayland 
1564042879fcSMark Cave-Ayland     fifo8_create(&s->fifo, ESP_FIFO_SZ);
1565023666daSMark Cave-Ayland     fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ);
1566042879fcSMark Cave-Ayland }
1567042879fcSMark Cave-Ayland 
1568eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data)
1569eb169c76SMark Cave-Ayland {
1570eb169c76SMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(klass);
1571eb169c76SMark Cave-Ayland 
1572eb169c76SMark Cave-Ayland     /* internal device for sysbusesp/pciespscsi, not user-creatable */
1573eb169c76SMark Cave-Ayland     dc->user_creatable = false;
1574eb169c76SMark Cave-Ayland     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
1575eb169c76SMark Cave-Ayland }
1576eb169c76SMark Cave-Ayland 
1577eb169c76SMark Cave-Ayland static const TypeInfo esp_info = {
1578eb169c76SMark Cave-Ayland     .name = TYPE_ESP,
1579eb169c76SMark Cave-Ayland     .parent = TYPE_DEVICE,
1580042879fcSMark Cave-Ayland     .instance_init = esp_init,
1581042879fcSMark Cave-Ayland     .instance_finalize = esp_finalize,
1582eb169c76SMark Cave-Ayland     .instance_size = sizeof(ESPState),
1583eb169c76SMark Cave-Ayland     .class_init = esp_class_init,
1584eb169c76SMark Cave-Ayland };
1585eb169c76SMark Cave-Ayland 
158649ab747fSPaolo Bonzini static void esp_register_types(void)
158749ab747fSPaolo Bonzini {
158849ab747fSPaolo Bonzini     type_register_static(&sysbus_esp_info);
1589eb169c76SMark Cave-Ayland     type_register_static(&esp_info);
159049ab747fSPaolo Bonzini }
159149ab747fSPaolo Bonzini 
159249ab747fSPaolo Bonzini type_init(esp_register_types)
1593