xref: /qemu/hw/scsi/esp.c (revision 0056d51bf7db8bcea10fda599b79c86fb35d59c1)
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);
6674d71ea1SLaurent Vivier }
6774d71ea1SLaurent Vivier 
6874d71ea1SLaurent Vivier static void esp_lower_drq(ESPState *s)
6974d71ea1SLaurent Vivier {
7074d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
7174d71ea1SLaurent Vivier }
7274d71ea1SLaurent Vivier 
739c7e23fcSHervé Poussineau void esp_dma_enable(ESPState *s, int irq, int level)
7473d74342SBlue Swirl {
7573d74342SBlue Swirl     if (level) {
7673d74342SBlue Swirl         s->dma_enabled = 1;
77bf4b9889SBlue Swirl         trace_esp_dma_enable();
7873d74342SBlue Swirl         if (s->dma_cb) {
7973d74342SBlue Swirl             s->dma_cb(s);
8073d74342SBlue Swirl             s->dma_cb = NULL;
8173d74342SBlue Swirl         }
8273d74342SBlue Swirl     } else {
83bf4b9889SBlue Swirl         trace_esp_dma_disable();
8473d74342SBlue Swirl         s->dma_enabled = 0;
8573d74342SBlue Swirl     }
8673d74342SBlue Swirl }
8773d74342SBlue Swirl 
889c7e23fcSHervé Poussineau void esp_request_cancelled(SCSIRequest *req)
8994d3f98aSPaolo Bonzini {
90e6810db8SHervé Poussineau     ESPState *s = req->hba_private;
9194d3f98aSPaolo Bonzini 
9294d3f98aSPaolo Bonzini     if (req == s->current_req) {
9394d3f98aSPaolo Bonzini         scsi_req_unref(s->current_req);
9494d3f98aSPaolo Bonzini         s->current_req = NULL;
9594d3f98aSPaolo Bonzini         s->current_dev = NULL;
9694d3f98aSPaolo Bonzini     }
9794d3f98aSPaolo Bonzini }
9894d3f98aSPaolo Bonzini 
9974d71ea1SLaurent Vivier static void set_pdma(ESPState *s, enum pdma_origin_id origin,
10074d71ea1SLaurent Vivier                      uint32_t index, uint32_t len)
10174d71ea1SLaurent Vivier {
10274d71ea1SLaurent Vivier     s->pdma_origin = origin;
10374d71ea1SLaurent Vivier     s->pdma_start = index;
10474d71ea1SLaurent Vivier     s->pdma_cur = index;
10574d71ea1SLaurent Vivier     s->pdma_len = len;
10674d71ea1SLaurent Vivier }
10774d71ea1SLaurent Vivier 
10874d71ea1SLaurent Vivier static uint8_t *get_pdma_buf(ESPState *s)
10974d71ea1SLaurent Vivier {
11074d71ea1SLaurent Vivier     switch (s->pdma_origin) {
11174d71ea1SLaurent Vivier     case PDMA:
11274d71ea1SLaurent Vivier         return s->pdma_buf;
11374d71ea1SLaurent Vivier     case TI:
11474d71ea1SLaurent Vivier         return s->ti_buf;
11574d71ea1SLaurent Vivier     case CMD:
11674d71ea1SLaurent Vivier         return s->cmdbuf;
11774d71ea1SLaurent Vivier     case ASYNC:
11874d71ea1SLaurent Vivier         return s->async_buf;
11974d71ea1SLaurent Vivier     }
12074d71ea1SLaurent Vivier     return NULL;
12174d71ea1SLaurent Vivier }
12274d71ea1SLaurent Vivier 
1236130b188SLaurent Vivier static int get_cmd_cb(ESPState *s)
1246130b188SLaurent Vivier {
1256130b188SLaurent Vivier     int target;
1266130b188SLaurent Vivier 
1276130b188SLaurent Vivier     target = s->wregs[ESP_WBUSID] & BUSID_DID;
1286130b188SLaurent Vivier 
1296130b188SLaurent Vivier     s->ti_size = 0;
1306130b188SLaurent Vivier     s->ti_rptr = 0;
1316130b188SLaurent Vivier     s->ti_wptr = 0;
1326130b188SLaurent Vivier 
1336130b188SLaurent Vivier     if (s->current_req) {
1346130b188SLaurent Vivier         /* Started a new command before the old one finished.  Cancel it.  */
1356130b188SLaurent Vivier         scsi_req_cancel(s->current_req);
1366130b188SLaurent Vivier         s->async_len = 0;
1376130b188SLaurent Vivier     }
1386130b188SLaurent Vivier 
1396130b188SLaurent Vivier     s->current_dev = scsi_device_find(&s->bus, 0, target, 0);
1406130b188SLaurent Vivier     if (!s->current_dev) {
1416130b188SLaurent Vivier         /* No such drive */
1426130b188SLaurent Vivier         s->rregs[ESP_RSTAT] = 0;
1436130b188SLaurent Vivier         s->rregs[ESP_RINTR] = INTR_DC;
1446130b188SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_0;
1456130b188SLaurent Vivier         esp_raise_irq(s);
1466130b188SLaurent Vivier         return -1;
1476130b188SLaurent Vivier     }
1486130b188SLaurent Vivier     return 0;
1496130b188SLaurent Vivier }
1506130b188SLaurent Vivier 
1516c1fef6bSPrasad J Pandit static uint32_t get_cmd(ESPState *s, uint8_t *buf, uint8_t buflen)
1522f275b8fSbellard {
153a917d384Spbrook     uint32_t dmalen;
1542f275b8fSbellard     int target;
1552f275b8fSbellard 
1568dea1dd4Sblueswir1     target = s->wregs[ESP_WBUSID] & BUSID_DID;
1574f6200f0Sbellard     if (s->dma) {
1589ea73f8bSPaolo Bonzini         dmalen = s->rregs[ESP_TCLO];
1599ea73f8bSPaolo Bonzini         dmalen |= s->rregs[ESP_TCMID] << 8;
1609ea73f8bSPaolo Bonzini         dmalen |= s->rregs[ESP_TCHI] << 16;
1616c1fef6bSPrasad J Pandit         if (dmalen > buflen) {
1626c1fef6bSPrasad J Pandit             return 0;
1636c1fef6bSPrasad J Pandit         }
16474d71ea1SLaurent Vivier         if (s->dma_memory_read) {
1658b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, buf, dmalen);
1664f6200f0Sbellard         } else {
16774d71ea1SLaurent Vivier             memcpy(s->pdma_buf, buf, dmalen);
16874d71ea1SLaurent Vivier             set_pdma(s, PDMA, 0, dmalen);
16974d71ea1SLaurent Vivier             esp_raise_drq(s);
17074d71ea1SLaurent Vivier             return 0;
17174d71ea1SLaurent Vivier         }
17274d71ea1SLaurent Vivier     } else {
173fc4d65daSblueswir1         dmalen = s->ti_size;
174d3cdc491SPrasad J Pandit         if (dmalen > TI_BUFSZ) {
175d3cdc491SPrasad J Pandit             return 0;
176d3cdc491SPrasad J Pandit         }
177fc4d65daSblueswir1         memcpy(buf, s->ti_buf, dmalen);
17875ef8496SHervé Poussineau         buf[0] = buf[2] >> 5;
1794f6200f0Sbellard     }
180bf4b9889SBlue Swirl     trace_esp_get_cmd(dmalen, target);
1812e5d83bbSpbrook 
1826130b188SLaurent Vivier     if (get_cmd_cb(s) < 0) {
1839f149aa9Spbrook         return 0;
1842f275b8fSbellard     }
1859f149aa9Spbrook     return dmalen;
1869f149aa9Spbrook }
1879f149aa9Spbrook 
188f2818f22SArtyom Tarasenko static void do_busid_cmd(ESPState *s, uint8_t *buf, uint8_t busid)
1899f149aa9Spbrook {
1909f149aa9Spbrook     int32_t datalen;
1919f149aa9Spbrook     int lun;
192f48a7a6eSPaolo Bonzini     SCSIDevice *current_lun;
1939f149aa9Spbrook 
194bf4b9889SBlue Swirl     trace_esp_do_busid_cmd(busid);
195f2818f22SArtyom Tarasenko     lun = busid & 7;
1960d3545e7SPaolo Bonzini     current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, lun);
197e6810db8SHervé Poussineau     s->current_req = scsi_req_new(current_lun, 0, lun, buf, s);
198c39ce112SPaolo Bonzini     datalen = scsi_req_enqueue(s->current_req);
19967e999beSbellard     s->ti_size = datalen;
20067e999beSbellard     if (datalen != 0) {
201c73f96fdSblueswir1         s->rregs[ESP_RSTAT] = STAT_TC;
202a917d384Spbrook         s->dma_left = 0;
2036787f5faSpbrook         s->dma_counter = 0;
2042e5d83bbSpbrook         if (datalen > 0) {
2055ad6bb97Sblueswir1             s->rregs[ESP_RSTAT] |= STAT_DI;
2064f6200f0Sbellard         } else {
2075ad6bb97Sblueswir1             s->rregs[ESP_RSTAT] |= STAT_DO;
2084f6200f0Sbellard         }
209ad3376ccSPaolo Bonzini         scsi_req_continue(s->current_req);
2104e9aec74Spbrook     }
2115ad6bb97Sblueswir1     s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
2125ad6bb97Sblueswir1     s->rregs[ESP_RSEQ] = SEQ_CD;
213c73f96fdSblueswir1     esp_raise_irq(s);
2142f275b8fSbellard }
2152f275b8fSbellard 
216f2818f22SArtyom Tarasenko static void do_cmd(ESPState *s, uint8_t *buf)
217f2818f22SArtyom Tarasenko {
218f2818f22SArtyom Tarasenko     uint8_t busid = buf[0];
219f2818f22SArtyom Tarasenko 
220f2818f22SArtyom Tarasenko     do_busid_cmd(s, &buf[1], busid);
221f2818f22SArtyom Tarasenko }
222f2818f22SArtyom Tarasenko 
22374d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s)
22474d71ea1SLaurent Vivier {
22574d71ea1SLaurent Vivier     if (get_cmd_cb(s) < 0) {
22674d71ea1SLaurent Vivier         return;
22774d71ea1SLaurent Vivier     }
22874d71ea1SLaurent Vivier     if (s->pdma_cur != s->pdma_start) {
22974d71ea1SLaurent Vivier         do_cmd(s, get_pdma_buf(s) + s->pdma_start);
23074d71ea1SLaurent Vivier     }
23174d71ea1SLaurent Vivier }
23274d71ea1SLaurent Vivier 
2339f149aa9Spbrook static void handle_satn(ESPState *s)
2349f149aa9Spbrook {
2359f149aa9Spbrook     uint8_t buf[32];
2369f149aa9Spbrook     int len;
2379f149aa9Spbrook 
2381b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
23973d74342SBlue Swirl         s->dma_cb = handle_satn;
24073d74342SBlue Swirl         return;
24173d74342SBlue Swirl     }
24274d71ea1SLaurent Vivier     s->pdma_cb = satn_pdma_cb;
2436c1fef6bSPrasad J Pandit     len = get_cmd(s, buf, sizeof(buf));
2449f149aa9Spbrook     if (len)
2459f149aa9Spbrook         do_cmd(s, buf);
2469f149aa9Spbrook }
2479f149aa9Spbrook 
24874d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s)
24974d71ea1SLaurent Vivier {
25074d71ea1SLaurent Vivier     if (get_cmd_cb(s) < 0) {
25174d71ea1SLaurent Vivier         return;
25274d71ea1SLaurent Vivier     }
25374d71ea1SLaurent Vivier     if (s->pdma_cur != s->pdma_start) {
25474d71ea1SLaurent Vivier         do_busid_cmd(s, get_pdma_buf(s) + s->pdma_start, 0);
25574d71ea1SLaurent Vivier     }
25674d71ea1SLaurent Vivier }
25774d71ea1SLaurent Vivier 
258f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s)
259f2818f22SArtyom Tarasenko {
260f2818f22SArtyom Tarasenko     uint8_t buf[32];
261f2818f22SArtyom Tarasenko     int len;
262f2818f22SArtyom Tarasenko 
2631b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
26473d74342SBlue Swirl         s->dma_cb = handle_s_without_atn;
26573d74342SBlue Swirl         return;
26673d74342SBlue Swirl     }
26774d71ea1SLaurent Vivier     s->pdma_cb = s_without_satn_pdma_cb;
2686c1fef6bSPrasad J Pandit     len = get_cmd(s, buf, sizeof(buf));
269f2818f22SArtyom Tarasenko     if (len) {
270f2818f22SArtyom Tarasenko         do_busid_cmd(s, buf, 0);
271f2818f22SArtyom Tarasenko     }
272f2818f22SArtyom Tarasenko }
273f2818f22SArtyom Tarasenko 
27474d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s)
27574d71ea1SLaurent Vivier {
27674d71ea1SLaurent Vivier     if (get_cmd_cb(s) < 0) {
27774d71ea1SLaurent Vivier         return;
27874d71ea1SLaurent Vivier     }
27974d71ea1SLaurent Vivier     s->cmdlen = s->pdma_cur - s->pdma_start;
28074d71ea1SLaurent Vivier     if (s->cmdlen) {
28174d71ea1SLaurent Vivier         trace_esp_handle_satn_stop(s->cmdlen);
28274d71ea1SLaurent Vivier         s->do_cmd = 1;
28374d71ea1SLaurent Vivier         s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD;
28474d71ea1SLaurent Vivier         s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
28574d71ea1SLaurent Vivier         s->rregs[ESP_RSEQ] = SEQ_CD;
28674d71ea1SLaurent Vivier         esp_raise_irq(s);
28774d71ea1SLaurent Vivier     }
28874d71ea1SLaurent Vivier }
28974d71ea1SLaurent Vivier 
2909f149aa9Spbrook static void handle_satn_stop(ESPState *s)
2919f149aa9Spbrook {
2921b26eaa1SHervé Poussineau     if (s->dma && !s->dma_enabled) {
29373d74342SBlue Swirl         s->dma_cb = handle_satn_stop;
29473d74342SBlue Swirl         return;
29573d74342SBlue Swirl     }
296c62c1fa0SPhilippe Mathieu-Daudé     s->pdma_cb = satn_stop_pdma_cb;
2976c1fef6bSPrasad J Pandit     s->cmdlen = get_cmd(s, s->cmdbuf, sizeof(s->cmdbuf));
2989f149aa9Spbrook     if (s->cmdlen) {
299bf4b9889SBlue Swirl         trace_esp_handle_satn_stop(s->cmdlen);
3009f149aa9Spbrook         s->do_cmd = 1;
301c73f96fdSblueswir1         s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD;
3025ad6bb97Sblueswir1         s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
3035ad6bb97Sblueswir1         s->rregs[ESP_RSEQ] = SEQ_CD;
304c73f96fdSblueswir1         esp_raise_irq(s);
3059f149aa9Spbrook     }
3069f149aa9Spbrook }
3079f149aa9Spbrook 
30874d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s)
30974d71ea1SLaurent Vivier {
31074d71ea1SLaurent Vivier     s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST;
31174d71ea1SLaurent Vivier     s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
31274d71ea1SLaurent Vivier     s->rregs[ESP_RSEQ] = SEQ_CD;
31374d71ea1SLaurent Vivier     esp_raise_irq(s);
31474d71ea1SLaurent Vivier }
31574d71ea1SLaurent Vivier 
3160fc5c15aSpbrook static void write_response(ESPState *s)
3172f275b8fSbellard {
318bf4b9889SBlue Swirl     trace_esp_write_response(s->status);
3193944966dSPaolo Bonzini     s->ti_buf[0] = s->status;
3200fc5c15aSpbrook     s->ti_buf[1] = 0;
3214f6200f0Sbellard     if (s->dma) {
32274d71ea1SLaurent Vivier         if (s->dma_memory_write) {
3238b17de88Sblueswir1             s->dma_memory_write(s->dma_opaque, s->ti_buf, 2);
324c73f96fdSblueswir1             s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST;
3255ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_BS | INTR_FC;
3265ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = SEQ_CD;
3274f6200f0Sbellard         } else {
32874d71ea1SLaurent Vivier             set_pdma(s, TI, 0, 2);
32974d71ea1SLaurent Vivier             s->pdma_cb = write_response_pdma_cb;
33074d71ea1SLaurent Vivier             esp_raise_drq(s);
33174d71ea1SLaurent Vivier             return;
33274d71ea1SLaurent Vivier         }
33374d71ea1SLaurent Vivier     } else {
3340fc5c15aSpbrook         s->ti_size = 2;
3354f6200f0Sbellard         s->ti_rptr = 0;
336d020aa50SPaolo Bonzini         s->ti_wptr = 2;
3375ad6bb97Sblueswir1         s->rregs[ESP_RFLAGS] = 2;
3384f6200f0Sbellard     }
339c73f96fdSblueswir1     esp_raise_irq(s);
3402f275b8fSbellard }
3414f6200f0Sbellard 
342a917d384Spbrook static void esp_dma_done(ESPState *s)
3434d611c9aSpbrook {
344c73f96fdSblueswir1     s->rregs[ESP_RSTAT] |= STAT_TC;
3455ad6bb97Sblueswir1     s->rregs[ESP_RINTR] = INTR_BS;
3465ad6bb97Sblueswir1     s->rregs[ESP_RSEQ] = 0;
3475ad6bb97Sblueswir1     s->rregs[ESP_RFLAGS] = 0;
3485ad6bb97Sblueswir1     s->rregs[ESP_TCLO] = 0;
3495ad6bb97Sblueswir1     s->rregs[ESP_TCMID] = 0;
3509ea73f8bSPaolo Bonzini     s->rregs[ESP_TCHI] = 0;
351c73f96fdSblueswir1     esp_raise_irq(s);
3524d611c9aSpbrook }
353a917d384Spbrook 
35474d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s)
35574d71ea1SLaurent Vivier {
35674d71ea1SLaurent Vivier     int to_device = (s->ti_size < 0);
35774d71ea1SLaurent Vivier     int len = s->pdma_cur - s->pdma_start;
35874d71ea1SLaurent Vivier     if (s->do_cmd) {
35974d71ea1SLaurent Vivier         s->ti_size = 0;
36074d71ea1SLaurent Vivier         s->cmdlen = 0;
36174d71ea1SLaurent Vivier         s->do_cmd = 0;
36274d71ea1SLaurent Vivier         do_cmd(s, s->cmdbuf);
36374d71ea1SLaurent Vivier         return;
36474d71ea1SLaurent Vivier     }
36574d71ea1SLaurent Vivier     s->dma_left -= len;
36674d71ea1SLaurent Vivier     s->async_buf += len;
36774d71ea1SLaurent Vivier     s->async_len -= len;
36874d71ea1SLaurent Vivier     if (to_device) {
36974d71ea1SLaurent Vivier         s->ti_size += len;
37074d71ea1SLaurent Vivier     } else {
37174d71ea1SLaurent Vivier         s->ti_size -= len;
37274d71ea1SLaurent Vivier     }
37374d71ea1SLaurent Vivier     if (s->async_len == 0) {
37474d71ea1SLaurent Vivier         scsi_req_continue(s->current_req);
37574d71ea1SLaurent Vivier         /*
37674d71ea1SLaurent Vivier          * If there is still data to be read from the device then
37774d71ea1SLaurent Vivier          * complete the DMA operation immediately.  Otherwise defer
37874d71ea1SLaurent Vivier          * until the scsi layer has completed.
37974d71ea1SLaurent Vivier          */
38074d71ea1SLaurent Vivier         if (to_device || s->dma_left != 0 || s->ti_size == 0) {
38174d71ea1SLaurent Vivier             return;
38274d71ea1SLaurent Vivier         }
38374d71ea1SLaurent Vivier     }
38474d71ea1SLaurent Vivier 
38574d71ea1SLaurent Vivier     /* Partially filled a scsi buffer. Complete immediately.  */
38674d71ea1SLaurent Vivier     esp_dma_done(s);
38774d71ea1SLaurent Vivier }
38874d71ea1SLaurent Vivier 
389a917d384Spbrook static void esp_do_dma(ESPState *s)
390a917d384Spbrook {
39167e999beSbellard     uint32_t len;
392a917d384Spbrook     int to_device;
393a917d384Spbrook 
394a917d384Spbrook     len = s->dma_left;
395a917d384Spbrook     if (s->do_cmd) {
39615407433SLaurent Vivier         /*
39715407433SLaurent Vivier          * handle_ti_cmd() case: esp_do_dma() is called only from
39815407433SLaurent Vivier          * handle_ti_cmd() with do_cmd != NULL (see the assert())
39915407433SLaurent Vivier          */
400bf4b9889SBlue Swirl         trace_esp_do_dma(s->cmdlen, len);
401926cde5fSPrasad J Pandit         assert (s->cmdlen <= sizeof(s->cmdbuf) &&
402926cde5fSPrasad J Pandit                 len <= sizeof(s->cmdbuf) - s->cmdlen);
40374d71ea1SLaurent Vivier         if (s->dma_memory_read) {
4048b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, &s->cmdbuf[s->cmdlen], len);
40574d71ea1SLaurent Vivier         } else {
40674d71ea1SLaurent Vivier             set_pdma(s, CMD, s->cmdlen, len);
40774d71ea1SLaurent Vivier             s->pdma_cb = do_dma_pdma_cb;
40874d71ea1SLaurent Vivier             esp_raise_drq(s);
40974d71ea1SLaurent Vivier             return;
41074d71ea1SLaurent Vivier         }
41115407433SLaurent Vivier         trace_esp_handle_ti_cmd(s->cmdlen);
41215407433SLaurent Vivier         s->ti_size = 0;
41315407433SLaurent Vivier         s->cmdlen = 0;
41415407433SLaurent Vivier         s->do_cmd = 0;
41515407433SLaurent Vivier         do_cmd(s, s->cmdbuf);
416a917d384Spbrook         return;
417a917d384Spbrook     }
418a917d384Spbrook     if (s->async_len == 0) {
419a917d384Spbrook         /* Defer until data is available.  */
420a917d384Spbrook         return;
421a917d384Spbrook     }
422a917d384Spbrook     if (len > s->async_len) {
423a917d384Spbrook         len = s->async_len;
424a917d384Spbrook     }
4257f0b6e11SPaolo Bonzini     to_device = (s->ti_size < 0);
426a917d384Spbrook     if (to_device) {
42774d71ea1SLaurent Vivier         if (s->dma_memory_read) {
4288b17de88Sblueswir1             s->dma_memory_read(s->dma_opaque, s->async_buf, len);
429a917d384Spbrook         } else {
43074d71ea1SLaurent Vivier             set_pdma(s, ASYNC, 0, len);
43174d71ea1SLaurent Vivier             s->pdma_cb = do_dma_pdma_cb;
43274d71ea1SLaurent Vivier             esp_raise_drq(s);
43374d71ea1SLaurent Vivier             return;
43474d71ea1SLaurent Vivier         }
43574d71ea1SLaurent Vivier     } else {
43674d71ea1SLaurent Vivier         if (s->dma_memory_write) {
4378b17de88Sblueswir1             s->dma_memory_write(s->dma_opaque, s->async_buf, len);
43874d71ea1SLaurent Vivier         } else {
43974d71ea1SLaurent Vivier             set_pdma(s, ASYNC, 0, len);
44074d71ea1SLaurent Vivier             s->pdma_cb = do_dma_pdma_cb;
44174d71ea1SLaurent Vivier             esp_raise_drq(s);
44274d71ea1SLaurent Vivier             return;
44374d71ea1SLaurent Vivier         }
444a917d384Spbrook     }
445a917d384Spbrook     s->dma_left -= len;
446a917d384Spbrook     s->async_buf += len;
447a917d384Spbrook     s->async_len -= len;
4486787f5faSpbrook     if (to_device)
4496787f5faSpbrook         s->ti_size += len;
4506787f5faSpbrook     else
4516787f5faSpbrook         s->ti_size -= len;
452a917d384Spbrook     if (s->async_len == 0) {
453ad3376ccSPaolo Bonzini         scsi_req_continue(s->current_req);
4546787f5faSpbrook         /* If there is still data to be read from the device then
4558dea1dd4Sblueswir1            complete the DMA operation immediately.  Otherwise defer
4566787f5faSpbrook            until the scsi layer has completed.  */
457ad3376ccSPaolo Bonzini         if (to_device || s->dma_left != 0 || s->ti_size == 0) {
458ad3376ccSPaolo Bonzini             return;
459a917d384Spbrook         }
460a917d384Spbrook     }
461ad3376ccSPaolo Bonzini 
4626787f5faSpbrook     /* Partially filled a scsi buffer. Complete immediately.  */
463a917d384Spbrook     esp_dma_done(s);
464a917d384Spbrook }
465a917d384Spbrook 
466ea84a442SGuenter Roeck static void esp_report_command_complete(ESPState *s, uint32_t status)
467a917d384Spbrook {
468bf4b9889SBlue Swirl     trace_esp_command_complete();
469c6df7102SPaolo Bonzini     if (s->ti_size != 0) {
470bf4b9889SBlue Swirl         trace_esp_command_complete_unexpected();
471c6df7102SPaolo Bonzini     }
472a917d384Spbrook     s->ti_size = 0;
473a917d384Spbrook     s->dma_left = 0;
474a917d384Spbrook     s->async_len = 0;
475aba1f023SPaolo Bonzini     if (status) {
476bf4b9889SBlue Swirl         trace_esp_command_complete_fail();
477c6df7102SPaolo Bonzini     }
478aba1f023SPaolo Bonzini     s->status = status;
4795ad6bb97Sblueswir1     s->rregs[ESP_RSTAT] = STAT_ST;
480a917d384Spbrook     esp_dma_done(s);
4815c6c0e51SHannes Reinecke     if (s->current_req) {
4825c6c0e51SHannes Reinecke         scsi_req_unref(s->current_req);
4835c6c0e51SHannes Reinecke         s->current_req = NULL;
484a917d384Spbrook         s->current_dev = NULL;
4855c6c0e51SHannes Reinecke     }
486c6df7102SPaolo Bonzini }
487c6df7102SPaolo Bonzini 
488ea84a442SGuenter Roeck void esp_command_complete(SCSIRequest *req, uint32_t status,
489ea84a442SGuenter Roeck                           size_t resid)
490ea84a442SGuenter Roeck {
491ea84a442SGuenter Roeck     ESPState *s = req->hba_private;
492ea84a442SGuenter Roeck 
493ea84a442SGuenter Roeck     if (s->rregs[ESP_RSTAT] & STAT_INT) {
494ea84a442SGuenter Roeck         /* Defer handling command complete until the previous
495ea84a442SGuenter Roeck          * interrupt has been handled.
496ea84a442SGuenter Roeck          */
497ea84a442SGuenter Roeck         trace_esp_command_complete_deferred();
498ea84a442SGuenter Roeck         s->deferred_status = status;
499ea84a442SGuenter Roeck         s->deferred_complete = true;
500ea84a442SGuenter Roeck         return;
501ea84a442SGuenter Roeck     }
502ea84a442SGuenter Roeck     esp_report_command_complete(s, status);
503ea84a442SGuenter Roeck }
504ea84a442SGuenter Roeck 
5059c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len)
506c6df7102SPaolo Bonzini {
507e6810db8SHervé Poussineau     ESPState *s = req->hba_private;
508c6df7102SPaolo Bonzini 
5097f0b6e11SPaolo Bonzini     assert(!s->do_cmd);
510bf4b9889SBlue Swirl     trace_esp_transfer_data(s->dma_left, s->ti_size);
511aba1f023SPaolo Bonzini     s->async_len = len;
5120c34459bSPaolo Bonzini     s->async_buf = scsi_req_get_buf(req);
5136787f5faSpbrook     if (s->dma_left) {
514a917d384Spbrook         esp_do_dma(s);
5156787f5faSpbrook     } else if (s->dma_counter != 0 && s->ti_size <= 0) {
5166787f5faSpbrook         /* If this was the last part of a DMA transfer then the
5176787f5faSpbrook            completion interrupt is deferred to here.  */
5186787f5faSpbrook         esp_dma_done(s);
5196787f5faSpbrook     }
520a917d384Spbrook }
5212e5d83bbSpbrook 
5222f275b8fSbellard static void handle_ti(ESPState *s)
5232f275b8fSbellard {
5244d611c9aSpbrook     uint32_t dmalen, minlen;
5252f275b8fSbellard 
5267246e160SHervé Poussineau     if (s->dma && !s->dma_enabled) {
5277246e160SHervé Poussineau         s->dma_cb = handle_ti;
5287246e160SHervé Poussineau         return;
5297246e160SHervé Poussineau     }
5307246e160SHervé Poussineau 
5319ea73f8bSPaolo Bonzini     dmalen = s->rregs[ESP_TCLO];
5329ea73f8bSPaolo Bonzini     dmalen |= s->rregs[ESP_TCMID] << 8;
5339ea73f8bSPaolo Bonzini     dmalen |= s->rregs[ESP_TCHI] << 16;
534db59203dSpbrook     if (dmalen==0) {
535db59203dSpbrook       dmalen=0x10000;
536db59203dSpbrook     }
5376787f5faSpbrook     s->dma_counter = dmalen;
538db59203dSpbrook 
5399f149aa9Spbrook     if (s->do_cmd)
540926cde5fSPrasad J Pandit         minlen = (dmalen < ESP_CMDBUF_SZ) ? dmalen : ESP_CMDBUF_SZ;
54167e999beSbellard     else if (s->ti_size < 0)
54267e999beSbellard         minlen = (dmalen < -s->ti_size) ? dmalen : -s->ti_size;
5439f149aa9Spbrook     else
544db59203dSpbrook         minlen = (dmalen < s->ti_size) ? dmalen : s->ti_size;
545bf4b9889SBlue Swirl     trace_esp_handle_ti(minlen);
5464f6200f0Sbellard     if (s->dma) {
5474d611c9aSpbrook         s->dma_left = minlen;
5485ad6bb97Sblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_TC;
5494d611c9aSpbrook         esp_do_dma(s);
55015407433SLaurent Vivier     } else if (s->do_cmd) {
551bf4b9889SBlue Swirl         trace_esp_handle_ti_cmd(s->cmdlen);
5529f149aa9Spbrook         s->ti_size = 0;
5539f149aa9Spbrook         s->cmdlen = 0;
5549f149aa9Spbrook         s->do_cmd = 0;
5559f149aa9Spbrook         do_cmd(s, s->cmdbuf);
5564f6200f0Sbellard     }
5572f275b8fSbellard }
5582f275b8fSbellard 
5599c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s)
5606f7e9aecSbellard {
5615aca8c3bSblueswir1     memset(s->rregs, 0, ESP_REGS);
5625aca8c3bSblueswir1     memset(s->wregs, 0, ESP_REGS);
563c9cf45c1SHannes Reinecke     s->tchi_written = 0;
5644e9aec74Spbrook     s->ti_size = 0;
5654e9aec74Spbrook     s->ti_rptr = 0;
5664e9aec74Spbrook     s->ti_wptr = 0;
5674e9aec74Spbrook     s->dma = 0;
5689f149aa9Spbrook     s->do_cmd = 0;
56973d74342SBlue Swirl     s->dma_cb = NULL;
5708dea1dd4Sblueswir1 
5718dea1dd4Sblueswir1     s->rregs[ESP_CFG1] = 7;
5726f7e9aecSbellard }
5736f7e9aecSbellard 
574a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s)
57585948643SBlue Swirl {
57685948643SBlue Swirl     qemu_irq_lower(s->irq);
57774d71ea1SLaurent Vivier     qemu_irq_lower(s->irq_data);
578a391fdbcSHervé Poussineau     esp_hard_reset(s);
57985948643SBlue Swirl }
58085948643SBlue Swirl 
581a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level)
5822d069babSblueswir1 {
58385948643SBlue Swirl     if (level) {
584a391fdbcSHervé Poussineau         esp_soft_reset(s);
58585948643SBlue Swirl     }
5862d069babSblueswir1 }
5872d069babSblueswir1 
5889c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr)
58973d74342SBlue Swirl {
590a391fdbcSHervé Poussineau     uint32_t old_val;
59173d74342SBlue Swirl 
592bf4b9889SBlue Swirl     trace_esp_mem_readb(saddr, s->rregs[saddr]);
5936f7e9aecSbellard     switch (saddr) {
5945ad6bb97Sblueswir1     case ESP_FIFO:
5955ad6bb97Sblueswir1         if ((s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) {
5968dea1dd4Sblueswir1             /* Data out.  */
597ff589551SPrasad J Pandit             qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n");
5985ad6bb97Sblueswir1             s->rregs[ESP_FIFO] = 0;
599ff589551SPrasad J Pandit         } else if (s->ti_rptr < s->ti_wptr) {
600ff589551SPrasad J Pandit             s->ti_size--;
6015ad6bb97Sblueswir1             s->rregs[ESP_FIFO] = s->ti_buf[s->ti_rptr++];
6024f6200f0Sbellard         }
603ff589551SPrasad J Pandit         if (s->ti_rptr == s->ti_wptr) {
6044f6200f0Sbellard             s->ti_rptr = 0;
6054f6200f0Sbellard             s->ti_wptr = 0;
6064f6200f0Sbellard         }
6074f6200f0Sbellard         break;
6085ad6bb97Sblueswir1     case ESP_RINTR:
6092814df28SBlue Swirl         /* Clear sequence step, interrupt register and all status bits
6102814df28SBlue Swirl            except TC */
6112814df28SBlue Swirl         old_val = s->rregs[ESP_RINTR];
6122814df28SBlue Swirl         s->rregs[ESP_RINTR] = 0;
6132814df28SBlue Swirl         s->rregs[ESP_RSTAT] &= ~STAT_TC;
6142814df28SBlue Swirl         s->rregs[ESP_RSEQ] = SEQ_CD;
615c73f96fdSblueswir1         esp_lower_irq(s);
616ea84a442SGuenter Roeck         if (s->deferred_complete) {
617ea84a442SGuenter Roeck             esp_report_command_complete(s, s->deferred_status);
618ea84a442SGuenter Roeck             s->deferred_complete = false;
619ea84a442SGuenter Roeck         }
6202814df28SBlue Swirl         return old_val;
621c9cf45c1SHannes Reinecke     case ESP_TCHI:
622c9cf45c1SHannes Reinecke         /* Return the unique id if the value has never been written */
623c9cf45c1SHannes Reinecke         if (!s->tchi_written) {
624c9cf45c1SHannes Reinecke             return s->chip_id;
625c9cf45c1SHannes Reinecke         }
6266f7e9aecSbellard     default:
6276f7e9aecSbellard         break;
6286f7e9aecSbellard     }
6292f275b8fSbellard     return s->rregs[saddr];
6306f7e9aecSbellard }
6316f7e9aecSbellard 
6329c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val)
6336f7e9aecSbellard {
634bf4b9889SBlue Swirl     trace_esp_mem_writeb(saddr, s->wregs[saddr], val);
6356f7e9aecSbellard     switch (saddr) {
636c9cf45c1SHannes Reinecke     case ESP_TCHI:
637c9cf45c1SHannes Reinecke         s->tchi_written = true;
638c9cf45c1SHannes Reinecke         /* fall through */
6395ad6bb97Sblueswir1     case ESP_TCLO:
6405ad6bb97Sblueswir1     case ESP_TCMID:
6415ad6bb97Sblueswir1         s->rregs[ESP_RSTAT] &= ~STAT_TC;
6424f6200f0Sbellard         break;
6435ad6bb97Sblueswir1     case ESP_FIFO:
6449f149aa9Spbrook         if (s->do_cmd) {
645926cde5fSPrasad J Pandit             if (s->cmdlen < ESP_CMDBUF_SZ) {
6469f149aa9Spbrook                 s->cmdbuf[s->cmdlen++] = val & 0xff;
647c98c6c10SPrasad J Pandit             } else {
648c98c6c10SPrasad J Pandit                 trace_esp_error_fifo_overrun();
649c98c6c10SPrasad J Pandit             }
650ff589551SPrasad J Pandit         } else if (s->ti_wptr == TI_BUFSZ - 1) {
6513af4e9aaSHervé Poussineau             trace_esp_error_fifo_overrun();
6522e5d83bbSpbrook         } else {
6534f6200f0Sbellard             s->ti_size++;
6544f6200f0Sbellard             s->ti_buf[s->ti_wptr++] = val & 0xff;
6552e5d83bbSpbrook         }
6564f6200f0Sbellard         break;
6575ad6bb97Sblueswir1     case ESP_CMD:
6584f6200f0Sbellard         s->rregs[saddr] = val;
6595ad6bb97Sblueswir1         if (val & CMD_DMA) {
6604f6200f0Sbellard             s->dma = 1;
6616787f5faSpbrook             /* Reload DMA counter.  */
6625ad6bb97Sblueswir1             s->rregs[ESP_TCLO] = s->wregs[ESP_TCLO];
6635ad6bb97Sblueswir1             s->rregs[ESP_TCMID] = s->wregs[ESP_TCMID];
6649ea73f8bSPaolo Bonzini             s->rregs[ESP_TCHI] = s->wregs[ESP_TCHI];
6654f6200f0Sbellard         } else {
6664f6200f0Sbellard             s->dma = 0;
6674f6200f0Sbellard         }
6685ad6bb97Sblueswir1         switch(val & CMD_CMD) {
6695ad6bb97Sblueswir1         case CMD_NOP:
670bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_nop(val);
6712f275b8fSbellard             break;
6725ad6bb97Sblueswir1         case CMD_FLUSH:
673bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_flush(val);
6749e61bde5Sbellard             //s->ti_size = 0;
6755ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_FC;
6765ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = 0;
677a214c598Sblueswir1             s->rregs[ESP_RFLAGS] = 0;
6786f7e9aecSbellard             break;
6795ad6bb97Sblueswir1         case CMD_RESET:
680bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_reset(val);
681a391fdbcSHervé Poussineau             esp_soft_reset(s);
6826f7e9aecSbellard             break;
6835ad6bb97Sblueswir1         case CMD_BUSRESET:
684bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_bus_reset(val);
6855ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_RST;
6865ad6bb97Sblueswir1             if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) {
687c73f96fdSblueswir1                 esp_raise_irq(s);
6889e61bde5Sbellard             }
6892f275b8fSbellard             break;
6905ad6bb97Sblueswir1         case CMD_TI:
6912f275b8fSbellard             handle_ti(s);
6922f275b8fSbellard             break;
6935ad6bb97Sblueswir1         case CMD_ICCS:
694bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_iccs(val);
6950fc5c15aSpbrook             write_response(s);
6964bf5801dSblueswir1             s->rregs[ESP_RINTR] = INTR_FC;
6974bf5801dSblueswir1             s->rregs[ESP_RSTAT] |= STAT_MI;
6982f275b8fSbellard             break;
6995ad6bb97Sblueswir1         case CMD_MSGACC:
700bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_msgacc(val);
7015ad6bb97Sblueswir1             s->rregs[ESP_RINTR] = INTR_DC;
7025ad6bb97Sblueswir1             s->rregs[ESP_RSEQ] = 0;
7034e2a68c1SArtyom Tarasenko             s->rregs[ESP_RFLAGS] = 0;
7044e2a68c1SArtyom Tarasenko             esp_raise_irq(s);
7056f7e9aecSbellard             break;
7060fd0eb21SBlue Swirl         case CMD_PAD:
707bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_pad(val);
7080fd0eb21SBlue Swirl             s->rregs[ESP_RSTAT] = STAT_TC;
7090fd0eb21SBlue Swirl             s->rregs[ESP_RINTR] = INTR_FC;
7100fd0eb21SBlue Swirl             s->rregs[ESP_RSEQ] = 0;
7110fd0eb21SBlue Swirl             break;
7125ad6bb97Sblueswir1         case CMD_SATN:
713bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_satn(val);
7146f7e9aecSbellard             break;
7156915bff1SHervé Poussineau         case CMD_RSTATN:
7166915bff1SHervé Poussineau             trace_esp_mem_writeb_cmd_rstatn(val);
7176915bff1SHervé Poussineau             break;
7185e1e0a3bSBlue Swirl         case CMD_SEL:
719bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_sel(val);
720f2818f22SArtyom Tarasenko             handle_s_without_atn(s);
7215e1e0a3bSBlue Swirl             break;
7225ad6bb97Sblueswir1         case CMD_SELATN:
723bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_selatn(val);
7242f275b8fSbellard             handle_satn(s);
7252f275b8fSbellard             break;
7265ad6bb97Sblueswir1         case CMD_SELATNS:
727bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_selatns(val);
7289f149aa9Spbrook             handle_satn_stop(s);
7292f275b8fSbellard             break;
7305ad6bb97Sblueswir1         case CMD_ENSEL:
731bf4b9889SBlue Swirl             trace_esp_mem_writeb_cmd_ensel(val);
732e3926838Sblueswir1             s->rregs[ESP_RINTR] = 0;
73374ec6048Sblueswir1             break;
7346fe84c18SHervé Poussineau         case CMD_DISSEL:
7356fe84c18SHervé Poussineau             trace_esp_mem_writeb_cmd_dissel(val);
7366fe84c18SHervé Poussineau             s->rregs[ESP_RINTR] = 0;
7376fe84c18SHervé Poussineau             esp_raise_irq(s);
7386fe84c18SHervé Poussineau             break;
7392f275b8fSbellard         default:
7403af4e9aaSHervé Poussineau             trace_esp_error_unhandled_command(val);
7416f7e9aecSbellard             break;
7426f7e9aecSbellard         }
7436f7e9aecSbellard         break;
7445ad6bb97Sblueswir1     case ESP_WBUSID ... ESP_WSYNO:
7454f6200f0Sbellard         break;
7465ad6bb97Sblueswir1     case ESP_CFG1:
7479ea73f8bSPaolo Bonzini     case ESP_CFG2: case ESP_CFG3:
7489ea73f8bSPaolo Bonzini     case ESP_RES3: case ESP_RES4:
7494f6200f0Sbellard         s->rregs[saddr] = val;
7504f6200f0Sbellard         break;
7515ad6bb97Sblueswir1     case ESP_WCCF ... ESP_WTEST:
7524f6200f0Sbellard         break;
7536f7e9aecSbellard     default:
7543af4e9aaSHervé Poussineau         trace_esp_error_invalid_write(val, saddr);
7558dea1dd4Sblueswir1         return;
7566f7e9aecSbellard     }
7572f275b8fSbellard     s->wregs[saddr] = val;
7586f7e9aecSbellard }
7596f7e9aecSbellard 
760a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr,
7618372d383SPeter Maydell                             unsigned size, bool is_write,
7628372d383SPeter Maydell                             MemTxAttrs attrs)
76367bb5314SAvi Kivity {
76467bb5314SAvi Kivity     return (size == 1) || (is_write && size == 4);
76567bb5314SAvi Kivity }
7666f7e9aecSbellard 
76774d71ea1SLaurent Vivier static bool esp_pdma_needed(void *opaque)
76874d71ea1SLaurent Vivier {
76974d71ea1SLaurent Vivier     ESPState *s = opaque;
77074d71ea1SLaurent Vivier     return s->dma_memory_read == NULL && s->dma_memory_write == NULL &&
77174d71ea1SLaurent Vivier            s->dma_enabled;
77274d71ea1SLaurent Vivier }
77374d71ea1SLaurent Vivier 
77474d71ea1SLaurent Vivier static const VMStateDescription vmstate_esp_pdma = {
77574d71ea1SLaurent Vivier     .name = "esp/pdma",
77674d71ea1SLaurent Vivier     .version_id = 1,
77774d71ea1SLaurent Vivier     .minimum_version_id = 1,
77874d71ea1SLaurent Vivier     .needed = esp_pdma_needed,
77974d71ea1SLaurent Vivier     .fields = (VMStateField[]) {
78074d71ea1SLaurent Vivier         VMSTATE_BUFFER(pdma_buf, ESPState),
78174d71ea1SLaurent Vivier         VMSTATE_INT32(pdma_origin, ESPState),
78274d71ea1SLaurent Vivier         VMSTATE_UINT32(pdma_len, ESPState),
78374d71ea1SLaurent Vivier         VMSTATE_UINT32(pdma_start, ESPState),
78474d71ea1SLaurent Vivier         VMSTATE_UINT32(pdma_cur, ESPState),
78574d71ea1SLaurent Vivier         VMSTATE_END_OF_LIST()
78674d71ea1SLaurent Vivier     }
78774d71ea1SLaurent Vivier };
78874d71ea1SLaurent Vivier 
7899c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = {
790cc9952f3SBlue Swirl     .name ="esp",
791cc966774SPaolo Bonzini     .version_id = 4,
792cc9952f3SBlue Swirl     .minimum_version_id = 3,
793cc9952f3SBlue Swirl     .fields = (VMStateField[]) {
794cc9952f3SBlue Swirl         VMSTATE_BUFFER(rregs, ESPState),
795cc9952f3SBlue Swirl         VMSTATE_BUFFER(wregs, ESPState),
796cc9952f3SBlue Swirl         VMSTATE_INT32(ti_size, ESPState),
797cc9952f3SBlue Swirl         VMSTATE_UINT32(ti_rptr, ESPState),
798cc9952f3SBlue Swirl         VMSTATE_UINT32(ti_wptr, ESPState),
799cc9952f3SBlue Swirl         VMSTATE_BUFFER(ti_buf, ESPState),
8003944966dSPaolo Bonzini         VMSTATE_UINT32(status, ESPState),
801ea84a442SGuenter Roeck         VMSTATE_UINT32(deferred_status, ESPState),
802ea84a442SGuenter Roeck         VMSTATE_BOOL(deferred_complete, ESPState),
803cc9952f3SBlue Swirl         VMSTATE_UINT32(dma, ESPState),
804cc966774SPaolo Bonzini         VMSTATE_PARTIAL_BUFFER(cmdbuf, ESPState, 16),
805cc966774SPaolo Bonzini         VMSTATE_BUFFER_START_MIDDLE_V(cmdbuf, ESPState, 16, 4),
806cc9952f3SBlue Swirl         VMSTATE_UINT32(cmdlen, ESPState),
807cc9952f3SBlue Swirl         VMSTATE_UINT32(do_cmd, ESPState),
808cc9952f3SBlue Swirl         VMSTATE_UINT32(dma_left, ESPState),
809cc9952f3SBlue Swirl         VMSTATE_END_OF_LIST()
81074d71ea1SLaurent Vivier     },
81174d71ea1SLaurent Vivier     .subsections = (const VMStateDescription * []) {
81274d71ea1SLaurent Vivier         &vmstate_esp_pdma,
81374d71ea1SLaurent Vivier         NULL
8146f7e9aecSbellard     }
815cc9952f3SBlue Swirl };
8166f7e9aecSbellard 
817a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr,
818a391fdbcSHervé Poussineau                                  uint64_t val, unsigned int size)
819a391fdbcSHervé Poussineau {
820a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
821a391fdbcSHervé Poussineau     uint32_t saddr;
822a391fdbcSHervé Poussineau 
823a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
824a391fdbcSHervé Poussineau     esp_reg_write(&sysbus->esp, saddr, val);
825a391fdbcSHervé Poussineau }
826a391fdbcSHervé Poussineau 
827a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr,
828a391fdbcSHervé Poussineau                                     unsigned int size)
829a391fdbcSHervé Poussineau {
830a391fdbcSHervé Poussineau     SysBusESPState *sysbus = opaque;
831a391fdbcSHervé Poussineau     uint32_t saddr;
832a391fdbcSHervé Poussineau 
833a391fdbcSHervé Poussineau     saddr = addr >> sysbus->it_shift;
834a391fdbcSHervé Poussineau     return esp_reg_read(&sysbus->esp, saddr);
835a391fdbcSHervé Poussineau }
836a391fdbcSHervé Poussineau 
837a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = {
838a391fdbcSHervé Poussineau     .read = sysbus_esp_mem_read,
839a391fdbcSHervé Poussineau     .write = sysbus_esp_mem_write,
840a391fdbcSHervé Poussineau     .endianness = DEVICE_NATIVE_ENDIAN,
841a391fdbcSHervé Poussineau     .valid.accepts = esp_mem_accepts,
842a391fdbcSHervé Poussineau };
843a391fdbcSHervé Poussineau 
84474d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr,
84574d71ea1SLaurent Vivier                                   uint64_t val, unsigned int size)
84674d71ea1SLaurent Vivier {
84774d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
84874d71ea1SLaurent Vivier     ESPState *s = &sysbus->esp;
84974d71ea1SLaurent Vivier     uint32_t dmalen;
85074d71ea1SLaurent Vivier     uint8_t *buf = get_pdma_buf(s);
85174d71ea1SLaurent Vivier 
85274d71ea1SLaurent Vivier     dmalen = s->rregs[ESP_TCLO];
85374d71ea1SLaurent Vivier     dmalen |= s->rregs[ESP_TCMID] << 8;
85474d71ea1SLaurent Vivier     dmalen |= s->rregs[ESP_TCHI] << 16;
85574d71ea1SLaurent Vivier     if (dmalen == 0 || s->pdma_len == 0) {
85674d71ea1SLaurent Vivier         return;
85774d71ea1SLaurent Vivier     }
85874d71ea1SLaurent Vivier     switch (size) {
85974d71ea1SLaurent Vivier     case 1:
86074d71ea1SLaurent Vivier         buf[s->pdma_cur++] = val;
86174d71ea1SLaurent Vivier         s->pdma_len--;
86274d71ea1SLaurent Vivier         dmalen--;
86374d71ea1SLaurent Vivier         break;
86474d71ea1SLaurent Vivier     case 2:
86574d71ea1SLaurent Vivier         buf[s->pdma_cur++] = val >> 8;
86674d71ea1SLaurent Vivier         buf[s->pdma_cur++] = val;
86774d71ea1SLaurent Vivier         s->pdma_len -= 2;
86874d71ea1SLaurent Vivier         dmalen -= 2;
86974d71ea1SLaurent Vivier         break;
87074d71ea1SLaurent Vivier     }
87174d71ea1SLaurent Vivier     s->rregs[ESP_TCLO] = dmalen & 0xff;
87274d71ea1SLaurent Vivier     s->rregs[ESP_TCMID] = dmalen >> 8;
87374d71ea1SLaurent Vivier     s->rregs[ESP_TCHI] = dmalen >> 16;
87474d71ea1SLaurent Vivier     if (s->pdma_len == 0 && s->pdma_cb) {
87574d71ea1SLaurent Vivier         esp_lower_drq(s);
87674d71ea1SLaurent Vivier         s->pdma_cb(s);
87774d71ea1SLaurent Vivier         s->pdma_cb = NULL;
87874d71ea1SLaurent Vivier     }
87974d71ea1SLaurent Vivier }
88074d71ea1SLaurent Vivier 
88174d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr,
88274d71ea1SLaurent Vivier                                      unsigned int size)
88374d71ea1SLaurent Vivier {
88474d71ea1SLaurent Vivier     SysBusESPState *sysbus = opaque;
88574d71ea1SLaurent Vivier     ESPState *s = &sysbus->esp;
88674d71ea1SLaurent Vivier     uint8_t *buf = get_pdma_buf(s);
88774d71ea1SLaurent Vivier     uint64_t val = 0;
88874d71ea1SLaurent Vivier 
88974d71ea1SLaurent Vivier     if (s->pdma_len == 0) {
89074d71ea1SLaurent Vivier         return 0;
89174d71ea1SLaurent Vivier     }
89274d71ea1SLaurent Vivier     switch (size) {
89374d71ea1SLaurent Vivier     case 1:
89474d71ea1SLaurent Vivier         val = buf[s->pdma_cur++];
89574d71ea1SLaurent Vivier         s->pdma_len--;
89674d71ea1SLaurent Vivier         break;
89774d71ea1SLaurent Vivier     case 2:
89874d71ea1SLaurent Vivier         val = buf[s->pdma_cur++];
89974d71ea1SLaurent Vivier         val = (val << 8) | buf[s->pdma_cur++];
90074d71ea1SLaurent Vivier         s->pdma_len -= 2;
90174d71ea1SLaurent Vivier         break;
90274d71ea1SLaurent Vivier     }
90374d71ea1SLaurent Vivier 
90474d71ea1SLaurent Vivier     if (s->pdma_len == 0 && s->pdma_cb) {
90574d71ea1SLaurent Vivier         esp_lower_drq(s);
90674d71ea1SLaurent Vivier         s->pdma_cb(s);
90774d71ea1SLaurent Vivier         s->pdma_cb = NULL;
90874d71ea1SLaurent Vivier     }
90974d71ea1SLaurent Vivier     return val;
91074d71ea1SLaurent Vivier }
91174d71ea1SLaurent Vivier 
91274d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = {
91374d71ea1SLaurent Vivier     .read = sysbus_esp_pdma_read,
91474d71ea1SLaurent Vivier     .write = sysbus_esp_pdma_write,
91574d71ea1SLaurent Vivier     .endianness = DEVICE_NATIVE_ENDIAN,
91674d71ea1SLaurent Vivier     .valid.min_access_size = 1,
91774d71ea1SLaurent Vivier     .valid.max_access_size = 2,
91874d71ea1SLaurent Vivier };
91974d71ea1SLaurent Vivier 
920afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = {
921afd4030cSPaolo Bonzini     .tcq = false,
9227e0380b9SPaolo Bonzini     .max_target = ESP_MAX_DEVS,
9237e0380b9SPaolo Bonzini     .max_lun = 7,
924afd4030cSPaolo Bonzini 
925c6df7102SPaolo Bonzini     .transfer_data = esp_transfer_data,
92694d3f98aSPaolo Bonzini     .complete = esp_command_complete,
92794d3f98aSPaolo Bonzini     .cancel = esp_request_cancelled
928cfdc1bb0SPaolo Bonzini };
929cfdc1bb0SPaolo Bonzini 
930a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level)
931cfb9de9cSPaul Brook {
932*0056d51bSEduardo Habkost     SysBusESPState *sysbus = ESP(opaque);
933a391fdbcSHervé Poussineau     ESPState *s = &sysbus->esp;
934a391fdbcSHervé Poussineau 
935a391fdbcSHervé Poussineau     switch (irq) {
936a391fdbcSHervé Poussineau     case 0:
937a391fdbcSHervé Poussineau         parent_esp_reset(s, irq, level);
938a391fdbcSHervé Poussineau         break;
939a391fdbcSHervé Poussineau     case 1:
940a391fdbcSHervé Poussineau         esp_dma_enable(opaque, irq, level);
941a391fdbcSHervé Poussineau         break;
942a391fdbcSHervé Poussineau     }
943a391fdbcSHervé Poussineau }
944a391fdbcSHervé Poussineau 
945b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp)
946a391fdbcSHervé Poussineau {
947b09318caSHu Tao     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
948*0056d51bSEduardo Habkost     SysBusESPState *sysbus = ESP(dev);
949a391fdbcSHervé Poussineau     ESPState *s = &sysbus->esp;
9506f7e9aecSbellard 
951b09318caSHu Tao     sysbus_init_irq(sbd, &s->irq);
95274d71ea1SLaurent Vivier     sysbus_init_irq(sbd, &s->irq_data);
953a391fdbcSHervé Poussineau     assert(sysbus->it_shift != -1);
9546f7e9aecSbellard 
955d32e4b3dSHervé Poussineau     s->chip_id = TCHI_FAS100A;
95629776739SPaolo Bonzini     memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops,
95774d71ea1SLaurent Vivier                           sysbus, "esp-regs", ESP_REGS << sysbus->it_shift);
958b09318caSHu Tao     sysbus_init_mmio(sbd, &sysbus->iomem);
95974d71ea1SLaurent Vivier     memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops,
96074d71ea1SLaurent Vivier                           sysbus, "esp-pdma", 2);
96174d71ea1SLaurent Vivier     sysbus_init_mmio(sbd, &sysbus->pdma);
9626f7e9aecSbellard 
963b09318caSHu Tao     qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2);
9642d069babSblueswir1 
965b1187b51SAndreas Färber     scsi_bus_new(&s->bus, sizeof(s->bus), dev, &esp_scsi_info, NULL);
96667e999beSbellard }
967cfb9de9cSPaul Brook 
968a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev)
969a391fdbcSHervé Poussineau {
970*0056d51bSEduardo Habkost     SysBusESPState *sysbus = ESP(dev);
971a391fdbcSHervé Poussineau     esp_hard_reset(&sysbus->esp);
972a391fdbcSHervé Poussineau }
973a391fdbcSHervé Poussineau 
974a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = {
975a391fdbcSHervé Poussineau     .name = "sysbusespscsi",
976ea84a442SGuenter Roeck     .version_id = 1,
977ea84a442SGuenter Roeck     .minimum_version_id = 1,
978a391fdbcSHervé Poussineau     .fields = (VMStateField[]) {
979a391fdbcSHervé Poussineau         VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState),
980a391fdbcSHervé Poussineau         VMSTATE_END_OF_LIST()
981a391fdbcSHervé Poussineau     }
982999e12bbSAnthony Liguori };
983999e12bbSAnthony Liguori 
984a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data)
985999e12bbSAnthony Liguori {
98639bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
987999e12bbSAnthony Liguori 
988b09318caSHu Tao     dc->realize = sysbus_esp_realize;
989a391fdbcSHervé Poussineau     dc->reset = sysbus_esp_hard_reset;
990a391fdbcSHervé Poussineau     dc->vmsd = &vmstate_sysbus_esp_scsi;
991125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
99263235df8SBlue Swirl }
993999e12bbSAnthony Liguori 
9941f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = {
995a71c7ec5SHu Tao     .name          = TYPE_ESP,
99639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
997a391fdbcSHervé Poussineau     .instance_size = sizeof(SysBusESPState),
998a391fdbcSHervé Poussineau     .class_init    = sysbus_esp_class_init,
99963235df8SBlue Swirl };
100063235df8SBlue Swirl 
100183f7d43aSAndreas Färber static void esp_register_types(void)
1002cfb9de9cSPaul Brook {
1003a391fdbcSHervé Poussineau     type_register_static(&sysbus_esp_info);
1004cfb9de9cSPaul Brook }
1005cfb9de9cSPaul Brook 
100683f7d43aSAndreas Färber type_init(esp_register_types)
1007