149ab747fSPaolo Bonzini /* 249ab747fSPaolo Bonzini * QEMU ESP/NCR53C9x emulation 349ab747fSPaolo Bonzini * 449ab747fSPaolo Bonzini * Copyright (c) 2005-2006 Fabrice Bellard 549ab747fSPaolo Bonzini * Copyright (c) 2012 Herve Poussineau 678d68f31SMark Cave-Ayland * Copyright (c) 2023 Mark Cave-Ayland 749ab747fSPaolo Bonzini * 849ab747fSPaolo Bonzini * Permission is hereby granted, free of charge, to any person obtaining a copy 949ab747fSPaolo Bonzini * of this software and associated documentation files (the "Software"), to deal 1049ab747fSPaolo Bonzini * in the Software without restriction, including without limitation the rights 1149ab747fSPaolo Bonzini * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 1249ab747fSPaolo Bonzini * copies of the Software, and to permit persons to whom the Software is 1349ab747fSPaolo Bonzini * furnished to do so, subject to the following conditions: 1449ab747fSPaolo Bonzini * 1549ab747fSPaolo Bonzini * The above copyright notice and this permission notice shall be included in 1649ab747fSPaolo Bonzini * all copies or substantial portions of the Software. 1749ab747fSPaolo Bonzini * 1849ab747fSPaolo Bonzini * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 1949ab747fSPaolo Bonzini * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 2049ab747fSPaolo Bonzini * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 2149ab747fSPaolo Bonzini * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 2249ab747fSPaolo Bonzini * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 2349ab747fSPaolo Bonzini * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 2449ab747fSPaolo Bonzini * THE SOFTWARE. 2549ab747fSPaolo Bonzini */ 2649ab747fSPaolo Bonzini 27a4ab4792SPeter Maydell #include "qemu/osdep.h" 2849ab747fSPaolo Bonzini #include "hw/sysbus.h" 29d6454270SMarkus Armbruster #include "migration/vmstate.h" 3064552b6bSMarkus Armbruster #include "hw/irq.h" 3149ab747fSPaolo Bonzini #include "hw/scsi/esp.h" 3249ab747fSPaolo Bonzini #include "trace.h" 3349ab747fSPaolo Bonzini #include "qemu/log.h" 340b8fa32fSMarkus Armbruster #include "qemu/module.h" 3549ab747fSPaolo Bonzini 3649ab747fSPaolo Bonzini /* 3749ab747fSPaolo Bonzini * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O), 3849ab747fSPaolo Bonzini * also produced as NCR89C100. See 3949ab747fSPaolo Bonzini * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt 4049ab747fSPaolo Bonzini * and 4149ab747fSPaolo Bonzini * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt 4274d71ea1SLaurent Vivier * 4374d71ea1SLaurent Vivier * On Macintosh Quadra it is a NCR53C96. 4449ab747fSPaolo Bonzini */ 4549ab747fSPaolo Bonzini 4649ab747fSPaolo Bonzini static void esp_raise_irq(ESPState *s) 4749ab747fSPaolo Bonzini { 4849ab747fSPaolo Bonzini if (!(s->rregs[ESP_RSTAT] & STAT_INT)) { 4949ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_INT; 5049ab747fSPaolo Bonzini qemu_irq_raise(s->irq); 5149ab747fSPaolo Bonzini trace_esp_raise_irq(); 5249ab747fSPaolo Bonzini } 5349ab747fSPaolo Bonzini } 5449ab747fSPaolo Bonzini 5549ab747fSPaolo Bonzini static void esp_lower_irq(ESPState *s) 5649ab747fSPaolo Bonzini { 5749ab747fSPaolo Bonzini if (s->rregs[ESP_RSTAT] & STAT_INT) { 5849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_INT; 5949ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 6049ab747fSPaolo Bonzini trace_esp_lower_irq(); 6149ab747fSPaolo Bonzini } 6249ab747fSPaolo Bonzini } 6349ab747fSPaolo Bonzini 6474d71ea1SLaurent Vivier static void esp_raise_drq(ESPState *s) 6574d71ea1SLaurent Vivier { 66442de89aSMark Cave-Ayland if (!(s->drq_state)) { 676dec7c0dSMark Cave-Ayland qemu_irq_raise(s->drq_irq); 68960ebfd9SMark Cave-Ayland trace_esp_raise_drq(); 69442de89aSMark Cave-Ayland s->drq_state = true; 70442de89aSMark Cave-Ayland } 7174d71ea1SLaurent Vivier } 7274d71ea1SLaurent Vivier 7374d71ea1SLaurent Vivier static void esp_lower_drq(ESPState *s) 7474d71ea1SLaurent Vivier { 75442de89aSMark Cave-Ayland if (s->drq_state) { 766dec7c0dSMark Cave-Ayland qemu_irq_lower(s->drq_irq); 77960ebfd9SMark Cave-Ayland trace_esp_lower_drq(); 78442de89aSMark Cave-Ayland s->drq_state = false; 79442de89aSMark Cave-Ayland } 8074d71ea1SLaurent Vivier } 8174d71ea1SLaurent Vivier 82*2c1017bfSMark Cave-Ayland static const char *esp_phase_names[8] = { 83*2c1017bfSMark Cave-Ayland "DATA OUT", "DATA IN", "COMMAND", "STATUS", 84*2c1017bfSMark Cave-Ayland "(reserved)", "(reserved)", "MESSAGE OUT", "MESSAGE IN" 85*2c1017bfSMark Cave-Ayland }; 86*2c1017bfSMark Cave-Ayland 87*2c1017bfSMark Cave-Ayland static void esp_set_phase(ESPState *s, uint8_t phase) 88*2c1017bfSMark Cave-Ayland { 89*2c1017bfSMark Cave-Ayland s->rregs[ESP_RSTAT] &= ~7; 90*2c1017bfSMark Cave-Ayland s->rregs[ESP_RSTAT] |= phase; 91*2c1017bfSMark Cave-Ayland 92*2c1017bfSMark Cave-Ayland trace_esp_set_phase(esp_phase_names[phase]); 93*2c1017bfSMark Cave-Ayland } 94*2c1017bfSMark Cave-Ayland 95*2c1017bfSMark Cave-Ayland static uint8_t esp_get_phase(ESPState *s) 96*2c1017bfSMark Cave-Ayland { 97*2c1017bfSMark Cave-Ayland return s->rregs[ESP_RSTAT] & 7; 98*2c1017bfSMark Cave-Ayland } 99*2c1017bfSMark Cave-Ayland 10049ab747fSPaolo Bonzini void esp_dma_enable(ESPState *s, int irq, int level) 10149ab747fSPaolo Bonzini { 10249ab747fSPaolo Bonzini if (level) { 10349ab747fSPaolo Bonzini s->dma_enabled = 1; 10449ab747fSPaolo Bonzini trace_esp_dma_enable(); 10549ab747fSPaolo Bonzini if (s->dma_cb) { 10649ab747fSPaolo Bonzini s->dma_cb(s); 10749ab747fSPaolo Bonzini s->dma_cb = NULL; 10849ab747fSPaolo Bonzini } 10949ab747fSPaolo Bonzini } else { 11049ab747fSPaolo Bonzini trace_esp_dma_disable(); 11149ab747fSPaolo Bonzini s->dma_enabled = 0; 11249ab747fSPaolo Bonzini } 11349ab747fSPaolo Bonzini } 11449ab747fSPaolo Bonzini 11549ab747fSPaolo Bonzini void esp_request_cancelled(SCSIRequest *req) 11649ab747fSPaolo Bonzini { 11749ab747fSPaolo Bonzini ESPState *s = req->hba_private; 11849ab747fSPaolo Bonzini 11949ab747fSPaolo Bonzini if (req == s->current_req) { 12049ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 12149ab747fSPaolo Bonzini s->current_req = NULL; 12249ab747fSPaolo Bonzini s->current_dev = NULL; 123324c8809SMark Cave-Ayland s->async_len = 0; 12449ab747fSPaolo Bonzini } 12549ab747fSPaolo Bonzini } 12649ab747fSPaolo Bonzini 1270e7dbe29SMark Cave-Ayland static void esp_fifo_push(ESPState *s, uint8_t val) 128042879fcSMark Cave-Ayland { 1290e7dbe29SMark Cave-Ayland if (fifo8_num_used(&s->fifo) == s->fifo.capacity) { 130042879fcSMark Cave-Ayland trace_esp_error_fifo_overrun(); 131042879fcSMark Cave-Ayland return; 132042879fcSMark Cave-Ayland } 133042879fcSMark Cave-Ayland 1340e7dbe29SMark Cave-Ayland fifo8_push(&s->fifo, val); 135042879fcSMark Cave-Ayland } 136c5fef911SMark Cave-Ayland 137266170f9SMark Cave-Ayland static void esp_fifo_push_buf(ESPState *s, uint8_t *buf, int len) 138266170f9SMark Cave-Ayland { 139266170f9SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, len); 140266170f9SMark Cave-Ayland } 141266170f9SMark Cave-Ayland 14261fa150dSMark Cave-Ayland static uint8_t esp_fifo_pop(ESPState *s) 143042879fcSMark Cave-Ayland { 14461fa150dSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 145042879fcSMark Cave-Ayland return 0; 146042879fcSMark Cave-Ayland } 147042879fcSMark Cave-Ayland 14861fa150dSMark Cave-Ayland return fifo8_pop(&s->fifo); 149023666daSMark Cave-Ayland } 150023666daSMark Cave-Ayland 151d103d0dbSMark Cave-Ayland static uint32_t esp_fifo8_pop_buf(Fifo8 *fifo, uint8_t *dest, int maxlen) 1527b320a8eSMark Cave-Ayland { 1537b320a8eSMark Cave-Ayland const uint8_t *buf; 15449c60d16SMark Cave-Ayland uint32_t n, n2; 15549c60d16SMark Cave-Ayland int len; 1567b320a8eSMark Cave-Ayland 1577b320a8eSMark Cave-Ayland if (maxlen == 0) { 1587b320a8eSMark Cave-Ayland return 0; 1597b320a8eSMark Cave-Ayland } 1607b320a8eSMark Cave-Ayland 16149c60d16SMark Cave-Ayland len = maxlen; 16249c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n); 1637b320a8eSMark Cave-Ayland if (dest) { 1647b320a8eSMark Cave-Ayland memcpy(dest, buf, n); 1657b320a8eSMark Cave-Ayland } 1667b320a8eSMark Cave-Ayland 16749c60d16SMark Cave-Ayland /* Add FIFO wraparound if needed */ 16849c60d16SMark Cave-Ayland len -= n; 16949c60d16SMark Cave-Ayland len = MIN(len, fifo8_num_used(fifo)); 17049c60d16SMark Cave-Ayland if (len) { 17149c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n2); 17249c60d16SMark Cave-Ayland if (dest) { 17349c60d16SMark Cave-Ayland memcpy(&dest[n], buf, n2); 17449c60d16SMark Cave-Ayland } 17549c60d16SMark Cave-Ayland n += n2; 17649c60d16SMark Cave-Ayland } 17749c60d16SMark Cave-Ayland 1787b320a8eSMark Cave-Ayland return n; 1797b320a8eSMark Cave-Ayland } 1807b320a8eSMark Cave-Ayland 181da838126SMark Cave-Ayland static uint32_t esp_fifo_pop_buf(ESPState *s, uint8_t *dest, int maxlen) 182d103d0dbSMark Cave-Ayland { 183da838126SMark Cave-Ayland return esp_fifo8_pop_buf(&s->fifo, dest, maxlen); 184d103d0dbSMark Cave-Ayland } 185d103d0dbSMark Cave-Ayland 186c47b5835SMark Cave-Ayland static uint32_t esp_get_tc(ESPState *s) 187c47b5835SMark Cave-Ayland { 188c47b5835SMark Cave-Ayland uint32_t dmalen; 189c47b5835SMark Cave-Ayland 190c47b5835SMark Cave-Ayland dmalen = s->rregs[ESP_TCLO]; 191c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCMID] << 8; 192c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCHI] << 16; 193c47b5835SMark Cave-Ayland 194c47b5835SMark Cave-Ayland return dmalen; 195c47b5835SMark Cave-Ayland } 196c47b5835SMark Cave-Ayland 197c47b5835SMark Cave-Ayland static void esp_set_tc(ESPState *s, uint32_t dmalen) 198c47b5835SMark Cave-Ayland { 199c5d7df28SMark Cave-Ayland uint32_t old_tc = esp_get_tc(s); 200c5d7df28SMark Cave-Ayland 201c47b5835SMark Cave-Ayland s->rregs[ESP_TCLO] = dmalen; 202c47b5835SMark Cave-Ayland s->rregs[ESP_TCMID] = dmalen >> 8; 203c47b5835SMark Cave-Ayland s->rregs[ESP_TCHI] = dmalen >> 16; 204c5d7df28SMark Cave-Ayland 205c5d7df28SMark Cave-Ayland if (old_tc && dmalen == 0) { 206c5d7df28SMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 207c5d7df28SMark Cave-Ayland } 208c47b5835SMark Cave-Ayland } 209c47b5835SMark Cave-Ayland 210c04ed569SMark Cave-Ayland static uint32_t esp_get_stc(ESPState *s) 211c04ed569SMark Cave-Ayland { 212c04ed569SMark Cave-Ayland uint32_t dmalen; 213c04ed569SMark Cave-Ayland 214c04ed569SMark Cave-Ayland dmalen = s->wregs[ESP_TCLO]; 215c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCMID] << 8; 216c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCHI] << 16; 217c04ed569SMark Cave-Ayland 218c04ed569SMark Cave-Ayland return dmalen; 219c04ed569SMark Cave-Ayland } 220c04ed569SMark Cave-Ayland 221761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 222761bef75SMark Cave-Ayland { 2238da90e81SMark Cave-Ayland uint8_t val; 2248da90e81SMark Cave-Ayland 22561fa150dSMark Cave-Ayland val = esp_fifo_pop(s); 2268da90e81SMark Cave-Ayland return val; 227761bef75SMark Cave-Ayland } 228761bef75SMark Cave-Ayland 229761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 230761bef75SMark Cave-Ayland { 2318da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 2328da90e81SMark Cave-Ayland 2333c421400SMark Cave-Ayland if (dmalen == 0) { 2348da90e81SMark Cave-Ayland return; 2358da90e81SMark Cave-Ayland } 2368da90e81SMark Cave-Ayland 2370e7dbe29SMark Cave-Ayland esp_fifo_push(s, val); 2388da90e81SMark Cave-Ayland 2398da90e81SMark Cave-Ayland dmalen--; 2408da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 241761bef75SMark Cave-Ayland } 242761bef75SMark Cave-Ayland 243c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2446130b188SLaurent Vivier { 2456130b188SLaurent Vivier int target; 2466130b188SLaurent Vivier 2476130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2486130b188SLaurent Vivier 2496130b188SLaurent Vivier s->ti_size = 0; 2509b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_0; 2516130b188SLaurent Vivier 252cf40a5e4SMark Cave-Ayland if (s->current_req) { 253cf40a5e4SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 254cf40a5e4SMark Cave-Ayland scsi_req_cancel(s->current_req); 255cf40a5e4SMark Cave-Ayland } 256cf40a5e4SMark Cave-Ayland 2576130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 2586130b188SLaurent Vivier if (!s->current_dev) { 2596130b188SLaurent Vivier /* No such drive */ 2606130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 261cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 2626130b188SLaurent Vivier esp_raise_irq(s); 2636130b188SLaurent Vivier return -1; 2646130b188SLaurent Vivier } 2654e78f3bfSMark Cave-Ayland 2664e78f3bfSMark Cave-Ayland /* 2674e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 268c90b2792SMark Cave-Ayland * either in esp_transfer_data() or esp_command_complete() 2694e78f3bfSMark Cave-Ayland */ 2706130b188SLaurent Vivier return 0; 2716130b188SLaurent Vivier } 2726130b188SLaurent Vivier 2733ee9a475SMark Cave-Ayland static void esp_do_dma(ESPState *s); 2743ee9a475SMark Cave-Ayland static void esp_do_nodma(ESPState *s); 2753ee9a475SMark Cave-Ayland 2764eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 27749ab747fSPaolo Bonzini { 2787b320a8eSMark Cave-Ayland uint32_t cmdlen; 27949ab747fSPaolo Bonzini int32_t datalen; 28049ab747fSPaolo Bonzini SCSIDevice *current_lun; 2817b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 28249ab747fSPaolo Bonzini 2834eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 284023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 28599545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 28699545751SMark Cave-Ayland return; 28799545751SMark Cave-Ayland } 288f87d0487SMark Cave-Ayland esp_fifo8_pop_buf(&s->cmdfifo, buf, cmdlen); 289023666daSMark Cave-Ayland 2904eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 291b22f83d8SAlexandra Diupina if (!current_lun) { 292b22f83d8SAlexandra Diupina /* No such drive */ 293b22f83d8SAlexandra Diupina s->rregs[ESP_RSTAT] = 0; 294b22f83d8SAlexandra Diupina s->rregs[ESP_RINTR] = INTR_DC; 295b22f83d8SAlexandra Diupina s->rregs[ESP_RSEQ] = SEQ_0; 296b22f83d8SAlexandra Diupina esp_raise_irq(s); 297b22f83d8SAlexandra Diupina return; 298b22f83d8SAlexandra Diupina } 299b22f83d8SAlexandra Diupina 300fe9d8927SJohn Millikin s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s); 30149ab747fSPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 30249ab747fSPaolo Bonzini s->ti_size = datalen; 303023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 304c90b2792SMark Cave-Ayland s->data_ready = false; 30549ab747fSPaolo Bonzini if (datalen != 0) { 3064e78f3bfSMark Cave-Ayland /* 307c90b2792SMark Cave-Ayland * Switch to DATA phase but wait until initial data xfer is 3084e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3094e78f3bfSMark Cave-Ayland */ 310c90b2792SMark Cave-Ayland if (datalen > 0) { 311abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DI); 31249ab747fSPaolo Bonzini } else { 313abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DO); 31449ab747fSPaolo Bonzini } 3154e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3164e78f3bfSMark Cave-Ayland return; 3174e78f3bfSMark Cave-Ayland } 3184e78f3bfSMark Cave-Ayland } 31949ab747fSPaolo Bonzini 3204eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 32149ab747fSPaolo Bonzini { 3224eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3231828000bSMark Cave-Ayland uint8_t message = fifo8_is_empty(&s->cmdfifo) ? 0 : 3241828000bSMark Cave-Ayland fifo8_pop(&s->cmdfifo); 325023666daSMark Cave-Ayland 3264eb86065SPaolo Bonzini trace_esp_do_identify(message); 3274eb86065SPaolo Bonzini s->lun = message & 7; 328023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3294eb86065SPaolo Bonzini } 33049ab747fSPaolo Bonzini 331799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 332023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3334eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 3342260402bSMark Cave-Ayland esp_fifo8_pop_buf(&s->cmdfifo, NULL, len); 335023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 336023666daSMark Cave-Ayland } 3374eb86065SPaolo Bonzini } 338023666daSMark Cave-Ayland 3394eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3404eb86065SPaolo Bonzini { 3414eb86065SPaolo Bonzini do_message_phase(s); 3424eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3434eb86065SPaolo Bonzini do_command_phase(s); 34449ab747fSPaolo Bonzini } 34549ab747fSPaolo Bonzini 34649ab747fSPaolo Bonzini static void handle_satn(ESPState *s) 34749ab747fSPaolo Bonzini { 34849ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 34949ab747fSPaolo Bonzini s->dma_cb = handle_satn; 35049ab747fSPaolo Bonzini return; 35149ab747fSPaolo Bonzini } 352b46a43a2SMark Cave-Ayland 3531bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3541bcaf71bSMark Cave-Ayland return; 3551bcaf71bSMark Cave-Ayland } 3563ee9a475SMark Cave-Ayland 3573ee9a475SMark Cave-Ayland esp_set_phase(s, STAT_MO); 3583ee9a475SMark Cave-Ayland 3593ee9a475SMark Cave-Ayland if (s->dma) { 3603ee9a475SMark Cave-Ayland esp_do_dma(s); 3613ee9a475SMark Cave-Ayland } else { 362d39592ffSMark Cave-Ayland esp_do_nodma(s); 36349ab747fSPaolo Bonzini } 36494d5c79dSMark Cave-Ayland } 36549ab747fSPaolo Bonzini 36649ab747fSPaolo Bonzini static void handle_s_without_atn(ESPState *s) 36749ab747fSPaolo Bonzini { 36849ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 36949ab747fSPaolo Bonzini s->dma_cb = handle_s_without_atn; 37049ab747fSPaolo Bonzini return; 37149ab747fSPaolo Bonzini } 372b46a43a2SMark Cave-Ayland 3731bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3741bcaf71bSMark Cave-Ayland return; 3751bcaf71bSMark Cave-Ayland } 3769ff0fd12SMark Cave-Ayland 377abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 3789ff0fd12SMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 3799ff0fd12SMark Cave-Ayland 3809ff0fd12SMark Cave-Ayland if (s->dma) { 3819ff0fd12SMark Cave-Ayland esp_do_dma(s); 3829ff0fd12SMark Cave-Ayland } else { 383d39592ffSMark Cave-Ayland esp_do_nodma(s); 38449ab747fSPaolo Bonzini } 38549ab747fSPaolo Bonzini } 38649ab747fSPaolo Bonzini 38749ab747fSPaolo Bonzini static void handle_satn_stop(ESPState *s) 38849ab747fSPaolo Bonzini { 38949ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 39049ab747fSPaolo Bonzini s->dma_cb = handle_satn_stop; 39149ab747fSPaolo Bonzini return; 39249ab747fSPaolo Bonzini } 393b46a43a2SMark Cave-Ayland 3941bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3951bcaf71bSMark Cave-Ayland return; 3961bcaf71bSMark Cave-Ayland } 397db4d4150SMark Cave-Ayland 398abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 3995d02add4SMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 400db4d4150SMark Cave-Ayland 401db4d4150SMark Cave-Ayland if (s->dma) { 402db4d4150SMark Cave-Ayland esp_do_dma(s); 403db4d4150SMark Cave-Ayland } else { 404d39592ffSMark Cave-Ayland esp_do_nodma(s); 40549ab747fSPaolo Bonzini } 40649ab747fSPaolo Bonzini } 40749ab747fSPaolo Bonzini 408a6cad7cdSMark Cave-Ayland static void handle_pad(ESPState *s) 409a6cad7cdSMark Cave-Ayland { 410a6cad7cdSMark Cave-Ayland if (s->dma) { 411a6cad7cdSMark Cave-Ayland esp_do_dma(s); 412a6cad7cdSMark Cave-Ayland } else { 413a6cad7cdSMark Cave-Ayland esp_do_nodma(s); 414a6cad7cdSMark Cave-Ayland } 415a6cad7cdSMark Cave-Ayland } 416a6cad7cdSMark Cave-Ayland 41749ab747fSPaolo Bonzini static void write_response(ESPState *s) 41849ab747fSPaolo Bonzini { 41949ab747fSPaolo Bonzini trace_esp_write_response(s->status); 420042879fcSMark Cave-Ayland 4218baa1472SMark Cave-Ayland if (s->dma) { 4228baa1472SMark Cave-Ayland esp_do_dma(s); 4238baa1472SMark Cave-Ayland } else { 42483428f7aSMark Cave-Ayland esp_do_nodma(s); 42549ab747fSPaolo Bonzini } 4268baa1472SMark Cave-Ayland } 42749ab747fSPaolo Bonzini 4285aa0df40SMark Cave-Ayland static bool esp_cdb_ready(ESPState *s) 4295d02add4SMark Cave-Ayland { 4305aa0df40SMark Cave-Ayland int len = fifo8_num_used(&s->cmdfifo) - s->cmdfifo_cdb_offset; 4315d02add4SMark Cave-Ayland const uint8_t *pbuf; 4323cc70889SMark Cave-Ayland uint32_t n; 4335aa0df40SMark Cave-Ayland int cdblen; 4345d02add4SMark Cave-Ayland 4355aa0df40SMark Cave-Ayland if (len <= 0) { 4365aa0df40SMark Cave-Ayland return false; 4375d02add4SMark Cave-Ayland } 4385d02add4SMark Cave-Ayland 4393cc70889SMark Cave-Ayland pbuf = fifo8_peek_buf(&s->cmdfifo, len, &n); 4403cc70889SMark Cave-Ayland if (n < len) { 4413cc70889SMark Cave-Ayland /* 4423cc70889SMark Cave-Ayland * In normal use the cmdfifo should never wrap, but include this check 4433cc70889SMark Cave-Ayland * to prevent a malicious guest from reading past the end of the 4443cc70889SMark Cave-Ayland * cmdfifo data buffer below 4453cc70889SMark Cave-Ayland */ 4463cc70889SMark Cave-Ayland return false; 4473cc70889SMark Cave-Ayland } 4483cc70889SMark Cave-Ayland 4495aa0df40SMark Cave-Ayland cdblen = scsi_cdb_length((uint8_t *)&pbuf[s->cmdfifo_cdb_offset]); 4505d02add4SMark Cave-Ayland 4515aa0df40SMark Cave-Ayland return cdblen < 0 ? false : (len >= cdblen); 4525d02add4SMark Cave-Ayland } 4535d02add4SMark Cave-Ayland 454004826d0SMark Cave-Ayland static void esp_dma_ti_check(ESPState *s) 45549ab747fSPaolo Bonzini { 456af74b3c1SMark Cave-Ayland if (esp_get_tc(s) == 0 && fifo8_num_used(&s->fifo) < 2) { 457cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 45849ab747fSPaolo Bonzini esp_raise_irq(s); 459af74b3c1SMark Cave-Ayland esp_lower_drq(s); 460af74b3c1SMark Cave-Ayland } 46149ab747fSPaolo Bonzini } 46249ab747fSPaolo Bonzini 46349ab747fSPaolo Bonzini static void esp_do_dma(ESPState *s) 46449ab747fSPaolo Bonzini { 465023666daSMark Cave-Ayland uint32_t len, cmdlen; 466023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 46749ab747fSPaolo Bonzini 4686cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 469ad2725afSMark Cave-Ayland 470ad2725afSMark Cave-Ayland switch (esp_get_phase(s)) { 471ad2725afSMark Cave-Ayland case STAT_MO: 47246b0c361SMark Cave-Ayland if (s->dma_memory_read) { 47346b0c361SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 47446b0c361SMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 47546b0c361SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 47646b0c361SMark Cave-Ayland } else { 477da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 47867ea170eSMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 47967ea170eSMark Cave-Ayland esp_raise_drq(s); 48046b0c361SMark Cave-Ayland } 48146b0c361SMark Cave-Ayland 48267ea170eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 48367ea170eSMark Cave-Ayland s->cmdfifo_cdb_offset += len; 48446b0c361SMark Cave-Ayland 4853ee9a475SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 4863ee9a475SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 4873ee9a475SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) >= 1) { 4883ee9a475SMark Cave-Ayland /* First byte received, switch to command phase */ 4893ee9a475SMark Cave-Ayland esp_set_phase(s, STAT_CD); 4909b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 4913ee9a475SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 4923ee9a475SMark Cave-Ayland 4933ee9a475SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) > 1) { 4943ee9a475SMark Cave-Ayland /* Process any additional command phase data */ 4953ee9a475SMark Cave-Ayland esp_do_dma(s); 4963ee9a475SMark Cave-Ayland } 4973ee9a475SMark Cave-Ayland } 4983ee9a475SMark Cave-Ayland break; 4993ee9a475SMark Cave-Ayland 500db4d4150SMark Cave-Ayland case CMD_SELATNS | CMD_DMA: 501db4d4150SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) == 1) { 502db4d4150SMark Cave-Ayland /* First byte received, stop in message out phase */ 5039b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 504db4d4150SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 505db4d4150SMark Cave-Ayland 506db4d4150SMark Cave-Ayland /* Raise command completion interrupt */ 507db4d4150SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 508db4d4150SMark Cave-Ayland esp_raise_irq(s); 509db4d4150SMark Cave-Ayland } 510db4d4150SMark Cave-Ayland break; 511db4d4150SMark Cave-Ayland 5123fd325a2SMark Cave-Ayland case CMD_TI | CMD_DMA: 51346b0c361SMark Cave-Ayland /* ATN remains asserted until TC == 0 */ 51446b0c361SMark Cave-Ayland if (esp_get_tc(s) == 0) { 51546b0c361SMark Cave-Ayland esp_set_phase(s, STAT_CD); 516cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 51746b0c361SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 51846b0c361SMark Cave-Ayland esp_raise_irq(s); 51946b0c361SMark Cave-Ayland } 52046b0c361SMark Cave-Ayland break; 5213fd325a2SMark Cave-Ayland } 5223fd325a2SMark Cave-Ayland break; 52346b0c361SMark Cave-Ayland 524ad2725afSMark Cave-Ayland case STAT_CD: 525023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 526023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 52774d71ea1SLaurent Vivier if (s->dma_memory_read) { 5280ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 529023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 530023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 531a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 53274d71ea1SLaurent Vivier } else { 533da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 534406e8a3eSMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 535406e8a3eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 53674d71ea1SLaurent Vivier esp_raise_drq(s); 5373c7f3c8bSMark Cave-Ayland } 538023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 53915407433SLaurent Vivier s->ti_size = 0; 54046b0c361SMark Cave-Ayland if (esp_get_tc(s) == 0) { 541799d90d8SMark Cave-Ayland /* Command has been received */ 542c959f218SMark Cave-Ayland do_cmd(s); 543799d90d8SMark Cave-Ayland } 544ad2725afSMark Cave-Ayland break; 5451454dc76SMark Cave-Ayland 5461454dc76SMark Cave-Ayland case STAT_DO: 5470db89536SMark Cave-Ayland if (!s->current_req) { 5480db89536SMark Cave-Ayland return; 5490db89536SMark Cave-Ayland } 5504460b86aSMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 55149ab747fSPaolo Bonzini /* Defer until data is available. */ 55249ab747fSPaolo Bonzini return; 55349ab747fSPaolo Bonzini } 55449ab747fSPaolo Bonzini if (len > s->async_len) { 55549ab747fSPaolo Bonzini len = s->async_len; 55649ab747fSPaolo Bonzini } 5570d17ce82SMark Cave-Ayland 558a6cad7cdSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 559a6cad7cdSMark Cave-Ayland case CMD_TI | CMD_DMA: 56074d71ea1SLaurent Vivier if (s->dma_memory_read) { 56149ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, s->async_buf, len); 562f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 5630d17ce82SMark Cave-Ayland } else { 5640d17ce82SMark Cave-Ayland /* Copy FIFO data to device */ 5650d17ce82SMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 5660d17ce82SMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 567da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, s->async_buf, len); 5680d17ce82SMark Cave-Ayland esp_raise_drq(s); 5690d17ce82SMark Cave-Ayland } 5700d17ce82SMark Cave-Ayland 571f3666223SMark Cave-Ayland s->async_buf += len; 572f3666223SMark Cave-Ayland s->async_len -= len; 573f3666223SMark Cave-Ayland s->ti_size += len; 574a6cad7cdSMark Cave-Ayland break; 575a6cad7cdSMark Cave-Ayland 576a6cad7cdSMark Cave-Ayland case CMD_PAD | CMD_DMA: 577a6cad7cdSMark Cave-Ayland /* Copy TC zero bytes into the incoming stream */ 578a6cad7cdSMark Cave-Ayland if (!s->dma_memory_read) { 579a6cad7cdSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 580a6cad7cdSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 581a6cad7cdSMark Cave-Ayland } 582a6cad7cdSMark Cave-Ayland 583a6cad7cdSMark Cave-Ayland memset(s->async_buf, 0, len); 584a6cad7cdSMark Cave-Ayland 585a6cad7cdSMark Cave-Ayland s->async_buf += len; 586a6cad7cdSMark Cave-Ayland s->async_len -= len; 587a6cad7cdSMark Cave-Ayland s->ti_size += len; 588a6cad7cdSMark Cave-Ayland break; 589a6cad7cdSMark Cave-Ayland } 590f3666223SMark Cave-Ayland 591e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 592e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 593f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 594f3666223SMark Cave-Ayland return; 595f3666223SMark Cave-Ayland } 596f3666223SMark Cave-Ayland 597004826d0SMark Cave-Ayland esp_dma_ti_check(s); 5981454dc76SMark Cave-Ayland break; 5991454dc76SMark Cave-Ayland 6001454dc76SMark Cave-Ayland case STAT_DI: 6011454dc76SMark Cave-Ayland if (!s->current_req) { 6021454dc76SMark Cave-Ayland return; 6031454dc76SMark Cave-Ayland } 6041454dc76SMark Cave-Ayland if (s->async_len == 0 && esp_get_tc(s) && s->ti_size) { 6051454dc76SMark Cave-Ayland /* Defer until data is available. */ 6061454dc76SMark Cave-Ayland return; 6071454dc76SMark Cave-Ayland } 6081454dc76SMark Cave-Ayland if (len > s->async_len) { 6091454dc76SMark Cave-Ayland len = s->async_len; 6101454dc76SMark Cave-Ayland } 611c37cc88eSMark Cave-Ayland 612a6cad7cdSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 613a6cad7cdSMark Cave-Ayland case CMD_TI | CMD_DMA: 61474d71ea1SLaurent Vivier if (s->dma_memory_write) { 61549ab747fSPaolo Bonzini s->dma_memory_write(s->dma_opaque, s->async_buf, len); 61674d71ea1SLaurent Vivier } else { 61782141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 618042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 619266170f9SMark Cave-Ayland esp_fifo_push_buf(s, s->async_buf, len); 620c37cc88eSMark Cave-Ayland esp_raise_drq(s); 621c37cc88eSMark Cave-Ayland } 622c37cc88eSMark Cave-Ayland 62382141c8bSMark Cave-Ayland s->async_buf += len; 62482141c8bSMark Cave-Ayland s->async_len -= len; 62582141c8bSMark Cave-Ayland s->ti_size -= len; 62682141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 627a6cad7cdSMark Cave-Ayland break; 628a6cad7cdSMark Cave-Ayland 629a6cad7cdSMark Cave-Ayland case CMD_PAD | CMD_DMA: 630a6cad7cdSMark Cave-Ayland /* Drop TC bytes from the incoming stream */ 631a6cad7cdSMark Cave-Ayland if (!s->dma_memory_write) { 632a6cad7cdSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 633a6cad7cdSMark Cave-Ayland } 634a6cad7cdSMark Cave-Ayland 635a6cad7cdSMark Cave-Ayland s->async_buf += len; 636a6cad7cdSMark Cave-Ayland s->async_len -= len; 637a6cad7cdSMark Cave-Ayland s->ti_size -= len; 638a6cad7cdSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 639a6cad7cdSMark Cave-Ayland break; 640a6cad7cdSMark Cave-Ayland } 641e4e166c8SMark Cave-Ayland 64202a3ce56SMark Cave-Ayland if (s->async_len == 0 && s->ti_size == 0 && esp_get_tc(s)) { 64302a3ce56SMark Cave-Ayland /* If the guest underflows TC then terminate SCSI request */ 64402a3ce56SMark Cave-Ayland scsi_req_continue(s->current_req); 64502a3ce56SMark Cave-Ayland return; 64602a3ce56SMark Cave-Ayland } 64702a3ce56SMark Cave-Ayland 648e4e166c8SMark Cave-Ayland if (s->async_len == 0 && fifo8_num_used(&s->fifo) < 2) { 649e4e166c8SMark Cave-Ayland /* Defer until the scsi layer has completed */ 650e4e166c8SMark Cave-Ayland scsi_req_continue(s->current_req); 651e4e166c8SMark Cave-Ayland return; 652e4e166c8SMark Cave-Ayland } 653e4e166c8SMark Cave-Ayland 654004826d0SMark Cave-Ayland esp_dma_ti_check(s); 6551454dc76SMark Cave-Ayland break; 6568baa1472SMark Cave-Ayland 6578baa1472SMark Cave-Ayland case STAT_ST: 6588baa1472SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 6598baa1472SMark Cave-Ayland case CMD_ICCS | CMD_DMA: 6608baa1472SMark Cave-Ayland len = MIN(len, 1); 6618baa1472SMark Cave-Ayland 6628baa1472SMark Cave-Ayland if (len) { 6638baa1472SMark Cave-Ayland buf[0] = s->status; 6648baa1472SMark Cave-Ayland 6658baa1472SMark Cave-Ayland if (s->dma_memory_write) { 6668baa1472SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, len); 6678baa1472SMark Cave-Ayland } else { 668266170f9SMark Cave-Ayland esp_fifo_push_buf(s, buf, len); 6698baa1472SMark Cave-Ayland } 6708baa1472SMark Cave-Ayland 671421d1ca5SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 6728baa1472SMark Cave-Ayland esp_set_phase(s, STAT_MI); 6738baa1472SMark Cave-Ayland 6748baa1472SMark Cave-Ayland if (esp_get_tc(s) > 0) { 6758baa1472SMark Cave-Ayland /* Process any message in phase data */ 6768baa1472SMark Cave-Ayland esp_do_dma(s); 6778baa1472SMark Cave-Ayland } 6788baa1472SMark Cave-Ayland } 6798baa1472SMark Cave-Ayland break; 68002a3ce56SMark Cave-Ayland 68102a3ce56SMark Cave-Ayland default: 68202a3ce56SMark Cave-Ayland /* Consume remaining data if the guest underflows TC */ 68302a3ce56SMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 68402a3ce56SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 68502a3ce56SMark Cave-Ayland esp_raise_irq(s); 68602a3ce56SMark Cave-Ayland esp_lower_drq(s); 68702a3ce56SMark Cave-Ayland } 68802a3ce56SMark Cave-Ayland break; 6898baa1472SMark Cave-Ayland } 6908baa1472SMark Cave-Ayland break; 6918baa1472SMark Cave-Ayland 6928baa1472SMark Cave-Ayland case STAT_MI: 6938baa1472SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 6948baa1472SMark Cave-Ayland case CMD_ICCS | CMD_DMA: 6958baa1472SMark Cave-Ayland len = MIN(len, 1); 6968baa1472SMark Cave-Ayland 6978baa1472SMark Cave-Ayland if (len) { 6988baa1472SMark Cave-Ayland buf[0] = 0; 6998baa1472SMark Cave-Ayland 7008baa1472SMark Cave-Ayland if (s->dma_memory_write) { 7018baa1472SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, len); 7028baa1472SMark Cave-Ayland } else { 703266170f9SMark Cave-Ayland esp_fifo_push_buf(s, buf, len); 7048baa1472SMark Cave-Ayland } 7058baa1472SMark Cave-Ayland 706421d1ca5SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 707421d1ca5SMark Cave-Ayland 7088baa1472SMark Cave-Ayland /* Raise end of command interrupt */ 7090ee71db4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 7108baa1472SMark Cave-Ayland esp_raise_irq(s); 7118baa1472SMark Cave-Ayland } 7128baa1472SMark Cave-Ayland break; 7138baa1472SMark Cave-Ayland } 7148baa1472SMark Cave-Ayland break; 71574d71ea1SLaurent Vivier } 71649ab747fSPaolo Bonzini } 71749ab747fSPaolo Bonzini 718a1b8d389SMark Cave-Ayland static void esp_nodma_ti_dataout(ESPState *s) 719a1b8d389SMark Cave-Ayland { 720a1b8d389SMark Cave-Ayland int len; 721a1b8d389SMark Cave-Ayland 722a1b8d389SMark Cave-Ayland if (!s->current_req) { 723a1b8d389SMark Cave-Ayland return; 724a1b8d389SMark Cave-Ayland } 725a1b8d389SMark Cave-Ayland if (s->async_len == 0) { 726a1b8d389SMark Cave-Ayland /* Defer until data is available. */ 727a1b8d389SMark Cave-Ayland return; 728a1b8d389SMark Cave-Ayland } 729a1b8d389SMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 730a1b8d389SMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 731da838126SMark Cave-Ayland esp_fifo_pop_buf(s, s->async_buf, len); 732a1b8d389SMark Cave-Ayland s->async_buf += len; 733a1b8d389SMark Cave-Ayland s->async_len -= len; 734a1b8d389SMark Cave-Ayland s->ti_size += len; 735a1b8d389SMark Cave-Ayland 736a1b8d389SMark Cave-Ayland if (s->async_len == 0) { 737a1b8d389SMark Cave-Ayland scsi_req_continue(s->current_req); 738a1b8d389SMark Cave-Ayland return; 739a1b8d389SMark Cave-Ayland } 740a1b8d389SMark Cave-Ayland 741a1b8d389SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 742a1b8d389SMark Cave-Ayland esp_raise_irq(s); 743a1b8d389SMark Cave-Ayland } 744a1b8d389SMark Cave-Ayland 7451b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7461b9e48a5SMark Cave-Ayland { 7472572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 7487b320a8eSMark Cave-Ayland uint32_t cmdlen; 7495a857339SMark Cave-Ayland int len; 7501b9e48a5SMark Cave-Ayland 75183e803deSMark Cave-Ayland switch (esp_get_phase(s)) { 75283e803deSMark Cave-Ayland case STAT_MO: 753215d2579SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 754215d2579SMark Cave-Ayland case CMD_SELATN: 7552572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 756da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 7575a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 7585a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 7592572689bSMark Cave-Ayland 7605d02add4SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) >= 1) { 7615d02add4SMark Cave-Ayland /* First byte received, switch to command phase */ 7625d02add4SMark Cave-Ayland esp_set_phase(s, STAT_CD); 7639b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 7645d02add4SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 7655d02add4SMark Cave-Ayland 7665d02add4SMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) > 1) { 7675d02add4SMark Cave-Ayland /* Process any additional command phase data */ 7685d02add4SMark Cave-Ayland esp_do_nodma(s); 7695d02add4SMark Cave-Ayland } 7705d02add4SMark Cave-Ayland } 7715d02add4SMark Cave-Ayland break; 7725d02add4SMark Cave-Ayland 7735d02add4SMark Cave-Ayland case CMD_SELATNS: 774215d2579SMark Cave-Ayland /* Copy one byte from FIFO into cmdfifo */ 7755a50644eSMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, 7765a50644eSMark Cave-Ayland MIN(fifo8_num_used(&s->fifo), 1)); 7775a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 7785a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 779215d2579SMark Cave-Ayland 780d39592ffSMark Cave-Ayland if (fifo8_num_used(&s->cmdfifo) >= 1) { 7815d02add4SMark Cave-Ayland /* First byte received, stop in message out phase */ 7829b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 7835d02add4SMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 7845d02add4SMark Cave-Ayland 7855d02add4SMark Cave-Ayland /* Raise command completion interrupt */ 7865d02add4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 7875d02add4SMark Cave-Ayland esp_raise_irq(s); 7885d02add4SMark Cave-Ayland } 7895d02add4SMark Cave-Ayland break; 7905d02add4SMark Cave-Ayland 7915d02add4SMark Cave-Ayland case CMD_TI: 792215d2579SMark Cave-Ayland /* Copy FIFO into cmdfifo */ 793da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 7945a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 7955a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 796215d2579SMark Cave-Ayland 7975d02add4SMark Cave-Ayland /* ATN remains asserted until FIFO empty */ 7981b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 799abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 800cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 8011b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8021b9e48a5SMark Cave-Ayland esp_raise_irq(s); 80379a6c7c6SMark Cave-Ayland break; 8045d02add4SMark Cave-Ayland } 8055d02add4SMark Cave-Ayland break; 80679a6c7c6SMark Cave-Ayland 80779a6c7c6SMark Cave-Ayland case STAT_CD: 808acdee66dSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 809acdee66dSMark Cave-Ayland case CMD_TI: 81079a6c7c6SMark Cave-Ayland /* Copy FIFO into cmdfifo */ 811da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8125a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8135a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 81479a6c7c6SMark Cave-Ayland 81579a6c7c6SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 81679a6c7c6SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 81779a6c7c6SMark Cave-Ayland 8185d02add4SMark Cave-Ayland /* CDB may be transferred in one or more TI commands */ 8195aa0df40SMark Cave-Ayland if (esp_cdb_ready(s)) { 82079a6c7c6SMark Cave-Ayland /* Command has been received */ 82179a6c7c6SMark Cave-Ayland do_cmd(s); 8225d02add4SMark Cave-Ayland } else { 8235d02add4SMark Cave-Ayland /* 8245d02add4SMark Cave-Ayland * If data was transferred from the FIFO then raise bus 8255d02add4SMark Cave-Ayland * service interrupt to indicate transfer complete. Otherwise 8265d02add4SMark Cave-Ayland * defer until the next FIFO write. 8275d02add4SMark Cave-Ayland */ 8285a857339SMark Cave-Ayland if (len) { 8295d02add4SMark Cave-Ayland /* Raise interrupt to indicate transfer complete */ 8305d02add4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8315d02add4SMark Cave-Ayland esp_raise_irq(s); 8325d02add4SMark Cave-Ayland } 8335d02add4SMark Cave-Ayland } 8345d02add4SMark Cave-Ayland break; 8355d02add4SMark Cave-Ayland 8368ba32048SMark Cave-Ayland case CMD_SEL | CMD_DMA: 8378ba32048SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 838acdee66dSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 839da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8405a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8415a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 842acdee66dSMark Cave-Ayland 8438ba32048SMark Cave-Ayland /* Handle when DMA transfer is terminated by non-DMA FIFO write */ 8445aa0df40SMark Cave-Ayland if (esp_cdb_ready(s)) { 8458ba32048SMark Cave-Ayland /* Command has been received */ 8468ba32048SMark Cave-Ayland do_cmd(s); 8478ba32048SMark Cave-Ayland } 8488ba32048SMark Cave-Ayland break; 8498ba32048SMark Cave-Ayland 8505d02add4SMark Cave-Ayland case CMD_SEL: 8515d02add4SMark Cave-Ayland case CMD_SELATN: 852acdee66dSMark Cave-Ayland /* FIFO already contain entire CDB: copy to cmdfifo and execute */ 853da838126SMark Cave-Ayland len = esp_fifo_pop_buf(s, buf, fifo8_num_used(&s->fifo)); 8545a857339SMark Cave-Ayland len = MIN(fifo8_num_free(&s->cmdfifo), len); 8555a857339SMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 856acdee66dSMark Cave-Ayland 8575d02add4SMark Cave-Ayland do_cmd(s); 8585d02add4SMark Cave-Ayland break; 8595d02add4SMark Cave-Ayland } 86083e803deSMark Cave-Ayland break; 8611b9e48a5SMark Cave-Ayland 8629d1aa52bSMark Cave-Ayland case STAT_DO: 8635d02add4SMark Cave-Ayland /* Accumulate data in FIFO until non-DMA TI is executed */ 8649d1aa52bSMark Cave-Ayland break; 8659d1aa52bSMark Cave-Ayland 8669d1aa52bSMark Cave-Ayland case STAT_DI: 8679d1aa52bSMark Cave-Ayland if (!s->current_req) { 8689d1aa52bSMark Cave-Ayland return; 8699d1aa52bSMark Cave-Ayland } 8709d1aa52bSMark Cave-Ayland if (s->async_len == 0) { 8719d1aa52bSMark Cave-Ayland /* Defer until data is available. */ 8729d1aa52bSMark Cave-Ayland return; 8739d1aa52bSMark Cave-Ayland } 8746ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 8751f46d1c3SMark Cave-Ayland esp_fifo_push(s, s->async_buf[0]); 8766ef2cabcSMark Cave-Ayland s->async_buf++; 8776ef2cabcSMark Cave-Ayland s->async_len--; 8786ef2cabcSMark Cave-Ayland s->ti_size--; 8796ef2cabcSMark Cave-Ayland } 8801b9e48a5SMark Cave-Ayland 8811b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8821b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 8831b9e48a5SMark Cave-Ayland return; 8841b9e48a5SMark Cave-Ayland } 8851b9e48a5SMark Cave-Ayland 8869655f72cSMark Cave-Ayland /* If preloading the FIFO, defer until TI command issued */ 8879655f72cSMark Cave-Ayland if (s->rregs[ESP_CMD] != CMD_TI) { 8889655f72cSMark Cave-Ayland return; 8899655f72cSMark Cave-Ayland } 8909655f72cSMark Cave-Ayland 8911b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8921b9e48a5SMark Cave-Ayland esp_raise_irq(s); 8939d1aa52bSMark Cave-Ayland break; 89483428f7aSMark Cave-Ayland 89583428f7aSMark Cave-Ayland case STAT_ST: 89683428f7aSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 89783428f7aSMark Cave-Ayland case CMD_ICCS: 8981f46d1c3SMark Cave-Ayland esp_fifo_push(s, s->status); 89983428f7aSMark Cave-Ayland esp_set_phase(s, STAT_MI); 90083428f7aSMark Cave-Ayland 90183428f7aSMark Cave-Ayland /* Process any message in phase data */ 90283428f7aSMark Cave-Ayland esp_do_nodma(s); 90383428f7aSMark Cave-Ayland break; 90483428f7aSMark Cave-Ayland } 90583428f7aSMark Cave-Ayland break; 90683428f7aSMark Cave-Ayland 90783428f7aSMark Cave-Ayland case STAT_MI: 90883428f7aSMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 90983428f7aSMark Cave-Ayland case CMD_ICCS: 9101f46d1c3SMark Cave-Ayland esp_fifo_push(s, 0); 91183428f7aSMark Cave-Ayland 9120ee71db4SMark Cave-Ayland /* Raise end of command interrupt */ 9130ee71db4SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 91483428f7aSMark Cave-Ayland esp_raise_irq(s); 91583428f7aSMark Cave-Ayland break; 91683428f7aSMark Cave-Ayland } 91783428f7aSMark Cave-Ayland break; 9189d1aa52bSMark Cave-Ayland } 9191b9e48a5SMark Cave-Ayland } 9201b9e48a5SMark Cave-Ayland 9214aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 92249ab747fSPaolo Bonzini { 9234aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 9245a83e83eSMark Cave-Ayland int to_device = (esp_get_phase(s) == STAT_DO); 9254aaa6ac3SMark Cave-Ayland 92649ab747fSPaolo Bonzini trace_esp_command_complete(); 9276ef2cabcSMark Cave-Ayland 9286ef2cabcSMark Cave-Ayland /* 9296ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 9306ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 9316ef2cabcSMark Cave-Ayland */ 9326ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 93349ab747fSPaolo Bonzini if (s->ti_size != 0) { 93449ab747fSPaolo Bonzini trace_esp_command_complete_unexpected(); 93549ab747fSPaolo Bonzini } 9366ef2cabcSMark Cave-Ayland } 9376ef2cabcSMark Cave-Ayland 93849ab747fSPaolo Bonzini s->async_len = 0; 9394aaa6ac3SMark Cave-Ayland if (req->status) { 94049ab747fSPaolo Bonzini trace_esp_command_complete_fail(); 94149ab747fSPaolo Bonzini } 9424aaa6ac3SMark Cave-Ayland s->status = req->status; 9436ef2cabcSMark Cave-Ayland 9446ef2cabcSMark Cave-Ayland /* 945cb988199SMark Cave-Ayland * Switch to status phase. For non-DMA transfers from the target the last 946cb988199SMark Cave-Ayland * byte is still in the FIFO 9476ef2cabcSMark Cave-Ayland */ 9488bb22495SMark Cave-Ayland s->ti_size = 0; 9498bb22495SMark Cave-Ayland 9508bb22495SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 9518bb22495SMark Cave-Ayland case CMD_SEL | CMD_DMA: 9528bb22495SMark Cave-Ayland case CMD_SEL: 9538bb22495SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 9548bb22495SMark Cave-Ayland case CMD_SELATN: 955cb988199SMark Cave-Ayland /* 9568bb22495SMark Cave-Ayland * No data phase for sequencer command so raise deferred bus service 957c90b2792SMark Cave-Ayland * and function complete interrupt 958cb988199SMark Cave-Ayland */ 959c90b2792SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 9609b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 9618bb22495SMark Cave-Ayland break; 962cb22ce50SMark Cave-Ayland 963cb22ce50SMark Cave-Ayland case CMD_TI | CMD_DMA: 964cb22ce50SMark Cave-Ayland case CMD_TI: 965cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 966cb22ce50SMark Cave-Ayland break; 9676ef2cabcSMark Cave-Ayland } 9686ef2cabcSMark Cave-Ayland 9698bb22495SMark Cave-Ayland /* Raise bus service interrupt to indicate change to STATUS phase */ 9708bb22495SMark Cave-Ayland esp_set_phase(s, STAT_ST); 9718bb22495SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 9728bb22495SMark Cave-Ayland esp_raise_irq(s); 97302a3ce56SMark Cave-Ayland 97402a3ce56SMark Cave-Ayland /* Ensure DRQ is set correctly for TC underflow or normal completion */ 97502a3ce56SMark Cave-Ayland esp_dma_ti_check(s); 9768bb22495SMark Cave-Ayland 97749ab747fSPaolo Bonzini if (s->current_req) { 97849ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 97949ab747fSPaolo Bonzini s->current_req = NULL; 98049ab747fSPaolo Bonzini s->current_dev = NULL; 98149ab747fSPaolo Bonzini } 98249ab747fSPaolo Bonzini } 98349ab747fSPaolo Bonzini 98449ab747fSPaolo Bonzini void esp_transfer_data(SCSIRequest *req, uint32_t len) 98549ab747fSPaolo Bonzini { 98649ab747fSPaolo Bonzini ESPState *s = req->hba_private; 9876cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 98849ab747fSPaolo Bonzini 9896cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 99049ab747fSPaolo Bonzini s->async_len = len; 99149ab747fSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 9924e78f3bfSMark Cave-Ayland 993c90b2792SMark Cave-Ayland if (!s->data_ready) { 994a4608fa0SMark Cave-Ayland s->data_ready = true; 995a4608fa0SMark Cave-Ayland 996a4608fa0SMark Cave-Ayland switch (s->rregs[ESP_CMD]) { 997a4608fa0SMark Cave-Ayland case CMD_SEL | CMD_DMA: 998a4608fa0SMark Cave-Ayland case CMD_SEL: 999a4608fa0SMark Cave-Ayland case CMD_SELATN | CMD_DMA: 1000a4608fa0SMark Cave-Ayland case CMD_SELATN: 1001c90b2792SMark Cave-Ayland /* 1002c90b2792SMark Cave-Ayland * Initial incoming data xfer is complete for sequencer command 1003c90b2792SMark Cave-Ayland * so raise deferred bus service and function complete interrupt 1004c90b2792SMark Cave-Ayland */ 1005c90b2792SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 10069b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 1007c90b2792SMark Cave-Ayland break; 1008c90b2792SMark Cave-Ayland 1009a4608fa0SMark Cave-Ayland case CMD_SELATNS | CMD_DMA: 1010a4608fa0SMark Cave-Ayland case CMD_SELATNS: 10114e78f3bfSMark Cave-Ayland /* 10124e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 10134e78f3bfSMark Cave-Ayland * completion interrupt 10144e78f3bfSMark Cave-Ayland */ 10154e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 10169b2cdca2SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 1017a4608fa0SMark Cave-Ayland break; 1018a4608fa0SMark Cave-Ayland 1019a4608fa0SMark Cave-Ayland case CMD_TI | CMD_DMA: 1020a4608fa0SMark Cave-Ayland case CMD_TI: 1021a4608fa0SMark Cave-Ayland /* 1022a4608fa0SMark Cave-Ayland * Bus service interrupt raised because of initial change to 1023a4608fa0SMark Cave-Ayland * DATA phase 1024a4608fa0SMark Cave-Ayland */ 1025cb22ce50SMark Cave-Ayland s->rregs[ESP_CMD] = 0; 1026a4608fa0SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 1027a4608fa0SMark Cave-Ayland break; 1028a4608fa0SMark Cave-Ayland } 1029c90b2792SMark Cave-Ayland 1030c90b2792SMark Cave-Ayland esp_raise_irq(s); 10314e78f3bfSMark Cave-Ayland } 10324e78f3bfSMark Cave-Ayland 10331b9e48a5SMark Cave-Ayland /* 10341b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 10351b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 10361b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 10371b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 10381b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 10391b9e48a5SMark Cave-Ayland */ 10401b9e48a5SMark Cave-Ayland 104182003450SMark Cave-Ayland if (s->rregs[ESP_CMD] == (CMD_TI | CMD_DMA)) { 1042a79e767aSMark Cave-Ayland /* When the SCSI layer returns more data, raise deferred INTR_BS */ 1043004826d0SMark Cave-Ayland esp_dma_ti_check(s); 1044a79e767aSMark Cave-Ayland 1045a79e767aSMark Cave-Ayland esp_do_dma(s); 104682003450SMark Cave-Ayland } else if (s->rregs[ESP_CMD] == CMD_TI) { 10471b9e48a5SMark Cave-Ayland esp_do_nodma(s); 10481b9e48a5SMark Cave-Ayland } 104949ab747fSPaolo Bonzini } 105049ab747fSPaolo Bonzini 105149ab747fSPaolo Bonzini static void handle_ti(ESPState *s) 105249ab747fSPaolo Bonzini { 10531b9e48a5SMark Cave-Ayland uint32_t dmalen; 105449ab747fSPaolo Bonzini 105549ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 105649ab747fSPaolo Bonzini s->dma_cb = handle_ti; 105749ab747fSPaolo Bonzini return; 105849ab747fSPaolo Bonzini } 105949ab747fSPaolo Bonzini 106049ab747fSPaolo Bonzini if (s->dma) { 10611b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 1062b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 106349ab747fSPaolo Bonzini esp_do_dma(s); 1064799d90d8SMark Cave-Ayland } else { 10651b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 10661b9e48a5SMark Cave-Ayland esp_do_nodma(s); 10675d02add4SMark Cave-Ayland 10685d02add4SMark Cave-Ayland if (esp_get_phase(s) == STAT_DO) { 10695d02add4SMark Cave-Ayland esp_nodma_ti_dataout(s); 10705d02add4SMark Cave-Ayland } 107149ab747fSPaolo Bonzini } 107249ab747fSPaolo Bonzini } 107349ab747fSPaolo Bonzini 107449ab747fSPaolo Bonzini void esp_hard_reset(ESPState *s) 107549ab747fSPaolo Bonzini { 107649ab747fSPaolo Bonzini memset(s->rregs, 0, ESP_REGS); 107749ab747fSPaolo Bonzini memset(s->wregs, 0, ESP_REGS); 1078c9cf45c1SHannes Reinecke s->tchi_written = 0; 107949ab747fSPaolo Bonzini s->ti_size = 0; 10803f26c975SMark Cave-Ayland s->async_len = 0; 1081042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 1082023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 108349ab747fSPaolo Bonzini s->dma = 0; 108449ab747fSPaolo Bonzini s->dma_cb = NULL; 108549ab747fSPaolo Bonzini 108649ab747fSPaolo Bonzini s->rregs[ESP_CFG1] = 7; 108749ab747fSPaolo Bonzini } 108849ab747fSPaolo Bonzini 108949ab747fSPaolo Bonzini static void esp_soft_reset(ESPState *s) 109049ab747fSPaolo Bonzini { 109149ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 10926dec7c0dSMark Cave-Ayland qemu_irq_lower(s->drq_irq); 109349ab747fSPaolo Bonzini esp_hard_reset(s); 109449ab747fSPaolo Bonzini } 109549ab747fSPaolo Bonzini 1096c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s) 1097c6e51f1bSJohn Millikin { 10984a5fc890SPeter Maydell bus_cold_reset(BUS(&s->bus)); 1099c6e51f1bSJohn Millikin } 1100c6e51f1bSJohn Millikin 110149ab747fSPaolo Bonzini static void parent_esp_reset(ESPState *s, int irq, int level) 110249ab747fSPaolo Bonzini { 110349ab747fSPaolo Bonzini if (level) { 110449ab747fSPaolo Bonzini esp_soft_reset(s); 110549ab747fSPaolo Bonzini } 110649ab747fSPaolo Bonzini } 110749ab747fSPaolo Bonzini 1108f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s) 1109f21fe39dSMark Cave-Ayland { 1110f21fe39dSMark Cave-Ayland uint8_t cmd = s->rregs[ESP_CMD]; 1111f21fe39dSMark Cave-Ayland 1112f21fe39dSMark Cave-Ayland if (cmd & CMD_DMA) { 1113f21fe39dSMark Cave-Ayland s->dma = 1; 1114f21fe39dSMark Cave-Ayland /* Reload DMA counter. */ 1115f21fe39dSMark Cave-Ayland if (esp_get_stc(s) == 0) { 1116f21fe39dSMark Cave-Ayland esp_set_tc(s, 0x10000); 1117f21fe39dSMark Cave-Ayland } else { 1118f21fe39dSMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 1119f21fe39dSMark Cave-Ayland } 1120f21fe39dSMark Cave-Ayland } else { 1121f21fe39dSMark Cave-Ayland s->dma = 0; 1122f21fe39dSMark Cave-Ayland } 1123f21fe39dSMark Cave-Ayland switch (cmd & CMD_CMD) { 1124f21fe39dSMark Cave-Ayland case CMD_NOP: 1125f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_nop(cmd); 1126f21fe39dSMark Cave-Ayland break; 1127f21fe39dSMark Cave-Ayland case CMD_FLUSH: 1128f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_flush(cmd); 1129f21fe39dSMark Cave-Ayland fifo8_reset(&s->fifo); 1130f21fe39dSMark Cave-Ayland break; 1131f21fe39dSMark Cave-Ayland case CMD_RESET: 1132f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_reset(cmd); 1133f21fe39dSMark Cave-Ayland esp_soft_reset(s); 1134f21fe39dSMark Cave-Ayland break; 1135f21fe39dSMark Cave-Ayland case CMD_BUSRESET: 1136f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_bus_reset(cmd); 1137f21fe39dSMark Cave-Ayland esp_bus_reset(s); 1138f21fe39dSMark Cave-Ayland if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1139f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 1140f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1141f21fe39dSMark Cave-Ayland } 1142f21fe39dSMark Cave-Ayland break; 1143f21fe39dSMark Cave-Ayland case CMD_TI: 1144f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(cmd); 1145f21fe39dSMark Cave-Ayland handle_ti(s); 1146f21fe39dSMark Cave-Ayland break; 1147f21fe39dSMark Cave-Ayland case CMD_ICCS: 1148f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_iccs(cmd); 1149f21fe39dSMark Cave-Ayland write_response(s); 1150f21fe39dSMark Cave-Ayland break; 1151f21fe39dSMark Cave-Ayland case CMD_MSGACC: 1152f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_msgacc(cmd); 1153f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 1154f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1155f21fe39dSMark Cave-Ayland s->rregs[ESP_RFLAGS] = 0; 1156f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1157f21fe39dSMark Cave-Ayland break; 1158f21fe39dSMark Cave-Ayland case CMD_PAD: 1159f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_pad(cmd); 1160a6cad7cdSMark Cave-Ayland handle_pad(s); 1161f21fe39dSMark Cave-Ayland break; 1162f21fe39dSMark Cave-Ayland case CMD_SATN: 1163f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_satn(cmd); 1164f21fe39dSMark Cave-Ayland break; 1165f21fe39dSMark Cave-Ayland case CMD_RSTATN: 1166f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_rstatn(cmd); 1167f21fe39dSMark Cave-Ayland break; 1168f21fe39dSMark Cave-Ayland case CMD_SEL: 1169f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_sel(cmd); 1170f21fe39dSMark Cave-Ayland handle_s_without_atn(s); 1171f21fe39dSMark Cave-Ayland break; 1172f21fe39dSMark Cave-Ayland case CMD_SELATN: 1173f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatn(cmd); 1174f21fe39dSMark Cave-Ayland handle_satn(s); 1175f21fe39dSMark Cave-Ayland break; 1176f21fe39dSMark Cave-Ayland case CMD_SELATNS: 1177f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatns(cmd); 1178f21fe39dSMark Cave-Ayland handle_satn_stop(s); 1179f21fe39dSMark Cave-Ayland break; 1180f21fe39dSMark Cave-Ayland case CMD_ENSEL: 1181f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ensel(cmd); 1182f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1183f21fe39dSMark Cave-Ayland break; 1184f21fe39dSMark Cave-Ayland case CMD_DISSEL: 1185f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_dissel(cmd); 1186f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1187f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1188f21fe39dSMark Cave-Ayland break; 1189f21fe39dSMark Cave-Ayland default: 1190f21fe39dSMark Cave-Ayland trace_esp_error_unhandled_command(cmd); 1191f21fe39dSMark Cave-Ayland break; 1192f21fe39dSMark Cave-Ayland } 1193f21fe39dSMark Cave-Ayland } 1194f21fe39dSMark Cave-Ayland 119549ab747fSPaolo Bonzini uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 119649ab747fSPaolo Bonzini { 1197b630c075SMark Cave-Ayland uint32_t val; 119849ab747fSPaolo Bonzini 119949ab747fSPaolo Bonzini switch (saddr) { 120049ab747fSPaolo Bonzini case ESP_FIFO: 120161fa150dSMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(s); 1202b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 120349ab747fSPaolo Bonzini break; 120449ab747fSPaolo Bonzini case ESP_RINTR: 120594d5c79dSMark Cave-Ayland /* 120694d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 120794d5c79dSMark Cave-Ayland * except TC 120894d5c79dSMark Cave-Ayland */ 1209b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 121049ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 1211d294b77aSMark Cave-Ayland esp_lower_irq(s); 1212d68212cdSMark Cave-Ayland s->rregs[ESP_RSTAT] &= STAT_TC | 7; 1213af947a3dSMark Cave-Ayland /* 1214af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 1215af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 1216af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 1217af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 1218af947a3dSMark Cave-Ayland * transition. 1219af947a3dSMark Cave-Ayland * 1220af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 1221af947a3dSMark Cave-Ayland */ 1222b630c075SMark Cave-Ayland break; 1223c9cf45c1SHannes Reinecke case ESP_TCHI: 1224c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 1225c9cf45c1SHannes Reinecke if (!s->tchi_written) { 1226b630c075SMark Cave-Ayland val = s->chip_id; 1227b630c075SMark Cave-Ayland } else { 1228b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1229c9cf45c1SHannes Reinecke } 1230b630c075SMark Cave-Ayland break; 1231238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1232238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1233238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1234238ec4d7SMark Cave-Ayland break; 123549ab747fSPaolo Bonzini default: 1236b630c075SMark Cave-Ayland val = s->rregs[saddr]; 123749ab747fSPaolo Bonzini break; 123849ab747fSPaolo Bonzini } 1239b630c075SMark Cave-Ayland 1240b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1241b630c075SMark Cave-Ayland return val; 124249ab747fSPaolo Bonzini } 124349ab747fSPaolo Bonzini 124449ab747fSPaolo Bonzini void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 124549ab747fSPaolo Bonzini { 124649ab747fSPaolo Bonzini trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 124749ab747fSPaolo Bonzini switch (saddr) { 1248c9cf45c1SHannes Reinecke case ESP_TCHI: 1249c9cf45c1SHannes Reinecke s->tchi_written = true; 1250c9cf45c1SHannes Reinecke /* fall through */ 125149ab747fSPaolo Bonzini case ESP_TCLO: 125249ab747fSPaolo Bonzini case ESP_TCMID: 125349ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 125449ab747fSPaolo Bonzini break; 125549ab747fSPaolo Bonzini case ESP_FIFO: 12562572689bSMark Cave-Ayland if (!fifo8_is_full(&s->fifo)) { 12570e7dbe29SMark Cave-Ayland esp_fifo_push(s, val); 12582572689bSMark Cave-Ayland } 12595d02add4SMark Cave-Ayland esp_do_nodma(s); 126049ab747fSPaolo Bonzini break; 126149ab747fSPaolo Bonzini case ESP_CMD: 126249ab747fSPaolo Bonzini s->rregs[saddr] = val; 1263f21fe39dSMark Cave-Ayland esp_run_cmd(s); 126449ab747fSPaolo Bonzini break; 126549ab747fSPaolo Bonzini case ESP_WBUSID ... ESP_WSYNO: 126649ab747fSPaolo Bonzini break; 126749ab747fSPaolo Bonzini case ESP_CFG1: 126849ab747fSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 126949ab747fSPaolo Bonzini case ESP_RES3: case ESP_RES4: 127049ab747fSPaolo Bonzini s->rregs[saddr] = val; 127149ab747fSPaolo Bonzini break; 127249ab747fSPaolo Bonzini case ESP_WCCF ... ESP_WTEST: 127349ab747fSPaolo Bonzini break; 127449ab747fSPaolo Bonzini default: 127549ab747fSPaolo Bonzini trace_esp_error_invalid_write(val, saddr); 127649ab747fSPaolo Bonzini return; 127749ab747fSPaolo Bonzini } 127849ab747fSPaolo Bonzini s->wregs[saddr] = val; 127949ab747fSPaolo Bonzini } 128049ab747fSPaolo Bonzini 128149ab747fSPaolo Bonzini static bool esp_mem_accepts(void *opaque, hwaddr addr, 12828372d383SPeter Maydell unsigned size, bool is_write, 12838372d383SPeter Maydell MemTxAttrs attrs) 128449ab747fSPaolo Bonzini { 128549ab747fSPaolo Bonzini return (size == 1) || (is_write && size == 4); 128649ab747fSPaolo Bonzini } 128749ab747fSPaolo Bonzini 12886cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 12896cc88d6bSMark Cave-Ayland { 12906cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 12916cc88d6bSMark Cave-Ayland 12926cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12936cc88d6bSMark Cave-Ayland return version_id < 5; 12946cc88d6bSMark Cave-Ayland } 12956cc88d6bSMark Cave-Ayland 12964e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 12974e78f3bfSMark Cave-Ayland { 12984e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 12994e78f3bfSMark Cave-Ayland 13004e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 13010bcd5a18SMark Cave-Ayland return version_id >= 5; 13024e78f3bfSMark Cave-Ayland } 13034e78f3bfSMark Cave-Ayland 13044eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 13054eb86065SPaolo Bonzini { 13064eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 13074eb86065SPaolo Bonzini 13084eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 13094eb86065SPaolo Bonzini return version_id >= 6; 13104eb86065SPaolo Bonzini } 13114eb86065SPaolo Bonzini 131282003450SMark Cave-Ayland static bool esp_is_between_version_5_and_6(void *opaque, int version_id) 131382003450SMark Cave-Ayland { 131482003450SMark Cave-Ayland ESPState *s = ESP(opaque); 131582003450SMark Cave-Ayland 131682003450SMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 131782003450SMark Cave-Ayland return version_id >= 5 && version_id <= 6; 131882003450SMark Cave-Ayland } 131982003450SMark Cave-Ayland 1320ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 13210bd005beSMark Cave-Ayland { 1322ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1323ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 13240bd005beSMark Cave-Ayland 13250bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 13260bd005beSMark Cave-Ayland return 0; 13270bd005beSMark Cave-Ayland } 13280bd005beSMark Cave-Ayland 13290bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 13300bd005beSMark Cave-Ayland { 13310bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1332042879fcSMark Cave-Ayland int len, i; 13330bd005beSMark Cave-Ayland 13346cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 13356cc88d6bSMark Cave-Ayland 13366cc88d6bSMark Cave-Ayland if (version_id < 5) { 13376cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1338042879fcSMark Cave-Ayland 1339042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1340042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1341042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1342042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1343042879fcSMark Cave-Ayland } 1344023666daSMark Cave-Ayland 1345023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1346023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1347023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1348023666daSMark Cave-Ayland } 13496cc88d6bSMark Cave-Ayland } 13506cc88d6bSMark Cave-Ayland 13510bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 13520bd005beSMark Cave-Ayland return 0; 13530bd005beSMark Cave-Ayland } 13540bd005beSMark Cave-Ayland 135549ab747fSPaolo Bonzini const VMStateDescription vmstate_esp = { 135649ab747fSPaolo Bonzini .name = "esp", 135782003450SMark Cave-Ayland .version_id = 7, 135849ab747fSPaolo Bonzini .minimum_version_id = 3, 13590bd005beSMark Cave-Ayland .post_load = esp_post_load, 13602d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 136149ab747fSPaolo Bonzini VMSTATE_BUFFER(rregs, ESPState), 136249ab747fSPaolo Bonzini VMSTATE_BUFFER(wregs, ESPState), 136349ab747fSPaolo Bonzini VMSTATE_INT32(ti_size, ESPState), 1364042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1365042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1366042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 136749ab747fSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 13684aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 13694aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 13704aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 13714aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 137249ab747fSPaolo Bonzini VMSTATE_UINT32(dma, ESPState), 1373023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1374023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1375023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1376023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1377023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1378023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 137949ab747fSPaolo Bonzini VMSTATE_UINT32(do_cmd, ESPState), 13806cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 13818dded6deSMark Cave-Ayland VMSTATE_BOOL_TEST(data_ready, ESPState, esp_is_version_5), 1382023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1383042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1384023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 138582003450SMark Cave-Ayland VMSTATE_UINT8_TEST(mig_ti_cmd, ESPState, 138682003450SMark Cave-Ayland esp_is_between_version_5_and_6), 13874eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 1388442de89aSMark Cave-Ayland VMSTATE_BOOL(drq_state, ESPState), 138949ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 139074d71ea1SLaurent Vivier }, 139149ab747fSPaolo Bonzini }; 139249ab747fSPaolo Bonzini 139349ab747fSPaolo Bonzini static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 139449ab747fSPaolo Bonzini uint64_t val, unsigned int size) 139549ab747fSPaolo Bonzini { 139649ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1397eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 139849ab747fSPaolo Bonzini uint32_t saddr; 139949ab747fSPaolo Bonzini 140049ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1401eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 140249ab747fSPaolo Bonzini } 140349ab747fSPaolo Bonzini 140449ab747fSPaolo Bonzini static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 140549ab747fSPaolo Bonzini unsigned int size) 140649ab747fSPaolo Bonzini { 140749ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1408eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 140949ab747fSPaolo Bonzini uint32_t saddr; 141049ab747fSPaolo Bonzini 141149ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1412eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 141349ab747fSPaolo Bonzini } 141449ab747fSPaolo Bonzini 141549ab747fSPaolo Bonzini static const MemoryRegionOps sysbus_esp_mem_ops = { 141649ab747fSPaolo Bonzini .read = sysbus_esp_mem_read, 141749ab747fSPaolo Bonzini .write = sysbus_esp_mem_write, 141849ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 141949ab747fSPaolo Bonzini .valid.accepts = esp_mem_accepts, 142049ab747fSPaolo Bonzini }; 142149ab747fSPaolo Bonzini 142274d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 142374d71ea1SLaurent Vivier uint64_t val, unsigned int size) 142474d71ea1SLaurent Vivier { 142574d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1426eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 142774d71ea1SLaurent Vivier 1428960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1429960ebfd9SMark Cave-Ayland 143074d71ea1SLaurent Vivier switch (size) { 143174d71ea1SLaurent Vivier case 1: 1432761bef75SMark Cave-Ayland esp_pdma_write(s, val); 143374d71ea1SLaurent Vivier break; 143474d71ea1SLaurent Vivier case 2: 1435761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1436761bef75SMark Cave-Ayland esp_pdma_write(s, val); 143774d71ea1SLaurent Vivier break; 143874d71ea1SLaurent Vivier } 1439b46a43a2SMark Cave-Ayland esp_do_dma(s); 144074d71ea1SLaurent Vivier } 144174d71ea1SLaurent Vivier 144274d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 144374d71ea1SLaurent Vivier unsigned int size) 144474d71ea1SLaurent Vivier { 144574d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1446eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 144774d71ea1SLaurent Vivier uint64_t val = 0; 144874d71ea1SLaurent Vivier 1449960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1450960ebfd9SMark Cave-Ayland 145174d71ea1SLaurent Vivier switch (size) { 145274d71ea1SLaurent Vivier case 1: 1453761bef75SMark Cave-Ayland val = esp_pdma_read(s); 145474d71ea1SLaurent Vivier break; 145574d71ea1SLaurent Vivier case 2: 1456761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1457761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 145874d71ea1SLaurent Vivier break; 145974d71ea1SLaurent Vivier } 1460b46a43a2SMark Cave-Ayland esp_do_dma(s); 146174d71ea1SLaurent Vivier return val; 146274d71ea1SLaurent Vivier } 146374d71ea1SLaurent Vivier 1464a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1465a7a22088SMark Cave-Ayland { 1466a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1467a7a22088SMark Cave-Ayland 1468a7a22088SMark Cave-Ayland scsi_req_ref(req); 1469a7a22088SMark Cave-Ayland s->current_req = req; 1470a7a22088SMark Cave-Ayland return s; 1471a7a22088SMark Cave-Ayland } 1472a7a22088SMark Cave-Ayland 147374d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 147474d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 147574d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 147674d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 147774d71ea1SLaurent Vivier .valid.min_access_size = 1, 1478cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1479cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1480cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 148174d71ea1SLaurent Vivier }; 148274d71ea1SLaurent Vivier 148349ab747fSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 148449ab747fSPaolo Bonzini .tcq = false, 148549ab747fSPaolo Bonzini .max_target = ESP_MAX_DEVS, 148649ab747fSPaolo Bonzini .max_lun = 7, 148749ab747fSPaolo Bonzini 1488a7a22088SMark Cave-Ayland .load_request = esp_load_request, 148949ab747fSPaolo Bonzini .transfer_data = esp_transfer_data, 149049ab747fSPaolo Bonzini .complete = esp_command_complete, 149149ab747fSPaolo Bonzini .cancel = esp_request_cancelled 149249ab747fSPaolo Bonzini }; 149349ab747fSPaolo Bonzini 149449ab747fSPaolo Bonzini static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 149549ab747fSPaolo Bonzini { 149684fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1497eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 149849ab747fSPaolo Bonzini 149949ab747fSPaolo Bonzini switch (irq) { 150049ab747fSPaolo Bonzini case 0: 150149ab747fSPaolo Bonzini parent_esp_reset(s, irq, level); 150249ab747fSPaolo Bonzini break; 150349ab747fSPaolo Bonzini case 1: 1504b86dc5cbSMark Cave-Ayland esp_dma_enable(s, irq, level); 150549ab747fSPaolo Bonzini break; 150649ab747fSPaolo Bonzini } 150749ab747fSPaolo Bonzini } 150849ab747fSPaolo Bonzini 1509b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 151049ab747fSPaolo Bonzini { 1511b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 151284fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1513eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1514eb169c76SMark Cave-Ayland 1515eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1516eb169c76SMark Cave-Ayland return; 1517eb169c76SMark Cave-Ayland } 151849ab747fSPaolo Bonzini 1519b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 15206dec7c0dSMark Cave-Ayland sysbus_init_irq(sbd, &s->drq_irq); 152149ab747fSPaolo Bonzini assert(sysbus->it_shift != -1); 152249ab747fSPaolo Bonzini 152349ab747fSPaolo Bonzini s->chip_id = TCHI_FAS100A; 152429776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 152574d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1526b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 152774d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1528cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 152974d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 153049ab747fSPaolo Bonzini 1531b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 153249ab747fSPaolo Bonzini 1533739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 153449ab747fSPaolo Bonzini } 153549ab747fSPaolo Bonzini 153649ab747fSPaolo Bonzini static void sysbus_esp_hard_reset(DeviceState *dev) 153749ab747fSPaolo Bonzini { 153884fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1539eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1540eb169c76SMark Cave-Ayland 1541eb169c76SMark Cave-Ayland esp_hard_reset(s); 1542eb169c76SMark Cave-Ayland } 1543eb169c76SMark Cave-Ayland 1544eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1545eb169c76SMark Cave-Ayland { 1546eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1547eb169c76SMark Cave-Ayland 1548eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 154949ab747fSPaolo Bonzini } 155049ab747fSPaolo Bonzini 155149ab747fSPaolo Bonzini static const VMStateDescription vmstate_sysbus_esp_scsi = { 155249ab747fSPaolo Bonzini .name = "sysbusespscsi", 15530bd005beSMark Cave-Ayland .version_id = 2, 1554ea84a442SGuenter Roeck .minimum_version_id = 1, 1555ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 15562d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 15570bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 155849ab747fSPaolo Bonzini VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 155949ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 156049ab747fSPaolo Bonzini } 156149ab747fSPaolo Bonzini }; 156249ab747fSPaolo Bonzini 156349ab747fSPaolo Bonzini static void sysbus_esp_class_init(ObjectClass *klass, void *data) 156449ab747fSPaolo Bonzini { 156549ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 156649ab747fSPaolo Bonzini 1567b09318caSHu Tao dc->realize = sysbus_esp_realize; 156849ab747fSPaolo Bonzini dc->reset = sysbus_esp_hard_reset; 156949ab747fSPaolo Bonzini dc->vmsd = &vmstate_sysbus_esp_scsi; 1570125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 157149ab747fSPaolo Bonzini } 157249ab747fSPaolo Bonzini 1573042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1574042879fcSMark Cave-Ayland { 1575042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1576042879fcSMark Cave-Ayland 1577042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1578023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1579042879fcSMark Cave-Ayland } 1580042879fcSMark Cave-Ayland 1581042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1582042879fcSMark Cave-Ayland { 1583042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1584042879fcSMark Cave-Ayland 1585042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1586023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1587042879fcSMark Cave-Ayland } 1588042879fcSMark Cave-Ayland 1589eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1590eb169c76SMark Cave-Ayland { 1591eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1592eb169c76SMark Cave-Ayland 1593eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1594eb169c76SMark Cave-Ayland dc->user_creatable = false; 1595eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1596eb169c76SMark Cave-Ayland } 1597eb169c76SMark Cave-Ayland 1598499f4089SMark Cave-Ayland static const TypeInfo esp_info_types[] = { 1599499f4089SMark Cave-Ayland { 1600499f4089SMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 1601499f4089SMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE, 1602499f4089SMark Cave-Ayland .instance_init = sysbus_esp_init, 1603499f4089SMark Cave-Ayland .instance_size = sizeof(SysBusESPState), 1604499f4089SMark Cave-Ayland .class_init = sysbus_esp_class_init, 1605499f4089SMark Cave-Ayland }, 1606499f4089SMark Cave-Ayland { 1607eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1608eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1609042879fcSMark Cave-Ayland .instance_init = esp_init, 1610042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1611eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1612eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1613499f4089SMark Cave-Ayland }, 1614eb169c76SMark Cave-Ayland }; 1615eb169c76SMark Cave-Ayland 1616499f4089SMark Cave-Ayland DEFINE_TYPES(esp_info_types) 1617