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