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 649ab747fSPaolo Bonzini * 749ab747fSPaolo Bonzini * Permission is hereby granted, free of charge, to any person obtaining a copy 849ab747fSPaolo Bonzini * of this software and associated documentation files (the "Software"), to deal 949ab747fSPaolo Bonzini * in the Software without restriction, including without limitation the rights 1049ab747fSPaolo Bonzini * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 1149ab747fSPaolo Bonzini * copies of the Software, and to permit persons to whom the Software is 1249ab747fSPaolo Bonzini * furnished to do so, subject to the following conditions: 1349ab747fSPaolo Bonzini * 1449ab747fSPaolo Bonzini * The above copyright notice and this permission notice shall be included in 1549ab747fSPaolo Bonzini * all copies or substantial portions of the Software. 1649ab747fSPaolo Bonzini * 1749ab747fSPaolo Bonzini * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 1849ab747fSPaolo Bonzini * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 1949ab747fSPaolo Bonzini * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 2049ab747fSPaolo Bonzini * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 2149ab747fSPaolo Bonzini * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 2249ab747fSPaolo Bonzini * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 2349ab747fSPaolo Bonzini * THE SOFTWARE. 2449ab747fSPaolo Bonzini */ 2549ab747fSPaolo Bonzini 26a4ab4792SPeter Maydell #include "qemu/osdep.h" 2749ab747fSPaolo Bonzini #include "hw/sysbus.h" 28d6454270SMarkus Armbruster #include "migration/vmstate.h" 2964552b6bSMarkus Armbruster #include "hw/irq.h" 3049ab747fSPaolo Bonzini #include "hw/scsi/esp.h" 3149ab747fSPaolo Bonzini #include "trace.h" 3249ab747fSPaolo Bonzini #include "qemu/log.h" 330b8fa32fSMarkus Armbruster #include "qemu/module.h" 3449ab747fSPaolo Bonzini 3549ab747fSPaolo Bonzini /* 3649ab747fSPaolo Bonzini * On Sparc32, this is the ESP (NCR53C90) part of chip STP2000 (Master I/O), 3749ab747fSPaolo Bonzini * also produced as NCR89C100. See 3849ab747fSPaolo Bonzini * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt 3949ab747fSPaolo Bonzini * and 4049ab747fSPaolo Bonzini * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR53C9X.txt 4174d71ea1SLaurent Vivier * 4274d71ea1SLaurent Vivier * On Macintosh Quadra it is a NCR53C96. 4349ab747fSPaolo Bonzini */ 4449ab747fSPaolo Bonzini 4549ab747fSPaolo Bonzini static void esp_raise_irq(ESPState *s) 4649ab747fSPaolo Bonzini { 4749ab747fSPaolo Bonzini if (!(s->rregs[ESP_RSTAT] & STAT_INT)) { 4849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_INT; 4949ab747fSPaolo Bonzini qemu_irq_raise(s->irq); 5049ab747fSPaolo Bonzini trace_esp_raise_irq(); 5149ab747fSPaolo Bonzini } 5249ab747fSPaolo Bonzini } 5349ab747fSPaolo Bonzini 5449ab747fSPaolo Bonzini static void esp_lower_irq(ESPState *s) 5549ab747fSPaolo Bonzini { 5649ab747fSPaolo Bonzini if (s->rregs[ESP_RSTAT] & STAT_INT) { 5749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_INT; 5849ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 5949ab747fSPaolo Bonzini trace_esp_lower_irq(); 6049ab747fSPaolo Bonzini } 6149ab747fSPaolo Bonzini } 6249ab747fSPaolo Bonzini 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 7549ab747fSPaolo Bonzini void esp_dma_enable(ESPState *s, int irq, int level) 7649ab747fSPaolo Bonzini { 7749ab747fSPaolo Bonzini if (level) { 7849ab747fSPaolo Bonzini s->dma_enabled = 1; 7949ab747fSPaolo Bonzini trace_esp_dma_enable(); 8049ab747fSPaolo Bonzini if (s->dma_cb) { 8149ab747fSPaolo Bonzini s->dma_cb(s); 8249ab747fSPaolo Bonzini s->dma_cb = NULL; 8349ab747fSPaolo Bonzini } 8449ab747fSPaolo Bonzini } else { 8549ab747fSPaolo Bonzini trace_esp_dma_disable(); 8649ab747fSPaolo Bonzini s->dma_enabled = 0; 8749ab747fSPaolo Bonzini } 8849ab747fSPaolo Bonzini } 8949ab747fSPaolo Bonzini 9049ab747fSPaolo Bonzini void esp_request_cancelled(SCSIRequest *req) 9149ab747fSPaolo Bonzini { 9249ab747fSPaolo Bonzini ESPState *s = req->hba_private; 9349ab747fSPaolo Bonzini 9449ab747fSPaolo Bonzini if (req == s->current_req) { 9549ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 9649ab747fSPaolo Bonzini s->current_req = NULL; 9749ab747fSPaolo Bonzini s->current_dev = NULL; 98324c8809SMark Cave-Ayland s->async_len = 0; 9949ab747fSPaolo Bonzini } 10049ab747fSPaolo Bonzini } 10149ab747fSPaolo 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; 1247b320a8eSMark Cave-Ayland uint32_t n; 1257b320a8eSMark Cave-Ayland 1267b320a8eSMark Cave-Ayland if (maxlen == 0) { 1277b320a8eSMark Cave-Ayland return 0; 1287b320a8eSMark Cave-Ayland } 1297b320a8eSMark Cave-Ayland 1307b320a8eSMark Cave-Ayland buf = fifo8_pop_buf(fifo, maxlen, &n); 1317b320a8eSMark Cave-Ayland if (dest) { 1327b320a8eSMark Cave-Ayland memcpy(dest, buf, n); 1337b320a8eSMark Cave-Ayland } 1347b320a8eSMark Cave-Ayland 1357b320a8eSMark Cave-Ayland return n; 1367b320a8eSMark Cave-Ayland } 1377b320a8eSMark Cave-Ayland 138c47b5835SMark Cave-Ayland static uint32_t esp_get_tc(ESPState *s) 139c47b5835SMark Cave-Ayland { 140c47b5835SMark Cave-Ayland uint32_t dmalen; 141c47b5835SMark Cave-Ayland 142c47b5835SMark Cave-Ayland dmalen = s->rregs[ESP_TCLO]; 143c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCMID] << 8; 144c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCHI] << 16; 145c47b5835SMark Cave-Ayland 146c47b5835SMark Cave-Ayland return dmalen; 147c47b5835SMark Cave-Ayland } 148c47b5835SMark Cave-Ayland 149c47b5835SMark Cave-Ayland static void esp_set_tc(ESPState *s, uint32_t dmalen) 150c47b5835SMark Cave-Ayland { 151c47b5835SMark Cave-Ayland s->rregs[ESP_TCLO] = dmalen; 152c47b5835SMark Cave-Ayland s->rregs[ESP_TCMID] = dmalen >> 8; 153c47b5835SMark Cave-Ayland s->rregs[ESP_TCHI] = dmalen >> 16; 154c47b5835SMark Cave-Ayland } 155c47b5835SMark Cave-Ayland 156c04ed569SMark Cave-Ayland static uint32_t esp_get_stc(ESPState *s) 157c04ed569SMark Cave-Ayland { 158c04ed569SMark Cave-Ayland uint32_t dmalen; 159c04ed569SMark Cave-Ayland 160c04ed569SMark Cave-Ayland dmalen = s->wregs[ESP_TCLO]; 161c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCMID] << 8; 162c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCHI] << 16; 163c04ed569SMark Cave-Ayland 164c04ed569SMark Cave-Ayland return dmalen; 165c04ed569SMark Cave-Ayland } 166c04ed569SMark Cave-Ayland 167761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 168761bef75SMark Cave-Ayland { 1698da90e81SMark Cave-Ayland uint8_t val; 1708da90e81SMark Cave-Ayland 17102abe246SMark Cave-Ayland if (s->do_cmd) { 172c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->cmdfifo); 17302abe246SMark Cave-Ayland } else { 174c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->fifo); 17502abe246SMark Cave-Ayland } 1768da90e81SMark Cave-Ayland 1778da90e81SMark Cave-Ayland return val; 178761bef75SMark Cave-Ayland } 179761bef75SMark Cave-Ayland 180761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 181761bef75SMark Cave-Ayland { 1828da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 1838da90e81SMark Cave-Ayland 1843c421400SMark Cave-Ayland if (dmalen == 0) { 1858da90e81SMark Cave-Ayland return; 1868da90e81SMark Cave-Ayland } 1878da90e81SMark Cave-Ayland 18802abe246SMark Cave-Ayland if (s->do_cmd) { 189e5455b8cSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, val); 19002abe246SMark Cave-Ayland } else { 191e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 19202abe246SMark Cave-Ayland } 1938da90e81SMark Cave-Ayland 1948da90e81SMark Cave-Ayland dmalen--; 1958da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 196761bef75SMark Cave-Ayland } 197761bef75SMark Cave-Ayland 19877987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb) 1991e794c51SMark Cave-Ayland { 2001e794c51SMark Cave-Ayland s->pdma_cb = cb; 2011e794c51SMark Cave-Ayland } 2021e794c51SMark Cave-Ayland 203c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2046130b188SLaurent Vivier { 2056130b188SLaurent Vivier int target; 2066130b188SLaurent Vivier 2076130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2086130b188SLaurent Vivier 2096130b188SLaurent Vivier s->ti_size = 0; 210042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 2116130b188SLaurent Vivier 2126130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 2136130b188SLaurent Vivier if (!s->current_dev) { 2146130b188SLaurent Vivier /* No such drive */ 2156130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 216cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 2176130b188SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_0; 2186130b188SLaurent Vivier esp_raise_irq(s); 2196130b188SLaurent Vivier return -1; 2206130b188SLaurent Vivier } 2214e78f3bfSMark Cave-Ayland 2224e78f3bfSMark Cave-Ayland /* 2234e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 2244eb86065SPaolo Bonzini * either in do_command_phase() for DATA OUT transfers or by the deferred 2254e78f3bfSMark Cave-Ayland * IRQ mechanism in esp_transfer_data() for DATA IN transfers 2264e78f3bfSMark Cave-Ayland */ 2274e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 2284e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 2296130b188SLaurent Vivier return 0; 2306130b188SLaurent Vivier } 2316130b188SLaurent Vivier 23220c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen) 23349ab747fSPaolo Bonzini { 234023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 235042879fcSMark Cave-Ayland uint32_t dmalen, n; 23649ab747fSPaolo Bonzini int target; 23749ab747fSPaolo Bonzini 238de7e2cb1SMark Cave-Ayland if (s->current_req) { 239de7e2cb1SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 240de7e2cb1SMark Cave-Ayland scsi_req_cancel(s->current_req); 241de7e2cb1SMark Cave-Ayland } 242de7e2cb1SMark Cave-Ayland 24349ab747fSPaolo Bonzini target = s->wregs[ESP_WBUSID] & BUSID_DID; 24449ab747fSPaolo Bonzini if (s->dma) { 24520c8d2edSMark Cave-Ayland dmalen = MIN(esp_get_tc(s), maxlen); 24620c8d2edSMark Cave-Ayland if (dmalen == 0) { 2476c1fef6bSPrasad J Pandit return 0; 2486c1fef6bSPrasad J Pandit } 24974d71ea1SLaurent Vivier if (s->dma_memory_read) { 25049ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, buf, dmalen); 251fbc6510eSMark Cave-Ayland dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen); 252023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, dmalen); 25349ab747fSPaolo Bonzini } else { 25449691315SMark Cave-Ayland if (esp_select(s) < 0) { 255023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 25649691315SMark Cave-Ayland return -1; 25749691315SMark Cave-Ayland } 25874d71ea1SLaurent Vivier esp_raise_drq(s); 259023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 26074d71ea1SLaurent Vivier return 0; 26174d71ea1SLaurent Vivier } 26274d71ea1SLaurent Vivier } else { 263023666daSMark Cave-Ayland dmalen = MIN(fifo8_num_used(&s->fifo), maxlen); 26420c8d2edSMark Cave-Ayland if (dmalen == 0) { 265d3cdc491SPrasad J Pandit return 0; 266d3cdc491SPrasad J Pandit } 2677b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, dmalen); 268fbc6510eSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 2697b320a8eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 27020c8d2edSMark Cave-Ayland } 27149ab747fSPaolo Bonzini trace_esp_get_cmd(dmalen, target); 27249ab747fSPaolo Bonzini 273c7bce09cSMark Cave-Ayland if (esp_select(s) < 0) { 274023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 27549691315SMark Cave-Ayland return -1; 27649ab747fSPaolo Bonzini } 27749ab747fSPaolo Bonzini return dmalen; 27849ab747fSPaolo Bonzini } 27949ab747fSPaolo Bonzini 2804eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 28149ab747fSPaolo Bonzini { 2827b320a8eSMark Cave-Ayland uint32_t cmdlen; 28349ab747fSPaolo Bonzini int32_t datalen; 28449ab747fSPaolo Bonzini SCSIDevice *current_lun; 2857b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 28649ab747fSPaolo Bonzini 2874eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 288023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 28999545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 29099545751SMark Cave-Ayland return; 29199545751SMark Cave-Ayland } 2927b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen); 293023666daSMark Cave-Ayland 2944eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 2954eb86065SPaolo Bonzini s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, s); 29649ab747fSPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 29749ab747fSPaolo Bonzini s->ti_size = datalen; 298023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 29949ab747fSPaolo Bonzini if (datalen != 0) { 30049ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC; 3014e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 3021b9e48a5SMark Cave-Ayland s->ti_cmd = 0; 3036cc88d6bSMark Cave-Ayland esp_set_tc(s, 0); 30449ab747fSPaolo Bonzini if (datalen > 0) { 3054e78f3bfSMark Cave-Ayland /* 3064e78f3bfSMark Cave-Ayland * Switch to DATA IN phase but wait until initial data xfer is 3074e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3084e78f3bfSMark Cave-Ayland */ 3094e78f3bfSMark Cave-Ayland s->data_in_ready = false; 31049ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_DI; 31149ab747fSPaolo Bonzini } else { 31249ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_DO; 313cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 31449ab747fSPaolo Bonzini esp_raise_irq(s); 31582141c8bSMark Cave-Ayland esp_lower_drq(s); 31649ab747fSPaolo Bonzini } 3174e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3184e78f3bfSMark Cave-Ayland return; 3194e78f3bfSMark Cave-Ayland } 3204e78f3bfSMark Cave-Ayland } 32149ab747fSPaolo Bonzini 3224eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 32349ab747fSPaolo Bonzini { 3244eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3254eb86065SPaolo Bonzini uint8_t message = esp_fifo_pop(&s->cmdfifo); 326023666daSMark Cave-Ayland 3274eb86065SPaolo Bonzini trace_esp_do_identify(message); 3284eb86065SPaolo Bonzini s->lun = message & 7; 329023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3304eb86065SPaolo Bonzini } 33149ab747fSPaolo Bonzini 332799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 333023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3344eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 335fa7505c1SMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, NULL, len); 336023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 337023666daSMark Cave-Ayland } 3384eb86065SPaolo Bonzini } 339023666daSMark Cave-Ayland 3404eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3414eb86065SPaolo Bonzini { 3424eb86065SPaolo Bonzini do_message_phase(s); 3434eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3444eb86065SPaolo Bonzini do_command_phase(s); 34549ab747fSPaolo Bonzini } 34649ab747fSPaolo Bonzini 34774d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s) 34874d71ea1SLaurent Vivier { 349e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 350023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 351e62a959aSMark Cave-Ayland s->do_cmd = 0; 352c959f218SMark Cave-Ayland do_cmd(s); 35374d71ea1SLaurent Vivier } 35474d71ea1SLaurent Vivier } 35574d71ea1SLaurent Vivier 35649ab747fSPaolo Bonzini static void handle_satn(ESPState *s) 35749ab747fSPaolo Bonzini { 35849691315SMark Cave-Ayland int32_t cmdlen; 35949691315SMark Cave-Ayland 36049ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 36149ab747fSPaolo Bonzini s->dma_cb = handle_satn; 36249ab747fSPaolo Bonzini return; 36349ab747fSPaolo Bonzini } 36477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_PDMA_CB); 365023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 36649691315SMark Cave-Ayland if (cmdlen > 0) { 367023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 36860720694SMark Cave-Ayland s->do_cmd = 0; 369c959f218SMark Cave-Ayland do_cmd(s); 37049691315SMark Cave-Ayland } else if (cmdlen == 0) { 371bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 37249691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 37349691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 37449691315SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_CD; 37549ab747fSPaolo Bonzini } 37694d5c79dSMark Cave-Ayland } 37749ab747fSPaolo Bonzini 37874d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s) 37974d71ea1SLaurent Vivier { 380e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 381023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 382e62a959aSMark Cave-Ayland s->do_cmd = 0; 3834eb86065SPaolo Bonzini do_cmd(s); 38474d71ea1SLaurent Vivier } 38574d71ea1SLaurent Vivier } 38674d71ea1SLaurent Vivier 38749ab747fSPaolo Bonzini static void handle_s_without_atn(ESPState *s) 38849ab747fSPaolo Bonzini { 38949691315SMark Cave-Ayland int32_t cmdlen; 39049691315SMark Cave-Ayland 39149ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 39249ab747fSPaolo Bonzini s->dma_cb = handle_s_without_atn; 39349ab747fSPaolo Bonzini return; 39449ab747fSPaolo Bonzini } 39577987ef5SMark Cave-Ayland esp_set_pdma_cb(s, S_WITHOUT_SATN_PDMA_CB); 396023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 39749691315SMark Cave-Ayland if (cmdlen > 0) { 398023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 39960720694SMark Cave-Ayland s->do_cmd = 0; 4004eb86065SPaolo Bonzini do_cmd(s); 40149691315SMark Cave-Ayland } else if (cmdlen == 0) { 402bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 40349691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 40449691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 40549691315SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_CD; 40649ab747fSPaolo Bonzini } 40749ab747fSPaolo Bonzini } 40849ab747fSPaolo Bonzini 40974d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s) 41074d71ea1SLaurent Vivier { 411e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 412023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 41374d71ea1SLaurent Vivier s->do_cmd = 1; 414023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 41574d71ea1SLaurent Vivier s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 416cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 41774d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 41874d71ea1SLaurent Vivier esp_raise_irq(s); 41974d71ea1SLaurent Vivier } 42074d71ea1SLaurent Vivier } 42174d71ea1SLaurent Vivier 42249ab747fSPaolo Bonzini static void handle_satn_stop(ESPState *s) 42349ab747fSPaolo Bonzini { 42449691315SMark Cave-Ayland int32_t cmdlen; 42549691315SMark Cave-Ayland 42649ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 42749ab747fSPaolo Bonzini s->dma_cb = handle_satn_stop; 42849ab747fSPaolo Bonzini return; 42949ab747fSPaolo Bonzini } 43077987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_STOP_PDMA_CB); 431799d90d8SMark Cave-Ayland cmdlen = get_cmd(s, 1); 43249691315SMark Cave-Ayland if (cmdlen > 0) { 433023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 43449ab747fSPaolo Bonzini s->do_cmd = 1; 435023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 436799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_MO; 437cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 438799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 43949ab747fSPaolo Bonzini esp_raise_irq(s); 44049691315SMark Cave-Ayland } else if (cmdlen == 0) { 441bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 442799d90d8SMark Cave-Ayland /* Target present, switch to message out phase */ 443799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 444799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_MO; 44549ab747fSPaolo Bonzini } 44649ab747fSPaolo Bonzini } 44749ab747fSPaolo Bonzini 44874d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s) 44974d71ea1SLaurent Vivier { 45074d71ea1SLaurent Vivier s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 451cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 45274d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 45374d71ea1SLaurent Vivier esp_raise_irq(s); 45474d71ea1SLaurent Vivier } 45574d71ea1SLaurent Vivier 45649ab747fSPaolo Bonzini static void write_response(ESPState *s) 45749ab747fSPaolo Bonzini { 458e3922557SMark Cave-Ayland uint8_t buf[2]; 459042879fcSMark Cave-Ayland 46049ab747fSPaolo Bonzini trace_esp_write_response(s->status); 461042879fcSMark Cave-Ayland 462e3922557SMark Cave-Ayland buf[0] = s->status; 463e3922557SMark Cave-Ayland buf[1] = 0; 464042879fcSMark Cave-Ayland 46549ab747fSPaolo Bonzini if (s->dma) { 46674d71ea1SLaurent Vivier if (s->dma_memory_write) { 467e3922557SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, 2); 46849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 469cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 47049ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = SEQ_CD; 47149ab747fSPaolo Bonzini } else { 47277987ef5SMark Cave-Ayland esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB); 47374d71ea1SLaurent Vivier esp_raise_drq(s); 47474d71ea1SLaurent Vivier return; 47574d71ea1SLaurent Vivier } 47674d71ea1SLaurent Vivier } else { 477e3922557SMark Cave-Ayland fifo8_reset(&s->fifo); 478e3922557SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, 2); 47949ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 2; 48049ab747fSPaolo Bonzini } 48149ab747fSPaolo Bonzini esp_raise_irq(s); 48249ab747fSPaolo Bonzini } 48349ab747fSPaolo Bonzini 48449ab747fSPaolo Bonzini static void esp_dma_done(ESPState *s) 48549ab747fSPaolo Bonzini { 48649ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_TC; 487cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 48849ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 0; 489c47b5835SMark Cave-Ayland esp_set_tc(s, 0); 49049ab747fSPaolo Bonzini esp_raise_irq(s); 49149ab747fSPaolo Bonzini } 49249ab747fSPaolo Bonzini 49374d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s) 49474d71ea1SLaurent Vivier { 4954ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 49682141c8bSMark Cave-Ayland int len; 497042879fcSMark Cave-Ayland uint32_t n; 4986cc88d6bSMark Cave-Ayland 49974d71ea1SLaurent Vivier if (s->do_cmd) { 500e62a959aSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 501e62a959aSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 502e62a959aSMark Cave-Ayland return; 503e62a959aSMark Cave-Ayland } 504e62a959aSMark Cave-Ayland 50574d71ea1SLaurent Vivier s->ti_size = 0; 506c348458fSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 507c348458fSMark Cave-Ayland /* No command received */ 508c348458fSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 509c348458fSMark Cave-Ayland return; 510c348458fSMark Cave-Ayland } 511c348458fSMark Cave-Ayland 512c348458fSMark Cave-Ayland /* Command has been received */ 51374d71ea1SLaurent Vivier s->do_cmd = 0; 514c959f218SMark Cave-Ayland do_cmd(s); 515c348458fSMark Cave-Ayland } else { 516c348458fSMark Cave-Ayland /* 517c348458fSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 518c348458fSMark Cave-Ayland * and then switch to commmand phase 519c348458fSMark Cave-Ayland */ 520c348458fSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 521c348458fSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 522c348458fSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 523c348458fSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 524c348458fSMark Cave-Ayland esp_raise_irq(s); 525c348458fSMark Cave-Ayland } 52674d71ea1SLaurent Vivier return; 52774d71ea1SLaurent Vivier } 52882141c8bSMark Cave-Ayland 5290db89536SMark Cave-Ayland if (!s->current_req) { 5300db89536SMark Cave-Ayland return; 5310db89536SMark Cave-Ayland } 5320db89536SMark Cave-Ayland 53382141c8bSMark Cave-Ayland if (to_device) { 53482141c8bSMark Cave-Ayland /* Copy FIFO data to device */ 5357aa6baeeSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 5367aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 5377b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5387aa6baeeSMark Cave-Ayland s->async_buf += n; 5397aa6baeeSMark Cave-Ayland s->async_len -= n; 5407aa6baeeSMark Cave-Ayland s->ti_size += n; 5417aa6baeeSMark Cave-Ayland 5427aa6baeeSMark Cave-Ayland if (n < len) { 5437aa6baeeSMark Cave-Ayland /* Unaligned accesses can cause FIFO wraparound */ 5447aa6baeeSMark Cave-Ayland len = len - n; 5457b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5467aa6baeeSMark Cave-Ayland s->async_buf += n; 5477aa6baeeSMark Cave-Ayland s->async_len -= n; 5487aa6baeeSMark Cave-Ayland s->ti_size += n; 5497aa6baeeSMark Cave-Ayland } 5507aa6baeeSMark Cave-Ayland 55174d71ea1SLaurent Vivier if (s->async_len == 0) { 55274d71ea1SLaurent Vivier scsi_req_continue(s->current_req); 55382141c8bSMark Cave-Ayland return; 55482141c8bSMark Cave-Ayland } 55582141c8bSMark Cave-Ayland 55682141c8bSMark Cave-Ayland if (esp_get_tc(s) == 0) { 55782141c8bSMark Cave-Ayland esp_lower_drq(s); 55882141c8bSMark Cave-Ayland esp_dma_done(s); 55982141c8bSMark Cave-Ayland } 56082141c8bSMark Cave-Ayland 56182141c8bSMark Cave-Ayland return; 56282141c8bSMark Cave-Ayland } else { 56382141c8bSMark Cave-Ayland if (s->async_len == 0) { 5644e78f3bfSMark Cave-Ayland /* Defer until the scsi layer has completed */ 56582141c8bSMark Cave-Ayland scsi_req_continue(s->current_req); 5664e78f3bfSMark Cave-Ayland s->data_in_ready = false; 56774d71ea1SLaurent Vivier return; 56874d71ea1SLaurent Vivier } 56974d71ea1SLaurent Vivier 57082141c8bSMark Cave-Ayland if (esp_get_tc(s) != 0) { 57182141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 5727aa6baeeSMark Cave-Ayland len = MIN(s->async_len, esp_get_tc(s)); 5737aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 574042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 57582141c8bSMark Cave-Ayland s->async_buf += len; 57682141c8bSMark Cave-Ayland s->async_len -= len; 57782141c8bSMark Cave-Ayland s->ti_size -= len; 57882141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 5797aa6baeeSMark Cave-Ayland 5807aa6baeeSMark Cave-Ayland if (esp_get_tc(s) == 0) { 5817aa6baeeSMark Cave-Ayland /* Indicate transfer to FIFO is complete */ 5827aa6baeeSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 5837aa6baeeSMark Cave-Ayland } 58482141c8bSMark Cave-Ayland return; 58582141c8bSMark Cave-Ayland } 58682141c8bSMark Cave-Ayland 58774d71ea1SLaurent Vivier /* Partially filled a scsi buffer. Complete immediately. */ 58882141c8bSMark Cave-Ayland esp_lower_drq(s); 58974d71ea1SLaurent Vivier esp_dma_done(s); 59074d71ea1SLaurent Vivier } 59182141c8bSMark Cave-Ayland } 59274d71ea1SLaurent Vivier 59349ab747fSPaolo Bonzini static void esp_do_dma(ESPState *s) 59449ab747fSPaolo Bonzini { 595023666daSMark Cave-Ayland uint32_t len, cmdlen; 5964ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 597023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 59849ab747fSPaolo Bonzini 5996cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 60049ab747fSPaolo Bonzini if (s->do_cmd) { 60115407433SLaurent Vivier /* 60215407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 60315407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 60415407433SLaurent Vivier */ 605023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 606023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 60774d71ea1SLaurent Vivier if (s->dma_memory_read) { 6080ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 609023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 610023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 61174d71ea1SLaurent Vivier } else { 61277987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 61374d71ea1SLaurent Vivier esp_raise_drq(s); 61474d71ea1SLaurent Vivier return; 61574d71ea1SLaurent Vivier } 616023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 61715407433SLaurent Vivier s->ti_size = 0; 618799d90d8SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 619799d90d8SMark Cave-Ayland /* No command received */ 620023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 621799d90d8SMark Cave-Ayland return; 622799d90d8SMark Cave-Ayland } 623799d90d8SMark Cave-Ayland 624799d90d8SMark Cave-Ayland /* Command has been received */ 62515407433SLaurent Vivier s->do_cmd = 0; 626c959f218SMark Cave-Ayland do_cmd(s); 627799d90d8SMark Cave-Ayland } else { 628799d90d8SMark Cave-Ayland /* 629023666daSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 630799d90d8SMark Cave-Ayland * and then switch to commmand phase 631799d90d8SMark Cave-Ayland */ 632023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 633799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 634799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 635799d90d8SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 636799d90d8SMark Cave-Ayland esp_raise_irq(s); 637799d90d8SMark Cave-Ayland } 63849ab747fSPaolo Bonzini return; 63949ab747fSPaolo Bonzini } 6400db89536SMark Cave-Ayland if (!s->current_req) { 6410db89536SMark Cave-Ayland return; 6420db89536SMark Cave-Ayland } 64349ab747fSPaolo Bonzini if (s->async_len == 0) { 64449ab747fSPaolo Bonzini /* Defer until data is available. */ 64549ab747fSPaolo Bonzini return; 64649ab747fSPaolo Bonzini } 64749ab747fSPaolo Bonzini if (len > s->async_len) { 64849ab747fSPaolo Bonzini len = s->async_len; 64949ab747fSPaolo Bonzini } 65049ab747fSPaolo Bonzini if (to_device) { 65174d71ea1SLaurent Vivier if (s->dma_memory_read) { 65249ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, s->async_buf, len); 65349ab747fSPaolo Bonzini } else { 65477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 65574d71ea1SLaurent Vivier esp_raise_drq(s); 65674d71ea1SLaurent Vivier return; 65774d71ea1SLaurent Vivier } 65874d71ea1SLaurent Vivier } else { 65974d71ea1SLaurent Vivier if (s->dma_memory_write) { 66049ab747fSPaolo Bonzini s->dma_memory_write(s->dma_opaque, s->async_buf, len); 66174d71ea1SLaurent Vivier } else { 6627aa6baeeSMark Cave-Ayland /* Adjust TC for any leftover data in the FIFO */ 6637aa6baeeSMark Cave-Ayland if (!fifo8_is_empty(&s->fifo)) { 6647aa6baeeSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - fifo8_num_used(&s->fifo)); 6657aa6baeeSMark Cave-Ayland } 6667aa6baeeSMark Cave-Ayland 66782141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 668042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 669042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 67082141c8bSMark Cave-Ayland s->async_buf += len; 67182141c8bSMark Cave-Ayland s->async_len -= len; 67282141c8bSMark Cave-Ayland s->ti_size -= len; 6737aa6baeeSMark Cave-Ayland 6747aa6baeeSMark Cave-Ayland /* 6757aa6baeeSMark Cave-Ayland * MacOS toolbox uses a TI length of 16 bytes for all commands, so 6767aa6baeeSMark Cave-Ayland * commands shorter than this must be padded accordingly 6777aa6baeeSMark Cave-Ayland */ 6787aa6baeeSMark Cave-Ayland if (len < esp_get_tc(s) && esp_get_tc(s) <= ESP_FIFO_SZ) { 6797aa6baeeSMark Cave-Ayland while (fifo8_num_used(&s->fifo) < ESP_FIFO_SZ) { 680e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, 0); 6817aa6baeeSMark Cave-Ayland len++; 6827aa6baeeSMark Cave-Ayland } 6837aa6baeeSMark Cave-Ayland } 6847aa6baeeSMark Cave-Ayland 68582141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 68677987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 68774d71ea1SLaurent Vivier esp_raise_drq(s); 68882141c8bSMark Cave-Ayland 68982141c8bSMark Cave-Ayland /* Indicate transfer to FIFO is complete */ 69082141c8bSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 69174d71ea1SLaurent Vivier return; 69274d71ea1SLaurent Vivier } 69349ab747fSPaolo Bonzini } 6946cc88d6bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 69549ab747fSPaolo Bonzini s->async_buf += len; 69649ab747fSPaolo Bonzini s->async_len -= len; 69794d5c79dSMark Cave-Ayland if (to_device) { 69849ab747fSPaolo Bonzini s->ti_size += len; 69994d5c79dSMark Cave-Ayland } else { 70049ab747fSPaolo Bonzini s->ti_size -= len; 70194d5c79dSMark Cave-Ayland } 70249ab747fSPaolo Bonzini if (s->async_len == 0) { 70349ab747fSPaolo Bonzini scsi_req_continue(s->current_req); 70494d5c79dSMark Cave-Ayland /* 70594d5c79dSMark Cave-Ayland * If there is still data to be read from the device then 70694d5c79dSMark Cave-Ayland * complete the DMA operation immediately. Otherwise defer 70794d5c79dSMark Cave-Ayland * until the scsi layer has completed. 70894d5c79dSMark Cave-Ayland */ 7096cc88d6bSMark Cave-Ayland if (to_device || esp_get_tc(s) != 0 || s->ti_size == 0) { 71049ab747fSPaolo Bonzini return; 71149ab747fSPaolo Bonzini } 71249ab747fSPaolo Bonzini } 71349ab747fSPaolo Bonzini 71449ab747fSPaolo Bonzini /* Partially filled a scsi buffer. Complete immediately. */ 71549ab747fSPaolo Bonzini esp_dma_done(s); 71682141c8bSMark Cave-Ayland esp_lower_drq(s); 71749ab747fSPaolo Bonzini } 71849ab747fSPaolo Bonzini 7191b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7201b9e48a5SMark Cave-Ayland { 7211b9e48a5SMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 7227b320a8eSMark Cave-Ayland uint32_t cmdlen; 7231b9e48a5SMark Cave-Ayland int len; 7241b9e48a5SMark Cave-Ayland 7251b9e48a5SMark Cave-Ayland if (s->do_cmd) { 7261b9e48a5SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 7271b9e48a5SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 7281b9e48a5SMark Cave-Ayland s->ti_size = 0; 7291b9e48a5SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 7301b9e48a5SMark Cave-Ayland /* No command received */ 7311b9e48a5SMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 7321b9e48a5SMark Cave-Ayland return; 7331b9e48a5SMark Cave-Ayland } 7341b9e48a5SMark Cave-Ayland 7351b9e48a5SMark Cave-Ayland /* Command has been received */ 7361b9e48a5SMark Cave-Ayland s->do_cmd = 0; 7371b9e48a5SMark Cave-Ayland do_cmd(s); 7381b9e48a5SMark Cave-Ayland } else { 7391b9e48a5SMark Cave-Ayland /* 7401b9e48a5SMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 7411b9e48a5SMark Cave-Ayland * and then switch to commmand phase 7421b9e48a5SMark Cave-Ayland */ 7431b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 7441b9e48a5SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 7451b9e48a5SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 7461b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 7471b9e48a5SMark Cave-Ayland esp_raise_irq(s); 7481b9e48a5SMark Cave-Ayland } 7491b9e48a5SMark Cave-Ayland return; 7501b9e48a5SMark Cave-Ayland } 7511b9e48a5SMark Cave-Ayland 7520db89536SMark Cave-Ayland if (!s->current_req) { 7530db89536SMark Cave-Ayland return; 7540db89536SMark Cave-Ayland } 7550db89536SMark Cave-Ayland 7561b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 7571b9e48a5SMark Cave-Ayland /* Defer until data is available. */ 7581b9e48a5SMark Cave-Ayland return; 7591b9e48a5SMark Cave-Ayland } 7601b9e48a5SMark Cave-Ayland 7611b9e48a5SMark Cave-Ayland if (to_device) { 7621b9e48a5SMark Cave-Ayland len = MIN(fifo8_num_used(&s->fifo), ESP_FIFO_SZ); 7637b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 7641b9e48a5SMark Cave-Ayland s->async_buf += len; 7651b9e48a5SMark Cave-Ayland s->async_len -= len; 7661b9e48a5SMark Cave-Ayland s->ti_size += len; 7671b9e48a5SMark Cave-Ayland } else { 7686ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 7696ef2cabcSMark Cave-Ayland fifo8_push(&s->fifo, s->async_buf[0]); 7706ef2cabcSMark Cave-Ayland s->async_buf++; 7716ef2cabcSMark Cave-Ayland s->async_len--; 7726ef2cabcSMark Cave-Ayland s->ti_size--; 7736ef2cabcSMark Cave-Ayland } 7741b9e48a5SMark Cave-Ayland } 7751b9e48a5SMark Cave-Ayland 7761b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 7771b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 7781b9e48a5SMark Cave-Ayland return; 7791b9e48a5SMark Cave-Ayland } 7801b9e48a5SMark Cave-Ayland 7811b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 7821b9e48a5SMark Cave-Ayland esp_raise_irq(s); 7831b9e48a5SMark Cave-Ayland } 7841b9e48a5SMark Cave-Ayland 78577987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s) 78677987ef5SMark Cave-Ayland { 78777987ef5SMark Cave-Ayland switch (s->pdma_cb) { 78877987ef5SMark Cave-Ayland case SATN_PDMA_CB: 78977987ef5SMark Cave-Ayland satn_pdma_cb(s); 79077987ef5SMark Cave-Ayland break; 79177987ef5SMark Cave-Ayland case S_WITHOUT_SATN_PDMA_CB: 79277987ef5SMark Cave-Ayland s_without_satn_pdma_cb(s); 79377987ef5SMark Cave-Ayland break; 79477987ef5SMark Cave-Ayland case SATN_STOP_PDMA_CB: 79577987ef5SMark Cave-Ayland satn_stop_pdma_cb(s); 79677987ef5SMark Cave-Ayland break; 79777987ef5SMark Cave-Ayland case WRITE_RESPONSE_PDMA_CB: 79877987ef5SMark Cave-Ayland write_response_pdma_cb(s); 79977987ef5SMark Cave-Ayland break; 80077987ef5SMark Cave-Ayland case DO_DMA_PDMA_CB: 80177987ef5SMark Cave-Ayland do_dma_pdma_cb(s); 80277987ef5SMark Cave-Ayland break; 80377987ef5SMark Cave-Ayland default: 80477987ef5SMark Cave-Ayland g_assert_not_reached(); 80577987ef5SMark Cave-Ayland } 80677987ef5SMark Cave-Ayland } 80777987ef5SMark Cave-Ayland 8084aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 80949ab747fSPaolo Bonzini { 8104aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 8116ef2cabcSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8124aaa6ac3SMark Cave-Ayland 81349ab747fSPaolo Bonzini trace_esp_command_complete(); 8146ef2cabcSMark Cave-Ayland 8156ef2cabcSMark Cave-Ayland /* 8166ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 8176ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 8186ef2cabcSMark Cave-Ayland */ 8196ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 82049ab747fSPaolo Bonzini if (s->ti_size != 0) { 82149ab747fSPaolo Bonzini trace_esp_command_complete_unexpected(); 82249ab747fSPaolo Bonzini } 82349ab747fSPaolo Bonzini s->ti_size = 0; 8246ef2cabcSMark Cave-Ayland } 8256ef2cabcSMark Cave-Ayland 82649ab747fSPaolo Bonzini s->async_len = 0; 8274aaa6ac3SMark Cave-Ayland if (req->status) { 82849ab747fSPaolo Bonzini trace_esp_command_complete_fail(); 82949ab747fSPaolo Bonzini } 8304aaa6ac3SMark Cave-Ayland s->status = req->status; 8316ef2cabcSMark Cave-Ayland 8326ef2cabcSMark Cave-Ayland /* 8336ef2cabcSMark Cave-Ayland * If the transfer is finished, switch to status phase. For non-DMA 8346ef2cabcSMark Cave-Ayland * transfers from the target the last byte is still in the FIFO 8356ef2cabcSMark Cave-Ayland */ 8366ef2cabcSMark Cave-Ayland if (s->ti_size == 0) { 8376ef2cabcSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 83849ab747fSPaolo Bonzini esp_dma_done(s); 83982141c8bSMark Cave-Ayland esp_lower_drq(s); 8406ef2cabcSMark Cave-Ayland } 8416ef2cabcSMark Cave-Ayland 84249ab747fSPaolo Bonzini if (s->current_req) { 84349ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 84449ab747fSPaolo Bonzini s->current_req = NULL; 84549ab747fSPaolo Bonzini s->current_dev = NULL; 84649ab747fSPaolo Bonzini } 84749ab747fSPaolo Bonzini } 84849ab747fSPaolo Bonzini 84949ab747fSPaolo Bonzini void esp_transfer_data(SCSIRequest *req, uint32_t len) 85049ab747fSPaolo Bonzini { 85149ab747fSPaolo Bonzini ESPState *s = req->hba_private; 8524e78f3bfSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8536cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 85449ab747fSPaolo Bonzini 8557f0b6e11SPaolo Bonzini assert(!s->do_cmd); 8566cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 85749ab747fSPaolo Bonzini s->async_len = len; 85849ab747fSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 8594e78f3bfSMark Cave-Ayland 8604e78f3bfSMark Cave-Ayland if (!to_device && !s->data_in_ready) { 8614e78f3bfSMark Cave-Ayland /* 8624e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 8634e78f3bfSMark Cave-Ayland * completion interrupt 8644e78f3bfSMark Cave-Ayland */ 8654e78f3bfSMark Cave-Ayland s->data_in_ready = true; 8664e78f3bfSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 8674e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8684e78f3bfSMark Cave-Ayland esp_raise_irq(s); 8694e78f3bfSMark Cave-Ayland } 8704e78f3bfSMark Cave-Ayland 8711b9e48a5SMark Cave-Ayland if (s->ti_cmd == 0) { 8721b9e48a5SMark Cave-Ayland /* 8731b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 8741b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 8751b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 8761b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 8771b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 8781b9e48a5SMark Cave-Ayland */ 8791b9e48a5SMark Cave-Ayland return; 8801b9e48a5SMark Cave-Ayland } 8811b9e48a5SMark Cave-Ayland 882880d3089SMark Cave-Ayland if (s->ti_cmd == (CMD_TI | CMD_DMA)) { 8836cc88d6bSMark Cave-Ayland if (dmalen) { 88449ab747fSPaolo Bonzini esp_do_dma(s); 8855eb7a23fSMark Cave-Ayland } else if (s->ti_size <= 0) { 88694d5c79dSMark Cave-Ayland /* 88794d5c79dSMark Cave-Ayland * If this was the last part of a DMA transfer then the 88894d5c79dSMark Cave-Ayland * completion interrupt is deferred to here. 88994d5c79dSMark Cave-Ayland */ 89049ab747fSPaolo Bonzini esp_dma_done(s); 89182141c8bSMark Cave-Ayland esp_lower_drq(s); 89249ab747fSPaolo Bonzini } 893880d3089SMark Cave-Ayland } else if (s->ti_cmd == CMD_TI) { 8941b9e48a5SMark Cave-Ayland esp_do_nodma(s); 8951b9e48a5SMark Cave-Ayland } 89649ab747fSPaolo Bonzini } 89749ab747fSPaolo Bonzini 89849ab747fSPaolo Bonzini static void handle_ti(ESPState *s) 89949ab747fSPaolo Bonzini { 9001b9e48a5SMark Cave-Ayland uint32_t dmalen; 90149ab747fSPaolo Bonzini 90249ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 90349ab747fSPaolo Bonzini s->dma_cb = handle_ti; 90449ab747fSPaolo Bonzini return; 90549ab747fSPaolo Bonzini } 90649ab747fSPaolo Bonzini 9071b9e48a5SMark Cave-Ayland s->ti_cmd = s->rregs[ESP_CMD]; 90849ab747fSPaolo Bonzini if (s->dma) { 9091b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 910b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 91149ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 91249ab747fSPaolo Bonzini esp_do_dma(s); 913799d90d8SMark Cave-Ayland } else { 9141b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 9151b9e48a5SMark Cave-Ayland esp_do_nodma(s); 91649ab747fSPaolo Bonzini } 91749ab747fSPaolo Bonzini } 91849ab747fSPaolo Bonzini 91949ab747fSPaolo Bonzini void esp_hard_reset(ESPState *s) 92049ab747fSPaolo Bonzini { 92149ab747fSPaolo Bonzini memset(s->rregs, 0, ESP_REGS); 92249ab747fSPaolo Bonzini memset(s->wregs, 0, ESP_REGS); 923c9cf45c1SHannes Reinecke s->tchi_written = 0; 92449ab747fSPaolo Bonzini s->ti_size = 0; 9253f26c975SMark Cave-Ayland s->async_len = 0; 926042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 927023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 92849ab747fSPaolo Bonzini s->dma = 0; 92949ab747fSPaolo Bonzini s->do_cmd = 0; 93049ab747fSPaolo Bonzini s->dma_cb = NULL; 93149ab747fSPaolo Bonzini 93249ab747fSPaolo Bonzini s->rregs[ESP_CFG1] = 7; 93349ab747fSPaolo Bonzini } 93449ab747fSPaolo Bonzini 93549ab747fSPaolo Bonzini static void esp_soft_reset(ESPState *s) 93649ab747fSPaolo Bonzini { 93749ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 93874d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 93949ab747fSPaolo Bonzini esp_hard_reset(s); 94049ab747fSPaolo Bonzini } 94149ab747fSPaolo Bonzini 94249ab747fSPaolo Bonzini static void parent_esp_reset(ESPState *s, int irq, int level) 94349ab747fSPaolo Bonzini { 94449ab747fSPaolo Bonzini if (level) { 94549ab747fSPaolo Bonzini esp_soft_reset(s); 94649ab747fSPaolo Bonzini } 94749ab747fSPaolo Bonzini } 94849ab747fSPaolo Bonzini 94949ab747fSPaolo Bonzini uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 95049ab747fSPaolo Bonzini { 951b630c075SMark Cave-Ayland uint32_t val; 95249ab747fSPaolo Bonzini 95349ab747fSPaolo Bonzini switch (saddr) { 95449ab747fSPaolo Bonzini case ESP_FIFO: 9551b9e48a5SMark Cave-Ayland if (s->dma_memory_read && s->dma_memory_write && 9561b9e48a5SMark Cave-Ayland (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 95749ab747fSPaolo Bonzini /* Data out. */ 958ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 95949ab747fSPaolo Bonzini s->rregs[ESP_FIFO] = 0; 960042879fcSMark Cave-Ayland } else { 9616ef2cabcSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) { 9626ef2cabcSMark Cave-Ayland if (s->ti_size) { 9636ef2cabcSMark Cave-Ayland esp_do_nodma(s); 9646ef2cabcSMark Cave-Ayland } else { 9656ef2cabcSMark Cave-Ayland /* 9666ef2cabcSMark Cave-Ayland * The last byte of a non-DMA transfer has been read out 9676ef2cabcSMark Cave-Ayland * of the FIFO so switch to status phase 9686ef2cabcSMark Cave-Ayland */ 9696ef2cabcSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 9706ef2cabcSMark Cave-Ayland } 9716ef2cabcSMark Cave-Ayland } 972c5fef911SMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo); 97349ab747fSPaolo Bonzini } 974b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 97549ab747fSPaolo Bonzini break; 97649ab747fSPaolo Bonzini case ESP_RINTR: 97794d5c79dSMark Cave-Ayland /* 97894d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 97994d5c79dSMark Cave-Ayland * except TC 98094d5c79dSMark Cave-Ayland */ 981b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 98249ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 98349ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 984af947a3dSMark Cave-Ayland /* 985af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 986af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 987af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 988af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 989af947a3dSMark Cave-Ayland * transition. 990af947a3dSMark Cave-Ayland * 991af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 992af947a3dSMark Cave-Ayland */ 99349ab747fSPaolo Bonzini esp_lower_irq(s); 994b630c075SMark Cave-Ayland break; 995c9cf45c1SHannes Reinecke case ESP_TCHI: 996c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 997c9cf45c1SHannes Reinecke if (!s->tchi_written) { 998b630c075SMark Cave-Ayland val = s->chip_id; 999b630c075SMark Cave-Ayland } else { 1000b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1001c9cf45c1SHannes Reinecke } 1002b630c075SMark Cave-Ayland break; 1003238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1004238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1005238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1006238ec4d7SMark Cave-Ayland break; 100749ab747fSPaolo Bonzini default: 1008b630c075SMark Cave-Ayland val = s->rregs[saddr]; 100949ab747fSPaolo Bonzini break; 101049ab747fSPaolo Bonzini } 1011b630c075SMark Cave-Ayland 1012b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1013b630c075SMark Cave-Ayland return val; 101449ab747fSPaolo Bonzini } 101549ab747fSPaolo Bonzini 101649ab747fSPaolo Bonzini void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 101749ab747fSPaolo Bonzini { 101849ab747fSPaolo Bonzini trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 101949ab747fSPaolo Bonzini switch (saddr) { 1020c9cf45c1SHannes Reinecke case ESP_TCHI: 1021c9cf45c1SHannes Reinecke s->tchi_written = true; 1022c9cf45c1SHannes Reinecke /* fall through */ 102349ab747fSPaolo Bonzini case ESP_TCLO: 102449ab747fSPaolo Bonzini case ESP_TCMID: 102549ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 102649ab747fSPaolo Bonzini break; 102749ab747fSPaolo Bonzini case ESP_FIFO: 102849ab747fSPaolo Bonzini if (s->do_cmd) { 1029e5455b8cSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, val); 10306ef2cabcSMark Cave-Ayland 10316ef2cabcSMark Cave-Ayland /* 10326ef2cabcSMark Cave-Ayland * If any unexpected message out/command phase data is 10336ef2cabcSMark Cave-Ayland * transferred using non-DMA, raise the interrupt 10346ef2cabcSMark Cave-Ayland */ 10356ef2cabcSMark Cave-Ayland if (s->rregs[ESP_CMD] == CMD_TI) { 10366ef2cabcSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 10376ef2cabcSMark Cave-Ayland esp_raise_irq(s); 10386ef2cabcSMark Cave-Ayland } 103949ab747fSPaolo Bonzini } else { 1040e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 104149ab747fSPaolo Bonzini } 104249ab747fSPaolo Bonzini break; 104349ab747fSPaolo Bonzini case ESP_CMD: 104449ab747fSPaolo Bonzini s->rregs[saddr] = val; 104549ab747fSPaolo Bonzini if (val & CMD_DMA) { 104649ab747fSPaolo Bonzini s->dma = 1; 104749ab747fSPaolo Bonzini /* Reload DMA counter. */ 104896676c2fSMark Cave-Ayland if (esp_get_stc(s) == 0) { 104996676c2fSMark Cave-Ayland esp_set_tc(s, 0x10000); 105096676c2fSMark Cave-Ayland } else { 1051c04ed569SMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 105296676c2fSMark Cave-Ayland } 105349ab747fSPaolo Bonzini } else { 105449ab747fSPaolo Bonzini s->dma = 0; 105549ab747fSPaolo Bonzini } 105649ab747fSPaolo Bonzini switch (val & CMD_CMD) { 105749ab747fSPaolo Bonzini case CMD_NOP: 105849ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_nop(val); 105949ab747fSPaolo Bonzini break; 106049ab747fSPaolo Bonzini case CMD_FLUSH: 106149ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_flush(val); 1062042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 106349ab747fSPaolo Bonzini break; 106449ab747fSPaolo Bonzini case CMD_RESET: 106549ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_reset(val); 106649ab747fSPaolo Bonzini esp_soft_reset(s); 106749ab747fSPaolo Bonzini break; 106849ab747fSPaolo Bonzini case CMD_BUSRESET: 106949ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_bus_reset(val); 107049ab747fSPaolo Bonzini if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1071cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 107249ab747fSPaolo Bonzini esp_raise_irq(s); 107349ab747fSPaolo Bonzini } 107449ab747fSPaolo Bonzini break; 107549ab747fSPaolo Bonzini case CMD_TI: 10760097d3ecSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(val); 107749ab747fSPaolo Bonzini handle_ti(s); 107849ab747fSPaolo Bonzini break; 107949ab747fSPaolo Bonzini case CMD_ICCS: 108049ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_iccs(val); 108149ab747fSPaolo Bonzini write_response(s); 1082cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 108349ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_MI; 108449ab747fSPaolo Bonzini break; 108549ab747fSPaolo Bonzini case CMD_MSGACC: 108649ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_msgacc(val); 1087cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 108849ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = 0; 108949ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 0; 109049ab747fSPaolo Bonzini esp_raise_irq(s); 109149ab747fSPaolo Bonzini break; 109249ab747fSPaolo Bonzini case CMD_PAD: 109349ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_pad(val); 109449ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC; 1095cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 109649ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = 0; 109749ab747fSPaolo Bonzini break; 109849ab747fSPaolo Bonzini case CMD_SATN: 109949ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_satn(val); 110049ab747fSPaolo Bonzini break; 110149ab747fSPaolo Bonzini case CMD_RSTATN: 110249ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_rstatn(val); 110349ab747fSPaolo Bonzini break; 110449ab747fSPaolo Bonzini case CMD_SEL: 110549ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_sel(val); 110649ab747fSPaolo Bonzini handle_s_without_atn(s); 110749ab747fSPaolo Bonzini break; 110849ab747fSPaolo Bonzini case CMD_SELATN: 110949ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_selatn(val); 111049ab747fSPaolo Bonzini handle_satn(s); 111149ab747fSPaolo Bonzini break; 111249ab747fSPaolo Bonzini case CMD_SELATNS: 111349ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_selatns(val); 111449ab747fSPaolo Bonzini handle_satn_stop(s); 111549ab747fSPaolo Bonzini break; 111649ab747fSPaolo Bonzini case CMD_ENSEL: 111749ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_ensel(val); 111849ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 111949ab747fSPaolo Bonzini break; 112049ab747fSPaolo Bonzini case CMD_DISSEL: 112149ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_dissel(val); 112249ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 112349ab747fSPaolo Bonzini esp_raise_irq(s); 112449ab747fSPaolo Bonzini break; 112549ab747fSPaolo Bonzini default: 112649ab747fSPaolo Bonzini trace_esp_error_unhandled_command(val); 112749ab747fSPaolo Bonzini break; 112849ab747fSPaolo Bonzini } 112949ab747fSPaolo Bonzini break; 113049ab747fSPaolo Bonzini case ESP_WBUSID ... ESP_WSYNO: 113149ab747fSPaolo Bonzini break; 113249ab747fSPaolo Bonzini case ESP_CFG1: 113349ab747fSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 113449ab747fSPaolo Bonzini case ESP_RES3: case ESP_RES4: 113549ab747fSPaolo Bonzini s->rregs[saddr] = val; 113649ab747fSPaolo Bonzini break; 113749ab747fSPaolo Bonzini case ESP_WCCF ... ESP_WTEST: 113849ab747fSPaolo Bonzini break; 113949ab747fSPaolo Bonzini default: 114049ab747fSPaolo Bonzini trace_esp_error_invalid_write(val, saddr); 114149ab747fSPaolo Bonzini return; 114249ab747fSPaolo Bonzini } 114349ab747fSPaolo Bonzini s->wregs[saddr] = val; 114449ab747fSPaolo Bonzini } 114549ab747fSPaolo Bonzini 114649ab747fSPaolo Bonzini static bool esp_mem_accepts(void *opaque, hwaddr addr, 11478372d383SPeter Maydell unsigned size, bool is_write, 11488372d383SPeter Maydell MemTxAttrs attrs) 114949ab747fSPaolo Bonzini { 115049ab747fSPaolo Bonzini return (size == 1) || (is_write && size == 4); 115149ab747fSPaolo Bonzini } 115249ab747fSPaolo Bonzini 11536cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 11546cc88d6bSMark Cave-Ayland { 11556cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 11566cc88d6bSMark Cave-Ayland 11576cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11586cc88d6bSMark Cave-Ayland return version_id < 5; 11596cc88d6bSMark Cave-Ayland } 11606cc88d6bSMark Cave-Ayland 11614e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 11624e78f3bfSMark Cave-Ayland { 11634e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 11644e78f3bfSMark Cave-Ayland 11654e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11660bcd5a18SMark Cave-Ayland return version_id >= 5; 11674e78f3bfSMark Cave-Ayland } 11684e78f3bfSMark Cave-Ayland 11694eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 11704eb86065SPaolo Bonzini { 11714eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 11724eb86065SPaolo Bonzini 11734eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 11744eb86065SPaolo Bonzini return version_id >= 6; 11754eb86065SPaolo Bonzini } 11764eb86065SPaolo Bonzini 1177ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 11780bd005beSMark Cave-Ayland { 1179ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1180ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 11810bd005beSMark Cave-Ayland 11820bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 11830bd005beSMark Cave-Ayland return 0; 11840bd005beSMark Cave-Ayland } 11850bd005beSMark Cave-Ayland 11860bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 11870bd005beSMark Cave-Ayland { 11880bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1189042879fcSMark Cave-Ayland int len, i; 11900bd005beSMark Cave-Ayland 11916cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11926cc88d6bSMark Cave-Ayland 11936cc88d6bSMark Cave-Ayland if (version_id < 5) { 11946cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1195042879fcSMark Cave-Ayland 1196042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1197042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1198042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1199042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1200042879fcSMark Cave-Ayland } 1201023666daSMark Cave-Ayland 1202023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1203023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1204023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1205023666daSMark Cave-Ayland } 12066cc88d6bSMark Cave-Ayland } 12076cc88d6bSMark Cave-Ayland 12080bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12090bd005beSMark Cave-Ayland return 0; 12100bd005beSMark Cave-Ayland } 12110bd005beSMark Cave-Ayland 1212eda59b39SMark Cave-Ayland /* 1213eda59b39SMark Cave-Ayland * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the 1214eda59b39SMark Cave-Ayland * guest CPU to perform the transfers between the SCSI bus and memory 1215eda59b39SMark Cave-Ayland * itself. This is indicated by the dma_memory_read and dma_memory_write 1216eda59b39SMark Cave-Ayland * functions being NULL (in contrast to the ESP PCI device) whilst 1217eda59b39SMark Cave-Ayland * dma_enabled is still set. 1218eda59b39SMark Cave-Ayland */ 1219eda59b39SMark Cave-Ayland 1220eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque) 1221eda59b39SMark Cave-Ayland { 1222eda59b39SMark Cave-Ayland ESPState *s = ESP(opaque); 1223eda59b39SMark Cave-Ayland 1224eda59b39SMark Cave-Ayland return s->dma_memory_read == NULL && s->dma_memory_write == NULL && 1225eda59b39SMark Cave-Ayland s->dma_enabled; 1226eda59b39SMark Cave-Ayland } 1227eda59b39SMark Cave-Ayland 1228eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = { 1229eda59b39SMark Cave-Ayland .name = "esp/pdma", 1230eda59b39SMark Cave-Ayland .version_id = 0, 1231eda59b39SMark Cave-Ayland .minimum_version_id = 0, 1232eda59b39SMark Cave-Ayland .needed = esp_pdma_needed, 1233eda59b39SMark Cave-Ayland .fields = (VMStateField[]) { 1234eda59b39SMark Cave-Ayland VMSTATE_UINT8(pdma_cb, ESPState), 1235eda59b39SMark Cave-Ayland VMSTATE_END_OF_LIST() 1236eda59b39SMark Cave-Ayland } 1237eda59b39SMark Cave-Ayland }; 1238eda59b39SMark Cave-Ayland 123949ab747fSPaolo Bonzini const VMStateDescription vmstate_esp = { 124049ab747fSPaolo Bonzini .name = "esp", 12414eb86065SPaolo Bonzini .version_id = 6, 124249ab747fSPaolo Bonzini .minimum_version_id = 3, 12430bd005beSMark Cave-Ayland .post_load = esp_post_load, 124449ab747fSPaolo Bonzini .fields = (VMStateField[]) { 124549ab747fSPaolo Bonzini VMSTATE_BUFFER(rregs, ESPState), 124649ab747fSPaolo Bonzini VMSTATE_BUFFER(wregs, ESPState), 124749ab747fSPaolo Bonzini VMSTATE_INT32(ti_size, ESPState), 1248042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1249042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1250042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 125149ab747fSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 12524aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 12534aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 12544aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 12554aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 125649ab747fSPaolo Bonzini VMSTATE_UINT32(dma, ESPState), 1257023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1258023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1259023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1260023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1261023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1262023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 126349ab747fSPaolo Bonzini VMSTATE_UINT32(do_cmd, ESPState), 12646cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 12654e78f3bfSMark Cave-Ayland VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5), 1266023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1267042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1268023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 12691b9e48a5SMark Cave-Ayland VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5), 12704eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 127149ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 127274d71ea1SLaurent Vivier }, 1273eda59b39SMark Cave-Ayland .subsections = (const VMStateDescription * []) { 1274eda59b39SMark Cave-Ayland &vmstate_esp_pdma, 1275eda59b39SMark Cave-Ayland NULL 1276eda59b39SMark Cave-Ayland } 127749ab747fSPaolo Bonzini }; 127849ab747fSPaolo Bonzini 127949ab747fSPaolo Bonzini static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 128049ab747fSPaolo Bonzini uint64_t val, unsigned int size) 128149ab747fSPaolo Bonzini { 128249ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1283eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 128449ab747fSPaolo Bonzini uint32_t saddr; 128549ab747fSPaolo Bonzini 128649ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1287eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 128849ab747fSPaolo Bonzini } 128949ab747fSPaolo Bonzini 129049ab747fSPaolo Bonzini static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 129149ab747fSPaolo Bonzini unsigned int size) 129249ab747fSPaolo Bonzini { 129349ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1294eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 129549ab747fSPaolo Bonzini uint32_t saddr; 129649ab747fSPaolo Bonzini 129749ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1298eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 129949ab747fSPaolo Bonzini } 130049ab747fSPaolo Bonzini 130149ab747fSPaolo Bonzini static const MemoryRegionOps sysbus_esp_mem_ops = { 130249ab747fSPaolo Bonzini .read = sysbus_esp_mem_read, 130349ab747fSPaolo Bonzini .write = sysbus_esp_mem_write, 130449ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 130549ab747fSPaolo Bonzini .valid.accepts = esp_mem_accepts, 130649ab747fSPaolo Bonzini }; 130749ab747fSPaolo Bonzini 130874d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 130974d71ea1SLaurent Vivier uint64_t val, unsigned int size) 131074d71ea1SLaurent Vivier { 131174d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1312eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 131374d71ea1SLaurent Vivier 1314960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1315960ebfd9SMark Cave-Ayland 131674d71ea1SLaurent Vivier switch (size) { 131774d71ea1SLaurent Vivier case 1: 1318761bef75SMark Cave-Ayland esp_pdma_write(s, val); 131974d71ea1SLaurent Vivier break; 132074d71ea1SLaurent Vivier case 2: 1321761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1322761bef75SMark Cave-Ayland esp_pdma_write(s, val); 132374d71ea1SLaurent Vivier break; 132474d71ea1SLaurent Vivier } 1325d0243b09SMark Cave-Ayland esp_pdma_cb(s); 132674d71ea1SLaurent Vivier } 132774d71ea1SLaurent Vivier 132874d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 132974d71ea1SLaurent Vivier unsigned int size) 133074d71ea1SLaurent Vivier { 133174d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1332eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 133374d71ea1SLaurent Vivier uint64_t val = 0; 133474d71ea1SLaurent Vivier 1335960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1336960ebfd9SMark Cave-Ayland 133774d71ea1SLaurent Vivier switch (size) { 133874d71ea1SLaurent Vivier case 1: 1339761bef75SMark Cave-Ayland val = esp_pdma_read(s); 134074d71ea1SLaurent Vivier break; 134174d71ea1SLaurent Vivier case 2: 1342761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1343761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 134474d71ea1SLaurent Vivier break; 134574d71ea1SLaurent Vivier } 13467aa6baeeSMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 1347d0243b09SMark Cave-Ayland esp_pdma_cb(s); 134874d71ea1SLaurent Vivier } 134974d71ea1SLaurent Vivier return val; 135074d71ea1SLaurent Vivier } 135174d71ea1SLaurent Vivier 1352*a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1353*a7a22088SMark Cave-Ayland { 1354*a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1355*a7a22088SMark Cave-Ayland 1356*a7a22088SMark Cave-Ayland scsi_req_ref(req); 1357*a7a22088SMark Cave-Ayland s->current_req = req; 1358*a7a22088SMark Cave-Ayland return s; 1359*a7a22088SMark Cave-Ayland } 1360*a7a22088SMark Cave-Ayland 136174d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 136274d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 136374d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 136474d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 136574d71ea1SLaurent Vivier .valid.min_access_size = 1, 1366cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1367cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1368cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 136974d71ea1SLaurent Vivier }; 137074d71ea1SLaurent Vivier 137149ab747fSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 137249ab747fSPaolo Bonzini .tcq = false, 137349ab747fSPaolo Bonzini .max_target = ESP_MAX_DEVS, 137449ab747fSPaolo Bonzini .max_lun = 7, 137549ab747fSPaolo Bonzini 1376*a7a22088SMark Cave-Ayland .load_request = esp_load_request, 137749ab747fSPaolo Bonzini .transfer_data = esp_transfer_data, 137849ab747fSPaolo Bonzini .complete = esp_command_complete, 137949ab747fSPaolo Bonzini .cancel = esp_request_cancelled 138049ab747fSPaolo Bonzini }; 138149ab747fSPaolo Bonzini 138249ab747fSPaolo Bonzini static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 138349ab747fSPaolo Bonzini { 138484fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1385eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 138649ab747fSPaolo Bonzini 138749ab747fSPaolo Bonzini switch (irq) { 138849ab747fSPaolo Bonzini case 0: 138949ab747fSPaolo Bonzini parent_esp_reset(s, irq, level); 139049ab747fSPaolo Bonzini break; 139149ab747fSPaolo Bonzini case 1: 139249ab747fSPaolo Bonzini esp_dma_enable(opaque, irq, level); 139349ab747fSPaolo Bonzini break; 139449ab747fSPaolo Bonzini } 139549ab747fSPaolo Bonzini } 139649ab747fSPaolo Bonzini 1397b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 139849ab747fSPaolo Bonzini { 1399b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 140084fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1401eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1402eb169c76SMark Cave-Ayland 1403eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1404eb169c76SMark Cave-Ayland return; 1405eb169c76SMark Cave-Ayland } 140649ab747fSPaolo Bonzini 1407b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 140874d71ea1SLaurent Vivier sysbus_init_irq(sbd, &s->irq_data); 140949ab747fSPaolo Bonzini assert(sysbus->it_shift != -1); 141049ab747fSPaolo Bonzini 141149ab747fSPaolo Bonzini s->chip_id = TCHI_FAS100A; 141229776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 141374d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1414b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 141574d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1416cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 141774d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 141849ab747fSPaolo Bonzini 1419b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 142049ab747fSPaolo Bonzini 1421739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 142249ab747fSPaolo Bonzini } 142349ab747fSPaolo Bonzini 142449ab747fSPaolo Bonzini static void sysbus_esp_hard_reset(DeviceState *dev) 142549ab747fSPaolo Bonzini { 142684fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1427eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1428eb169c76SMark Cave-Ayland 1429eb169c76SMark Cave-Ayland esp_hard_reset(s); 1430eb169c76SMark Cave-Ayland } 1431eb169c76SMark Cave-Ayland 1432eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1433eb169c76SMark Cave-Ayland { 1434eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1435eb169c76SMark Cave-Ayland 1436eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 143749ab747fSPaolo Bonzini } 143849ab747fSPaolo Bonzini 143949ab747fSPaolo Bonzini static const VMStateDescription vmstate_sysbus_esp_scsi = { 144049ab747fSPaolo Bonzini .name = "sysbusespscsi", 14410bd005beSMark Cave-Ayland .version_id = 2, 1442ea84a442SGuenter Roeck .minimum_version_id = 1, 1443ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 144449ab747fSPaolo Bonzini .fields = (VMStateField[]) { 14450bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 144649ab747fSPaolo Bonzini VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 144749ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 144849ab747fSPaolo Bonzini } 144949ab747fSPaolo Bonzini }; 145049ab747fSPaolo Bonzini 145149ab747fSPaolo Bonzini static void sysbus_esp_class_init(ObjectClass *klass, void *data) 145249ab747fSPaolo Bonzini { 145349ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 145449ab747fSPaolo Bonzini 1455b09318caSHu Tao dc->realize = sysbus_esp_realize; 145649ab747fSPaolo Bonzini dc->reset = sysbus_esp_hard_reset; 145749ab747fSPaolo Bonzini dc->vmsd = &vmstate_sysbus_esp_scsi; 1458125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 145949ab747fSPaolo Bonzini } 146049ab747fSPaolo Bonzini 146149ab747fSPaolo Bonzini static const TypeInfo sysbus_esp_info = { 146284fbefedSMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 146349ab747fSPaolo Bonzini .parent = TYPE_SYS_BUS_DEVICE, 1464eb169c76SMark Cave-Ayland .instance_init = sysbus_esp_init, 146549ab747fSPaolo Bonzini .instance_size = sizeof(SysBusESPState), 146649ab747fSPaolo Bonzini .class_init = sysbus_esp_class_init, 146749ab747fSPaolo Bonzini }; 146849ab747fSPaolo Bonzini 1469042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1470042879fcSMark Cave-Ayland { 1471042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1472042879fcSMark Cave-Ayland 1473042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1474023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1475042879fcSMark Cave-Ayland } 1476042879fcSMark Cave-Ayland 1477042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1478042879fcSMark Cave-Ayland { 1479042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1480042879fcSMark Cave-Ayland 1481042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1482023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1483042879fcSMark Cave-Ayland } 1484042879fcSMark Cave-Ayland 1485eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1486eb169c76SMark Cave-Ayland { 1487eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1488eb169c76SMark Cave-Ayland 1489eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1490eb169c76SMark Cave-Ayland dc->user_creatable = false; 1491eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1492eb169c76SMark Cave-Ayland } 1493eb169c76SMark Cave-Ayland 1494eb169c76SMark Cave-Ayland static const TypeInfo esp_info = { 1495eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1496eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1497042879fcSMark Cave-Ayland .instance_init = esp_init, 1498042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1499eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1500eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1501eb169c76SMark Cave-Ayland }; 1502eb169c76SMark Cave-Ayland 150349ab747fSPaolo Bonzini static void esp_register_types(void) 150449ab747fSPaolo Bonzini { 150549ab747fSPaolo Bonzini type_register_static(&sysbus_esp_info); 1506eb169c76SMark Cave-Ayland type_register_static(&esp_info); 150749ab747fSPaolo Bonzini } 150849ab747fSPaolo Bonzini 150949ab747fSPaolo Bonzini type_init(esp_register_types) 1510