16f7e9aecSbellard /* 267e999beSbellard * QEMU ESP/NCR53C9x emulation 36f7e9aecSbellard * 44e9aec74Spbrook * Copyright (c) 2005-2006 Fabrice Bellard 5fabaaf1dSHervé Poussineau * Copyright (c) 2012 Herve Poussineau 66f7e9aecSbellard * 76f7e9aecSbellard * Permission is hereby granted, free of charge, to any person obtaining a copy 86f7e9aecSbellard * of this software and associated documentation files (the "Software"), to deal 96f7e9aecSbellard * in the Software without restriction, including without limitation the rights 106f7e9aecSbellard * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 116f7e9aecSbellard * copies of the Software, and to permit persons to whom the Software is 126f7e9aecSbellard * furnished to do so, subject to the following conditions: 136f7e9aecSbellard * 146f7e9aecSbellard * The above copyright notice and this permission notice shall be included in 156f7e9aecSbellard * all copies or substantial portions of the Software. 166f7e9aecSbellard * 176f7e9aecSbellard * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 186f7e9aecSbellard * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 196f7e9aecSbellard * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 206f7e9aecSbellard * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 216f7e9aecSbellard * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 226f7e9aecSbellard * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 236f7e9aecSbellard * THE SOFTWARE. 246f7e9aecSbellard */ 255d20fa6bSblueswir1 26a4ab4792SPeter Maydell #include "qemu/osdep.h" 2783c9f4caSPaolo Bonzini #include "hw/sysbus.h" 28d6454270SMarkus Armbruster #include "migration/vmstate.h" 2964552b6bSMarkus Armbruster #include "hw/irq.h" 300d09e41aSPaolo Bonzini #include "hw/scsi/esp.h" 31bf4b9889SBlue Swirl #include "trace.h" 321de7afc9SPaolo Bonzini #include "qemu/log.h" 330b8fa32fSMarkus Armbruster #include "qemu/module.h" 346f7e9aecSbellard 3567e999beSbellard /* 365ad6bb97Sblueswir1 * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O), 375ad6bb97Sblueswir1 * also produced as NCR89C100. See 3867e999beSbellard * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt 3967e999beSbellard * and 4067e999beSbellard * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt 4174d71ea1SLaurent Vivier * 4274d71ea1SLaurent Vivier * On Macintosh Quadra it is a NCR53C96. 4367e999beSbellard */ 4467e999beSbellard 45c73f96fdSblueswir1 static void esp_raise_irq(ESPState *s) 46c73f96fdSblueswir1 { 47c73f96fdSblueswir1 if (!(s->rregs[ESP_RSTAT] & STAT_INT)) { 48c73f96fdSblueswir1 s->rregs[ESP_RSTAT] |= STAT_INT; 49c73f96fdSblueswir1 qemu_irq_raise(s->irq); 50bf4b9889SBlue Swirl trace_esp_raise_irq(); 51c73f96fdSblueswir1 } 52c73f96fdSblueswir1 } 53c73f96fdSblueswir1 54c73f96fdSblueswir1 static void esp_lower_irq(ESPState *s) 55c73f96fdSblueswir1 { 56c73f96fdSblueswir1 if (s->rregs[ESP_RSTAT] & STAT_INT) { 57c73f96fdSblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_INT; 58c73f96fdSblueswir1 qemu_irq_lower(s->irq); 59bf4b9889SBlue Swirl trace_esp_lower_irq(); 60c73f96fdSblueswir1 } 61c73f96fdSblueswir1 } 62c73f96fdSblueswir1 6374d71ea1SLaurent Vivier static void esp_raise_drq(ESPState *s) 6474d71ea1SLaurent Vivier { 6574d71ea1SLaurent Vivier qemu_irq_raise(s->irq_data); 66960ebfd9SMark Cave-Ayland trace_esp_raise_drq(); 6774d71ea1SLaurent Vivier } 6874d71ea1SLaurent Vivier 6974d71ea1SLaurent Vivier static void esp_lower_drq(ESPState *s) 7074d71ea1SLaurent Vivier { 7174d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 72960ebfd9SMark Cave-Ayland trace_esp_lower_drq(); 7374d71ea1SLaurent Vivier } 7474d71ea1SLaurent Vivier 759c7e23fcSHervé Poussineau void esp_dma_enable(ESPState *s, int irq, int level) 7673d74342SBlue Swirl { 7773d74342SBlue Swirl if (level) { 7873d74342SBlue Swirl s->dma_enabled = 1; 79bf4b9889SBlue Swirl trace_esp_dma_enable(); 8073d74342SBlue Swirl if (s->dma_cb) { 8173d74342SBlue Swirl s->dma_cb(s); 8273d74342SBlue Swirl s->dma_cb = NULL; 8373d74342SBlue Swirl } 8473d74342SBlue Swirl } else { 85bf4b9889SBlue Swirl trace_esp_dma_disable(); 8673d74342SBlue Swirl s->dma_enabled = 0; 8773d74342SBlue Swirl } 8873d74342SBlue Swirl } 8973d74342SBlue Swirl 909c7e23fcSHervé Poussineau void esp_request_cancelled(SCSIRequest *req) 9194d3f98aSPaolo Bonzini { 92e6810db8SHervé Poussineau ESPState *s = req->hba_private; 9394d3f98aSPaolo Bonzini 9494d3f98aSPaolo Bonzini if (req == s->current_req) { 9594d3f98aSPaolo Bonzini scsi_req_unref(s->current_req); 9694d3f98aSPaolo Bonzini s->current_req = NULL; 9794d3f98aSPaolo Bonzini s->current_dev = NULL; 98324c8809SMark Cave-Ayland s->async_len = 0; 9994d3f98aSPaolo Bonzini } 10094d3f98aSPaolo Bonzini } 10194d3f98aSPaolo Bonzini 102e5455b8cSMark Cave-Ayland static void esp_fifo_push(Fifo8 *fifo, uint8_t val) 103042879fcSMark Cave-Ayland { 104e5455b8cSMark Cave-Ayland if (fifo8_num_used(fifo) == fifo->capacity) { 105042879fcSMark Cave-Ayland trace_esp_error_fifo_overrun(); 106042879fcSMark Cave-Ayland return; 107042879fcSMark Cave-Ayland } 108042879fcSMark Cave-Ayland 109e5455b8cSMark Cave-Ayland fifo8_push(fifo, val); 110042879fcSMark Cave-Ayland } 111c5fef911SMark Cave-Ayland 112c5fef911SMark Cave-Ayland static uint8_t esp_fifo_pop(Fifo8 *fifo) 113042879fcSMark Cave-Ayland { 114c5fef911SMark Cave-Ayland if (fifo8_is_empty(fifo)) { 115042879fcSMark Cave-Ayland return 0; 116042879fcSMark Cave-Ayland } 117042879fcSMark Cave-Ayland 118c5fef911SMark Cave-Ayland return fifo8_pop(fifo); 119023666daSMark Cave-Ayland } 120023666daSMark Cave-Ayland 1217b320a8eSMark Cave-Ayland static uint32_t esp_fifo_pop_buf(Fifo8 *fifo, uint8_t *dest, int maxlen) 1227b320a8eSMark Cave-Ayland { 1237b320a8eSMark Cave-Ayland const uint8_t *buf; 12449c60d16SMark Cave-Ayland uint32_t n, n2; 12549c60d16SMark Cave-Ayland int len; 1267b320a8eSMark Cave-Ayland 1277b320a8eSMark Cave-Ayland if (maxlen == 0) { 1287b320a8eSMark Cave-Ayland return 0; 1297b320a8eSMark Cave-Ayland } 1307b320a8eSMark Cave-Ayland 13149c60d16SMark Cave-Ayland len = maxlen; 13249c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n); 1337b320a8eSMark Cave-Ayland if (dest) { 1347b320a8eSMark Cave-Ayland memcpy(dest, buf, n); 1357b320a8eSMark Cave-Ayland } 1367b320a8eSMark Cave-Ayland 13749c60d16SMark Cave-Ayland /* Add FIFO wraparound if needed */ 13849c60d16SMark Cave-Ayland len -= n; 13949c60d16SMark Cave-Ayland len = MIN(len, fifo8_num_used(fifo)); 14049c60d16SMark Cave-Ayland if (len) { 14149c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n2); 14249c60d16SMark Cave-Ayland if (dest) { 14349c60d16SMark Cave-Ayland memcpy(&dest[n], buf, n2); 14449c60d16SMark Cave-Ayland } 14549c60d16SMark Cave-Ayland n += n2; 14649c60d16SMark Cave-Ayland } 14749c60d16SMark Cave-Ayland 1487b320a8eSMark Cave-Ayland return n; 1497b320a8eSMark Cave-Ayland } 1507b320a8eSMark Cave-Ayland 151c47b5835SMark Cave-Ayland static uint32_t esp_get_tc(ESPState *s) 152c47b5835SMark Cave-Ayland { 153c47b5835SMark Cave-Ayland uint32_t dmalen; 154c47b5835SMark Cave-Ayland 155c47b5835SMark Cave-Ayland dmalen = s->rregs[ESP_TCLO]; 156c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCMID] << 8; 157c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCHI] << 16; 158c47b5835SMark Cave-Ayland 159c47b5835SMark Cave-Ayland return dmalen; 160c47b5835SMark Cave-Ayland } 161c47b5835SMark Cave-Ayland 162c47b5835SMark Cave-Ayland static void esp_set_tc(ESPState *s, uint32_t dmalen) 163c47b5835SMark Cave-Ayland { 164c5d7df28SMark Cave-Ayland uint32_t old_tc = esp_get_tc(s); 165c5d7df28SMark Cave-Ayland 166c47b5835SMark Cave-Ayland s->rregs[ESP_TCLO] = dmalen; 167c47b5835SMark Cave-Ayland s->rregs[ESP_TCMID] = dmalen >> 8; 168c47b5835SMark Cave-Ayland s->rregs[ESP_TCHI] = dmalen >> 16; 169c5d7df28SMark Cave-Ayland 170c5d7df28SMark Cave-Ayland if (old_tc && dmalen == 0) { 171c5d7df28SMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 172c5d7df28SMark Cave-Ayland } 173c47b5835SMark Cave-Ayland } 174c47b5835SMark Cave-Ayland 175c04ed569SMark Cave-Ayland static uint32_t esp_get_stc(ESPState *s) 176c04ed569SMark Cave-Ayland { 177c04ed569SMark Cave-Ayland uint32_t dmalen; 178c04ed569SMark Cave-Ayland 179c04ed569SMark Cave-Ayland dmalen = s->wregs[ESP_TCLO]; 180c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCMID] << 8; 181c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCHI] << 16; 182c04ed569SMark Cave-Ayland 183c04ed569SMark Cave-Ayland return dmalen; 184c04ed569SMark Cave-Ayland } 185c04ed569SMark Cave-Ayland 186abc139cdSMark Cave-Ayland static const char *esp_phase_names[8] = { 187abc139cdSMark Cave-Ayland "DATA OUT", "DATA IN", "COMMAND", "STATUS", 188abc139cdSMark Cave-Ayland "(reserved)", "(reserved)", "MESSAGE OUT", "MESSAGE IN" 189abc139cdSMark Cave-Ayland }; 190abc139cdSMark Cave-Ayland 191abc139cdSMark Cave-Ayland static void esp_set_phase(ESPState *s, uint8_t phase) 192abc139cdSMark Cave-Ayland { 193abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] &= ~7; 194abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= phase; 195abc139cdSMark Cave-Ayland 196abc139cdSMark Cave-Ayland trace_esp_set_phase(esp_phase_names[phase]); 197abc139cdSMark Cave-Ayland } 198abc139cdSMark Cave-Ayland 1995a83e83eSMark Cave-Ayland static uint8_t esp_get_phase(ESPState *s) 2005a83e83eSMark Cave-Ayland { 2015a83e83eSMark Cave-Ayland return s->rregs[ESP_RSTAT] & 7; 2025a83e83eSMark Cave-Ayland } 2035a83e83eSMark Cave-Ayland 204761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 205761bef75SMark Cave-Ayland { 2068da90e81SMark Cave-Ayland uint8_t val; 2078da90e81SMark Cave-Ayland 208c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->fifo); 2098da90e81SMark Cave-Ayland return val; 210761bef75SMark Cave-Ayland } 211761bef75SMark Cave-Ayland 212761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 213761bef75SMark Cave-Ayland { 2148da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 2158da90e81SMark Cave-Ayland 2163c421400SMark Cave-Ayland if (dmalen == 0) { 2178da90e81SMark Cave-Ayland return; 2188da90e81SMark Cave-Ayland } 2198da90e81SMark Cave-Ayland 220e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 2218da90e81SMark Cave-Ayland 2228da90e81SMark Cave-Ayland dmalen--; 2238da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 224761bef75SMark Cave-Ayland } 225761bef75SMark Cave-Ayland 22677987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb) 2271e794c51SMark Cave-Ayland { 2281e794c51SMark Cave-Ayland s->pdma_cb = cb; 2291e794c51SMark Cave-Ayland } 2301e794c51SMark Cave-Ayland 231c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2326130b188SLaurent Vivier { 2336130b188SLaurent Vivier int target; 2346130b188SLaurent Vivier 2356130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2366130b188SLaurent Vivier 2376130b188SLaurent Vivier s->ti_size = 0; 2386130b188SLaurent Vivier 239cf40a5e4SMark Cave-Ayland if (s->current_req) { 240cf40a5e4SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 241cf40a5e4SMark Cave-Ayland scsi_req_cancel(s->current_req); 242cf40a5e4SMark Cave-Ayland } 243cf40a5e4SMark Cave-Ayland 2446130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 2456130b188SLaurent Vivier if (!s->current_dev) { 2466130b188SLaurent Vivier /* No such drive */ 2476130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 248cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 2496130b188SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_0; 2506130b188SLaurent Vivier esp_raise_irq(s); 2516130b188SLaurent Vivier return -1; 2526130b188SLaurent Vivier } 2534e78f3bfSMark Cave-Ayland 2544e78f3bfSMark Cave-Ayland /* 2554e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 2564eb86065SPaolo Bonzini * either in do_command_phase() for DATA OUT transfers or by the deferred 2574e78f3bfSMark Cave-Ayland * IRQ mechanism in esp_transfer_data() for DATA IN transfers 2584e78f3bfSMark Cave-Ayland */ 2594e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 2604e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 2616130b188SLaurent Vivier return 0; 2626130b188SLaurent Vivier } 2636130b188SLaurent Vivier 26420c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen) 2652f275b8fSbellard { 266023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 267042879fcSMark Cave-Ayland uint32_t dmalen, n; 2682f275b8fSbellard int target; 2692f275b8fSbellard 2708dea1dd4Sblueswir1 target = s->wregs[ESP_WBUSID] & BUSID_DID; 2714f6200f0Sbellard if (s->dma) { 27220c8d2edSMark Cave-Ayland dmalen = MIN(esp_get_tc(s), maxlen); 27320c8d2edSMark Cave-Ayland if (dmalen == 0) { 2746c1fef6bSPrasad J Pandit return 0; 2756c1fef6bSPrasad J Pandit } 27674d71ea1SLaurent Vivier if (s->dma_memory_read) { 2778b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, buf, dmalen); 278fbc6510eSMark Cave-Ayland dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen); 279023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, dmalen); 280a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - dmalen); 2814f6200f0Sbellard } else { 28274d71ea1SLaurent Vivier return 0; 28374d71ea1SLaurent Vivier } 28474d71ea1SLaurent Vivier } else { 285023666daSMark Cave-Ayland dmalen = MIN(fifo8_num_used(&s->fifo), maxlen); 28620c8d2edSMark Cave-Ayland if (dmalen == 0) { 287d3cdc491SPrasad J Pandit return 0; 288d3cdc491SPrasad J Pandit } 2897b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, dmalen); 290fbc6510eSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 2917b320a8eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 29220c8d2edSMark Cave-Ayland } 293bf4b9889SBlue Swirl trace_esp_get_cmd(dmalen, target); 2942e5d83bbSpbrook 2959f149aa9Spbrook return dmalen; 2969f149aa9Spbrook } 2979f149aa9Spbrook 2984eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 2999f149aa9Spbrook { 3007b320a8eSMark Cave-Ayland uint32_t cmdlen; 3019f149aa9Spbrook int32_t datalen; 302f48a7a6eSPaolo Bonzini SCSIDevice *current_lun; 3037b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 3049f149aa9Spbrook 3054eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 306023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 30799545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 30899545751SMark Cave-Ayland return; 30999545751SMark Cave-Ayland } 3107b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen); 311023666daSMark Cave-Ayland 3124eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 313b22f83d8SAlexandra Diupina if (!current_lun) { 314b22f83d8SAlexandra Diupina /* No such drive */ 315b22f83d8SAlexandra Diupina s->rregs[ESP_RSTAT] = 0; 316b22f83d8SAlexandra Diupina s->rregs[ESP_RINTR] = INTR_DC; 317b22f83d8SAlexandra Diupina s->rregs[ESP_RSEQ] = SEQ_0; 318b22f83d8SAlexandra Diupina esp_raise_irq(s); 319b22f83d8SAlexandra Diupina return; 320b22f83d8SAlexandra Diupina } 321b22f83d8SAlexandra Diupina 322fe9d8927SJohn Millikin s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s); 323c39ce112SPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 32467e999beSbellard s->ti_size = datalen; 325023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 32667e999beSbellard if (datalen != 0) { 3271b9e48a5SMark Cave-Ayland s->ti_cmd = 0; 3282e5d83bbSpbrook if (datalen > 0) { 3294e78f3bfSMark Cave-Ayland /* 3304e78f3bfSMark Cave-Ayland * Switch to DATA IN phase but wait until initial data xfer is 3314e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3324e78f3bfSMark Cave-Ayland */ 3334e78f3bfSMark Cave-Ayland s->data_in_ready = false; 334abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DI); 3354f6200f0Sbellard } else { 336abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DO); 337cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 338c73f96fdSblueswir1 esp_raise_irq(s); 33982141c8bSMark Cave-Ayland esp_lower_drq(s); 3402f275b8fSbellard } 3414e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3424e78f3bfSMark Cave-Ayland return; 3434e78f3bfSMark Cave-Ayland } 3444e78f3bfSMark Cave-Ayland } 3452f275b8fSbellard 3464eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 347f2818f22SArtyom Tarasenko { 3484eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3494eb86065SPaolo Bonzini uint8_t message = esp_fifo_pop(&s->cmdfifo); 350023666daSMark Cave-Ayland 3514eb86065SPaolo Bonzini trace_esp_do_identify(message); 3524eb86065SPaolo Bonzini s->lun = message & 7; 353023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3544eb86065SPaolo Bonzini } 355f2818f22SArtyom Tarasenko 356799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 357023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3584eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 359fa7505c1SMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, NULL, len); 360023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 361023666daSMark Cave-Ayland } 3624eb86065SPaolo Bonzini } 363023666daSMark Cave-Ayland 3644eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3654eb86065SPaolo Bonzini { 3664eb86065SPaolo Bonzini do_message_phase(s); 3674eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3684eb86065SPaolo Bonzini do_command_phase(s); 369f2818f22SArtyom Tarasenko } 370f2818f22SArtyom Tarasenko 37174d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s) 37274d71ea1SLaurent Vivier { 3732572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 3742572689bSMark Cave-Ayland int n; 3752572689bSMark Cave-Ayland 3762572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 3772572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 3782572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 3792572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 3802572689bSMark Cave-Ayland 381e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 382023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 383e62a959aSMark Cave-Ayland s->do_cmd = 0; 384c959f218SMark Cave-Ayland do_cmd(s); 38574d71ea1SLaurent Vivier } 38674d71ea1SLaurent Vivier } 38774d71ea1SLaurent Vivier 3889f149aa9Spbrook static void handle_satn(ESPState *s) 3899f149aa9Spbrook { 39049691315SMark Cave-Ayland int32_t cmdlen; 39149691315SMark Cave-Ayland 3921b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 39373d74342SBlue Swirl s->dma_cb = handle_satn; 39473d74342SBlue Swirl return; 39573d74342SBlue Swirl } 39677987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_PDMA_CB); 3971bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3981bcaf71bSMark Cave-Ayland return; 3991bcaf71bSMark Cave-Ayland } 400023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 40149691315SMark Cave-Ayland if (cmdlen > 0) { 402023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 40360720694SMark Cave-Ayland s->do_cmd = 0; 404c959f218SMark Cave-Ayland do_cmd(s); 40549691315SMark Cave-Ayland } else if (cmdlen == 0) { 4061bcaf71bSMark Cave-Ayland if (s->dma) { 4071bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4081bcaf71bSMark Cave-Ayland } 409bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 41049691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 41149691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 412abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 4139f149aa9Spbrook } 41494d5c79dSMark Cave-Ayland } 4159f149aa9Spbrook 416f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s) 417f2818f22SArtyom Tarasenko { 41849691315SMark Cave-Ayland int32_t cmdlen; 41949691315SMark Cave-Ayland 4201b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 42173d74342SBlue Swirl s->dma_cb = handle_s_without_atn; 42273d74342SBlue Swirl return; 42373d74342SBlue Swirl } 42466fd5657SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 4251bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4261bcaf71bSMark Cave-Ayland return; 4271bcaf71bSMark Cave-Ayland } 428023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 42949691315SMark Cave-Ayland if (cmdlen > 0) { 430023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 43160720694SMark Cave-Ayland s->do_cmd = 0; 4324eb86065SPaolo Bonzini do_cmd(s); 43349691315SMark Cave-Ayland } else if (cmdlen == 0) { 4341bcaf71bSMark Cave-Ayland if (s->dma) { 4351bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4361bcaf71bSMark Cave-Ayland } 437bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 43849691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 43949691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 440abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 441f2818f22SArtyom Tarasenko } 442f2818f22SArtyom Tarasenko } 443f2818f22SArtyom Tarasenko 44474d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s) 44574d71ea1SLaurent Vivier { 4462572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 4472572689bSMark Cave-Ayland int n; 4482572689bSMark Cave-Ayland 4492572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 4502572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 4512572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 4522572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 4532572689bSMark Cave-Ayland 454e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 455023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 45674d71ea1SLaurent Vivier s->do_cmd = 1; 457023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 458abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 459abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 460cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 46174d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 46274d71ea1SLaurent Vivier esp_raise_irq(s); 46374d71ea1SLaurent Vivier } 46474d71ea1SLaurent Vivier } 46574d71ea1SLaurent Vivier 4669f149aa9Spbrook static void handle_satn_stop(ESPState *s) 4679f149aa9Spbrook { 46849691315SMark Cave-Ayland int32_t cmdlen; 46949691315SMark Cave-Ayland 4701b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 47173d74342SBlue Swirl s->dma_cb = handle_satn_stop; 47273d74342SBlue Swirl return; 47373d74342SBlue Swirl } 47477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_STOP_PDMA_CB); 4751bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4761bcaf71bSMark Cave-Ayland return; 4771bcaf71bSMark Cave-Ayland } 478799d90d8SMark Cave-Ayland cmdlen = get_cmd(s, 1); 47949691315SMark Cave-Ayland if (cmdlen > 0) { 480023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 4819f149aa9Spbrook s->do_cmd = 1; 482023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 483abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 484cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 485799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 486c73f96fdSblueswir1 esp_raise_irq(s); 48749691315SMark Cave-Ayland } else if (cmdlen == 0) { 4881bcaf71bSMark Cave-Ayland if (s->dma) { 4891bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4901bcaf71bSMark Cave-Ayland } 491bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 492799d90d8SMark Cave-Ayland /* Target present, switch to message out phase */ 493799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 494abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 4959f149aa9Spbrook } 4969f149aa9Spbrook } 4979f149aa9Spbrook 49874d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s) 49974d71ea1SLaurent Vivier { 500abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 501cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 50274d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 50374d71ea1SLaurent Vivier esp_raise_irq(s); 50474d71ea1SLaurent Vivier } 50574d71ea1SLaurent Vivier 5060fc5c15aSpbrook static void write_response(ESPState *s) 5072f275b8fSbellard { 508e3922557SMark Cave-Ayland uint8_t buf[2]; 509042879fcSMark Cave-Ayland 510bf4b9889SBlue Swirl trace_esp_write_response(s->status); 511042879fcSMark Cave-Ayland 512e3922557SMark Cave-Ayland buf[0] = s->status; 513e3922557SMark Cave-Ayland buf[1] = 0; 514042879fcSMark Cave-Ayland 5154f6200f0Sbellard if (s->dma) { 51674d71ea1SLaurent Vivier if (s->dma_memory_write) { 517e3922557SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, 2); 518abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 519cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 5205ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 5214f6200f0Sbellard } else { 52277987ef5SMark Cave-Ayland esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB); 52374d71ea1SLaurent Vivier esp_raise_drq(s); 52474d71ea1SLaurent Vivier return; 52574d71ea1SLaurent Vivier } 52674d71ea1SLaurent Vivier } else { 527e3922557SMark Cave-Ayland fifo8_reset(&s->fifo); 528e3922557SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, 2); 5295ad6bb97Sblueswir1 s->rregs[ESP_RFLAGS] = 2; 5304f6200f0Sbellard } 531c73f96fdSblueswir1 esp_raise_irq(s); 5322f275b8fSbellard } 5334f6200f0Sbellard 534004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s) 5354d611c9aSpbrook { 536af74b3c1SMark Cave-Ayland if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) { 537cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 538c73f96fdSblueswir1 esp_raise_irq(s); 539af74b3c1SMark Cave-Ayland esp_lower_drq(s); 540af74b3c1SMark Cave-Ayland } 5414d611c9aSpbrook } 542a917d384Spbrook 54374d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s) 54474d71ea1SLaurent Vivier { 5452572689bSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 54682141c8bSMark Cave-Ayland int len; 547042879fcSMark Cave-Ayland uint32_t n; 5486cc88d6bSMark Cave-Ayland 54974d71ea1SLaurent Vivier if (s->do_cmd) { 5502572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 5512572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 5522572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 5532572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 5542572689bSMark Cave-Ayland 555e62a959aSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 556e62a959aSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 557e62a959aSMark Cave-Ayland return; 558e62a959aSMark Cave-Ayland } 559e62a959aSMark Cave-Ayland 56074d71ea1SLaurent Vivier s->ti_size = 0; 5615a83e83eSMark Cave-Ayland if (esp_get_phase(s) == STAT_CD) { 562c348458fSMark Cave-Ayland /* No command received */ 563c348458fSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 564c348458fSMark Cave-Ayland return; 565c348458fSMark Cave-Ayland } 566c348458fSMark Cave-Ayland 567c348458fSMark Cave-Ayland /* Command has been received */ 56874d71ea1SLaurent Vivier s->do_cmd = 0; 569c959f218SMark Cave-Ayland do_cmd(s); 570c348458fSMark Cave-Ayland } else { 571c348458fSMark Cave-Ayland /* 572c348458fSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 5732cb40d44SStefan Weil * and then switch to command phase 574c348458fSMark Cave-Ayland */ 575c348458fSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 576abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 577c348458fSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 578c348458fSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 579c348458fSMark Cave-Ayland esp_raise_irq(s); 580c348458fSMark Cave-Ayland } 58174d71ea1SLaurent Vivier return; 58274d71ea1SLaurent Vivier } 58382141c8bSMark Cave-Ayland 584844b3a84SMark Cave-Ayland switch (esp_get_phase(s)) { 585844b3a84SMark Cave-Ayland case STAT_DO: 5860db89536SMark Cave-Ayland if (!s->current_req) { 5870db89536SMark Cave-Ayland return; 5880db89536SMark Cave-Ayland } 58982141c8bSMark Cave-Ayland /* Copy FIFO data to device */ 5907aa6baeeSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 5917aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 5927b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5937aa6baeeSMark Cave-Ayland s->async_buf += n; 5947aa6baeeSMark Cave-Ayland s->async_len -= n; 5957aa6baeeSMark Cave-Ayland s->ti_size += n; 5967aa6baeeSMark Cave-Ayland 597e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 598e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 59974d71ea1SLaurent Vivier scsi_req_continue(s->current_req); 60082141c8bSMark Cave-Ayland return; 60182141c8bSMark Cave-Ayland } 60282141c8bSMark Cave-Ayland 603004826d0SMark Cave-Ayland esp_dma_ti_check(s); 604844b3a84SMark Cave-Ayland break; 605844b3a84SMark Cave-Ayland 606844b3a84SMark Cave-Ayland case STAT_DI: 607844b3a84SMark Cave-Ayland if (!s->current_req) { 608844b3a84SMark Cave-Ayland return; 609844b3a84SMark Cave-Ayland } 61082141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 6117aa6baeeSMark Cave-Ayland len = MIN(s->async_len, esp_get_tc(s)); 6127aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 613042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 61482141c8bSMark Cave-Ayland s->async_buf += len; 61582141c8bSMark Cave-Ayland s->async_len -= len; 61682141c8bSMark Cave-Ayland s->ti_size -= len; 61782141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 6181b2e34caSMark Cave-Ayland 6191b2e34caSMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 6201b2e34caSMark Cave-Ayland /* Defer until the scsi layer has completed */ 6211b2e34caSMark Cave-Ayland scsi_req_continue(s->current_req); 6221b2e34caSMark Cave-Ayland s->data_in_ready = false; 6231b2e34caSMark Cave-Ayland return; 6241b2e34caSMark Cave-Ayland } 6251b2e34caSMark Cave-Ayland 6261b2e34caSMark Cave-Ayland esp_dma_ti_check(s); 627844b3a84SMark Cave-Ayland break; 62874d71ea1SLaurent Vivier } 62982141c8bSMark Cave-Ayland } 63074d71ea1SLaurent Vivier 631a917d384Spbrook static void esp_do_dma(ESPState *s) 632a917d384Spbrook { 633023666daSMark Cave-Ayland uint32_t len, cmdlen; 634023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 63519e9afb1SMark Cave-Ayland int n; 636a917d384Spbrook 6376cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 638a917d384Spbrook if (s->do_cmd) { 63915407433SLaurent Vivier /* 64015407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 64115407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 64215407433SLaurent Vivier */ 643023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 644023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 64574d71ea1SLaurent Vivier if (s->dma_memory_read) { 6460ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 647023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 648023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 649a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 65074d71ea1SLaurent Vivier } else { 6513c7f3c8bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 6523c7f3c8bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 6533c7f3c8bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 6543c7f3c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - n); 6553c7f3c8bSMark Cave-Ayland 65677987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 65774d71ea1SLaurent Vivier esp_raise_drq(s); 6583c7f3c8bSMark Cave-Ayland 6593c7f3c8bSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 6603c7f3c8bSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 66174d71ea1SLaurent Vivier return; 66274d71ea1SLaurent Vivier } 6633c7f3c8bSMark Cave-Ayland } 664023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 66515407433SLaurent Vivier s->ti_size = 0; 6665a83e83eSMark Cave-Ayland if (esp_get_phase(s) == STAT_CD) { 667799d90d8SMark Cave-Ayland /* No command received */ 668023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 669799d90d8SMark Cave-Ayland return; 670799d90d8SMark Cave-Ayland } 671799d90d8SMark Cave-Ayland 672799d90d8SMark Cave-Ayland /* Command has been received */ 67315407433SLaurent Vivier s->do_cmd = 0; 674c959f218SMark Cave-Ayland do_cmd(s); 675799d90d8SMark Cave-Ayland } else { 676799d90d8SMark Cave-Ayland /* 677023666daSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 6782cb40d44SStefan Weil * and then switch to command phase 679799d90d8SMark Cave-Ayland */ 680023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 681abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 682799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 683799d90d8SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 684799d90d8SMark Cave-Ayland esp_raise_irq(s); 685799d90d8SMark Cave-Ayland } 686a917d384Spbrook return; 687a917d384Spbrook } 6881454dc76SMark Cave-Ayland 6891454dc76SMark Cave-Ayland switch (esp_get_phase(s)) { 6901454dc76SMark Cave-Ayland case STAT_DO: 6910db89536SMark Cave-Ayland if (!s->current_req) { 6920db89536SMark Cave-Ayland return; 6930db89536SMark Cave-Ayland } 6944460b86aSMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 695a917d384Spbrook /* Defer until data is available. */ 696a917d384Spbrook return; 697a917d384Spbrook } 698a917d384Spbrook if (len > s->async_len) { 699a917d384Spbrook len = s->async_len; 700a917d384Spbrook } 70174d71ea1SLaurent Vivier if (s->dma_memory_read) { 7028b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, s->async_buf, len); 703f3666223SMark Cave-Ayland 704f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 705f3666223SMark Cave-Ayland s->async_buf += len; 706f3666223SMark Cave-Ayland s->async_len -= len; 707f3666223SMark Cave-Ayland s->ti_size += len; 708f3666223SMark Cave-Ayland 709e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 710e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 711f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 712f3666223SMark Cave-Ayland return; 713f3666223SMark Cave-Ayland } 714f3666223SMark Cave-Ayland 715004826d0SMark Cave-Ayland esp_dma_ti_check(s); 716a917d384Spbrook } else { 71719e9afb1SMark Cave-Ayland /* Copy FIFO data to device */ 71819e9afb1SMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 71919e9afb1SMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 72019e9afb1SMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 72119e9afb1SMark Cave-Ayland s->async_buf += n; 72219e9afb1SMark Cave-Ayland s->async_len -= n; 72319e9afb1SMark Cave-Ayland s->ti_size += n; 72419e9afb1SMark Cave-Ayland 72577987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 72674d71ea1SLaurent Vivier esp_raise_drq(s); 727e4e166c8SMark Cave-Ayland 728e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 729e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 730e4e166c8SMark Cave-Ayland scsi_req_continue(s->current_req); 731e4e166c8SMark Cave-Ayland return; 732e4e166c8SMark Cave-Ayland } 733e4e166c8SMark Cave-Ayland 734004826d0SMark Cave-Ayland esp_dma_ti_check(s); 73574d71ea1SLaurent Vivier } 7361454dc76SMark Cave-Ayland break; 7371454dc76SMark Cave-Ayland 7381454dc76SMark Cave-Ayland case STAT_DI: 7391454dc76SMark Cave-Ayland if (!s->current_req) { 7401454dc76SMark Cave-Ayland return; 7411454dc76SMark Cave-Ayland } 7421454dc76SMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 7431454dc76SMark Cave-Ayland /* Defer until data is available. */ 7441454dc76SMark Cave-Ayland return; 7451454dc76SMark Cave-Ayland } 7461454dc76SMark Cave-Ayland if (len > s->async_len) { 7471454dc76SMark Cave-Ayland len = s->async_len; 7481454dc76SMark Cave-Ayland } 74974d71ea1SLaurent Vivier if (s->dma_memory_write) { 7508b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->async_buf, len); 751f3666223SMark Cave-Ayland 752f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 753f3666223SMark Cave-Ayland s->async_buf += len; 754f3666223SMark Cave-Ayland s->async_len -= len; 755f3666223SMark Cave-Ayland s->ti_size -= len; 756f3666223SMark Cave-Ayland 757e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 758e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 759f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 760fabcba49SMark Cave-Ayland return; 761f3666223SMark Cave-Ayland } 762f3666223SMark Cave-Ayland 763004826d0SMark Cave-Ayland esp_dma_ti_check(s); 76474d71ea1SLaurent Vivier } else { 76582141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 766042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 767042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 76882141c8bSMark Cave-Ayland s->async_buf += len; 76982141c8bSMark Cave-Ayland s->async_len -= len; 77082141c8bSMark Cave-Ayland s->ti_size -= len; 77182141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 77277987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 77374d71ea1SLaurent Vivier esp_raise_drq(s); 774e4e166c8SMark Cave-Ayland 775e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 776e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 777e4e166c8SMark Cave-Ayland scsi_req_continue(s->current_req); 778e4e166c8SMark Cave-Ayland return; 779e4e166c8SMark Cave-Ayland } 780e4e166c8SMark Cave-Ayland 781004826d0SMark Cave-Ayland esp_dma_ti_check(s); 782e4e166c8SMark Cave-Ayland } 7831454dc76SMark Cave-Ayland break; 78474d71ea1SLaurent Vivier } 785a917d384Spbrook } 786a917d384Spbrook 7871b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7881b9e48a5SMark Cave-Ayland { 7892572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 7907b320a8eSMark Cave-Ayland uint32_t cmdlen; 7912572689bSMark Cave-Ayland int len, n; 7921b9e48a5SMark Cave-Ayland 7931b9e48a5SMark Cave-Ayland if (s->do_cmd) { 7942572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 7952572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 7962572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 7972572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 7982572689bSMark Cave-Ayland 7991b9e48a5SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 8001b9e48a5SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 8011b9e48a5SMark Cave-Ayland s->ti_size = 0; 8025a83e83eSMark Cave-Ayland if (esp_get_phase(s) == STAT_CD) { 8031b9e48a5SMark Cave-Ayland /* No command received */ 8041b9e48a5SMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 8051b9e48a5SMark Cave-Ayland return; 8061b9e48a5SMark Cave-Ayland } 8071b9e48a5SMark Cave-Ayland 8081b9e48a5SMark Cave-Ayland /* Command has been received */ 8091b9e48a5SMark Cave-Ayland s->do_cmd = 0; 8101b9e48a5SMark Cave-Ayland do_cmd(s); 8111b9e48a5SMark Cave-Ayland } else { 8121b9e48a5SMark Cave-Ayland /* 8131b9e48a5SMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 8142cb40d44SStefan Weil * and then switch to command phase 8151b9e48a5SMark Cave-Ayland */ 8161b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 817abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 8181b9e48a5SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 8191b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8201b9e48a5SMark Cave-Ayland esp_raise_irq(s); 8211b9e48a5SMark Cave-Ayland } 8221b9e48a5SMark Cave-Ayland return; 8231b9e48a5SMark Cave-Ayland } 8241b9e48a5SMark Cave-Ayland 825*9d1aa52bSMark Cave-Ayland switch (esp_get_phase(s)) { 826*9d1aa52bSMark Cave-Ayland case STAT_DO: 8270db89536SMark Cave-Ayland if (!s->current_req) { 8280db89536SMark Cave-Ayland return; 8290db89536SMark Cave-Ayland } 8301b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8311b9e48a5SMark Cave-Ayland /* Defer until data is available. */ 8321b9e48a5SMark Cave-Ayland return; 8331b9e48a5SMark Cave-Ayland } 83477668e4bSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 83577668e4bSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 8367b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 8371b9e48a5SMark Cave-Ayland s->async_buf += len; 8381b9e48a5SMark Cave-Ayland s->async_len -= len; 8391b9e48a5SMark Cave-Ayland s->ti_size += len; 840*9d1aa52bSMark Cave-Ayland 841*9d1aa52bSMark Cave-Ayland if (s->async_len == 0) { 842*9d1aa52bSMark Cave-Ayland scsi_req_continue(s->current_req); 843*9d1aa52bSMark Cave-Ayland return; 844*9d1aa52bSMark Cave-Ayland } 845*9d1aa52bSMark Cave-Ayland 846*9d1aa52bSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 847*9d1aa52bSMark Cave-Ayland esp_raise_irq(s); 848*9d1aa52bSMark Cave-Ayland break; 849*9d1aa52bSMark Cave-Ayland 850*9d1aa52bSMark Cave-Ayland case STAT_DI: 851*9d1aa52bSMark Cave-Ayland if (!s->current_req) { 852*9d1aa52bSMark Cave-Ayland return; 853*9d1aa52bSMark Cave-Ayland } 854*9d1aa52bSMark Cave-Ayland if (s->async_len == 0) { 855*9d1aa52bSMark Cave-Ayland /* Defer until data is available. */ 856*9d1aa52bSMark Cave-Ayland return; 857*9d1aa52bSMark Cave-Ayland } 8586ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 8596ef2cabcSMark Cave-Ayland fifo8_push(&s->fifo, s->async_buf[0]); 8606ef2cabcSMark Cave-Ayland s->async_buf++; 8616ef2cabcSMark Cave-Ayland s->async_len--; 8626ef2cabcSMark Cave-Ayland s->ti_size--; 8636ef2cabcSMark Cave-Ayland } 8641b9e48a5SMark Cave-Ayland 8651b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8661b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 8671b9e48a5SMark Cave-Ayland return; 8681b9e48a5SMark Cave-Ayland } 8691b9e48a5SMark Cave-Ayland 8701b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8711b9e48a5SMark Cave-Ayland esp_raise_irq(s); 872*9d1aa52bSMark Cave-Ayland break; 873*9d1aa52bSMark Cave-Ayland } 8741b9e48a5SMark Cave-Ayland } 8751b9e48a5SMark Cave-Ayland 87677987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s) 87777987ef5SMark Cave-Ayland { 87877987ef5SMark Cave-Ayland switch (s->pdma_cb) { 87977987ef5SMark Cave-Ayland case SATN_PDMA_CB: 88077987ef5SMark Cave-Ayland satn_pdma_cb(s); 88177987ef5SMark Cave-Ayland break; 88277987ef5SMark Cave-Ayland case SATN_STOP_PDMA_CB: 88377987ef5SMark Cave-Ayland satn_stop_pdma_cb(s); 88477987ef5SMark Cave-Ayland break; 88577987ef5SMark Cave-Ayland case WRITE_RESPONSE_PDMA_CB: 88677987ef5SMark Cave-Ayland write_response_pdma_cb(s); 88777987ef5SMark Cave-Ayland break; 88877987ef5SMark Cave-Ayland case DO_DMA_PDMA_CB: 88977987ef5SMark Cave-Ayland do_dma_pdma_cb(s); 89077987ef5SMark Cave-Ayland break; 89177987ef5SMark Cave-Ayland default: 89277987ef5SMark Cave-Ayland g_assert_not_reached(); 89377987ef5SMark Cave-Ayland } 89477987ef5SMark Cave-Ayland } 89577987ef5SMark Cave-Ayland 8964aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 897a917d384Spbrook { 8984aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 8995a83e83eSMark Cave-Ayland int to_device = (esp_get_phase(s) == STAT_DO); 9004aaa6ac3SMark Cave-Ayland 901bf4b9889SBlue Swirl trace_esp_command_complete(); 9026ef2cabcSMark Cave-Ayland 9036ef2cabcSMark Cave-Ayland /* 9046ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 9056ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 9066ef2cabcSMark Cave-Ayland */ 9076ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 908c6df7102SPaolo Bonzini if (s->ti_size != 0) { 909bf4b9889SBlue Swirl trace_esp_command_complete_unexpected(); 910c6df7102SPaolo Bonzini } 9116ef2cabcSMark Cave-Ayland } 9126ef2cabcSMark Cave-Ayland 913a917d384Spbrook s->async_len = 0; 9144aaa6ac3SMark Cave-Ayland if (req->status) { 915bf4b9889SBlue Swirl trace_esp_command_complete_fail(); 916c6df7102SPaolo Bonzini } 9174aaa6ac3SMark Cave-Ayland s->status = req->status; 9186ef2cabcSMark Cave-Ayland 9196ef2cabcSMark Cave-Ayland /* 920cb988199SMark Cave-Ayland * Switch to status phase. For non-DMA transfers from the target the last 921cb988199SMark Cave-Ayland * byte is still in the FIFO 9226ef2cabcSMark Cave-Ayland */ 923abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 924cb988199SMark Cave-Ayland if (s->ti_size == 0) { 925cb988199SMark Cave-Ayland /* 926cb988199SMark Cave-Ayland * Transfer complete: force TC to zero just in case a TI command was 927cb988199SMark Cave-Ayland * requested for more data than the command returns (Solaris 8 does 928cb988199SMark Cave-Ayland * this) 929cb988199SMark Cave-Ayland */ 930cb988199SMark Cave-Ayland esp_set_tc(s, 0); 931004826d0SMark Cave-Ayland esp_dma_ti_check(s); 932cb988199SMark Cave-Ayland } else { 933cb988199SMark Cave-Ayland /* 934cb988199SMark Cave-Ayland * Transfer truncated: raise INTR_BS to indicate early change of 935cb988199SMark Cave-Ayland * phase 936cb988199SMark Cave-Ayland */ 937cb988199SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 938cb988199SMark Cave-Ayland esp_raise_irq(s); 939cb988199SMark Cave-Ayland s->ti_size = 0; 9406ef2cabcSMark Cave-Ayland } 9416ef2cabcSMark Cave-Ayland 9425c6c0e51SHannes Reinecke if (s->current_req) { 9435c6c0e51SHannes Reinecke scsi_req_unref(s->current_req); 9445c6c0e51SHannes Reinecke s->current_req = NULL; 945a917d384Spbrook s->current_dev = NULL; 9465c6c0e51SHannes Reinecke } 947c6df7102SPaolo Bonzini } 948c6df7102SPaolo Bonzini 9499c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len) 950c6df7102SPaolo Bonzini { 951e6810db8SHervé Poussineau ESPState *s = req->hba_private; 9525a83e83eSMark Cave-Ayland int to_device = (esp_get_phase(s) == STAT_DO); 9536cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 954c6df7102SPaolo Bonzini 9557f0b6e11SPaolo Bonzini assert(!s->do_cmd); 9566cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 957aba1f023SPaolo Bonzini s->async_len = len; 9580c34459bSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 9594e78f3bfSMark Cave-Ayland 9604e78f3bfSMark Cave-Ayland if (!to_device && !s->data_in_ready) { 9614e78f3bfSMark Cave-Ayland /* 9624e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 9634e78f3bfSMark Cave-Ayland * completion interrupt 9644e78f3bfSMark Cave-Ayland */ 9654e78f3bfSMark Cave-Ayland s->data_in_ready = true; 9664e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 9674e78f3bfSMark Cave-Ayland esp_raise_irq(s); 9684e78f3bfSMark Cave-Ayland } 9694e78f3bfSMark Cave-Ayland 9701b9e48a5SMark Cave-Ayland /* 9711b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 9721b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 9731b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 9741b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 9751b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 9761b9e48a5SMark Cave-Ayland */ 9771b9e48a5SMark Cave-Ayland 978880d3089SMark Cave-Ayland if (s->ti_cmd == (CMD_TI | CMD_DMA)) { 979a79e767aSMark Cave-Ayland /* When the SCSI layer returns more data, raise deferred INTR_BS */ 980004826d0SMark Cave-Ayland esp_dma_ti_check(s); 981a79e767aSMark Cave-Ayland 982a79e767aSMark Cave-Ayland esp_do_dma(s); 983880d3089SMark Cave-Ayland } else if (s->ti_cmd == CMD_TI) { 9841b9e48a5SMark Cave-Ayland esp_do_nodma(s); 9851b9e48a5SMark Cave-Ayland } 986a917d384Spbrook } 9872e5d83bbSpbrook 9882f275b8fSbellard static void handle_ti(ESPState *s) 9892f275b8fSbellard { 9901b9e48a5SMark Cave-Ayland uint32_t dmalen; 9912f275b8fSbellard 9927246e160SHervé Poussineau if (s->dma && !s->dma_enabled) { 9937246e160SHervé Poussineau s->dma_cb = handle_ti; 9947246e160SHervé Poussineau return; 9957246e160SHervé Poussineau } 9967246e160SHervé Poussineau 9971b9e48a5SMark Cave-Ayland s->ti_cmd = s->rregs[ESP_CMD]; 9984f6200f0Sbellard if (s->dma) { 9991b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 1000b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 10014d611c9aSpbrook esp_do_dma(s); 1002799d90d8SMark Cave-Ayland } else { 10031b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 10041b9e48a5SMark Cave-Ayland esp_do_nodma(s); 10054f6200f0Sbellard } 10062f275b8fSbellard } 10072f275b8fSbellard 10089c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s) 10096f7e9aecSbellard { 10105aca8c3bSblueswir1 memset(s->rregs, 0, ESP_REGS); 10115aca8c3bSblueswir1 memset(s->wregs, 0, ESP_REGS); 1012c9cf45c1SHannes Reinecke s->tchi_written = 0; 10134e9aec74Spbrook s->ti_size = 0; 10143f26c975SMark Cave-Ayland s->async_len = 0; 1015042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 1016023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 10174e9aec74Spbrook s->dma = 0; 10189f149aa9Spbrook s->do_cmd = 0; 101973d74342SBlue Swirl s->dma_cb = NULL; 10208dea1dd4Sblueswir1 10218dea1dd4Sblueswir1 s->rregs[ESP_CFG1] = 7; 10226f7e9aecSbellard } 10236f7e9aecSbellard 1024a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s) 102585948643SBlue Swirl { 102685948643SBlue Swirl qemu_irq_lower(s->irq); 102774d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 1028a391fdbcSHervé Poussineau esp_hard_reset(s); 102985948643SBlue Swirl } 103085948643SBlue Swirl 1031c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s) 1032c6e51f1bSJohn Millikin { 10334a5fc890SPeter Maydell bus_cold_reset(BUS(&s->bus)); 1034c6e51f1bSJohn Millikin } 1035c6e51f1bSJohn Millikin 1036a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level) 10372d069babSblueswir1 { 103885948643SBlue Swirl if (level) { 1039a391fdbcSHervé Poussineau esp_soft_reset(s); 104085948643SBlue Swirl } 10412d069babSblueswir1 } 10422d069babSblueswir1 1043f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s) 1044f21fe39dSMark Cave-Ayland { 1045f21fe39dSMark Cave-Ayland uint8_t cmd = s->rregs[ESP_CMD]; 1046f21fe39dSMark Cave-Ayland 1047f21fe39dSMark Cave-Ayland if (cmd & CMD_DMA) { 1048f21fe39dSMark Cave-Ayland s->dma = 1; 1049f21fe39dSMark Cave-Ayland /* Reload DMA counter. */ 1050f21fe39dSMark Cave-Ayland if (esp_get_stc(s) == 0) { 1051f21fe39dSMark Cave-Ayland esp_set_tc(s, 0x10000); 1052f21fe39dSMark Cave-Ayland } else { 1053f21fe39dSMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 1054f21fe39dSMark Cave-Ayland } 1055f21fe39dSMark Cave-Ayland } else { 1056f21fe39dSMark Cave-Ayland s->dma = 0; 1057f21fe39dSMark Cave-Ayland } 1058f21fe39dSMark Cave-Ayland switch (cmd & CMD_CMD) { 1059f21fe39dSMark Cave-Ayland case CMD_NOP: 1060f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_nop(cmd); 1061f21fe39dSMark Cave-Ayland break; 1062f21fe39dSMark Cave-Ayland case CMD_FLUSH: 1063f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_flush(cmd); 1064f21fe39dSMark Cave-Ayland fifo8_reset(&s->fifo); 1065f21fe39dSMark Cave-Ayland break; 1066f21fe39dSMark Cave-Ayland case CMD_RESET: 1067f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_reset(cmd); 1068f21fe39dSMark Cave-Ayland esp_soft_reset(s); 1069f21fe39dSMark Cave-Ayland break; 1070f21fe39dSMark Cave-Ayland case CMD_BUSRESET: 1071f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_bus_reset(cmd); 1072f21fe39dSMark Cave-Ayland esp_bus_reset(s); 1073f21fe39dSMark Cave-Ayland if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1074f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 1075f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1076f21fe39dSMark Cave-Ayland } 1077f21fe39dSMark Cave-Ayland break; 1078f21fe39dSMark Cave-Ayland case CMD_TI: 1079f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(cmd); 1080f21fe39dSMark Cave-Ayland handle_ti(s); 1081f21fe39dSMark Cave-Ayland break; 1082f21fe39dSMark Cave-Ayland case CMD_ICCS: 1083f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_iccs(cmd); 1084f21fe39dSMark Cave-Ayland write_response(s); 1085f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1086abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MI); 1087f21fe39dSMark Cave-Ayland break; 1088f21fe39dSMark Cave-Ayland case CMD_MSGACC: 1089f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_msgacc(cmd); 1090f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 1091f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1092f21fe39dSMark Cave-Ayland s->rregs[ESP_RFLAGS] = 0; 1093f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1094f21fe39dSMark Cave-Ayland break; 1095f21fe39dSMark Cave-Ayland case CMD_PAD: 1096f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_pad(cmd); 1097f21fe39dSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC; 1098f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1099f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1100f21fe39dSMark Cave-Ayland break; 1101f21fe39dSMark Cave-Ayland case CMD_SATN: 1102f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_satn(cmd); 1103f21fe39dSMark Cave-Ayland break; 1104f21fe39dSMark Cave-Ayland case CMD_RSTATN: 1105f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_rstatn(cmd); 1106f21fe39dSMark Cave-Ayland break; 1107f21fe39dSMark Cave-Ayland case CMD_SEL: 1108f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_sel(cmd); 1109f21fe39dSMark Cave-Ayland handle_s_without_atn(s); 1110f21fe39dSMark Cave-Ayland break; 1111f21fe39dSMark Cave-Ayland case CMD_SELATN: 1112f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatn(cmd); 1113f21fe39dSMark Cave-Ayland handle_satn(s); 1114f21fe39dSMark Cave-Ayland break; 1115f21fe39dSMark Cave-Ayland case CMD_SELATNS: 1116f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatns(cmd); 1117f21fe39dSMark Cave-Ayland handle_satn_stop(s); 1118f21fe39dSMark Cave-Ayland break; 1119f21fe39dSMark Cave-Ayland case CMD_ENSEL: 1120f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ensel(cmd); 1121f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1122f21fe39dSMark Cave-Ayland break; 1123f21fe39dSMark Cave-Ayland case CMD_DISSEL: 1124f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_dissel(cmd); 1125f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1126f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1127f21fe39dSMark Cave-Ayland break; 1128f21fe39dSMark Cave-Ayland default: 1129f21fe39dSMark Cave-Ayland trace_esp_error_unhandled_command(cmd); 1130f21fe39dSMark Cave-Ayland break; 1131f21fe39dSMark Cave-Ayland } 1132f21fe39dSMark Cave-Ayland } 1133f21fe39dSMark Cave-Ayland 11349c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 113573d74342SBlue Swirl { 1136b630c075SMark Cave-Ayland uint32_t val; 113773d74342SBlue Swirl 11386f7e9aecSbellard switch (saddr) { 11395ad6bb97Sblueswir1 case ESP_FIFO: 11401b9e48a5SMark Cave-Ayland if (s->dma_memory_read && s->dma_memory_write && 11411b9e48a5SMark Cave-Ayland (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 11428dea1dd4Sblueswir1 /* Data out. */ 1143ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 11445ad6bb97Sblueswir1 s->rregs[ESP_FIFO] = 0; 1145042879fcSMark Cave-Ayland } else { 11465a83e83eSMark Cave-Ayland if (esp_get_phase(s) == STAT_DI) { 11476ef2cabcSMark Cave-Ayland if (s->ti_size) { 11486ef2cabcSMark Cave-Ayland esp_do_nodma(s); 11496ef2cabcSMark Cave-Ayland } else { 11506ef2cabcSMark Cave-Ayland /* 11516ef2cabcSMark Cave-Ayland * The last byte of a non-DMA transfer has been read out 11526ef2cabcSMark Cave-Ayland * of the FIFO so switch to status phase 11536ef2cabcSMark Cave-Ayland */ 1154abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 11556ef2cabcSMark Cave-Ayland } 11566ef2cabcSMark Cave-Ayland } 1157c5fef911SMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo); 11584f6200f0Sbellard } 1159b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 11604f6200f0Sbellard break; 11615ad6bb97Sblueswir1 case ESP_RINTR: 116294d5c79dSMark Cave-Ayland /* 116394d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 116494d5c79dSMark Cave-Ayland * except TC 116594d5c79dSMark Cave-Ayland */ 1166b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 11672814df28SBlue Swirl s->rregs[ESP_RINTR] = 0; 11682814df28SBlue Swirl s->rregs[ESP_RSTAT] &= ~STAT_TC; 1169af947a3dSMark Cave-Ayland /* 1170af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 1171af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 1172af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 1173af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 1174af947a3dSMark Cave-Ayland * transition. 1175af947a3dSMark Cave-Ayland * 1176af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 1177af947a3dSMark Cave-Ayland */ 1178c73f96fdSblueswir1 esp_lower_irq(s); 1179b630c075SMark Cave-Ayland break; 1180c9cf45c1SHannes Reinecke case ESP_TCHI: 1181c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 1182c9cf45c1SHannes Reinecke if (!s->tchi_written) { 1183b630c075SMark Cave-Ayland val = s->chip_id; 1184b630c075SMark Cave-Ayland } else { 1185b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1186c9cf45c1SHannes Reinecke } 1187b630c075SMark Cave-Ayland break; 1188238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1189238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1190238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1191238ec4d7SMark Cave-Ayland break; 11926f7e9aecSbellard default: 1193b630c075SMark Cave-Ayland val = s->rregs[saddr]; 11946f7e9aecSbellard break; 11956f7e9aecSbellard } 1196b630c075SMark Cave-Ayland 1197b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1198b630c075SMark Cave-Ayland return val; 11996f7e9aecSbellard } 12006f7e9aecSbellard 12019c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 12026f7e9aecSbellard { 1203bf4b9889SBlue Swirl trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 12046f7e9aecSbellard switch (saddr) { 1205c9cf45c1SHannes Reinecke case ESP_TCHI: 1206c9cf45c1SHannes Reinecke s->tchi_written = true; 1207c9cf45c1SHannes Reinecke /* fall through */ 12085ad6bb97Sblueswir1 case ESP_TCLO: 12095ad6bb97Sblueswir1 case ESP_TCMID: 12105ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 12114f6200f0Sbellard break; 12125ad6bb97Sblueswir1 case ESP_FIFO: 12139f149aa9Spbrook if (s->do_cmd) { 12142572689bSMark Cave-Ayland if (!fifo8_is_full(&s->fifo)) { 12152572689bSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 12162572689bSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, fifo8_pop(&s->fifo)); 12172572689bSMark Cave-Ayland } 12186ef2cabcSMark Cave-Ayland 12196ef2cabcSMark Cave-Ayland /* 12206ef2cabcSMark Cave-Ayland * If any unexpected message out/command phase data is 12216ef2cabcSMark Cave-Ayland * transferred using non-DMA, raise the interrupt 12226ef2cabcSMark Cave-Ayland */ 12236ef2cabcSMark Cave-Ayland if (s->rregs[ESP_CMD] == CMD_TI) { 12246ef2cabcSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 12256ef2cabcSMark Cave-Ayland esp_raise_irq(s); 12266ef2cabcSMark Cave-Ayland } 12272e5d83bbSpbrook } else { 1228e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 12292e5d83bbSpbrook } 12304f6200f0Sbellard break; 12315ad6bb97Sblueswir1 case ESP_CMD: 12324f6200f0Sbellard s->rregs[saddr] = val; 1233f21fe39dSMark Cave-Ayland esp_run_cmd(s); 12346f7e9aecSbellard break; 12355ad6bb97Sblueswir1 case ESP_WBUSID ... ESP_WSYNO: 12364f6200f0Sbellard break; 12375ad6bb97Sblueswir1 case ESP_CFG1: 12389ea73f8bSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 12399ea73f8bSPaolo Bonzini case ESP_RES3: case ESP_RES4: 12404f6200f0Sbellard s->rregs[saddr] = val; 12414f6200f0Sbellard break; 12425ad6bb97Sblueswir1 case ESP_WCCF ... ESP_WTEST: 12434f6200f0Sbellard break; 12446f7e9aecSbellard default: 12453af4e9aaSHervé Poussineau trace_esp_error_invalid_write(val, saddr); 12468dea1dd4Sblueswir1 return; 12476f7e9aecSbellard } 12482f275b8fSbellard s->wregs[saddr] = val; 12496f7e9aecSbellard } 12506f7e9aecSbellard 1251a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr, 12528372d383SPeter Maydell unsigned size, bool is_write, 12538372d383SPeter Maydell MemTxAttrs attrs) 125467bb5314SAvi Kivity { 125567bb5314SAvi Kivity return (size == 1) || (is_write && size == 4); 125667bb5314SAvi Kivity } 12576f7e9aecSbellard 12586cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 12596cc88d6bSMark Cave-Ayland { 12606cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 12616cc88d6bSMark Cave-Ayland 12626cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12636cc88d6bSMark Cave-Ayland return version_id < 5; 12646cc88d6bSMark Cave-Ayland } 12656cc88d6bSMark Cave-Ayland 12664e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 12674e78f3bfSMark Cave-Ayland { 12684e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 12694e78f3bfSMark Cave-Ayland 12704e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12710bcd5a18SMark Cave-Ayland return version_id >= 5; 12724e78f3bfSMark Cave-Ayland } 12734e78f3bfSMark Cave-Ayland 12744eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 12754eb86065SPaolo Bonzini { 12764eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 12774eb86065SPaolo Bonzini 12784eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 12794eb86065SPaolo Bonzini return version_id >= 6; 12804eb86065SPaolo Bonzini } 12814eb86065SPaolo Bonzini 1282ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 12830bd005beSMark Cave-Ayland { 1284ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1285ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 12860bd005beSMark Cave-Ayland 12870bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12880bd005beSMark Cave-Ayland return 0; 12890bd005beSMark Cave-Ayland } 12900bd005beSMark Cave-Ayland 12910bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 12920bd005beSMark Cave-Ayland { 12930bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1294042879fcSMark Cave-Ayland int len, i; 12950bd005beSMark Cave-Ayland 12966cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12976cc88d6bSMark Cave-Ayland 12986cc88d6bSMark Cave-Ayland if (version_id < 5) { 12996cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1300042879fcSMark Cave-Ayland 1301042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1302042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1303042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1304042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1305042879fcSMark Cave-Ayland } 1306023666daSMark Cave-Ayland 1307023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1308023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1309023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1310023666daSMark Cave-Ayland } 13116cc88d6bSMark Cave-Ayland } 13126cc88d6bSMark Cave-Ayland 13130bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 13140bd005beSMark Cave-Ayland return 0; 13150bd005beSMark Cave-Ayland } 13160bd005beSMark Cave-Ayland 1317eda59b39SMark Cave-Ayland /* 1318eda59b39SMark Cave-Ayland * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the 1319eda59b39SMark Cave-Ayland * guest CPU to perform the transfers between the SCSI bus and memory 1320eda59b39SMark Cave-Ayland * itself. This is indicated by the dma_memory_read and dma_memory_write 1321eda59b39SMark Cave-Ayland * functions being NULL (in contrast to the ESP PCI device) whilst 1322eda59b39SMark Cave-Ayland * dma_enabled is still set. 1323eda59b39SMark Cave-Ayland */ 1324eda59b39SMark Cave-Ayland 1325eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque) 1326eda59b39SMark Cave-Ayland { 1327eda59b39SMark Cave-Ayland ESPState *s = ESP(opaque); 1328eda59b39SMark Cave-Ayland 1329eda59b39SMark Cave-Ayland return s->dma_memory_read == NULL && s->dma_memory_write == NULL && 1330eda59b39SMark Cave-Ayland s->dma_enabled; 1331eda59b39SMark Cave-Ayland } 1332eda59b39SMark Cave-Ayland 1333eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = { 1334eda59b39SMark Cave-Ayland .name = "esp/pdma", 1335eda59b39SMark Cave-Ayland .version_id = 0, 1336eda59b39SMark Cave-Ayland .minimum_version_id = 0, 1337eda59b39SMark Cave-Ayland .needed = esp_pdma_needed, 13382d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1339eda59b39SMark Cave-Ayland VMSTATE_UINT8(pdma_cb, ESPState), 1340eda59b39SMark Cave-Ayland VMSTATE_END_OF_LIST() 1341eda59b39SMark Cave-Ayland } 1342eda59b39SMark Cave-Ayland }; 1343eda59b39SMark Cave-Ayland 13449c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = { 1345cc9952f3SBlue Swirl .name = "esp", 13464eb86065SPaolo Bonzini .version_id = 6, 1347cc9952f3SBlue Swirl .minimum_version_id = 3, 13480bd005beSMark Cave-Ayland .post_load = esp_post_load, 13492d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1350cc9952f3SBlue Swirl VMSTATE_BUFFER(rregs, ESPState), 1351cc9952f3SBlue Swirl VMSTATE_BUFFER(wregs, ESPState), 1352cc9952f3SBlue Swirl VMSTATE_INT32(ti_size, ESPState), 1353042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1354042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1355042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 13563944966dSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 13574aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 13584aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 13594aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 13604aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 1361cc9952f3SBlue Swirl VMSTATE_UINT32(dma, ESPState), 1362023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1363023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1364023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1365023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1366023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1367023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 1368cc9952f3SBlue Swirl VMSTATE_UINT32(do_cmd, ESPState), 13696cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 13704e78f3bfSMark Cave-Ayland VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5), 1371023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1372042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1373023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 13741b9e48a5SMark Cave-Ayland VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5), 13754eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 1376cc9952f3SBlue Swirl VMSTATE_END_OF_LIST() 137774d71ea1SLaurent Vivier }, 13782d7b39a6SRichard Henderson .subsections = (const VMStateDescription * const []) { 1379eda59b39SMark Cave-Ayland &vmstate_esp_pdma, 1380eda59b39SMark Cave-Ayland NULL 1381eda59b39SMark Cave-Ayland } 1382cc9952f3SBlue Swirl }; 13836f7e9aecSbellard 1384a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 1385a391fdbcSHervé Poussineau uint64_t val, unsigned int size) 1386a391fdbcSHervé Poussineau { 1387a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 1388eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1389a391fdbcSHervé Poussineau uint32_t saddr; 1390a391fdbcSHervé Poussineau 1391a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 1392eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 1393a391fdbcSHervé Poussineau } 1394a391fdbcSHervé Poussineau 1395a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 1396a391fdbcSHervé Poussineau unsigned int size) 1397a391fdbcSHervé Poussineau { 1398a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 1399eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1400a391fdbcSHervé Poussineau uint32_t saddr; 1401a391fdbcSHervé Poussineau 1402a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 1403eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 1404a391fdbcSHervé Poussineau } 1405a391fdbcSHervé Poussineau 1406a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = { 1407a391fdbcSHervé Poussineau .read = sysbus_esp_mem_read, 1408a391fdbcSHervé Poussineau .write = sysbus_esp_mem_write, 1409a391fdbcSHervé Poussineau .endianness = DEVICE_NATIVE_ENDIAN, 1410a391fdbcSHervé Poussineau .valid.accepts = esp_mem_accepts, 1411a391fdbcSHervé Poussineau }; 1412a391fdbcSHervé Poussineau 141374d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 141474d71ea1SLaurent Vivier uint64_t val, unsigned int size) 141574d71ea1SLaurent Vivier { 141674d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1417eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 141874d71ea1SLaurent Vivier 1419960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1420960ebfd9SMark Cave-Ayland 142174d71ea1SLaurent Vivier switch (size) { 142274d71ea1SLaurent Vivier case 1: 1423761bef75SMark Cave-Ayland esp_pdma_write(s, val); 142474d71ea1SLaurent Vivier break; 142574d71ea1SLaurent Vivier case 2: 1426761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1427761bef75SMark Cave-Ayland esp_pdma_write(s, val); 142874d71ea1SLaurent Vivier break; 142974d71ea1SLaurent Vivier } 1430d0243b09SMark Cave-Ayland esp_pdma_cb(s); 143174d71ea1SLaurent Vivier } 143274d71ea1SLaurent Vivier 143374d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 143474d71ea1SLaurent Vivier unsigned int size) 143574d71ea1SLaurent Vivier { 143674d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1437eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 143874d71ea1SLaurent Vivier uint64_t val = 0; 143974d71ea1SLaurent Vivier 1440960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1441960ebfd9SMark Cave-Ayland 144274d71ea1SLaurent Vivier switch (size) { 144374d71ea1SLaurent Vivier case 1: 1444761bef75SMark Cave-Ayland val = esp_pdma_read(s); 144574d71ea1SLaurent Vivier break; 144674d71ea1SLaurent Vivier case 2: 1447761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1448761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 144974d71ea1SLaurent Vivier break; 145074d71ea1SLaurent Vivier } 1451d0243b09SMark Cave-Ayland esp_pdma_cb(s); 145274d71ea1SLaurent Vivier return val; 145374d71ea1SLaurent Vivier } 145474d71ea1SLaurent Vivier 1455a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1456a7a22088SMark Cave-Ayland { 1457a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1458a7a22088SMark Cave-Ayland 1459a7a22088SMark Cave-Ayland scsi_req_ref(req); 1460a7a22088SMark Cave-Ayland s->current_req = req; 1461a7a22088SMark Cave-Ayland return s; 1462a7a22088SMark Cave-Ayland } 1463a7a22088SMark Cave-Ayland 146474d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 146574d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 146674d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 146774d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 146874d71ea1SLaurent Vivier .valid.min_access_size = 1, 1469cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1470cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1471cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 147274d71ea1SLaurent Vivier }; 147374d71ea1SLaurent Vivier 1474afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 1475afd4030cSPaolo Bonzini .tcq = false, 14767e0380b9SPaolo Bonzini .max_target = ESP_MAX_DEVS, 14777e0380b9SPaolo Bonzini .max_lun = 7, 1478afd4030cSPaolo Bonzini 1479a7a22088SMark Cave-Ayland .load_request = esp_load_request, 1480c6df7102SPaolo Bonzini .transfer_data = esp_transfer_data, 148194d3f98aSPaolo Bonzini .complete = esp_command_complete, 148294d3f98aSPaolo Bonzini .cancel = esp_request_cancelled 1483cfdc1bb0SPaolo Bonzini }; 1484cfdc1bb0SPaolo Bonzini 1485a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 1486cfb9de9cSPaul Brook { 148784fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1488eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1489a391fdbcSHervé Poussineau 1490a391fdbcSHervé Poussineau switch (irq) { 1491a391fdbcSHervé Poussineau case 0: 1492a391fdbcSHervé Poussineau parent_esp_reset(s, irq, level); 1493a391fdbcSHervé Poussineau break; 1494a391fdbcSHervé Poussineau case 1: 1495b86dc5cbSMark Cave-Ayland esp_dma_enable(s, irq, level); 1496a391fdbcSHervé Poussineau break; 1497a391fdbcSHervé Poussineau } 1498a391fdbcSHervé Poussineau } 1499a391fdbcSHervé Poussineau 1500b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 1501a391fdbcSHervé Poussineau { 1502b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 150384fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1504eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1505eb169c76SMark Cave-Ayland 1506eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1507eb169c76SMark Cave-Ayland return; 1508eb169c76SMark Cave-Ayland } 15096f7e9aecSbellard 1510b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 151174d71ea1SLaurent Vivier sysbus_init_irq(sbd, &s->irq_data); 1512a391fdbcSHervé Poussineau assert(sysbus->it_shift != -1); 15136f7e9aecSbellard 1514d32e4b3dSHervé Poussineau s->chip_id = TCHI_FAS100A; 151529776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 151674d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1517b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 151874d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1519cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 152074d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 15216f7e9aecSbellard 1522b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 15232d069babSblueswir1 1524739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 152567e999beSbellard } 1526cfb9de9cSPaul Brook 1527a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev) 1528a391fdbcSHervé Poussineau { 152984fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1530eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1531eb169c76SMark Cave-Ayland 1532eb169c76SMark Cave-Ayland esp_hard_reset(s); 1533eb169c76SMark Cave-Ayland } 1534eb169c76SMark Cave-Ayland 1535eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1536eb169c76SMark Cave-Ayland { 1537eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1538eb169c76SMark Cave-Ayland 1539eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 1540a391fdbcSHervé Poussineau } 1541a391fdbcSHervé Poussineau 1542a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = { 1543a391fdbcSHervé Poussineau .name = "sysbusespscsi", 15440bd005beSMark Cave-Ayland .version_id = 2, 1545ea84a442SGuenter Roeck .minimum_version_id = 1, 1546ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 15472d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 15480bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 1549a391fdbcSHervé Poussineau VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 1550a391fdbcSHervé Poussineau VMSTATE_END_OF_LIST() 1551a391fdbcSHervé Poussineau } 1552999e12bbSAnthony Liguori }; 1553999e12bbSAnthony Liguori 1554a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data) 1555999e12bbSAnthony Liguori { 155639bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 1557999e12bbSAnthony Liguori 1558b09318caSHu Tao dc->realize = sysbus_esp_realize; 1559a391fdbcSHervé Poussineau dc->reset = sysbus_esp_hard_reset; 1560a391fdbcSHervé Poussineau dc->vmsd = &vmstate_sysbus_esp_scsi; 1561125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 156263235df8SBlue Swirl } 1563999e12bbSAnthony Liguori 15641f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = { 156584fbefedSMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 156639bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 1567eb169c76SMark Cave-Ayland .instance_init = sysbus_esp_init, 1568a391fdbcSHervé Poussineau .instance_size = sizeof(SysBusESPState), 1569a391fdbcSHervé Poussineau .class_init = sysbus_esp_class_init, 157063235df8SBlue Swirl }; 157163235df8SBlue Swirl 1572042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1573042879fcSMark Cave-Ayland { 1574042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1575042879fcSMark Cave-Ayland 1576042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1577023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1578042879fcSMark Cave-Ayland } 1579042879fcSMark Cave-Ayland 1580042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1581042879fcSMark Cave-Ayland { 1582042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1583042879fcSMark Cave-Ayland 1584042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1585023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1586042879fcSMark Cave-Ayland } 1587042879fcSMark Cave-Ayland 1588eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1589eb169c76SMark Cave-Ayland { 1590eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1591eb169c76SMark Cave-Ayland 1592eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1593eb169c76SMark Cave-Ayland dc->user_creatable = false; 1594eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1595eb169c76SMark Cave-Ayland } 1596eb169c76SMark Cave-Ayland 1597eb169c76SMark Cave-Ayland static const TypeInfo esp_info = { 1598eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1599eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1600042879fcSMark Cave-Ayland .instance_init = esp_init, 1601042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1602eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1603eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1604eb169c76SMark Cave-Ayland }; 1605eb169c76SMark Cave-Ayland 160683f7d43aSAndreas Färber static void esp_register_types(void) 1607cfb9de9cSPaul Brook { 1608a391fdbcSHervé Poussineau type_register_static(&sysbus_esp_info); 1609eb169c76SMark Cave-Ayland type_register_static(&esp_info); 1610cfb9de9cSPaul Brook } 1611cfb9de9cSPaul Brook 161283f7d43aSAndreas Färber type_init(esp_register_types) 1613