xref: /qemu/hw/scsi/esp.c (revision 960ebfd94e8f6ea879472e7efb84b1704f685d39)
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);
66*960ebfd9SMark 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);
72*960ebfd9SMark 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;
9894d3f98aSPaolo Bonzini     }
9994d3f98aSPaolo Bonzini }
10094d3f98aSPaolo Bonzini 
10174d71ea1SLaurent Vivier static void set_pdma(ESPState *s, enum pdma_origin_id origin,
10274d71ea1SLaurent Vivier                      uint32_t index, uint32_t len)
10374d71ea1SLaurent Vivier {
10474d71ea1SLaurent Vivier     s->pdma_origin = origin;
10574d71ea1SLaurent Vivier     s->pdma_start = index;
10674d71ea1SLaurent Vivier     s->pdma_cur = index;
10774d71ea1SLaurent Vivier     s->pdma_len = len;
10874d71ea1SLaurent Vivier }
10974d71ea1SLaurent Vivier 
11074d71ea1SLaurent Vivier static uint8_t *get_pdma_buf(ESPState *s)
11174d71ea1SLaurent Vivier {
11274d71ea1SLaurent Vivier     switch (s->pdma_origin) {
11374d71ea1SLaurent Vivier     case PDMA:
11474d71ea1SLaurent Vivier         return s->pdma_buf;
11574d71ea1SLaurent Vivier     case TI:
11674d71ea1SLaurent Vivier         return s->ti_buf;
11774d71ea1SLaurent Vivier     case CMD:
11874d71ea1SLaurent Vivier         return s->cmdbuf;
11974d71ea1SLaurent Vivier     case ASYNC:
12074d71ea1SLaurent Vivier         return s->async_buf;
12174d71ea1SLaurent Vivier     }
12274d71ea1SLaurent Vivier     return NULL;
12374d71ea1SLaurent Vivier }
12474d71ea1SLaurent Vivier 
1256130b188SLaurent Vivier static int get_cmd_cb(ESPState *s)
1266130b188SLaurent Vivier {
1276130b188SLaurent Vivier     int target;
1286130b188SLaurent Vivier 
1296130b188SLaurent Vivier     target = s->wregs[ESP_WBUSID] & BUSID_DID;
1306130b188SLaurent Vivier 
1316130b188SLaurent Vivier     s->ti_size = 0;
1326130b188SLaurent Vivier     s->ti_rptr = 0;
1336130b188SLaurent Vivier     s->ti_wptr = 0;
1346130b188SLaurent Vivier 
1356130b188SLaurent Vivier     if (s->current_req) {
1366130b188SLaurent Vivier         /* Started a new command before the old one finished.  Cancel it.  */
1376130b188SLaurent Vivier         scsi_req_cancel(s->current_req);
1386130b188SLaurent Vivier         s->async_len = 0;
1396130b188SLaurent Vivier     }
1406130b188SLaurent Vivier 
1416130b188SLaurent Vivier     s->current_dev = scsi_device_find(&s->bus, 0, target, 0);
1426130b188SLaurent Vivier     if (!s->current_dev) {
1436130b188SLaurent Vivier         /* No such drive */
1446130b188SLaurent Vivier         s->rregs[ESP_RSTAT] = 0;
1456130b188SLaurent Vivier         s->rregs[ESP_RINTR] = INTR_DC;
1466130b188SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_0;
1476130b188SLaurent Vivier         esp_raise_irq(s);
1486130b188SLaurent Vivier         return -1;
1496130b188SLaurent Vivier     }
1506130b188SLaurent Vivier     return 0;
1516130b188SLaurent Vivier }
1526130b188SLaurent Vivier 
1536c1fef6bSPrasad J Pandit static uint32_t get_cmd(ESPState *s, uint8_t *buf, uint8_t buflen)
1542f275b8fSbellard {
155a917d384Spbrook     uint32_t dmalen;
1562f275b8fSbellard     int target;
1572f275b8fSbellard 
1588dea1dd4Sblueswir1     target = s->wregs[ESP_WBUSID] & BUSID_DID;
1594f6200f0Sbellard     if (s->dma) {
1609ea73f8bSPaolo Bonzini         dmalen = s->rregs[ESP_TCLO];
1619ea73f8bSPaolo Bonzini         dmalen |= s->rregs[ESP_TCMID] << 8;
1629ea73f8bSPaolo Bonzini         dmalen |= s->rregs[ESP_TCHI] << 16;
1636c1fef6bSPrasad J Pandit         if (dmalen > buflen) {
1646c1fef6bSPrasad J Pandit             return 0;
1656c1fef6bSPrasad J Pandit         }
16674d71ea1SLaurent Vivier         if (s->dma_memory_read) {
1678b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, buf, dmalen);
1684f6200f0Sbellard         } else {
16974d71ea1SLaurent Vivier             memcpy(s->pdma_buf, buf, dmalen);
17074d71ea1SLaurent Vivier             set_pdma(s, PDMA, 0, dmalen);
17174d71ea1SLaurent Vivier             esp_raise_drq(s);
17274d71ea1SLaurent Vivier             return 0;
17374d71ea1SLaurent Vivier         }
17474d71ea1SLaurent Vivier     } else {
175fc4d65daSblueswir1         dmalen = s->ti_size;
176d3cdc491SPrasad J Pandit         if (dmalen > TI_BUFSZ) {
177d3cdc491SPrasad J Pandit             return 0;
178d3cdc491SPrasad J Pandit         }
179fc4d65daSblueswir1         memcpy(buf, s->ti_buf, dmalen);
18075ef8496SHervé Poussineau         buf[0] = buf[2] >> 5;
1814f6200f0Sbellard     }
182bf4b9889SBlue Swirl     trace_esp_get_cmd(dmalen, target);
1832e5d83bbSpbrook 
1846130b188SLaurent Vivier     if (get_cmd_cb(s) < 0) {
1859f149aa9Spbrook         return 0;
1862f275b8fSbellard     }
1879f149aa9Spbrook     return dmalen;
1889f149aa9Spbrook }
1899f149aa9Spbrook 
190f2818f22SArtyom Tarasenko static void do_busid_cmd(ESPState *s, uint8_t *buf, uint8_t busid)
1919f149aa9Spbrook {
1929f149aa9Spbrook     int32_t datalen;
1939f149aa9Spbrook     int lun;
194f48a7a6eSPaolo Bonzini     SCSIDevice *current_lun;
1959f149aa9Spbrook 
196bf4b9889SBlue Swirl     trace_esp_do_busid_cmd(busid);
197f2818f22SArtyom Tarasenko     lun = busid & 7;
1980d3545e7SPaolo Bonzini     current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, lun);
199e6810db8SHervé Poussineau     s->current_req = scsi_req_new(current_lun, 0, lun, buf, s);
200c39ce112SPaolo Bonzini     datalen = scsi_req_enqueue(s->current_req);
20167e999beSbellard     s->ti_size = datalen;
20267e999beSbellard     if (datalen != 0) {
203c73f96fdSblueswir1         s->rregs[ESP_RSTAT] = STAT_TC;
204a917d384Spbrook         s->dma_left = 0;
2056787f5faSpbrook         s->dma_counter = 0;
2062e5d83bbSpbrook         if (datalen > 0) {
2075ad6bb97Sblueswir1             s->rregs[ESP_RSTAT] |= STAT_DI;
2084f6200f0Sbellard         } else {
2095ad6bb97Sblueswir1             s->rregs[ESP_RSTAT] |= STAT_DO;
2104f6200f0Sbellard         }
211ad3376ccSPaolo Bonzini         scsi_req_continue(s->current_req);
2124e9aec74Spbrook     }
2135ad6bb97Sblueswir1     s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
2145ad6bb97Sblueswir1     s->rregs[ESP_RSEQ] = SEQ_CD;
215c73f96fdSblueswir1     esp_raise_irq(s);
2162f275b8fSbellard }
2172f275b8fSbellard 
218f2818f22SArtyom Tarasenko static void do_cmd(ESPState *s, uint8_t *buf)
219f2818f22SArtyom Tarasenko {
220f2818f22SArtyom Tarasenko     uint8_t busid = buf[0];
221f2818f22SArtyom Tarasenko 
222f2818f22SArtyom Tarasenko     do_busid_cmd(s, &buf[1], busid);
223f2818f22SArtyom Tarasenko }
224f2818f22SArtyom Tarasenko 
22574d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s)
22674d71ea1SLaurent Vivier {
22774d71ea1SLaurent Vivier     if (get_cmd_cb(s) < 0) {
22874d71ea1SLaurent Vivier         return;
22974d71ea1SLaurent Vivier     }
23074d71ea1SLaurent Vivier     if (s->pdma_cur != s->pdma_start) {
23174d71ea1SLaurent Vivier         do_cmd(s, get_pdma_buf(s) + s->pdma_start);
23274d71ea1SLaurent Vivier     }
23374d71ea1SLaurent Vivier }
23474d71ea1SLaurent Vivier 
2359f149aa9Spbrook static void handle_satn(ESPState *s)
2369f149aa9Spbrook {
2379f149aa9Spbrook     uint8_t buf[32];
2389f149aa9Spbrook     int len;
2399f149aa9Spbrook 
2401b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
24173d74342SBlue Swirl         s->dma_cb = handle_satn;
24273d74342SBlue Swirl         return;
24373d74342SBlue Swirl     }
24474d71ea1SLaurent Vivier     s->pdma_cb = satn_pdma_cb;
2456c1fef6bSPrasad J Pandit     len = get_cmd(s, buf, sizeof(buf));
24694d5c79dSMark Cave-Ayland     if (len) {
2479f149aa9Spbrook         do_cmd(s, buf);
2489f149aa9Spbrook     }
24994d5c79dSMark Cave-Ayland }
2509f149aa9Spbrook 
25174d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s)
25274d71ea1SLaurent Vivier {
25374d71ea1SLaurent Vivier     if (get_cmd_cb(s) < 0) {
25474d71ea1SLaurent Vivier         return;
25574d71ea1SLaurent Vivier     }
25674d71ea1SLaurent Vivier     if (s->pdma_cur != s->pdma_start) {
25774d71ea1SLaurent Vivier         do_busid_cmd(s, get_pdma_buf(s) + s->pdma_start, 0);
25874d71ea1SLaurent Vivier     }
25974d71ea1SLaurent Vivier }
26074d71ea1SLaurent Vivier 
261f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s)
262f2818f22SArtyom Tarasenko {
263f2818f22SArtyom Tarasenko     uint8_t buf[32];
264f2818f22SArtyom Tarasenko     int len;
265f2818f22SArtyom Tarasenko 
2661b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
26773d74342SBlue Swirl         s->dma_cb = handle_s_without_atn;
26873d74342SBlue Swirl         return;
26973d74342SBlue Swirl     }
27074d71ea1SLaurent Vivier     s->pdma_cb = s_without_satn_pdma_cb;
2716c1fef6bSPrasad J Pandit     len = get_cmd(s, buf, sizeof(buf));
272f2818f22SArtyom Tarasenko     if (len) {
273f2818f22SArtyom Tarasenko         do_busid_cmd(s, buf, 0);
274f2818f22SArtyom Tarasenko     }
275f2818f22SArtyom Tarasenko }
276f2818f22SArtyom Tarasenko 
27774d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s)
27874d71ea1SLaurent Vivier {
27974d71ea1SLaurent Vivier     if (get_cmd_cb(s) < 0) {
28074d71ea1SLaurent Vivier         return;
28174d71ea1SLaurent Vivier     }
28274d71ea1SLaurent Vivier     s->cmdlen = s->pdma_cur - s->pdma_start;
28374d71ea1SLaurent Vivier     if (s->cmdlen) {
28474d71ea1SLaurent Vivier         trace_esp_handle_satn_stop(s->cmdlen);
28574d71ea1SLaurent Vivier         s->do_cmd = 1;
28674d71ea1SLaurent Vivier         s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD;
28774d71ea1SLaurent Vivier         s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
28874d71ea1SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_CD;
28974d71ea1SLaurent Vivier         esp_raise_irq(s);
29074d71ea1SLaurent Vivier     }
29174d71ea1SLaurent Vivier }
29274d71ea1SLaurent Vivier 
2939f149aa9Spbrook static void handle_satn_stop(ESPState *s)
2949f149aa9Spbrook {
2951b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
29673d74342SBlue Swirl         s->dma_cb = handle_satn_stop;
29773d74342SBlue Swirl         return;
29873d74342SBlue Swirl     }
299c62c1fa0SPhilippe Mathieu-Daudé     s->pdma_cb = satn_stop_pdma_cb;
3006c1fef6bSPrasad J Pandit     s->cmdlen = get_cmd(s, s->cmdbuf, sizeof(s->cmdbuf));
3019f149aa9Spbrook     if (s->cmdlen) {
302bf4b9889SBlue Swirl         trace_esp_handle_satn_stop(s->cmdlen);
3039f149aa9Spbrook         s->do_cmd = 1;
304c73f96fdSblueswir1         s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD;
3055ad6bb97Sblueswir1         s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
3065ad6bb97Sblueswir1         s->rregs[ESP_RSEQ] = SEQ_CD;
307c73f96fdSblueswir1         esp_raise_irq(s);
3089f149aa9Spbrook     }
3099f149aa9Spbrook }
3109f149aa9Spbrook 
31174d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s)
31274d71ea1SLaurent Vivier {
31374d71ea1SLaurent Vivier     s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST;
31474d71ea1SLaurent Vivier     s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
31574d71ea1SLaurent Vivier     s->rregs[ESP_RSEQ] = SEQ_CD;
31674d71ea1SLaurent Vivier     esp_raise_irq(s);
31774d71ea1SLaurent Vivier }
31874d71ea1SLaurent Vivier 
3190fc5c15aSpbrook static void write_response(ESPState *s)
3202f275b8fSbellard {
321bf4b9889SBlue Swirl     trace_esp_write_response(s->status);
3223944966dSPaolo Bonzini     s->ti_buf[0] = s->status;
3230fc5c15aSpbrook     s->ti_buf[1] = 0;
3244f6200f0Sbellard     if (s->dma) {
32574d71ea1SLaurent Vivier         if (s->dma_memory_write) {
3268b17de88Sblueswir1             s->dma_memory_write(s->dma_opaque, s->ti_buf, 2);
327c73f96fdSblueswir1             s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST;
3285ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
3295ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = SEQ_CD;
3304f6200f0Sbellard         } else {
33174d71ea1SLaurent Vivier             set_pdma(s, TI, 0, 2);
33274d71ea1SLaurent Vivier             s->pdma_cb = write_response_pdma_cb;
33374d71ea1SLaurent Vivier             esp_raise_drq(s);
33474d71ea1SLaurent Vivier             return;
33574d71ea1SLaurent Vivier         }
33674d71ea1SLaurent Vivier     } else {
3370fc5c15aSpbrook         s->ti_size = 2;
3384f6200f0Sbellard         s->ti_rptr = 0;
339d020aa50SPaolo Bonzini         s->ti_wptr = 2;
3405ad6bb97Sblueswir1         s->rregs[ESP_RFLAGS] = 2;
3414f6200f0Sbellard     }
342c73f96fdSblueswir1     esp_raise_irq(s);
3432f275b8fSbellard }
3444f6200f0Sbellard 
345a917d384Spbrook static void esp_dma_done(ESPState *s)
3464d611c9aSpbrook {
347c73f96fdSblueswir1     s->rregs[ESP_RSTAT] |= STAT_TC;
3485ad6bb97Sblueswir1     s->rregs[ESP_RINTR] = INTR_BS;
3495ad6bb97Sblueswir1     s->rregs[ESP_RSEQ] = 0;
3505ad6bb97Sblueswir1     s->rregs[ESP_RFLAGS] = 0;
3515ad6bb97Sblueswir1     s->rregs[ESP_TCLO] = 0;
3525ad6bb97Sblueswir1     s->rregs[ESP_TCMID] = 0;
3539ea73f8bSPaolo Bonzini     s->rregs[ESP_TCHI] = 0;
354c73f96fdSblueswir1     esp_raise_irq(s);
3554d611c9aSpbrook }
356a917d384Spbrook 
35774d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s)
35874d71ea1SLaurent Vivier {
35974d71ea1SLaurent Vivier     int to_device = (s->ti_size < 0);
36074d71ea1SLaurent Vivier     int len = s->pdma_cur - s->pdma_start;
36174d71ea1SLaurent Vivier     if (s->do_cmd) {
36274d71ea1SLaurent Vivier         s->ti_size = 0;
36374d71ea1SLaurent Vivier         s->cmdlen = 0;
36474d71ea1SLaurent Vivier         s->do_cmd = 0;
36574d71ea1SLaurent Vivier         do_cmd(s, s->cmdbuf);
36674d71ea1SLaurent Vivier         return;
36774d71ea1SLaurent Vivier     }
36874d71ea1SLaurent Vivier     s->dma_left -= len;
36974d71ea1SLaurent Vivier     s->async_buf += len;
37074d71ea1SLaurent Vivier     s->async_len -= len;
37174d71ea1SLaurent Vivier     if (to_device) {
37274d71ea1SLaurent Vivier         s->ti_size += len;
37374d71ea1SLaurent Vivier     } else {
37474d71ea1SLaurent Vivier         s->ti_size -= len;
37574d71ea1SLaurent Vivier     }
37674d71ea1SLaurent Vivier     if (s->async_len == 0) {
37774d71ea1SLaurent Vivier         scsi_req_continue(s->current_req);
37874d71ea1SLaurent Vivier         /*
37974d71ea1SLaurent Vivier          * If there is still data to be read from the device then
38074d71ea1SLaurent Vivier          * complete the DMA operation immediately.  Otherwise defer
38174d71ea1SLaurent Vivier          * until the scsi layer has completed.
38274d71ea1SLaurent Vivier          */
38374d71ea1SLaurent Vivier         if (to_device || s->dma_left != 0 || s->ti_size == 0) {
38474d71ea1SLaurent Vivier             return;
38574d71ea1SLaurent Vivier         }
38674d71ea1SLaurent Vivier     }
38774d71ea1SLaurent Vivier 
38874d71ea1SLaurent Vivier     /* Partially filled a scsi buffer. Complete immediately.  */
38974d71ea1SLaurent Vivier     esp_dma_done(s);
39074d71ea1SLaurent Vivier }
39174d71ea1SLaurent Vivier 
392a917d384Spbrook static void esp_do_dma(ESPState *s)
393a917d384Spbrook {
39467e999beSbellard     uint32_t len;
395a917d384Spbrook     int to_device;
396a917d384Spbrook 
397a917d384Spbrook     len = s->dma_left;
398a917d384Spbrook     if (s->do_cmd) {
39915407433SLaurent Vivier         /*
40015407433SLaurent Vivier          * handle_ti_cmd() case: esp_do_dma() is called only from
40115407433SLaurent Vivier          * handle_ti_cmd() with do_cmd != NULL (see the assert())
40215407433SLaurent Vivier          */
403bf4b9889SBlue Swirl         trace_esp_do_dma(s->cmdlen, len);
404926cde5fSPrasad J Pandit         assert(s->cmdlen <= sizeof(s->cmdbuf) &&
405926cde5fSPrasad J Pandit                len <= sizeof(s->cmdbuf) - s->cmdlen);
40674d71ea1SLaurent Vivier         if (s->dma_memory_read) {
4078b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, &s->cmdbuf[s->cmdlen], len);
40874d71ea1SLaurent Vivier         } else {
40974d71ea1SLaurent Vivier             set_pdma(s, CMD, s->cmdlen, len);
41074d71ea1SLaurent Vivier             s->pdma_cb = do_dma_pdma_cb;
41174d71ea1SLaurent Vivier             esp_raise_drq(s);
41274d71ea1SLaurent Vivier             return;
41374d71ea1SLaurent Vivier         }
41415407433SLaurent Vivier         trace_esp_handle_ti_cmd(s->cmdlen);
41515407433SLaurent Vivier         s->ti_size = 0;
41615407433SLaurent Vivier         s->cmdlen = 0;
41715407433SLaurent Vivier         s->do_cmd = 0;
41815407433SLaurent Vivier         do_cmd(s, s->cmdbuf);
419a917d384Spbrook         return;
420a917d384Spbrook     }
421a917d384Spbrook     if (s->async_len == 0) {
422a917d384Spbrook         /* Defer until data is available.  */
423a917d384Spbrook         return;
424a917d384Spbrook     }
425a917d384Spbrook     if (len > s->async_len) {
426a917d384Spbrook         len = s->async_len;
427a917d384Spbrook     }
4287f0b6e11SPaolo Bonzini     to_device = (s->ti_size < 0);
429a917d384Spbrook     if (to_device) {
43074d71ea1SLaurent Vivier         if (s->dma_memory_read) {
4318b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, s->async_buf, len);
432a917d384Spbrook         } else {
43374d71ea1SLaurent Vivier             set_pdma(s, ASYNC, 0, len);
43474d71ea1SLaurent Vivier             s->pdma_cb = do_dma_pdma_cb;
43574d71ea1SLaurent Vivier             esp_raise_drq(s);
43674d71ea1SLaurent Vivier             return;
43774d71ea1SLaurent Vivier         }
43874d71ea1SLaurent Vivier     } else {
43974d71ea1SLaurent Vivier         if (s->dma_memory_write) {
4408b17de88Sblueswir1             s->dma_memory_write(s->dma_opaque, s->async_buf, len);
44174d71ea1SLaurent Vivier         } else {
44274d71ea1SLaurent Vivier             set_pdma(s, ASYNC, 0, len);
44374d71ea1SLaurent Vivier             s->pdma_cb = do_dma_pdma_cb;
44474d71ea1SLaurent Vivier             esp_raise_drq(s);
44574d71ea1SLaurent Vivier             return;
44674d71ea1SLaurent Vivier         }
447a917d384Spbrook     }
448a917d384Spbrook     s->dma_left -= len;
449a917d384Spbrook     s->async_buf += len;
450a917d384Spbrook     s->async_len -= len;
45194d5c79dSMark Cave-Ayland     if (to_device) {
4526787f5faSpbrook         s->ti_size += len;
45394d5c79dSMark Cave-Ayland     } else {
4546787f5faSpbrook         s->ti_size -= len;
45594d5c79dSMark Cave-Ayland     }
456a917d384Spbrook     if (s->async_len == 0) {
457ad3376ccSPaolo Bonzini         scsi_req_continue(s->current_req);
45894d5c79dSMark Cave-Ayland         /*
45994d5c79dSMark Cave-Ayland          * If there is still data to be read from the device then
46094d5c79dSMark Cave-Ayland          * complete the DMA operation immediately.  Otherwise defer
46194d5c79dSMark Cave-Ayland          * until the scsi layer has completed.
46294d5c79dSMark Cave-Ayland          */
463ad3376ccSPaolo Bonzini         if (to_device || s->dma_left != 0 || s->ti_size == 0) {
464ad3376ccSPaolo Bonzini             return;
465a917d384Spbrook         }
466a917d384Spbrook     }
467ad3376ccSPaolo Bonzini 
4686787f5faSpbrook     /* Partially filled a scsi buffer. Complete immediately.  */
469a917d384Spbrook     esp_dma_done(s);
470a917d384Spbrook }
471a917d384Spbrook 
472ea84a442SGuenter Roeck static void esp_report_command_complete(ESPState *s, uint32_t status)
473a917d384Spbrook {
474bf4b9889SBlue Swirl     trace_esp_command_complete();
475c6df7102SPaolo Bonzini     if (s->ti_size != 0) {
476bf4b9889SBlue Swirl         trace_esp_command_complete_unexpected();
477c6df7102SPaolo Bonzini     }
478a917d384Spbrook     s->ti_size = 0;
479a917d384Spbrook     s->dma_left = 0;
480a917d384Spbrook     s->async_len = 0;
481aba1f023SPaolo Bonzini     if (status) {
482bf4b9889SBlue Swirl         trace_esp_command_complete_fail();
483c6df7102SPaolo Bonzini     }
484aba1f023SPaolo Bonzini     s->status = status;
4855ad6bb97Sblueswir1     s->rregs[ESP_RSTAT] = STAT_ST;
486a917d384Spbrook     esp_dma_done(s);
4875c6c0e51SHannes Reinecke     if (s->current_req) {
4885c6c0e51SHannes Reinecke         scsi_req_unref(s->current_req);
4895c6c0e51SHannes Reinecke         s->current_req = NULL;
490a917d384Spbrook         s->current_dev = NULL;
4915c6c0e51SHannes Reinecke     }
492c6df7102SPaolo Bonzini }
493c6df7102SPaolo Bonzini 
49417ea26c2SHannes Reinecke void esp_command_complete(SCSIRequest *req, size_t resid)
495ea84a442SGuenter Roeck {
496ea84a442SGuenter Roeck     ESPState *s = req->hba_private;
497ea84a442SGuenter Roeck 
498ea84a442SGuenter Roeck     if (s->rregs[ESP_RSTAT] & STAT_INT) {
49994d5c79dSMark Cave-Ayland         /*
50094d5c79dSMark Cave-Ayland          * Defer handling command complete until the previous
501ea84a442SGuenter Roeck          * interrupt has been handled.
502ea84a442SGuenter Roeck          */
503ea84a442SGuenter Roeck         trace_esp_command_complete_deferred();
50417ea26c2SHannes Reinecke         s->deferred_status = req->status;
505ea84a442SGuenter Roeck         s->deferred_complete = true;
506ea84a442SGuenter Roeck         return;
507ea84a442SGuenter Roeck     }
50817ea26c2SHannes Reinecke     esp_report_command_complete(s, req->status);
509ea84a442SGuenter Roeck }
510ea84a442SGuenter Roeck 
5119c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len)
512c6df7102SPaolo Bonzini {
513e6810db8SHervé Poussineau     ESPState *s = req->hba_private;
514c6df7102SPaolo Bonzini 
5157f0b6e11SPaolo Bonzini     assert(!s->do_cmd);
516bf4b9889SBlue Swirl     trace_esp_transfer_data(s->dma_left, s->ti_size);
517aba1f023SPaolo Bonzini     s->async_len = len;
5180c34459bSPaolo Bonzini     s->async_buf = scsi_req_get_buf(req);
5196787f5faSpbrook     if (s->dma_left) {
520a917d384Spbrook         esp_do_dma(s);
5216787f5faSpbrook     } else if (s->dma_counter != 0 && s->ti_size <= 0) {
52294d5c79dSMark Cave-Ayland         /*
52394d5c79dSMark Cave-Ayland          * If this was the last part of a DMA transfer then the
52494d5c79dSMark Cave-Ayland          * completion interrupt is deferred to here.
52594d5c79dSMark Cave-Ayland          */
5266787f5faSpbrook         esp_dma_done(s);
5276787f5faSpbrook     }
528a917d384Spbrook }
5292e5d83bbSpbrook 
5302f275b8fSbellard static void handle_ti(ESPState *s)
5312f275b8fSbellard {
5324d611c9aSpbrook     uint32_t dmalen, minlen;
5332f275b8fSbellard 
5347246e160SHervé Poussineau     if (s->dma && !s->dma_enabled) {
5357246e160SHervé Poussineau         s->dma_cb = handle_ti;
5367246e160SHervé Poussineau         return;
5377246e160SHervé Poussineau     }
5387246e160SHervé Poussineau 
5399ea73f8bSPaolo Bonzini     dmalen = s->rregs[ESP_TCLO];
5409ea73f8bSPaolo Bonzini     dmalen |= s->rregs[ESP_TCMID] << 8;
5419ea73f8bSPaolo Bonzini     dmalen |= s->rregs[ESP_TCHI] << 16;
542db59203dSpbrook     if (dmalen == 0) {
543db59203dSpbrook         dmalen = 0x10000;
544db59203dSpbrook     }
5456787f5faSpbrook     s->dma_counter = dmalen;
546db59203dSpbrook 
54794d5c79dSMark Cave-Ayland     if (s->do_cmd) {
548926cde5fSPrasad J Pandit         minlen = (dmalen < ESP_CMDBUF_SZ) ? dmalen : ESP_CMDBUF_SZ;
54994d5c79dSMark Cave-Ayland     } else if (s->ti_size < 0) {
55067e999beSbellard         minlen = (dmalen < -s->ti_size) ? dmalen : -s->ti_size;
55194d5c79dSMark Cave-Ayland     } else {
552db59203dSpbrook         minlen = (dmalen < s->ti_size) ? dmalen : s->ti_size;
55394d5c79dSMark Cave-Ayland     }
554bf4b9889SBlue Swirl     trace_esp_handle_ti(minlen);
5554f6200f0Sbellard     if (s->dma) {
5564d611c9aSpbrook         s->dma_left = minlen;
5575ad6bb97Sblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_TC;
5584d611c9aSpbrook         esp_do_dma(s);
55915407433SLaurent Vivier     } else if (s->do_cmd) {
560bf4b9889SBlue Swirl         trace_esp_handle_ti_cmd(s->cmdlen);
5619f149aa9Spbrook         s->ti_size = 0;
5629f149aa9Spbrook         s->cmdlen = 0;
5639f149aa9Spbrook         s->do_cmd = 0;
5649f149aa9Spbrook         do_cmd(s, s->cmdbuf);
5654f6200f0Sbellard     }
5662f275b8fSbellard }
5672f275b8fSbellard 
5689c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s)
5696f7e9aecSbellard {
5705aca8c3bSblueswir1     memset(s->rregs, 0, ESP_REGS);
5715aca8c3bSblueswir1     memset(s->wregs, 0, ESP_REGS);
572c9cf45c1SHannes Reinecke     s->tchi_written = 0;
5734e9aec74Spbrook     s->ti_size = 0;
5744e9aec74Spbrook     s->ti_rptr = 0;
5754e9aec74Spbrook     s->ti_wptr = 0;
5764e9aec74Spbrook     s->dma = 0;
5779f149aa9Spbrook     s->do_cmd = 0;
57873d74342SBlue Swirl     s->dma_cb = NULL;
5798dea1dd4Sblueswir1 
5808dea1dd4Sblueswir1     s->rregs[ESP_CFG1] = 7;
5816f7e9aecSbellard }
5826f7e9aecSbellard 
583a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s)
58485948643SBlue Swirl {
58585948643SBlue Swirl     qemu_irq_lower(s->irq);
58674d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
587a391fdbcSHervé Poussineau     esp_hard_reset(s);
58885948643SBlue Swirl }
58985948643SBlue Swirl 
590a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level)
5912d069babSblueswir1 {
59285948643SBlue Swirl     if (level) {
593a391fdbcSHervé Poussineau         esp_soft_reset(s);
59485948643SBlue Swirl     }
5952d069babSblueswir1 }
5962d069babSblueswir1 
5979c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr)
59873d74342SBlue Swirl {
599b630c075SMark Cave-Ayland     uint32_t val;
60073d74342SBlue Swirl 
6016f7e9aecSbellard     switch (saddr) {
6025ad6bb97Sblueswir1     case ESP_FIFO:
6035ad6bb97Sblueswir1         if ((s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) {
6048dea1dd4Sblueswir1             /* Data out.  */
605ff589551SPrasad J Pandit             qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n");
6065ad6bb97Sblueswir1             s->rregs[ESP_FIFO] = 0;
607ff589551SPrasad J Pandit         } else if (s->ti_rptr < s->ti_wptr) {
608ff589551SPrasad J Pandit             s->ti_size--;
6095ad6bb97Sblueswir1             s->rregs[ESP_FIFO] = s->ti_buf[s->ti_rptr++];
6104f6200f0Sbellard         }
611ff589551SPrasad J Pandit         if (s->ti_rptr == s->ti_wptr) {
6124f6200f0Sbellard             s->ti_rptr = 0;
6134f6200f0Sbellard             s->ti_wptr = 0;
6144f6200f0Sbellard         }
615b630c075SMark Cave-Ayland         val = s->rregs[ESP_FIFO];
6164f6200f0Sbellard         break;
6175ad6bb97Sblueswir1     case ESP_RINTR:
61894d5c79dSMark Cave-Ayland         /*
61994d5c79dSMark Cave-Ayland          * Clear sequence step, interrupt register and all status bits
62094d5c79dSMark Cave-Ayland          * except TC
62194d5c79dSMark Cave-Ayland          */
622b630c075SMark Cave-Ayland         val = s->rregs[ESP_RINTR];
6232814df28SBlue Swirl         s->rregs[ESP_RINTR] = 0;
6242814df28SBlue Swirl         s->rregs[ESP_RSTAT] &= ~STAT_TC;
6252814df28SBlue Swirl         s->rregs[ESP_RSEQ] = SEQ_CD;
626c73f96fdSblueswir1         esp_lower_irq(s);
627ea84a442SGuenter Roeck         if (s->deferred_complete) {
628ea84a442SGuenter Roeck             esp_report_command_complete(s, s->deferred_status);
629ea84a442SGuenter Roeck             s->deferred_complete = false;
630ea84a442SGuenter Roeck         }
631b630c075SMark Cave-Ayland         break;
632c9cf45c1SHannes Reinecke     case ESP_TCHI:
633c9cf45c1SHannes Reinecke         /* Return the unique id if the value has never been written */
634c9cf45c1SHannes Reinecke         if (!s->tchi_written) {
635b630c075SMark Cave-Ayland             val = s->chip_id;
636b630c075SMark Cave-Ayland         } else {
637b630c075SMark Cave-Ayland             val = s->rregs[saddr];
638c9cf45c1SHannes Reinecke         }
639b630c075SMark Cave-Ayland         break;
6406f7e9aecSbellard     default:
641b630c075SMark Cave-Ayland         val = s->rregs[saddr];
6426f7e9aecSbellard         break;
6436f7e9aecSbellard     }
644b630c075SMark Cave-Ayland 
645b630c075SMark Cave-Ayland     trace_esp_mem_readb(saddr, val);
646b630c075SMark Cave-Ayland     return val;
6476f7e9aecSbellard }
6486f7e9aecSbellard 
6499c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val)
6506f7e9aecSbellard {
651bf4b9889SBlue Swirl     trace_esp_mem_writeb(saddr, s->wregs[saddr], val);
6526f7e9aecSbellard     switch (saddr) {
653c9cf45c1SHannes Reinecke     case ESP_TCHI:
654c9cf45c1SHannes Reinecke         s->tchi_written = true;
655c9cf45c1SHannes Reinecke         /* fall through */
6565ad6bb97Sblueswir1     case ESP_TCLO:
6575ad6bb97Sblueswir1     case ESP_TCMID:
6585ad6bb97Sblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_TC;
6594f6200f0Sbellard         break;
6605ad6bb97Sblueswir1     case ESP_FIFO:
6619f149aa9Spbrook         if (s->do_cmd) {
662926cde5fSPrasad J Pandit             if (s->cmdlen < ESP_CMDBUF_SZ) {
6639f149aa9Spbrook                 s->cmdbuf[s->cmdlen++] = val & 0xff;
664c98c6c10SPrasad J Pandit             } else {
665c98c6c10SPrasad J Pandit                 trace_esp_error_fifo_overrun();
666c98c6c10SPrasad J Pandit             }
667ff589551SPrasad J Pandit         } else if (s->ti_wptr == TI_BUFSZ - 1) {
6683af4e9aaSHervé Poussineau             trace_esp_error_fifo_overrun();
6692e5d83bbSpbrook         } else {
6704f6200f0Sbellard             s->ti_size++;
6714f6200f0Sbellard             s->ti_buf[s->ti_wptr++] = val & 0xff;
6722e5d83bbSpbrook         }
6734f6200f0Sbellard         break;
6745ad6bb97Sblueswir1     case ESP_CMD:
6754f6200f0Sbellard         s->rregs[saddr] = val;
6765ad6bb97Sblueswir1         if (val & CMD_DMA) {
6774f6200f0Sbellard             s->dma = 1;
6786787f5faSpbrook             /* Reload DMA counter.  */
6795ad6bb97Sblueswir1             s->rregs[ESP_TCLO] = s->wregs[ESP_TCLO];
6805ad6bb97Sblueswir1             s->rregs[ESP_TCMID] = s->wregs[ESP_TCMID];
6819ea73f8bSPaolo Bonzini             s->rregs[ESP_TCHI] = s->wregs[ESP_TCHI];
6824f6200f0Sbellard         } else {
6834f6200f0Sbellard             s->dma = 0;
6844f6200f0Sbellard         }
6855ad6bb97Sblueswir1         switch (val & CMD_CMD) {
6865ad6bb97Sblueswir1         case CMD_NOP:
687bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_nop(val);
6882f275b8fSbellard             break;
6895ad6bb97Sblueswir1         case CMD_FLUSH:
690bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_flush(val);
69194d5c79dSMark Cave-Ayland             /*s->ti_size = 0;*/
6925ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_FC;
6935ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = 0;
694a214c598Sblueswir1             s->rregs[ESP_RFLAGS] = 0;
6956f7e9aecSbellard             break;
6965ad6bb97Sblueswir1         case CMD_RESET:
697bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_reset(val);
698a391fdbcSHervé Poussineau             esp_soft_reset(s);
6996f7e9aecSbellard             break;
7005ad6bb97Sblueswir1         case CMD_BUSRESET:
701bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_bus_reset(val);
7025ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_RST;
7035ad6bb97Sblueswir1             if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) {
704c73f96fdSblueswir1                 esp_raise_irq(s);
7059e61bde5Sbellard             }
7062f275b8fSbellard             break;
7075ad6bb97Sblueswir1         case CMD_TI:
7080097d3ecSMark Cave-Ayland             trace_esp_mem_writeb_cmd_ti(val);
7092f275b8fSbellard             handle_ti(s);
7102f275b8fSbellard             break;
7115ad6bb97Sblueswir1         case CMD_ICCS:
712bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_iccs(val);
7130fc5c15aSpbrook             write_response(s);
7144bf5801dSblueswir1             s->rregs[ESP_RINTR] = INTR_FC;
7154bf5801dSblueswir1             s->rregs[ESP_RSTAT] |= STAT_MI;
7162f275b8fSbellard             break;
7175ad6bb97Sblueswir1         case CMD_MSGACC:
718bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_msgacc(val);
7195ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_DC;
7205ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = 0;
7214e2a68c1SArtyom Tarasenko             s->rregs[ESP_RFLAGS] = 0;
7224e2a68c1SArtyom Tarasenko             esp_raise_irq(s);
7236f7e9aecSbellard             break;
7240fd0eb21SBlue Swirl         case CMD_PAD:
725bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_pad(val);
7260fd0eb21SBlue Swirl             s->rregs[ESP_RSTAT] = STAT_TC;
7270fd0eb21SBlue Swirl             s->rregs[ESP_RINTR] = INTR_FC;
7280fd0eb21SBlue Swirl             s->rregs[ESP_RSEQ] = 0;
7290fd0eb21SBlue Swirl             break;
7305ad6bb97Sblueswir1         case CMD_SATN:
731bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_satn(val);
7326f7e9aecSbellard             break;
7336915bff1SHervé Poussineau         case CMD_RSTATN:
7346915bff1SHervé Poussineau             trace_esp_mem_writeb_cmd_rstatn(val);
7356915bff1SHervé Poussineau             break;
7365e1e0a3bSBlue Swirl         case CMD_SEL:
737bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_sel(val);
738f2818f22SArtyom Tarasenko             handle_s_without_atn(s);
7395e1e0a3bSBlue Swirl             break;
7405ad6bb97Sblueswir1         case CMD_SELATN:
741bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_selatn(val);
7422f275b8fSbellard             handle_satn(s);
7432f275b8fSbellard             break;
7445ad6bb97Sblueswir1         case CMD_SELATNS:
745bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_selatns(val);
7469f149aa9Spbrook             handle_satn_stop(s);
7472f275b8fSbellard             break;
7485ad6bb97Sblueswir1         case CMD_ENSEL:
749bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_ensel(val);
750e3926838Sblueswir1             s->rregs[ESP_RINTR] = 0;
75174ec6048Sblueswir1             break;
7526fe84c18SHervé Poussineau         case CMD_DISSEL:
7536fe84c18SHervé Poussineau             trace_esp_mem_writeb_cmd_dissel(val);
7546fe84c18SHervé Poussineau             s->rregs[ESP_RINTR] = 0;
7556fe84c18SHervé Poussineau             esp_raise_irq(s);
7566fe84c18SHervé Poussineau             break;
7572f275b8fSbellard         default:
7583af4e9aaSHervé Poussineau             trace_esp_error_unhandled_command(val);
7596f7e9aecSbellard             break;
7606f7e9aecSbellard         }
7616f7e9aecSbellard         break;
7625ad6bb97Sblueswir1     case ESP_WBUSID ... ESP_WSYNO:
7634f6200f0Sbellard         break;
7645ad6bb97Sblueswir1     case ESP_CFG1:
7659ea73f8bSPaolo Bonzini     case ESP_CFG2: case ESP_CFG3:
7669ea73f8bSPaolo Bonzini     case ESP_RES3: case ESP_RES4:
7674f6200f0Sbellard         s->rregs[saddr] = val;
7684f6200f0Sbellard         break;
7695ad6bb97Sblueswir1     case ESP_WCCF ... ESP_WTEST:
7704f6200f0Sbellard         break;
7716f7e9aecSbellard     default:
7723af4e9aaSHervé Poussineau         trace_esp_error_invalid_write(val, saddr);
7738dea1dd4Sblueswir1         return;
7746f7e9aecSbellard     }
7752f275b8fSbellard     s->wregs[saddr] = val;
7766f7e9aecSbellard }
7776f7e9aecSbellard 
778a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr,
7798372d383SPeter Maydell                             unsigned size, bool is_write,
7808372d383SPeter Maydell                             MemTxAttrs attrs)
78167bb5314SAvi Kivity {
78267bb5314SAvi Kivity     return (size == 1) || (is_write && size == 4);
78367bb5314SAvi Kivity }
7846f7e9aecSbellard 
78574d71ea1SLaurent Vivier static bool esp_pdma_needed(void *opaque)
78674d71ea1SLaurent Vivier {
78774d71ea1SLaurent Vivier     ESPState *s = opaque;
78874d71ea1SLaurent Vivier     return s->dma_memory_read == NULL && s->dma_memory_write == NULL &&
78974d71ea1SLaurent Vivier            s->dma_enabled;
79074d71ea1SLaurent Vivier }
79174d71ea1SLaurent Vivier 
79274d71ea1SLaurent Vivier static const VMStateDescription vmstate_esp_pdma = {
79374d71ea1SLaurent Vivier     .name = "esp/pdma",
79474d71ea1SLaurent Vivier     .version_id = 1,
79574d71ea1SLaurent Vivier     .minimum_version_id = 1,
79674d71ea1SLaurent Vivier     .needed = esp_pdma_needed,
79774d71ea1SLaurent Vivier     .fields = (VMStateField[]) {
79874d71ea1SLaurent Vivier         VMSTATE_BUFFER(pdma_buf, ESPState),
79974d71ea1SLaurent Vivier         VMSTATE_INT32(pdma_origin, ESPState),
80074d71ea1SLaurent Vivier         VMSTATE_UINT32(pdma_len, ESPState),
80174d71ea1SLaurent Vivier         VMSTATE_UINT32(pdma_start, ESPState),
80274d71ea1SLaurent Vivier         VMSTATE_UINT32(pdma_cur, ESPState),
80374d71ea1SLaurent Vivier         VMSTATE_END_OF_LIST()
80474d71ea1SLaurent Vivier     }
80574d71ea1SLaurent Vivier };
80674d71ea1SLaurent Vivier 
8070bd005beSMark Cave-Ayland static int esp_pre_save(void *opaque)
8080bd005beSMark Cave-Ayland {
8090bd005beSMark Cave-Ayland     ESPState *s = ESP(opaque);
8100bd005beSMark Cave-Ayland 
8110bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
8120bd005beSMark Cave-Ayland     return 0;
8130bd005beSMark Cave-Ayland }
8140bd005beSMark Cave-Ayland 
8150bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id)
8160bd005beSMark Cave-Ayland {
8170bd005beSMark Cave-Ayland     ESPState *s = ESP(opaque);
8180bd005beSMark Cave-Ayland 
8190bd005beSMark Cave-Ayland     s->mig_version_id = vmstate_esp.version_id;
8200bd005beSMark Cave-Ayland     return 0;
8210bd005beSMark Cave-Ayland }
8220bd005beSMark Cave-Ayland 
8239c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = {
824cc9952f3SBlue Swirl     .name = "esp",
8250bd005beSMark Cave-Ayland     .version_id = 5,
826cc9952f3SBlue Swirl     .minimum_version_id = 3,
8270bd005beSMark Cave-Ayland     .pre_save = esp_pre_save,
8280bd005beSMark Cave-Ayland     .post_load = esp_post_load,
829cc9952f3SBlue Swirl     .fields = (VMStateField[]) {
830cc9952f3SBlue Swirl         VMSTATE_BUFFER(rregs, ESPState),
831cc9952f3SBlue Swirl         VMSTATE_BUFFER(wregs, ESPState),
832cc9952f3SBlue Swirl         VMSTATE_INT32(ti_size, ESPState),
833cc9952f3SBlue Swirl         VMSTATE_UINT32(ti_rptr, ESPState),
834cc9952f3SBlue Swirl         VMSTATE_UINT32(ti_wptr, ESPState),
835cc9952f3SBlue Swirl         VMSTATE_BUFFER(ti_buf, ESPState),
8363944966dSPaolo Bonzini         VMSTATE_UINT32(status, ESPState),
837ea84a442SGuenter Roeck         VMSTATE_UINT32(deferred_status, ESPState),
838ea84a442SGuenter Roeck         VMSTATE_BOOL(deferred_complete, ESPState),
839cc9952f3SBlue Swirl         VMSTATE_UINT32(dma, ESPState),
840cc966774SPaolo Bonzini         VMSTATE_PARTIAL_BUFFER(cmdbuf, ESPState, 16),
841cc966774SPaolo Bonzini         VMSTATE_BUFFER_START_MIDDLE_V(cmdbuf, ESPState, 16, 4),
842cc9952f3SBlue Swirl         VMSTATE_UINT32(cmdlen, ESPState),
843cc9952f3SBlue Swirl         VMSTATE_UINT32(do_cmd, ESPState),
844cc9952f3SBlue Swirl         VMSTATE_UINT32(dma_left, ESPState),
845cc9952f3SBlue Swirl         VMSTATE_END_OF_LIST()
84674d71ea1SLaurent Vivier     },
84774d71ea1SLaurent Vivier     .subsections = (const VMStateDescription * []) {
84874d71ea1SLaurent Vivier         &vmstate_esp_pdma,
84974d71ea1SLaurent Vivier         NULL
8506f7e9aecSbellard     }
851cc9952f3SBlue Swirl };
8526f7e9aecSbellard 
853a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr,
854a391fdbcSHervé Poussineau                                  uint64_t val, unsigned int size)
855a391fdbcSHervé Poussineau {
856a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
857eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
858a391fdbcSHervé Poussineau     uint32_t saddr;
859a391fdbcSHervé Poussineau 
860a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
861eb169c76SMark Cave-Ayland     esp_reg_write(s, saddr, val);
862a391fdbcSHervé Poussineau }
863a391fdbcSHervé Poussineau 
864a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr,
865a391fdbcSHervé Poussineau                                     unsigned int size)
866a391fdbcSHervé Poussineau {
867a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
868eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
869a391fdbcSHervé Poussineau     uint32_t saddr;
870a391fdbcSHervé Poussineau 
871a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
872eb169c76SMark Cave-Ayland     return esp_reg_read(s, saddr);
873a391fdbcSHervé Poussineau }
874a391fdbcSHervé Poussineau 
875a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = {
876a391fdbcSHervé Poussineau     .read = sysbus_esp_mem_read,
877a391fdbcSHervé Poussineau     .write = sysbus_esp_mem_write,
878a391fdbcSHervé Poussineau     .endianness = DEVICE_NATIVE_ENDIAN,
879a391fdbcSHervé Poussineau     .valid.accepts = esp_mem_accepts,
880a391fdbcSHervé Poussineau };
881a391fdbcSHervé Poussineau 
88274d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
88374d71ea1SLaurent Vivier                                   uint64_t val, unsigned int size)
88474d71ea1SLaurent Vivier {
88574d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
886eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
88774d71ea1SLaurent Vivier     uint32_t dmalen;
88874d71ea1SLaurent Vivier     uint8_t *buf = get_pdma_buf(s);
88974d71ea1SLaurent Vivier 
890*960ebfd9SMark Cave-Ayland     trace_esp_pdma_write(size);
891*960ebfd9SMark Cave-Ayland 
89274d71ea1SLaurent Vivier     dmalen = s->rregs[ESP_TCLO];
89374d71ea1SLaurent Vivier     dmalen |= s->rregs[ESP_TCMID] << 8;
89474d71ea1SLaurent Vivier     dmalen |= s->rregs[ESP_TCHI] << 16;
89574d71ea1SLaurent Vivier     if (dmalen == 0 || s->pdma_len == 0) {
89674d71ea1SLaurent Vivier         return;
89774d71ea1SLaurent Vivier     }
89874d71ea1SLaurent Vivier     switch (size) {
89974d71ea1SLaurent Vivier     case 1:
90074d71ea1SLaurent Vivier         buf[s->pdma_cur++] = val;
90174d71ea1SLaurent Vivier         s->pdma_len--;
90274d71ea1SLaurent Vivier         dmalen--;
90374d71ea1SLaurent Vivier         break;
90474d71ea1SLaurent Vivier     case 2:
90574d71ea1SLaurent Vivier         buf[s->pdma_cur++] = val >> 8;
90674d71ea1SLaurent Vivier         buf[s->pdma_cur++] = val;
90774d71ea1SLaurent Vivier         s->pdma_len -= 2;
90874d71ea1SLaurent Vivier         dmalen -= 2;
90974d71ea1SLaurent Vivier         break;
91074d71ea1SLaurent Vivier     }
91174d71ea1SLaurent Vivier     s->rregs[ESP_TCLO] = dmalen & 0xff;
91274d71ea1SLaurent Vivier     s->rregs[ESP_TCMID] = dmalen >> 8;
91374d71ea1SLaurent Vivier     s->rregs[ESP_TCHI] = dmalen >> 16;
91474d71ea1SLaurent Vivier     if (s->pdma_len == 0 && s->pdma_cb) {
91574d71ea1SLaurent Vivier         esp_lower_drq(s);
91674d71ea1SLaurent Vivier         s->pdma_cb(s);
91774d71ea1SLaurent Vivier         s->pdma_cb = NULL;
91874d71ea1SLaurent Vivier     }
91974d71ea1SLaurent Vivier }
92074d71ea1SLaurent Vivier 
92174d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
92274d71ea1SLaurent Vivier                                      unsigned int size)
92374d71ea1SLaurent Vivier {
92474d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
925eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
92674d71ea1SLaurent Vivier     uint8_t *buf = get_pdma_buf(s);
92774d71ea1SLaurent Vivier     uint64_t val = 0;
92874d71ea1SLaurent Vivier 
929*960ebfd9SMark Cave-Ayland     trace_esp_pdma_read(size);
930*960ebfd9SMark Cave-Ayland 
93174d71ea1SLaurent Vivier     if (s->pdma_len == 0) {
93274d71ea1SLaurent Vivier         return 0;
93374d71ea1SLaurent Vivier     }
93474d71ea1SLaurent Vivier     switch (size) {
93574d71ea1SLaurent Vivier     case 1:
93674d71ea1SLaurent Vivier         val = buf[s->pdma_cur++];
93774d71ea1SLaurent Vivier         s->pdma_len--;
93874d71ea1SLaurent Vivier         break;
93974d71ea1SLaurent Vivier     case 2:
94074d71ea1SLaurent Vivier         val = buf[s->pdma_cur++];
94174d71ea1SLaurent Vivier         val = (val << 8) | buf[s->pdma_cur++];
94274d71ea1SLaurent Vivier         s->pdma_len -= 2;
94374d71ea1SLaurent Vivier         break;
94474d71ea1SLaurent Vivier     }
94574d71ea1SLaurent Vivier 
94674d71ea1SLaurent Vivier     if (s->pdma_len == 0 && s->pdma_cb) {
94774d71ea1SLaurent Vivier         esp_lower_drq(s);
94874d71ea1SLaurent Vivier         s->pdma_cb(s);
94974d71ea1SLaurent Vivier         s->pdma_cb = NULL;
95074d71ea1SLaurent Vivier     }
95174d71ea1SLaurent Vivier     return val;
95274d71ea1SLaurent Vivier }
95374d71ea1SLaurent Vivier 
95474d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = {
95574d71ea1SLaurent Vivier     .read = sysbus_esp_pdma_read,
95674d71ea1SLaurent Vivier     .write = sysbus_esp_pdma_write,
95774d71ea1SLaurent Vivier     .endianness = DEVICE_NATIVE_ENDIAN,
95874d71ea1SLaurent Vivier     .valid.min_access_size = 1,
95974d71ea1SLaurent Vivier     .valid.max_access_size = 2,
96074d71ea1SLaurent Vivier };
96174d71ea1SLaurent Vivier 
962afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = {
963afd4030cSPaolo Bonzini     .tcq = false,
9647e0380b9SPaolo Bonzini     .max_target = ESP_MAX_DEVS,
9657e0380b9SPaolo Bonzini     .max_lun = 7,
966afd4030cSPaolo Bonzini 
967c6df7102SPaolo Bonzini     .transfer_data = esp_transfer_data,
96894d3f98aSPaolo Bonzini     .complete = esp_command_complete,
96994d3f98aSPaolo Bonzini     .cancel = esp_request_cancelled
970cfdc1bb0SPaolo Bonzini };
971cfdc1bb0SPaolo Bonzini 
972a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level)
973cfb9de9cSPaul Brook {
97484fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(opaque);
975eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
976a391fdbcSHervé Poussineau 
977a391fdbcSHervé Poussineau     switch (irq) {
978a391fdbcSHervé Poussineau     case 0:
979a391fdbcSHervé Poussineau         parent_esp_reset(s, irq, level);
980a391fdbcSHervé Poussineau         break;
981a391fdbcSHervé Poussineau     case 1:
982a391fdbcSHervé Poussineau         esp_dma_enable(opaque, irq, level);
983a391fdbcSHervé Poussineau         break;
984a391fdbcSHervé Poussineau     }
985a391fdbcSHervé Poussineau }
986a391fdbcSHervé Poussineau 
987b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp)
988a391fdbcSHervé Poussineau {
989b09318caSHu Tao     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
99084fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
991eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
992eb169c76SMark Cave-Ayland 
993eb169c76SMark Cave-Ayland     if (!qdev_realize(DEVICE(s), NULL, errp)) {
994eb169c76SMark Cave-Ayland         return;
995eb169c76SMark Cave-Ayland     }
9966f7e9aecSbellard 
997b09318caSHu Tao     sysbus_init_irq(sbd, &s->irq);
99874d71ea1SLaurent Vivier     sysbus_init_irq(sbd, &s->irq_data);
999a391fdbcSHervé Poussineau     assert(sysbus->it_shift != -1);
10006f7e9aecSbellard 
1001d32e4b3dSHervé Poussineau     s->chip_id = TCHI_FAS100A;
100229776739SPaolo Bonzini     memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops,
100374d71ea1SLaurent Vivier                           sysbus, "esp-regs", ESP_REGS << sysbus->it_shift);
1004b09318caSHu Tao     sysbus_init_mmio(sbd, &sysbus->iomem);
100574d71ea1SLaurent Vivier     memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops,
100674d71ea1SLaurent Vivier                           sysbus, "esp-pdma", 2);
100774d71ea1SLaurent Vivier     sysbus_init_mmio(sbd, &sysbus->pdma);
10086f7e9aecSbellard 
1009b09318caSHu Tao     qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2);
10102d069babSblueswir1 
1011b1187b51SAndreas Färber     scsi_bus_new(&s->bus, sizeof(s->bus), dev, &esp_scsi_info, NULL);
101267e999beSbellard }
1013cfb9de9cSPaul Brook 
1014a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev)
1015a391fdbcSHervé Poussineau {
101684fbefedSMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(dev);
1017eb169c76SMark Cave-Ayland     ESPState *s = ESP(&sysbus->esp);
1018eb169c76SMark Cave-Ayland 
1019eb169c76SMark Cave-Ayland     esp_hard_reset(s);
1020eb169c76SMark Cave-Ayland }
1021eb169c76SMark Cave-Ayland 
1022eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj)
1023eb169c76SMark Cave-Ayland {
1024eb169c76SMark Cave-Ayland     SysBusESPState *sysbus = SYSBUS_ESP(obj);
1025eb169c76SMark Cave-Ayland 
1026eb169c76SMark Cave-Ayland     object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP);
1027a391fdbcSHervé Poussineau }
1028a391fdbcSHervé Poussineau 
1029a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = {
1030a391fdbcSHervé Poussineau     .name = "sysbusespscsi",
10310bd005beSMark Cave-Ayland     .version_id = 2,
1032ea84a442SGuenter Roeck     .minimum_version_id = 1,
1033a391fdbcSHervé Poussineau     .fields = (VMStateField[]) {
10340bd005beSMark Cave-Ayland         VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2),
1035a391fdbcSHervé Poussineau         VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState),
1036a391fdbcSHervé Poussineau         VMSTATE_END_OF_LIST()
1037a391fdbcSHervé Poussineau     }
1038999e12bbSAnthony Liguori };
1039999e12bbSAnthony Liguori 
1040a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data)
1041999e12bbSAnthony Liguori {
104239bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1043999e12bbSAnthony Liguori 
1044b09318caSHu Tao     dc->realize = sysbus_esp_realize;
1045a391fdbcSHervé Poussineau     dc->reset = sysbus_esp_hard_reset;
1046a391fdbcSHervé Poussineau     dc->vmsd = &vmstate_sysbus_esp_scsi;
1047125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
104863235df8SBlue Swirl }
1049999e12bbSAnthony Liguori 
10501f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = {
105184fbefedSMark Cave-Ayland     .name          = TYPE_SYSBUS_ESP,
105239bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
1053eb169c76SMark Cave-Ayland     .instance_init = sysbus_esp_init,
1054a391fdbcSHervé Poussineau     .instance_size = sizeof(SysBusESPState),
1055a391fdbcSHervé Poussineau     .class_init    = sysbus_esp_class_init,
105663235df8SBlue Swirl };
105763235df8SBlue Swirl 
1058eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data)
1059eb169c76SMark Cave-Ayland {
1060eb169c76SMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(klass);
1061eb169c76SMark Cave-Ayland 
1062eb169c76SMark Cave-Ayland     /* internal device for sysbusesp/pciespscsi, not user-creatable */
1063eb169c76SMark Cave-Ayland     dc->user_creatable = false;
1064eb169c76SMark Cave-Ayland     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
1065eb169c76SMark Cave-Ayland }
1066eb169c76SMark Cave-Ayland 
1067eb169c76SMark Cave-Ayland static const TypeInfo esp_info = {
1068eb169c76SMark Cave-Ayland     .name = TYPE_ESP,
1069eb169c76SMark Cave-Ayland     .parent = TYPE_DEVICE,
1070eb169c76SMark Cave-Ayland     .instance_size = sizeof(ESPState),
1071eb169c76SMark Cave-Ayland     .class_init = esp_class_init,
1072eb169c76SMark Cave-Ayland };
1073eb169c76SMark Cave-Ayland 
107483f7d43aSAndreas Färber static void esp_register_types(void)
1075cfb9de9cSPaul Brook {
1076a391fdbcSHervé Poussineau     type_register_static(&sysbus_esp_info);
1077eb169c76SMark Cave-Ayland     type_register_static(&esp_info);
1078cfb9de9cSPaul Brook }
1079cfb9de9cSPaul Brook 
108083f7d43aSAndreas Färber type_init(esp_register_types)
1081