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 199761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 200761bef75SMark Cave-Ayland { 2018da90e81SMark Cave-Ayland uint8_t val; 2028da90e81SMark Cave-Ayland 203c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->fifo); 2048da90e81SMark Cave-Ayland return val; 205761bef75SMark Cave-Ayland } 206761bef75SMark Cave-Ayland 207761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 208761bef75SMark Cave-Ayland { 2098da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 2108da90e81SMark Cave-Ayland 2113c421400SMark Cave-Ayland if (dmalen == 0) { 2128da90e81SMark Cave-Ayland return; 2138da90e81SMark Cave-Ayland } 2148da90e81SMark Cave-Ayland 215e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 2168da90e81SMark Cave-Ayland 2178da90e81SMark Cave-Ayland dmalen--; 2188da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 219761bef75SMark Cave-Ayland } 220761bef75SMark Cave-Ayland 22177987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb) 2221e794c51SMark Cave-Ayland { 2231e794c51SMark Cave-Ayland s->pdma_cb = cb; 2241e794c51SMark Cave-Ayland } 2251e794c51SMark Cave-Ayland 226c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2276130b188SLaurent Vivier { 2286130b188SLaurent Vivier int target; 2296130b188SLaurent Vivier 2306130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2316130b188SLaurent Vivier 2326130b188SLaurent Vivier s->ti_size = 0; 2336130b188SLaurent Vivier 234cf40a5e4SMark Cave-Ayland if (s->current_req) { 235cf40a5e4SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 236cf40a5e4SMark Cave-Ayland scsi_req_cancel(s->current_req); 237cf40a5e4SMark Cave-Ayland } 238cf40a5e4SMark Cave-Ayland 2396130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 2406130b188SLaurent Vivier if (!s->current_dev) { 2416130b188SLaurent Vivier /* No such drive */ 2426130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 243cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 2446130b188SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_0; 2456130b188SLaurent Vivier esp_raise_irq(s); 2466130b188SLaurent Vivier return -1; 2476130b188SLaurent Vivier } 2484e78f3bfSMark Cave-Ayland 2494e78f3bfSMark Cave-Ayland /* 2504e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 2514eb86065SPaolo Bonzini * either in do_command_phase() for DATA OUT transfers or by the deferred 2524e78f3bfSMark Cave-Ayland * IRQ mechanism in esp_transfer_data() for DATA IN transfers 2534e78f3bfSMark Cave-Ayland */ 2544e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 2554e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 2566130b188SLaurent Vivier return 0; 2576130b188SLaurent Vivier } 2586130b188SLaurent Vivier 25920c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen) 2602f275b8fSbellard { 261023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 262042879fcSMark Cave-Ayland uint32_t dmalen, n; 2632f275b8fSbellard int target; 2642f275b8fSbellard 2658dea1dd4Sblueswir1 target = s->wregs[ESP_WBUSID] & BUSID_DID; 2664f6200f0Sbellard if (s->dma) { 26720c8d2edSMark Cave-Ayland dmalen = MIN(esp_get_tc(s), maxlen); 26820c8d2edSMark Cave-Ayland if (dmalen == 0) { 2696c1fef6bSPrasad J Pandit return 0; 2706c1fef6bSPrasad J Pandit } 27174d71ea1SLaurent Vivier if (s->dma_memory_read) { 2728b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, buf, dmalen); 273fbc6510eSMark Cave-Ayland dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen); 274023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, dmalen); 275a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - dmalen); 2764f6200f0Sbellard } else { 27774d71ea1SLaurent Vivier return 0; 27874d71ea1SLaurent Vivier } 27974d71ea1SLaurent Vivier } else { 280023666daSMark Cave-Ayland dmalen = MIN(fifo8_num_used(&s->fifo), maxlen); 28120c8d2edSMark Cave-Ayland if (dmalen == 0) { 282d3cdc491SPrasad J Pandit return 0; 283d3cdc491SPrasad J Pandit } 2847b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, dmalen); 285fbc6510eSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 2867b320a8eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 28720c8d2edSMark Cave-Ayland } 288bf4b9889SBlue Swirl trace_esp_get_cmd(dmalen, target); 2892e5d83bbSpbrook 2909f149aa9Spbrook return dmalen; 2919f149aa9Spbrook } 2929f149aa9Spbrook 2934eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 2949f149aa9Spbrook { 2957b320a8eSMark Cave-Ayland uint32_t cmdlen; 2969f149aa9Spbrook int32_t datalen; 297f48a7a6eSPaolo Bonzini SCSIDevice *current_lun; 2987b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 2999f149aa9Spbrook 3004eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 301023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 30299545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 30399545751SMark Cave-Ayland return; 30499545751SMark Cave-Ayland } 3057b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen); 306023666daSMark Cave-Ayland 3074eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 308b22f83d8SAlexandra Diupina if (!current_lun) { 309b22f83d8SAlexandra Diupina /* No such drive */ 310b22f83d8SAlexandra Diupina s->rregs[ESP_RSTAT] = 0; 311b22f83d8SAlexandra Diupina s->rregs[ESP_RINTR] = INTR_DC; 312b22f83d8SAlexandra Diupina s->rregs[ESP_RSEQ] = SEQ_0; 313b22f83d8SAlexandra Diupina esp_raise_irq(s); 314b22f83d8SAlexandra Diupina return; 315b22f83d8SAlexandra Diupina } 316b22f83d8SAlexandra Diupina 317fe9d8927SJohn Millikin s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s); 318c39ce112SPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 31967e999beSbellard s->ti_size = datalen; 320023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 32167e999beSbellard if (datalen != 0) { 3221b9e48a5SMark Cave-Ayland s->ti_cmd = 0; 3232e5d83bbSpbrook if (datalen > 0) { 3244e78f3bfSMark Cave-Ayland /* 3254e78f3bfSMark Cave-Ayland * Switch to DATA IN phase but wait until initial data xfer is 3264e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3274e78f3bfSMark Cave-Ayland */ 3284e78f3bfSMark Cave-Ayland s->data_in_ready = false; 329abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DI); 3304f6200f0Sbellard } else { 331abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DO); 332cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 333c73f96fdSblueswir1 esp_raise_irq(s); 33482141c8bSMark Cave-Ayland esp_lower_drq(s); 3352f275b8fSbellard } 3364e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3374e78f3bfSMark Cave-Ayland return; 3384e78f3bfSMark Cave-Ayland } 3394e78f3bfSMark Cave-Ayland } 3402f275b8fSbellard 3414eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 342f2818f22SArtyom Tarasenko { 3434eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3444eb86065SPaolo Bonzini uint8_t message = esp_fifo_pop(&s->cmdfifo); 345023666daSMark Cave-Ayland 3464eb86065SPaolo Bonzini trace_esp_do_identify(message); 3474eb86065SPaolo Bonzini s->lun = message & 7; 348023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3494eb86065SPaolo Bonzini } 350f2818f22SArtyom Tarasenko 351799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 352023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3534eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 354fa7505c1SMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, NULL, len); 355023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 356023666daSMark Cave-Ayland } 3574eb86065SPaolo Bonzini } 358023666daSMark Cave-Ayland 3594eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3604eb86065SPaolo Bonzini { 3614eb86065SPaolo Bonzini do_message_phase(s); 3624eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3634eb86065SPaolo Bonzini do_command_phase(s); 364f2818f22SArtyom Tarasenko } 365f2818f22SArtyom Tarasenko 36674d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s) 36774d71ea1SLaurent Vivier { 3682572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 3692572689bSMark Cave-Ayland int n; 3702572689bSMark Cave-Ayland 3712572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 3722572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 3732572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 3742572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 3752572689bSMark Cave-Ayland 376e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 377023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 378e62a959aSMark Cave-Ayland s->do_cmd = 0; 379c959f218SMark Cave-Ayland do_cmd(s); 38074d71ea1SLaurent Vivier } 38174d71ea1SLaurent Vivier } 38274d71ea1SLaurent Vivier 3839f149aa9Spbrook static void handle_satn(ESPState *s) 3849f149aa9Spbrook { 38549691315SMark Cave-Ayland int32_t cmdlen; 38649691315SMark Cave-Ayland 3871b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 38873d74342SBlue Swirl s->dma_cb = handle_satn; 38973d74342SBlue Swirl return; 39073d74342SBlue Swirl } 39177987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_PDMA_CB); 3921bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3931bcaf71bSMark Cave-Ayland return; 3941bcaf71bSMark Cave-Ayland } 395023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 39649691315SMark Cave-Ayland if (cmdlen > 0) { 397023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 39860720694SMark Cave-Ayland s->do_cmd = 0; 399c959f218SMark Cave-Ayland do_cmd(s); 40049691315SMark Cave-Ayland } else if (cmdlen == 0) { 4011bcaf71bSMark Cave-Ayland if (s->dma) { 4021bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4031bcaf71bSMark Cave-Ayland } 404bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 40549691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 40649691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 407abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 4089f149aa9Spbrook } 40994d5c79dSMark Cave-Ayland } 4109f149aa9Spbrook 411f2818f22SArtyom Tarasenko static void handle_s_without_atn(ESPState *s) 412f2818f22SArtyom Tarasenko { 41349691315SMark Cave-Ayland int32_t cmdlen; 41449691315SMark Cave-Ayland 4151b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 41673d74342SBlue Swirl s->dma_cb = handle_s_without_atn; 41773d74342SBlue Swirl return; 41873d74342SBlue Swirl } 419*66fd5657SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 4201bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4211bcaf71bSMark Cave-Ayland return; 4221bcaf71bSMark Cave-Ayland } 423023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 42449691315SMark Cave-Ayland if (cmdlen > 0) { 425023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 42660720694SMark Cave-Ayland s->do_cmd = 0; 4274eb86065SPaolo Bonzini do_cmd(s); 42849691315SMark Cave-Ayland } else if (cmdlen == 0) { 4291bcaf71bSMark Cave-Ayland if (s->dma) { 4301bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4311bcaf71bSMark Cave-Ayland } 432bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 43349691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 43449691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 435abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 436f2818f22SArtyom Tarasenko } 437f2818f22SArtyom Tarasenko } 438f2818f22SArtyom Tarasenko 43974d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s) 44074d71ea1SLaurent Vivier { 4412572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 4422572689bSMark Cave-Ayland int n; 4432572689bSMark Cave-Ayland 4442572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 4452572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 4462572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 4472572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 4482572689bSMark Cave-Ayland 449e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 450023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 45174d71ea1SLaurent Vivier s->do_cmd = 1; 452023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 453abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 454abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 455cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 45674d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 45774d71ea1SLaurent Vivier esp_raise_irq(s); 45874d71ea1SLaurent Vivier } 45974d71ea1SLaurent Vivier } 46074d71ea1SLaurent Vivier 4619f149aa9Spbrook static void handle_satn_stop(ESPState *s) 4629f149aa9Spbrook { 46349691315SMark Cave-Ayland int32_t cmdlen; 46449691315SMark Cave-Ayland 4651b26eaa1SHervé Poussineau if (s->dma && !s->dma_enabled) { 46673d74342SBlue Swirl s->dma_cb = handle_satn_stop; 46773d74342SBlue Swirl return; 46873d74342SBlue Swirl } 46977987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_STOP_PDMA_CB); 4701bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4711bcaf71bSMark Cave-Ayland return; 4721bcaf71bSMark Cave-Ayland } 473799d90d8SMark Cave-Ayland cmdlen = get_cmd(s, 1); 47449691315SMark Cave-Ayland if (cmdlen > 0) { 475023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 4769f149aa9Spbrook s->do_cmd = 1; 477023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 478abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 479cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 480799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 481c73f96fdSblueswir1 esp_raise_irq(s); 48249691315SMark Cave-Ayland } else if (cmdlen == 0) { 4831bcaf71bSMark Cave-Ayland if (s->dma) { 4841bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4851bcaf71bSMark Cave-Ayland } 486bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 487799d90d8SMark Cave-Ayland /* Target present, switch to message out phase */ 488799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 489abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 4909f149aa9Spbrook } 4919f149aa9Spbrook } 4929f149aa9Spbrook 49374d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s) 49474d71ea1SLaurent Vivier { 495abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 496cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 49774d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 49874d71ea1SLaurent Vivier esp_raise_irq(s); 49974d71ea1SLaurent Vivier } 50074d71ea1SLaurent Vivier 5010fc5c15aSpbrook static void write_response(ESPState *s) 5022f275b8fSbellard { 503e3922557SMark Cave-Ayland uint8_t buf[2]; 504042879fcSMark Cave-Ayland 505bf4b9889SBlue Swirl trace_esp_write_response(s->status); 506042879fcSMark Cave-Ayland 507e3922557SMark Cave-Ayland buf[0] = s->status; 508e3922557SMark Cave-Ayland buf[1] = 0; 509042879fcSMark Cave-Ayland 5104f6200f0Sbellard if (s->dma) { 51174d71ea1SLaurent Vivier if (s->dma_memory_write) { 512e3922557SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, 2); 513abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 514cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 5155ad6bb97Sblueswir1 s->rregs[ESP_RSEQ] = SEQ_CD; 5164f6200f0Sbellard } else { 51777987ef5SMark Cave-Ayland esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB); 51874d71ea1SLaurent Vivier esp_raise_drq(s); 51974d71ea1SLaurent Vivier return; 52074d71ea1SLaurent Vivier } 52174d71ea1SLaurent Vivier } else { 522e3922557SMark Cave-Ayland fifo8_reset(&s->fifo); 523e3922557SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, 2); 5245ad6bb97Sblueswir1 s->rregs[ESP_RFLAGS] = 2; 5254f6200f0Sbellard } 526c73f96fdSblueswir1 esp_raise_irq(s); 5272f275b8fSbellard } 5284f6200f0Sbellard 529004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s) 5304d611c9aSpbrook { 531af74b3c1SMark Cave-Ayland if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) { 532cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 533c73f96fdSblueswir1 esp_raise_irq(s); 534af74b3c1SMark Cave-Ayland esp_lower_drq(s); 535af74b3c1SMark Cave-Ayland } 5364d611c9aSpbrook } 537a917d384Spbrook 53874d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s) 53974d71ea1SLaurent Vivier { 5404ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 5412572689bSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 54282141c8bSMark Cave-Ayland int len; 543042879fcSMark Cave-Ayland uint32_t n; 5446cc88d6bSMark Cave-Ayland 54574d71ea1SLaurent Vivier if (s->do_cmd) { 5462572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 5472572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 5482572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 5492572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 5502572689bSMark Cave-Ayland 551e62a959aSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 552e62a959aSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 553e62a959aSMark Cave-Ayland return; 554e62a959aSMark Cave-Ayland } 555e62a959aSMark Cave-Ayland 55674d71ea1SLaurent Vivier s->ti_size = 0; 557c348458fSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 558c348458fSMark Cave-Ayland /* No command received */ 559c348458fSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 560c348458fSMark Cave-Ayland return; 561c348458fSMark Cave-Ayland } 562c348458fSMark Cave-Ayland 563c348458fSMark Cave-Ayland /* Command has been received */ 56474d71ea1SLaurent Vivier s->do_cmd = 0; 565c959f218SMark Cave-Ayland do_cmd(s); 566c348458fSMark Cave-Ayland } else { 567c348458fSMark Cave-Ayland /* 568c348458fSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 5692cb40d44SStefan Weil * and then switch to command phase 570c348458fSMark Cave-Ayland */ 571c348458fSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 572abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 573c348458fSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 574c348458fSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 575c348458fSMark Cave-Ayland esp_raise_irq(s); 576c348458fSMark Cave-Ayland } 57774d71ea1SLaurent Vivier return; 57874d71ea1SLaurent Vivier } 57982141c8bSMark Cave-Ayland 5800db89536SMark Cave-Ayland if (!s->current_req) { 5810db89536SMark Cave-Ayland return; 5820db89536SMark Cave-Ayland } 5830db89536SMark Cave-Ayland 58482141c8bSMark Cave-Ayland if (to_device) { 58582141c8bSMark Cave-Ayland /* Copy FIFO data to device */ 5867aa6baeeSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 5877aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 5887b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5897aa6baeeSMark Cave-Ayland s->async_buf += n; 5907aa6baeeSMark Cave-Ayland s->async_len -= n; 5917aa6baeeSMark Cave-Ayland s->ti_size += n; 5927aa6baeeSMark Cave-Ayland 593e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 594e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 59574d71ea1SLaurent Vivier scsi_req_continue(s->current_req); 59682141c8bSMark Cave-Ayland return; 59782141c8bSMark Cave-Ayland } 59882141c8bSMark Cave-Ayland 599004826d0SMark Cave-Ayland esp_dma_ti_check(s); 60082141c8bSMark Cave-Ayland } else { 60182141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 6027aa6baeeSMark Cave-Ayland len = MIN(s->async_len, esp_get_tc(s)); 6037aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 604042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 60582141c8bSMark Cave-Ayland s->async_buf += len; 60682141c8bSMark Cave-Ayland s->async_len -= len; 60782141c8bSMark Cave-Ayland s->ti_size -= len; 60882141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 6091b2e34caSMark Cave-Ayland 6101b2e34caSMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 6111b2e34caSMark Cave-Ayland /* Defer until the scsi layer has completed */ 6121b2e34caSMark Cave-Ayland scsi_req_continue(s->current_req); 6131b2e34caSMark Cave-Ayland s->data_in_ready = false; 6141b2e34caSMark Cave-Ayland return; 6151b2e34caSMark Cave-Ayland } 6161b2e34caSMark Cave-Ayland 6171b2e34caSMark Cave-Ayland esp_dma_ti_check(s); 61874d71ea1SLaurent Vivier } 61982141c8bSMark Cave-Ayland } 62074d71ea1SLaurent Vivier 621a917d384Spbrook static void esp_do_dma(ESPState *s) 622a917d384Spbrook { 623023666daSMark Cave-Ayland uint32_t len, cmdlen; 6244ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 625023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 62619e9afb1SMark Cave-Ayland int n; 627a917d384Spbrook 6286cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 629a917d384Spbrook if (s->do_cmd) { 63015407433SLaurent Vivier /* 63115407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 63215407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 63315407433SLaurent Vivier */ 634023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 635023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 63674d71ea1SLaurent Vivier if (s->dma_memory_read) { 6370ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 638023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 639023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 640a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 64174d71ea1SLaurent Vivier } else { 6423c7f3c8bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 6433c7f3c8bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 6443c7f3c8bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 6453c7f3c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - n); 6463c7f3c8bSMark Cave-Ayland 64777987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 64874d71ea1SLaurent Vivier esp_raise_drq(s); 6493c7f3c8bSMark Cave-Ayland 6503c7f3c8bSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 6513c7f3c8bSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 65274d71ea1SLaurent Vivier return; 65374d71ea1SLaurent Vivier } 6543c7f3c8bSMark Cave-Ayland } 655023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 65615407433SLaurent Vivier s->ti_size = 0; 657799d90d8SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 658799d90d8SMark Cave-Ayland /* No command received */ 659023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 660799d90d8SMark Cave-Ayland return; 661799d90d8SMark Cave-Ayland } 662799d90d8SMark Cave-Ayland 663799d90d8SMark Cave-Ayland /* Command has been received */ 66415407433SLaurent Vivier s->do_cmd = 0; 665c959f218SMark Cave-Ayland do_cmd(s); 666799d90d8SMark Cave-Ayland } else { 667799d90d8SMark Cave-Ayland /* 668023666daSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 6692cb40d44SStefan Weil * and then switch to command phase 670799d90d8SMark Cave-Ayland */ 671023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 672abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 673799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 674799d90d8SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 675799d90d8SMark Cave-Ayland esp_raise_irq(s); 676799d90d8SMark Cave-Ayland } 677a917d384Spbrook return; 678a917d384Spbrook } 6790db89536SMark Cave-Ayland if (!s->current_req) { 6800db89536SMark Cave-Ayland return; 6810db89536SMark Cave-Ayland } 6824460b86aSMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 683a917d384Spbrook /* Defer until data is available. */ 684a917d384Spbrook return; 685a917d384Spbrook } 686a917d384Spbrook if (len > s->async_len) { 687a917d384Spbrook len = s->async_len; 688a917d384Spbrook } 689a917d384Spbrook if (to_device) { 69074d71ea1SLaurent Vivier if (s->dma_memory_read) { 6918b17de88Sblueswir1 s->dma_memory_read(s->dma_opaque, s->async_buf, len); 692f3666223SMark Cave-Ayland 693f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 694f3666223SMark Cave-Ayland s->async_buf += len; 695f3666223SMark Cave-Ayland s->async_len -= len; 696f3666223SMark Cave-Ayland s->ti_size += len; 697f3666223SMark 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 */ 700f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 701f3666223SMark Cave-Ayland return; 702f3666223SMark Cave-Ayland } 703f3666223SMark Cave-Ayland 704004826d0SMark Cave-Ayland esp_dma_ti_check(s); 705a917d384Spbrook } else { 70619e9afb1SMark Cave-Ayland /* Copy FIFO data to device */ 70719e9afb1SMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 70819e9afb1SMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 70919e9afb1SMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 71019e9afb1SMark Cave-Ayland s->async_buf += n; 71119e9afb1SMark Cave-Ayland s->async_len -= n; 71219e9afb1SMark Cave-Ayland s->ti_size += n; 71319e9afb1SMark Cave-Ayland 71477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 71574d71ea1SLaurent Vivier esp_raise_drq(s); 716e4e166c8SMark Cave-Ayland 717e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 718e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 719e4e166c8SMark Cave-Ayland scsi_req_continue(s->current_req); 720e4e166c8SMark Cave-Ayland return; 721e4e166c8SMark Cave-Ayland } 722e4e166c8SMark Cave-Ayland 723004826d0SMark Cave-Ayland esp_dma_ti_check(s); 72474d71ea1SLaurent Vivier } 72574d71ea1SLaurent Vivier } else { 72674d71ea1SLaurent Vivier if (s->dma_memory_write) { 7278b17de88Sblueswir1 s->dma_memory_write(s->dma_opaque, s->async_buf, len); 728f3666223SMark Cave-Ayland 729f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 730f3666223SMark Cave-Ayland s->async_buf += len; 731f3666223SMark Cave-Ayland s->async_len -= len; 732f3666223SMark Cave-Ayland s->ti_size -= len; 733f3666223SMark Cave-Ayland 734e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 735e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 736f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 737fabcba49SMark Cave-Ayland return; 738f3666223SMark Cave-Ayland } 739f3666223SMark Cave-Ayland 740004826d0SMark Cave-Ayland esp_dma_ti_check(s); 74174d71ea1SLaurent Vivier } else { 74282141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 743042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 744042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 74582141c8bSMark Cave-Ayland s->async_buf += len; 74682141c8bSMark Cave-Ayland s->async_len -= len; 74782141c8bSMark Cave-Ayland s->ti_size -= len; 74882141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 74977987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 75074d71ea1SLaurent Vivier esp_raise_drq(s); 751e4e166c8SMark Cave-Ayland 752e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 753e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 754e4e166c8SMark Cave-Ayland scsi_req_continue(s->current_req); 755e4e166c8SMark Cave-Ayland return; 756e4e166c8SMark Cave-Ayland } 757e4e166c8SMark Cave-Ayland 758004826d0SMark Cave-Ayland esp_dma_ti_check(s); 759e4e166c8SMark Cave-Ayland } 76074d71ea1SLaurent Vivier } 761a917d384Spbrook } 762a917d384Spbrook 7631b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7641b9e48a5SMark Cave-Ayland { 7651b9e48a5SMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 7662572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 7677b320a8eSMark Cave-Ayland uint32_t cmdlen; 7682572689bSMark Cave-Ayland int len, n; 7691b9e48a5SMark Cave-Ayland 7701b9e48a5SMark Cave-Ayland if (s->do_cmd) { 7712572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 7722572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 7732572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 7742572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 7752572689bSMark Cave-Ayland 7761b9e48a5SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 7771b9e48a5SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 7781b9e48a5SMark Cave-Ayland s->ti_size = 0; 7791b9e48a5SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 7801b9e48a5SMark Cave-Ayland /* No command received */ 7811b9e48a5SMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 7821b9e48a5SMark Cave-Ayland return; 7831b9e48a5SMark Cave-Ayland } 7841b9e48a5SMark Cave-Ayland 7851b9e48a5SMark Cave-Ayland /* Command has been received */ 7861b9e48a5SMark Cave-Ayland s->do_cmd = 0; 7871b9e48a5SMark Cave-Ayland do_cmd(s); 7881b9e48a5SMark Cave-Ayland } else { 7891b9e48a5SMark Cave-Ayland /* 7901b9e48a5SMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 7912cb40d44SStefan Weil * and then switch to command phase 7921b9e48a5SMark Cave-Ayland */ 7931b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 794abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 7951b9e48a5SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 7961b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 7971b9e48a5SMark Cave-Ayland esp_raise_irq(s); 7981b9e48a5SMark Cave-Ayland } 7991b9e48a5SMark Cave-Ayland return; 8001b9e48a5SMark Cave-Ayland } 8011b9e48a5SMark Cave-Ayland 8020db89536SMark Cave-Ayland if (!s->current_req) { 8030db89536SMark Cave-Ayland return; 8040db89536SMark Cave-Ayland } 8050db89536SMark Cave-Ayland 8061b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8071b9e48a5SMark Cave-Ayland /* Defer until data is available. */ 8081b9e48a5SMark Cave-Ayland return; 8091b9e48a5SMark Cave-Ayland } 8101b9e48a5SMark Cave-Ayland 8111b9e48a5SMark Cave-Ayland if (to_device) { 81277668e4bSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 81377668e4bSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 8147b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 8151b9e48a5SMark Cave-Ayland s->async_buf += len; 8161b9e48a5SMark Cave-Ayland s->async_len -= len; 8171b9e48a5SMark Cave-Ayland s->ti_size += len; 8181b9e48a5SMark Cave-Ayland } else { 8196ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 8206ef2cabcSMark Cave-Ayland fifo8_push(&s->fifo, s->async_buf[0]); 8216ef2cabcSMark Cave-Ayland s->async_buf++; 8226ef2cabcSMark Cave-Ayland s->async_len--; 8236ef2cabcSMark Cave-Ayland s->ti_size--; 8246ef2cabcSMark Cave-Ayland } 8251b9e48a5SMark Cave-Ayland } 8261b9e48a5SMark Cave-Ayland 8271b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8281b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 8291b9e48a5SMark Cave-Ayland return; 8301b9e48a5SMark Cave-Ayland } 8311b9e48a5SMark Cave-Ayland 8321b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8331b9e48a5SMark Cave-Ayland esp_raise_irq(s); 8341b9e48a5SMark Cave-Ayland } 8351b9e48a5SMark Cave-Ayland 83677987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s) 83777987ef5SMark Cave-Ayland { 83877987ef5SMark Cave-Ayland switch (s->pdma_cb) { 83977987ef5SMark Cave-Ayland case SATN_PDMA_CB: 84077987ef5SMark Cave-Ayland satn_pdma_cb(s); 84177987ef5SMark Cave-Ayland break; 84277987ef5SMark Cave-Ayland case SATN_STOP_PDMA_CB: 84377987ef5SMark Cave-Ayland satn_stop_pdma_cb(s); 84477987ef5SMark Cave-Ayland break; 84577987ef5SMark Cave-Ayland case WRITE_RESPONSE_PDMA_CB: 84677987ef5SMark Cave-Ayland write_response_pdma_cb(s); 84777987ef5SMark Cave-Ayland break; 84877987ef5SMark Cave-Ayland case DO_DMA_PDMA_CB: 84977987ef5SMark Cave-Ayland do_dma_pdma_cb(s); 85077987ef5SMark Cave-Ayland break; 85177987ef5SMark Cave-Ayland default: 85277987ef5SMark Cave-Ayland g_assert_not_reached(); 85377987ef5SMark Cave-Ayland } 85477987ef5SMark Cave-Ayland } 85577987ef5SMark Cave-Ayland 8564aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 857a917d384Spbrook { 8584aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 8596ef2cabcSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8604aaa6ac3SMark Cave-Ayland 861bf4b9889SBlue Swirl trace_esp_command_complete(); 8626ef2cabcSMark Cave-Ayland 8636ef2cabcSMark Cave-Ayland /* 8646ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 8656ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 8666ef2cabcSMark Cave-Ayland */ 8676ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 868c6df7102SPaolo Bonzini if (s->ti_size != 0) { 869bf4b9889SBlue Swirl trace_esp_command_complete_unexpected(); 870c6df7102SPaolo Bonzini } 8716ef2cabcSMark Cave-Ayland } 8726ef2cabcSMark Cave-Ayland 873a917d384Spbrook s->async_len = 0; 8744aaa6ac3SMark Cave-Ayland if (req->status) { 875bf4b9889SBlue Swirl trace_esp_command_complete_fail(); 876c6df7102SPaolo Bonzini } 8774aaa6ac3SMark Cave-Ayland s->status = req->status; 8786ef2cabcSMark Cave-Ayland 8796ef2cabcSMark Cave-Ayland /* 880cb988199SMark Cave-Ayland * Switch to status phase. For non-DMA transfers from the target the last 881cb988199SMark Cave-Ayland * byte is still in the FIFO 8826ef2cabcSMark Cave-Ayland */ 883abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 884cb988199SMark Cave-Ayland if (s->ti_size == 0) { 885cb988199SMark Cave-Ayland /* 886cb988199SMark Cave-Ayland * Transfer complete: force TC to zero just in case a TI command was 887cb988199SMark Cave-Ayland * requested for more data than the command returns (Solaris 8 does 888cb988199SMark Cave-Ayland * this) 889cb988199SMark Cave-Ayland */ 890cb988199SMark Cave-Ayland esp_set_tc(s, 0); 891004826d0SMark Cave-Ayland esp_dma_ti_check(s); 892cb988199SMark Cave-Ayland } else { 893cb988199SMark Cave-Ayland /* 894cb988199SMark Cave-Ayland * Transfer truncated: raise INTR_BS to indicate early change of 895cb988199SMark Cave-Ayland * phase 896cb988199SMark Cave-Ayland */ 897cb988199SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 898cb988199SMark Cave-Ayland esp_raise_irq(s); 899cb988199SMark Cave-Ayland s->ti_size = 0; 9006ef2cabcSMark Cave-Ayland } 9016ef2cabcSMark Cave-Ayland 9025c6c0e51SHannes Reinecke if (s->current_req) { 9035c6c0e51SHannes Reinecke scsi_req_unref(s->current_req); 9045c6c0e51SHannes Reinecke s->current_req = NULL; 905a917d384Spbrook s->current_dev = NULL; 9065c6c0e51SHannes Reinecke } 907c6df7102SPaolo Bonzini } 908c6df7102SPaolo Bonzini 9099c7e23fcSHervé Poussineau void esp_transfer_data(SCSIRequest *req, uint32_t len) 910c6df7102SPaolo Bonzini { 911e6810db8SHervé Poussineau ESPState *s = req->hba_private; 9124e78f3bfSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 9136cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 914c6df7102SPaolo Bonzini 9157f0b6e11SPaolo Bonzini assert(!s->do_cmd); 9166cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 917aba1f023SPaolo Bonzini s->async_len = len; 9180c34459bSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 9194e78f3bfSMark Cave-Ayland 9204e78f3bfSMark Cave-Ayland if (!to_device && !s->data_in_ready) { 9214e78f3bfSMark Cave-Ayland /* 9224e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 9234e78f3bfSMark Cave-Ayland * completion interrupt 9244e78f3bfSMark Cave-Ayland */ 9254e78f3bfSMark Cave-Ayland s->data_in_ready = true; 9264e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 9274e78f3bfSMark Cave-Ayland esp_raise_irq(s); 9284e78f3bfSMark Cave-Ayland } 9294e78f3bfSMark Cave-Ayland 9301b9e48a5SMark Cave-Ayland /* 9311b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 9321b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 9331b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 9341b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 9351b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 9361b9e48a5SMark Cave-Ayland */ 9371b9e48a5SMark Cave-Ayland 938880d3089SMark Cave-Ayland if (s->ti_cmd == (CMD_TI | CMD_DMA)) { 939a79e767aSMark Cave-Ayland /* When the SCSI layer returns more data, raise deferred INTR_BS */ 940004826d0SMark Cave-Ayland esp_dma_ti_check(s); 941a79e767aSMark Cave-Ayland 942a79e767aSMark Cave-Ayland esp_do_dma(s); 943880d3089SMark Cave-Ayland } else if (s->ti_cmd == CMD_TI) { 9441b9e48a5SMark Cave-Ayland esp_do_nodma(s); 9451b9e48a5SMark Cave-Ayland } 946a917d384Spbrook } 9472e5d83bbSpbrook 9482f275b8fSbellard static void handle_ti(ESPState *s) 9492f275b8fSbellard { 9501b9e48a5SMark Cave-Ayland uint32_t dmalen; 9512f275b8fSbellard 9527246e160SHervé Poussineau if (s->dma && !s->dma_enabled) { 9537246e160SHervé Poussineau s->dma_cb = handle_ti; 9547246e160SHervé Poussineau return; 9557246e160SHervé Poussineau } 9567246e160SHervé Poussineau 9571b9e48a5SMark Cave-Ayland s->ti_cmd = s->rregs[ESP_CMD]; 9584f6200f0Sbellard if (s->dma) { 9591b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 960b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 9614d611c9aSpbrook esp_do_dma(s); 962799d90d8SMark Cave-Ayland } else { 9631b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 9641b9e48a5SMark Cave-Ayland esp_do_nodma(s); 9654f6200f0Sbellard } 9662f275b8fSbellard } 9672f275b8fSbellard 9689c7e23fcSHervé Poussineau void esp_hard_reset(ESPState *s) 9696f7e9aecSbellard { 9705aca8c3bSblueswir1 memset(s->rregs, 0, ESP_REGS); 9715aca8c3bSblueswir1 memset(s->wregs, 0, ESP_REGS); 972c9cf45c1SHannes Reinecke s->tchi_written = 0; 9734e9aec74Spbrook s->ti_size = 0; 9743f26c975SMark Cave-Ayland s->async_len = 0; 975042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 976023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 9774e9aec74Spbrook s->dma = 0; 9789f149aa9Spbrook s->do_cmd = 0; 97973d74342SBlue Swirl s->dma_cb = NULL; 9808dea1dd4Sblueswir1 9818dea1dd4Sblueswir1 s->rregs[ESP_CFG1] = 7; 9826f7e9aecSbellard } 9836f7e9aecSbellard 984a391fdbcSHervé Poussineau static void esp_soft_reset(ESPState *s) 98585948643SBlue Swirl { 98685948643SBlue Swirl qemu_irq_lower(s->irq); 98774d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 988a391fdbcSHervé Poussineau esp_hard_reset(s); 98985948643SBlue Swirl } 99085948643SBlue Swirl 991c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s) 992c6e51f1bSJohn Millikin { 9934a5fc890SPeter Maydell bus_cold_reset(BUS(&s->bus)); 994c6e51f1bSJohn Millikin } 995c6e51f1bSJohn Millikin 996a391fdbcSHervé Poussineau static void parent_esp_reset(ESPState *s, int irq, int level) 9972d069babSblueswir1 { 99885948643SBlue Swirl if (level) { 999a391fdbcSHervé Poussineau esp_soft_reset(s); 100085948643SBlue Swirl } 10012d069babSblueswir1 } 10022d069babSblueswir1 1003f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s) 1004f21fe39dSMark Cave-Ayland { 1005f21fe39dSMark Cave-Ayland uint8_t cmd = s->rregs[ESP_CMD]; 1006f21fe39dSMark Cave-Ayland 1007f21fe39dSMark Cave-Ayland if (cmd & CMD_DMA) { 1008f21fe39dSMark Cave-Ayland s->dma = 1; 1009f21fe39dSMark Cave-Ayland /* Reload DMA counter. */ 1010f21fe39dSMark Cave-Ayland if (esp_get_stc(s) == 0) { 1011f21fe39dSMark Cave-Ayland esp_set_tc(s, 0x10000); 1012f21fe39dSMark Cave-Ayland } else { 1013f21fe39dSMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 1014f21fe39dSMark Cave-Ayland } 1015f21fe39dSMark Cave-Ayland } else { 1016f21fe39dSMark Cave-Ayland s->dma = 0; 1017f21fe39dSMark Cave-Ayland } 1018f21fe39dSMark Cave-Ayland switch (cmd & CMD_CMD) { 1019f21fe39dSMark Cave-Ayland case CMD_NOP: 1020f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_nop(cmd); 1021f21fe39dSMark Cave-Ayland break; 1022f21fe39dSMark Cave-Ayland case CMD_FLUSH: 1023f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_flush(cmd); 1024f21fe39dSMark Cave-Ayland fifo8_reset(&s->fifo); 1025f21fe39dSMark Cave-Ayland break; 1026f21fe39dSMark Cave-Ayland case CMD_RESET: 1027f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_reset(cmd); 1028f21fe39dSMark Cave-Ayland esp_soft_reset(s); 1029f21fe39dSMark Cave-Ayland break; 1030f21fe39dSMark Cave-Ayland case CMD_BUSRESET: 1031f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_bus_reset(cmd); 1032f21fe39dSMark Cave-Ayland esp_bus_reset(s); 1033f21fe39dSMark Cave-Ayland if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1034f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 1035f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1036f21fe39dSMark Cave-Ayland } 1037f21fe39dSMark Cave-Ayland break; 1038f21fe39dSMark Cave-Ayland case CMD_TI: 1039f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(cmd); 1040f21fe39dSMark Cave-Ayland handle_ti(s); 1041f21fe39dSMark Cave-Ayland break; 1042f21fe39dSMark Cave-Ayland case CMD_ICCS: 1043f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_iccs(cmd); 1044f21fe39dSMark Cave-Ayland write_response(s); 1045f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1046abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MI); 1047f21fe39dSMark Cave-Ayland break; 1048f21fe39dSMark Cave-Ayland case CMD_MSGACC: 1049f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_msgacc(cmd); 1050f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 1051f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1052f21fe39dSMark Cave-Ayland s->rregs[ESP_RFLAGS] = 0; 1053f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1054f21fe39dSMark Cave-Ayland break; 1055f21fe39dSMark Cave-Ayland case CMD_PAD: 1056f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_pad(cmd); 1057f21fe39dSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC; 1058f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1059f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1060f21fe39dSMark Cave-Ayland break; 1061f21fe39dSMark Cave-Ayland case CMD_SATN: 1062f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_satn(cmd); 1063f21fe39dSMark Cave-Ayland break; 1064f21fe39dSMark Cave-Ayland case CMD_RSTATN: 1065f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_rstatn(cmd); 1066f21fe39dSMark Cave-Ayland break; 1067f21fe39dSMark Cave-Ayland case CMD_SEL: 1068f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_sel(cmd); 1069f21fe39dSMark Cave-Ayland handle_s_without_atn(s); 1070f21fe39dSMark Cave-Ayland break; 1071f21fe39dSMark Cave-Ayland case CMD_SELATN: 1072f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatn(cmd); 1073f21fe39dSMark Cave-Ayland handle_satn(s); 1074f21fe39dSMark Cave-Ayland break; 1075f21fe39dSMark Cave-Ayland case CMD_SELATNS: 1076f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatns(cmd); 1077f21fe39dSMark Cave-Ayland handle_satn_stop(s); 1078f21fe39dSMark Cave-Ayland break; 1079f21fe39dSMark Cave-Ayland case CMD_ENSEL: 1080f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ensel(cmd); 1081f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1082f21fe39dSMark Cave-Ayland break; 1083f21fe39dSMark Cave-Ayland case CMD_DISSEL: 1084f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_dissel(cmd); 1085f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1086f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1087f21fe39dSMark Cave-Ayland break; 1088f21fe39dSMark Cave-Ayland default: 1089f21fe39dSMark Cave-Ayland trace_esp_error_unhandled_command(cmd); 1090f21fe39dSMark Cave-Ayland break; 1091f21fe39dSMark Cave-Ayland } 1092f21fe39dSMark Cave-Ayland } 1093f21fe39dSMark Cave-Ayland 10949c7e23fcSHervé Poussineau uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 109573d74342SBlue Swirl { 1096b630c075SMark Cave-Ayland uint32_t val; 109773d74342SBlue Swirl 10986f7e9aecSbellard switch (saddr) { 10995ad6bb97Sblueswir1 case ESP_FIFO: 11001b9e48a5SMark Cave-Ayland if (s->dma_memory_read && s->dma_memory_write && 11011b9e48a5SMark Cave-Ayland (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 11028dea1dd4Sblueswir1 /* Data out. */ 1103ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 11045ad6bb97Sblueswir1 s->rregs[ESP_FIFO] = 0; 1105042879fcSMark Cave-Ayland } else { 11066ef2cabcSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) { 11076ef2cabcSMark Cave-Ayland if (s->ti_size) { 11086ef2cabcSMark Cave-Ayland esp_do_nodma(s); 11096ef2cabcSMark Cave-Ayland } else { 11106ef2cabcSMark Cave-Ayland /* 11116ef2cabcSMark Cave-Ayland * The last byte of a non-DMA transfer has been read out 11126ef2cabcSMark Cave-Ayland * of the FIFO so switch to status phase 11136ef2cabcSMark Cave-Ayland */ 1114abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 11156ef2cabcSMark Cave-Ayland } 11166ef2cabcSMark Cave-Ayland } 1117c5fef911SMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo); 11184f6200f0Sbellard } 1119b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 11204f6200f0Sbellard break; 11215ad6bb97Sblueswir1 case ESP_RINTR: 112294d5c79dSMark Cave-Ayland /* 112394d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 112494d5c79dSMark Cave-Ayland * except TC 112594d5c79dSMark Cave-Ayland */ 1126b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 11272814df28SBlue Swirl s->rregs[ESP_RINTR] = 0; 11282814df28SBlue Swirl s->rregs[ESP_RSTAT] &= ~STAT_TC; 1129af947a3dSMark Cave-Ayland /* 1130af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 1131af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 1132af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 1133af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 1134af947a3dSMark Cave-Ayland * transition. 1135af947a3dSMark Cave-Ayland * 1136af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 1137af947a3dSMark Cave-Ayland */ 1138c73f96fdSblueswir1 esp_lower_irq(s); 1139b630c075SMark Cave-Ayland break; 1140c9cf45c1SHannes Reinecke case ESP_TCHI: 1141c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 1142c9cf45c1SHannes Reinecke if (!s->tchi_written) { 1143b630c075SMark Cave-Ayland val = s->chip_id; 1144b630c075SMark Cave-Ayland } else { 1145b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1146c9cf45c1SHannes Reinecke } 1147b630c075SMark Cave-Ayland break; 1148238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1149238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1150238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1151238ec4d7SMark Cave-Ayland break; 11526f7e9aecSbellard default: 1153b630c075SMark Cave-Ayland val = s->rregs[saddr]; 11546f7e9aecSbellard break; 11556f7e9aecSbellard } 1156b630c075SMark Cave-Ayland 1157b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1158b630c075SMark Cave-Ayland return val; 11596f7e9aecSbellard } 11606f7e9aecSbellard 11619c7e23fcSHervé Poussineau void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 11626f7e9aecSbellard { 1163bf4b9889SBlue Swirl trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 11646f7e9aecSbellard switch (saddr) { 1165c9cf45c1SHannes Reinecke case ESP_TCHI: 1166c9cf45c1SHannes Reinecke s->tchi_written = true; 1167c9cf45c1SHannes Reinecke /* fall through */ 11685ad6bb97Sblueswir1 case ESP_TCLO: 11695ad6bb97Sblueswir1 case ESP_TCMID: 11705ad6bb97Sblueswir1 s->rregs[ESP_RSTAT] &= ~STAT_TC; 11714f6200f0Sbellard break; 11725ad6bb97Sblueswir1 case ESP_FIFO: 11739f149aa9Spbrook if (s->do_cmd) { 11742572689bSMark Cave-Ayland if (!fifo8_is_full(&s->fifo)) { 11752572689bSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 11762572689bSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, fifo8_pop(&s->fifo)); 11772572689bSMark Cave-Ayland } 11786ef2cabcSMark Cave-Ayland 11796ef2cabcSMark Cave-Ayland /* 11806ef2cabcSMark Cave-Ayland * If any unexpected message out/command phase data is 11816ef2cabcSMark Cave-Ayland * transferred using non-DMA, raise the interrupt 11826ef2cabcSMark Cave-Ayland */ 11836ef2cabcSMark Cave-Ayland if (s->rregs[ESP_CMD] == CMD_TI) { 11846ef2cabcSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 11856ef2cabcSMark Cave-Ayland esp_raise_irq(s); 11866ef2cabcSMark Cave-Ayland } 11872e5d83bbSpbrook } else { 1188e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 11892e5d83bbSpbrook } 11904f6200f0Sbellard break; 11915ad6bb97Sblueswir1 case ESP_CMD: 11924f6200f0Sbellard s->rregs[saddr] = val; 1193f21fe39dSMark Cave-Ayland esp_run_cmd(s); 11946f7e9aecSbellard break; 11955ad6bb97Sblueswir1 case ESP_WBUSID ... ESP_WSYNO: 11964f6200f0Sbellard break; 11975ad6bb97Sblueswir1 case ESP_CFG1: 11989ea73f8bSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 11999ea73f8bSPaolo Bonzini case ESP_RES3: case ESP_RES4: 12004f6200f0Sbellard s->rregs[saddr] = val; 12014f6200f0Sbellard break; 12025ad6bb97Sblueswir1 case ESP_WCCF ... ESP_WTEST: 12034f6200f0Sbellard break; 12046f7e9aecSbellard default: 12053af4e9aaSHervé Poussineau trace_esp_error_invalid_write(val, saddr); 12068dea1dd4Sblueswir1 return; 12076f7e9aecSbellard } 12082f275b8fSbellard s->wregs[saddr] = val; 12096f7e9aecSbellard } 12106f7e9aecSbellard 1211a8170e5eSAvi Kivity static bool esp_mem_accepts(void *opaque, hwaddr addr, 12128372d383SPeter Maydell unsigned size, bool is_write, 12138372d383SPeter Maydell MemTxAttrs attrs) 121467bb5314SAvi Kivity { 121567bb5314SAvi Kivity return (size == 1) || (is_write && size == 4); 121667bb5314SAvi Kivity } 12176f7e9aecSbellard 12186cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 12196cc88d6bSMark Cave-Ayland { 12206cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 12216cc88d6bSMark Cave-Ayland 12226cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12236cc88d6bSMark Cave-Ayland return version_id < 5; 12246cc88d6bSMark Cave-Ayland } 12256cc88d6bSMark Cave-Ayland 12264e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 12274e78f3bfSMark Cave-Ayland { 12284e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 12294e78f3bfSMark Cave-Ayland 12304e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12310bcd5a18SMark Cave-Ayland return version_id >= 5; 12324e78f3bfSMark Cave-Ayland } 12334e78f3bfSMark Cave-Ayland 12344eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 12354eb86065SPaolo Bonzini { 12364eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 12374eb86065SPaolo Bonzini 12384eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 12394eb86065SPaolo Bonzini return version_id >= 6; 12404eb86065SPaolo Bonzini } 12414eb86065SPaolo Bonzini 1242ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 12430bd005beSMark Cave-Ayland { 1244ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1245ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 12460bd005beSMark Cave-Ayland 12470bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12480bd005beSMark Cave-Ayland return 0; 12490bd005beSMark Cave-Ayland } 12500bd005beSMark Cave-Ayland 12510bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 12520bd005beSMark Cave-Ayland { 12530bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1254042879fcSMark Cave-Ayland int len, i; 12550bd005beSMark Cave-Ayland 12566cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12576cc88d6bSMark Cave-Ayland 12586cc88d6bSMark Cave-Ayland if (version_id < 5) { 12596cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1260042879fcSMark Cave-Ayland 1261042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1262042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1263042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1264042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1265042879fcSMark Cave-Ayland } 1266023666daSMark Cave-Ayland 1267023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1268023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1269023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1270023666daSMark Cave-Ayland } 12716cc88d6bSMark Cave-Ayland } 12726cc88d6bSMark Cave-Ayland 12730bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12740bd005beSMark Cave-Ayland return 0; 12750bd005beSMark Cave-Ayland } 12760bd005beSMark Cave-Ayland 1277eda59b39SMark Cave-Ayland /* 1278eda59b39SMark Cave-Ayland * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the 1279eda59b39SMark Cave-Ayland * guest CPU to perform the transfers between the SCSI bus and memory 1280eda59b39SMark Cave-Ayland * itself. This is indicated by the dma_memory_read and dma_memory_write 1281eda59b39SMark Cave-Ayland * functions being NULL (in contrast to the ESP PCI device) whilst 1282eda59b39SMark Cave-Ayland * dma_enabled is still set. 1283eda59b39SMark Cave-Ayland */ 1284eda59b39SMark Cave-Ayland 1285eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque) 1286eda59b39SMark Cave-Ayland { 1287eda59b39SMark Cave-Ayland ESPState *s = ESP(opaque); 1288eda59b39SMark Cave-Ayland 1289eda59b39SMark Cave-Ayland return s->dma_memory_read == NULL && s->dma_memory_write == NULL && 1290eda59b39SMark Cave-Ayland s->dma_enabled; 1291eda59b39SMark Cave-Ayland } 1292eda59b39SMark Cave-Ayland 1293eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = { 1294eda59b39SMark Cave-Ayland .name = "esp/pdma", 1295eda59b39SMark Cave-Ayland .version_id = 0, 1296eda59b39SMark Cave-Ayland .minimum_version_id = 0, 1297eda59b39SMark Cave-Ayland .needed = esp_pdma_needed, 12982d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1299eda59b39SMark Cave-Ayland VMSTATE_UINT8(pdma_cb, ESPState), 1300eda59b39SMark Cave-Ayland VMSTATE_END_OF_LIST() 1301eda59b39SMark Cave-Ayland } 1302eda59b39SMark Cave-Ayland }; 1303eda59b39SMark Cave-Ayland 13049c7e23fcSHervé Poussineau const VMStateDescription vmstate_esp = { 1305cc9952f3SBlue Swirl .name = "esp", 13064eb86065SPaolo Bonzini .version_id = 6, 1307cc9952f3SBlue Swirl .minimum_version_id = 3, 13080bd005beSMark Cave-Ayland .post_load = esp_post_load, 13092d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1310cc9952f3SBlue Swirl VMSTATE_BUFFER(rregs, ESPState), 1311cc9952f3SBlue Swirl VMSTATE_BUFFER(wregs, ESPState), 1312cc9952f3SBlue Swirl VMSTATE_INT32(ti_size, ESPState), 1313042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1314042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1315042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 13163944966dSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 13174aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 13184aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 13194aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 13204aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 1321cc9952f3SBlue Swirl VMSTATE_UINT32(dma, ESPState), 1322023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1323023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1324023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1325023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1326023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1327023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 1328cc9952f3SBlue Swirl VMSTATE_UINT32(do_cmd, ESPState), 13296cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 13304e78f3bfSMark Cave-Ayland VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5), 1331023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1332042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1333023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 13341b9e48a5SMark Cave-Ayland VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5), 13354eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 1336cc9952f3SBlue Swirl VMSTATE_END_OF_LIST() 133774d71ea1SLaurent Vivier }, 13382d7b39a6SRichard Henderson .subsections = (const VMStateDescription * const []) { 1339eda59b39SMark Cave-Ayland &vmstate_esp_pdma, 1340eda59b39SMark Cave-Ayland NULL 1341eda59b39SMark Cave-Ayland } 1342cc9952f3SBlue Swirl }; 13436f7e9aecSbellard 1344a8170e5eSAvi Kivity static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 1345a391fdbcSHervé Poussineau uint64_t val, unsigned int size) 1346a391fdbcSHervé Poussineau { 1347a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 1348eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1349a391fdbcSHervé Poussineau uint32_t saddr; 1350a391fdbcSHervé Poussineau 1351a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 1352eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 1353a391fdbcSHervé Poussineau } 1354a391fdbcSHervé Poussineau 1355a8170e5eSAvi Kivity static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 1356a391fdbcSHervé Poussineau unsigned int size) 1357a391fdbcSHervé Poussineau { 1358a391fdbcSHervé Poussineau SysBusESPState *sysbus = opaque; 1359eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1360a391fdbcSHervé Poussineau uint32_t saddr; 1361a391fdbcSHervé Poussineau 1362a391fdbcSHervé Poussineau saddr = addr >> sysbus->it_shift; 1363eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 1364a391fdbcSHervé Poussineau } 1365a391fdbcSHervé Poussineau 1366a391fdbcSHervé Poussineau static const MemoryRegionOps sysbus_esp_mem_ops = { 1367a391fdbcSHervé Poussineau .read = sysbus_esp_mem_read, 1368a391fdbcSHervé Poussineau .write = sysbus_esp_mem_write, 1369a391fdbcSHervé Poussineau .endianness = DEVICE_NATIVE_ENDIAN, 1370a391fdbcSHervé Poussineau .valid.accepts = esp_mem_accepts, 1371a391fdbcSHervé Poussineau }; 1372a391fdbcSHervé Poussineau 137374d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 137474d71ea1SLaurent Vivier uint64_t val, unsigned int size) 137574d71ea1SLaurent Vivier { 137674d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1377eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 137874d71ea1SLaurent Vivier 1379960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1380960ebfd9SMark Cave-Ayland 138174d71ea1SLaurent Vivier switch (size) { 138274d71ea1SLaurent Vivier case 1: 1383761bef75SMark Cave-Ayland esp_pdma_write(s, val); 138474d71ea1SLaurent Vivier break; 138574d71ea1SLaurent Vivier case 2: 1386761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1387761bef75SMark Cave-Ayland esp_pdma_write(s, val); 138874d71ea1SLaurent Vivier break; 138974d71ea1SLaurent Vivier } 1390d0243b09SMark Cave-Ayland esp_pdma_cb(s); 139174d71ea1SLaurent Vivier } 139274d71ea1SLaurent Vivier 139374d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 139474d71ea1SLaurent Vivier unsigned int size) 139574d71ea1SLaurent Vivier { 139674d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1397eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 139874d71ea1SLaurent Vivier uint64_t val = 0; 139974d71ea1SLaurent Vivier 1400960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1401960ebfd9SMark Cave-Ayland 140274d71ea1SLaurent Vivier switch (size) { 140374d71ea1SLaurent Vivier case 1: 1404761bef75SMark Cave-Ayland val = esp_pdma_read(s); 140574d71ea1SLaurent Vivier break; 140674d71ea1SLaurent Vivier case 2: 1407761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1408761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 140974d71ea1SLaurent Vivier break; 141074d71ea1SLaurent Vivier } 1411d0243b09SMark Cave-Ayland esp_pdma_cb(s); 141274d71ea1SLaurent Vivier return val; 141374d71ea1SLaurent Vivier } 141474d71ea1SLaurent Vivier 1415a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1416a7a22088SMark Cave-Ayland { 1417a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1418a7a22088SMark Cave-Ayland 1419a7a22088SMark Cave-Ayland scsi_req_ref(req); 1420a7a22088SMark Cave-Ayland s->current_req = req; 1421a7a22088SMark Cave-Ayland return s; 1422a7a22088SMark Cave-Ayland } 1423a7a22088SMark Cave-Ayland 142474d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 142574d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 142674d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 142774d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 142874d71ea1SLaurent Vivier .valid.min_access_size = 1, 1429cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1430cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1431cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 143274d71ea1SLaurent Vivier }; 143374d71ea1SLaurent Vivier 1434afd4030cSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 1435afd4030cSPaolo Bonzini .tcq = false, 14367e0380b9SPaolo Bonzini .max_target = ESP_MAX_DEVS, 14377e0380b9SPaolo Bonzini .max_lun = 7, 1438afd4030cSPaolo Bonzini 1439a7a22088SMark Cave-Ayland .load_request = esp_load_request, 1440c6df7102SPaolo Bonzini .transfer_data = esp_transfer_data, 144194d3f98aSPaolo Bonzini .complete = esp_command_complete, 144294d3f98aSPaolo Bonzini .cancel = esp_request_cancelled 1443cfdc1bb0SPaolo Bonzini }; 1444cfdc1bb0SPaolo Bonzini 1445a391fdbcSHervé Poussineau static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 1446cfb9de9cSPaul Brook { 144784fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1448eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1449a391fdbcSHervé Poussineau 1450a391fdbcSHervé Poussineau switch (irq) { 1451a391fdbcSHervé Poussineau case 0: 1452a391fdbcSHervé Poussineau parent_esp_reset(s, irq, level); 1453a391fdbcSHervé Poussineau break; 1454a391fdbcSHervé Poussineau case 1: 1455b86dc5cbSMark Cave-Ayland esp_dma_enable(s, irq, level); 1456a391fdbcSHervé Poussineau break; 1457a391fdbcSHervé Poussineau } 1458a391fdbcSHervé Poussineau } 1459a391fdbcSHervé Poussineau 1460b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 1461a391fdbcSHervé Poussineau { 1462b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 146384fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1464eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1465eb169c76SMark Cave-Ayland 1466eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1467eb169c76SMark Cave-Ayland return; 1468eb169c76SMark Cave-Ayland } 14696f7e9aecSbellard 1470b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 147174d71ea1SLaurent Vivier sysbus_init_irq(sbd, &s->irq_data); 1472a391fdbcSHervé Poussineau assert(sysbus->it_shift != -1); 14736f7e9aecSbellard 1474d32e4b3dSHervé Poussineau s->chip_id = TCHI_FAS100A; 147529776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 147674d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1477b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 147874d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1479cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 148074d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 14816f7e9aecSbellard 1482b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 14832d069babSblueswir1 1484739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 148567e999beSbellard } 1486cfb9de9cSPaul Brook 1487a391fdbcSHervé Poussineau static void sysbus_esp_hard_reset(DeviceState *dev) 1488a391fdbcSHervé Poussineau { 148984fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1490eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1491eb169c76SMark Cave-Ayland 1492eb169c76SMark Cave-Ayland esp_hard_reset(s); 1493eb169c76SMark Cave-Ayland } 1494eb169c76SMark Cave-Ayland 1495eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1496eb169c76SMark Cave-Ayland { 1497eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1498eb169c76SMark Cave-Ayland 1499eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 1500a391fdbcSHervé Poussineau } 1501a391fdbcSHervé Poussineau 1502a391fdbcSHervé Poussineau static const VMStateDescription vmstate_sysbus_esp_scsi = { 1503a391fdbcSHervé Poussineau .name = "sysbusespscsi", 15040bd005beSMark Cave-Ayland .version_id = 2, 1505ea84a442SGuenter Roeck .minimum_version_id = 1, 1506ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 15072d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 15080bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 1509a391fdbcSHervé Poussineau VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 1510a391fdbcSHervé Poussineau VMSTATE_END_OF_LIST() 1511a391fdbcSHervé Poussineau } 1512999e12bbSAnthony Liguori }; 1513999e12bbSAnthony Liguori 1514a391fdbcSHervé Poussineau static void sysbus_esp_class_init(ObjectClass *klass, void *data) 1515999e12bbSAnthony Liguori { 151639bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 1517999e12bbSAnthony Liguori 1518b09318caSHu Tao dc->realize = sysbus_esp_realize; 1519a391fdbcSHervé Poussineau dc->reset = sysbus_esp_hard_reset; 1520a391fdbcSHervé Poussineau dc->vmsd = &vmstate_sysbus_esp_scsi; 1521125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 152263235df8SBlue Swirl } 1523999e12bbSAnthony Liguori 15241f077308SHervé Poussineau static const TypeInfo sysbus_esp_info = { 152584fbefedSMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 152639bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 1527eb169c76SMark Cave-Ayland .instance_init = sysbus_esp_init, 1528a391fdbcSHervé Poussineau .instance_size = sizeof(SysBusESPState), 1529a391fdbcSHervé Poussineau .class_init = sysbus_esp_class_init, 153063235df8SBlue Swirl }; 153163235df8SBlue Swirl 1532042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1533042879fcSMark Cave-Ayland { 1534042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1535042879fcSMark Cave-Ayland 1536042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1537023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1538042879fcSMark Cave-Ayland } 1539042879fcSMark Cave-Ayland 1540042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1541042879fcSMark Cave-Ayland { 1542042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1543042879fcSMark Cave-Ayland 1544042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1545023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1546042879fcSMark Cave-Ayland } 1547042879fcSMark Cave-Ayland 1548eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1549eb169c76SMark Cave-Ayland { 1550eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1551eb169c76SMark Cave-Ayland 1552eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1553eb169c76SMark Cave-Ayland dc->user_creatable = false; 1554eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1555eb169c76SMark Cave-Ayland } 1556eb169c76SMark Cave-Ayland 1557eb169c76SMark Cave-Ayland static const TypeInfo esp_info = { 1558eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1559eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1560042879fcSMark Cave-Ayland .instance_init = esp_init, 1561042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1562eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1563eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1564eb169c76SMark Cave-Ayland }; 1565eb169c76SMark Cave-Ayland 156683f7d43aSAndreas Färber static void esp_register_types(void) 1567cfb9de9cSPaul Brook { 1568a391fdbcSHervé Poussineau type_register_static(&sysbus_esp_info); 1569eb169c76SMark Cave-Ayland type_register_static(&esp_info); 1570cfb9de9cSPaul Brook } 1571cfb9de9cSPaul Brook 157283f7d43aSAndreas Färber type_init(esp_register_types) 1573