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 4167e999beSbellard */ 4267e999beSbellard 43c73f96fdSblueswir1 static void esp_raise_irq(ESPState *s) 44c73f96fdSblueswir1 { 45c73f96fdSblueswir1 if (!(s->rregs[ESP_RSTAT] & STAT_INT)) { 46c73f96fdSblueswir1 s->rregs[ESP_RSTAT] |= STAT_INT; 47c73f96fdSblueswir1 qemu_irq_raise(s->irq); 48bf4b9889SBlue Swirl trace_esp_raise_irq(); 49c73f96fdSblueswir1 } 50c73f96fdSblueswir1 } 51c73f96fdSblueswir1 52c73f96fdSblueswir1 static void esp_lower_irq(ESPState *s) 53c73f96fdSblueswir1 { 54c73f96fdSblueswir1 if (s->rregs[ESP_RSTAT] & STAT_INT) { 55c73f96fdSblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_INT; 56c73f96fdSblueswir1 qemu_irq_lower(s->irq); 57bf4b9889SBlue Swirl trace_esp_lower_irq(); 58c73f96fdSblueswir1 } 59c73f96fdSblueswir1 } 60c73f96fdSblueswir1 619c7e23fcSHervé Poussineau void esp_dma_enable(ESPState *s, int irq, int level) 6273d74342SBlue Swirl { 6373d74342SBlue Swirl if (level) { 6473d74342SBlue Swirl s->dma_enabled = 1; 65bf4b9889SBlue Swirl trace_esp_dma_enable(); 6673d74342SBlue Swirl if (s->dma_cb) { 6773d74342SBlue Swirl s->dma_cb(s); 6873d74342SBlue Swirl s->dma_cb = NULL; 6973d74342SBlue Swirl } 7073d74342SBlue Swirl } else { 71bf4b9889SBlue Swirl trace_esp_dma_disable(); 7273d74342SBlue Swirl s->dma_enabled = 0; 7373d74342SBlue Swirl } 7473d74342SBlue Swirl } 7573d74342SBlue Swirl 769c7e23fcSHervé Poussineau void esp_request_cancelled(SCSIRequest *req) 7794d3f98aSPaolo Bonzini { 78e6810db8SHervé Poussineau ESPState *s = req->hba_private; 7994d3f98aSPaolo Bonzini 8094d3f98aSPaolo Bonzini if (req == s->current_req) { 8194d3f98aSPaolo Bonzini scsi_req_unref(s->current_req); 8294d3f98aSPaolo Bonzini s->current_req = NULL; 8394d3f98aSPaolo Bonzini s->current_dev = NULL; 8494d3f98aSPaolo Bonzini } 8594d3f98aSPaolo Bonzini } 8694d3f98aSPaolo Bonzini 876c1fef6bSPrasad J Pandit static uint32_t get_cmd(ESPState *s, uint8_t *buf, uint8_t buflen) 882f275b8fSbellard { 89a917d384Spbrook uint32_t dmalen; 902f275b8fSbellard int target; 912f275b8fSbellard 928dea1dd4Sblueswir1 target = s->wregs[ESP_WBUSID] & BUSID_DID; 934f6200f0Sbellard if (s->dma) { 949ea73f8bSPaolo Bonzini dmalen = s->rregs[ESP_TCLO]; 959ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCMID] << 8; 969ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCHI] << 16; 976c1fef6bSPrasad J Pandit if (dmalen > buflen) { 986c1fef6bSPrasad J Pandit return 0; 996c1fef6bSPrasad J Pandit } 1008b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, buf, dmalen); 1014f6200f0Sbellard } else { 102fc4d65daSblueswir1 dmalen = s->ti_size; 103d3cdc491SPrasad J Pandit if (dmalen > TI_BUFSZ) { 104d3cdc491SPrasad J Pandit return 0; 105d3cdc491SPrasad J Pandit } 106fc4d65daSblueswir1 memcpy(buf, s->ti_buf, dmalen); 10775ef8496SHervé Poussineau buf[0] = buf[2] >> 5; 1084f6200f0Sbellard } 109bf4b9889SBlue Swirl trace_esp_get_cmd(dmalen, target); 1102e5d83bbSpbrook 1112f275b8fSbellard s->ti_size = 0; 1124f6200f0Sbellard s->ti_rptr = 0; 1134f6200f0Sbellard s->ti_wptr = 0; 1142f275b8fSbellard 115429bef69SHervé Poussineau if (s->current_req) { 116a917d384Spbrook /* Started a new command before the old one finished. Cancel it. */ 11794d3f98aSPaolo Bonzini scsi_req_cancel(s->current_req); 118a917d384Spbrook s->async_len = 0; 119a917d384Spbrook } 120a917d384Spbrook 1210d3545e7SPaolo Bonzini s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 122f48a7a6eSPaolo Bonzini if (!s->current_dev) { 1232e5d83bbSpbrook // No such drive 124c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = 0; 1255ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_DC; 1265ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_0; 127c73f96fdSblueswir1 esp_raise_irq(s); 1289f149aa9Spbrook return 0; 1292f275b8fSbellard } 1309f149aa9Spbrook return dmalen; 1319f149aa9Spbrook } 1329f149aa9Spbrook 133f2818f22SArtyom Tarasenko static void do_busid_cmd(ESPState *s, uint8_t *buf, uint8_t busid) 1349f149aa9Spbrook { 1359f149aa9Spbrook int32_t datalen; 1369f149aa9Spbrook int lun; 137f48a7a6eSPaolo Bonzini SCSIDevice *current_lun; 1389f149aa9Spbrook 139bf4b9889SBlue Swirl trace_esp_do_busid_cmd(busid); 140f2818f22SArtyom Tarasenko lun = busid & 7; 1410d3545e7SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, lun); 142e6810db8SHervé Poussineau s->current_req = scsi_req_new(current_lun, 0, lun, buf, s); 143c39ce112SPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 14467e999beSbellard s->ti_size = datalen; 14567e999beSbellard if (datalen != 0) { 146c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = STAT_TC; 147a917d384Spbrook s->dma_left = 0; 1486787f5faSpbrook s->dma_counter = 0; 1492e5d83bbSpbrook if (datalen > 0) { 1505ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] |= STAT_DI; 1514f6200f0Sbellard } else { 1525ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] |= STAT_DO; 1534f6200f0Sbellard } 154ad3376ccSPaolo Bonzini scsi_req_continue(s->current_req); 1554e9aec74Spbrook } 1565ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS | INTR_FC; 1575ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 158c73f96fdSblueswir1 esp_raise_irq(s); 1592f275b8fSbellard } 1602f275b8fSbellard 161f2818f22SArtyom Tarasenko static void do_cmd(ESPState *s, uint8_t *buf) 162f2818f22SArtyom Tarasenko { 163f2818f22SArtyom Tarasenko uint8_t busid = buf[0]; 164f2818f22SArtyom Tarasenko 165f2818f22SArtyom Tarasenko do_busid_cmd(s, &buf[1], busid); 166f2818f22SArtyom Tarasenko } 167f2818f22SArtyom Tarasenko 1689f149aa9Spbrook static void handle_satn(ESPState *s) 1699f149aa9Spbrook { 1709f149aa9Spbrook uint8_t buf[32]; 1719f149aa9Spbrook int len; 1729f149aa9Spbrook 1731b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 17473d74342SBlue Swirl s->dma_cb = handle_satn; 17573d74342SBlue Swirl return; 17673d74342SBlue Swirl } 1776c1fef6bSPrasad J Pandit len = get_cmd(s, buf, sizeof(buf)); 1789f149aa9Spbrook if (len) 1799f149aa9Spbrook do_cmd(s, buf); 1809f149aa9Spbrook } 1819f149aa9Spbrook 182f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s) 183f2818f22SArtyom Tarasenko { 184f2818f22SArtyom Tarasenko uint8_t buf[32]; 185f2818f22SArtyom Tarasenko int len; 186f2818f22SArtyom Tarasenko 1871b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 18873d74342SBlue Swirl s->dma_cb = handle_s_without_atn; 18973d74342SBlue Swirl return; 19073d74342SBlue Swirl } 1916c1fef6bSPrasad J Pandit len = get_cmd(s, buf, sizeof(buf)); 192f2818f22SArtyom Tarasenko if (len) { 193f2818f22SArtyom Tarasenko do_busid_cmd(s, buf, 0); 194f2818f22SArtyom Tarasenko } 195f2818f22SArtyom Tarasenko } 196f2818f22SArtyom Tarasenko 1979f149aa9Spbrook static void handle_satn_stop(ESPState *s) 1989f149aa9Spbrook { 1991b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 20073d74342SBlue Swirl s->dma_cb = handle_satn_stop; 20173d74342SBlue Swirl return; 20273d74342SBlue Swirl } 2036c1fef6bSPrasad J Pandit s->cmdlen = get_cmd(s, s->cmdbuf, sizeof(s->cmdbuf)); 2049f149aa9Spbrook if (s->cmdlen) { 205bf4b9889SBlue Swirl trace_esp_handle_satn_stop(s->cmdlen); 2069f149aa9Spbrook s->do_cmd = 1; 207c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 2085ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS | INTR_FC; 2095ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 210c73f96fdSblueswir1 esp_raise_irq(s); 2119f149aa9Spbrook } 2129f149aa9Spbrook } 2139f149aa9Spbrook 2140fc5c15aSpbrook static void write_response(ESPState *s) 2152f275b8fSbellard { 216bf4b9889SBlue Swirl trace_esp_write_response(s->status); 2173944966dSPaolo Bonzini s->ti_buf[0] = s->status; 2180fc5c15aSpbrook s->ti_buf[1] = 0; 2194f6200f0Sbellard if (s->dma) { 2208b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->ti_buf, 2); 221c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 2225ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS | INTR_FC; 2235ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 2244f6200f0Sbellard } else { 2250fc5c15aSpbrook s->ti_size = 2; 2264f6200f0Sbellard s->ti_rptr = 0; 227d020aa50SPaolo Bonzini s->ti_wptr = 2; 2285ad6bb97Sblueswir1 s->rregs[ESP_RFLAGS] = 2; 2294f6200f0Sbellard } 230c73f96fdSblueswir1 esp_raise_irq(s); 2312f275b8fSbellard } 2324f6200f0Sbellard 233a917d384Spbrook static void esp_dma_done(ESPState *s) 2344d611c9aSpbrook { 235c73f96fdSblueswir1 s->rregs[ESP_RSTAT] |= STAT_TC; 2365ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS; 2375ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = 0; 2385ad6bb97Sblueswir1 s->rregs[ESP_RFLAGS] = 0; 2395ad6bb97Sblueswir1 s->rregs[ESP_TCLO] = 0; 2405ad6bb97Sblueswir1 s->rregs[ESP_TCMID] = 0; 2419ea73f8bSPaolo Bonzini s->rregs[ESP_TCHI] = 0; 242c73f96fdSblueswir1 esp_raise_irq(s); 2434d611c9aSpbrook } 244a917d384Spbrook 245a917d384Spbrook static void esp_do_dma(ESPState *s) 246a917d384Spbrook { 24767e999beSbellard uint32_t len; 248a917d384Spbrook int to_device; 249a917d384Spbrook 250a917d384Spbrook len = s->dma_left; 251a917d384Spbrook if (s->do_cmd) { 252*15407433SLaurent Vivier /* 253*15407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 254*15407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 255*15407433SLaurent Vivier */ 256bf4b9889SBlue Swirl trace_esp_do_dma(s->cmdlen, len); 257926cde5fSPrasad J Pandit assert (s->cmdlen <= sizeof(s->cmdbuf) && 258926cde5fSPrasad J Pandit len <= sizeof(s->cmdbuf) - s->cmdlen); 2598b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, &s->cmdbuf[s->cmdlen], len); 260*15407433SLaurent Vivier trace_esp_handle_ti_cmd(s->cmdlen); 261*15407433SLaurent Vivier s->ti_size = 0; 262*15407433SLaurent Vivier s->cmdlen = 0; 263*15407433SLaurent Vivier s->do_cmd = 0; 264*15407433SLaurent Vivier do_cmd(s, s->cmdbuf); 265a917d384Spbrook return; 266a917d384Spbrook } 267a917d384Spbrook if (s->async_len == 0) { 268a917d384Spbrook /* Defer until data is available. */ 269a917d384Spbrook return; 270a917d384Spbrook } 271a917d384Spbrook if (len > s->async_len) { 272a917d384Spbrook len = s->async_len; 273a917d384Spbrook } 2747f0b6e11SPaolo Bonzini to_device = (s->ti_size < 0); 275a917d384Spbrook if (to_device) { 2768b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, s->async_buf, len); 277a917d384Spbrook } else { 2788b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->async_buf, len); 279a917d384Spbrook } 280a917d384Spbrook s->dma_left -= len; 281a917d384Spbrook s->async_buf += len; 282a917d384Spbrook s->async_len -= len; 2836787f5faSpbrook if (to_device) 2846787f5faSpbrook s->ti_size += len; 2856787f5faSpbrook else 2866787f5faSpbrook s->ti_size -= len; 287a917d384Spbrook if (s->async_len == 0) { 288ad3376ccSPaolo Bonzini scsi_req_continue(s->current_req); 2896787f5faSpbrook /* If there is still data to be read from the device then 2908dea1dd4Sblueswir1 complete the DMA operation immediately. Otherwise defer 2916787f5faSpbrook until the scsi layer has completed. */ 292ad3376ccSPaolo Bonzini if (to_device || s->dma_left != 0 || s->ti_size == 0) { 293ad3376ccSPaolo Bonzini return; 294a917d384Spbrook } 295a917d384Spbrook } 296ad3376ccSPaolo Bonzini 2976787f5faSpbrook /* Partially filled a scsi buffer. Complete immediately. */ 298a917d384Spbrook esp_dma_done(s); 299a917d384Spbrook } 300a917d384Spbrook 301ea84a442SGuenter Roeck static void esp_report_command_complete(ESPState *s, uint32_t status) 302a917d384Spbrook { 303bf4b9889SBlue Swirl trace_esp_command_complete(); 304c6df7102SPaolo Bonzini if (s->ti_size != 0) { 305bf4b9889SBlue Swirl trace_esp_command_complete_unexpected(); 306c6df7102SPaolo Bonzini } 307a917d384Spbrook s->ti_size = 0; 308a917d384Spbrook s->dma_left = 0; 309a917d384Spbrook s->async_len = 0; 310aba1f023SPaolo Bonzini if (status) { 311bf4b9889SBlue Swirl trace_esp_command_complete_fail(); 312c6df7102SPaolo Bonzini } 313aba1f023SPaolo Bonzini s->status = status; 3145ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] = STAT_ST; 315a917d384Spbrook esp_dma_done(s); 3165c6c0e51SHannes Reinecke if (s->current_req) { 3175c6c0e51SHannes Reinecke scsi_req_unref(s->current_req); 3185c6c0e51SHannes Reinecke s->current_req = NULL; 319a917d384Spbrook s->current_dev = NULL; 3205c6c0e51SHannes Reinecke } 321c6df7102SPaolo Bonzini } 322c6df7102SPaolo Bonzini 323ea84a442SGuenter Roeck void esp_command_complete(SCSIRequest *req, uint32_t status, 324ea84a442SGuenter Roeck size_t resid) 325ea84a442SGuenter Roeck { 326ea84a442SGuenter Roeck ESPState *s = req->hba_private; 327ea84a442SGuenter Roeck 328ea84a442SGuenter Roeck if (s->rregs[ESP_RSTAT] & STAT_INT) { 329ea84a442SGuenter Roeck /* Defer handling command complete until the previous 330ea84a442SGuenter Roeck * interrupt has been handled. 331ea84a442SGuenter Roeck */ 332ea84a442SGuenter Roeck trace_esp_command_complete_deferred(); 333ea84a442SGuenter Roeck s->deferred_status = status; 334ea84a442SGuenter Roeck s->deferred_complete = true; 335ea84a442SGuenter Roeck return; 336ea84a442SGuenter Roeck } 337ea84a442SGuenter Roeck esp_report_command_complete(s, status); 338ea84a442SGuenter Roeck } 339ea84a442SGuenter Roeck 3409c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len) 341c6df7102SPaolo Bonzini { 342e6810db8SHervé Poussineau ESPState *s = req->hba_private; 343c6df7102SPaolo Bonzini 3447f0b6e11SPaolo Bonzini assert(!s->do_cmd); 345bf4b9889SBlue Swirl trace_esp_transfer_data(s->dma_left, s->ti_size); 346aba1f023SPaolo Bonzini s->async_len = len; 3470c34459bSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 3486787f5faSpbrook if (s->dma_left) { 349a917d384Spbrook esp_do_dma(s); 3506787f5faSpbrook } else if (s->dma_counter != 0 && s->ti_size <= 0) { 3516787f5faSpbrook /* If this was the last part of a DMA transfer then the 3526787f5faSpbrook completion interrupt is deferred to here. */ 3536787f5faSpbrook esp_dma_done(s); 3546787f5faSpbrook } 355a917d384Spbrook } 3562e5d83bbSpbrook 3572f275b8fSbellard static void handle_ti(ESPState *s) 3582f275b8fSbellard { 3594d611c9aSpbrook uint32_t dmalen, minlen; 3602f275b8fSbellard 3617246e160SHervé Poussineau if (s->dma && !s->dma_enabled) { 3627246e160SHervé Poussineau s->dma_cb = handle_ti; 3637246e160SHervé Poussineau return; 3647246e160SHervé Poussineau } 3657246e160SHervé Poussineau 3669ea73f8bSPaolo Bonzini dmalen = s->rregs[ESP_TCLO]; 3679ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCMID] << 8; 3689ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCHI] << 16; 369db59203dSpbrook if (dmalen==0) { 370db59203dSpbrook dmalen=0x10000; 371db59203dSpbrook } 3726787f5faSpbrook s->dma_counter = dmalen; 373db59203dSpbrook 3749f149aa9Spbrook if (s->do_cmd) 375926cde5fSPrasad J Pandit minlen = (dmalen < ESP_CMDBUF_SZ) ? dmalen : ESP_CMDBUF_SZ; 37667e999beSbellard else if (s->ti_size < 0) 37767e999beSbellard minlen = (dmalen < -s->ti_size) ? dmalen : -s->ti_size; 3789f149aa9Spbrook else 379db59203dSpbrook minlen = (dmalen < s->ti_size) ? dmalen : s->ti_size; 380bf4b9889SBlue Swirl trace_esp_handle_ti(minlen); 3814f6200f0Sbellard if (s->dma) { 3824d611c9aSpbrook s->dma_left = minlen; 3835ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 3844d611c9aSpbrook esp_do_dma(s); 385*15407433SLaurent Vivier } else if (s->do_cmd) { 386bf4b9889SBlue Swirl trace_esp_handle_ti_cmd(s->cmdlen); 3879f149aa9Spbrook s->ti_size = 0; 3889f149aa9Spbrook s->cmdlen = 0; 3899f149aa9Spbrook s->do_cmd = 0; 3909f149aa9Spbrook do_cmd(s, s->cmdbuf); 3914f6200f0Sbellard } 3922f275b8fSbellard } 3932f275b8fSbellard 3949c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s) 3956f7e9aecSbellard { 3965aca8c3bSblueswir1 memset(s->rregs, 0, ESP_REGS); 3975aca8c3bSblueswir1 memset(s->wregs, 0, ESP_REGS); 398c9cf45c1SHannes Reinecke s->tchi_written = 0; 3994e9aec74Spbrook s->ti_size = 0; 4004e9aec74Spbrook s->ti_rptr = 0; 4014e9aec74Spbrook s->ti_wptr = 0; 4024e9aec74Spbrook s->dma = 0; 4039f149aa9Spbrook s->do_cmd = 0; 40473d74342SBlue Swirl s->dma_cb = NULL; 4058dea1dd4Sblueswir1 4068dea1dd4Sblueswir1 s->rregs[ESP_CFG1] = 7; 4076f7e9aecSbellard } 4086f7e9aecSbellard 409a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s) 41085948643SBlue Swirl { 41185948643SBlue Swirl qemu_irq_lower(s->irq); 412a391fdbcSHervé Poussineau esp_hard_reset(s); 41385948643SBlue Swirl } 41485948643SBlue Swirl 415a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level) 4162d069babSblueswir1 { 41785948643SBlue Swirl if (level) { 418a391fdbcSHervé Poussineau esp_soft_reset(s); 41985948643SBlue Swirl } 4202d069babSblueswir1 } 4212d069babSblueswir1 4229c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 42373d74342SBlue Swirl { 424a391fdbcSHervé Poussineau uint32_t old_val; 42573d74342SBlue Swirl 426bf4b9889SBlue Swirl trace_esp_mem_readb(saddr, s->rregs[saddr]); 4276f7e9aecSbellard switch (saddr) { 4285ad6bb97Sblueswir1 case ESP_FIFO: 4295ad6bb97Sblueswir1 if ((s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 4308dea1dd4Sblueswir1 /* Data out. */ 431ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 4325ad6bb97Sblueswir1 s->rregs[ESP_FIFO] = 0; 433ff589551SPrasad J Pandit } else if (s->ti_rptr < s->ti_wptr) { 434ff589551SPrasad J Pandit s->ti_size--; 4355ad6bb97Sblueswir1 s->rregs[ESP_FIFO] = s->ti_buf[s->ti_rptr++]; 4364f6200f0Sbellard } 437ff589551SPrasad J Pandit if (s->ti_rptr == s->ti_wptr) { 4384f6200f0Sbellard s->ti_rptr = 0; 4394f6200f0Sbellard s->ti_wptr = 0; 4404f6200f0Sbellard } 4414f6200f0Sbellard break; 4425ad6bb97Sblueswir1 case ESP_RINTR: 4432814df28SBlue Swirl /* Clear sequence step, interrupt register and all status bits 4442814df28SBlue Swirl except TC */ 4452814df28SBlue Swirl old_val = s->rregs[ESP_RINTR]; 4462814df28SBlue Swirl s->rregs[ESP_RINTR] = 0; 4472814df28SBlue Swirl s->rregs[ESP_RSTAT] &= ~STAT_TC; 4482814df28SBlue Swirl s->rregs[ESP_RSEQ] = SEQ_CD; 449c73f96fdSblueswir1 esp_lower_irq(s); 450ea84a442SGuenter Roeck if (s->deferred_complete) { 451ea84a442SGuenter Roeck esp_report_command_complete(s, s->deferred_status); 452ea84a442SGuenter Roeck s->deferred_complete = false; 453ea84a442SGuenter Roeck } 4542814df28SBlue Swirl return old_val; 455c9cf45c1SHannes Reinecke case ESP_TCHI: 456c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 457c9cf45c1SHannes Reinecke if (!s->tchi_written) { 458c9cf45c1SHannes Reinecke return s->chip_id; 459c9cf45c1SHannes Reinecke } 4606f7e9aecSbellard default: 4616f7e9aecSbellard break; 4626f7e9aecSbellard } 4632f275b8fSbellard return s->rregs[saddr]; 4646f7e9aecSbellard } 4656f7e9aecSbellard 4669c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 4676f7e9aecSbellard { 468bf4b9889SBlue Swirl trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 4696f7e9aecSbellard switch (saddr) { 470c9cf45c1SHannes Reinecke case ESP_TCHI: 471c9cf45c1SHannes Reinecke s->tchi_written = true; 472c9cf45c1SHannes Reinecke /* fall through */ 4735ad6bb97Sblueswir1 case ESP_TCLO: 4745ad6bb97Sblueswir1 case ESP_TCMID: 4755ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 4764f6200f0Sbellard break; 4775ad6bb97Sblueswir1 case ESP_FIFO: 4789f149aa9Spbrook if (s->do_cmd) { 479926cde5fSPrasad J Pandit if (s->cmdlen < ESP_CMDBUF_SZ) { 4809f149aa9Spbrook s->cmdbuf[s->cmdlen++] = val & 0xff; 481c98c6c10SPrasad J Pandit } else { 482c98c6c10SPrasad J Pandit trace_esp_error_fifo_overrun(); 483c98c6c10SPrasad J Pandit } 484ff589551SPrasad J Pandit } else if (s->ti_wptr == TI_BUFSZ - 1) { 4853af4e9aaSHervé Poussineau trace_esp_error_fifo_overrun(); 4862e5d83bbSpbrook } else { 4874f6200f0Sbellard s->ti_size++; 4884f6200f0Sbellard s->ti_buf[s->ti_wptr++] = val & 0xff; 4892e5d83bbSpbrook } 4904f6200f0Sbellard break; 4915ad6bb97Sblueswir1 case ESP_CMD: 4924f6200f0Sbellard s->rregs[saddr] = val; 4935ad6bb97Sblueswir1 if (val & CMD_DMA) { 4944f6200f0Sbellard s->dma = 1; 4956787f5faSpbrook /* Reload DMA counter. */ 4965ad6bb97Sblueswir1 s->rregs[ESP_TCLO] = s->wregs[ESP_TCLO]; 4975ad6bb97Sblueswir1 s->rregs[ESP_TCMID] = s->wregs[ESP_TCMID]; 4989ea73f8bSPaolo Bonzini s->rregs[ESP_TCHI] = s->wregs[ESP_TCHI]; 4994f6200f0Sbellard } else { 5004f6200f0Sbellard s->dma = 0; 5014f6200f0Sbellard } 5025ad6bb97Sblueswir1 switch(val & CMD_CMD) { 5035ad6bb97Sblueswir1 case CMD_NOP: 504bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_nop(val); 5052f275b8fSbellard break; 5065ad6bb97Sblueswir1 case CMD_FLUSH: 507bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_flush(val); 5089e61bde5Sbellard //s->ti_size = 0; 5095ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_FC; 5105ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = 0; 511a214c598Sblueswir1 s->rregs[ESP_RFLAGS] = 0; 5126f7e9aecSbellard break; 5135ad6bb97Sblueswir1 case CMD_RESET: 514bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_reset(val); 515a391fdbcSHervé Poussineau esp_soft_reset(s); 5166f7e9aecSbellard break; 5175ad6bb97Sblueswir1 case CMD_BUSRESET: 518bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_bus_reset(val); 5195ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_RST; 5205ad6bb97Sblueswir1 if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 521c73f96fdSblueswir1 esp_raise_irq(s); 5229e61bde5Sbellard } 5232f275b8fSbellard break; 5245ad6bb97Sblueswir1 case CMD_TI: 5252f275b8fSbellard handle_ti(s); 5262f275b8fSbellard break; 5275ad6bb97Sblueswir1 case CMD_ICCS: 528bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_iccs(val); 5290fc5c15aSpbrook write_response(s); 5304bf5801dSblueswir1 s->rregs[ESP_RINTR] = INTR_FC; 5314bf5801dSblueswir1 s->rregs[ESP_RSTAT] |= STAT_MI; 5322f275b8fSbellard break; 5335ad6bb97Sblueswir1 case CMD_MSGACC: 534bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_msgacc(val); 5355ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_DC; 5365ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = 0; 5374e2a68c1SArtyom Tarasenko s->rregs[ESP_RFLAGS] = 0; 5384e2a68c1SArtyom Tarasenko esp_raise_irq(s); 5396f7e9aecSbellard break; 5400fd0eb21SBlue Swirl case CMD_PAD: 541bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_pad(val); 5420fd0eb21SBlue Swirl s->rregs[ESP_RSTAT] = STAT_TC; 5430fd0eb21SBlue Swirl s->rregs[ESP_RINTR] = INTR_FC; 5440fd0eb21SBlue Swirl s->rregs[ESP_RSEQ] = 0; 5450fd0eb21SBlue Swirl break; 5465ad6bb97Sblueswir1 case CMD_SATN: 547bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_satn(val); 5486f7e9aecSbellard break; 5496915bff1SHervé Poussineau case CMD_RSTATN: 5506915bff1SHervé Poussineau trace_esp_mem_writeb_cmd_rstatn(val); 5516915bff1SHervé Poussineau break; 5525e1e0a3bSBlue Swirl case CMD_SEL: 553bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_sel(val); 554f2818f22SArtyom Tarasenko handle_s_without_atn(s); 5555e1e0a3bSBlue Swirl break; 5565ad6bb97Sblueswir1 case CMD_SELATN: 557bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_selatn(val); 5582f275b8fSbellard handle_satn(s); 5592f275b8fSbellard break; 5605ad6bb97Sblueswir1 case CMD_SELATNS: 561bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_selatns(val); 5629f149aa9Spbrook handle_satn_stop(s); 5632f275b8fSbellard break; 5645ad6bb97Sblueswir1 case CMD_ENSEL: 565bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_ensel(val); 566e3926838Sblueswir1 s->rregs[ESP_RINTR] = 0; 56774ec6048Sblueswir1 break; 5686fe84c18SHervé Poussineau case CMD_DISSEL: 5696fe84c18SHervé Poussineau trace_esp_mem_writeb_cmd_dissel(val); 5706fe84c18SHervé Poussineau s->rregs[ESP_RINTR] = 0; 5716fe84c18SHervé Poussineau esp_raise_irq(s); 5726fe84c18SHervé Poussineau break; 5732f275b8fSbellard default: 5743af4e9aaSHervé Poussineau trace_esp_error_unhandled_command(val); 5756f7e9aecSbellard break; 5766f7e9aecSbellard } 5776f7e9aecSbellard break; 5785ad6bb97Sblueswir1 case ESP_WBUSID ... ESP_WSYNO: 5794f6200f0Sbellard break; 5805ad6bb97Sblueswir1 case ESP_CFG1: 5819ea73f8bSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 5829ea73f8bSPaolo Bonzini case ESP_RES3: case ESP_RES4: 5834f6200f0Sbellard s->rregs[saddr] = val; 5844f6200f0Sbellard break; 5855ad6bb97Sblueswir1 case ESP_WCCF ... ESP_WTEST: 5864f6200f0Sbellard break; 5876f7e9aecSbellard default: 5883af4e9aaSHervé Poussineau trace_esp_error_invalid_write(val, saddr); 5898dea1dd4Sblueswir1 return; 5906f7e9aecSbellard } 5912f275b8fSbellard s->wregs[saddr] = val; 5926f7e9aecSbellard } 5936f7e9aecSbellard 594a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr, 5958372d383SPeter Maydell unsigned size, bool is_write, 5968372d383SPeter Maydell MemTxAttrs attrs) 59767bb5314SAvi Kivity { 59867bb5314SAvi Kivity return (size == 1) || (is_write && size == 4); 59967bb5314SAvi Kivity } 6006f7e9aecSbellard 6019c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = { 602cc9952f3SBlue Swirl .name ="esp", 603cc966774SPaolo Bonzini .version_id = 4, 604cc9952f3SBlue Swirl .minimum_version_id = 3, 605cc9952f3SBlue Swirl .fields = (VMStateField[]) { 606cc9952f3SBlue Swirl VMSTATE_BUFFER(rregs, ESPState), 607cc9952f3SBlue Swirl VMSTATE_BUFFER(wregs, ESPState), 608cc9952f3SBlue Swirl VMSTATE_INT32(ti_size, ESPState), 609cc9952f3SBlue Swirl VMSTATE_UINT32(ti_rptr, ESPState), 610cc9952f3SBlue Swirl VMSTATE_UINT32(ti_wptr, ESPState), 611cc9952f3SBlue Swirl VMSTATE_BUFFER(ti_buf, ESPState), 6123944966dSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 613ea84a442SGuenter Roeck VMSTATE_UINT32(deferred_status, ESPState), 614ea84a442SGuenter Roeck VMSTATE_BOOL(deferred_complete, ESPState), 615cc9952f3SBlue Swirl VMSTATE_UINT32(dma, ESPState), 616cc966774SPaolo Bonzini VMSTATE_PARTIAL_BUFFER(cmdbuf, ESPState, 16), 617cc966774SPaolo Bonzini VMSTATE_BUFFER_START_MIDDLE_V(cmdbuf, ESPState, 16, 4), 618cc9952f3SBlue Swirl VMSTATE_UINT32(cmdlen, ESPState), 619cc9952f3SBlue Swirl VMSTATE_UINT32(do_cmd, ESPState), 620cc9952f3SBlue Swirl VMSTATE_UINT32(dma_left, ESPState), 621cc9952f3SBlue Swirl VMSTATE_END_OF_LIST() 6226f7e9aecSbellard } 623cc9952f3SBlue Swirl }; 6246f7e9aecSbellard 625a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 626a391fdbcSHervé Poussineau uint64_t val, unsigned int size) 627a391fdbcSHervé Poussineau { 628a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 629a391fdbcSHervé Poussineau uint32_t saddr; 630a391fdbcSHervé Poussineau 631a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 632a391fdbcSHervé Poussineau esp_reg_write(&sysbus->esp, saddr, val); 633a391fdbcSHervé Poussineau } 634a391fdbcSHervé Poussineau 635a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 636a391fdbcSHervé Poussineau unsigned int size) 637a391fdbcSHervé Poussineau { 638a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 639a391fdbcSHervé Poussineau uint32_t saddr; 640a391fdbcSHervé Poussineau 641a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 642a391fdbcSHervé Poussineau return esp_reg_read(&sysbus->esp, saddr); 643a391fdbcSHervé Poussineau } 644a391fdbcSHervé Poussineau 645a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = { 646a391fdbcSHervé Poussineau .read = sysbus_esp_mem_read, 647a391fdbcSHervé Poussineau .write = sysbus_esp_mem_write, 648a391fdbcSHervé Poussineau .endianness = DEVICE_NATIVE_ENDIAN, 649a391fdbcSHervé Poussineau .valid.accepts = esp_mem_accepts, 650a391fdbcSHervé Poussineau }; 651a391fdbcSHervé Poussineau 652afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 653afd4030cSPaolo Bonzini .tcq = false, 6547e0380b9SPaolo Bonzini .max_target = ESP_MAX_DEVS, 6557e0380b9SPaolo Bonzini .max_lun = 7, 656afd4030cSPaolo Bonzini 657c6df7102SPaolo Bonzini .transfer_data = esp_transfer_data, 65894d3f98aSPaolo Bonzini .complete = esp_command_complete, 65994d3f98aSPaolo Bonzini .cancel = esp_request_cancelled 660cfdc1bb0SPaolo Bonzini }; 661cfdc1bb0SPaolo Bonzini 662a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 663cfb9de9cSPaul Brook { 66480cac47eSKamil Rytarowski SysBusESPState *sysbus = ESP_STATE(opaque); 665a391fdbcSHervé Poussineau ESPState *s = &sysbus->esp; 666a391fdbcSHervé Poussineau 667a391fdbcSHervé Poussineau switch (irq) { 668a391fdbcSHervé Poussineau case 0: 669a391fdbcSHervé Poussineau parent_esp_reset(s, irq, level); 670a391fdbcSHervé Poussineau break; 671a391fdbcSHervé Poussineau case 1: 672a391fdbcSHervé Poussineau esp_dma_enable(opaque, irq, level); 673a391fdbcSHervé Poussineau break; 674a391fdbcSHervé Poussineau } 675a391fdbcSHervé Poussineau } 676a391fdbcSHervé Poussineau 677b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 678a391fdbcSHervé Poussineau { 679b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 68080cac47eSKamil Rytarowski SysBusESPState *sysbus = ESP_STATE(dev); 681a391fdbcSHervé Poussineau ESPState *s = &sysbus->esp; 6826f7e9aecSbellard 683b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 684a391fdbcSHervé Poussineau assert(sysbus->it_shift != -1); 6856f7e9aecSbellard 686d32e4b3dSHervé Poussineau s->chip_id = TCHI_FAS100A; 68729776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 68829776739SPaolo Bonzini sysbus, "esp", ESP_REGS << sysbus->it_shift); 689b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 6906f7e9aecSbellard 691b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 6922d069babSblueswir1 693b1187b51SAndreas Färber scsi_bus_new(&s->bus, sizeof(s->bus), dev, &esp_scsi_info, NULL); 69467e999beSbellard } 695cfb9de9cSPaul Brook 696a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev) 697a391fdbcSHervé Poussineau { 69880cac47eSKamil Rytarowski SysBusESPState *sysbus = ESP_STATE(dev); 699a391fdbcSHervé Poussineau esp_hard_reset(&sysbus->esp); 700a391fdbcSHervé Poussineau } 701a391fdbcSHervé Poussineau 702a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = { 703a391fdbcSHervé Poussineau .name = "sysbusespscsi", 704ea84a442SGuenter Roeck .version_id = 1, 705ea84a442SGuenter Roeck .minimum_version_id = 1, 706a391fdbcSHervé Poussineau .fields = (VMStateField[]) { 707a391fdbcSHervé Poussineau VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 708a391fdbcSHervé Poussineau VMSTATE_END_OF_LIST() 709a391fdbcSHervé Poussineau } 710999e12bbSAnthony Liguori }; 711999e12bbSAnthony Liguori 712a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data) 713999e12bbSAnthony Liguori { 71439bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 715999e12bbSAnthony Liguori 716b09318caSHu Tao dc->realize = sysbus_esp_realize; 717a391fdbcSHervé Poussineau dc->reset = sysbus_esp_hard_reset; 718a391fdbcSHervé Poussineau dc->vmsd = &vmstate_sysbus_esp_scsi; 719125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 72063235df8SBlue Swirl } 721999e12bbSAnthony Liguori 7221f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = { 723a71c7ec5SHu Tao .name = TYPE_ESP, 72439bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 725a391fdbcSHervé Poussineau .instance_size = sizeof(SysBusESPState), 726a391fdbcSHervé Poussineau .class_init = sysbus_esp_class_init, 72763235df8SBlue Swirl }; 72863235df8SBlue Swirl 72983f7d43aSAndreas Färber static void esp_register_types(void) 730cfb9de9cSPaul Brook { 731a391fdbcSHervé Poussineau type_register_static(&sysbus_esp_info); 732cfb9de9cSPaul Brook } 733cfb9de9cSPaul Brook 73483f7d43aSAndreas Färber type_init(esp_register_types) 735