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" 280d09e41aSPaolo Bonzini #include "hw/scsi/esp.h" 29bf4b9889SBlue Swirl #include "trace.h" 30da34e65cSMarkus Armbruster #include "qapi/error.h" 311de7afc9SPaolo Bonzini #include "qemu/log.h" 326f7e9aecSbellard 3367e999beSbellard /* 345ad6bb97Sblueswir1 * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O), 355ad6bb97Sblueswir1 * also produced as NCR89C100. See 3667e999beSbellard * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt 3767e999beSbellard * and 3867e999beSbellard * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt 3967e999beSbellard */ 4067e999beSbellard 41c73f96fdSblueswir1 static void esp_raise_irq(ESPState *s) 42c73f96fdSblueswir1 { 43c73f96fdSblueswir1 if (!(s->rregs[ESP_RSTAT] & STAT_INT)) { 44c73f96fdSblueswir1 s->rregs[ESP_RSTAT] |= STAT_INT; 45c73f96fdSblueswir1 qemu_irq_raise(s->irq); 46bf4b9889SBlue Swirl trace_esp_raise_irq(); 47c73f96fdSblueswir1 } 48c73f96fdSblueswir1 } 49c73f96fdSblueswir1 50c73f96fdSblueswir1 static void esp_lower_irq(ESPState *s) 51c73f96fdSblueswir1 { 52c73f96fdSblueswir1 if (s->rregs[ESP_RSTAT] & STAT_INT) { 53c73f96fdSblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_INT; 54c73f96fdSblueswir1 qemu_irq_lower(s->irq); 55bf4b9889SBlue Swirl trace_esp_lower_irq(); 56c73f96fdSblueswir1 } 57c73f96fdSblueswir1 } 58c73f96fdSblueswir1 599c7e23fcSHervé Poussineau void esp_dma_enable(ESPState *s, int irq, int level) 6073d74342SBlue Swirl { 6173d74342SBlue Swirl if (level) { 6273d74342SBlue Swirl s->dma_enabled = 1; 63bf4b9889SBlue Swirl trace_esp_dma_enable(); 6473d74342SBlue Swirl if (s->dma_cb) { 6573d74342SBlue Swirl s->dma_cb(s); 6673d74342SBlue Swirl s->dma_cb = NULL; 6773d74342SBlue Swirl } 6873d74342SBlue Swirl } else { 69bf4b9889SBlue Swirl trace_esp_dma_disable(); 7073d74342SBlue Swirl s->dma_enabled = 0; 7173d74342SBlue Swirl } 7273d74342SBlue Swirl } 7373d74342SBlue Swirl 749c7e23fcSHervé Poussineau void esp_request_cancelled(SCSIRequest *req) 7594d3f98aSPaolo Bonzini { 76e6810db8SHervé Poussineau ESPState *s = req->hba_private; 7794d3f98aSPaolo Bonzini 7894d3f98aSPaolo Bonzini if (req == s->current_req) { 7994d3f98aSPaolo Bonzini scsi_req_unref(s->current_req); 8094d3f98aSPaolo Bonzini s->current_req = NULL; 8194d3f98aSPaolo Bonzini s->current_dev = NULL; 8294d3f98aSPaolo Bonzini } 8394d3f98aSPaolo Bonzini } 8494d3f98aSPaolo Bonzini 856c1fef6bSPrasad J Pandit static uint32_t get_cmd(ESPState *s, uint8_t *buf, uint8_t buflen) 862f275b8fSbellard { 87a917d384Spbrook uint32_t dmalen; 882f275b8fSbellard int target; 892f275b8fSbellard 908dea1dd4Sblueswir1 target = s->wregs[ESP_WBUSID] & BUSID_DID; 914f6200f0Sbellard if (s->dma) { 929ea73f8bSPaolo Bonzini dmalen = s->rregs[ESP_TCLO]; 939ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCMID] << 8; 949ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCHI] << 16; 956c1fef6bSPrasad J Pandit if (dmalen > buflen) { 966c1fef6bSPrasad J Pandit return 0; 976c1fef6bSPrasad J Pandit } 988b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, buf, dmalen); 994f6200f0Sbellard } else { 100fc4d65daSblueswir1 dmalen = s->ti_size; 101d3cdc491SPrasad J Pandit if (dmalen > TI_BUFSZ) { 102d3cdc491SPrasad J Pandit return 0; 103d3cdc491SPrasad J Pandit } 104fc4d65daSblueswir1 memcpy(buf, s->ti_buf, dmalen); 10575ef8496SHervé Poussineau buf[0] = buf[2] >> 5; 1064f6200f0Sbellard } 107bf4b9889SBlue Swirl trace_esp_get_cmd(dmalen, target); 1082e5d83bbSpbrook 1092f275b8fSbellard s->ti_size = 0; 1104f6200f0Sbellard s->ti_rptr = 0; 1114f6200f0Sbellard s->ti_wptr = 0; 1122f275b8fSbellard 113429bef69SHervé Poussineau if (s->current_req) { 114a917d384Spbrook /* Started a new command before the old one finished. Cancel it. */ 11594d3f98aSPaolo Bonzini scsi_req_cancel(s->current_req); 116a917d384Spbrook s->async_len = 0; 117a917d384Spbrook } 118a917d384Spbrook 1190d3545e7SPaolo Bonzini s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 120f48a7a6eSPaolo Bonzini if (!s->current_dev) { 1212e5d83bbSpbrook // No such drive 122c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = 0; 1235ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_DC; 1245ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_0; 125c73f96fdSblueswir1 esp_raise_irq(s); 1269f149aa9Spbrook return 0; 1272f275b8fSbellard } 1289f149aa9Spbrook return dmalen; 1299f149aa9Spbrook } 1309f149aa9Spbrook 131f2818f22SArtyom Tarasenko static void do_busid_cmd(ESPState *s, uint8_t *buf, uint8_t busid) 1329f149aa9Spbrook { 1339f149aa9Spbrook int32_t datalen; 1349f149aa9Spbrook int lun; 135f48a7a6eSPaolo Bonzini SCSIDevice *current_lun; 1369f149aa9Spbrook 137bf4b9889SBlue Swirl trace_esp_do_busid_cmd(busid); 138f2818f22SArtyom Tarasenko lun = busid & 7; 1390d3545e7SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, lun); 140e6810db8SHervé Poussineau s->current_req = scsi_req_new(current_lun, 0, lun, buf, s); 141c39ce112SPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 14267e999beSbellard s->ti_size = datalen; 14367e999beSbellard if (datalen != 0) { 144c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = STAT_TC; 145a917d384Spbrook s->dma_left = 0; 1466787f5faSpbrook s->dma_counter = 0; 1472e5d83bbSpbrook if (datalen > 0) { 1485ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] |= STAT_DI; 1494f6200f0Sbellard } else { 1505ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] |= STAT_DO; 1514f6200f0Sbellard } 152ad3376ccSPaolo Bonzini scsi_req_continue(s->current_req); 1534e9aec74Spbrook } 1545ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS | INTR_FC; 1555ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 156c73f96fdSblueswir1 esp_raise_irq(s); 1572f275b8fSbellard } 1582f275b8fSbellard 159f2818f22SArtyom Tarasenko static void do_cmd(ESPState *s, uint8_t *buf) 160f2818f22SArtyom Tarasenko { 161f2818f22SArtyom Tarasenko uint8_t busid = buf[0]; 162f2818f22SArtyom Tarasenko 163f2818f22SArtyom Tarasenko do_busid_cmd(s, &buf[1], busid); 164f2818f22SArtyom Tarasenko } 165f2818f22SArtyom Tarasenko 1669f149aa9Spbrook static void handle_satn(ESPState *s) 1679f149aa9Spbrook { 1689f149aa9Spbrook uint8_t buf[32]; 1699f149aa9Spbrook int len; 1709f149aa9Spbrook 1711b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 17273d74342SBlue Swirl s->dma_cb = handle_satn; 17373d74342SBlue Swirl return; 17473d74342SBlue Swirl } 1756c1fef6bSPrasad J Pandit len = get_cmd(s, buf, sizeof(buf)); 1769f149aa9Spbrook if (len) 1779f149aa9Spbrook do_cmd(s, buf); 1789f149aa9Spbrook } 1799f149aa9Spbrook 180f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s) 181f2818f22SArtyom Tarasenko { 182f2818f22SArtyom Tarasenko uint8_t buf[32]; 183f2818f22SArtyom Tarasenko int len; 184f2818f22SArtyom Tarasenko 1851b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 18673d74342SBlue Swirl s->dma_cb = handle_s_without_atn; 18773d74342SBlue Swirl return; 18873d74342SBlue Swirl } 1896c1fef6bSPrasad J Pandit len = get_cmd(s, buf, sizeof(buf)); 190f2818f22SArtyom Tarasenko if (len) { 191f2818f22SArtyom Tarasenko do_busid_cmd(s, buf, 0); 192f2818f22SArtyom Tarasenko } 193f2818f22SArtyom Tarasenko } 194f2818f22SArtyom Tarasenko 1959f149aa9Spbrook static void handle_satn_stop(ESPState *s) 1969f149aa9Spbrook { 1971b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 19873d74342SBlue Swirl s->dma_cb = handle_satn_stop; 19973d74342SBlue Swirl return; 20073d74342SBlue Swirl } 2016c1fef6bSPrasad J Pandit s->cmdlen = get_cmd(s, s->cmdbuf, sizeof(s->cmdbuf)); 2029f149aa9Spbrook if (s->cmdlen) { 203bf4b9889SBlue Swirl trace_esp_handle_satn_stop(s->cmdlen); 2049f149aa9Spbrook s->do_cmd = 1; 205c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 2065ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS | INTR_FC; 2075ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 208c73f96fdSblueswir1 esp_raise_irq(s); 2099f149aa9Spbrook } 2109f149aa9Spbrook } 2119f149aa9Spbrook 2120fc5c15aSpbrook static void write_response(ESPState *s) 2132f275b8fSbellard { 214bf4b9889SBlue Swirl trace_esp_write_response(s->status); 2153944966dSPaolo Bonzini s->ti_buf[0] = s->status; 2160fc5c15aSpbrook s->ti_buf[1] = 0; 2174f6200f0Sbellard if (s->dma) { 2188b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->ti_buf, 2); 219c73f96fdSblueswir1 s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 2205ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS | INTR_FC; 2215ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 2224f6200f0Sbellard } else { 2230fc5c15aSpbrook s->ti_size = 2; 2244f6200f0Sbellard s->ti_rptr = 0; 225d020aa50SPaolo Bonzini s->ti_wptr = 2; 2265ad6bb97Sblueswir1 s->rregs[ESP_RFLAGS] = 2; 2274f6200f0Sbellard } 228c73f96fdSblueswir1 esp_raise_irq(s); 2292f275b8fSbellard } 2304f6200f0Sbellard 231a917d384Spbrook static void esp_dma_done(ESPState *s) 2324d611c9aSpbrook { 233c73f96fdSblueswir1 s->rregs[ESP_RSTAT] |= STAT_TC; 2345ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_BS; 2355ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = 0; 2365ad6bb97Sblueswir1 s->rregs[ESP_RFLAGS] = 0; 2375ad6bb97Sblueswir1 s->rregs[ESP_TCLO] = 0; 2385ad6bb97Sblueswir1 s->rregs[ESP_TCMID] = 0; 2399ea73f8bSPaolo Bonzini s->rregs[ESP_TCHI] = 0; 240c73f96fdSblueswir1 esp_raise_irq(s); 2414d611c9aSpbrook } 242a917d384Spbrook 243a917d384Spbrook static void esp_do_dma(ESPState *s) 244a917d384Spbrook { 24567e999beSbellard uint32_t len; 246a917d384Spbrook int to_device; 247a917d384Spbrook 248a917d384Spbrook len = s->dma_left; 249a917d384Spbrook if (s->do_cmd) { 250bf4b9889SBlue Swirl trace_esp_do_dma(s->cmdlen, len); 251*926cde5fSPrasad J Pandit assert (s->cmdlen <= sizeof(s->cmdbuf) && 252*926cde5fSPrasad J Pandit len <= sizeof(s->cmdbuf) - s->cmdlen); 2538b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, &s->cmdbuf[s->cmdlen], len); 254a917d384Spbrook return; 255a917d384Spbrook } 256a917d384Spbrook if (s->async_len == 0) { 257a917d384Spbrook /* Defer until data is available. */ 258a917d384Spbrook return; 259a917d384Spbrook } 260a917d384Spbrook if (len > s->async_len) { 261a917d384Spbrook len = s->async_len; 262a917d384Spbrook } 2637f0b6e11SPaolo Bonzini to_device = (s->ti_size < 0); 264a917d384Spbrook if (to_device) { 2658b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, s->async_buf, len); 266a917d384Spbrook } else { 2678b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->async_buf, len); 268a917d384Spbrook } 269a917d384Spbrook s->dma_left -= len; 270a917d384Spbrook s->async_buf += len; 271a917d384Spbrook s->async_len -= len; 2726787f5faSpbrook if (to_device) 2736787f5faSpbrook s->ti_size += len; 2746787f5faSpbrook else 2756787f5faSpbrook s->ti_size -= len; 276a917d384Spbrook if (s->async_len == 0) { 277ad3376ccSPaolo Bonzini scsi_req_continue(s->current_req); 2786787f5faSpbrook /* If there is still data to be read from the device then 2798dea1dd4Sblueswir1 complete the DMA operation immediately. Otherwise defer 2806787f5faSpbrook until the scsi layer has completed. */ 281ad3376ccSPaolo Bonzini if (to_device || s->dma_left != 0 || s->ti_size == 0) { 282ad3376ccSPaolo Bonzini return; 283a917d384Spbrook } 284a917d384Spbrook } 285ad3376ccSPaolo Bonzini 2866787f5faSpbrook /* Partially filled a scsi buffer. Complete immediately. */ 287a917d384Spbrook esp_dma_done(s); 288a917d384Spbrook } 289a917d384Spbrook 2909c7e23fcSHervé Poussineau void esp_command_complete(SCSIRequest *req, uint32_t status, 29101e95455SPaolo Bonzini size_t resid) 292a917d384Spbrook { 293e6810db8SHervé Poussineau ESPState *s = req->hba_private; 294a917d384Spbrook 295bf4b9889SBlue Swirl trace_esp_command_complete(); 296c6df7102SPaolo Bonzini if (s->ti_size != 0) { 297bf4b9889SBlue Swirl trace_esp_command_complete_unexpected(); 298c6df7102SPaolo Bonzini } 299a917d384Spbrook s->ti_size = 0; 300a917d384Spbrook s->dma_left = 0; 301a917d384Spbrook s->async_len = 0; 302aba1f023SPaolo Bonzini if (status) { 303bf4b9889SBlue Swirl trace_esp_command_complete_fail(); 304c6df7102SPaolo Bonzini } 305aba1f023SPaolo Bonzini s->status = status; 3065ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] = STAT_ST; 307a917d384Spbrook esp_dma_done(s); 3085c6c0e51SHannes Reinecke if (s->current_req) { 3095c6c0e51SHannes Reinecke scsi_req_unref(s->current_req); 3105c6c0e51SHannes Reinecke s->current_req = NULL; 311a917d384Spbrook s->current_dev = NULL; 3125c6c0e51SHannes Reinecke } 313c6df7102SPaolo Bonzini } 314c6df7102SPaolo Bonzini 3159c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len) 316c6df7102SPaolo Bonzini { 317e6810db8SHervé Poussineau ESPState *s = req->hba_private; 318c6df7102SPaolo Bonzini 3197f0b6e11SPaolo Bonzini assert(!s->do_cmd); 320bf4b9889SBlue Swirl trace_esp_transfer_data(s->dma_left, s->ti_size); 321aba1f023SPaolo Bonzini s->async_len = len; 3220c34459bSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 3236787f5faSpbrook if (s->dma_left) { 324a917d384Spbrook esp_do_dma(s); 3256787f5faSpbrook } else if (s->dma_counter != 0 && s->ti_size <= 0) { 3266787f5faSpbrook /* If this was the last part of a DMA transfer then the 3276787f5faSpbrook completion interrupt is deferred to here. */ 3286787f5faSpbrook esp_dma_done(s); 3296787f5faSpbrook } 330a917d384Spbrook } 3312e5d83bbSpbrook 3322f275b8fSbellard static void handle_ti(ESPState *s) 3332f275b8fSbellard { 3344d611c9aSpbrook uint32_t dmalen, minlen; 3352f275b8fSbellard 3367246e160SHervé Poussineau if (s->dma && !s->dma_enabled) { 3377246e160SHervé Poussineau s->dma_cb = handle_ti; 3387246e160SHervé Poussineau return; 3397246e160SHervé Poussineau } 3407246e160SHervé Poussineau 3419ea73f8bSPaolo Bonzini dmalen = s->rregs[ESP_TCLO]; 3429ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCMID] << 8; 3439ea73f8bSPaolo Bonzini dmalen |= s->rregs[ESP_TCHI] << 16; 344db59203dSpbrook if (dmalen==0) { 345db59203dSpbrook dmalen=0x10000; 346db59203dSpbrook } 3476787f5faSpbrook s->dma_counter = dmalen; 348db59203dSpbrook 3499f149aa9Spbrook if (s->do_cmd) 350*926cde5fSPrasad J Pandit minlen = (dmalen < ESP_CMDBUF_SZ) ? dmalen : ESP_CMDBUF_SZ; 35167e999beSbellard else if (s->ti_size < 0) 35267e999beSbellard minlen = (dmalen < -s->ti_size) ? dmalen : -s->ti_size; 3539f149aa9Spbrook else 354db59203dSpbrook minlen = (dmalen < s->ti_size) ? dmalen : s->ti_size; 355bf4b9889SBlue Swirl trace_esp_handle_ti(minlen); 3564f6200f0Sbellard if (s->dma) { 3574d611c9aSpbrook s->dma_left = minlen; 3585ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 3594d611c9aSpbrook esp_do_dma(s); 3607f0b6e11SPaolo Bonzini } 3617f0b6e11SPaolo Bonzini if (s->do_cmd) { 362bf4b9889SBlue Swirl trace_esp_handle_ti_cmd(s->cmdlen); 3639f149aa9Spbrook s->ti_size = 0; 3649f149aa9Spbrook s->cmdlen = 0; 3659f149aa9Spbrook s->do_cmd = 0; 3669f149aa9Spbrook do_cmd(s, s->cmdbuf); 3674f6200f0Sbellard } 3682f275b8fSbellard } 3692f275b8fSbellard 3709c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s) 3716f7e9aecSbellard { 3725aca8c3bSblueswir1 memset(s->rregs, 0, ESP_REGS); 3735aca8c3bSblueswir1 memset(s->wregs, 0, ESP_REGS); 374c9cf45c1SHannes Reinecke s->tchi_written = 0; 3754e9aec74Spbrook s->ti_size = 0; 3764e9aec74Spbrook s->ti_rptr = 0; 3774e9aec74Spbrook s->ti_wptr = 0; 3784e9aec74Spbrook s->dma = 0; 3799f149aa9Spbrook s->do_cmd = 0; 38073d74342SBlue Swirl s->dma_cb = NULL; 3818dea1dd4Sblueswir1 3828dea1dd4Sblueswir1 s->rregs[ESP_CFG1] = 7; 3836f7e9aecSbellard } 3846f7e9aecSbellard 385a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s) 38685948643SBlue Swirl { 38785948643SBlue Swirl qemu_irq_lower(s->irq); 388a391fdbcSHervé Poussineau esp_hard_reset(s); 38985948643SBlue Swirl } 39085948643SBlue Swirl 391a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level) 3922d069babSblueswir1 { 39385948643SBlue Swirl if (level) { 394a391fdbcSHervé Poussineau esp_soft_reset(s); 39585948643SBlue Swirl } 3962d069babSblueswir1 } 3972d069babSblueswir1 3989c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 39973d74342SBlue Swirl { 400a391fdbcSHervé Poussineau uint32_t old_val; 40173d74342SBlue Swirl 402bf4b9889SBlue Swirl trace_esp_mem_readb(saddr, s->rregs[saddr]); 4036f7e9aecSbellard switch (saddr) { 4045ad6bb97Sblueswir1 case ESP_FIFO: 4055ad6bb97Sblueswir1 if ((s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 4068dea1dd4Sblueswir1 /* Data out. */ 407ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 4085ad6bb97Sblueswir1 s->rregs[ESP_FIFO] = 0; 409ff589551SPrasad J Pandit esp_raise_irq(s); 410ff589551SPrasad J Pandit } else if (s->ti_rptr < s->ti_wptr) { 411ff589551SPrasad J Pandit s->ti_size--; 4125ad6bb97Sblueswir1 s->rregs[ESP_FIFO] = s->ti_buf[s->ti_rptr++]; 413c73f96fdSblueswir1 esp_raise_irq(s); 4144f6200f0Sbellard } 415ff589551SPrasad J Pandit if (s->ti_rptr == s->ti_wptr) { 4164f6200f0Sbellard s->ti_rptr = 0; 4174f6200f0Sbellard s->ti_wptr = 0; 4184f6200f0Sbellard } 4194f6200f0Sbellard break; 4205ad6bb97Sblueswir1 case ESP_RINTR: 4212814df28SBlue Swirl /* Clear sequence step, interrupt register and all status bits 4222814df28SBlue Swirl except TC */ 4232814df28SBlue Swirl old_val = s->rregs[ESP_RINTR]; 4242814df28SBlue Swirl s->rregs[ESP_RINTR] = 0; 4252814df28SBlue Swirl s->rregs[ESP_RSTAT] &= ~STAT_TC; 4262814df28SBlue Swirl s->rregs[ESP_RSEQ] = SEQ_CD; 427c73f96fdSblueswir1 esp_lower_irq(s); 4282814df28SBlue Swirl 4292814df28SBlue Swirl return old_val; 430c9cf45c1SHannes Reinecke case ESP_TCHI: 431c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 432c9cf45c1SHannes Reinecke if (!s->tchi_written) { 433c9cf45c1SHannes Reinecke return s->chip_id; 434c9cf45c1SHannes Reinecke } 4356f7e9aecSbellard default: 4366f7e9aecSbellard break; 4376f7e9aecSbellard } 4382f275b8fSbellard return s->rregs[saddr]; 4396f7e9aecSbellard } 4406f7e9aecSbellard 4419c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 4426f7e9aecSbellard { 443bf4b9889SBlue Swirl trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 4446f7e9aecSbellard switch (saddr) { 445c9cf45c1SHannes Reinecke case ESP_TCHI: 446c9cf45c1SHannes Reinecke s->tchi_written = true; 447c9cf45c1SHannes Reinecke /* fall through */ 4485ad6bb97Sblueswir1 case ESP_TCLO: 4495ad6bb97Sblueswir1 case ESP_TCMID: 4505ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 4514f6200f0Sbellard break; 4525ad6bb97Sblueswir1 case ESP_FIFO: 4539f149aa9Spbrook if (s->do_cmd) { 454*926cde5fSPrasad J Pandit if (s->cmdlen < ESP_CMDBUF_SZ) { 4559f149aa9Spbrook s->cmdbuf[s->cmdlen++] = val & 0xff; 456c98c6c10SPrasad J Pandit } else { 457c98c6c10SPrasad J Pandit trace_esp_error_fifo_overrun(); 458c98c6c10SPrasad J Pandit } 459ff589551SPrasad J Pandit } else if (s->ti_wptr == TI_BUFSZ - 1) { 4603af4e9aaSHervé Poussineau trace_esp_error_fifo_overrun(); 4612e5d83bbSpbrook } else { 4624f6200f0Sbellard s->ti_size++; 4634f6200f0Sbellard s->ti_buf[s->ti_wptr++] = val & 0xff; 4642e5d83bbSpbrook } 4654f6200f0Sbellard break; 4665ad6bb97Sblueswir1 case ESP_CMD: 4674f6200f0Sbellard s->rregs[saddr] = val; 4685ad6bb97Sblueswir1 if (val & CMD_DMA) { 4694f6200f0Sbellard s->dma = 1; 4706787f5faSpbrook /* Reload DMA counter. */ 4715ad6bb97Sblueswir1 s->rregs[ESP_TCLO] = s->wregs[ESP_TCLO]; 4725ad6bb97Sblueswir1 s->rregs[ESP_TCMID] = s->wregs[ESP_TCMID]; 4739ea73f8bSPaolo Bonzini s->rregs[ESP_TCHI] = s->wregs[ESP_TCHI]; 4744f6200f0Sbellard } else { 4754f6200f0Sbellard s->dma = 0; 4764f6200f0Sbellard } 4775ad6bb97Sblueswir1 switch(val & CMD_CMD) { 4785ad6bb97Sblueswir1 case CMD_NOP: 479bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_nop(val); 4802f275b8fSbellard break; 4815ad6bb97Sblueswir1 case CMD_FLUSH: 482bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_flush(val); 4839e61bde5Sbellard //s->ti_size = 0; 4845ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_FC; 4855ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = 0; 486a214c598Sblueswir1 s->rregs[ESP_RFLAGS] = 0; 4876f7e9aecSbellard break; 4885ad6bb97Sblueswir1 case CMD_RESET: 489bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_reset(val); 490a391fdbcSHervé Poussineau esp_soft_reset(s); 4916f7e9aecSbellard break; 4925ad6bb97Sblueswir1 case CMD_BUSRESET: 493bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_bus_reset(val); 4945ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_RST; 4955ad6bb97Sblueswir1 if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 496c73f96fdSblueswir1 esp_raise_irq(s); 4979e61bde5Sbellard } 4982f275b8fSbellard break; 4995ad6bb97Sblueswir1 case CMD_TI: 5002f275b8fSbellard handle_ti(s); 5012f275b8fSbellard break; 5025ad6bb97Sblueswir1 case CMD_ICCS: 503bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_iccs(val); 5040fc5c15aSpbrook write_response(s); 5054bf5801dSblueswir1 s->rregs[ESP_RINTR] = INTR_FC; 5064bf5801dSblueswir1 s->rregs[ESP_RSTAT] |= STAT_MI; 5072f275b8fSbellard break; 5085ad6bb97Sblueswir1 case CMD_MSGACC: 509bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_msgacc(val); 5105ad6bb97Sblueswir1 s->rregs[ESP_RINTR] = INTR_DC; 5115ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = 0; 5124e2a68c1SArtyom Tarasenko s->rregs[ESP_RFLAGS] = 0; 5134e2a68c1SArtyom Tarasenko esp_raise_irq(s); 5146f7e9aecSbellard break; 5150fd0eb21SBlue Swirl case CMD_PAD: 516bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_pad(val); 5170fd0eb21SBlue Swirl s->rregs[ESP_RSTAT] = STAT_TC; 5180fd0eb21SBlue Swirl s->rregs[ESP_RINTR] = INTR_FC; 5190fd0eb21SBlue Swirl s->rregs[ESP_RSEQ] = 0; 5200fd0eb21SBlue Swirl break; 5215ad6bb97Sblueswir1 case CMD_SATN: 522bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_satn(val); 5236f7e9aecSbellard break; 5246915bff1SHervé Poussineau case CMD_RSTATN: 5256915bff1SHervé Poussineau trace_esp_mem_writeb_cmd_rstatn(val); 5266915bff1SHervé Poussineau break; 5275e1e0a3bSBlue Swirl case CMD_SEL: 528bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_sel(val); 529f2818f22SArtyom Tarasenko handle_s_without_atn(s); 5305e1e0a3bSBlue Swirl break; 5315ad6bb97Sblueswir1 case CMD_SELATN: 532bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_selatn(val); 5332f275b8fSbellard handle_satn(s); 5342f275b8fSbellard break; 5355ad6bb97Sblueswir1 case CMD_SELATNS: 536bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_selatns(val); 5379f149aa9Spbrook handle_satn_stop(s); 5382f275b8fSbellard break; 5395ad6bb97Sblueswir1 case CMD_ENSEL: 540bf4b9889SBlue Swirl trace_esp_mem_writeb_cmd_ensel(val); 541e3926838Sblueswir1 s->rregs[ESP_RINTR] = 0; 54274ec6048Sblueswir1 break; 5436fe84c18SHervé Poussineau case CMD_DISSEL: 5446fe84c18SHervé Poussineau trace_esp_mem_writeb_cmd_dissel(val); 5456fe84c18SHervé Poussineau s->rregs[ESP_RINTR] = 0; 5466fe84c18SHervé Poussineau esp_raise_irq(s); 5476fe84c18SHervé Poussineau break; 5482f275b8fSbellard default: 5493af4e9aaSHervé Poussineau trace_esp_error_unhandled_command(val); 5506f7e9aecSbellard break; 5516f7e9aecSbellard } 5526f7e9aecSbellard break; 5535ad6bb97Sblueswir1 case ESP_WBUSID ... ESP_WSYNO: 5544f6200f0Sbellard break; 5555ad6bb97Sblueswir1 case ESP_CFG1: 5569ea73f8bSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 5579ea73f8bSPaolo Bonzini case ESP_RES3: case ESP_RES4: 5584f6200f0Sbellard s->rregs[saddr] = val; 5594f6200f0Sbellard break; 5605ad6bb97Sblueswir1 case ESP_WCCF ... ESP_WTEST: 5614f6200f0Sbellard break; 5626f7e9aecSbellard default: 5633af4e9aaSHervé Poussineau trace_esp_error_invalid_write(val, saddr); 5648dea1dd4Sblueswir1 return; 5656f7e9aecSbellard } 5662f275b8fSbellard s->wregs[saddr] = val; 5676f7e9aecSbellard } 5686f7e9aecSbellard 569a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr, 57067bb5314SAvi Kivity unsigned size, bool is_write) 57167bb5314SAvi Kivity { 57267bb5314SAvi Kivity return (size == 1) || (is_write && size == 4); 57367bb5314SAvi Kivity } 5746f7e9aecSbellard 5759c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = { 576cc9952f3SBlue Swirl .name ="esp", 577cc9952f3SBlue Swirl .version_id = 3, 578cc9952f3SBlue Swirl .minimum_version_id = 3, 579cc9952f3SBlue Swirl .fields = (VMStateField[]) { 580cc9952f3SBlue Swirl VMSTATE_BUFFER(rregs, ESPState), 581cc9952f3SBlue Swirl VMSTATE_BUFFER(wregs, ESPState), 582cc9952f3SBlue Swirl VMSTATE_INT32(ti_size, ESPState), 583cc9952f3SBlue Swirl VMSTATE_UINT32(ti_rptr, ESPState), 584cc9952f3SBlue Swirl VMSTATE_UINT32(ti_wptr, ESPState), 585cc9952f3SBlue Swirl VMSTATE_BUFFER(ti_buf, ESPState), 5863944966dSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 587cc9952f3SBlue Swirl VMSTATE_UINT32(dma, ESPState), 588cc9952f3SBlue Swirl VMSTATE_BUFFER(cmdbuf, ESPState), 589cc9952f3SBlue Swirl VMSTATE_UINT32(cmdlen, ESPState), 590cc9952f3SBlue Swirl VMSTATE_UINT32(do_cmd, ESPState), 591cc9952f3SBlue Swirl VMSTATE_UINT32(dma_left, ESPState), 592cc9952f3SBlue Swirl VMSTATE_END_OF_LIST() 5936f7e9aecSbellard } 594cc9952f3SBlue Swirl }; 5956f7e9aecSbellard 596a71c7ec5SHu Tao #define TYPE_ESP "esp" 597a71c7ec5SHu Tao #define ESP(obj) OBJECT_CHECK(SysBusESPState, (obj), TYPE_ESP) 598a71c7ec5SHu Tao 599a391fdbcSHervé Poussineau typedef struct { 600a71c7ec5SHu Tao /*< private >*/ 601a71c7ec5SHu Tao SysBusDevice parent_obj; 602a71c7ec5SHu Tao /*< public >*/ 603a71c7ec5SHu Tao 604a391fdbcSHervé Poussineau MemoryRegion iomem; 605a391fdbcSHervé Poussineau uint32_t it_shift; 606a391fdbcSHervé Poussineau ESPState esp; 607a391fdbcSHervé Poussineau } SysBusESPState; 608a391fdbcSHervé Poussineau 609a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 610a391fdbcSHervé Poussineau uint64_t val, unsigned int size) 611a391fdbcSHervé Poussineau { 612a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 613a391fdbcSHervé Poussineau uint32_t saddr; 614a391fdbcSHervé Poussineau 615a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 616a391fdbcSHervé Poussineau esp_reg_write(&sysbus->esp, saddr, val); 617a391fdbcSHervé Poussineau } 618a391fdbcSHervé Poussineau 619a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 620a391fdbcSHervé Poussineau unsigned int size) 621a391fdbcSHervé Poussineau { 622a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 623a391fdbcSHervé Poussineau uint32_t saddr; 624a391fdbcSHervé Poussineau 625a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 626a391fdbcSHervé Poussineau return esp_reg_read(&sysbus->esp, saddr); 627a391fdbcSHervé Poussineau } 628a391fdbcSHervé Poussineau 629a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = { 630a391fdbcSHervé Poussineau .read = sysbus_esp_mem_read, 631a391fdbcSHervé Poussineau .write = sysbus_esp_mem_write, 632a391fdbcSHervé Poussineau .endianness = DEVICE_NATIVE_ENDIAN, 633a391fdbcSHervé Poussineau .valid.accepts = esp_mem_accepts, 634a391fdbcSHervé Poussineau }; 635a391fdbcSHervé Poussineau 636a8170e5eSAvi Kivity void esp_init(hwaddr espaddr, int it_shift, 637ff9868ecSBlue Swirl ESPDMAMemoryReadWriteFunc dma_memory_read, 638ff9868ecSBlue Swirl ESPDMAMemoryReadWriteFunc dma_memory_write, 63973d74342SBlue Swirl void *dma_opaque, qemu_irq irq, qemu_irq *reset, 64073d74342SBlue Swirl qemu_irq *dma_enable) 6416f7e9aecSbellard { 642cfb9de9cSPaul Brook DeviceState *dev; 643cfb9de9cSPaul Brook SysBusDevice *s; 644a391fdbcSHervé Poussineau SysBusESPState *sysbus; 645ee6847d1SGerd Hoffmann ESPState *esp; 646cfb9de9cSPaul Brook 647a71c7ec5SHu Tao dev = qdev_create(NULL, TYPE_ESP); 648a71c7ec5SHu Tao sysbus = ESP(dev); 649a391fdbcSHervé Poussineau esp = &sysbus->esp; 650ee6847d1SGerd Hoffmann esp->dma_memory_read = dma_memory_read; 651ee6847d1SGerd Hoffmann esp->dma_memory_write = dma_memory_write; 652ee6847d1SGerd Hoffmann esp->dma_opaque = dma_opaque; 653a391fdbcSHervé Poussineau sysbus->it_shift = it_shift; 65473d74342SBlue Swirl /* XXX for now until rc4030 has been changed to use DMA enable signal */ 65573d74342SBlue Swirl esp->dma_enabled = 1; 656e23a1b33SMarkus Armbruster qdev_init_nofail(dev); 6571356b98dSAndreas Färber s = SYS_BUS_DEVICE(dev); 658cfb9de9cSPaul Brook sysbus_connect_irq(s, 0, irq); 659cfb9de9cSPaul Brook sysbus_mmio_map(s, 0, espaddr); 66074ff8d90SBlue Swirl *reset = qdev_get_gpio_in(dev, 0); 66173d74342SBlue Swirl *dma_enable = qdev_get_gpio_in(dev, 1); 662cfb9de9cSPaul Brook } 663cfb9de9cSPaul Brook 664afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 665afd4030cSPaolo Bonzini .tcq = false, 6667e0380b9SPaolo Bonzini .max_target = ESP_MAX_DEVS, 6677e0380b9SPaolo Bonzini .max_lun = 7, 668afd4030cSPaolo Bonzini 669c6df7102SPaolo Bonzini .transfer_data = esp_transfer_data, 67094d3f98aSPaolo Bonzini .complete = esp_command_complete, 67194d3f98aSPaolo Bonzini .cancel = esp_request_cancelled 672cfdc1bb0SPaolo Bonzini }; 673cfdc1bb0SPaolo Bonzini 674a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 675cfb9de9cSPaul Brook { 676a71c7ec5SHu Tao SysBusESPState *sysbus = ESP(opaque); 677a391fdbcSHervé Poussineau ESPState *s = &sysbus->esp; 678a391fdbcSHervé Poussineau 679a391fdbcSHervé Poussineau switch (irq) { 680a391fdbcSHervé Poussineau case 0: 681a391fdbcSHervé Poussineau parent_esp_reset(s, irq, level); 682a391fdbcSHervé Poussineau break; 683a391fdbcSHervé Poussineau case 1: 684a391fdbcSHervé Poussineau esp_dma_enable(opaque, irq, level); 685a391fdbcSHervé Poussineau break; 686a391fdbcSHervé Poussineau } 687a391fdbcSHervé Poussineau } 688a391fdbcSHervé Poussineau 689b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 690a391fdbcSHervé Poussineau { 691b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 692a71c7ec5SHu Tao SysBusESPState *sysbus = ESP(dev); 693a391fdbcSHervé Poussineau ESPState *s = &sysbus->esp; 694caad4eb3SAndreas Färber Error *err = NULL; 6956f7e9aecSbellard 696b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 697a391fdbcSHervé Poussineau assert(sysbus->it_shift != -1); 6986f7e9aecSbellard 699d32e4b3dSHervé Poussineau s->chip_id = TCHI_FAS100A; 70029776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 70129776739SPaolo Bonzini sysbus, "esp", ESP_REGS << sysbus->it_shift); 702b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 7036f7e9aecSbellard 704b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 7052d069babSblueswir1 706b1187b51SAndreas Färber scsi_bus_new(&s->bus, sizeof(s->bus), dev, &esp_scsi_info, NULL); 707caad4eb3SAndreas Färber scsi_bus_legacy_handle_cmdline(&s->bus, &err); 708caad4eb3SAndreas Färber if (err != NULL) { 709caad4eb3SAndreas Färber error_propagate(errp, err); 710b09318caSHu Tao return; 711b09318caSHu Tao } 71267e999beSbellard } 713cfb9de9cSPaul Brook 714a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev) 715a391fdbcSHervé Poussineau { 716a71c7ec5SHu Tao SysBusESPState *sysbus = ESP(dev); 717a391fdbcSHervé Poussineau esp_hard_reset(&sysbus->esp); 718a391fdbcSHervé Poussineau } 719a391fdbcSHervé Poussineau 720a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = { 721a391fdbcSHervé Poussineau .name = "sysbusespscsi", 722a391fdbcSHervé Poussineau .version_id = 0, 723a391fdbcSHervé Poussineau .minimum_version_id = 0, 724a391fdbcSHervé Poussineau .fields = (VMStateField[]) { 725a391fdbcSHervé Poussineau VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 726a391fdbcSHervé Poussineau VMSTATE_END_OF_LIST() 727a391fdbcSHervé Poussineau } 728999e12bbSAnthony Liguori }; 729999e12bbSAnthony Liguori 730a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data) 731999e12bbSAnthony Liguori { 73239bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 733999e12bbSAnthony Liguori 734b09318caSHu Tao dc->realize = sysbus_esp_realize; 735a391fdbcSHervé Poussineau dc->reset = sysbus_esp_hard_reset; 736a391fdbcSHervé Poussineau dc->vmsd = &vmstate_sysbus_esp_scsi; 737125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 73863235df8SBlue Swirl } 739999e12bbSAnthony Liguori 7401f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = { 741a71c7ec5SHu Tao .name = TYPE_ESP, 74239bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 743a391fdbcSHervé Poussineau .instance_size = sizeof(SysBusESPState), 744a391fdbcSHervé Poussineau .class_init = sysbus_esp_class_init, 74563235df8SBlue Swirl }; 74663235df8SBlue Swirl 74783f7d43aSAndreas Färber static void esp_register_types(void) 748cfb9de9cSPaul Brook { 749a391fdbcSHervé Poussineau type_register_static(&sysbus_esp_info); 750cfb9de9cSPaul Brook } 751cfb9de9cSPaul Brook 75283f7d43aSAndreas Färber type_init(esp_register_types) 753