xref: /qemu/hw/scsi/esp.c (revision 66fd5657338b7a1ca9c362a593e2daca5a9f4300)
16f7e9aecSbellard /*
267e999beSbellard  * QEMU ESP/NCR53C9x emulation
36f7e9aecSbellard  *
44e9aec74Spbrook  * Copyright (c) 2005-2006 Fabrice Bellard
5fabaaf1dSHervé Poussineau  * Copyright (c) 2012 Herve Poussineau
66f7e9aecSbellard  *
76f7e9aecSbellard  * Permission is hereby granted, free of charge, to any person obtaining a copy
86f7e9aecSbellard  * of this software and associated documentation files (the "Software"), to deal
96f7e9aecSbellard  * in the Software without restriction, including without limitation the rights
106f7e9aecSbellard  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
116f7e9aecSbellard  * copies of the Software, and to permit persons to whom the Software is
126f7e9aecSbellard  * furnished to do so, subject to the following conditions:
136f7e9aecSbellard  *
146f7e9aecSbellard  * The above copyright notice and this permission notice shall be included in
156f7e9aecSbellard  * all copies or substantial portions of the Software.
166f7e9aecSbellard  *
176f7e9aecSbellard  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
186f7e9aecSbellard  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
196f7e9aecSbellard  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
206f7e9aecSbellard  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
216f7e9aecSbellard  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
226f7e9aecSbellard  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
236f7e9aecSbellard  * THE SOFTWARE.
246f7e9aecSbellard  */
255d20fa6bSblueswir1 
26a4ab4792SPeter Maydell #include "qemu/osdep.h"
2783c9f4caSPaolo Bonzini #include "hw/sysbus.h"
28d6454270SMarkus Armbruster #include "migration/vmstate.h"
2964552b6bSMarkus Armbruster #include "hw/irq.h"
300d09e41aSPaolo Bonzini #include "hw/scsi/esp.h"
31bf4b9889SBlue Swirl #include "trace.h"
321de7afc9SPaolo Bonzini #include "qemu/log.h"
330b8fa32fSMarkus Armbruster #include "qemu/module.h"
346f7e9aecSbellard 
3567e999beSbellard /*
365ad6bb97Sblueswir1  * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O),
375ad6bb97Sblueswir1  * also produced as NCR89C100. See
3867e999beSbellard  * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt
3967e999beSbellard  * and
4067e999beSbellard  * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt
4174d71ea1SLaurent Vivier  *
4274d71ea1SLaurent Vivier  * On Macintosh Quadra it is a NCR53C96.
4367e999beSbellard  */
4467e999beSbellard 
45c73f96fdSblueswir1 static void esp_raise_irq(ESPState *s)
46c73f96fdSblueswir1 {
47c73f96fdSblueswir1     if (!(s->rregs[ESP_RSTAT] & STAT_INT)) {
48c73f96fdSblueswir1         s->rregs[ESP_RSTAT] |= STAT_INT;
49c73f96fdSblueswir1         qemu_irq_raise(s->irq);
50bf4b9889SBlue Swirl         trace_esp_raise_irq();
51c73f96fdSblueswir1     }
52c73f96fdSblueswir1 }
53c73f96fdSblueswir1 
54c73f96fdSblueswir1 static void esp_lower_irq(ESPState *s)
55c73f96fdSblueswir1 {
56c73f96fdSblueswir1     if (s->rregs[ESP_RSTAT] & STAT_INT) {
57c73f96fdSblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_INT;
58c73f96fdSblueswir1         qemu_irq_lower(s->irq);
59bf4b9889SBlue Swirl         trace_esp_lower_irq();
60c73f96fdSblueswir1     }
61c73f96fdSblueswir1 }
62c73f96fdSblueswir1 
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 
759c7e23fcSHervé Poussineau void esp_dma_enable(ESPState *s, int irq, int level)
7673d74342SBlue Swirl {
7773d74342SBlue Swirl     if (level) {
7873d74342SBlue Swirl         s->dma_enabled = 1;
79bf4b9889SBlue Swirl         trace_esp_dma_enable();
8073d74342SBlue Swirl         if (s->dma_cb) {
8173d74342SBlue Swirl             s->dma_cb(s);
8273d74342SBlue Swirl             s->dma_cb = NULL;
8373d74342SBlue Swirl         }
8473d74342SBlue Swirl     } else {
85bf4b9889SBlue Swirl         trace_esp_dma_disable();
8673d74342SBlue Swirl         s->dma_enabled = 0;
8773d74342SBlue Swirl     }
8873d74342SBlue Swirl }
8973d74342SBlue Swirl 
909c7e23fcSHervé Poussineau void esp_request_cancelled(SCSIRequest *req)
9194d3f98aSPaolo Bonzini {
92e6810db8SHervé Poussineau     ESPState *s = req->hba_private;
9394d3f98aSPaolo Bonzini 
9494d3f98aSPaolo Bonzini     if (req == s->current_req) {
9594d3f98aSPaolo Bonzini         scsi_req_unref(s->current_req);
9694d3f98aSPaolo Bonzini         s->current_req = NULL;
9794d3f98aSPaolo Bonzini         s->current_dev = NULL;
98324c8809SMark Cave-Ayland         s->async_len = 0;
9994d3f98aSPaolo Bonzini     }
10094d3f98aSPaolo Bonzini }
10194d3f98aSPaolo 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)
2602f275b8fSbellard {
261023666daSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
262042879fcSMark Cave-Ayland     uint32_t dmalen, n;
2632f275b8fSbellard     int target;
2642f275b8fSbellard 
2658dea1dd4Sblueswir1     target = s->wregs[ESP_WBUSID] & BUSID_DID;
2664f6200f0Sbellard     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) {
2728b17de88Sblueswir1             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);
2764f6200f0Sbellard         } 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     }
288bf4b9889SBlue Swirl     trace_esp_get_cmd(dmalen, target);
2892e5d83bbSpbrook 
2909f149aa9Spbrook     return dmalen;
2919f149aa9Spbrook }
2929f149aa9Spbrook 
2934eb86065SPaolo Bonzini static void do_command_phase(ESPState *s)
2949f149aa9Spbrook {
2957b320a8eSMark Cave-Ayland     uint32_t cmdlen;
2969f149aa9Spbrook     int32_t datalen;
297f48a7a6eSPaolo Bonzini     SCSIDevice *current_lun;
2987b320a8eSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
2999f149aa9Spbrook 
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);
318c39ce112SPaolo Bonzini     datalen = scsi_req_enqueue(s->current_req);
31967e999beSbellard     s->ti_size = datalen;
320023666daSMark Cave-Ayland     fifo8_reset(&s->cmdfifo);
32167e999beSbellard     if (datalen != 0) {
3221b9e48a5SMark Cave-Ayland         s->ti_cmd = 0;
3232e5d83bbSpbrook         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);
3304f6200f0Sbellard         } else {
331abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_DO);
332cf47a41eSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
333c73f96fdSblueswir1             esp_raise_irq(s);
33482141c8bSMark Cave-Ayland             esp_lower_drq(s);
3352f275b8fSbellard         }
3364e78f3bfSMark Cave-Ayland         scsi_req_continue(s->current_req);
3374e78f3bfSMark Cave-Ayland         return;
3384e78f3bfSMark Cave-Ayland     }
3394e78f3bfSMark Cave-Ayland }
3402f275b8fSbellard 
3414eb86065SPaolo Bonzini static void do_message_phase(ESPState *s)
342f2818f22SArtyom Tarasenko {
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     }
350f2818f22SArtyom Tarasenko 
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);
364f2818f22SArtyom Tarasenko }
365f2818f22SArtyom Tarasenko 
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 
3839f149aa9Spbrook static void handle_satn(ESPState *s)
3849f149aa9Spbrook {
38549691315SMark Cave-Ayland     int32_t cmdlen;
38649691315SMark Cave-Ayland 
3871b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
38873d74342SBlue Swirl         s->dma_cb = handle_satn;
38973d74342SBlue Swirl         return;
39073d74342SBlue Swirl     }
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);
4089f149aa9Spbrook     }
40994d5c79dSMark Cave-Ayland }
4109f149aa9Spbrook 
411f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s)
412f2818f22SArtyom Tarasenko {
41349691315SMark Cave-Ayland     int32_t cmdlen;
41449691315SMark Cave-Ayland 
4151b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
41673d74342SBlue Swirl         s->dma_cb = handle_s_without_atn;
41773d74342SBlue Swirl         return;
41873d74342SBlue Swirl     }
419*66fd5657SMark Cave-Ayland     esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
4201bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
4211bcaf71bSMark Cave-Ayland         return;
4221bcaf71bSMark Cave-Ayland     }
423023666daSMark Cave-Ayland     cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
42449691315SMark Cave-Ayland     if (cmdlen > 0) {
425023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 0;
42660720694SMark Cave-Ayland         s->do_cmd = 0;
4274eb86065SPaolo Bonzini         do_cmd(s);
42849691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4291bcaf71bSMark Cave-Ayland         if (s->dma) {
4301bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4311bcaf71bSMark Cave-Ayland         }
432bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
43349691315SMark Cave-Ayland         /* Target present, but no cmd yet - switch to command phase */
43449691315SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_CD;
435abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
436f2818f22SArtyom Tarasenko     }
437f2818f22SArtyom Tarasenko }
438f2818f22SArtyom Tarasenko 
43974d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s)
44074d71ea1SLaurent Vivier {
4412572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
4422572689bSMark Cave-Ayland     int n;
4432572689bSMark Cave-Ayland 
4442572689bSMark Cave-Ayland     /* Copy FIFO into cmdfifo */
4452572689bSMark Cave-Ayland     n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
4462572689bSMark Cave-Ayland     n = MIN(fifo8_num_free(&s->cmdfifo), n);
4472572689bSMark Cave-Ayland     fifo8_push_all(&s->cmdfifo, buf, n);
4482572689bSMark Cave-Ayland 
449e62a959aSMark Cave-Ayland     if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) {
450023666daSMark Cave-Ayland         trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
45174d71ea1SLaurent Vivier         s->do_cmd = 1;
452023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
453abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
454abc139cdSMark Cave-Ayland         s->rregs[ESP_RSTAT] |= STAT_TC;
455cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
45674d71ea1SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_CD;
45774d71ea1SLaurent Vivier         esp_raise_irq(s);
45874d71ea1SLaurent Vivier     }
45974d71ea1SLaurent Vivier }
46074d71ea1SLaurent Vivier 
4619f149aa9Spbrook static void handle_satn_stop(ESPState *s)
4629f149aa9Spbrook {
46349691315SMark Cave-Ayland     int32_t cmdlen;
46449691315SMark Cave-Ayland 
4651b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
46673d74342SBlue Swirl         s->dma_cb = handle_satn_stop;
46773d74342SBlue Swirl         return;
46873d74342SBlue Swirl     }
46977987ef5SMark Cave-Ayland     esp_set_pdma_cb(s, SATN_STOP_PDMA_CB);
4701bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
4711bcaf71bSMark Cave-Ayland         return;
4721bcaf71bSMark Cave-Ayland     }
473799d90d8SMark Cave-Ayland     cmdlen = get_cmd(s, 1);
47449691315SMark Cave-Ayland     if (cmdlen > 0) {
475023666daSMark Cave-Ayland         trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
4769f149aa9Spbrook         s->do_cmd = 1;
477023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
478abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MO);
479cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
480799d90d8SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_MO;
481c73f96fdSblueswir1         esp_raise_irq(s);
48249691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4831bcaf71bSMark Cave-Ayland         if (s->dma) {
4841bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4851bcaf71bSMark Cave-Ayland         }
486bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
487799d90d8SMark Cave-Ayland         /* Target present, switch to message out phase */
488799d90d8SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_MO;
489abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MO);
4909f149aa9Spbrook     }
4919f149aa9Spbrook }
4929f149aa9Spbrook 
49374d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s)
49474d71ea1SLaurent Vivier {
495abc139cdSMark Cave-Ayland     esp_set_phase(s, STAT_ST);
496cf47a41eSMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
49774d71ea1SLaurent Vivier     s->rregs[ESP_RSEQ] = SEQ_CD;
49874d71ea1SLaurent Vivier     esp_raise_irq(s);
49974d71ea1SLaurent Vivier }
50074d71ea1SLaurent Vivier 
5010fc5c15aSpbrook static void write_response(ESPState *s)
5022f275b8fSbellard {
503e3922557SMark Cave-Ayland     uint8_t buf[2];
504042879fcSMark Cave-Ayland 
505bf4b9889SBlue Swirl     trace_esp_write_response(s->status);
506042879fcSMark Cave-Ayland 
507e3922557SMark Cave-Ayland     buf[0] = s->status;
508e3922557SMark Cave-Ayland     buf[1] = 0;
509042879fcSMark Cave-Ayland 
5104f6200f0Sbellard     if (s->dma) {
51174d71ea1SLaurent Vivier         if (s->dma_memory_write) {
512e3922557SMark Cave-Ayland             s->dma_memory_write(s->dma_opaque, buf, 2);
513abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_ST);
514cf47a41eSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
5155ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = SEQ_CD;
5164f6200f0Sbellard         } else {
51777987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB);
51874d71ea1SLaurent Vivier             esp_raise_drq(s);
51974d71ea1SLaurent Vivier             return;
52074d71ea1SLaurent Vivier         }
52174d71ea1SLaurent Vivier     } else {
522e3922557SMark Cave-Ayland         fifo8_reset(&s->fifo);
523e3922557SMark Cave-Ayland         fifo8_push_all(&s->fifo, buf, 2);
5245ad6bb97Sblueswir1         s->rregs[ESP_RFLAGS] = 2;
5254f6200f0Sbellard     }
526c73f96fdSblueswir1     esp_raise_irq(s);
5272f275b8fSbellard }
5284f6200f0Sbellard 
529004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s)
5304d611c9aSpbrook {
531af74b3c1SMark Cave-Ayland     if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) {
532cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
533c73f96fdSblueswir1         esp_raise_irq(s);
534af74b3c1SMark Cave-Ayland         esp_lower_drq(s);
535af74b3c1SMark Cave-Ayland     }
5364d611c9aSpbrook }
537a917d384Spbrook 
53874d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s)
53974d71ea1SLaurent Vivier {
5404ca2ba6fSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
5412572689bSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
54282141c8bSMark Cave-Ayland     int len;
543042879fcSMark Cave-Ayland     uint32_t n;
5446cc88d6bSMark Cave-Ayland 
54574d71ea1SLaurent Vivier     if (s->do_cmd) {
5462572689bSMark Cave-Ayland         /* Copy FIFO into cmdfifo */
5472572689bSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
5482572689bSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
5492572689bSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
5502572689bSMark Cave-Ayland 
551e62a959aSMark Cave-Ayland         /* Ensure we have received complete command after SATN and stop */
552e62a959aSMark Cave-Ayland         if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) {
553e62a959aSMark Cave-Ayland             return;
554e62a959aSMark Cave-Ayland         }
555e62a959aSMark Cave-Ayland 
55674d71ea1SLaurent Vivier         s->ti_size = 0;
557c348458fSMark Cave-Ayland         if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) {
558c348458fSMark Cave-Ayland             /* No command received */
559c348458fSMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
560c348458fSMark Cave-Ayland                 return;
561c348458fSMark Cave-Ayland             }
562c348458fSMark Cave-Ayland 
563c348458fSMark Cave-Ayland             /* Command has been received */
56474d71ea1SLaurent Vivier             s->do_cmd = 0;
565c959f218SMark Cave-Ayland             do_cmd(s);
566c348458fSMark Cave-Ayland         } else {
567c348458fSMark Cave-Ayland             /*
568c348458fSMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
5692cb40d44SStefan Weil              * and then switch to command phase
570c348458fSMark Cave-Ayland              */
571c348458fSMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
572abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
573c348458fSMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
574c348458fSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
575c348458fSMark Cave-Ayland             esp_raise_irq(s);
576c348458fSMark Cave-Ayland         }
57774d71ea1SLaurent Vivier         return;
57874d71ea1SLaurent Vivier     }
57982141c8bSMark Cave-Ayland 
5800db89536SMark Cave-Ayland     if (!s->current_req) {
5810db89536SMark Cave-Ayland         return;
5820db89536SMark Cave-Ayland     }
5830db89536SMark Cave-Ayland 
58482141c8bSMark Cave-Ayland     if (to_device) {
58582141c8bSMark Cave-Ayland         /* Copy FIFO data to device */
5867aa6baeeSMark Cave-Ayland         len = MIN(s->async_len, ESP_FIFO_SZ);
5877aa6baeeSMark Cave-Ayland         len = MIN(len, fifo8_num_used(&s->fifo));
5887b320a8eSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
5897aa6baeeSMark Cave-Ayland         s->async_buf += n;
5907aa6baeeSMark Cave-Ayland         s->async_len -= n;
5917aa6baeeSMark Cave-Ayland         s->ti_size += n;
5927aa6baeeSMark Cave-Ayland 
593e4e166c8SMark Cave-Ayland         if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
594e4e166c8SMark Cave-Ayland             /* Defer until the scsi layer has completed */
59574d71ea1SLaurent Vivier             scsi_req_continue(s->current_req);
59682141c8bSMark Cave-Ayland             return;
59782141c8bSMark Cave-Ayland         }
59882141c8bSMark Cave-Ayland 
599004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
60082141c8bSMark Cave-Ayland     } else {
60182141c8bSMark Cave-Ayland         /* Copy device data to FIFO */
6027aa6baeeSMark Cave-Ayland         len = MIN(s->async_len, esp_get_tc(s));
6037aa6baeeSMark Cave-Ayland         len = MIN(len, fifo8_num_free(&s->fifo));
604042879fcSMark Cave-Ayland         fifo8_push_all(&s->fifo, s->async_buf, len);
60582141c8bSMark Cave-Ayland         s->async_buf += len;
60682141c8bSMark Cave-Ayland         s->async_len -= len;
60782141c8bSMark Cave-Ayland         s->ti_size -= len;
60882141c8bSMark Cave-Ayland         esp_set_tc(s, esp_get_tc(s) - len);
6091b2e34caSMark Cave-Ayland 
6101b2e34caSMark Cave-Ayland         if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
6111b2e34caSMark Cave-Ayland             /* Defer until the scsi layer has completed */
6121b2e34caSMark Cave-Ayland             scsi_req_continue(s->current_req);
6131b2e34caSMark Cave-Ayland             s->data_in_ready = false;
6141b2e34caSMark Cave-Ayland             return;
6151b2e34caSMark Cave-Ayland         }
6161b2e34caSMark Cave-Ayland 
6171b2e34caSMark Cave-Ayland         esp_dma_ti_check(s);
61874d71ea1SLaurent Vivier     }
61982141c8bSMark Cave-Ayland }
62074d71ea1SLaurent Vivier 
621a917d384Spbrook static void esp_do_dma(ESPState *s)
622a917d384Spbrook {
623023666daSMark Cave-Ayland     uint32_t len, cmdlen;
6244ca2ba6fSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
625023666daSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
62619e9afb1SMark Cave-Ayland     int n;
627a917d384Spbrook 
6286cc88d6bSMark Cave-Ayland     len = esp_get_tc(s);
629a917d384Spbrook     if (s->do_cmd) {
63015407433SLaurent Vivier         /*
63115407433SLaurent Vivier          * handle_ti_cmd() case: esp_do_dma() is called only from
63215407433SLaurent Vivier          * handle_ti_cmd() with do_cmd != NULL (see the assert())
63315407433SLaurent Vivier          */
634023666daSMark Cave-Ayland         cmdlen = fifo8_num_used(&s->cmdfifo);
635023666daSMark Cave-Ayland         trace_esp_do_dma(cmdlen, len);
63674d71ea1SLaurent Vivier         if (s->dma_memory_read) {
6370ebb5fd8SMark Cave-Ayland             len = MIN(len, fifo8_num_free(&s->cmdfifo));
638023666daSMark Cave-Ayland             s->dma_memory_read(s->dma_opaque, buf, len);
639023666daSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, len);
640a0347651SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
64174d71ea1SLaurent Vivier         } else {
6423c7f3c8bSMark Cave-Ayland             n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
6433c7f3c8bSMark Cave-Ayland             n = MIN(fifo8_num_free(&s->cmdfifo), n);
6443c7f3c8bSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, n);
6453c7f3c8bSMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - n);
6463c7f3c8bSMark Cave-Ayland 
64777987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
64874d71ea1SLaurent Vivier             esp_raise_drq(s);
6493c7f3c8bSMark Cave-Ayland 
6503c7f3c8bSMark Cave-Ayland             /* Ensure we have received complete command after SATN and stop */
6513c7f3c8bSMark Cave-Ayland             if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) {
65274d71ea1SLaurent Vivier                 return;
65374d71ea1SLaurent Vivier             }
6543c7f3c8bSMark Cave-Ayland         }
655023666daSMark Cave-Ayland         trace_esp_handle_ti_cmd(cmdlen);
65615407433SLaurent Vivier         s->ti_size = 0;
657799d90d8SMark Cave-Ayland         if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) {
658799d90d8SMark Cave-Ayland             /* No command received */
659023666daSMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
660799d90d8SMark Cave-Ayland                 return;
661799d90d8SMark Cave-Ayland             }
662799d90d8SMark Cave-Ayland 
663799d90d8SMark Cave-Ayland             /* Command has been received */
66415407433SLaurent Vivier             s->do_cmd = 0;
665c959f218SMark Cave-Ayland             do_cmd(s);
666799d90d8SMark Cave-Ayland         } else {
667799d90d8SMark Cave-Ayland             /*
668023666daSMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
6692cb40d44SStefan Weil              * and then switch to command phase
670799d90d8SMark Cave-Ayland              */
671023666daSMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
672abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
673799d90d8SMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
674799d90d8SMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
675799d90d8SMark Cave-Ayland             esp_raise_irq(s);
676799d90d8SMark Cave-Ayland         }
677a917d384Spbrook         return;
678a917d384Spbrook     }
6790db89536SMark Cave-Ayland     if (!s->current_req) {
6800db89536SMark Cave-Ayland         return;
6810db89536SMark Cave-Ayland     }
6824460b86aSMark Cave-Ayland     if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) {
683a917d384Spbrook         /* Defer until data is available.  */
684a917d384Spbrook         return;
685a917d384Spbrook     }
686a917d384Spbrook     if (len > s->async_len) {
687a917d384Spbrook         len = s->async_len;
688a917d384Spbrook     }
689a917d384Spbrook     if (to_device) {
69074d71ea1SLaurent Vivier         if (s->dma_memory_read) {
6918b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, s->async_buf, len);
692f3666223SMark Cave-Ayland 
693f3666223SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
694f3666223SMark Cave-Ayland             s->async_buf += len;
695f3666223SMark Cave-Ayland             s->async_len -= len;
696f3666223SMark Cave-Ayland             s->ti_size += len;
697f3666223SMark Cave-Ayland 
698e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
699e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
700f3666223SMark Cave-Ayland                 scsi_req_continue(s->current_req);
701f3666223SMark Cave-Ayland                 return;
702f3666223SMark Cave-Ayland             }
703f3666223SMark Cave-Ayland 
704004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
705a917d384Spbrook         } else {
70619e9afb1SMark Cave-Ayland             /* Copy FIFO data to device */
70719e9afb1SMark Cave-Ayland             len = MIN(s->async_len, ESP_FIFO_SZ);
70819e9afb1SMark Cave-Ayland             len = MIN(len, fifo8_num_used(&s->fifo));
70919e9afb1SMark Cave-Ayland             n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
71019e9afb1SMark Cave-Ayland             s->async_buf += n;
71119e9afb1SMark Cave-Ayland             s->async_len -= n;
71219e9afb1SMark Cave-Ayland             s->ti_size += n;
71319e9afb1SMark Cave-Ayland 
71477987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
71574d71ea1SLaurent Vivier             esp_raise_drq(s);
716e4e166c8SMark Cave-Ayland 
717e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
718e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
719e4e166c8SMark Cave-Ayland                 scsi_req_continue(s->current_req);
720e4e166c8SMark Cave-Ayland                 return;
721e4e166c8SMark Cave-Ayland             }
722e4e166c8SMark Cave-Ayland 
723004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
72474d71ea1SLaurent Vivier         }
72574d71ea1SLaurent Vivier     } else {
72674d71ea1SLaurent Vivier         if (s->dma_memory_write) {
7278b17de88Sblueswir1             s->dma_memory_write(s->dma_opaque, s->async_buf, len);
728f3666223SMark Cave-Ayland 
729f3666223SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
730f3666223SMark Cave-Ayland             s->async_buf += len;
731f3666223SMark Cave-Ayland             s->async_len -= len;
732f3666223SMark Cave-Ayland             s->ti_size -= len;
733f3666223SMark 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 */
736f3666223SMark Cave-Ayland                 scsi_req_continue(s->current_req);
737fabcba49SMark Cave-Ayland                 return;
738f3666223SMark Cave-Ayland             }
739f3666223SMark Cave-Ayland 
740004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
74174d71ea1SLaurent Vivier         } else {
74282141c8bSMark Cave-Ayland             /* Copy device data to FIFO */
743042879fcSMark Cave-Ayland             len = MIN(len, fifo8_num_free(&s->fifo));
744042879fcSMark Cave-Ayland             fifo8_push_all(&s->fifo, s->async_buf, len);
74582141c8bSMark Cave-Ayland             s->async_buf += len;
74682141c8bSMark Cave-Ayland             s->async_len -= len;
74782141c8bSMark Cave-Ayland             s->ti_size -= len;
74882141c8bSMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
74977987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
75074d71ea1SLaurent Vivier             esp_raise_drq(s);
751e4e166c8SMark Cave-Ayland 
752e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
753e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
754e4e166c8SMark Cave-Ayland                 scsi_req_continue(s->current_req);
755e4e166c8SMark Cave-Ayland                 return;
756e4e166c8SMark Cave-Ayland             }
757e4e166c8SMark Cave-Ayland 
758004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
759e4e166c8SMark Cave-Ayland         }
76074d71ea1SLaurent Vivier     }
761a917d384Spbrook }
762a917d384Spbrook 
7631b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s)
7641b9e48a5SMark Cave-Ayland {
7651b9e48a5SMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
7662572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
7677b320a8eSMark Cave-Ayland     uint32_t cmdlen;
7682572689bSMark Cave-Ayland     int len, n;
7691b9e48a5SMark Cave-Ayland 
7701b9e48a5SMark Cave-Ayland     if (s->do_cmd) {
7712572689bSMark Cave-Ayland         /* Copy FIFO into cmdfifo */
7722572689bSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
7732572689bSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
7742572689bSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
7752572689bSMark Cave-Ayland 
7761b9e48a5SMark Cave-Ayland         cmdlen = fifo8_num_used(&s->cmdfifo);
7771b9e48a5SMark Cave-Ayland         trace_esp_handle_ti_cmd(cmdlen);
7781b9e48a5SMark Cave-Ayland         s->ti_size = 0;
7791b9e48a5SMark Cave-Ayland         if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) {
7801b9e48a5SMark Cave-Ayland             /* No command received */
7811b9e48a5SMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
7821b9e48a5SMark Cave-Ayland                 return;
7831b9e48a5SMark Cave-Ayland             }
7841b9e48a5SMark Cave-Ayland 
7851b9e48a5SMark Cave-Ayland             /* Command has been received */
7861b9e48a5SMark Cave-Ayland             s->do_cmd = 0;
7871b9e48a5SMark Cave-Ayland             do_cmd(s);
7881b9e48a5SMark Cave-Ayland         } else {
7891b9e48a5SMark Cave-Ayland             /*
7901b9e48a5SMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
7912cb40d44SStefan Weil              * and then switch to command phase
7921b9e48a5SMark Cave-Ayland              */
7931b9e48a5SMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
794abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
7951b9e48a5SMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
7961b9e48a5SMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
7971b9e48a5SMark Cave-Ayland             esp_raise_irq(s);
7981b9e48a5SMark Cave-Ayland         }
7991b9e48a5SMark Cave-Ayland         return;
8001b9e48a5SMark Cave-Ayland     }
8011b9e48a5SMark Cave-Ayland 
8020db89536SMark Cave-Ayland     if (!s->current_req) {
8030db89536SMark Cave-Ayland         return;
8040db89536SMark Cave-Ayland     }
8050db89536SMark Cave-Ayland 
8061b9e48a5SMark Cave-Ayland     if (s->async_len == 0) {
8071b9e48a5SMark Cave-Ayland         /* Defer until data is available.  */
8081b9e48a5SMark Cave-Ayland         return;
8091b9e48a5SMark Cave-Ayland     }
8101b9e48a5SMark Cave-Ayland 
8111b9e48a5SMark Cave-Ayland     if (to_device) {
81277668e4bSMark Cave-Ayland         len = MIN(s->async_len, ESP_FIFO_SZ);
81377668e4bSMark Cave-Ayland         len = MIN(len, fifo8_num_used(&s->fifo));
8147b320a8eSMark Cave-Ayland         esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
8151b9e48a5SMark Cave-Ayland         s->async_buf += len;
8161b9e48a5SMark Cave-Ayland         s->async_len -= len;
8171b9e48a5SMark Cave-Ayland         s->ti_size += len;
8181b9e48a5SMark Cave-Ayland     } else {
8196ef2cabcSMark Cave-Ayland         if (fifo8_is_empty(&s->fifo)) {
8206ef2cabcSMark Cave-Ayland             fifo8_push(&s->fifo, s->async_buf[0]);
8216ef2cabcSMark Cave-Ayland             s->async_buf++;
8226ef2cabcSMark Cave-Ayland             s->async_len--;
8236ef2cabcSMark Cave-Ayland             s->ti_size--;
8246ef2cabcSMark Cave-Ayland         }
8251b9e48a5SMark Cave-Ayland     }
8261b9e48a5SMark Cave-Ayland 
8271b9e48a5SMark Cave-Ayland     if (s->async_len == 0) {
8281b9e48a5SMark Cave-Ayland         scsi_req_continue(s->current_req);
8291b9e48a5SMark Cave-Ayland         return;
8301b9e48a5SMark Cave-Ayland     }
8311b9e48a5SMark Cave-Ayland 
8321b9e48a5SMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_BS;
8331b9e48a5SMark Cave-Ayland     esp_raise_irq(s);
8341b9e48a5SMark Cave-Ayland }
8351b9e48a5SMark Cave-Ayland 
83677987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s)
83777987ef5SMark Cave-Ayland {
83877987ef5SMark Cave-Ayland     switch (s->pdma_cb) {
83977987ef5SMark Cave-Ayland     case SATN_PDMA_CB:
84077987ef5SMark Cave-Ayland         satn_pdma_cb(s);
84177987ef5SMark Cave-Ayland         break;
84277987ef5SMark Cave-Ayland     case SATN_STOP_PDMA_CB:
84377987ef5SMark Cave-Ayland         satn_stop_pdma_cb(s);
84477987ef5SMark Cave-Ayland         break;
84577987ef5SMark Cave-Ayland     case WRITE_RESPONSE_PDMA_CB:
84677987ef5SMark Cave-Ayland         write_response_pdma_cb(s);
84777987ef5SMark Cave-Ayland         break;
84877987ef5SMark Cave-Ayland     case DO_DMA_PDMA_CB:
84977987ef5SMark Cave-Ayland         do_dma_pdma_cb(s);
85077987ef5SMark Cave-Ayland         break;
85177987ef5SMark Cave-Ayland     default:
85277987ef5SMark Cave-Ayland         g_assert_not_reached();
85377987ef5SMark Cave-Ayland     }
85477987ef5SMark Cave-Ayland }
85577987ef5SMark Cave-Ayland 
8564aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid)
857a917d384Spbrook {
8584aaa6ac3SMark Cave-Ayland     ESPState *s = req->hba_private;
8596ef2cabcSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
8604aaa6ac3SMark Cave-Ayland 
861bf4b9889SBlue Swirl     trace_esp_command_complete();
8626ef2cabcSMark Cave-Ayland 
8636ef2cabcSMark Cave-Ayland     /*
8646ef2cabcSMark Cave-Ayland      * Non-DMA transfers from the target will leave the last byte in
8656ef2cabcSMark Cave-Ayland      * the FIFO so don't reset ti_size in this case
8666ef2cabcSMark Cave-Ayland      */
8676ef2cabcSMark Cave-Ayland     if (s->dma || to_device) {
868c6df7102SPaolo Bonzini         if (s->ti_size != 0) {
869bf4b9889SBlue Swirl             trace_esp_command_complete_unexpected();
870c6df7102SPaolo Bonzini         }
8716ef2cabcSMark Cave-Ayland     }
8726ef2cabcSMark Cave-Ayland 
873a917d384Spbrook     s->async_len = 0;
8744aaa6ac3SMark Cave-Ayland     if (req->status) {
875bf4b9889SBlue Swirl         trace_esp_command_complete_fail();
876c6df7102SPaolo Bonzini     }
8774aaa6ac3SMark Cave-Ayland     s->status = req->status;
8786ef2cabcSMark Cave-Ayland 
8796ef2cabcSMark Cave-Ayland     /*
880cb988199SMark Cave-Ayland      * Switch to status phase. For non-DMA transfers from the target the last
881cb988199SMark Cave-Ayland      * byte is still in the FIFO
8826ef2cabcSMark Cave-Ayland      */
883abc139cdSMark Cave-Ayland     esp_set_phase(s, STAT_ST);
884cb988199SMark Cave-Ayland     if (s->ti_size == 0) {
885cb988199SMark Cave-Ayland         /*
886cb988199SMark Cave-Ayland          * Transfer complete: force TC to zero just in case a TI command was
887cb988199SMark Cave-Ayland          * requested for more data than the command returns (Solaris 8 does
888cb988199SMark Cave-Ayland          * this)
889cb988199SMark Cave-Ayland          */
890cb988199SMark Cave-Ayland         esp_set_tc(s, 0);
891004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
892cb988199SMark Cave-Ayland     } else {
893cb988199SMark Cave-Ayland         /*
894cb988199SMark Cave-Ayland          * Transfer truncated: raise INTR_BS to indicate early change of
895cb988199SMark Cave-Ayland          * phase
896cb988199SMark Cave-Ayland          */
897cb988199SMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
898cb988199SMark Cave-Ayland         esp_raise_irq(s);
899cb988199SMark Cave-Ayland         s->ti_size = 0;
9006ef2cabcSMark Cave-Ayland     }
9016ef2cabcSMark Cave-Ayland 
9025c6c0e51SHannes Reinecke     if (s->current_req) {
9035c6c0e51SHannes Reinecke         scsi_req_unref(s->current_req);
9045c6c0e51SHannes Reinecke         s->current_req = NULL;
905a917d384Spbrook         s->current_dev = NULL;
9065c6c0e51SHannes Reinecke     }
907c6df7102SPaolo Bonzini }
908c6df7102SPaolo Bonzini 
9099c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len)
910c6df7102SPaolo Bonzini {
911e6810db8SHervé Poussineau     ESPState *s = req->hba_private;
9124e78f3bfSMark Cave-Ayland     int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO);
9136cc88d6bSMark Cave-Ayland     uint32_t dmalen = esp_get_tc(s);
914c6df7102SPaolo Bonzini 
9157f0b6e11SPaolo Bonzini     assert(!s->do_cmd);
9166cc88d6bSMark Cave-Ayland     trace_esp_transfer_data(dmalen, s->ti_size);
917aba1f023SPaolo Bonzini     s->async_len = len;
9180c34459bSPaolo Bonzini     s->async_buf = scsi_req_get_buf(req);
9194e78f3bfSMark Cave-Ayland 
9204e78f3bfSMark Cave-Ayland     if (!to_device && !s->data_in_ready) {
9214e78f3bfSMark Cave-Ayland         /*
9224e78f3bfSMark Cave-Ayland          * Initial incoming data xfer is complete so raise command
9234e78f3bfSMark Cave-Ayland          * completion interrupt
9244e78f3bfSMark Cave-Ayland          */
9254e78f3bfSMark Cave-Ayland         s->data_in_ready = true;
9264e78f3bfSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
9274e78f3bfSMark Cave-Ayland         esp_raise_irq(s);
9284e78f3bfSMark Cave-Ayland     }
9294e78f3bfSMark Cave-Ayland 
9301b9e48a5SMark Cave-Ayland     /*
9311b9e48a5SMark Cave-Ayland      * Always perform the initial transfer upon reception of the next TI
9321b9e48a5SMark Cave-Ayland      * command to ensure the DMA/non-DMA status of the command is correct.
9331b9e48a5SMark Cave-Ayland      * It is not possible to use s->dma directly in the section below as
9341b9e48a5SMark Cave-Ayland      * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the
9351b9e48a5SMark Cave-Ayland      * async data transfer is delayed then s->dma is set incorrectly.
9361b9e48a5SMark Cave-Ayland      */
9371b9e48a5SMark Cave-Ayland 
938880d3089SMark Cave-Ayland     if (s->ti_cmd == (CMD_TI | CMD_DMA)) {
939a79e767aSMark Cave-Ayland         /* When the SCSI layer returns more data, raise deferred INTR_BS */
940004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
941a79e767aSMark Cave-Ayland 
942a79e767aSMark Cave-Ayland         esp_do_dma(s);
943880d3089SMark Cave-Ayland     } else if (s->ti_cmd == CMD_TI) {
9441b9e48a5SMark Cave-Ayland         esp_do_nodma(s);
9451b9e48a5SMark Cave-Ayland     }
946a917d384Spbrook }
9472e5d83bbSpbrook 
9482f275b8fSbellard static void handle_ti(ESPState *s)
9492f275b8fSbellard {
9501b9e48a5SMark Cave-Ayland     uint32_t dmalen;
9512f275b8fSbellard 
9527246e160SHervé Poussineau     if (s->dma && !s->dma_enabled) {
9537246e160SHervé Poussineau         s->dma_cb = handle_ti;
9547246e160SHervé Poussineau         return;
9557246e160SHervé Poussineau     }
9567246e160SHervé Poussineau 
9571b9e48a5SMark Cave-Ayland     s->ti_cmd = s->rregs[ESP_CMD];
9584f6200f0Sbellard     if (s->dma) {
9591b9e48a5SMark Cave-Ayland         dmalen = esp_get_tc(s);
960b76624deSMark Cave-Ayland         trace_esp_handle_ti(dmalen);
9614d611c9aSpbrook         esp_do_dma(s);
962799d90d8SMark Cave-Ayland     } else {
9631b9e48a5SMark Cave-Ayland         trace_esp_handle_ti(s->ti_size);
9641b9e48a5SMark Cave-Ayland         esp_do_nodma(s);
9654f6200f0Sbellard     }
9662f275b8fSbellard }
9672f275b8fSbellard 
9689c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s)
9696f7e9aecSbellard {
9705aca8c3bSblueswir1     memset(s->rregs, 0, ESP_REGS);
9715aca8c3bSblueswir1     memset(s->wregs, 0, ESP_REGS);
972c9cf45c1SHannes Reinecke     s->tchi_written = 0;
9734e9aec74Spbrook     s->ti_size = 0;
9743f26c975SMark Cave-Ayland     s->async_len = 0;
975042879fcSMark Cave-Ayland     fifo8_reset(&s->fifo);
976023666daSMark Cave-Ayland     fifo8_reset(&s->cmdfifo);
9774e9aec74Spbrook     s->dma = 0;
9789f149aa9Spbrook     s->do_cmd = 0;
97973d74342SBlue Swirl     s->dma_cb = NULL;
9808dea1dd4Sblueswir1 
9818dea1dd4Sblueswir1     s->rregs[ESP_CFG1] = 7;
9826f7e9aecSbellard }
9836f7e9aecSbellard 
984a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s)
98585948643SBlue Swirl {
98685948643SBlue Swirl     qemu_irq_lower(s->irq);
98774d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
988a391fdbcSHervé Poussineau     esp_hard_reset(s);
98985948643SBlue Swirl }
99085948643SBlue Swirl 
991c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s)
992c6e51f1bSJohn Millikin {
9934a5fc890SPeter Maydell     bus_cold_reset(BUS(&s->bus));
994c6e51f1bSJohn Millikin }
995c6e51f1bSJohn Millikin 
996a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level)
9972d069babSblueswir1 {
99885948643SBlue Swirl     if (level) {
999a391fdbcSHervé Poussineau         esp_soft_reset(s);
100085948643SBlue Swirl     }
10012d069babSblueswir1 }
10022d069babSblueswir1 
1003f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s)
1004f21fe39dSMark Cave-Ayland {
1005f21fe39dSMark Cave-Ayland     uint8_t cmd = s->rregs[ESP_CMD];
1006f21fe39dSMark Cave-Ayland 
1007f21fe39dSMark Cave-Ayland     if (cmd & CMD_DMA) {
1008f21fe39dSMark Cave-Ayland         s->dma = 1;
1009f21fe39dSMark Cave-Ayland         /* Reload DMA counter.  */
1010f21fe39dSMark Cave-Ayland         if (esp_get_stc(s) == 0) {
1011f21fe39dSMark Cave-Ayland             esp_set_tc(s, 0x10000);
1012f21fe39dSMark Cave-Ayland         } else {
1013f21fe39dSMark Cave-Ayland             esp_set_tc(s, esp_get_stc(s));
1014f21fe39dSMark Cave-Ayland         }
1015f21fe39dSMark Cave-Ayland     } else {
1016f21fe39dSMark Cave-Ayland         s->dma = 0;
1017f21fe39dSMark Cave-Ayland     }
1018f21fe39dSMark Cave-Ayland     switch (cmd & CMD_CMD) {
1019f21fe39dSMark Cave-Ayland     case CMD_NOP:
1020f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_nop(cmd);
1021f21fe39dSMark Cave-Ayland         break;
1022f21fe39dSMark Cave-Ayland     case CMD_FLUSH:
1023f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_flush(cmd);
1024f21fe39dSMark Cave-Ayland         fifo8_reset(&s->fifo);
1025f21fe39dSMark Cave-Ayland         break;
1026f21fe39dSMark Cave-Ayland     case CMD_RESET:
1027f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_reset(cmd);
1028f21fe39dSMark Cave-Ayland         esp_soft_reset(s);
1029f21fe39dSMark Cave-Ayland         break;
1030f21fe39dSMark Cave-Ayland     case CMD_BUSRESET:
1031f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_bus_reset(cmd);
1032f21fe39dSMark Cave-Ayland         esp_bus_reset(s);
1033f21fe39dSMark Cave-Ayland         if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) {
1034f21fe39dSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_RST;
1035f21fe39dSMark Cave-Ayland             esp_raise_irq(s);
1036f21fe39dSMark Cave-Ayland         }
1037f21fe39dSMark Cave-Ayland         break;
1038f21fe39dSMark Cave-Ayland     case CMD_TI:
1039f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_ti(cmd);
1040f21fe39dSMark Cave-Ayland         handle_ti(s);
1041f21fe39dSMark Cave-Ayland         break;
1042f21fe39dSMark Cave-Ayland     case CMD_ICCS:
1043f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_iccs(cmd);
1044f21fe39dSMark Cave-Ayland         write_response(s);
1045f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_FC;
1046abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MI);
1047f21fe39dSMark Cave-Ayland         break;
1048f21fe39dSMark Cave-Ayland     case CMD_MSGACC:
1049f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_msgacc(cmd);
1050f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_DC;
1051f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSEQ] = 0;
1052f21fe39dSMark Cave-Ayland         s->rregs[ESP_RFLAGS] = 0;
1053f21fe39dSMark Cave-Ayland         esp_raise_irq(s);
1054f21fe39dSMark Cave-Ayland         break;
1055f21fe39dSMark Cave-Ayland     case CMD_PAD:
1056f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_pad(cmd);
1057f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSTAT] = STAT_TC;
1058f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_FC;
1059f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSEQ] = 0;
1060f21fe39dSMark Cave-Ayland         break;
1061f21fe39dSMark Cave-Ayland     case CMD_SATN:
1062f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_satn(cmd);
1063f21fe39dSMark Cave-Ayland         break;
1064f21fe39dSMark Cave-Ayland     case CMD_RSTATN:
1065f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_rstatn(cmd);
1066f21fe39dSMark Cave-Ayland         break;
1067f21fe39dSMark Cave-Ayland     case CMD_SEL:
1068f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_sel(cmd);
1069f21fe39dSMark Cave-Ayland         handle_s_without_atn(s);
1070f21fe39dSMark Cave-Ayland         break;
1071f21fe39dSMark Cave-Ayland     case CMD_SELATN:
1072f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_selatn(cmd);
1073f21fe39dSMark Cave-Ayland         handle_satn(s);
1074f21fe39dSMark Cave-Ayland         break;
1075f21fe39dSMark Cave-Ayland     case CMD_SELATNS:
1076f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_selatns(cmd);
1077f21fe39dSMark Cave-Ayland         handle_satn_stop(s);
1078f21fe39dSMark Cave-Ayland         break;
1079f21fe39dSMark Cave-Ayland     case CMD_ENSEL:
1080f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_ensel(cmd);
1081f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] = 0;
1082f21fe39dSMark Cave-Ayland         break;
1083f21fe39dSMark Cave-Ayland     case CMD_DISSEL:
1084f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_dissel(cmd);
1085f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] = 0;
1086f21fe39dSMark Cave-Ayland         esp_raise_irq(s);
1087f21fe39dSMark Cave-Ayland         break;
1088f21fe39dSMark Cave-Ayland     default:
1089f21fe39dSMark Cave-Ayland         trace_esp_error_unhandled_command(cmd);
1090f21fe39dSMark Cave-Ayland         break;
1091f21fe39dSMark Cave-Ayland     }
1092f21fe39dSMark Cave-Ayland }
1093f21fe39dSMark Cave-Ayland 
10949c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr)
109573d74342SBlue Swirl {
1096b630c075SMark Cave-Ayland     uint32_t val;
109773d74342SBlue Swirl 
10986f7e9aecSbellard     switch (saddr) {
10995ad6bb97Sblueswir1     case ESP_FIFO:
11001b9e48a5SMark Cave-Ayland         if (s->dma_memory_read && s->dma_memory_write &&
11011b9e48a5SMark Cave-Ayland                 (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) {
11028dea1dd4Sblueswir1             /* Data out.  */
1103ff589551SPrasad J Pandit             qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n");
11045ad6bb97Sblueswir1             s->rregs[ESP_FIFO] = 0;
1105042879fcSMark Cave-Ayland         } else {
11066ef2cabcSMark Cave-Ayland             if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) {
11076ef2cabcSMark Cave-Ayland                 if (s->ti_size) {
11086ef2cabcSMark Cave-Ayland                     esp_do_nodma(s);
11096ef2cabcSMark Cave-Ayland                 } else {
11106ef2cabcSMark Cave-Ayland                     /*
11116ef2cabcSMark Cave-Ayland                      * The last byte of a non-DMA transfer has been read out
11126ef2cabcSMark Cave-Ayland                      * of the FIFO so switch to status phase
11136ef2cabcSMark Cave-Ayland                      */
1114abc139cdSMark Cave-Ayland                     esp_set_phase(s, STAT_ST);
11156ef2cabcSMark Cave-Ayland                 }
11166ef2cabcSMark Cave-Ayland             }
1117c5fef911SMark Cave-Ayland             s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo);
11184f6200f0Sbellard         }
1119b630c075SMark Cave-Ayland         val = s->rregs[ESP_FIFO];
11204f6200f0Sbellard         break;
11215ad6bb97Sblueswir1     case ESP_RINTR:
112294d5c79dSMark Cave-Ayland         /*
112394d5c79dSMark Cave-Ayland          * Clear sequence step, interrupt register and all status bits
112494d5c79dSMark Cave-Ayland          * except TC
112594d5c79dSMark Cave-Ayland          */
1126b630c075SMark Cave-Ayland         val = s->rregs[ESP_RINTR];
11272814df28SBlue Swirl         s->rregs[ESP_RINTR] = 0;
11282814df28SBlue Swirl         s->rregs[ESP_RSTAT] &= ~STAT_TC;
1129af947a3dSMark Cave-Ayland         /*
1130af947a3dSMark Cave-Ayland          * According to the datasheet ESP_RSEQ should be cleared, but as the
1131af947a3dSMark Cave-Ayland          * emulation currently defers information transfers to the next TI
1132af947a3dSMark Cave-Ayland          * command leave it for now so that pedantic guests such as the old
1133af947a3dSMark Cave-Ayland          * Linux 2.6 driver see the correct flags before the next SCSI phase
1134af947a3dSMark Cave-Ayland          * transition.
1135af947a3dSMark Cave-Ayland          *
1136af947a3dSMark Cave-Ayland          * s->rregs[ESP_RSEQ] = SEQ_0;
1137af947a3dSMark Cave-Ayland          */
1138c73f96fdSblueswir1         esp_lower_irq(s);
1139b630c075SMark Cave-Ayland         break;
1140c9cf45c1SHannes Reinecke     case ESP_TCHI:
1141c9cf45c1SHannes Reinecke         /* Return the unique id if the value has never been written */
1142c9cf45c1SHannes Reinecke         if (!s->tchi_written) {
1143b630c075SMark Cave-Ayland             val = s->chip_id;
1144b630c075SMark Cave-Ayland         } else {
1145b630c075SMark Cave-Ayland             val = s->rregs[saddr];
1146c9cf45c1SHannes Reinecke         }
1147b630c075SMark Cave-Ayland         break;
1148238ec4d7SMark Cave-Ayland      case ESP_RFLAGS:
1149238ec4d7SMark Cave-Ayland         /* Bottom 5 bits indicate number of bytes in FIFO */
1150238ec4d7SMark Cave-Ayland         val = fifo8_num_used(&s->fifo);
1151238ec4d7SMark Cave-Ayland         break;
11526f7e9aecSbellard     default:
1153b630c075SMark Cave-Ayland         val = s->rregs[saddr];
11546f7e9aecSbellard         break;
11556f7e9aecSbellard     }
1156b630c075SMark Cave-Ayland 
1157b630c075SMark Cave-Ayland     trace_esp_mem_readb(saddr, val);
1158b630c075SMark Cave-Ayland     return val;
11596f7e9aecSbellard }
11606f7e9aecSbellard 
11619c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val)
11626f7e9aecSbellard {
1163bf4b9889SBlue Swirl     trace_esp_mem_writeb(saddr, s->wregs[saddr], val);
11646f7e9aecSbellard     switch (saddr) {
1165c9cf45c1SHannes Reinecke     case ESP_TCHI:
1166c9cf45c1SHannes Reinecke         s->tchi_written = true;
1167c9cf45c1SHannes Reinecke         /* fall through */
11685ad6bb97Sblueswir1     case ESP_TCLO:
11695ad6bb97Sblueswir1     case ESP_TCMID:
11705ad6bb97Sblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_TC;
11714f6200f0Sbellard         break;
11725ad6bb97Sblueswir1     case ESP_FIFO:
11739f149aa9Spbrook         if (s->do_cmd) {
11742572689bSMark Cave-Ayland             if (!fifo8_is_full(&s->fifo)) {
11752572689bSMark Cave-Ayland                 esp_fifo_push(&s->fifo, val);
11762572689bSMark Cave-Ayland                 esp_fifo_push(&s->cmdfifo, fifo8_pop(&s->fifo));
11772572689bSMark Cave-Ayland             }
11786ef2cabcSMark Cave-Ayland 
11796ef2cabcSMark Cave-Ayland             /*
11806ef2cabcSMark Cave-Ayland              * If any unexpected message out/command phase data is
11816ef2cabcSMark Cave-Ayland              * transferred using non-DMA, raise the interrupt
11826ef2cabcSMark Cave-Ayland              */
11836ef2cabcSMark Cave-Ayland             if (s->rregs[ESP_CMD] == CMD_TI) {
11846ef2cabcSMark Cave-Ayland                 s->rregs[ESP_RINTR] |= INTR_BS;
11856ef2cabcSMark Cave-Ayland                 esp_raise_irq(s);
11866ef2cabcSMark Cave-Ayland             }
11872e5d83bbSpbrook         } else {
1188e5455b8cSMark Cave-Ayland             esp_fifo_push(&s->fifo, val);
11892e5d83bbSpbrook         }
11904f6200f0Sbellard         break;
11915ad6bb97Sblueswir1     case ESP_CMD:
11924f6200f0Sbellard         s->rregs[saddr] = val;
1193f21fe39dSMark Cave-Ayland         esp_run_cmd(s);
11946f7e9aecSbellard         break;
11955ad6bb97Sblueswir1     case ESP_WBUSID ... ESP_WSYNO:
11964f6200f0Sbellard         break;
11975ad6bb97Sblueswir1     case ESP_CFG1:
11989ea73f8bSPaolo Bonzini     case ESP_CFG2: case ESP_CFG3:
11999ea73f8bSPaolo Bonzini     case ESP_RES3: case ESP_RES4:
12004f6200f0Sbellard         s->rregs[saddr] = val;
12014f6200f0Sbellard         break;
12025ad6bb97Sblueswir1     case ESP_WCCF ... ESP_WTEST:
12034f6200f0Sbellard         break;
12046f7e9aecSbellard     default:
12053af4e9aaSHervé Poussineau         trace_esp_error_invalid_write(val, saddr);
12068dea1dd4Sblueswir1         return;
12076f7e9aecSbellard     }
12082f275b8fSbellard     s->wregs[saddr] = val;
12096f7e9aecSbellard }
12106f7e9aecSbellard 
1211a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr,
12128372d383SPeter Maydell                             unsigned size, bool is_write,
12138372d383SPeter Maydell                             MemTxAttrs attrs)
121467bb5314SAvi Kivity {
121567bb5314SAvi Kivity     return (size == 1) || (is_write && size == 4);
121667bb5314SAvi Kivity }
12176f7e9aecSbellard 
12186cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id)
12196cc88d6bSMark Cave-Ayland {
12206cc88d6bSMark Cave-Ayland     ESPState *s = ESP(opaque);
12216cc88d6bSMark Cave-Ayland 
12226cc88d6bSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12236cc88d6bSMark Cave-Ayland     return version_id < 5;
12246cc88d6bSMark Cave-Ayland }
12256cc88d6bSMark Cave-Ayland 
12264e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id)
12274e78f3bfSMark Cave-Ayland {
12284e78f3bfSMark Cave-Ayland     ESPState *s = ESP(opaque);
12294e78f3bfSMark Cave-Ayland 
12304e78f3bfSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12310bcd5a18SMark Cave-Ayland     return version_id >= 5;
12324e78f3bfSMark Cave-Ayland }
12334e78f3bfSMark Cave-Ayland 
12344eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id)
12354eb86065SPaolo Bonzini {
12364eb86065SPaolo Bonzini     ESPState *s = ESP(opaque);
12374eb86065SPaolo Bonzini 
12384eb86065SPaolo Bonzini     version_id = MIN(version_id, s->mig_version_id);
12394eb86065SPaolo Bonzini     return version_id >= 6;
12404eb86065SPaolo Bonzini }
12414eb86065SPaolo Bonzini 
1242ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque)
12430bd005beSMark Cave-Ayland {
1244ff4a1dabSMark Cave-Ayland     ESPState *s = ESP(object_resolve_path_component(
1245ff4a1dabSMark Cave-Ayland                       OBJECT(opaque), "esp"));
12460bd005beSMark Cave-Ayland 
12470bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
12480bd005beSMark Cave-Ayland     return 0;
12490bd005beSMark Cave-Ayland }
12500bd005beSMark Cave-Ayland 
12510bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id)
12520bd005beSMark Cave-Ayland {
12530bd005beSMark Cave-Ayland     ESPState *s = ESP(opaque);
1254042879fcSMark Cave-Ayland     int len, i;
12550bd005beSMark Cave-Ayland 
12566cc88d6bSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12576cc88d6bSMark Cave-Ayland 
12586cc88d6bSMark Cave-Ayland     if (version_id < 5) {
12596cc88d6bSMark Cave-Ayland         esp_set_tc(s, s->mig_dma_left);
1260042879fcSMark Cave-Ayland 
1261042879fcSMark Cave-Ayland         /* Migrate ti_buf to fifo */
1262042879fcSMark Cave-Ayland         len = s->mig_ti_wptr - s->mig_ti_rptr;
1263042879fcSMark Cave-Ayland         for (i = 0; i < len; i++) {
1264042879fcSMark Cave-Ayland             fifo8_push(&s->fifo, s->mig_ti_buf[i]);
1265042879fcSMark Cave-Ayland         }
1266023666daSMark Cave-Ayland 
1267023666daSMark Cave-Ayland         /* Migrate cmdbuf to cmdfifo */
1268023666daSMark Cave-Ayland         for (i = 0; i < s->mig_cmdlen; i++) {
1269023666daSMark Cave-Ayland             fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]);
1270023666daSMark Cave-Ayland         }
12716cc88d6bSMark Cave-Ayland     }
12726cc88d6bSMark Cave-Ayland 
12730bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
12740bd005beSMark Cave-Ayland     return 0;
12750bd005beSMark Cave-Ayland }
12760bd005beSMark Cave-Ayland 
1277eda59b39SMark Cave-Ayland /*
1278eda59b39SMark Cave-Ayland  * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the
1279eda59b39SMark Cave-Ayland  * guest CPU to perform the transfers between the SCSI bus and memory
1280eda59b39SMark Cave-Ayland  * itself. This is indicated by the dma_memory_read and dma_memory_write
1281eda59b39SMark Cave-Ayland  * functions being NULL (in contrast to the ESP PCI device) whilst
1282eda59b39SMark Cave-Ayland  * dma_enabled is still set.
1283eda59b39SMark Cave-Ayland  */
1284eda59b39SMark Cave-Ayland 
1285eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque)
1286eda59b39SMark Cave-Ayland {
1287eda59b39SMark Cave-Ayland     ESPState *s = ESP(opaque);
1288eda59b39SMark Cave-Ayland 
1289eda59b39SMark Cave-Ayland     return s->dma_memory_read == NULL && s->dma_memory_write == NULL &&
1290eda59b39SMark Cave-Ayland            s->dma_enabled;
1291eda59b39SMark Cave-Ayland }
1292eda59b39SMark Cave-Ayland 
1293eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = {
1294eda59b39SMark Cave-Ayland     .name = "esp/pdma",
1295eda59b39SMark Cave-Ayland     .version_id = 0,
1296eda59b39SMark Cave-Ayland     .minimum_version_id = 0,
1297eda59b39SMark Cave-Ayland     .needed = esp_pdma_needed,
12982d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
1299eda59b39SMark Cave-Ayland         VMSTATE_UINT8(pdma_cb, ESPState),
1300eda59b39SMark Cave-Ayland         VMSTATE_END_OF_LIST()
1301eda59b39SMark Cave-Ayland     }
1302eda59b39SMark Cave-Ayland };
1303eda59b39SMark Cave-Ayland 
13049c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = {
1305cc9952f3SBlue Swirl     .name = "esp",
13064eb86065SPaolo Bonzini     .version_id = 6,
1307cc9952f3SBlue Swirl     .minimum_version_id = 3,
13080bd005beSMark Cave-Ayland     .post_load = esp_post_load,
13092d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
1310cc9952f3SBlue Swirl         VMSTATE_BUFFER(rregs, ESPState),
1311cc9952f3SBlue Swirl         VMSTATE_BUFFER(wregs, ESPState),
1312cc9952f3SBlue Swirl         VMSTATE_INT32(ti_size, ESPState),
1313042879fcSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5),
1314042879fcSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5),
1315042879fcSMark Cave-Ayland         VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5),
13163944966dSPaolo Bonzini         VMSTATE_UINT32(status, ESPState),
13174aaa6ac3SMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_deferred_status, ESPState,
13184aaa6ac3SMark Cave-Ayland                             esp_is_before_version_5),
13194aaa6ac3SMark Cave-Ayland         VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState,
13204aaa6ac3SMark Cave-Ayland                           esp_is_before_version_5),
1321cc9952f3SBlue Swirl         VMSTATE_UINT32(dma, ESPState),
1322023666daSMark Cave-Ayland         VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0,
1323023666daSMark Cave-Ayland                               esp_is_before_version_5, 0, 16),
1324023666daSMark Cave-Ayland         VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4,
1325023666daSMark Cave-Ayland                               esp_is_before_version_5, 16,
1326023666daSMark Cave-Ayland                               sizeof(typeof_field(ESPState, mig_cmdbuf))),
1327023666daSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5),
1328cc9952f3SBlue Swirl         VMSTATE_UINT32(do_cmd, ESPState),
13296cc88d6bSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5),
13304e78f3bfSMark Cave-Ayland         VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5),
1331023666daSMark Cave-Ayland         VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5),
1332042879fcSMark Cave-Ayland         VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5),
1333023666daSMark Cave-Ayland         VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5),
13341b9e48a5SMark Cave-Ayland         VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5),
13354eb86065SPaolo Bonzini         VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6),
1336cc9952f3SBlue Swirl         VMSTATE_END_OF_LIST()
133774d71ea1SLaurent Vivier     },
13382d7b39a6SRichard Henderson     .subsections = (const VMStateDescription * const []) {
1339eda59b39SMark Cave-Ayland         &vmstate_esp_pdma,
1340eda59b39SMark Cave-Ayland         NULL
1341eda59b39SMark Cave-Ayland     }
1342cc9952f3SBlue Swirl };
13436f7e9aecSbellard 
1344a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr,
1345a391fdbcSHervé Poussineau                                  uint64_t val, unsigned int size)
1346a391fdbcSHervé Poussineau {
1347a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
1348eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1349a391fdbcSHervé Poussineau     uint32_t saddr;
1350a391fdbcSHervé Poussineau 
1351a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
1352eb169c76SMark Cave-Ayland     esp_reg_write(s, saddr, val);
1353a391fdbcSHervé Poussineau }
1354a391fdbcSHervé Poussineau 
1355a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr,
1356a391fdbcSHervé Poussineau                                     unsigned int size)
1357a391fdbcSHervé Poussineau {
1358a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
1359eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1360a391fdbcSHervé Poussineau     uint32_t saddr;
1361a391fdbcSHervé Poussineau 
1362a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
1363eb169c76SMark Cave-Ayland     return esp_reg_read(s, saddr);
1364a391fdbcSHervé Poussineau }
1365a391fdbcSHervé Poussineau 
1366a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = {
1367a391fdbcSHervé Poussineau     .read = sysbus_esp_mem_read,
1368a391fdbcSHervé Poussineau     .write = sysbus_esp_mem_write,
1369a391fdbcSHervé Poussineau     .endianness = DEVICE_NATIVE_ENDIAN,
1370a391fdbcSHervé Poussineau     .valid.accepts = esp_mem_accepts,
1371a391fdbcSHervé Poussineau };
1372a391fdbcSHervé Poussineau 
137374d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
137474d71ea1SLaurent Vivier                                   uint64_t val, unsigned int size)
137574d71ea1SLaurent Vivier {
137674d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
1377eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
137874d71ea1SLaurent Vivier 
1379960ebfd9SMark Cave-Ayland     trace_esp_pdma_write(size);
1380960ebfd9SMark Cave-Ayland 
138174d71ea1SLaurent Vivier     switch (size) {
138274d71ea1SLaurent Vivier     case 1:
1383761bef75SMark Cave-Ayland         esp_pdma_write(s, val);
138474d71ea1SLaurent Vivier         break;
138574d71ea1SLaurent Vivier     case 2:
1386761bef75SMark Cave-Ayland         esp_pdma_write(s, val >> 8);
1387761bef75SMark Cave-Ayland         esp_pdma_write(s, val);
138874d71ea1SLaurent Vivier         break;
138974d71ea1SLaurent Vivier     }
1390d0243b09SMark Cave-Ayland     esp_pdma_cb(s);
139174d71ea1SLaurent Vivier }
139274d71ea1SLaurent Vivier 
139374d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
139474d71ea1SLaurent Vivier                                      unsigned int size)
139574d71ea1SLaurent Vivier {
139674d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
1397eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
139874d71ea1SLaurent Vivier     uint64_t val = 0;
139974d71ea1SLaurent Vivier 
1400960ebfd9SMark Cave-Ayland     trace_esp_pdma_read(size);
1401960ebfd9SMark Cave-Ayland 
140274d71ea1SLaurent Vivier     switch (size) {
140374d71ea1SLaurent Vivier     case 1:
1404761bef75SMark Cave-Ayland         val = esp_pdma_read(s);
140574d71ea1SLaurent Vivier         break;
140674d71ea1SLaurent Vivier     case 2:
1407761bef75SMark Cave-Ayland         val = esp_pdma_read(s);
1408761bef75SMark Cave-Ayland         val = (val << 8) | esp_pdma_read(s);
140974d71ea1SLaurent Vivier         break;
141074d71ea1SLaurent Vivier     }
1411d0243b09SMark Cave-Ayland     esp_pdma_cb(s);
141274d71ea1SLaurent Vivier     return val;
141374d71ea1SLaurent Vivier }
141474d71ea1SLaurent Vivier 
1415a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req)
1416a7a22088SMark Cave-Ayland {
1417a7a22088SMark Cave-Ayland     ESPState *s = container_of(req->bus, ESPState, bus);
1418a7a22088SMark Cave-Ayland 
1419a7a22088SMark Cave-Ayland     scsi_req_ref(req);
1420a7a22088SMark Cave-Ayland     s->current_req = req;
1421a7a22088SMark Cave-Ayland     return s;
1422a7a22088SMark Cave-Ayland }
1423a7a22088SMark Cave-Ayland 
142474d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = {
142574d71ea1SLaurent Vivier     .read = sysbus_esp_pdma_read,
142674d71ea1SLaurent Vivier     .write = sysbus_esp_pdma_write,
142774d71ea1SLaurent Vivier     .endianness = DEVICE_NATIVE_ENDIAN,
142874d71ea1SLaurent Vivier     .valid.min_access_size = 1,
1429cf1b8286SMark Cave-Ayland     .valid.max_access_size = 4,
1430cf1b8286SMark Cave-Ayland     .impl.min_access_size = 1,
1431cf1b8286SMark Cave-Ayland     .impl.max_access_size = 2,
143274d71ea1SLaurent Vivier };
143374d71ea1SLaurent Vivier 
1434afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = {
1435afd4030cSPaolo Bonzini     .tcq = false,
14367e0380b9SPaolo Bonzini     .max_target = ESP_MAX_DEVS,
14377e0380b9SPaolo Bonzini     .max_lun = 7,
1438afd4030cSPaolo Bonzini 
1439a7a22088SMark Cave-Ayland     .load_request = esp_load_request,
1440c6df7102SPaolo Bonzini     .transfer_data = esp_transfer_data,
144194d3f98aSPaolo Bonzini     .complete = esp_command_complete,
144294d3f98aSPaolo Bonzini     .cancel = esp_request_cancelled
1443cfdc1bb0SPaolo Bonzini };
1444cfdc1bb0SPaolo Bonzini 
1445a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level)
1446cfb9de9cSPaul Brook {
144784fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(opaque);
1448eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1449a391fdbcSHervé Poussineau 
1450a391fdbcSHervé Poussineau     switch (irq) {
1451a391fdbcSHervé Poussineau     case 0:
1452a391fdbcSHervé Poussineau         parent_esp_reset(s, irq, level);
1453a391fdbcSHervé Poussineau         break;
1454a391fdbcSHervé Poussineau     case 1:
1455b86dc5cbSMark Cave-Ayland         esp_dma_enable(s, irq, level);
1456a391fdbcSHervé Poussineau         break;
1457a391fdbcSHervé Poussineau     }
1458a391fdbcSHervé Poussineau }
1459a391fdbcSHervé Poussineau 
1460b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp)
1461a391fdbcSHervé Poussineau {
1462b09318caSHu Tao     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
146384fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1464eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1465eb169c76SMark Cave-Ayland 
1466eb169c76SMark Cave-Ayland     if (!qdev_realize(DEVICE(s), NULL, errp)) {
1467eb169c76SMark Cave-Ayland         return;
1468eb169c76SMark Cave-Ayland     }
14696f7e9aecSbellard 
1470b09318caSHu Tao     sysbus_init_irq(sbd, &s->irq);
147174d71ea1SLaurent Vivier     sysbus_init_irq(sbd, &s->irq_data);
1472a391fdbcSHervé Poussineau     assert(sysbus->it_shift != -1);
14736f7e9aecSbellard 
1474d32e4b3dSHervé Poussineau     s->chip_id = TCHI_FAS100A;
147529776739SPaolo Bonzini     memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops,
147674d71ea1SLaurent Vivier                           sysbus, "esp-regs", ESP_REGS << sysbus->it_shift);
1477b09318caSHu Tao     sysbus_init_mmio(sbd, &sysbus->iomem);
147874d71ea1SLaurent Vivier     memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops,
1479cf1b8286SMark Cave-Ayland                           sysbus, "esp-pdma", 4);
148074d71ea1SLaurent Vivier     sysbus_init_mmio(sbd, &sysbus->pdma);
14816f7e9aecSbellard 
1482b09318caSHu Tao     qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2);
14832d069babSblueswir1 
1484739e95f5SPeter Maydell     scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info);
148567e999beSbellard }
1486cfb9de9cSPaul Brook 
1487a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev)
1488a391fdbcSHervé Poussineau {
148984fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1490eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1491eb169c76SMark Cave-Ayland 
1492eb169c76SMark Cave-Ayland     esp_hard_reset(s);
1493eb169c76SMark Cave-Ayland }
1494eb169c76SMark Cave-Ayland 
1495eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj)
1496eb169c76SMark Cave-Ayland {
1497eb169c76SMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(obj);
1498eb169c76SMark Cave-Ayland 
1499eb169c76SMark Cave-Ayland     object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP);
1500a391fdbcSHervé Poussineau }
1501a391fdbcSHervé Poussineau 
1502a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = {
1503a391fdbcSHervé Poussineau     .name = "sysbusespscsi",
15040bd005beSMark Cave-Ayland     .version_id = 2,
1505ea84a442SGuenter Roeck     .minimum_version_id = 1,
1506ff4a1dabSMark Cave-Ayland     .pre_save = esp_pre_save,
15072d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
15080bd005beSMark Cave-Ayland         VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2),
1509a391fdbcSHervé Poussineau         VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState),
1510a391fdbcSHervé Poussineau         VMSTATE_END_OF_LIST()
1511a391fdbcSHervé Poussineau     }
1512999e12bbSAnthony Liguori };
1513999e12bbSAnthony Liguori 
1514a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data)
1515999e12bbSAnthony Liguori {
151639bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1517999e12bbSAnthony Liguori 
1518b09318caSHu Tao     dc->realize = sysbus_esp_realize;
1519a391fdbcSHervé Poussineau     dc->reset = sysbus_esp_hard_reset;
1520a391fdbcSHervé Poussineau     dc->vmsd = &vmstate_sysbus_esp_scsi;
1521125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
152263235df8SBlue Swirl }
1523999e12bbSAnthony Liguori 
15241f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = {
152584fbefedSMark Cave-Ayland     .name          = TYPE_SYSBUS_ESP,
152639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
1527eb169c76SMark Cave-Ayland     .instance_init = sysbus_esp_init,
1528a391fdbcSHervé Poussineau     .instance_size = sizeof(SysBusESPState),
1529a391fdbcSHervé Poussineau     .class_init    = sysbus_esp_class_init,
153063235df8SBlue Swirl };
153163235df8SBlue Swirl 
1532042879fcSMark Cave-Ayland static void esp_finalize(Object *obj)
1533042879fcSMark Cave-Ayland {
1534042879fcSMark Cave-Ayland     ESPState *s = ESP(obj);
1535042879fcSMark Cave-Ayland 
1536042879fcSMark Cave-Ayland     fifo8_destroy(&s->fifo);
1537023666daSMark Cave-Ayland     fifo8_destroy(&s->cmdfifo);
1538042879fcSMark Cave-Ayland }
1539042879fcSMark Cave-Ayland 
1540042879fcSMark Cave-Ayland static void esp_init(Object *obj)
1541042879fcSMark Cave-Ayland {
1542042879fcSMark Cave-Ayland     ESPState *s = ESP(obj);
1543042879fcSMark Cave-Ayland 
1544042879fcSMark Cave-Ayland     fifo8_create(&s->fifo, ESP_FIFO_SZ);
1545023666daSMark Cave-Ayland     fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ);
1546042879fcSMark Cave-Ayland }
1547042879fcSMark Cave-Ayland 
1548eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data)
1549eb169c76SMark Cave-Ayland {
1550eb169c76SMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(klass);
1551eb169c76SMark Cave-Ayland 
1552eb169c76SMark Cave-Ayland     /* internal device for sysbusesp/pciespscsi, not user-creatable */
1553eb169c76SMark Cave-Ayland     dc->user_creatable = false;
1554eb169c76SMark Cave-Ayland     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
1555eb169c76SMark Cave-Ayland }
1556eb169c76SMark Cave-Ayland 
1557eb169c76SMark Cave-Ayland static const TypeInfo esp_info = {
1558eb169c76SMark Cave-Ayland     .name = TYPE_ESP,
1559eb169c76SMark Cave-Ayland     .parent = TYPE_DEVICE,
1560042879fcSMark Cave-Ayland     .instance_init = esp_init,
1561042879fcSMark Cave-Ayland     .instance_finalize = esp_finalize,
1562eb169c76SMark Cave-Ayland     .instance_size = sizeof(ESPState),
1563eb169c76SMark Cave-Ayland     .class_init = esp_class_init,
1564eb169c76SMark Cave-Ayland };
1565eb169c76SMark Cave-Ayland 
156683f7d43aSAndreas Färber static void esp_register_types(void)
1567cfb9de9cSPaul Brook {
1568a391fdbcSHervé Poussineau     type_register_static(&sysbus_esp_info);
1569eb169c76SMark Cave-Ayland     type_register_static(&esp_info);
1570cfb9de9cSPaul Brook }
1571cfb9de9cSPaul Brook 
157283f7d43aSAndreas Färber type_init(esp_register_types)
1573