16f7e9aecSbellard /* 267e999beSbellard * QEMU ESP/NCR53C9x emulation 36f7e9aecSbellard * 44e9aec74Spbrook * Copyright (c) 2005-2006 Fabrice Bellard 5fabaaf1dSHervé Poussineau * Copyright (c) 2012 Herve Poussineau 678d68f31SMark Cave-Ayland * Copyright (c) 2023 Mark Cave-Ayland 76f7e9aecSbellard * 86f7e9aecSbellard * Permission is hereby granted, free of charge, to any person obtaining a copy 96f7e9aecSbellard * of this software and associated documentation files (the "Software"), to deal 106f7e9aecSbellard * in the Software without restriction, including without limitation the rights 116f7e9aecSbellard * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 126f7e9aecSbellard * copies of the Software, and to permit persons to whom the Software is 136f7e9aecSbellard * furnished to do so, subject to the following conditions: 146f7e9aecSbellard * 156f7e9aecSbellard * The above copyright notice and this permission notice shall be included in 166f7e9aecSbellard * all copies or substantial portions of the Software. 176f7e9aecSbellard * 186f7e9aecSbellard * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 196f7e9aecSbellard * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 206f7e9aecSbellard * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 216f7e9aecSbellard * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 226f7e9aecSbellard * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 236f7e9aecSbellard * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 246f7e9aecSbellard * THE SOFTWARE. 256f7e9aecSbellard */ 265d20fa6bSblueswir1 27a4ab4792SPeter Maydell #include "qemu/osdep.h" 2883c9f4caSPaolo Bonzini #include "hw/sysbus.h" 29d6454270SMarkus Armbruster #include "migration/vmstate.h" 3064552b6bSMarkus Armbruster #include "hw/irq.h" 310d09e41aSPaolo Bonzini #include "hw/scsi/esp.h" 32bf4b9889SBlue Swirl #include "trace.h" 331de7afc9SPaolo Bonzini #include "qemu/log.h" 340b8fa32fSMarkus Armbruster #include "qemu/module.h" 356f7e9aecSbellard 3667e999beSbellard /* 375ad6bb97Sblueswir1 * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O), 385ad6bb97Sblueswir1 * also produced as NCR89C100. See 3967e999beSbellard * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt 4067e999beSbellard * and 4167e999beSbellard * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt 4274d71ea1SLaurent Vivier * 4374d71ea1SLaurent Vivier * On Macintosh Quadra it is a NCR53C96. 4467e999beSbellard */ 4567e999beSbellard 46c73f96fdSblueswir1 static void esp_raise_irq(ESPState *s) 47c73f96fdSblueswir1 { 48c73f96fdSblueswir1 if (!(s->rregs[ESP_RSTAT] & STAT_INT)) { 49c73f96fdSblueswir1 s->rregs[ESP_RSTAT] |= STAT_INT; 50c73f96fdSblueswir1 qemu_irq_raise(s->irq); 51bf4b9889SBlue Swirl trace_esp_raise_irq(); 52c73f96fdSblueswir1 } 53c73f96fdSblueswir1 } 54c73f96fdSblueswir1 55c73f96fdSblueswir1 static void esp_lower_irq(ESPState *s) 56c73f96fdSblueswir1 { 57c73f96fdSblueswir1 if (s->rregs[ESP_RSTAT] & STAT_INT) { 58c73f96fdSblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_INT; 59c73f96fdSblueswir1 qemu_irq_lower(s->irq); 60bf4b9889SBlue Swirl trace_esp_lower_irq(); 61c73f96fdSblueswir1 } 62c73f96fdSblueswir1 } 63c73f96fdSblueswir1 6474d71ea1SLaurent Vivier static void esp_raise_drq(ESPState *s) 6574d71ea1SLaurent Vivier { 66442de89aSMark Cave-Ayland if (!(s->drq_state)) { 676dec7c0dSMark Cave-Ayland qemu_irq_raise(s->drq_irq); 68960ebfd9SMark Cave-Ayland trace_esp_raise_drq(); 69442de89aSMark Cave-Ayland s->drq_state = true; 70442de89aSMark Cave-Ayland } 7174d71ea1SLaurent Vivier } 7274d71ea1SLaurent Vivier 7374d71ea1SLaurent Vivier static void esp_lower_drq(ESPState *s) 7474d71ea1SLaurent Vivier { 75442de89aSMark Cave-Ayland if (s->drq_state) { 766dec7c0dSMark Cave-Ayland qemu_irq_lower(s->drq_irq); 77960ebfd9SMark Cave-Ayland trace_esp_lower_drq(); 78442de89aSMark Cave-Ayland s->drq_state = false; 79442de89aSMark Cave-Ayland } 8074d71ea1SLaurent Vivier } 8174d71ea1SLaurent Vivier 822c1017bfSMark Cave-Ayland static const char *esp_phase_names[8] = { 832c1017bfSMark Cave-Ayland "DATA OUT", "DATA IN", "COMMAND", "STATUS", 842c1017bfSMark Cave-Ayland "(reserved)", "(reserved)", "MESSAGE OUT", "MESSAGE IN" 852c1017bfSMark Cave-Ayland }; 862c1017bfSMark Cave-Ayland 872c1017bfSMark Cave-Ayland static void esp_set_phase(ESPState *s, uint8_t phase) 882c1017bfSMark Cave-Ayland { 892c1017bfSMark Cave-Ayland s->rregs[ESP_RSTAT] &= ~7; 902c1017bfSMark Cave-Ayland s->rregs[ESP_RSTAT] |= phase; 912c1017bfSMark Cave-Ayland 922c1017bfSMark Cave-Ayland trace_esp_set_phase(esp_phase_names[phase]); 932c1017bfSMark Cave-Ayland } 942c1017bfSMark Cave-Ayland 952c1017bfSMark Cave-Ayland static uint8_t esp_get_phase(ESPState *s) 962c1017bfSMark Cave-Ayland { 972c1017bfSMark Cave-Ayland return s->rregs[ESP_RSTAT] & 7; 982c1017bfSMark Cave-Ayland } 992c1017bfSMark Cave-Ayland 1009c7e23fcSHervé Poussineau void esp_dma_enable(ESPState *s, int irq, int level) 10173d74342SBlue Swirl { 10273d74342SBlue Swirl if (level) { 10373d74342SBlue Swirl s->dma_enabled = 1; 104bf4b9889SBlue Swirl trace_esp_dma_enable(); 10573d74342SBlue Swirl if (s->dma_cb) { 10673d74342SBlue Swirl s->dma_cb(s); 10773d74342SBlue Swirl s->dma_cb = NULL; 10873d74342SBlue Swirl } 10973d74342SBlue Swirl } else { 110bf4b9889SBlue Swirl trace_esp_dma_disable(); 11173d74342SBlue Swirl s->dma_enabled = 0; 11273d74342SBlue Swirl } 11373d74342SBlue Swirl } 11473d74342SBlue Swirl 1159c7e23fcSHervé Poussineau void esp_request_cancelled(SCSIRequest *req) 11694d3f98aSPaolo Bonzini { 117e6810db8SHervé Poussineau ESPState *s = req->hba_private; 11894d3f98aSPaolo Bonzini 11994d3f98aSPaolo Bonzini if (req == s->current_req) { 12094d3f98aSPaolo Bonzini scsi_req_unref(s->current_req); 12194d3f98aSPaolo Bonzini s->current_req = NULL; 12294d3f98aSPaolo Bonzini s->current_dev = NULL; 123324c8809SMark Cave-Ayland s->async_len = 0; 12494d3f98aSPaolo Bonzini } 12594d3f98aSPaolo Bonzini } 12694d3f98aSPaolo Bonzini 127743d8736SMark Cave-Ayland static void esp_update_drq(ESPState *s) 128743d8736SMark Cave-Ayland { 129743d8736SMark Cave-Ayland bool to_device; 130743d8736SMark Cave-Ayland 131743d8736SMark Cave-Ayland switch (esp_get_phase(s)) { 132743d8736SMark Cave-Ayland case STAT_MO: 133743d8736SMark Cave-Ayland case STAT_CD: 134743d8736SMark Cave-Ayland case STAT_DO: 135743d8736SMark Cave-Ayland to_device = true; 136743d8736SMark Cave-Ayland break; 137743d8736SMark Cave-Ayland 138743d8736SMark Cave-Ayland case STAT_DI: 139743d8736SMark Cave-Ayland case STAT_ST: 140743d8736SMark Cave-Ayland case STAT_MI: 141743d8736SMark Cave-Ayland to_device = false; 142743d8736SMark Cave-Ayland break; 143743d8736SMark Cave-Ayland 144743d8736SMark Cave-Ayland default: 145743d8736SMark Cave-Ayland return; 146743d8736SMark Cave-Ayland } 147743d8736SMark Cave-Ayland 148743d8736SMark Cave-Ayland if (s->dma) { 149743d8736SMark Cave-Ayland /* DMA request so update DRQ according to transfer direction */ 150743d8736SMark Cave-Ayland if (to_device) { 151743d8736SMark Cave-Ayland if (fifo8_num_free(&s->fifo) < 2) { 152743d8736SMark Cave-Ayland esp_lower_drq(s); 153743d8736SMark Cave-Ayland } else { 154743d8736SMark Cave-Ayland esp_raise_drq(s); 155743d8736SMark Cave-Ayland } 156743d8736SMark Cave-Ayland } else { 157743d8736SMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 158743d8736SMark Cave-Ayland esp_lower_drq(s); 159743d8736SMark Cave-Ayland } else { 160743d8736SMark Cave-Ayland esp_raise_drq(s); 161743d8736SMark Cave-Ayland } 162743d8736SMark Cave-Ayland } 163743d8736SMark Cave-Ayland } else { 164743d8736SMark Cave-Ayland /* Not a DMA request */ 165743d8736SMark Cave-Ayland esp_lower_drq(s); 166743d8736SMark Cave-Ayland } 167743d8736SMark Cave-Ayland } 168743d8736SMark Cave-Ayland 1690e7dbe29SMark Cave-Ayland static void esp_fifo_push(ESPState *s, uint8_t val) 170042879fcSMark Cave-Ayland { 1710e7dbe29SMark Cave-Ayland if (fifo8_num_used(&s->fifo) == s->fifo.capacity) { 172042879fcSMark Cave-Ayland trace_esp_error_fifo_overrun(); 173ffa3a5f2SMark Cave-Ayland } else { 174ffa3a5f2SMark Cave-Ayland fifo8_push(&s->fifo, val); 175042879fcSMark Cave-Ayland } 176042879fcSMark Cave-Ayland 177ffa3a5f2SMark Cave-Ayland esp_update_drq(s); 178042879fcSMark Cave-Ayland } 179c5fef911SMark Cave-Ayland 180266170f9SMark Cave-Ayland static void esp_fifo_push_buf(ESPState *s, uint8_t *buf, int len) 181266170f9SMark Cave-Ayland { 182266170f9SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, len); 183743d8736SMark Cave-Ayland esp_update_drq(s); 184266170f9SMark Cave-Ayland } 185266170f9SMark Cave-Ayland 18661fa150dSMark Cave-Ayland static uint8_t esp_fifo_pop(ESPState *s) 187042879fcSMark Cave-Ayland { 188ffa3a5f2SMark Cave-Ayland uint8_t val; 189ffa3a5f2SMark Cave-Ayland 19061fa150dSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 191ffa3a5f2SMark Cave-Ayland val = 0; 192ffa3a5f2SMark Cave-Ayland } else { 193ffa3a5f2SMark Cave-Ayland val = fifo8_pop(&s->fifo); 194042879fcSMark Cave-Ayland } 195042879fcSMark Cave-Ayland 196ffa3a5f2SMark Cave-Ayland esp_update_drq(s); 197ffa3a5f2SMark Cave-Ayland return val; 198023666daSMark Cave-Ayland } 199023666daSMark Cave-Ayland 200d103d0dbSMark Cave-Ayland static uint32_t esp_fifo8_pop_buf(Fifo8 *fifo, uint8_t *dest, int maxlen) 2017b320a8eSMark Cave-Ayland { 2027b320a8eSMark Cave-Ayland const uint8_t *buf; 20349c60d16SMark Cave-Ayland uint32_t n, n2; 20449c60d16SMark Cave-Ayland int len; 2057b320a8eSMark Cave-Ayland 2067b320a8eSMark Cave-Ayland if (maxlen == 0) { 2077b320a8eSMark Cave-Ayland return 0; 2087b320a8eSMark Cave-Ayland } 2097b320a8eSMark Cave-Ayland 21049c60d16SMark Cave-Ayland len = maxlen; 21149c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n); 2127b320a8eSMark Cave-Ayland if (dest) { 2137b320a8eSMark Cave-Ayland memcpy(dest, buf, n); 2147b320a8eSMark Cave-Ayland } 2157b320a8eSMark Cave-Ayland 21649c60d16SMark Cave-Ayland /* Add FIFO wraparound if needed */ 21749c60d16SMark Cave-Ayland len -= n; 21849c60d16SMark Cave-Ayland len = MIN(len, fifo8_num_used(fifo)); 21949c60d16SMark Cave-Ayland if (len) { 22049c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n2); 22149c60d16SMark Cave-Ayland if (dest) { 22249c60d16SMark Cave-Ayland memcpy(&dest[n], buf, n2); 22349c60d16SMark Cave-Ayland } 22449c60d16SMark Cave-Ayland n += n2; 22549c60d16SMark Cave-Ayland } 22649c60d16SMark Cave-Ayland 2277b320a8eSMark Cave-Ayland return n; 2287b320a8eSMark Cave-Ayland } 2297b320a8eSMark Cave-Ayland 230da838126SMark Cave-Ayland static uint32_t esp_fifo_pop_buf(ESPState *s, uint8_t *dest, int maxlen) 231d103d0dbSMark Cave-Ayland { 232743d8736SMark Cave-Ayland uint32_t len = esp_fifo8_pop_buf(&s->fifo, dest, maxlen); 233743d8736SMark Cave-Ayland 234743d8736SMark Cave-Ayland esp_update_drq(s); 235743d8736SMark Cave-Ayland return len; 236d103d0dbSMark Cave-Ayland } 237d103d0dbSMark Cave-Ayland 238c47b5835SMark Cave-Ayland static uint32_t esp_get_tc(ESPState *s) 239c47b5835SMark Cave-Ayland { 240c47b5835SMark Cave-Ayland uint32_t dmalen; 241c47b5835SMark Cave-Ayland 242c47b5835SMark Cave-Ayland dmalen = s->rregs[ESP_TCLO]; 243c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCMID] << 8; 244c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCHI] << 16; 245c47b5835SMark Cave-Ayland 246c47b5835SMark Cave-Ayland return dmalen; 247c47b5835SMark Cave-Ayland } 248c47b5835SMark Cave-Ayland 249c47b5835SMark Cave-Ayland static void esp_set_tc(ESPState *s, uint32_t dmalen) 250c47b5835SMark Cave-Ayland { 251c5d7df28SMark Cave-Ayland uint32_t old_tc = esp_get_tc(s); 252c5d7df28SMark Cave-Ayland 253c47b5835SMark Cave-Ayland s->rregs[ESP_TCLO] = dmalen; 254c47b5835SMark Cave-Ayland s->rregs[ESP_TCMID] = dmalen >> 8; 255c47b5835SMark Cave-Ayland s->rregs[ESP_TCHI] = dmalen >> 16; 256c5d7df28SMark Cave-Ayland 257c5d7df28SMark Cave-Ayland if (old_tc && dmalen == 0) { 258c5d7df28SMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 259c5d7df28SMark Cave-Ayland } 260c47b5835SMark Cave-Ayland } 261c47b5835SMark Cave-Ayland 262c04ed569SMark Cave-Ayland static uint32_t esp_get_stc(ESPState *s) 263c04ed569SMark Cave-Ayland { 264c04ed569SMark Cave-Ayland uint32_t dmalen; 265c04ed569SMark Cave-Ayland 266c04ed569SMark Cave-Ayland dmalen = s->wregs[ESP_TCLO]; 267c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCMID] << 8; 268c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCHI] << 16; 269c04ed569SMark Cave-Ayland 270c04ed569SMark Cave-Ayland return dmalen; 271c04ed569SMark Cave-Ayland } 272c04ed569SMark Cave-Ayland 273761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 274761bef75SMark Cave-Ayland { 2758da90e81SMark Cave-Ayland uint8_t val; 2768da90e81SMark Cave-Ayland 27761fa150dSMark Cave-Ayland val = esp_fifo_pop(s); 2788da90e81SMark Cave-Ayland return val; 279761bef75SMark Cave-Ayland } 280761bef75SMark Cave-Ayland 281761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 282761bef75SMark Cave-Ayland { 2838da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 2848da90e81SMark Cave-Ayland 2850e7dbe29SMark Cave-Ayland esp_fifo_push(s, val); 2868da90e81SMark Cave-Ayland 287*60c57250SMark Cave-Ayland if (dmalen && s->drq_state) { 2888da90e81SMark Cave-Ayland dmalen--; 2898da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 290761bef75SMark Cave-Ayland } 291*60c57250SMark Cave-Ayland } 292761bef75SMark Cave-Ayland 293c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2946130b188SLaurent Vivier { 2956130b188SLaurent Vivier int target; 2966130b188SLaurent Vivier 2976130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2986130b188SLaurent Vivier 2996130b188SLaurent Vivier s->ti_size = 0; 3009b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_0; 3016130b188SLaurent Vivier 302cf40a5e4SMark Cave-Ayland if (s->current_req) { 303cf40a5e4SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 304cf40a5e4SMark Cave-Ayland scsi_req_cancel(s->current_req); 305cf40a5e4SMark Cave-Ayland } 306cf40a5e4SMark Cave-Ayland 3076130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 3086130b188SLaurent Vivier if (!s->current_dev) { 3096130b188SLaurent Vivier /* No such drive */ 3106130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 311cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 3126130b188SLaurent Vivier esp_raise_irq(s); 3136130b188SLaurent Vivier return -1; 3146130b188SLaurent Vivier } 3154e78f3bfSMark Cave-Ayland 3164e78f3bfSMark Cave-Ayland /* 3174e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 318c90b2792SMark Cave-Ayland * either in esp_transfer_data() or esp_command_complete() 3194e78f3bfSMark Cave-Ayland */ 3206130b188SLaurent Vivier return 0; 3216130b188SLaurent Vivier } 3226130b188SLaurent Vivier 3233ee9a475SMark Cave-Ayland static void esp_do_dma(ESPState *s); 3243ee9a475SMark Cave-Ayland static void esp_do_nodma(ESPState *s); 3253ee9a475SMark Cave-Ayland 3264eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 3279f149aa9Spbrook { 3287b320a8eSMark Cave-Ayland uint32_t cmdlen; 3299f149aa9Spbrook int32_t datalen; 330f48a7a6eSPaolo Bonzini SCSIDevice *current_lun; 3317b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 3329f149aa9Spbrook 3334eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 334023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 33599545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 33699545751SMark Cave-Ayland return; 33799545751SMark Cave-Ayland } 338f87d0487SMark Cave-Ayland esp_fifo8_pop_buf(&s->cmdfifo, buf, cmdlen); 339023666daSMark Cave-Ayland 3404eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 341b22f83d8SAlexandra Diupina if (!current_lun) { 342b22f83d8SAlexandra Diupina /* No such drive */ 343b22f83d8SAlexandra Diupina s->rregs[ESP_RSTAT] = 0; 344b22f83d8SAlexandra Diupina s->rregs[ESP_RINTR] = INTR_DC; 345b22f83d8SAlexandra Diupina s->rregs[ESP_RSEQ] = SEQ_0; 346b22f83d8SAlexandra Diupina esp_raise_irq(s); 347b22f83d8SAlexandra Diupina return; 348b22f83d8SAlexandra Diupina } 349b22f83d8SAlexandra Diupina 350fe9d8927SJohn Millikin s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s); 351c39ce112SPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 35267e999beSbellard s->ti_size = datalen; 353023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 354c90b2792SMark Cave-Ayland s->data_ready = false; 35567e999beSbellard if (datalen != 0) { 3564e78f3bfSMark Cave-Ayland /* 357c90b2792SMark Cave-Ayland * Switch to DATA phase but wait until initial data xfer is 3584e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3594e78f3bfSMark Cave-Ayland */ 360c90b2792SMark Cave-Ayland if (datalen > 0) { 361abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DI); 3624f6200f0Sbellard } else { 363abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DO); 3642f275b8fSbellard } 3654e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3664e78f3bfSMark Cave-Ayland return; 3674e78f3bfSMark Cave-Ayland } 3684e78f3bfSMark Cave-Ayland } 3692f275b8fSbellard 3704eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 371f2818f22SArtyom Tarasenko { 3724eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3731828000bSMark Cave-Ayland uint8_t message = fifo8_is_empty(&s->cmdfifo) ? 0 : 3741828000bSMark Cave-Ayland fifo8_pop(&s->cmdfifo); 375023666daSMark Cave-Ayland 3764eb86065SPaolo Bonzini trace_esp_do_identify(message); 3774eb86065SPaolo Bonzini s->lun = message & 7; 378023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3794eb86065SPaolo Bonzini } 380f2818f22SArtyom Tarasenko 381799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 382023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3834eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 3842260402bSMark Cave-Ayland esp_fifo8_pop_buf(&s->cmdfifo, NULL, len); 385023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 386023666daSMark Cave-Ayland } 3874eb86065SPaolo Bonzini } 388023666daSMark Cave-Ayland 3894eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3904eb86065SPaolo Bonzini { 3914eb86065SPaolo Bonzini do_message_phase(s); 3924eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3934eb86065SPaolo Bonzini do_command_phase(s); 394f2818f22SArtyom Tarasenko } 395f2818f22SArtyom Tarasenko 3969f149aa9Spbrook static void handle_satn(ESPState *s) 3979f149aa9Spbrook { 3981b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 39973d74342SBlue Swirl s->dma_cb = handle_satn; 40073d74342SBlue Swirl return; 40173d74342SBlue Swirl } 402b46a43a2SMark Cave-Ayland 4031bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4041bcaf71bSMark Cave-Ayland return; 4051bcaf71bSMark Cave-Ayland } 4063ee9a475SMark Cave-Ayland 4073ee9a475SMark Cave-Ayland esp_set_phase(s, STAT_MO); 4083ee9a475SMark Cave-Ayland 4093ee9a475SMark Cave-Ayland if (s->dma) { 4103ee9a475SMark Cave-Ayland esp_do_dma(s); 4113ee9a475SMark Cave-Ayland } else { 412d39592ffSMark Cave-Ayland esp_do_nodma(s); 4139f149aa9Spbrook } 41494d5c79dSMark Cave-Ayland } 4159f149aa9Spbrook 416f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s) 417f2818f22SArtyom Tarasenko { 4181b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 41973d74342SBlue Swirl s->dma_cb = handle_s_without_atn; 42073d74342SBlue Swirl return; 42173d74342SBlue Swirl } 422b46a43a2SMark Cave-Ayland 4231bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4241bcaf71bSMark Cave-Ayland return; 4251bcaf71bSMark Cave-Ayland } 4269ff0fd12SMark Cave-Ayland 427abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 4289ff0fd12SMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 4299ff0fd12SMark Cave-Ayland 4309ff0fd12SMark Cave-Ayland if (s->dma) { 4319ff0fd12SMark Cave-Ayland esp_do_dma(s); 4329ff0fd12SMark Cave-Ayland } else { 433d39592ffSMark Cave-Ayland esp_do_nodma(s); 434f2818f22SArtyom Tarasenko } 435f2818f22SArtyom Tarasenko } 436f2818f22SArtyom Tarasenko 4379f149aa9Spbrook static void handle_satn_stop(ESPState *s) 4389f149aa9Spbrook { 4391b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 44073d74342SBlue Swirl s->dma_cb = handle_satn_stop; 44173d74342SBlue Swirl return; 44273d74342SBlue Swirl } 443b46a43a2SMark Cave-Ayland 4441bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4451bcaf71bSMark Cave-Ayland return; 4461bcaf71bSMark Cave-Ayland } 447db4d4150SMark Cave-Ayland 448abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 4495d02add4SMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 450db4d4150SMark Cave-Ayland 451db4d4150SMark Cave-Ayland if (s->dma) { 452db4d4150SMark Cave-Ayland esp_do_dma(s); 453db4d4150SMark Cave-Ayland } else { 454d39592ffSMark Cave-Ayland esp_do_nodma(s); 4559f149aa9Spbrook } 4569f149aa9Spbrook } 4579f149aa9Spbrook 458a6cad7cdSMark Cave-Ayland static void handle_pad(ESPState *s) 459a6cad7cdSMark Cave-Ayland { 460a6cad7cdSMark Cave-Ayland if (s->dma) { 461a6cad7cdSMark Cave-Ayland esp_do_dma(s); 462a6cad7cdSMark Cave-Ayland } else { 463a6cad7cdSMark Cave-Ayland esp_do_nodma(s); 464a6cad7cdSMark Cave-Ayland } 465a6cad7cdSMark Cave-Ayland } 466a6cad7cdSMark Cave-Ayland 4670fc5c15aSpbrook static void write_response(ESPState *s) 4682f275b8fSbellard { 469bf4b9889SBlue Swirl trace_esp_write_response(s->status); 470042879fcSMark Cave-Ayland 4718baa1472SMark Cave-Ayland if (s->dma) { 4728baa1472SMark Cave-Ayland esp_do_dma(s); 4738baa1472SMark Cave-Ayland } else { 47483428f7aSMark Cave-Ayland esp_do_nodma(s); 4752f275b8fSbellard } 4768baa1472SMark Cave-Ayland } 4774f6200f0Sbellard 4785aa0df40SMark Cave-Ayland static bool esp_cdb_ready(ESPState *s) 4795d02add4SMark Cave-Ayland { 4805aa0df40SMark Cave-Ayland int len = fifo8_num_used(&s->cmdfifo) - s->cmdfifo_cdb_offset; 4815d02add4SMark Cave-Ayland const uint8_t *pbuf; 4823cc70889SMark Cave-Ayland uint32_t n; 4835aa0df40SMark Cave-Ayland int cdblen; 4845d02add4SMark Cave-Ayland 4855aa0df40SMark Cave-Ayland if (len <= 0) { 4865aa0df40SMark Cave-Ayland return false; 4875d02add4SMark Cave-Ayland } 4885d02add4SMark Cave-Ayland 4893cc70889SMark Cave-Ayland pbuf = fifo8_peek_buf(&s->cmdfifo, len, &n); 4903cc70889SMark Cave-Ayland if (n < len) { 4913cc70889SMark Cave-Ayland /* 4923cc70889SMark Cave-Ayland * In normal use the cmdfifo should never wrap, but include this check 4933cc70889SMark Cave-Ayland * to prevent a malicious guest from reading past the end of the 4943cc70889SMark Cave-Ayland * cmdfifo data buffer below 4953cc70889SMark Cave-Ayland */ 4963cc70889SMark Cave-Ayland return false; 4973cc70889SMark Cave-Ayland } 4983cc70889SMark Cave-Ayland 4995aa0df40SMark Cave-Ayland cdblen = scsi_cdb_length((uint8_t *)&pbuf[s->cmdfifo_cdb_offset]); 5005d02add4SMark Cave-Ayland 5015aa0df40SMark Cave-Ayland return cdblen < 0 ? false : (len >= cdblen); 5025d02add4SMark Cave-Ayland } 5035d02add4SMark Cave-Ayland 504004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s) 5054d611c9aSpbrook { 506af74b3c1SMark Cave-Ayland if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) { 507cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 508c73f96fdSblueswir1 esp_raise_irq(s); 509af74b3c1SMark Cave-Ayland esp_lower_drq(s); 510af74b3c1SMark Cave-Ayland } 5114d611c9aSpbrook } 512a917d384Spbrook 513a917d384Spbrook static void esp_do_dma(ESPState *s) 514a917d384Spbrook { 515023666daSMark Cave-Ayland uint32_t len, cmdlen; 516023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 517a917d384Spbrook 5186cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 519ad2725afSMark Cave-Ayland 520ad2725afSMark Cave-Ayland switch (esp_get_phase(s)) { 521ad2725afSMark Cave-Ayland case STAT_MO: 52246b0c361SMark Cave-Ayland if (s->dma_memory_read) { 52346b0c361SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 52446b0c361SMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 52546b0c361SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 52646b0c361SMark Cave-Ayland } else { 527da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 52867ea170eSMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 52967ea170eSMark Cave-Ayland esp_raise_drq(s); 53046b0c361SMark Cave-Ayland } 53146b0c361SMark Cave-Ayland 53267ea170eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 53367ea170eSMark Cave-Ayland s->cmdfifo_cdb_offset += len; 53446b0c361SMark Cave-Ayland 5353ee9a475SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 5363ee9a475SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 5373ee9a475SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) >= 1) { 5383ee9a475SMark Cave-Ayland /* First byte received, switch to command phase */ 5393ee9a475SMark Cave-Ayland esp_set_phase(s, STAT_CD); 5409b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 5413ee9a475SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 5423ee9a475SMark Cave-Ayland 5433ee9a475SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) > 1) { 5443ee9a475SMark Cave-Ayland /* Process any additional command phase data */ 5453ee9a475SMark Cave-Ayland esp_do_dma(s); 5463ee9a475SMark Cave-Ayland } 5473ee9a475SMark Cave-Ayland } 5483ee9a475SMark Cave-Ayland break; 5493ee9a475SMark Cave-Ayland 550db4d4150SMark Cave-Ayland case CMD_SELATNS | CMD_DMA: 551db4d4150SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) == 1) { 552db4d4150SMark Cave-Ayland /* First byte received, stop in message out phase */ 5539b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 554db4d4150SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 555db4d4150SMark Cave-Ayland 556db4d4150SMark Cave-Ayland /* Raise command completion interrupt */ 557db4d4150SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 558db4d4150SMark Cave-Ayland esp_raise_irq(s); 559db4d4150SMark Cave-Ayland } 560db4d4150SMark Cave-Ayland break; 561db4d4150SMark Cave-Ayland 5623fd325a2SMark Cave-Ayland case CMD_TI | CMD_DMA: 56346b0c361SMark Cave-Ayland /* ATN remains asserted until TC == 0 */ 56446b0c361SMark Cave-Ayland if (esp_get_tc(s) == 0) { 56546b0c361SMark Cave-Ayland esp_set_phase(s, STAT_CD); 566cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 56746b0c361SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 56846b0c361SMark Cave-Ayland esp_raise_irq(s); 56946b0c361SMark Cave-Ayland } 57046b0c361SMark Cave-Ayland break; 5713fd325a2SMark Cave-Ayland } 5723fd325a2SMark Cave-Ayland break; 57346b0c361SMark Cave-Ayland 574ad2725afSMark Cave-Ayland case STAT_CD: 575023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 576023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 57774d71ea1SLaurent Vivier if (s->dma_memory_read) { 5780ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 579023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 580023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 581a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 58274d71ea1SLaurent Vivier } else { 583da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 584406e8a3eSMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 585406e8a3eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 58674d71ea1SLaurent Vivier esp_raise_drq(s); 5873c7f3c8bSMark Cave-Ayland } 588023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 58915407433SLaurent Vivier s->ti_size = 0; 59046b0c361SMark Cave-Ayland if (esp_get_tc(s) == 0) { 591799d90d8SMark Cave-Ayland /* Command has been received */ 592c959f218SMark Cave-Ayland do_cmd(s); 593799d90d8SMark Cave-Ayland } 594ad2725afSMark Cave-Ayland break; 5951454dc76SMark Cave-Ayland 5961454dc76SMark Cave-Ayland case STAT_DO: 5970db89536SMark Cave-Ayland if (!s->current_req) { 5980db89536SMark Cave-Ayland return; 5990db89536SMark Cave-Ayland } 6004460b86aSMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 601a917d384Spbrook /* Defer until data is available. */ 602a917d384Spbrook return; 603a917d384Spbrook } 604a917d384Spbrook if (len > s->async_len) { 605a917d384Spbrook len = s->async_len; 606a917d384Spbrook } 6070d17ce82SMark Cave-Ayland 608a6cad7cdSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 609a6cad7cdSMark Cave-Ayland case CMD_TI | CMD_DMA: 61074d71ea1SLaurent Vivier if (s->dma_memory_read) { 6118b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, s->async_buf, len); 612f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 6130d17ce82SMark Cave-Ayland } else { 6140d17ce82SMark Cave-Ayland /* Copy FIFO data to device */ 6150d17ce82SMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 6160d17ce82SMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 617da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, s->async_buf, len); 6180d17ce82SMark Cave-Ayland esp_raise_drq(s); 6190d17ce82SMark Cave-Ayland } 6200d17ce82SMark Cave-Ayland 621f3666223SMark Cave-Ayland s->async_buf += len; 622f3666223SMark Cave-Ayland s->async_len -= len; 623f3666223SMark Cave-Ayland s->ti_size += len; 624a6cad7cdSMark Cave-Ayland break; 625a6cad7cdSMark Cave-Ayland 626a6cad7cdSMark Cave-Ayland case CMD_PAD | CMD_DMA: 627a6cad7cdSMark Cave-Ayland /* Copy TC zero bytes into the incoming stream */ 628a6cad7cdSMark Cave-Ayland if (!s->dma_memory_read) { 629a6cad7cdSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 630a6cad7cdSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 631a6cad7cdSMark Cave-Ayland } 632a6cad7cdSMark Cave-Ayland 633a6cad7cdSMark Cave-Ayland memset(s->async_buf, 0, len); 634a6cad7cdSMark Cave-Ayland 635a6cad7cdSMark Cave-Ayland s->async_buf += len; 636a6cad7cdSMark Cave-Ayland s->async_len -= len; 637a6cad7cdSMark Cave-Ayland s->ti_size += len; 638a6cad7cdSMark Cave-Ayland break; 639a6cad7cdSMark Cave-Ayland } 640f3666223SMark Cave-Ayland 641e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 642e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 643f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 644f3666223SMark Cave-Ayland return; 645f3666223SMark Cave-Ayland } 646f3666223SMark Cave-Ayland 647004826d0SMark Cave-Ayland esp_dma_ti_check(s); 6481454dc76SMark Cave-Ayland break; 6491454dc76SMark Cave-Ayland 6501454dc76SMark Cave-Ayland case STAT_DI: 6511454dc76SMark Cave-Ayland if (!s->current_req) { 6521454dc76SMark Cave-Ayland return; 6531454dc76SMark Cave-Ayland } 6541454dc76SMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 6551454dc76SMark Cave-Ayland /* Defer until data is available. */ 6561454dc76SMark Cave-Ayland return; 6571454dc76SMark Cave-Ayland } 6581454dc76SMark Cave-Ayland if (len > s->async_len) { 6591454dc76SMark Cave-Ayland len = s->async_len; 6601454dc76SMark Cave-Ayland } 661c37cc88eSMark Cave-Ayland 662a6cad7cdSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 663a6cad7cdSMark Cave-Ayland case CMD_TI | CMD_DMA: 66474d71ea1SLaurent Vivier if (s->dma_memory_write) { 6658b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->async_buf, len); 66674d71ea1SLaurent Vivier } else { 66782141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 668042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 669266170f9SMark Cave-Ayland esp_fifo_push_buf(s, s->async_buf, len); 670c37cc88eSMark Cave-Ayland esp_raise_drq(s); 671c37cc88eSMark Cave-Ayland } 672c37cc88eSMark Cave-Ayland 67382141c8bSMark Cave-Ayland s->async_buf += len; 67482141c8bSMark Cave-Ayland s->async_len -= len; 67582141c8bSMark Cave-Ayland s->ti_size -= len; 67682141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 677a6cad7cdSMark Cave-Ayland break; 678a6cad7cdSMark Cave-Ayland 679a6cad7cdSMark Cave-Ayland case CMD_PAD | CMD_DMA: 680a6cad7cdSMark Cave-Ayland /* Drop TC bytes from the incoming stream */ 681a6cad7cdSMark Cave-Ayland if (!s->dma_memory_write) { 682a6cad7cdSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 683a6cad7cdSMark Cave-Ayland } 684a6cad7cdSMark Cave-Ayland 685a6cad7cdSMark Cave-Ayland s->async_buf += len; 686a6cad7cdSMark Cave-Ayland s->async_len -= len; 687a6cad7cdSMark Cave-Ayland s->ti_size -= len; 688a6cad7cdSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 689a6cad7cdSMark Cave-Ayland break; 690a6cad7cdSMark Cave-Ayland } 691e4e166c8SMark Cave-Ayland 69202a3ce56SMark Cave-Ayland if (s->async_len == 0 && s->ti_size == 0 && esp_get_tc(s)) { 69302a3ce56SMark Cave-Ayland /* If the guest underflows TC then terminate SCSI request */ 69402a3ce56SMark Cave-Ayland scsi_req_continue(s->current_req); 69502a3ce56SMark Cave-Ayland return; 69602a3ce56SMark Cave-Ayland } 69702a3ce56SMark Cave-Ayland 698e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 699e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 700e4e166c8SMark Cave-Ayland scsi_req_continue(s->current_req); 701e4e166c8SMark Cave-Ayland return; 702e4e166c8SMark Cave-Ayland } 703e4e166c8SMark Cave-Ayland 704004826d0SMark Cave-Ayland esp_dma_ti_check(s); 7051454dc76SMark Cave-Ayland break; 7068baa1472SMark Cave-Ayland 7078baa1472SMark Cave-Ayland case STAT_ST: 7088baa1472SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 7098baa1472SMark Cave-Ayland case CMD_ICCS | CMD_DMA: 7108baa1472SMark Cave-Ayland len = MIN(len, 1); 7118baa1472SMark Cave-Ayland 7128baa1472SMark Cave-Ayland if (len) { 7138baa1472SMark Cave-Ayland buf[0] = s->status; 7148baa1472SMark Cave-Ayland 7158baa1472SMark Cave-Ayland if (s->dma_memory_write) { 7168baa1472SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, len); 7178baa1472SMark Cave-Ayland } else { 718266170f9SMark Cave-Ayland esp_fifo_push_buf(s, buf, len); 7198baa1472SMark Cave-Ayland } 7208baa1472SMark Cave-Ayland 721421d1ca5SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 7228baa1472SMark Cave-Ayland esp_set_phase(s, STAT_MI); 7238baa1472SMark Cave-Ayland 7248baa1472SMark Cave-Ayland if (esp_get_tc(s) > 0) { 7258baa1472SMark Cave-Ayland /* Process any message in phase data */ 7268baa1472SMark Cave-Ayland esp_do_dma(s); 7278baa1472SMark Cave-Ayland } 7288baa1472SMark Cave-Ayland } 7298baa1472SMark Cave-Ayland break; 73002a3ce56SMark Cave-Ayland 73102a3ce56SMark Cave-Ayland default: 73202a3ce56SMark Cave-Ayland /* Consume remaining data if the guest underflows TC */ 73302a3ce56SMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 73402a3ce56SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 73502a3ce56SMark Cave-Ayland esp_raise_irq(s); 73602a3ce56SMark Cave-Ayland esp_lower_drq(s); 73702a3ce56SMark Cave-Ayland } 73802a3ce56SMark Cave-Ayland break; 7398baa1472SMark Cave-Ayland } 7408baa1472SMark Cave-Ayland break; 7418baa1472SMark Cave-Ayland 7428baa1472SMark Cave-Ayland case STAT_MI: 7438baa1472SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 7448baa1472SMark Cave-Ayland case CMD_ICCS | CMD_DMA: 7458baa1472SMark Cave-Ayland len = MIN(len, 1); 7468baa1472SMark Cave-Ayland 7478baa1472SMark Cave-Ayland if (len) { 7488baa1472SMark Cave-Ayland buf[0] = 0; 7498baa1472SMark Cave-Ayland 7508baa1472SMark Cave-Ayland if (s->dma_memory_write) { 7518baa1472SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, len); 7528baa1472SMark Cave-Ayland } else { 753266170f9SMark Cave-Ayland esp_fifo_push_buf(s, buf, len); 7548baa1472SMark Cave-Ayland } 7558baa1472SMark Cave-Ayland 756421d1ca5SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 757421d1ca5SMark Cave-Ayland 7588baa1472SMark Cave-Ayland /* Raise end of command interrupt */ 7590ee71db4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 7608baa1472SMark Cave-Ayland esp_raise_irq(s); 7618baa1472SMark Cave-Ayland } 7628baa1472SMark Cave-Ayland break; 7638baa1472SMark Cave-Ayland } 7648baa1472SMark Cave-Ayland break; 76574d71ea1SLaurent Vivier } 766a917d384Spbrook } 767a917d384Spbrook 768a1b8d389SMark Cave-Ayland static void esp_nodma_ti_dataout(ESPState *s) 769a1b8d389SMark Cave-Ayland { 770a1b8d389SMark Cave-Ayland int len; 771a1b8d389SMark Cave-Ayland 772a1b8d389SMark Cave-Ayland if (!s->current_req) { 773a1b8d389SMark Cave-Ayland return; 774a1b8d389SMark Cave-Ayland } 775a1b8d389SMark Cave-Ayland if (s->async_len == 0) { 776a1b8d389SMark Cave-Ayland /* Defer until data is available. */ 777a1b8d389SMark Cave-Ayland return; 778a1b8d389SMark Cave-Ayland } 779a1b8d389SMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 780a1b8d389SMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 781da838126SMark Cave-Ayland esp_fifo_pop_buf(s, s->async_buf, len); 782a1b8d389SMark Cave-Ayland s->async_buf += len; 783a1b8d389SMark Cave-Ayland s->async_len -= len; 784a1b8d389SMark Cave-Ayland s->ti_size += len; 785a1b8d389SMark Cave-Ayland 786a1b8d389SMark Cave-Ayland if (s->async_len == 0) { 787a1b8d389SMark Cave-Ayland scsi_req_continue(s->current_req); 788a1b8d389SMark Cave-Ayland return; 789a1b8d389SMark Cave-Ayland } 790a1b8d389SMark Cave-Ayland 791a1b8d389SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 792a1b8d389SMark Cave-Ayland esp_raise_irq(s); 793a1b8d389SMark Cave-Ayland } 794a1b8d389SMark Cave-Ayland 7951b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7961b9e48a5SMark Cave-Ayland { 7972572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 7987b320a8eSMark Cave-Ayland uint32_t cmdlen; 7995a857339SMark Cave-Ayland int len; 8001b9e48a5SMark Cave-Ayland 80183e803deSMark Cave-Ayland switch (esp_get_phase(s)) { 80283e803deSMark Cave-Ayland case STAT_MO: 803215d2579SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 804215d2579SMark Cave-Ayland case CMD_SELATN: 8052572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 806da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8075a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8085a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 8092572689bSMark Cave-Ayland 8105d02add4SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) >= 1) { 8115d02add4SMark Cave-Ayland /* First byte received, switch to command phase */ 8125d02add4SMark Cave-Ayland esp_set_phase(s, STAT_CD); 8139b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 8145d02add4SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 8155d02add4SMark Cave-Ayland 8165d02add4SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) > 1) { 8175d02add4SMark Cave-Ayland /* Process any additional command phase data */ 8185d02add4SMark Cave-Ayland esp_do_nodma(s); 8195d02add4SMark Cave-Ayland } 8205d02add4SMark Cave-Ayland } 8215d02add4SMark Cave-Ayland break; 8225d02add4SMark Cave-Ayland 8235d02add4SMark Cave-Ayland case CMD_SELATNS: 824215d2579SMark Cave-Ayland /* Copy one byte from FIFO into cmdfifo */ 8255a50644eSMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, 8265a50644eSMark Cave-Ayland MIN(fifo8_num_used(&s->fifo), 1)); 8275a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8285a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 829215d2579SMark Cave-Ayland 830d39592ffSMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) >= 1) { 8315d02add4SMark Cave-Ayland /* First byte received, stop in message out phase */ 8329b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 8335d02add4SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 8345d02add4SMark Cave-Ayland 8355d02add4SMark Cave-Ayland /* Raise command completion interrupt */ 8365d02add4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 8375d02add4SMark Cave-Ayland esp_raise_irq(s); 8385d02add4SMark Cave-Ayland } 8395d02add4SMark Cave-Ayland break; 8405d02add4SMark Cave-Ayland 8415d02add4SMark Cave-Ayland case CMD_TI: 842215d2579SMark Cave-Ayland /* Copy FIFO into cmdfifo */ 843da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8445a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8455a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 846215d2579SMark Cave-Ayland 8475d02add4SMark Cave-Ayland /* ATN remains asserted until FIFO empty */ 8481b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 849abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 850cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 8511b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8521b9e48a5SMark Cave-Ayland esp_raise_irq(s); 85379a6c7c6SMark Cave-Ayland break; 8545d02add4SMark Cave-Ayland } 8555d02add4SMark Cave-Ayland break; 85679a6c7c6SMark Cave-Ayland 85779a6c7c6SMark Cave-Ayland case STAT_CD: 858acdee66dSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 859acdee66dSMark Cave-Ayland case CMD_TI: 86079a6c7c6SMark Cave-Ayland /* Copy FIFO into cmdfifo */ 861da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8625a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8635a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 86479a6c7c6SMark Cave-Ayland 86579a6c7c6SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 86679a6c7c6SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 86779a6c7c6SMark Cave-Ayland 8685d02add4SMark Cave-Ayland /* CDB may be transferred in one or more TI commands */ 8695aa0df40SMark Cave-Ayland if (esp_cdb_ready(s)) { 87079a6c7c6SMark Cave-Ayland /* Command has been received */ 87179a6c7c6SMark Cave-Ayland do_cmd(s); 8725d02add4SMark Cave-Ayland } else { 8735d02add4SMark Cave-Ayland /* 8745d02add4SMark Cave-Ayland * If data was transferred from the FIFO then raise bus 8755d02add4SMark Cave-Ayland * service interrupt to indicate transfer complete. Otherwise 8765d02add4SMark Cave-Ayland * defer until the next FIFO write. 8775d02add4SMark Cave-Ayland */ 8785a857339SMark Cave-Ayland if (len) { 8795d02add4SMark Cave-Ayland /* Raise interrupt to indicate transfer complete */ 8805d02add4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8815d02add4SMark Cave-Ayland esp_raise_irq(s); 8825d02add4SMark Cave-Ayland } 8835d02add4SMark Cave-Ayland } 8845d02add4SMark Cave-Ayland break; 8855d02add4SMark Cave-Ayland 8868ba32048SMark Cave-Ayland case CMD_SEL | CMD_DMA: 8878ba32048SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 888acdee66dSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 889da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8905a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8915a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 892acdee66dSMark Cave-Ayland 8938ba32048SMark Cave-Ayland /* Handle when DMA transfer is terminated by non-DMA FIFO write */ 8945aa0df40SMark Cave-Ayland if (esp_cdb_ready(s)) { 8958ba32048SMark Cave-Ayland /* Command has been received */ 8968ba32048SMark Cave-Ayland do_cmd(s); 8978ba32048SMark Cave-Ayland } 8988ba32048SMark Cave-Ayland break; 8998ba32048SMark Cave-Ayland 9005d02add4SMark Cave-Ayland case CMD_SEL: 9015d02add4SMark Cave-Ayland case CMD_SELATN: 902acdee66dSMark Cave-Ayland /* FIFO already contain entire CDB: copy to cmdfifo and execute */ 903da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 9045a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 9055a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 906acdee66dSMark Cave-Ayland 9075d02add4SMark Cave-Ayland do_cmd(s); 9085d02add4SMark Cave-Ayland break; 9095d02add4SMark Cave-Ayland } 91083e803deSMark Cave-Ayland break; 9111b9e48a5SMark Cave-Ayland 9129d1aa52bSMark Cave-Ayland case STAT_DO: 9135d02add4SMark Cave-Ayland /* Accumulate data in FIFO until non-DMA TI is executed */ 9149d1aa52bSMark Cave-Ayland break; 9159d1aa52bSMark Cave-Ayland 9169d1aa52bSMark Cave-Ayland case STAT_DI: 9179d1aa52bSMark Cave-Ayland if (!s->current_req) { 9189d1aa52bSMark Cave-Ayland return; 9199d1aa52bSMark Cave-Ayland } 9209d1aa52bSMark Cave-Ayland if (s->async_len == 0) { 9219d1aa52bSMark Cave-Ayland /* Defer until data is available. */ 9229d1aa52bSMark Cave-Ayland return; 9239d1aa52bSMark Cave-Ayland } 9246ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 9251f46d1c3SMark Cave-Ayland esp_fifo_push(s, s->async_buf[0]); 9266ef2cabcSMark Cave-Ayland s->async_buf++; 9276ef2cabcSMark Cave-Ayland s->async_len--; 9286ef2cabcSMark Cave-Ayland s->ti_size--; 9296ef2cabcSMark Cave-Ayland } 9301b9e48a5SMark Cave-Ayland 9311b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 9321b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 9331b9e48a5SMark Cave-Ayland return; 9341b9e48a5SMark Cave-Ayland } 9351b9e48a5SMark Cave-Ayland 9369655f72cSMark Cave-Ayland /* If preloading the FIFO, defer until TI command issued */ 9379655f72cSMark Cave-Ayland if (s->rregs[ESP_CMD] != CMD_TI) { 9389655f72cSMark Cave-Ayland return; 9399655f72cSMark Cave-Ayland } 9409655f72cSMark Cave-Ayland 9411b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 9421b9e48a5SMark Cave-Ayland esp_raise_irq(s); 9439d1aa52bSMark Cave-Ayland break; 94483428f7aSMark Cave-Ayland 94583428f7aSMark Cave-Ayland case STAT_ST: 94683428f7aSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 94783428f7aSMark Cave-Ayland case CMD_ICCS: 9481f46d1c3SMark Cave-Ayland esp_fifo_push(s, s->status); 94983428f7aSMark Cave-Ayland esp_set_phase(s, STAT_MI); 95083428f7aSMark Cave-Ayland 95183428f7aSMark Cave-Ayland /* Process any message in phase data */ 95283428f7aSMark Cave-Ayland esp_do_nodma(s); 95383428f7aSMark Cave-Ayland break; 95483428f7aSMark Cave-Ayland } 95583428f7aSMark Cave-Ayland break; 95683428f7aSMark Cave-Ayland 95783428f7aSMark Cave-Ayland case STAT_MI: 95883428f7aSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 95983428f7aSMark Cave-Ayland case CMD_ICCS: 9601f46d1c3SMark Cave-Ayland esp_fifo_push(s, 0); 96183428f7aSMark Cave-Ayland 9620ee71db4SMark Cave-Ayland /* Raise end of command interrupt */ 9630ee71db4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 96483428f7aSMark Cave-Ayland esp_raise_irq(s); 96583428f7aSMark Cave-Ayland break; 96683428f7aSMark Cave-Ayland } 96783428f7aSMark Cave-Ayland break; 9689d1aa52bSMark Cave-Ayland } 9691b9e48a5SMark Cave-Ayland } 9701b9e48a5SMark Cave-Ayland 9714aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 972a917d384Spbrook { 9734aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 9745a83e83eSMark Cave-Ayland int to_device = (esp_get_phase(s) == STAT_DO); 9754aaa6ac3SMark Cave-Ayland 976bf4b9889SBlue Swirl trace_esp_command_complete(); 9776ef2cabcSMark Cave-Ayland 9786ef2cabcSMark Cave-Ayland /* 9796ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 9806ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 9816ef2cabcSMark Cave-Ayland */ 9826ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 983c6df7102SPaolo Bonzini if (s->ti_size != 0) { 984bf4b9889SBlue Swirl trace_esp_command_complete_unexpected(); 985c6df7102SPaolo Bonzini } 9866ef2cabcSMark Cave-Ayland } 9876ef2cabcSMark Cave-Ayland 988a917d384Spbrook s->async_len = 0; 9894aaa6ac3SMark Cave-Ayland if (req->status) { 990bf4b9889SBlue Swirl trace_esp_command_complete_fail(); 991c6df7102SPaolo Bonzini } 9924aaa6ac3SMark Cave-Ayland s->status = req->status; 9936ef2cabcSMark Cave-Ayland 9946ef2cabcSMark Cave-Ayland /* 995cb988199SMark Cave-Ayland * Switch to status phase. For non-DMA transfers from the target the last 996cb988199SMark Cave-Ayland * byte is still in the FIFO 9976ef2cabcSMark Cave-Ayland */ 9988bb22495SMark Cave-Ayland s->ti_size = 0; 9998bb22495SMark Cave-Ayland 10008bb22495SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 10018bb22495SMark Cave-Ayland case CMD_SEL | CMD_DMA: 10028bb22495SMark Cave-Ayland case CMD_SEL: 10038bb22495SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 10048bb22495SMark Cave-Ayland case CMD_SELATN: 1005cb988199SMark Cave-Ayland /* 10068bb22495SMark Cave-Ayland * No data phase for sequencer command so raise deferred bus service 1007c90b2792SMark Cave-Ayland * and function complete interrupt 1008cb988199SMark Cave-Ayland */ 1009c90b2792SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 10109b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 10118bb22495SMark Cave-Ayland break; 1012cb22ce50SMark Cave-Ayland 1013cb22ce50SMark Cave-Ayland case CMD_TI | CMD_DMA: 1014cb22ce50SMark Cave-Ayland case CMD_TI: 1015cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 1016cb22ce50SMark Cave-Ayland break; 10176ef2cabcSMark Cave-Ayland } 10186ef2cabcSMark Cave-Ayland 10198bb22495SMark Cave-Ayland /* Raise bus service interrupt to indicate change to STATUS phase */ 10208bb22495SMark Cave-Ayland esp_set_phase(s, STAT_ST); 10218bb22495SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 10228bb22495SMark Cave-Ayland esp_raise_irq(s); 102302a3ce56SMark Cave-Ayland 102402a3ce56SMark Cave-Ayland /* Ensure DRQ is set correctly for TC underflow or normal completion */ 102502a3ce56SMark Cave-Ayland esp_dma_ti_check(s); 10268bb22495SMark Cave-Ayland 10275c6c0e51SHannes Reinecke if (s->current_req) { 10285c6c0e51SHannes Reinecke scsi_req_unref(s->current_req); 10295c6c0e51SHannes Reinecke s->current_req = NULL; 1030a917d384Spbrook s->current_dev = NULL; 10315c6c0e51SHannes Reinecke } 1032c6df7102SPaolo Bonzini } 1033c6df7102SPaolo Bonzini 10349c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len) 1035c6df7102SPaolo Bonzini { 1036e6810db8SHervé Poussineau ESPState *s = req->hba_private; 10376cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 1038c6df7102SPaolo Bonzini 10396cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 1040aba1f023SPaolo Bonzini s->async_len = len; 10410c34459bSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 10424e78f3bfSMark Cave-Ayland 1043c90b2792SMark Cave-Ayland if (!s->data_ready) { 1044a4608fa0SMark Cave-Ayland s->data_ready = true; 1045a4608fa0SMark Cave-Ayland 1046a4608fa0SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 1047a4608fa0SMark Cave-Ayland case CMD_SEL | CMD_DMA: 1048a4608fa0SMark Cave-Ayland case CMD_SEL: 1049a4608fa0SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 1050a4608fa0SMark Cave-Ayland case CMD_SELATN: 1051c90b2792SMark Cave-Ayland /* 1052c90b2792SMark Cave-Ayland * Initial incoming data xfer is complete for sequencer command 1053c90b2792SMark Cave-Ayland * so raise deferred bus service and function complete interrupt 1054c90b2792SMark Cave-Ayland */ 1055c90b2792SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 10569b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 1057c90b2792SMark Cave-Ayland break; 1058c90b2792SMark Cave-Ayland 1059a4608fa0SMark Cave-Ayland case CMD_SELATNS | CMD_DMA: 1060a4608fa0SMark Cave-Ayland case CMD_SELATNS: 10614e78f3bfSMark Cave-Ayland /* 10624e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 10634e78f3bfSMark Cave-Ayland * completion interrupt 10644e78f3bfSMark Cave-Ayland */ 10654e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 10669b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 1067a4608fa0SMark Cave-Ayland break; 1068a4608fa0SMark Cave-Ayland 1069a4608fa0SMark Cave-Ayland case CMD_TI | CMD_DMA: 1070a4608fa0SMark Cave-Ayland case CMD_TI: 1071a4608fa0SMark Cave-Ayland /* 1072a4608fa0SMark Cave-Ayland * Bus service interrupt raised because of initial change to 1073a4608fa0SMark Cave-Ayland * DATA phase 1074a4608fa0SMark Cave-Ayland */ 1075cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 1076a4608fa0SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 1077a4608fa0SMark Cave-Ayland break; 1078a4608fa0SMark Cave-Ayland } 1079c90b2792SMark Cave-Ayland 1080c90b2792SMark Cave-Ayland esp_raise_irq(s); 10814e78f3bfSMark Cave-Ayland } 10824e78f3bfSMark Cave-Ayland 10831b9e48a5SMark Cave-Ayland /* 10841b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 10851b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 10861b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 10871b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 10881b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 10891b9e48a5SMark Cave-Ayland */ 10901b9e48a5SMark Cave-Ayland 109182003450SMark Cave-Ayland if (s->rregs[ESP_CMD] == (CMD_TI | CMD_DMA)) { 1092a79e767aSMark Cave-Ayland /* When the SCSI layer returns more data, raise deferred INTR_BS */ 1093004826d0SMark Cave-Ayland esp_dma_ti_check(s); 1094a79e767aSMark Cave-Ayland 1095a79e767aSMark Cave-Ayland esp_do_dma(s); 109682003450SMark Cave-Ayland } else if (s->rregs[ESP_CMD] == CMD_TI) { 10971b9e48a5SMark Cave-Ayland esp_do_nodma(s); 10981b9e48a5SMark Cave-Ayland } 1099a917d384Spbrook } 11002e5d83bbSpbrook 11012f275b8fSbellard static void handle_ti(ESPState *s) 11022f275b8fSbellard { 11031b9e48a5SMark Cave-Ayland uint32_t dmalen; 11042f275b8fSbellard 11057246e160SHervé Poussineau if (s->dma && !s->dma_enabled) { 11067246e160SHervé Poussineau s->dma_cb = handle_ti; 11077246e160SHervé Poussineau return; 11087246e160SHervé Poussineau } 11097246e160SHervé Poussineau 11104f6200f0Sbellard if (s->dma) { 11111b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 1112b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 11134d611c9aSpbrook esp_do_dma(s); 1114799d90d8SMark Cave-Ayland } else { 11151b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 11161b9e48a5SMark Cave-Ayland esp_do_nodma(s); 11175d02add4SMark Cave-Ayland 11185d02add4SMark Cave-Ayland if (esp_get_phase(s) == STAT_DO) { 11195d02add4SMark Cave-Ayland esp_nodma_ti_dataout(s); 11205d02add4SMark Cave-Ayland } 11214f6200f0Sbellard } 11222f275b8fSbellard } 11232f275b8fSbellard 11249c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s) 11256f7e9aecSbellard { 11265aca8c3bSblueswir1 memset(s->rregs, 0, ESP_REGS); 11275aca8c3bSblueswir1 memset(s->wregs, 0, ESP_REGS); 1128c9cf45c1SHannes Reinecke s->tchi_written = 0; 11294e9aec74Spbrook s->ti_size = 0; 11303f26c975SMark Cave-Ayland s->async_len = 0; 1131042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 1132023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 11334e9aec74Spbrook s->dma = 0; 113473d74342SBlue Swirl s->dma_cb = NULL; 11358dea1dd4Sblueswir1 11368dea1dd4Sblueswir1 s->rregs[ESP_CFG1] = 7; 11376f7e9aecSbellard } 11386f7e9aecSbellard 1139a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s) 114085948643SBlue Swirl { 114185948643SBlue Swirl qemu_irq_lower(s->irq); 11426dec7c0dSMark Cave-Ayland qemu_irq_lower(s->drq_irq); 1143a391fdbcSHervé Poussineau esp_hard_reset(s); 114485948643SBlue Swirl } 114585948643SBlue Swirl 1146c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s) 1147c6e51f1bSJohn Millikin { 11484a5fc890SPeter Maydell bus_cold_reset(BUS(&s->bus)); 1149c6e51f1bSJohn Millikin } 1150c6e51f1bSJohn Millikin 1151a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level) 11522d069babSblueswir1 { 115385948643SBlue Swirl if (level) { 1154a391fdbcSHervé Poussineau esp_soft_reset(s); 115585948643SBlue Swirl } 11562d069babSblueswir1 } 11572d069babSblueswir1 1158f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s) 1159f21fe39dSMark Cave-Ayland { 1160f21fe39dSMark Cave-Ayland uint8_t cmd = s->rregs[ESP_CMD]; 1161f21fe39dSMark Cave-Ayland 1162f21fe39dSMark Cave-Ayland if (cmd & CMD_DMA) { 1163f21fe39dSMark Cave-Ayland s->dma = 1; 1164f21fe39dSMark Cave-Ayland /* Reload DMA counter. */ 1165f21fe39dSMark Cave-Ayland if (esp_get_stc(s) == 0) { 1166f21fe39dSMark Cave-Ayland esp_set_tc(s, 0x10000); 1167f21fe39dSMark Cave-Ayland } else { 1168f21fe39dSMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 1169f21fe39dSMark Cave-Ayland } 1170f21fe39dSMark Cave-Ayland } else { 1171f21fe39dSMark Cave-Ayland s->dma = 0; 1172f21fe39dSMark Cave-Ayland } 1173f21fe39dSMark Cave-Ayland switch (cmd & CMD_CMD) { 1174f21fe39dSMark Cave-Ayland case CMD_NOP: 1175f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_nop(cmd); 1176f21fe39dSMark Cave-Ayland break; 1177f21fe39dSMark Cave-Ayland case CMD_FLUSH: 1178f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_flush(cmd); 1179f21fe39dSMark Cave-Ayland fifo8_reset(&s->fifo); 1180f21fe39dSMark Cave-Ayland break; 1181f21fe39dSMark Cave-Ayland case CMD_RESET: 1182f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_reset(cmd); 1183f21fe39dSMark Cave-Ayland esp_soft_reset(s); 1184f21fe39dSMark Cave-Ayland break; 1185f21fe39dSMark Cave-Ayland case CMD_BUSRESET: 1186f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_bus_reset(cmd); 1187f21fe39dSMark Cave-Ayland esp_bus_reset(s); 1188f21fe39dSMark Cave-Ayland if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1189f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 1190f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1191f21fe39dSMark Cave-Ayland } 1192f21fe39dSMark Cave-Ayland break; 1193f21fe39dSMark Cave-Ayland case CMD_TI: 1194f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(cmd); 1195f21fe39dSMark Cave-Ayland handle_ti(s); 1196f21fe39dSMark Cave-Ayland break; 1197f21fe39dSMark Cave-Ayland case CMD_ICCS: 1198f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_iccs(cmd); 1199f21fe39dSMark Cave-Ayland write_response(s); 1200f21fe39dSMark Cave-Ayland break; 1201f21fe39dSMark Cave-Ayland case CMD_MSGACC: 1202f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_msgacc(cmd); 1203f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 1204f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1205f21fe39dSMark Cave-Ayland s->rregs[ESP_RFLAGS] = 0; 1206f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1207f21fe39dSMark Cave-Ayland break; 1208f21fe39dSMark Cave-Ayland case CMD_PAD: 1209f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_pad(cmd); 1210a6cad7cdSMark Cave-Ayland handle_pad(s); 1211f21fe39dSMark Cave-Ayland break; 1212f21fe39dSMark Cave-Ayland case CMD_SATN: 1213f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_satn(cmd); 1214f21fe39dSMark Cave-Ayland break; 1215f21fe39dSMark Cave-Ayland case CMD_RSTATN: 1216f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_rstatn(cmd); 1217f21fe39dSMark Cave-Ayland break; 1218f21fe39dSMark Cave-Ayland case CMD_SEL: 1219f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_sel(cmd); 1220f21fe39dSMark Cave-Ayland handle_s_without_atn(s); 1221f21fe39dSMark Cave-Ayland break; 1222f21fe39dSMark Cave-Ayland case CMD_SELATN: 1223f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatn(cmd); 1224f21fe39dSMark Cave-Ayland handle_satn(s); 1225f21fe39dSMark Cave-Ayland break; 1226f21fe39dSMark Cave-Ayland case CMD_SELATNS: 1227f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatns(cmd); 1228f21fe39dSMark Cave-Ayland handle_satn_stop(s); 1229f21fe39dSMark Cave-Ayland break; 1230f21fe39dSMark Cave-Ayland case CMD_ENSEL: 1231f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ensel(cmd); 1232f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1233f21fe39dSMark Cave-Ayland break; 1234f21fe39dSMark Cave-Ayland case CMD_DISSEL: 1235f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_dissel(cmd); 1236f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1237f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1238f21fe39dSMark Cave-Ayland break; 1239f21fe39dSMark Cave-Ayland default: 1240f21fe39dSMark Cave-Ayland trace_esp_error_unhandled_command(cmd); 1241f21fe39dSMark Cave-Ayland break; 1242f21fe39dSMark Cave-Ayland } 1243f21fe39dSMark Cave-Ayland } 1244f21fe39dSMark Cave-Ayland 12459c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 124673d74342SBlue Swirl { 1247b630c075SMark Cave-Ayland uint32_t val; 124873d74342SBlue Swirl 12496f7e9aecSbellard switch (saddr) { 12505ad6bb97Sblueswir1 case ESP_FIFO: 125161fa150dSMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(s); 1252b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 12534f6200f0Sbellard break; 12545ad6bb97Sblueswir1 case ESP_RINTR: 125594d5c79dSMark Cave-Ayland /* 125694d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 125794d5c79dSMark Cave-Ayland * except TC 125894d5c79dSMark Cave-Ayland */ 1259b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 12602814df28SBlue Swirl s->rregs[ESP_RINTR] = 0; 1261d294b77aSMark Cave-Ayland esp_lower_irq(s); 1262d68212cdSMark Cave-Ayland s->rregs[ESP_RSTAT] &= STAT_TC | 7; 1263af947a3dSMark Cave-Ayland /* 1264af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 1265af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 1266af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 1267af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 1268af947a3dSMark Cave-Ayland * transition. 1269af947a3dSMark Cave-Ayland * 1270af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 1271af947a3dSMark Cave-Ayland */ 1272b630c075SMark Cave-Ayland break; 1273c9cf45c1SHannes Reinecke case ESP_TCHI: 1274c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 1275c9cf45c1SHannes Reinecke if (!s->tchi_written) { 1276b630c075SMark Cave-Ayland val = s->chip_id; 1277b630c075SMark Cave-Ayland } else { 1278b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1279c9cf45c1SHannes Reinecke } 1280b630c075SMark Cave-Ayland break; 1281238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1282238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1283238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1284238ec4d7SMark Cave-Ayland break; 12856f7e9aecSbellard default: 1286b630c075SMark Cave-Ayland val = s->rregs[saddr]; 12876f7e9aecSbellard break; 12886f7e9aecSbellard } 1289b630c075SMark Cave-Ayland 1290b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1291b630c075SMark Cave-Ayland return val; 12926f7e9aecSbellard } 12936f7e9aecSbellard 12949c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 12956f7e9aecSbellard { 1296bf4b9889SBlue Swirl trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 12976f7e9aecSbellard switch (saddr) { 1298c9cf45c1SHannes Reinecke case ESP_TCHI: 1299c9cf45c1SHannes Reinecke s->tchi_written = true; 1300c9cf45c1SHannes Reinecke /* fall through */ 13015ad6bb97Sblueswir1 case ESP_TCLO: 13025ad6bb97Sblueswir1 case ESP_TCMID: 13035ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 13044f6200f0Sbellard break; 13055ad6bb97Sblueswir1 case ESP_FIFO: 13062572689bSMark Cave-Ayland if (!fifo8_is_full(&s->fifo)) { 13070e7dbe29SMark Cave-Ayland esp_fifo_push(s, val); 13082572689bSMark Cave-Ayland } 13095d02add4SMark Cave-Ayland esp_do_nodma(s); 13104f6200f0Sbellard break; 13115ad6bb97Sblueswir1 case ESP_CMD: 13124f6200f0Sbellard s->rregs[saddr] = val; 1313f21fe39dSMark Cave-Ayland esp_run_cmd(s); 13146f7e9aecSbellard break; 13155ad6bb97Sblueswir1 case ESP_WBUSID ... ESP_WSYNO: 13164f6200f0Sbellard break; 13175ad6bb97Sblueswir1 case ESP_CFG1: 13189ea73f8bSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 13199ea73f8bSPaolo Bonzini case ESP_RES3: case ESP_RES4: 13204f6200f0Sbellard s->rregs[saddr] = val; 13214f6200f0Sbellard break; 13225ad6bb97Sblueswir1 case ESP_WCCF ... ESP_WTEST: 13234f6200f0Sbellard break; 13246f7e9aecSbellard default: 13253af4e9aaSHervé Poussineau trace_esp_error_invalid_write(val, saddr); 13268dea1dd4Sblueswir1 return; 13276f7e9aecSbellard } 13282f275b8fSbellard s->wregs[saddr] = val; 13296f7e9aecSbellard } 13306f7e9aecSbellard 1331a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr, 13328372d383SPeter Maydell unsigned size, bool is_write, 13338372d383SPeter Maydell MemTxAttrs attrs) 133467bb5314SAvi Kivity { 133567bb5314SAvi Kivity return (size == 1) || (is_write && size == 4); 133667bb5314SAvi Kivity } 13376f7e9aecSbellard 13386cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 13396cc88d6bSMark Cave-Ayland { 13406cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 13416cc88d6bSMark Cave-Ayland 13426cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 13436cc88d6bSMark Cave-Ayland return version_id < 5; 13446cc88d6bSMark Cave-Ayland } 13456cc88d6bSMark Cave-Ayland 13464e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 13474e78f3bfSMark Cave-Ayland { 13484e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 13494e78f3bfSMark Cave-Ayland 13504e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 13510bcd5a18SMark Cave-Ayland return version_id >= 5; 13524e78f3bfSMark Cave-Ayland } 13534e78f3bfSMark Cave-Ayland 13544eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 13554eb86065SPaolo Bonzini { 13564eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 13574eb86065SPaolo Bonzini 13584eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 13594eb86065SPaolo Bonzini return version_id >= 6; 13604eb86065SPaolo Bonzini } 13614eb86065SPaolo Bonzini 136282003450SMark Cave-Ayland static bool esp_is_between_version_5_and_6(void *opaque, int version_id) 136382003450SMark Cave-Ayland { 136482003450SMark Cave-Ayland ESPState *s = ESP(opaque); 136582003450SMark Cave-Ayland 136682003450SMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 136782003450SMark Cave-Ayland return version_id >= 5 && version_id <= 6; 136882003450SMark Cave-Ayland } 136982003450SMark Cave-Ayland 1370ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 13710bd005beSMark Cave-Ayland { 1372ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1373ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 13740bd005beSMark Cave-Ayland 13750bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 13760bd005beSMark Cave-Ayland return 0; 13770bd005beSMark Cave-Ayland } 13780bd005beSMark Cave-Ayland 13790bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 13800bd005beSMark Cave-Ayland { 13810bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1382042879fcSMark Cave-Ayland int len, i; 13830bd005beSMark Cave-Ayland 13846cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 13856cc88d6bSMark Cave-Ayland 13866cc88d6bSMark Cave-Ayland if (version_id < 5) { 13876cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1388042879fcSMark Cave-Ayland 1389042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1390042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1391042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1392042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1393042879fcSMark Cave-Ayland } 1394023666daSMark Cave-Ayland 1395023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1396023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1397023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1398023666daSMark Cave-Ayland } 13996cc88d6bSMark Cave-Ayland } 14006cc88d6bSMark Cave-Ayland 14010bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 14020bd005beSMark Cave-Ayland return 0; 14030bd005beSMark Cave-Ayland } 14040bd005beSMark Cave-Ayland 14059c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = { 1406cc9952f3SBlue Swirl .name = "esp", 140782003450SMark Cave-Ayland .version_id = 7, 1408cc9952f3SBlue Swirl .minimum_version_id = 3, 14090bd005beSMark Cave-Ayland .post_load = esp_post_load, 14102d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1411cc9952f3SBlue Swirl VMSTATE_BUFFER(rregs, ESPState), 1412cc9952f3SBlue Swirl VMSTATE_BUFFER(wregs, ESPState), 1413cc9952f3SBlue Swirl VMSTATE_INT32(ti_size, ESPState), 1414042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1415042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1416042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 14173944966dSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 14184aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 14194aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 14204aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 14214aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 1422cc9952f3SBlue Swirl VMSTATE_UINT32(dma, ESPState), 1423023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1424023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1425023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1426023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1427023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1428023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 1429cc9952f3SBlue Swirl VMSTATE_UINT32(do_cmd, ESPState), 14306cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 14318dded6deSMark Cave-Ayland VMSTATE_BOOL_TEST(data_ready, ESPState, esp_is_version_5), 1432023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1433042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1434023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 143582003450SMark Cave-Ayland VMSTATE_UINT8_TEST(mig_ti_cmd, ESPState, 143682003450SMark Cave-Ayland esp_is_between_version_5_and_6), 14374eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 1438442de89aSMark Cave-Ayland VMSTATE_BOOL(drq_state, ESPState), 1439cc9952f3SBlue Swirl VMSTATE_END_OF_LIST() 144074d71ea1SLaurent Vivier }, 1441cc9952f3SBlue Swirl }; 14426f7e9aecSbellard 1443a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 1444a391fdbcSHervé Poussineau uint64_t val, unsigned int size) 1445a391fdbcSHervé Poussineau { 1446a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 1447eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1448a391fdbcSHervé Poussineau uint32_t saddr; 1449a391fdbcSHervé Poussineau 1450a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 1451eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 1452a391fdbcSHervé Poussineau } 1453a391fdbcSHervé Poussineau 1454a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 1455a391fdbcSHervé Poussineau unsigned int size) 1456a391fdbcSHervé Poussineau { 1457a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 1458eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1459a391fdbcSHervé Poussineau uint32_t saddr; 1460a391fdbcSHervé Poussineau 1461a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 1462eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 1463a391fdbcSHervé Poussineau } 1464a391fdbcSHervé Poussineau 1465a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = { 1466a391fdbcSHervé Poussineau .read = sysbus_esp_mem_read, 1467a391fdbcSHervé Poussineau .write = sysbus_esp_mem_write, 1468a391fdbcSHervé Poussineau .endianness = DEVICE_NATIVE_ENDIAN, 1469a391fdbcSHervé Poussineau .valid.accepts = esp_mem_accepts, 1470a391fdbcSHervé Poussineau }; 1471a391fdbcSHervé Poussineau 147274d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 147374d71ea1SLaurent Vivier uint64_t val, unsigned int size) 147474d71ea1SLaurent Vivier { 147574d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1476eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 147774d71ea1SLaurent Vivier 1478960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1479960ebfd9SMark Cave-Ayland 148074d71ea1SLaurent Vivier switch (size) { 148174d71ea1SLaurent Vivier case 1: 1482761bef75SMark Cave-Ayland esp_pdma_write(s, val); 148374d71ea1SLaurent Vivier break; 148474d71ea1SLaurent Vivier case 2: 1485761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1486761bef75SMark Cave-Ayland esp_pdma_write(s, val); 148774d71ea1SLaurent Vivier break; 148874d71ea1SLaurent Vivier } 1489b46a43a2SMark Cave-Ayland esp_do_dma(s); 149074d71ea1SLaurent Vivier } 149174d71ea1SLaurent Vivier 149274d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 149374d71ea1SLaurent Vivier unsigned int size) 149474d71ea1SLaurent Vivier { 149574d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1496eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 149774d71ea1SLaurent Vivier uint64_t val = 0; 149874d71ea1SLaurent Vivier 1499960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1500960ebfd9SMark Cave-Ayland 150174d71ea1SLaurent Vivier switch (size) { 150274d71ea1SLaurent Vivier case 1: 1503761bef75SMark Cave-Ayland val = esp_pdma_read(s); 150474d71ea1SLaurent Vivier break; 150574d71ea1SLaurent Vivier case 2: 1506761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1507761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 150874d71ea1SLaurent Vivier break; 150974d71ea1SLaurent Vivier } 1510b46a43a2SMark Cave-Ayland esp_do_dma(s); 151174d71ea1SLaurent Vivier return val; 151274d71ea1SLaurent Vivier } 151374d71ea1SLaurent Vivier 1514a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1515a7a22088SMark Cave-Ayland { 1516a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1517a7a22088SMark Cave-Ayland 1518a7a22088SMark Cave-Ayland scsi_req_ref(req); 1519a7a22088SMark Cave-Ayland s->current_req = req; 1520a7a22088SMark Cave-Ayland return s; 1521a7a22088SMark Cave-Ayland } 1522a7a22088SMark Cave-Ayland 152374d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 152474d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 152574d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 152674d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 152774d71ea1SLaurent Vivier .valid.min_access_size = 1, 1528cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1529cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1530cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 153174d71ea1SLaurent Vivier }; 153274d71ea1SLaurent Vivier 1533afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 1534afd4030cSPaolo Bonzini .tcq = false, 15357e0380b9SPaolo Bonzini .max_target = ESP_MAX_DEVS, 15367e0380b9SPaolo Bonzini .max_lun = 7, 1537afd4030cSPaolo Bonzini 1538a7a22088SMark Cave-Ayland .load_request = esp_load_request, 1539c6df7102SPaolo Bonzini .transfer_data = esp_transfer_data, 154094d3f98aSPaolo Bonzini .complete = esp_command_complete, 154194d3f98aSPaolo Bonzini .cancel = esp_request_cancelled 1542cfdc1bb0SPaolo Bonzini }; 1543cfdc1bb0SPaolo Bonzini 1544a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 1545cfb9de9cSPaul Brook { 154684fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1547eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1548a391fdbcSHervé Poussineau 1549a391fdbcSHervé Poussineau switch (irq) { 1550a391fdbcSHervé Poussineau case 0: 1551a391fdbcSHervé Poussineau parent_esp_reset(s, irq, level); 1552a391fdbcSHervé Poussineau break; 1553a391fdbcSHervé Poussineau case 1: 1554b86dc5cbSMark Cave-Ayland esp_dma_enable(s, irq, level); 1555a391fdbcSHervé Poussineau break; 1556a391fdbcSHervé Poussineau } 1557a391fdbcSHervé Poussineau } 1558a391fdbcSHervé Poussineau 1559b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 1560a391fdbcSHervé Poussineau { 1561b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 156284fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1563eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1564eb169c76SMark Cave-Ayland 1565eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1566eb169c76SMark Cave-Ayland return; 1567eb169c76SMark Cave-Ayland } 15686f7e9aecSbellard 1569b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 15706dec7c0dSMark Cave-Ayland sysbus_init_irq(sbd, &s->drq_irq); 1571a391fdbcSHervé Poussineau assert(sysbus->it_shift != -1); 15726f7e9aecSbellard 1573d32e4b3dSHervé Poussineau s->chip_id = TCHI_FAS100A; 157429776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 157574d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1576b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 157774d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1578cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 157974d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 15806f7e9aecSbellard 1581b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 15822d069babSblueswir1 1583739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 158467e999beSbellard } 1585cfb9de9cSPaul Brook 1586a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev) 1587a391fdbcSHervé Poussineau { 158884fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1589eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1590eb169c76SMark Cave-Ayland 1591eb169c76SMark Cave-Ayland esp_hard_reset(s); 1592eb169c76SMark Cave-Ayland } 1593eb169c76SMark Cave-Ayland 1594eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1595eb169c76SMark Cave-Ayland { 1596eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1597eb169c76SMark Cave-Ayland 1598eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 1599a391fdbcSHervé Poussineau } 1600a391fdbcSHervé Poussineau 1601a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = { 1602a391fdbcSHervé Poussineau .name = "sysbusespscsi", 16030bd005beSMark Cave-Ayland .version_id = 2, 1604ea84a442SGuenter Roeck .minimum_version_id = 1, 1605ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 16062d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 16070bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 1608a391fdbcSHervé Poussineau VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 1609a391fdbcSHervé Poussineau VMSTATE_END_OF_LIST() 1610a391fdbcSHervé Poussineau } 1611999e12bbSAnthony Liguori }; 1612999e12bbSAnthony Liguori 1613a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data) 1614999e12bbSAnthony Liguori { 161539bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 1616999e12bbSAnthony Liguori 1617b09318caSHu Tao dc->realize = sysbus_esp_realize; 1618a391fdbcSHervé Poussineau dc->reset = sysbus_esp_hard_reset; 1619a391fdbcSHervé Poussineau dc->vmsd = &vmstate_sysbus_esp_scsi; 1620125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 162163235df8SBlue Swirl } 1622999e12bbSAnthony Liguori 1623042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1624042879fcSMark Cave-Ayland { 1625042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1626042879fcSMark Cave-Ayland 1627042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1628023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1629042879fcSMark Cave-Ayland } 1630042879fcSMark Cave-Ayland 1631042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1632042879fcSMark Cave-Ayland { 1633042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1634042879fcSMark Cave-Ayland 1635042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1636023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1637042879fcSMark Cave-Ayland } 1638042879fcSMark Cave-Ayland 1639eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1640eb169c76SMark Cave-Ayland { 1641eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1642eb169c76SMark Cave-Ayland 1643eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1644eb169c76SMark Cave-Ayland dc->user_creatable = false; 1645eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1646eb169c76SMark Cave-Ayland } 1647eb169c76SMark Cave-Ayland 1648499f4089SMark Cave-Ayland static const TypeInfo esp_info_types[] = { 1649499f4089SMark Cave-Ayland { 1650499f4089SMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 1651499f4089SMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE, 1652499f4089SMark Cave-Ayland .instance_init = sysbus_esp_init, 1653499f4089SMark Cave-Ayland .instance_size = sizeof(SysBusESPState), 1654499f4089SMark Cave-Ayland .class_init = sysbus_esp_class_init, 1655499f4089SMark Cave-Ayland }, 1656499f4089SMark Cave-Ayland { 1657eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1658eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1659042879fcSMark Cave-Ayland .instance_init = esp_init, 1660042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1661eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1662eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1663499f4089SMark Cave-Ayland }, 1664eb169c76SMark Cave-Ayland }; 1665eb169c76SMark Cave-Ayland 1666499f4089SMark Cave-Ayland DEFINE_TYPES(esp_info_types) 1667