xref: /qemu/hw/scsi/esp.c (revision 9d1aa52b761bc9e38d19009ada723bd4f734cd90)
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 
1995a83e83eSMark Cave-Ayland static uint8_t esp_get_phase(ESPState *s)
2005a83e83eSMark Cave-Ayland {
2015a83e83eSMark Cave-Ayland     return s->rregs[ESP_RSTAT] & 7;
2025a83e83eSMark Cave-Ayland }
2035a83e83eSMark Cave-Ayland 
204761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s)
205761bef75SMark Cave-Ayland {
2068da90e81SMark Cave-Ayland     uint8_t val;
2078da90e81SMark Cave-Ayland 
208c5fef911SMark Cave-Ayland     val = esp_fifo_pop(&s->fifo);
2098da90e81SMark Cave-Ayland     return val;
210761bef75SMark Cave-Ayland }
211761bef75SMark Cave-Ayland 
212761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val)
213761bef75SMark Cave-Ayland {
2148da90e81SMark Cave-Ayland     uint32_t dmalen = esp_get_tc(s);
2158da90e81SMark Cave-Ayland 
2163c421400SMark Cave-Ayland     if (dmalen == 0) {
2178da90e81SMark Cave-Ayland         return;
2188da90e81SMark Cave-Ayland     }
2198da90e81SMark Cave-Ayland 
220e5455b8cSMark Cave-Ayland     esp_fifo_push(&s->fifo, val);
2218da90e81SMark Cave-Ayland 
2228da90e81SMark Cave-Ayland     dmalen--;
2238da90e81SMark Cave-Ayland     esp_set_tc(s, dmalen);
224761bef75SMark Cave-Ayland }
225761bef75SMark Cave-Ayland 
22677987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb)
2271e794c51SMark Cave-Ayland {
2281e794c51SMark Cave-Ayland     s->pdma_cb = cb;
2291e794c51SMark Cave-Ayland }
2301e794c51SMark Cave-Ayland 
231c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s)
2326130b188SLaurent Vivier {
2336130b188SLaurent Vivier     int target;
2346130b188SLaurent Vivier 
2356130b188SLaurent Vivier     target = s->wregs[ESP_WBUSID] & BUSID_DID;
2366130b188SLaurent Vivier 
2376130b188SLaurent Vivier     s->ti_size = 0;
2386130b188SLaurent Vivier 
239cf40a5e4SMark Cave-Ayland     if (s->current_req) {
240cf40a5e4SMark Cave-Ayland         /* Started a new command before the old one finished. Cancel it. */
241cf40a5e4SMark Cave-Ayland         scsi_req_cancel(s->current_req);
242cf40a5e4SMark Cave-Ayland     }
243cf40a5e4SMark Cave-Ayland 
2446130b188SLaurent Vivier     s->current_dev = scsi_device_find(&s->bus, 0, target, 0);
2456130b188SLaurent Vivier     if (!s->current_dev) {
2466130b188SLaurent Vivier         /* No such drive */
2476130b188SLaurent Vivier         s->rregs[ESP_RSTAT] = 0;
248cf1a7a9bSMark Cave-Ayland         s->rregs[ESP_RINTR] = INTR_DC;
2496130b188SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_0;
2506130b188SLaurent Vivier         esp_raise_irq(s);
2516130b188SLaurent Vivier         return -1;
2526130b188SLaurent Vivier     }
2534e78f3bfSMark Cave-Ayland 
2544e78f3bfSMark Cave-Ayland     /*
2554e78f3bfSMark Cave-Ayland      * Note that we deliberately don't raise the IRQ here: this will be done
2564eb86065SPaolo Bonzini      * either in do_command_phase() for DATA OUT transfers or by the deferred
2574e78f3bfSMark Cave-Ayland      * IRQ mechanism in esp_transfer_data() for DATA IN transfers
2584e78f3bfSMark Cave-Ayland      */
2594e78f3bfSMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_FC;
2604e78f3bfSMark Cave-Ayland     s->rregs[ESP_RSEQ] = SEQ_CD;
2616130b188SLaurent Vivier     return 0;
2626130b188SLaurent Vivier }
2636130b188SLaurent Vivier 
26420c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen)
2652f275b8fSbellard {
266023666daSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
267042879fcSMark Cave-Ayland     uint32_t dmalen, n;
2682f275b8fSbellard     int target;
2692f275b8fSbellard 
2708dea1dd4Sblueswir1     target = s->wregs[ESP_WBUSID] & BUSID_DID;
2714f6200f0Sbellard     if (s->dma) {
27220c8d2edSMark Cave-Ayland         dmalen = MIN(esp_get_tc(s), maxlen);
27320c8d2edSMark Cave-Ayland         if (dmalen == 0) {
2746c1fef6bSPrasad J Pandit             return 0;
2756c1fef6bSPrasad J Pandit         }
27674d71ea1SLaurent Vivier         if (s->dma_memory_read) {
2778b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, buf, dmalen);
278fbc6510eSMark Cave-Ayland             dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen);
279023666daSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, dmalen);
280a0347651SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - dmalen);
2814f6200f0Sbellard         } else {
28274d71ea1SLaurent Vivier             return 0;
28374d71ea1SLaurent Vivier         }
28474d71ea1SLaurent Vivier     } else {
285023666daSMark Cave-Ayland         dmalen = MIN(fifo8_num_used(&s->fifo), maxlen);
28620c8d2edSMark Cave-Ayland         if (dmalen == 0) {
287d3cdc491SPrasad J Pandit             return 0;
288d3cdc491SPrasad J Pandit         }
2897b320a8eSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, dmalen);
290fbc6510eSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
2917b320a8eSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
29220c8d2edSMark Cave-Ayland     }
293bf4b9889SBlue Swirl     trace_esp_get_cmd(dmalen, target);
2942e5d83bbSpbrook 
2959f149aa9Spbrook     return dmalen;
2969f149aa9Spbrook }
2979f149aa9Spbrook 
2984eb86065SPaolo Bonzini static void do_command_phase(ESPState *s)
2999f149aa9Spbrook {
3007b320a8eSMark Cave-Ayland     uint32_t cmdlen;
3019f149aa9Spbrook     int32_t datalen;
302f48a7a6eSPaolo Bonzini     SCSIDevice *current_lun;
3037b320a8eSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
3049f149aa9Spbrook 
3054eb86065SPaolo Bonzini     trace_esp_do_command_phase(s->lun);
306023666daSMark Cave-Ayland     cmdlen = fifo8_num_used(&s->cmdfifo);
30799545751SMark Cave-Ayland     if (!cmdlen || !s->current_dev) {
30899545751SMark Cave-Ayland         return;
30999545751SMark Cave-Ayland     }
3107b320a8eSMark Cave-Ayland     esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen);
311023666daSMark Cave-Ayland 
3124eb86065SPaolo Bonzini     current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun);
313b22f83d8SAlexandra Diupina     if (!current_lun) {
314b22f83d8SAlexandra Diupina         /* No such drive */
315b22f83d8SAlexandra Diupina         s->rregs[ESP_RSTAT] = 0;
316b22f83d8SAlexandra Diupina         s->rregs[ESP_RINTR] = INTR_DC;
317b22f83d8SAlexandra Diupina         s->rregs[ESP_RSEQ] = SEQ_0;
318b22f83d8SAlexandra Diupina         esp_raise_irq(s);
319b22f83d8SAlexandra Diupina         return;
320b22f83d8SAlexandra Diupina     }
321b22f83d8SAlexandra Diupina 
322fe9d8927SJohn Millikin     s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s);
323c39ce112SPaolo Bonzini     datalen = scsi_req_enqueue(s->current_req);
32467e999beSbellard     s->ti_size = datalen;
325023666daSMark Cave-Ayland     fifo8_reset(&s->cmdfifo);
32667e999beSbellard     if (datalen != 0) {
3271b9e48a5SMark Cave-Ayland         s->ti_cmd = 0;
3282e5d83bbSpbrook         if (datalen > 0) {
3294e78f3bfSMark Cave-Ayland             /*
3304e78f3bfSMark Cave-Ayland              * Switch to DATA IN phase but wait until initial data xfer is
3314e78f3bfSMark Cave-Ayland              * complete before raising the command completion interrupt
3324e78f3bfSMark Cave-Ayland              */
3334e78f3bfSMark Cave-Ayland             s->data_in_ready = false;
334abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_DI);
3354f6200f0Sbellard         } else {
336abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_DO);
337cf47a41eSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
338c73f96fdSblueswir1             esp_raise_irq(s);
33982141c8bSMark Cave-Ayland             esp_lower_drq(s);
3402f275b8fSbellard         }
3414e78f3bfSMark Cave-Ayland         scsi_req_continue(s->current_req);
3424e78f3bfSMark Cave-Ayland         return;
3434e78f3bfSMark Cave-Ayland     }
3444e78f3bfSMark Cave-Ayland }
3452f275b8fSbellard 
3464eb86065SPaolo Bonzini static void do_message_phase(ESPState *s)
347f2818f22SArtyom Tarasenko {
3484eb86065SPaolo Bonzini     if (s->cmdfifo_cdb_offset) {
3494eb86065SPaolo Bonzini         uint8_t message = esp_fifo_pop(&s->cmdfifo);
350023666daSMark Cave-Ayland 
3514eb86065SPaolo Bonzini         trace_esp_do_identify(message);
3524eb86065SPaolo Bonzini         s->lun = message & 7;
353023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset--;
3544eb86065SPaolo Bonzini     }
355f2818f22SArtyom Tarasenko 
356799d90d8SMark Cave-Ayland     /* Ignore extended messages for now */
357023666daSMark Cave-Ayland     if (s->cmdfifo_cdb_offset) {
3584eb86065SPaolo Bonzini         int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo));
359fa7505c1SMark Cave-Ayland         esp_fifo_pop_buf(&s->cmdfifo, NULL, len);
360023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 0;
361023666daSMark Cave-Ayland     }
3624eb86065SPaolo Bonzini }
363023666daSMark Cave-Ayland 
3644eb86065SPaolo Bonzini static void do_cmd(ESPState *s)
3654eb86065SPaolo Bonzini {
3664eb86065SPaolo Bonzini     do_message_phase(s);
3674eb86065SPaolo Bonzini     assert(s->cmdfifo_cdb_offset == 0);
3684eb86065SPaolo Bonzini     do_command_phase(s);
369f2818f22SArtyom Tarasenko }
370f2818f22SArtyom Tarasenko 
37174d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s)
37274d71ea1SLaurent Vivier {
3732572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
3742572689bSMark Cave-Ayland     int n;
3752572689bSMark Cave-Ayland 
3762572689bSMark Cave-Ayland     /* Copy FIFO into cmdfifo */
3772572689bSMark Cave-Ayland     n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
3782572689bSMark Cave-Ayland     n = MIN(fifo8_num_free(&s->cmdfifo), n);
3792572689bSMark Cave-Ayland     fifo8_push_all(&s->cmdfifo, buf, n);
3802572689bSMark Cave-Ayland 
381e62a959aSMark Cave-Ayland     if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) {
382023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
383e62a959aSMark Cave-Ayland         s->do_cmd = 0;
384c959f218SMark Cave-Ayland         do_cmd(s);
38574d71ea1SLaurent Vivier     }
38674d71ea1SLaurent Vivier }
38774d71ea1SLaurent Vivier 
3889f149aa9Spbrook static void handle_satn(ESPState *s)
3899f149aa9Spbrook {
39049691315SMark Cave-Ayland     int32_t cmdlen;
39149691315SMark Cave-Ayland 
3921b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
39373d74342SBlue Swirl         s->dma_cb = handle_satn;
39473d74342SBlue Swirl         return;
39573d74342SBlue Swirl     }
39677987ef5SMark Cave-Ayland     esp_set_pdma_cb(s, SATN_PDMA_CB);
3971bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
3981bcaf71bSMark Cave-Ayland         return;
3991bcaf71bSMark Cave-Ayland     }
400023666daSMark Cave-Ayland     cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
40149691315SMark Cave-Ayland     if (cmdlen > 0) {
402023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
40360720694SMark Cave-Ayland         s->do_cmd = 0;
404c959f218SMark Cave-Ayland         do_cmd(s);
40549691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4061bcaf71bSMark Cave-Ayland         if (s->dma) {
4071bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4081bcaf71bSMark Cave-Ayland         }
409bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
41049691315SMark Cave-Ayland         /* Target present, but no cmd yet - switch to command phase */
41149691315SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_CD;
412abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
4139f149aa9Spbrook     }
41494d5c79dSMark Cave-Ayland }
4159f149aa9Spbrook 
416f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s)
417f2818f22SArtyom Tarasenko {
41849691315SMark Cave-Ayland     int32_t cmdlen;
41949691315SMark Cave-Ayland 
4201b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
42173d74342SBlue Swirl         s->dma_cb = handle_s_without_atn;
42273d74342SBlue Swirl         return;
42373d74342SBlue Swirl     }
42466fd5657SMark Cave-Ayland     esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
4251bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
4261bcaf71bSMark Cave-Ayland         return;
4271bcaf71bSMark Cave-Ayland     }
428023666daSMark Cave-Ayland     cmdlen = get_cmd(s, ESP_CMDFIFO_SZ);
42949691315SMark Cave-Ayland     if (cmdlen > 0) {
430023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 0;
43160720694SMark Cave-Ayland         s->do_cmd = 0;
4324eb86065SPaolo Bonzini         do_cmd(s);
43349691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4341bcaf71bSMark Cave-Ayland         if (s->dma) {
4351bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4361bcaf71bSMark Cave-Ayland         }
437bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
43849691315SMark Cave-Ayland         /* Target present, but no cmd yet - switch to command phase */
43949691315SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_CD;
440abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
441f2818f22SArtyom Tarasenko     }
442f2818f22SArtyom Tarasenko }
443f2818f22SArtyom Tarasenko 
44474d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s)
44574d71ea1SLaurent Vivier {
4462572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
4472572689bSMark Cave-Ayland     int n;
4482572689bSMark Cave-Ayland 
4492572689bSMark Cave-Ayland     /* Copy FIFO into cmdfifo */
4502572689bSMark Cave-Ayland     n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
4512572689bSMark Cave-Ayland     n = MIN(fifo8_num_free(&s->cmdfifo), n);
4522572689bSMark Cave-Ayland     fifo8_push_all(&s->cmdfifo, buf, n);
4532572689bSMark Cave-Ayland 
454e62a959aSMark Cave-Ayland     if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) {
455023666daSMark Cave-Ayland         trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
45674d71ea1SLaurent Vivier         s->do_cmd = 1;
457023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
458abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_CD);
459abc139cdSMark Cave-Ayland         s->rregs[ESP_RSTAT] |= STAT_TC;
460cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
46174d71ea1SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_CD;
46274d71ea1SLaurent Vivier         esp_raise_irq(s);
46374d71ea1SLaurent Vivier     }
46474d71ea1SLaurent Vivier }
46574d71ea1SLaurent Vivier 
4669f149aa9Spbrook static void handle_satn_stop(ESPState *s)
4679f149aa9Spbrook {
46849691315SMark Cave-Ayland     int32_t cmdlen;
46949691315SMark Cave-Ayland 
4701b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
47173d74342SBlue Swirl         s->dma_cb = handle_satn_stop;
47273d74342SBlue Swirl         return;
47373d74342SBlue Swirl     }
47477987ef5SMark Cave-Ayland     esp_set_pdma_cb(s, SATN_STOP_PDMA_CB);
4751bcaf71bSMark Cave-Ayland     if (esp_select(s) < 0) {
4761bcaf71bSMark Cave-Ayland         return;
4771bcaf71bSMark Cave-Ayland     }
478799d90d8SMark Cave-Ayland     cmdlen = get_cmd(s, 1);
47949691315SMark Cave-Ayland     if (cmdlen > 0) {
480023666daSMark Cave-Ayland         trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo));
4819f149aa9Spbrook         s->do_cmd = 1;
482023666daSMark Cave-Ayland         s->cmdfifo_cdb_offset = 1;
483abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MO);
484cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
485799d90d8SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_MO;
486c73f96fdSblueswir1         esp_raise_irq(s);
48749691315SMark Cave-Ayland     } else if (cmdlen == 0) {
4881bcaf71bSMark Cave-Ayland         if (s->dma) {
4891bcaf71bSMark Cave-Ayland             esp_raise_drq(s);
4901bcaf71bSMark Cave-Ayland         }
491bb0bc7bbSMark Cave-Ayland         s->do_cmd = 1;
492799d90d8SMark Cave-Ayland         /* Target present, switch to message out phase */
493799d90d8SMark Cave-Ayland         s->rregs[ESP_RSEQ] = SEQ_MO;
494abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MO);
4959f149aa9Spbrook     }
4969f149aa9Spbrook }
4979f149aa9Spbrook 
49874d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s)
49974d71ea1SLaurent Vivier {
500abc139cdSMark Cave-Ayland     esp_set_phase(s, STAT_ST);
501cf47a41eSMark Cave-Ayland     s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
50274d71ea1SLaurent Vivier     s->rregs[ESP_RSEQ] = SEQ_CD;
50374d71ea1SLaurent Vivier     esp_raise_irq(s);
50474d71ea1SLaurent Vivier }
50574d71ea1SLaurent Vivier 
5060fc5c15aSpbrook static void write_response(ESPState *s)
5072f275b8fSbellard {
508e3922557SMark Cave-Ayland     uint8_t buf[2];
509042879fcSMark Cave-Ayland 
510bf4b9889SBlue Swirl     trace_esp_write_response(s->status);
511042879fcSMark Cave-Ayland 
512e3922557SMark Cave-Ayland     buf[0] = s->status;
513e3922557SMark Cave-Ayland     buf[1] = 0;
514042879fcSMark Cave-Ayland 
5154f6200f0Sbellard     if (s->dma) {
51674d71ea1SLaurent Vivier         if (s->dma_memory_write) {
517e3922557SMark Cave-Ayland             s->dma_memory_write(s->dma_opaque, buf, 2);
518abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_ST);
519cf47a41eSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC;
5205ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = SEQ_CD;
5214f6200f0Sbellard         } else {
52277987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB);
52374d71ea1SLaurent Vivier             esp_raise_drq(s);
52474d71ea1SLaurent Vivier             return;
52574d71ea1SLaurent Vivier         }
52674d71ea1SLaurent Vivier     } else {
527e3922557SMark Cave-Ayland         fifo8_reset(&s->fifo);
528e3922557SMark Cave-Ayland         fifo8_push_all(&s->fifo, buf, 2);
5295ad6bb97Sblueswir1         s->rregs[ESP_RFLAGS] = 2;
5304f6200f0Sbellard     }
531c73f96fdSblueswir1     esp_raise_irq(s);
5322f275b8fSbellard }
5334f6200f0Sbellard 
534004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s)
5354d611c9aSpbrook {
536af74b3c1SMark Cave-Ayland     if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) {
537cf47a41eSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
538c73f96fdSblueswir1         esp_raise_irq(s);
539af74b3c1SMark Cave-Ayland         esp_lower_drq(s);
540af74b3c1SMark Cave-Ayland     }
5414d611c9aSpbrook }
542a917d384Spbrook 
54374d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s)
54474d71ea1SLaurent Vivier {
5452572689bSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
54682141c8bSMark Cave-Ayland     int len;
547042879fcSMark Cave-Ayland     uint32_t n;
5486cc88d6bSMark Cave-Ayland 
54974d71ea1SLaurent Vivier     if (s->do_cmd) {
5502572689bSMark Cave-Ayland         /* Copy FIFO into cmdfifo */
5512572689bSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
5522572689bSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
5532572689bSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
5542572689bSMark Cave-Ayland 
555e62a959aSMark Cave-Ayland         /* Ensure we have received complete command after SATN and stop */
556e62a959aSMark Cave-Ayland         if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) {
557e62a959aSMark Cave-Ayland             return;
558e62a959aSMark Cave-Ayland         }
559e62a959aSMark Cave-Ayland 
56074d71ea1SLaurent Vivier         s->ti_size = 0;
5615a83e83eSMark Cave-Ayland         if (esp_get_phase(s) == STAT_CD) {
562c348458fSMark Cave-Ayland             /* No command received */
563c348458fSMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
564c348458fSMark Cave-Ayland                 return;
565c348458fSMark Cave-Ayland             }
566c348458fSMark Cave-Ayland 
567c348458fSMark Cave-Ayland             /* Command has been received */
56874d71ea1SLaurent Vivier             s->do_cmd = 0;
569c959f218SMark Cave-Ayland             do_cmd(s);
570c348458fSMark Cave-Ayland         } else {
571c348458fSMark Cave-Ayland             /*
572c348458fSMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
5732cb40d44SStefan Weil              * and then switch to command phase
574c348458fSMark Cave-Ayland              */
575c348458fSMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
576abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
577c348458fSMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
578c348458fSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
579c348458fSMark Cave-Ayland             esp_raise_irq(s);
580c348458fSMark Cave-Ayland         }
58174d71ea1SLaurent Vivier         return;
58274d71ea1SLaurent Vivier     }
58382141c8bSMark Cave-Ayland 
584844b3a84SMark Cave-Ayland     switch (esp_get_phase(s)) {
585844b3a84SMark Cave-Ayland     case STAT_DO:
5860db89536SMark Cave-Ayland         if (!s->current_req) {
5870db89536SMark Cave-Ayland             return;
5880db89536SMark Cave-Ayland         }
58982141c8bSMark Cave-Ayland         /* Copy FIFO data to device */
5907aa6baeeSMark Cave-Ayland         len = MIN(s->async_len, ESP_FIFO_SZ);
5917aa6baeeSMark Cave-Ayland         len = MIN(len, fifo8_num_used(&s->fifo));
5927b320a8eSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
5937aa6baeeSMark Cave-Ayland         s->async_buf += n;
5947aa6baeeSMark Cave-Ayland         s->async_len -= n;
5957aa6baeeSMark Cave-Ayland         s->ti_size += n;
5967aa6baeeSMark Cave-Ayland 
597e4e166c8SMark Cave-Ayland         if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
598e4e166c8SMark Cave-Ayland             /* Defer until the scsi layer has completed */
59974d71ea1SLaurent Vivier             scsi_req_continue(s->current_req);
60082141c8bSMark Cave-Ayland             return;
60182141c8bSMark Cave-Ayland         }
60282141c8bSMark Cave-Ayland 
603004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
604844b3a84SMark Cave-Ayland         break;
605844b3a84SMark Cave-Ayland 
606844b3a84SMark Cave-Ayland     case STAT_DI:
607844b3a84SMark Cave-Ayland         if (!s->current_req) {
608844b3a84SMark Cave-Ayland             return;
609844b3a84SMark Cave-Ayland         }
61082141c8bSMark Cave-Ayland         /* Copy device data to FIFO */
6117aa6baeeSMark Cave-Ayland         len = MIN(s->async_len, esp_get_tc(s));
6127aa6baeeSMark Cave-Ayland         len = MIN(len, fifo8_num_free(&s->fifo));
613042879fcSMark Cave-Ayland         fifo8_push_all(&s->fifo, s->async_buf, len);
61482141c8bSMark Cave-Ayland         s->async_buf += len;
61582141c8bSMark Cave-Ayland         s->async_len -= len;
61682141c8bSMark Cave-Ayland         s->ti_size -= len;
61782141c8bSMark Cave-Ayland         esp_set_tc(s, esp_get_tc(s) - len);
6181b2e34caSMark Cave-Ayland 
6191b2e34caSMark Cave-Ayland         if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
6201b2e34caSMark Cave-Ayland             /* Defer until the scsi layer has completed */
6211b2e34caSMark Cave-Ayland             scsi_req_continue(s->current_req);
6221b2e34caSMark Cave-Ayland             s->data_in_ready = false;
6231b2e34caSMark Cave-Ayland             return;
6241b2e34caSMark Cave-Ayland         }
6251b2e34caSMark Cave-Ayland 
6261b2e34caSMark Cave-Ayland         esp_dma_ti_check(s);
627844b3a84SMark Cave-Ayland         break;
62874d71ea1SLaurent Vivier     }
62982141c8bSMark Cave-Ayland }
63074d71ea1SLaurent Vivier 
631a917d384Spbrook static void esp_do_dma(ESPState *s)
632a917d384Spbrook {
633023666daSMark Cave-Ayland     uint32_t len, cmdlen;
634023666daSMark Cave-Ayland     uint8_t buf[ESP_CMDFIFO_SZ];
63519e9afb1SMark Cave-Ayland     int n;
636a917d384Spbrook 
6376cc88d6bSMark Cave-Ayland     len = esp_get_tc(s);
638a917d384Spbrook     if (s->do_cmd) {
63915407433SLaurent Vivier         /*
64015407433SLaurent Vivier          * handle_ti_cmd() case: esp_do_dma() is called only from
64115407433SLaurent Vivier          * handle_ti_cmd() with do_cmd != NULL (see the assert())
64215407433SLaurent Vivier          */
643023666daSMark Cave-Ayland         cmdlen = fifo8_num_used(&s->cmdfifo);
644023666daSMark Cave-Ayland         trace_esp_do_dma(cmdlen, len);
64574d71ea1SLaurent Vivier         if (s->dma_memory_read) {
6460ebb5fd8SMark Cave-Ayland             len = MIN(len, fifo8_num_free(&s->cmdfifo));
647023666daSMark Cave-Ayland             s->dma_memory_read(s->dma_opaque, buf, len);
648023666daSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, len);
649a0347651SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
65074d71ea1SLaurent Vivier         } else {
6513c7f3c8bSMark Cave-Ayland             n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
6523c7f3c8bSMark Cave-Ayland             n = MIN(fifo8_num_free(&s->cmdfifo), n);
6533c7f3c8bSMark Cave-Ayland             fifo8_push_all(&s->cmdfifo, buf, n);
6543c7f3c8bSMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - n);
6553c7f3c8bSMark Cave-Ayland 
65677987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
65774d71ea1SLaurent Vivier             esp_raise_drq(s);
6583c7f3c8bSMark Cave-Ayland 
6593c7f3c8bSMark Cave-Ayland             /* Ensure we have received complete command after SATN and stop */
6603c7f3c8bSMark Cave-Ayland             if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) {
66174d71ea1SLaurent Vivier                 return;
66274d71ea1SLaurent Vivier             }
6633c7f3c8bSMark Cave-Ayland         }
664023666daSMark Cave-Ayland         trace_esp_handle_ti_cmd(cmdlen);
66515407433SLaurent Vivier         s->ti_size = 0;
6665a83e83eSMark Cave-Ayland         if (esp_get_phase(s) == STAT_CD) {
667799d90d8SMark Cave-Ayland             /* No command received */
668023666daSMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
669799d90d8SMark Cave-Ayland                 return;
670799d90d8SMark Cave-Ayland             }
671799d90d8SMark Cave-Ayland 
672799d90d8SMark Cave-Ayland             /* Command has been received */
67315407433SLaurent Vivier             s->do_cmd = 0;
674c959f218SMark Cave-Ayland             do_cmd(s);
675799d90d8SMark Cave-Ayland         } else {
676799d90d8SMark Cave-Ayland             /*
677023666daSMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
6782cb40d44SStefan Weil              * and then switch to command phase
679799d90d8SMark Cave-Ayland              */
680023666daSMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
681abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
682799d90d8SMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
683799d90d8SMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
684799d90d8SMark Cave-Ayland             esp_raise_irq(s);
685799d90d8SMark Cave-Ayland         }
686a917d384Spbrook         return;
687a917d384Spbrook     }
6881454dc76SMark Cave-Ayland 
6891454dc76SMark Cave-Ayland     switch (esp_get_phase(s)) {
6901454dc76SMark Cave-Ayland     case STAT_DO:
6910db89536SMark Cave-Ayland         if (!s->current_req) {
6920db89536SMark Cave-Ayland             return;
6930db89536SMark Cave-Ayland         }
6944460b86aSMark Cave-Ayland         if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) {
695a917d384Spbrook             /* Defer until data is available.  */
696a917d384Spbrook             return;
697a917d384Spbrook         }
698a917d384Spbrook         if (len > s->async_len) {
699a917d384Spbrook             len = s->async_len;
700a917d384Spbrook         }
70174d71ea1SLaurent Vivier         if (s->dma_memory_read) {
7028b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, s->async_buf, len);
703f3666223SMark Cave-Ayland 
704f3666223SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
705f3666223SMark Cave-Ayland             s->async_buf += len;
706f3666223SMark Cave-Ayland             s->async_len -= len;
707f3666223SMark Cave-Ayland             s->ti_size += len;
708f3666223SMark Cave-Ayland 
709e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
710e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
711f3666223SMark Cave-Ayland                 scsi_req_continue(s->current_req);
712f3666223SMark Cave-Ayland                 return;
713f3666223SMark Cave-Ayland             }
714f3666223SMark Cave-Ayland 
715004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
716a917d384Spbrook         } else {
71719e9afb1SMark Cave-Ayland             /* Copy FIFO data to device */
71819e9afb1SMark Cave-Ayland             len = MIN(s->async_len, ESP_FIFO_SZ);
71919e9afb1SMark Cave-Ayland             len = MIN(len, fifo8_num_used(&s->fifo));
72019e9afb1SMark Cave-Ayland             n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
72119e9afb1SMark Cave-Ayland             s->async_buf += n;
72219e9afb1SMark Cave-Ayland             s->async_len -= n;
72319e9afb1SMark Cave-Ayland             s->ti_size += n;
72419e9afb1SMark Cave-Ayland 
72577987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
72674d71ea1SLaurent Vivier             esp_raise_drq(s);
727e4e166c8SMark Cave-Ayland 
728e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
729e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
730e4e166c8SMark Cave-Ayland                 scsi_req_continue(s->current_req);
731e4e166c8SMark Cave-Ayland                 return;
732e4e166c8SMark Cave-Ayland             }
733e4e166c8SMark Cave-Ayland 
734004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
73574d71ea1SLaurent Vivier         }
7361454dc76SMark Cave-Ayland         break;
7371454dc76SMark Cave-Ayland 
7381454dc76SMark Cave-Ayland     case STAT_DI:
7391454dc76SMark Cave-Ayland         if (!s->current_req) {
7401454dc76SMark Cave-Ayland             return;
7411454dc76SMark Cave-Ayland         }
7421454dc76SMark Cave-Ayland         if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) {
7431454dc76SMark Cave-Ayland             /* Defer until data is available.  */
7441454dc76SMark Cave-Ayland             return;
7451454dc76SMark Cave-Ayland         }
7461454dc76SMark Cave-Ayland         if (len > s->async_len) {
7471454dc76SMark Cave-Ayland             len = s->async_len;
7481454dc76SMark Cave-Ayland         }
74974d71ea1SLaurent Vivier         if (s->dma_memory_write) {
7508b17de88Sblueswir1             s->dma_memory_write(s->dma_opaque, s->async_buf, len);
751f3666223SMark Cave-Ayland 
752f3666223SMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
753f3666223SMark Cave-Ayland             s->async_buf += len;
754f3666223SMark Cave-Ayland             s->async_len -= len;
755f3666223SMark Cave-Ayland             s->ti_size -= len;
756f3666223SMark Cave-Ayland 
757e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
758e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
759f3666223SMark Cave-Ayland                 scsi_req_continue(s->current_req);
760fabcba49SMark Cave-Ayland                 return;
761f3666223SMark Cave-Ayland             }
762f3666223SMark Cave-Ayland 
763004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
76474d71ea1SLaurent Vivier         } else {
76582141c8bSMark Cave-Ayland             /* Copy device data to FIFO */
766042879fcSMark Cave-Ayland             len = MIN(len, fifo8_num_free(&s->fifo));
767042879fcSMark Cave-Ayland             fifo8_push_all(&s->fifo, s->async_buf, len);
76882141c8bSMark Cave-Ayland             s->async_buf += len;
76982141c8bSMark Cave-Ayland             s->async_len -= len;
77082141c8bSMark Cave-Ayland             s->ti_size -= len;
77182141c8bSMark Cave-Ayland             esp_set_tc(s, esp_get_tc(s) - len);
77277987ef5SMark Cave-Ayland             esp_set_pdma_cb(s, DO_DMA_PDMA_CB);
77374d71ea1SLaurent Vivier             esp_raise_drq(s);
774e4e166c8SMark Cave-Ayland 
775e4e166c8SMark Cave-Ayland             if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) {
776e4e166c8SMark Cave-Ayland                 /* Defer until the scsi layer has completed */
777e4e166c8SMark Cave-Ayland                 scsi_req_continue(s->current_req);
778e4e166c8SMark Cave-Ayland                 return;
779e4e166c8SMark Cave-Ayland             }
780e4e166c8SMark Cave-Ayland 
781004826d0SMark Cave-Ayland             esp_dma_ti_check(s);
782e4e166c8SMark Cave-Ayland         }
7831454dc76SMark Cave-Ayland         break;
78474d71ea1SLaurent Vivier     }
785a917d384Spbrook }
786a917d384Spbrook 
7871b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s)
7881b9e48a5SMark Cave-Ayland {
7892572689bSMark Cave-Ayland     uint8_t buf[ESP_FIFO_SZ];
7907b320a8eSMark Cave-Ayland     uint32_t cmdlen;
7912572689bSMark Cave-Ayland     int len, n;
7921b9e48a5SMark Cave-Ayland 
7931b9e48a5SMark Cave-Ayland     if (s->do_cmd) {
7942572689bSMark Cave-Ayland         /* Copy FIFO into cmdfifo */
7952572689bSMark Cave-Ayland         n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo));
7962572689bSMark Cave-Ayland         n = MIN(fifo8_num_free(&s->cmdfifo), n);
7972572689bSMark Cave-Ayland         fifo8_push_all(&s->cmdfifo, buf, n);
7982572689bSMark Cave-Ayland 
7991b9e48a5SMark Cave-Ayland         cmdlen = fifo8_num_used(&s->cmdfifo);
8001b9e48a5SMark Cave-Ayland         trace_esp_handle_ti_cmd(cmdlen);
8011b9e48a5SMark Cave-Ayland         s->ti_size = 0;
8025a83e83eSMark Cave-Ayland         if (esp_get_phase(s) == STAT_CD) {
8031b9e48a5SMark Cave-Ayland             /* No command received */
8041b9e48a5SMark Cave-Ayland             if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) {
8051b9e48a5SMark Cave-Ayland                 return;
8061b9e48a5SMark Cave-Ayland             }
8071b9e48a5SMark Cave-Ayland 
8081b9e48a5SMark Cave-Ayland             /* Command has been received */
8091b9e48a5SMark Cave-Ayland             s->do_cmd = 0;
8101b9e48a5SMark Cave-Ayland             do_cmd(s);
8111b9e48a5SMark Cave-Ayland         } else {
8121b9e48a5SMark Cave-Ayland             /*
8131b9e48a5SMark Cave-Ayland              * Extra message out bytes received: update cmdfifo_cdb_offset
8142cb40d44SStefan Weil              * and then switch to command phase
8151b9e48a5SMark Cave-Ayland              */
8161b9e48a5SMark Cave-Ayland             s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo);
817abc139cdSMark Cave-Ayland             esp_set_phase(s, STAT_CD);
8181b9e48a5SMark Cave-Ayland             s->rregs[ESP_RSEQ] = SEQ_CD;
8191b9e48a5SMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_BS;
8201b9e48a5SMark Cave-Ayland             esp_raise_irq(s);
8211b9e48a5SMark Cave-Ayland         }
8221b9e48a5SMark Cave-Ayland         return;
8231b9e48a5SMark Cave-Ayland     }
8241b9e48a5SMark Cave-Ayland 
825*9d1aa52bSMark Cave-Ayland     switch (esp_get_phase(s)) {
826*9d1aa52bSMark Cave-Ayland     case STAT_DO:
8270db89536SMark Cave-Ayland         if (!s->current_req) {
8280db89536SMark Cave-Ayland             return;
8290db89536SMark Cave-Ayland         }
8301b9e48a5SMark Cave-Ayland         if (s->async_len == 0) {
8311b9e48a5SMark Cave-Ayland             /* Defer until data is available.  */
8321b9e48a5SMark Cave-Ayland             return;
8331b9e48a5SMark Cave-Ayland         }
83477668e4bSMark Cave-Ayland         len = MIN(s->async_len, ESP_FIFO_SZ);
83577668e4bSMark Cave-Ayland         len = MIN(len, fifo8_num_used(&s->fifo));
8367b320a8eSMark Cave-Ayland         esp_fifo_pop_buf(&s->fifo, s->async_buf, len);
8371b9e48a5SMark Cave-Ayland         s->async_buf += len;
8381b9e48a5SMark Cave-Ayland         s->async_len -= len;
8391b9e48a5SMark Cave-Ayland         s->ti_size += len;
840*9d1aa52bSMark Cave-Ayland 
841*9d1aa52bSMark Cave-Ayland         if (s->async_len == 0) {
842*9d1aa52bSMark Cave-Ayland             scsi_req_continue(s->current_req);
843*9d1aa52bSMark Cave-Ayland             return;
844*9d1aa52bSMark Cave-Ayland         }
845*9d1aa52bSMark Cave-Ayland 
846*9d1aa52bSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
847*9d1aa52bSMark Cave-Ayland         esp_raise_irq(s);
848*9d1aa52bSMark Cave-Ayland         break;
849*9d1aa52bSMark Cave-Ayland 
850*9d1aa52bSMark Cave-Ayland     case STAT_DI:
851*9d1aa52bSMark Cave-Ayland         if (!s->current_req) {
852*9d1aa52bSMark Cave-Ayland             return;
853*9d1aa52bSMark Cave-Ayland         }
854*9d1aa52bSMark Cave-Ayland         if (s->async_len == 0) {
855*9d1aa52bSMark Cave-Ayland             /* Defer until data is available.  */
856*9d1aa52bSMark Cave-Ayland             return;
857*9d1aa52bSMark Cave-Ayland         }
8586ef2cabcSMark Cave-Ayland         if (fifo8_is_empty(&s->fifo)) {
8596ef2cabcSMark Cave-Ayland             fifo8_push(&s->fifo, s->async_buf[0]);
8606ef2cabcSMark Cave-Ayland             s->async_buf++;
8616ef2cabcSMark Cave-Ayland             s->async_len--;
8626ef2cabcSMark Cave-Ayland             s->ti_size--;
8636ef2cabcSMark Cave-Ayland         }
8641b9e48a5SMark Cave-Ayland 
8651b9e48a5SMark Cave-Ayland         if (s->async_len == 0) {
8661b9e48a5SMark Cave-Ayland             scsi_req_continue(s->current_req);
8671b9e48a5SMark Cave-Ayland             return;
8681b9e48a5SMark Cave-Ayland         }
8691b9e48a5SMark Cave-Ayland 
8701b9e48a5SMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
8711b9e48a5SMark Cave-Ayland         esp_raise_irq(s);
872*9d1aa52bSMark Cave-Ayland         break;
873*9d1aa52bSMark Cave-Ayland     }
8741b9e48a5SMark Cave-Ayland }
8751b9e48a5SMark Cave-Ayland 
87677987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s)
87777987ef5SMark Cave-Ayland {
87877987ef5SMark Cave-Ayland     switch (s->pdma_cb) {
87977987ef5SMark Cave-Ayland     case SATN_PDMA_CB:
88077987ef5SMark Cave-Ayland         satn_pdma_cb(s);
88177987ef5SMark Cave-Ayland         break;
88277987ef5SMark Cave-Ayland     case SATN_STOP_PDMA_CB:
88377987ef5SMark Cave-Ayland         satn_stop_pdma_cb(s);
88477987ef5SMark Cave-Ayland         break;
88577987ef5SMark Cave-Ayland     case WRITE_RESPONSE_PDMA_CB:
88677987ef5SMark Cave-Ayland         write_response_pdma_cb(s);
88777987ef5SMark Cave-Ayland         break;
88877987ef5SMark Cave-Ayland     case DO_DMA_PDMA_CB:
88977987ef5SMark Cave-Ayland         do_dma_pdma_cb(s);
89077987ef5SMark Cave-Ayland         break;
89177987ef5SMark Cave-Ayland     default:
89277987ef5SMark Cave-Ayland         g_assert_not_reached();
89377987ef5SMark Cave-Ayland     }
89477987ef5SMark Cave-Ayland }
89577987ef5SMark Cave-Ayland 
8964aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid)
897a917d384Spbrook {
8984aaa6ac3SMark Cave-Ayland     ESPState *s = req->hba_private;
8995a83e83eSMark Cave-Ayland     int to_device = (esp_get_phase(s) == STAT_DO);
9004aaa6ac3SMark Cave-Ayland 
901bf4b9889SBlue Swirl     trace_esp_command_complete();
9026ef2cabcSMark Cave-Ayland 
9036ef2cabcSMark Cave-Ayland     /*
9046ef2cabcSMark Cave-Ayland      * Non-DMA transfers from the target will leave the last byte in
9056ef2cabcSMark Cave-Ayland      * the FIFO so don't reset ti_size in this case
9066ef2cabcSMark Cave-Ayland      */
9076ef2cabcSMark Cave-Ayland     if (s->dma || to_device) {
908c6df7102SPaolo Bonzini         if (s->ti_size != 0) {
909bf4b9889SBlue Swirl             trace_esp_command_complete_unexpected();
910c6df7102SPaolo Bonzini         }
9116ef2cabcSMark Cave-Ayland     }
9126ef2cabcSMark Cave-Ayland 
913a917d384Spbrook     s->async_len = 0;
9144aaa6ac3SMark Cave-Ayland     if (req->status) {
915bf4b9889SBlue Swirl         trace_esp_command_complete_fail();
916c6df7102SPaolo Bonzini     }
9174aaa6ac3SMark Cave-Ayland     s->status = req->status;
9186ef2cabcSMark Cave-Ayland 
9196ef2cabcSMark Cave-Ayland     /*
920cb988199SMark Cave-Ayland      * Switch to status phase. For non-DMA transfers from the target the last
921cb988199SMark Cave-Ayland      * byte is still in the FIFO
9226ef2cabcSMark Cave-Ayland      */
923abc139cdSMark Cave-Ayland     esp_set_phase(s, STAT_ST);
924cb988199SMark Cave-Ayland     if (s->ti_size == 0) {
925cb988199SMark Cave-Ayland         /*
926cb988199SMark Cave-Ayland          * Transfer complete: force TC to zero just in case a TI command was
927cb988199SMark Cave-Ayland          * requested for more data than the command returns (Solaris 8 does
928cb988199SMark Cave-Ayland          * this)
929cb988199SMark Cave-Ayland          */
930cb988199SMark Cave-Ayland         esp_set_tc(s, 0);
931004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
932cb988199SMark Cave-Ayland     } else {
933cb988199SMark Cave-Ayland         /*
934cb988199SMark Cave-Ayland          * Transfer truncated: raise INTR_BS to indicate early change of
935cb988199SMark Cave-Ayland          * phase
936cb988199SMark Cave-Ayland          */
937cb988199SMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
938cb988199SMark Cave-Ayland         esp_raise_irq(s);
939cb988199SMark Cave-Ayland         s->ti_size = 0;
9406ef2cabcSMark Cave-Ayland     }
9416ef2cabcSMark Cave-Ayland 
9425c6c0e51SHannes Reinecke     if (s->current_req) {
9435c6c0e51SHannes Reinecke         scsi_req_unref(s->current_req);
9445c6c0e51SHannes Reinecke         s->current_req = NULL;
945a917d384Spbrook         s->current_dev = NULL;
9465c6c0e51SHannes Reinecke     }
947c6df7102SPaolo Bonzini }
948c6df7102SPaolo Bonzini 
9499c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len)
950c6df7102SPaolo Bonzini {
951e6810db8SHervé Poussineau     ESPState *s = req->hba_private;
9525a83e83eSMark Cave-Ayland     int to_device = (esp_get_phase(s) == STAT_DO);
9536cc88d6bSMark Cave-Ayland     uint32_t dmalen = esp_get_tc(s);
954c6df7102SPaolo Bonzini 
9557f0b6e11SPaolo Bonzini     assert(!s->do_cmd);
9566cc88d6bSMark Cave-Ayland     trace_esp_transfer_data(dmalen, s->ti_size);
957aba1f023SPaolo Bonzini     s->async_len = len;
9580c34459bSPaolo Bonzini     s->async_buf = scsi_req_get_buf(req);
9594e78f3bfSMark Cave-Ayland 
9604e78f3bfSMark Cave-Ayland     if (!to_device && !s->data_in_ready) {
9614e78f3bfSMark Cave-Ayland         /*
9624e78f3bfSMark Cave-Ayland          * Initial incoming data xfer is complete so raise command
9634e78f3bfSMark Cave-Ayland          * completion interrupt
9644e78f3bfSMark Cave-Ayland          */
9654e78f3bfSMark Cave-Ayland         s->data_in_ready = true;
9664e78f3bfSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_BS;
9674e78f3bfSMark Cave-Ayland         esp_raise_irq(s);
9684e78f3bfSMark Cave-Ayland     }
9694e78f3bfSMark Cave-Ayland 
9701b9e48a5SMark Cave-Ayland     /*
9711b9e48a5SMark Cave-Ayland      * Always perform the initial transfer upon reception of the next TI
9721b9e48a5SMark Cave-Ayland      * command to ensure the DMA/non-DMA status of the command is correct.
9731b9e48a5SMark Cave-Ayland      * It is not possible to use s->dma directly in the section below as
9741b9e48a5SMark Cave-Ayland      * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the
9751b9e48a5SMark Cave-Ayland      * async data transfer is delayed then s->dma is set incorrectly.
9761b9e48a5SMark Cave-Ayland      */
9771b9e48a5SMark Cave-Ayland 
978880d3089SMark Cave-Ayland     if (s->ti_cmd == (CMD_TI | CMD_DMA)) {
979a79e767aSMark Cave-Ayland         /* When the SCSI layer returns more data, raise deferred INTR_BS */
980004826d0SMark Cave-Ayland         esp_dma_ti_check(s);
981a79e767aSMark Cave-Ayland 
982a79e767aSMark Cave-Ayland         esp_do_dma(s);
983880d3089SMark Cave-Ayland     } else if (s->ti_cmd == CMD_TI) {
9841b9e48a5SMark Cave-Ayland         esp_do_nodma(s);
9851b9e48a5SMark Cave-Ayland     }
986a917d384Spbrook }
9872e5d83bbSpbrook 
9882f275b8fSbellard static void handle_ti(ESPState *s)
9892f275b8fSbellard {
9901b9e48a5SMark Cave-Ayland     uint32_t dmalen;
9912f275b8fSbellard 
9927246e160SHervé Poussineau     if (s->dma && !s->dma_enabled) {
9937246e160SHervé Poussineau         s->dma_cb = handle_ti;
9947246e160SHervé Poussineau         return;
9957246e160SHervé Poussineau     }
9967246e160SHervé Poussineau 
9971b9e48a5SMark Cave-Ayland     s->ti_cmd = s->rregs[ESP_CMD];
9984f6200f0Sbellard     if (s->dma) {
9991b9e48a5SMark Cave-Ayland         dmalen = esp_get_tc(s);
1000b76624deSMark Cave-Ayland         trace_esp_handle_ti(dmalen);
10014d611c9aSpbrook         esp_do_dma(s);
1002799d90d8SMark Cave-Ayland     } else {
10031b9e48a5SMark Cave-Ayland         trace_esp_handle_ti(s->ti_size);
10041b9e48a5SMark Cave-Ayland         esp_do_nodma(s);
10054f6200f0Sbellard     }
10062f275b8fSbellard }
10072f275b8fSbellard 
10089c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s)
10096f7e9aecSbellard {
10105aca8c3bSblueswir1     memset(s->rregs, 0, ESP_REGS);
10115aca8c3bSblueswir1     memset(s->wregs, 0, ESP_REGS);
1012c9cf45c1SHannes Reinecke     s->tchi_written = 0;
10134e9aec74Spbrook     s->ti_size = 0;
10143f26c975SMark Cave-Ayland     s->async_len = 0;
1015042879fcSMark Cave-Ayland     fifo8_reset(&s->fifo);
1016023666daSMark Cave-Ayland     fifo8_reset(&s->cmdfifo);
10174e9aec74Spbrook     s->dma = 0;
10189f149aa9Spbrook     s->do_cmd = 0;
101973d74342SBlue Swirl     s->dma_cb = NULL;
10208dea1dd4Sblueswir1 
10218dea1dd4Sblueswir1     s->rregs[ESP_CFG1] = 7;
10226f7e9aecSbellard }
10236f7e9aecSbellard 
1024a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s)
102585948643SBlue Swirl {
102685948643SBlue Swirl     qemu_irq_lower(s->irq);
102774d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
1028a391fdbcSHervé Poussineau     esp_hard_reset(s);
102985948643SBlue Swirl }
103085948643SBlue Swirl 
1031c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s)
1032c6e51f1bSJohn Millikin {
10334a5fc890SPeter Maydell     bus_cold_reset(BUS(&s->bus));
1034c6e51f1bSJohn Millikin }
1035c6e51f1bSJohn Millikin 
1036a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level)
10372d069babSblueswir1 {
103885948643SBlue Swirl     if (level) {
1039a391fdbcSHervé Poussineau         esp_soft_reset(s);
104085948643SBlue Swirl     }
10412d069babSblueswir1 }
10422d069babSblueswir1 
1043f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s)
1044f21fe39dSMark Cave-Ayland {
1045f21fe39dSMark Cave-Ayland     uint8_t cmd = s->rregs[ESP_CMD];
1046f21fe39dSMark Cave-Ayland 
1047f21fe39dSMark Cave-Ayland     if (cmd & CMD_DMA) {
1048f21fe39dSMark Cave-Ayland         s->dma = 1;
1049f21fe39dSMark Cave-Ayland         /* Reload DMA counter.  */
1050f21fe39dSMark Cave-Ayland         if (esp_get_stc(s) == 0) {
1051f21fe39dSMark Cave-Ayland             esp_set_tc(s, 0x10000);
1052f21fe39dSMark Cave-Ayland         } else {
1053f21fe39dSMark Cave-Ayland             esp_set_tc(s, esp_get_stc(s));
1054f21fe39dSMark Cave-Ayland         }
1055f21fe39dSMark Cave-Ayland     } else {
1056f21fe39dSMark Cave-Ayland         s->dma = 0;
1057f21fe39dSMark Cave-Ayland     }
1058f21fe39dSMark Cave-Ayland     switch (cmd & CMD_CMD) {
1059f21fe39dSMark Cave-Ayland     case CMD_NOP:
1060f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_nop(cmd);
1061f21fe39dSMark Cave-Ayland         break;
1062f21fe39dSMark Cave-Ayland     case CMD_FLUSH:
1063f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_flush(cmd);
1064f21fe39dSMark Cave-Ayland         fifo8_reset(&s->fifo);
1065f21fe39dSMark Cave-Ayland         break;
1066f21fe39dSMark Cave-Ayland     case CMD_RESET:
1067f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_reset(cmd);
1068f21fe39dSMark Cave-Ayland         esp_soft_reset(s);
1069f21fe39dSMark Cave-Ayland         break;
1070f21fe39dSMark Cave-Ayland     case CMD_BUSRESET:
1071f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_bus_reset(cmd);
1072f21fe39dSMark Cave-Ayland         esp_bus_reset(s);
1073f21fe39dSMark Cave-Ayland         if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) {
1074f21fe39dSMark Cave-Ayland             s->rregs[ESP_RINTR] |= INTR_RST;
1075f21fe39dSMark Cave-Ayland             esp_raise_irq(s);
1076f21fe39dSMark Cave-Ayland         }
1077f21fe39dSMark Cave-Ayland         break;
1078f21fe39dSMark Cave-Ayland     case CMD_TI:
1079f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_ti(cmd);
1080f21fe39dSMark Cave-Ayland         handle_ti(s);
1081f21fe39dSMark Cave-Ayland         break;
1082f21fe39dSMark Cave-Ayland     case CMD_ICCS:
1083f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_iccs(cmd);
1084f21fe39dSMark Cave-Ayland         write_response(s);
1085f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_FC;
1086abc139cdSMark Cave-Ayland         esp_set_phase(s, STAT_MI);
1087f21fe39dSMark Cave-Ayland         break;
1088f21fe39dSMark Cave-Ayland     case CMD_MSGACC:
1089f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_msgacc(cmd);
1090f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_DC;
1091f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSEQ] = 0;
1092f21fe39dSMark Cave-Ayland         s->rregs[ESP_RFLAGS] = 0;
1093f21fe39dSMark Cave-Ayland         esp_raise_irq(s);
1094f21fe39dSMark Cave-Ayland         break;
1095f21fe39dSMark Cave-Ayland     case CMD_PAD:
1096f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_pad(cmd);
1097f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSTAT] = STAT_TC;
1098f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] |= INTR_FC;
1099f21fe39dSMark Cave-Ayland         s->rregs[ESP_RSEQ] = 0;
1100f21fe39dSMark Cave-Ayland         break;
1101f21fe39dSMark Cave-Ayland     case CMD_SATN:
1102f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_satn(cmd);
1103f21fe39dSMark Cave-Ayland         break;
1104f21fe39dSMark Cave-Ayland     case CMD_RSTATN:
1105f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_rstatn(cmd);
1106f21fe39dSMark Cave-Ayland         break;
1107f21fe39dSMark Cave-Ayland     case CMD_SEL:
1108f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_sel(cmd);
1109f21fe39dSMark Cave-Ayland         handle_s_without_atn(s);
1110f21fe39dSMark Cave-Ayland         break;
1111f21fe39dSMark Cave-Ayland     case CMD_SELATN:
1112f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_selatn(cmd);
1113f21fe39dSMark Cave-Ayland         handle_satn(s);
1114f21fe39dSMark Cave-Ayland         break;
1115f21fe39dSMark Cave-Ayland     case CMD_SELATNS:
1116f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_selatns(cmd);
1117f21fe39dSMark Cave-Ayland         handle_satn_stop(s);
1118f21fe39dSMark Cave-Ayland         break;
1119f21fe39dSMark Cave-Ayland     case CMD_ENSEL:
1120f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_ensel(cmd);
1121f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] = 0;
1122f21fe39dSMark Cave-Ayland         break;
1123f21fe39dSMark Cave-Ayland     case CMD_DISSEL:
1124f21fe39dSMark Cave-Ayland         trace_esp_mem_writeb_cmd_dissel(cmd);
1125f21fe39dSMark Cave-Ayland         s->rregs[ESP_RINTR] = 0;
1126f21fe39dSMark Cave-Ayland         esp_raise_irq(s);
1127f21fe39dSMark Cave-Ayland         break;
1128f21fe39dSMark Cave-Ayland     default:
1129f21fe39dSMark Cave-Ayland         trace_esp_error_unhandled_command(cmd);
1130f21fe39dSMark Cave-Ayland         break;
1131f21fe39dSMark Cave-Ayland     }
1132f21fe39dSMark Cave-Ayland }
1133f21fe39dSMark Cave-Ayland 
11349c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr)
113573d74342SBlue Swirl {
1136b630c075SMark Cave-Ayland     uint32_t val;
113773d74342SBlue Swirl 
11386f7e9aecSbellard     switch (saddr) {
11395ad6bb97Sblueswir1     case ESP_FIFO:
11401b9e48a5SMark Cave-Ayland         if (s->dma_memory_read && s->dma_memory_write &&
11411b9e48a5SMark Cave-Ayland                 (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) {
11428dea1dd4Sblueswir1             /* Data out.  */
1143ff589551SPrasad J Pandit             qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n");
11445ad6bb97Sblueswir1             s->rregs[ESP_FIFO] = 0;
1145042879fcSMark Cave-Ayland         } else {
11465a83e83eSMark Cave-Ayland             if (esp_get_phase(s) == STAT_DI) {
11476ef2cabcSMark Cave-Ayland                 if (s->ti_size) {
11486ef2cabcSMark Cave-Ayland                     esp_do_nodma(s);
11496ef2cabcSMark Cave-Ayland                 } else {
11506ef2cabcSMark Cave-Ayland                     /*
11516ef2cabcSMark Cave-Ayland                      * The last byte of a non-DMA transfer has been read out
11526ef2cabcSMark Cave-Ayland                      * of the FIFO so switch to status phase
11536ef2cabcSMark Cave-Ayland                      */
1154abc139cdSMark Cave-Ayland                     esp_set_phase(s, STAT_ST);
11556ef2cabcSMark Cave-Ayland                 }
11566ef2cabcSMark Cave-Ayland             }
1157c5fef911SMark Cave-Ayland             s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo);
11584f6200f0Sbellard         }
1159b630c075SMark Cave-Ayland         val = s->rregs[ESP_FIFO];
11604f6200f0Sbellard         break;
11615ad6bb97Sblueswir1     case ESP_RINTR:
116294d5c79dSMark Cave-Ayland         /*
116394d5c79dSMark Cave-Ayland          * Clear sequence step, interrupt register and all status bits
116494d5c79dSMark Cave-Ayland          * except TC
116594d5c79dSMark Cave-Ayland          */
1166b630c075SMark Cave-Ayland         val = s->rregs[ESP_RINTR];
11672814df28SBlue Swirl         s->rregs[ESP_RINTR] = 0;
11682814df28SBlue Swirl         s->rregs[ESP_RSTAT] &= ~STAT_TC;
1169af947a3dSMark Cave-Ayland         /*
1170af947a3dSMark Cave-Ayland          * According to the datasheet ESP_RSEQ should be cleared, but as the
1171af947a3dSMark Cave-Ayland          * emulation currently defers information transfers to the next TI
1172af947a3dSMark Cave-Ayland          * command leave it for now so that pedantic guests such as the old
1173af947a3dSMark Cave-Ayland          * Linux 2.6 driver see the correct flags before the next SCSI phase
1174af947a3dSMark Cave-Ayland          * transition.
1175af947a3dSMark Cave-Ayland          *
1176af947a3dSMark Cave-Ayland          * s->rregs[ESP_RSEQ] = SEQ_0;
1177af947a3dSMark Cave-Ayland          */
1178c73f96fdSblueswir1         esp_lower_irq(s);
1179b630c075SMark Cave-Ayland         break;
1180c9cf45c1SHannes Reinecke     case ESP_TCHI:
1181c9cf45c1SHannes Reinecke         /* Return the unique id if the value has never been written */
1182c9cf45c1SHannes Reinecke         if (!s->tchi_written) {
1183b630c075SMark Cave-Ayland             val = s->chip_id;
1184b630c075SMark Cave-Ayland         } else {
1185b630c075SMark Cave-Ayland             val = s->rregs[saddr];
1186c9cf45c1SHannes Reinecke         }
1187b630c075SMark Cave-Ayland         break;
1188238ec4d7SMark Cave-Ayland      case ESP_RFLAGS:
1189238ec4d7SMark Cave-Ayland         /* Bottom 5 bits indicate number of bytes in FIFO */
1190238ec4d7SMark Cave-Ayland         val = fifo8_num_used(&s->fifo);
1191238ec4d7SMark Cave-Ayland         break;
11926f7e9aecSbellard     default:
1193b630c075SMark Cave-Ayland         val = s->rregs[saddr];
11946f7e9aecSbellard         break;
11956f7e9aecSbellard     }
1196b630c075SMark Cave-Ayland 
1197b630c075SMark Cave-Ayland     trace_esp_mem_readb(saddr, val);
1198b630c075SMark Cave-Ayland     return val;
11996f7e9aecSbellard }
12006f7e9aecSbellard 
12019c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val)
12026f7e9aecSbellard {
1203bf4b9889SBlue Swirl     trace_esp_mem_writeb(saddr, s->wregs[saddr], val);
12046f7e9aecSbellard     switch (saddr) {
1205c9cf45c1SHannes Reinecke     case ESP_TCHI:
1206c9cf45c1SHannes Reinecke         s->tchi_written = true;
1207c9cf45c1SHannes Reinecke         /* fall through */
12085ad6bb97Sblueswir1     case ESP_TCLO:
12095ad6bb97Sblueswir1     case ESP_TCMID:
12105ad6bb97Sblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_TC;
12114f6200f0Sbellard         break;
12125ad6bb97Sblueswir1     case ESP_FIFO:
12139f149aa9Spbrook         if (s->do_cmd) {
12142572689bSMark Cave-Ayland             if (!fifo8_is_full(&s->fifo)) {
12152572689bSMark Cave-Ayland                 esp_fifo_push(&s->fifo, val);
12162572689bSMark Cave-Ayland                 esp_fifo_push(&s->cmdfifo, fifo8_pop(&s->fifo));
12172572689bSMark Cave-Ayland             }
12186ef2cabcSMark Cave-Ayland 
12196ef2cabcSMark Cave-Ayland             /*
12206ef2cabcSMark Cave-Ayland              * If any unexpected message out/command phase data is
12216ef2cabcSMark Cave-Ayland              * transferred using non-DMA, raise the interrupt
12226ef2cabcSMark Cave-Ayland              */
12236ef2cabcSMark Cave-Ayland             if (s->rregs[ESP_CMD] == CMD_TI) {
12246ef2cabcSMark Cave-Ayland                 s->rregs[ESP_RINTR] |= INTR_BS;
12256ef2cabcSMark Cave-Ayland                 esp_raise_irq(s);
12266ef2cabcSMark Cave-Ayland             }
12272e5d83bbSpbrook         } else {
1228e5455b8cSMark Cave-Ayland             esp_fifo_push(&s->fifo, val);
12292e5d83bbSpbrook         }
12304f6200f0Sbellard         break;
12315ad6bb97Sblueswir1     case ESP_CMD:
12324f6200f0Sbellard         s->rregs[saddr] = val;
1233f21fe39dSMark Cave-Ayland         esp_run_cmd(s);
12346f7e9aecSbellard         break;
12355ad6bb97Sblueswir1     case ESP_WBUSID ... ESP_WSYNO:
12364f6200f0Sbellard         break;
12375ad6bb97Sblueswir1     case ESP_CFG1:
12389ea73f8bSPaolo Bonzini     case ESP_CFG2: case ESP_CFG3:
12399ea73f8bSPaolo Bonzini     case ESP_RES3: case ESP_RES4:
12404f6200f0Sbellard         s->rregs[saddr] = val;
12414f6200f0Sbellard         break;
12425ad6bb97Sblueswir1     case ESP_WCCF ... ESP_WTEST:
12434f6200f0Sbellard         break;
12446f7e9aecSbellard     default:
12453af4e9aaSHervé Poussineau         trace_esp_error_invalid_write(val, saddr);
12468dea1dd4Sblueswir1         return;
12476f7e9aecSbellard     }
12482f275b8fSbellard     s->wregs[saddr] = val;
12496f7e9aecSbellard }
12506f7e9aecSbellard 
1251a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr,
12528372d383SPeter Maydell                             unsigned size, bool is_write,
12538372d383SPeter Maydell                             MemTxAttrs attrs)
125467bb5314SAvi Kivity {
125567bb5314SAvi Kivity     return (size == 1) || (is_write && size == 4);
125667bb5314SAvi Kivity }
12576f7e9aecSbellard 
12586cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id)
12596cc88d6bSMark Cave-Ayland {
12606cc88d6bSMark Cave-Ayland     ESPState *s = ESP(opaque);
12616cc88d6bSMark Cave-Ayland 
12626cc88d6bSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12636cc88d6bSMark Cave-Ayland     return version_id < 5;
12646cc88d6bSMark Cave-Ayland }
12656cc88d6bSMark Cave-Ayland 
12664e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id)
12674e78f3bfSMark Cave-Ayland {
12684e78f3bfSMark Cave-Ayland     ESPState *s = ESP(opaque);
12694e78f3bfSMark Cave-Ayland 
12704e78f3bfSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12710bcd5a18SMark Cave-Ayland     return version_id >= 5;
12724e78f3bfSMark Cave-Ayland }
12734e78f3bfSMark Cave-Ayland 
12744eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id)
12754eb86065SPaolo Bonzini {
12764eb86065SPaolo Bonzini     ESPState *s = ESP(opaque);
12774eb86065SPaolo Bonzini 
12784eb86065SPaolo Bonzini     version_id = MIN(version_id, s->mig_version_id);
12794eb86065SPaolo Bonzini     return version_id >= 6;
12804eb86065SPaolo Bonzini }
12814eb86065SPaolo Bonzini 
1282ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque)
12830bd005beSMark Cave-Ayland {
1284ff4a1dabSMark Cave-Ayland     ESPState *s = ESP(object_resolve_path_component(
1285ff4a1dabSMark Cave-Ayland                       OBJECT(opaque), "esp"));
12860bd005beSMark Cave-Ayland 
12870bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
12880bd005beSMark Cave-Ayland     return 0;
12890bd005beSMark Cave-Ayland }
12900bd005beSMark Cave-Ayland 
12910bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id)
12920bd005beSMark Cave-Ayland {
12930bd005beSMark Cave-Ayland     ESPState *s = ESP(opaque);
1294042879fcSMark Cave-Ayland     int len, i;
12950bd005beSMark Cave-Ayland 
12966cc88d6bSMark Cave-Ayland     version_id = MIN(version_id, s->mig_version_id);
12976cc88d6bSMark Cave-Ayland 
12986cc88d6bSMark Cave-Ayland     if (version_id < 5) {
12996cc88d6bSMark Cave-Ayland         esp_set_tc(s, s->mig_dma_left);
1300042879fcSMark Cave-Ayland 
1301042879fcSMark Cave-Ayland         /* Migrate ti_buf to fifo */
1302042879fcSMark Cave-Ayland         len = s->mig_ti_wptr - s->mig_ti_rptr;
1303042879fcSMark Cave-Ayland         for (i = 0; i < len; i++) {
1304042879fcSMark Cave-Ayland             fifo8_push(&s->fifo, s->mig_ti_buf[i]);
1305042879fcSMark Cave-Ayland         }
1306023666daSMark Cave-Ayland 
1307023666daSMark Cave-Ayland         /* Migrate cmdbuf to cmdfifo */
1308023666daSMark Cave-Ayland         for (i = 0; i < s->mig_cmdlen; i++) {
1309023666daSMark Cave-Ayland             fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]);
1310023666daSMark Cave-Ayland         }
13116cc88d6bSMark Cave-Ayland     }
13126cc88d6bSMark Cave-Ayland 
13130bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
13140bd005beSMark Cave-Ayland     return 0;
13150bd005beSMark Cave-Ayland }
13160bd005beSMark Cave-Ayland 
1317eda59b39SMark Cave-Ayland /*
1318eda59b39SMark Cave-Ayland  * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the
1319eda59b39SMark Cave-Ayland  * guest CPU to perform the transfers between the SCSI bus and memory
1320eda59b39SMark Cave-Ayland  * itself. This is indicated by the dma_memory_read and dma_memory_write
1321eda59b39SMark Cave-Ayland  * functions being NULL (in contrast to the ESP PCI device) whilst
1322eda59b39SMark Cave-Ayland  * dma_enabled is still set.
1323eda59b39SMark Cave-Ayland  */
1324eda59b39SMark Cave-Ayland 
1325eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque)
1326eda59b39SMark Cave-Ayland {
1327eda59b39SMark Cave-Ayland     ESPState *s = ESP(opaque);
1328eda59b39SMark Cave-Ayland 
1329eda59b39SMark Cave-Ayland     return s->dma_memory_read == NULL && s->dma_memory_write == NULL &&
1330eda59b39SMark Cave-Ayland            s->dma_enabled;
1331eda59b39SMark Cave-Ayland }
1332eda59b39SMark Cave-Ayland 
1333eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = {
1334eda59b39SMark Cave-Ayland     .name = "esp/pdma",
1335eda59b39SMark Cave-Ayland     .version_id = 0,
1336eda59b39SMark Cave-Ayland     .minimum_version_id = 0,
1337eda59b39SMark Cave-Ayland     .needed = esp_pdma_needed,
13382d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
1339eda59b39SMark Cave-Ayland         VMSTATE_UINT8(pdma_cb, ESPState),
1340eda59b39SMark Cave-Ayland         VMSTATE_END_OF_LIST()
1341eda59b39SMark Cave-Ayland     }
1342eda59b39SMark Cave-Ayland };
1343eda59b39SMark Cave-Ayland 
13449c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = {
1345cc9952f3SBlue Swirl     .name = "esp",
13464eb86065SPaolo Bonzini     .version_id = 6,
1347cc9952f3SBlue Swirl     .minimum_version_id = 3,
13480bd005beSMark Cave-Ayland     .post_load = esp_post_load,
13492d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
1350cc9952f3SBlue Swirl         VMSTATE_BUFFER(rregs, ESPState),
1351cc9952f3SBlue Swirl         VMSTATE_BUFFER(wregs, ESPState),
1352cc9952f3SBlue Swirl         VMSTATE_INT32(ti_size, ESPState),
1353042879fcSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5),
1354042879fcSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5),
1355042879fcSMark Cave-Ayland         VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5),
13563944966dSPaolo Bonzini         VMSTATE_UINT32(status, ESPState),
13574aaa6ac3SMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_deferred_status, ESPState,
13584aaa6ac3SMark Cave-Ayland                             esp_is_before_version_5),
13594aaa6ac3SMark Cave-Ayland         VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState,
13604aaa6ac3SMark Cave-Ayland                           esp_is_before_version_5),
1361cc9952f3SBlue Swirl         VMSTATE_UINT32(dma, ESPState),
1362023666daSMark Cave-Ayland         VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0,
1363023666daSMark Cave-Ayland                               esp_is_before_version_5, 0, 16),
1364023666daSMark Cave-Ayland         VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4,
1365023666daSMark Cave-Ayland                               esp_is_before_version_5, 16,
1366023666daSMark Cave-Ayland                               sizeof(typeof_field(ESPState, mig_cmdbuf))),
1367023666daSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5),
1368cc9952f3SBlue Swirl         VMSTATE_UINT32(do_cmd, ESPState),
13696cc88d6bSMark Cave-Ayland         VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5),
13704e78f3bfSMark Cave-Ayland         VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5),
1371023666daSMark Cave-Ayland         VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5),
1372042879fcSMark Cave-Ayland         VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5),
1373023666daSMark Cave-Ayland         VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5),
13741b9e48a5SMark Cave-Ayland         VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5),
13754eb86065SPaolo Bonzini         VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6),
1376cc9952f3SBlue Swirl         VMSTATE_END_OF_LIST()
137774d71ea1SLaurent Vivier     },
13782d7b39a6SRichard Henderson     .subsections = (const VMStateDescription * const []) {
1379eda59b39SMark Cave-Ayland         &vmstate_esp_pdma,
1380eda59b39SMark Cave-Ayland         NULL
1381eda59b39SMark Cave-Ayland     }
1382cc9952f3SBlue Swirl };
13836f7e9aecSbellard 
1384a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr,
1385a391fdbcSHervé Poussineau                                  uint64_t val, unsigned int size)
1386a391fdbcSHervé Poussineau {
1387a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
1388eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1389a391fdbcSHervé Poussineau     uint32_t saddr;
1390a391fdbcSHervé Poussineau 
1391a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
1392eb169c76SMark Cave-Ayland     esp_reg_write(s, saddr, val);
1393a391fdbcSHervé Poussineau }
1394a391fdbcSHervé Poussineau 
1395a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr,
1396a391fdbcSHervé Poussineau                                     unsigned int size)
1397a391fdbcSHervé Poussineau {
1398a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
1399eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1400a391fdbcSHervé Poussineau     uint32_t saddr;
1401a391fdbcSHervé Poussineau 
1402a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
1403eb169c76SMark Cave-Ayland     return esp_reg_read(s, saddr);
1404a391fdbcSHervé Poussineau }
1405a391fdbcSHervé Poussineau 
1406a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = {
1407a391fdbcSHervé Poussineau     .read = sysbus_esp_mem_read,
1408a391fdbcSHervé Poussineau     .write = sysbus_esp_mem_write,
1409a391fdbcSHervé Poussineau     .endianness = DEVICE_NATIVE_ENDIAN,
1410a391fdbcSHervé Poussineau     .valid.accepts = esp_mem_accepts,
1411a391fdbcSHervé Poussineau };
1412a391fdbcSHervé Poussineau 
141374d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
141474d71ea1SLaurent Vivier                                   uint64_t val, unsigned int size)
141574d71ea1SLaurent Vivier {
141674d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
1417eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
141874d71ea1SLaurent Vivier 
1419960ebfd9SMark Cave-Ayland     trace_esp_pdma_write(size);
1420960ebfd9SMark Cave-Ayland 
142174d71ea1SLaurent Vivier     switch (size) {
142274d71ea1SLaurent Vivier     case 1:
1423761bef75SMark Cave-Ayland         esp_pdma_write(s, val);
142474d71ea1SLaurent Vivier         break;
142574d71ea1SLaurent Vivier     case 2:
1426761bef75SMark Cave-Ayland         esp_pdma_write(s, val >> 8);
1427761bef75SMark Cave-Ayland         esp_pdma_write(s, val);
142874d71ea1SLaurent Vivier         break;
142974d71ea1SLaurent Vivier     }
1430d0243b09SMark Cave-Ayland     esp_pdma_cb(s);
143174d71ea1SLaurent Vivier }
143274d71ea1SLaurent Vivier 
143374d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
143474d71ea1SLaurent Vivier                                      unsigned int size)
143574d71ea1SLaurent Vivier {
143674d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
1437eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
143874d71ea1SLaurent Vivier     uint64_t val = 0;
143974d71ea1SLaurent Vivier 
1440960ebfd9SMark Cave-Ayland     trace_esp_pdma_read(size);
1441960ebfd9SMark Cave-Ayland 
144274d71ea1SLaurent Vivier     switch (size) {
144374d71ea1SLaurent Vivier     case 1:
1444761bef75SMark Cave-Ayland         val = esp_pdma_read(s);
144574d71ea1SLaurent Vivier         break;
144674d71ea1SLaurent Vivier     case 2:
1447761bef75SMark Cave-Ayland         val = esp_pdma_read(s);
1448761bef75SMark Cave-Ayland         val = (val << 8) | esp_pdma_read(s);
144974d71ea1SLaurent Vivier         break;
145074d71ea1SLaurent Vivier     }
1451d0243b09SMark Cave-Ayland     esp_pdma_cb(s);
145274d71ea1SLaurent Vivier     return val;
145374d71ea1SLaurent Vivier }
145474d71ea1SLaurent Vivier 
1455a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req)
1456a7a22088SMark Cave-Ayland {
1457a7a22088SMark Cave-Ayland     ESPState *s = container_of(req->bus, ESPState, bus);
1458a7a22088SMark Cave-Ayland 
1459a7a22088SMark Cave-Ayland     scsi_req_ref(req);
1460a7a22088SMark Cave-Ayland     s->current_req = req;
1461a7a22088SMark Cave-Ayland     return s;
1462a7a22088SMark Cave-Ayland }
1463a7a22088SMark Cave-Ayland 
146474d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = {
146574d71ea1SLaurent Vivier     .read = sysbus_esp_pdma_read,
146674d71ea1SLaurent Vivier     .write = sysbus_esp_pdma_write,
146774d71ea1SLaurent Vivier     .endianness = DEVICE_NATIVE_ENDIAN,
146874d71ea1SLaurent Vivier     .valid.min_access_size = 1,
1469cf1b8286SMark Cave-Ayland     .valid.max_access_size = 4,
1470cf1b8286SMark Cave-Ayland     .impl.min_access_size = 1,
1471cf1b8286SMark Cave-Ayland     .impl.max_access_size = 2,
147274d71ea1SLaurent Vivier };
147374d71ea1SLaurent Vivier 
1474afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = {
1475afd4030cSPaolo Bonzini     .tcq = false,
14767e0380b9SPaolo Bonzini     .max_target = ESP_MAX_DEVS,
14777e0380b9SPaolo Bonzini     .max_lun = 7,
1478afd4030cSPaolo Bonzini 
1479a7a22088SMark Cave-Ayland     .load_request = esp_load_request,
1480c6df7102SPaolo Bonzini     .transfer_data = esp_transfer_data,
148194d3f98aSPaolo Bonzini     .complete = esp_command_complete,
148294d3f98aSPaolo Bonzini     .cancel = esp_request_cancelled
1483cfdc1bb0SPaolo Bonzini };
1484cfdc1bb0SPaolo Bonzini 
1485a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level)
1486cfb9de9cSPaul Brook {
148784fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(opaque);
1488eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1489a391fdbcSHervé Poussineau 
1490a391fdbcSHervé Poussineau     switch (irq) {
1491a391fdbcSHervé Poussineau     case 0:
1492a391fdbcSHervé Poussineau         parent_esp_reset(s, irq, level);
1493a391fdbcSHervé Poussineau         break;
1494a391fdbcSHervé Poussineau     case 1:
1495b86dc5cbSMark Cave-Ayland         esp_dma_enable(s, irq, level);
1496a391fdbcSHervé Poussineau         break;
1497a391fdbcSHervé Poussineau     }
1498a391fdbcSHervé Poussineau }
1499a391fdbcSHervé Poussineau 
1500b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp)
1501a391fdbcSHervé Poussineau {
1502b09318caSHu Tao     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
150384fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1504eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1505eb169c76SMark Cave-Ayland 
1506eb169c76SMark Cave-Ayland     if (!qdev_realize(DEVICE(s), NULL, errp)) {
1507eb169c76SMark Cave-Ayland         return;
1508eb169c76SMark Cave-Ayland     }
15096f7e9aecSbellard 
1510b09318caSHu Tao     sysbus_init_irq(sbd, &s->irq);
151174d71ea1SLaurent Vivier     sysbus_init_irq(sbd, &s->irq_data);
1512a391fdbcSHervé Poussineau     assert(sysbus->it_shift != -1);
15136f7e9aecSbellard 
1514d32e4b3dSHervé Poussineau     s->chip_id = TCHI_FAS100A;
151529776739SPaolo Bonzini     memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops,
151674d71ea1SLaurent Vivier                           sysbus, "esp-regs", ESP_REGS << sysbus->it_shift);
1517b09318caSHu Tao     sysbus_init_mmio(sbd, &sysbus->iomem);
151874d71ea1SLaurent Vivier     memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops,
1519cf1b8286SMark Cave-Ayland                           sysbus, "esp-pdma", 4);
152074d71ea1SLaurent Vivier     sysbus_init_mmio(sbd, &sysbus->pdma);
15216f7e9aecSbellard 
1522b09318caSHu Tao     qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2);
15232d069babSblueswir1 
1524739e95f5SPeter Maydell     scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info);
152567e999beSbellard }
1526cfb9de9cSPaul Brook 
1527a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev)
1528a391fdbcSHervé Poussineau {
152984fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1530eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1531eb169c76SMark Cave-Ayland 
1532eb169c76SMark Cave-Ayland     esp_hard_reset(s);
1533eb169c76SMark Cave-Ayland }
1534eb169c76SMark Cave-Ayland 
1535eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj)
1536eb169c76SMark Cave-Ayland {
1537eb169c76SMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(obj);
1538eb169c76SMark Cave-Ayland 
1539eb169c76SMark Cave-Ayland     object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP);
1540a391fdbcSHervé Poussineau }
1541a391fdbcSHervé Poussineau 
1542a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = {
1543a391fdbcSHervé Poussineau     .name = "sysbusespscsi",
15440bd005beSMark Cave-Ayland     .version_id = 2,
1545ea84a442SGuenter Roeck     .minimum_version_id = 1,
1546ff4a1dabSMark Cave-Ayland     .pre_save = esp_pre_save,
15472d7b39a6SRichard Henderson     .fields = (const VMStateField[]) {
15480bd005beSMark Cave-Ayland         VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2),
1549a391fdbcSHervé Poussineau         VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState),
1550a391fdbcSHervé Poussineau         VMSTATE_END_OF_LIST()
1551a391fdbcSHervé Poussineau     }
1552999e12bbSAnthony Liguori };
1553999e12bbSAnthony Liguori 
1554a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data)
1555999e12bbSAnthony Liguori {
155639bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1557999e12bbSAnthony Liguori 
1558b09318caSHu Tao     dc->realize = sysbus_esp_realize;
1559a391fdbcSHervé Poussineau     dc->reset = sysbus_esp_hard_reset;
1560a391fdbcSHervé Poussineau     dc->vmsd = &vmstate_sysbus_esp_scsi;
1561125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
156263235df8SBlue Swirl }
1563999e12bbSAnthony Liguori 
15641f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = {
156584fbefedSMark Cave-Ayland     .name          = TYPE_SYSBUS_ESP,
156639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
1567eb169c76SMark Cave-Ayland     .instance_init = sysbus_esp_init,
1568a391fdbcSHervé Poussineau     .instance_size = sizeof(SysBusESPState),
1569a391fdbcSHervé Poussineau     .class_init    = sysbus_esp_class_init,
157063235df8SBlue Swirl };
157163235df8SBlue Swirl 
1572042879fcSMark Cave-Ayland static void esp_finalize(Object *obj)
1573042879fcSMark Cave-Ayland {
1574042879fcSMark Cave-Ayland     ESPState *s = ESP(obj);
1575042879fcSMark Cave-Ayland 
1576042879fcSMark Cave-Ayland     fifo8_destroy(&s->fifo);
1577023666daSMark Cave-Ayland     fifo8_destroy(&s->cmdfifo);
1578042879fcSMark Cave-Ayland }
1579042879fcSMark Cave-Ayland 
1580042879fcSMark Cave-Ayland static void esp_init(Object *obj)
1581042879fcSMark Cave-Ayland {
1582042879fcSMark Cave-Ayland     ESPState *s = ESP(obj);
1583042879fcSMark Cave-Ayland 
1584042879fcSMark Cave-Ayland     fifo8_create(&s->fifo, ESP_FIFO_SZ);
1585023666daSMark Cave-Ayland     fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ);
1586042879fcSMark Cave-Ayland }
1587042879fcSMark Cave-Ayland 
1588eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data)
1589eb169c76SMark Cave-Ayland {
1590eb169c76SMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(klass);
1591eb169c76SMark Cave-Ayland 
1592eb169c76SMark Cave-Ayland     /* internal device for sysbusesp/pciespscsi, not user-creatable */
1593eb169c76SMark Cave-Ayland     dc->user_creatable = false;
1594eb169c76SMark Cave-Ayland     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
1595eb169c76SMark Cave-Ayland }
1596eb169c76SMark Cave-Ayland 
1597eb169c76SMark Cave-Ayland static const TypeInfo esp_info = {
1598eb169c76SMark Cave-Ayland     .name = TYPE_ESP,
1599eb169c76SMark Cave-Ayland     .parent = TYPE_DEVICE,
1600042879fcSMark Cave-Ayland     .instance_init = esp_init,
1601042879fcSMark Cave-Ayland     .instance_finalize = esp_finalize,
1602eb169c76SMark Cave-Ayland     .instance_size = sizeof(ESPState),
1603eb169c76SMark Cave-Ayland     .class_init = esp_class_init,
1604eb169c76SMark Cave-Ayland };
1605eb169c76SMark Cave-Ayland 
160683f7d43aSAndreas Färber static void esp_register_types(void)
1607cfb9de9cSPaul Brook {
1608a391fdbcSHervé Poussineau     type_register_static(&sysbus_esp_info);
1609eb169c76SMark Cave-Ayland     type_register_static(&esp_info);
1610cfb9de9cSPaul Brook }
1611cfb9de9cSPaul Brook 
161283f7d43aSAndreas Färber type_init(esp_register_types)
1613