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