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 198c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 1996130b188SLaurent Vivier { 2006130b188SLaurent Vivier int target; 2016130b188SLaurent Vivier 2026130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2036130b188SLaurent Vivier 2046130b188SLaurent Vivier s->ti_size = 0; 205042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 2066130b188SLaurent Vivier 2076130b188SLaurent Vivier if (s->current_req) { 2086130b188SLaurent Vivier /* Started a new command before the old one finished. Cancel it. */ 2096130b188SLaurent Vivier scsi_req_cancel(s->current_req); 2106130b188SLaurent Vivier } 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 2244e78f3bfSMark Cave-Ayland * either in do_busid_cmd() 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 23849ab747fSPaolo Bonzini target = s->wregs[ESP_WBUSID] & BUSID_DID; 23949ab747fSPaolo Bonzini if (s->dma) { 24020c8d2edSMark Cave-Ayland dmalen = MIN(esp_get_tc(s), maxlen); 24120c8d2edSMark Cave-Ayland if (dmalen == 0) { 2426c1fef6bSPrasad J Pandit return 0; 2436c1fef6bSPrasad J Pandit } 24474d71ea1SLaurent Vivier if (s->dma_memory_read) { 24549ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, buf, dmalen); 246fbc6510eSMark Cave-Ayland dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen); 247023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, dmalen); 24849ab747fSPaolo Bonzini } else { 24949691315SMark Cave-Ayland if (esp_select(s) < 0) { 250023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 25149691315SMark Cave-Ayland return -1; 25249691315SMark Cave-Ayland } 25374d71ea1SLaurent Vivier esp_raise_drq(s); 254023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 25574d71ea1SLaurent Vivier return 0; 25674d71ea1SLaurent Vivier } 25774d71ea1SLaurent Vivier } else { 258023666daSMark Cave-Ayland dmalen = MIN(fifo8_num_used(&s->fifo), maxlen); 25920c8d2edSMark Cave-Ayland if (dmalen == 0) { 260d3cdc491SPrasad J Pandit return 0; 261d3cdc491SPrasad J Pandit } 2627b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, dmalen); 263fbc6510eSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 2647b320a8eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 26520c8d2edSMark Cave-Ayland } 26649ab747fSPaolo Bonzini trace_esp_get_cmd(dmalen, target); 26749ab747fSPaolo Bonzini 268c7bce09cSMark Cave-Ayland if (esp_select(s) < 0) { 269023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 27049691315SMark Cave-Ayland return -1; 27149ab747fSPaolo Bonzini } 27249ab747fSPaolo Bonzini return dmalen; 27349ab747fSPaolo Bonzini } 27449ab747fSPaolo Bonzini 275023666daSMark Cave-Ayland static void do_busid_cmd(ESPState *s, uint8_t busid) 27649ab747fSPaolo Bonzini { 2777b320a8eSMark Cave-Ayland uint32_t cmdlen; 27849ab747fSPaolo Bonzini int32_t datalen; 27949ab747fSPaolo Bonzini int lun; 28049ab747fSPaolo Bonzini SCSIDevice *current_lun; 2817b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 28249ab747fSPaolo Bonzini 28349ab747fSPaolo Bonzini trace_esp_do_busid_cmd(busid); 28449ab747fSPaolo Bonzini lun = busid & 7; 285023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 28699545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 28799545751SMark Cave-Ayland return; 28899545751SMark Cave-Ayland } 2897b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen); 290023666daSMark Cave-Ayland 29149ab747fSPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, lun); 29249ab747fSPaolo Bonzini s->current_req = scsi_req_new(current_lun, 0, lun, buf, s); 29349ab747fSPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 29449ab747fSPaolo Bonzini s->ti_size = datalen; 295023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 29649ab747fSPaolo Bonzini if (datalen != 0) { 29749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC; 2984e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 2991b9e48a5SMark Cave-Ayland s->ti_cmd = 0; 3006cc88d6bSMark Cave-Ayland esp_set_tc(s, 0); 30149ab747fSPaolo Bonzini if (datalen > 0) { 3024e78f3bfSMark Cave-Ayland /* 3034e78f3bfSMark Cave-Ayland * Switch to DATA IN phase but wait until initial data xfer is 3044e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3054e78f3bfSMark Cave-Ayland */ 3064e78f3bfSMark Cave-Ayland s->data_in_ready = false; 30749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_DI; 30849ab747fSPaolo Bonzini } else { 30949ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_DO; 310cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 31149ab747fSPaolo Bonzini esp_raise_irq(s); 31282141c8bSMark Cave-Ayland esp_lower_drq(s); 31349ab747fSPaolo Bonzini } 3144e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3154e78f3bfSMark Cave-Ayland return; 3164e78f3bfSMark Cave-Ayland } 3174e78f3bfSMark Cave-Ayland } 31849ab747fSPaolo Bonzini 319c959f218SMark Cave-Ayland static void do_cmd(ESPState *s) 32049ab747fSPaolo Bonzini { 321fa7505c1SMark Cave-Ayland uint8_t busid = esp_fifo_pop(&s->cmdfifo); 322fa7505c1SMark Cave-Ayland int len; 323023666daSMark Cave-Ayland 324023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 32549ab747fSPaolo Bonzini 326799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 327023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 328fa7505c1SMark Cave-Ayland len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 329fa7505c1SMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, NULL, len); 330023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 331023666daSMark Cave-Ayland } 332023666daSMark Cave-Ayland 333023666daSMark Cave-Ayland do_busid_cmd(s, busid); 33449ab747fSPaolo Bonzini } 33549ab747fSPaolo Bonzini 33674d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s) 33774d71ea1SLaurent Vivier { 338e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 339023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 340e62a959aSMark Cave-Ayland s->do_cmd = 0; 341c959f218SMark Cave-Ayland do_cmd(s); 34274d71ea1SLaurent Vivier } 34374d71ea1SLaurent Vivier } 34474d71ea1SLaurent Vivier 34549ab747fSPaolo Bonzini static void handle_satn(ESPState *s) 34649ab747fSPaolo Bonzini { 34749691315SMark Cave-Ayland int32_t cmdlen; 34849691315SMark Cave-Ayland 34949ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 35049ab747fSPaolo Bonzini s->dma_cb = handle_satn; 35149ab747fSPaolo Bonzini return; 35249ab747fSPaolo Bonzini } 35374d71ea1SLaurent Vivier s->pdma_cb = satn_pdma_cb; 354023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 35549691315SMark Cave-Ayland if (cmdlen > 0) { 356023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 35760720694SMark Cave-Ayland s->do_cmd = 0; 358c959f218SMark Cave-Ayland do_cmd(s); 35949691315SMark Cave-Ayland } else if (cmdlen == 0) { 360bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 36149691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 36249691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 36349691315SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_CD; 36449ab747fSPaolo Bonzini } 36594d5c79dSMark Cave-Ayland } 36649ab747fSPaolo Bonzini 36774d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s) 36874d71ea1SLaurent Vivier { 369e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 370023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 371e62a959aSMark Cave-Ayland s->do_cmd = 0; 372023666daSMark Cave-Ayland do_busid_cmd(s, 0); 37374d71ea1SLaurent Vivier } 37474d71ea1SLaurent Vivier } 37574d71ea1SLaurent Vivier 37649ab747fSPaolo Bonzini static void handle_s_without_atn(ESPState *s) 37749ab747fSPaolo Bonzini { 37849691315SMark Cave-Ayland int32_t cmdlen; 37949691315SMark Cave-Ayland 38049ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 38149ab747fSPaolo Bonzini s->dma_cb = handle_s_without_atn; 38249ab747fSPaolo Bonzini return; 38349ab747fSPaolo Bonzini } 38474d71ea1SLaurent Vivier s->pdma_cb = s_without_satn_pdma_cb; 385023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 38649691315SMark Cave-Ayland if (cmdlen > 0) { 387023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 38860720694SMark Cave-Ayland s->do_cmd = 0; 389023666daSMark Cave-Ayland do_busid_cmd(s, 0); 39049691315SMark Cave-Ayland } else if (cmdlen == 0) { 391bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 39249691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 39349691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 39449691315SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_CD; 39549ab747fSPaolo Bonzini } 39649ab747fSPaolo Bonzini } 39749ab747fSPaolo Bonzini 39874d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s) 39974d71ea1SLaurent Vivier { 400e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 401023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 40274d71ea1SLaurent Vivier s->do_cmd = 1; 403023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 40474d71ea1SLaurent Vivier s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 405cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 40674d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 40774d71ea1SLaurent Vivier esp_raise_irq(s); 40874d71ea1SLaurent Vivier } 40974d71ea1SLaurent Vivier } 41074d71ea1SLaurent Vivier 41149ab747fSPaolo Bonzini static void handle_satn_stop(ESPState *s) 41249ab747fSPaolo Bonzini { 41349691315SMark Cave-Ayland int32_t cmdlen; 41449691315SMark Cave-Ayland 41549ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 41649ab747fSPaolo Bonzini s->dma_cb = handle_satn_stop; 41749ab747fSPaolo Bonzini return; 41849ab747fSPaolo Bonzini } 419c62c1fa0SPhilippe Mathieu-Daudé s->pdma_cb = satn_stop_pdma_cb; 420799d90d8SMark Cave-Ayland cmdlen = get_cmd(s, 1); 42149691315SMark Cave-Ayland if (cmdlen > 0) { 422023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 42349ab747fSPaolo Bonzini s->do_cmd = 1; 424023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 425799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_MO; 426cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 427799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 42849ab747fSPaolo Bonzini esp_raise_irq(s); 42949691315SMark Cave-Ayland } else if (cmdlen == 0) { 430bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 431799d90d8SMark Cave-Ayland /* Target present, switch to message out phase */ 432799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 433799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_MO; 43449ab747fSPaolo Bonzini } 43549ab747fSPaolo Bonzini } 43649ab747fSPaolo Bonzini 43774d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s) 43874d71ea1SLaurent Vivier { 43974d71ea1SLaurent Vivier s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 440cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 44174d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 44274d71ea1SLaurent Vivier esp_raise_irq(s); 44374d71ea1SLaurent Vivier } 44474d71ea1SLaurent Vivier 44549ab747fSPaolo Bonzini static void write_response(ESPState *s) 44649ab747fSPaolo Bonzini { 447e3922557SMark Cave-Ayland uint8_t buf[2]; 448042879fcSMark Cave-Ayland 44949ab747fSPaolo Bonzini trace_esp_write_response(s->status); 450042879fcSMark Cave-Ayland 451e3922557SMark Cave-Ayland buf[0] = s->status; 452e3922557SMark Cave-Ayland buf[1] = 0; 453042879fcSMark Cave-Ayland 45449ab747fSPaolo Bonzini if (s->dma) { 45574d71ea1SLaurent Vivier if (s->dma_memory_write) { 456e3922557SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, 2); 45749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 458cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 45949ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = SEQ_CD; 46049ab747fSPaolo Bonzini } else { 46174d71ea1SLaurent Vivier s->pdma_cb = write_response_pdma_cb; 46274d71ea1SLaurent Vivier esp_raise_drq(s); 46374d71ea1SLaurent Vivier return; 46474d71ea1SLaurent Vivier } 46574d71ea1SLaurent Vivier } else { 466e3922557SMark Cave-Ayland fifo8_reset(&s->fifo); 467e3922557SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, 2); 46849ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 2; 46949ab747fSPaolo Bonzini } 47049ab747fSPaolo Bonzini esp_raise_irq(s); 47149ab747fSPaolo Bonzini } 47249ab747fSPaolo Bonzini 47349ab747fSPaolo Bonzini static void esp_dma_done(ESPState *s) 47449ab747fSPaolo Bonzini { 47549ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_TC; 476cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 47749ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 0; 478c47b5835SMark Cave-Ayland esp_set_tc(s, 0); 47949ab747fSPaolo Bonzini esp_raise_irq(s); 48049ab747fSPaolo Bonzini } 48149ab747fSPaolo Bonzini 48274d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s) 48374d71ea1SLaurent Vivier { 4844ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 48582141c8bSMark Cave-Ayland int len; 486042879fcSMark Cave-Ayland uint32_t n; 4876cc88d6bSMark Cave-Ayland 48874d71ea1SLaurent Vivier if (s->do_cmd) { 489e62a959aSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 490e62a959aSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 491e62a959aSMark Cave-Ayland return; 492e62a959aSMark Cave-Ayland } 493e62a959aSMark Cave-Ayland 49474d71ea1SLaurent Vivier s->ti_size = 0; 495*c348458fSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 496*c348458fSMark Cave-Ayland /* No command received */ 497*c348458fSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 498*c348458fSMark Cave-Ayland return; 499*c348458fSMark Cave-Ayland } 500*c348458fSMark Cave-Ayland 501*c348458fSMark Cave-Ayland /* Command has been received */ 50274d71ea1SLaurent Vivier s->do_cmd = 0; 503c959f218SMark Cave-Ayland do_cmd(s); 504*c348458fSMark Cave-Ayland } else { 505*c348458fSMark Cave-Ayland /* 506*c348458fSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 507*c348458fSMark Cave-Ayland * and then switch to commmand phase 508*c348458fSMark Cave-Ayland */ 509*c348458fSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 510*c348458fSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 511*c348458fSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 512*c348458fSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 513*c348458fSMark Cave-Ayland esp_raise_irq(s); 514*c348458fSMark Cave-Ayland } 51574d71ea1SLaurent Vivier return; 51674d71ea1SLaurent Vivier } 51782141c8bSMark Cave-Ayland 5180db89536SMark Cave-Ayland if (!s->current_req) { 5190db89536SMark Cave-Ayland return; 5200db89536SMark Cave-Ayland } 5210db89536SMark Cave-Ayland 52282141c8bSMark Cave-Ayland if (to_device) { 52382141c8bSMark Cave-Ayland /* Copy FIFO data to device */ 5247aa6baeeSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 5257aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 5267b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5277aa6baeeSMark Cave-Ayland s->async_buf += n; 5287aa6baeeSMark Cave-Ayland s->async_len -= n; 5297aa6baeeSMark Cave-Ayland s->ti_size += n; 5307aa6baeeSMark Cave-Ayland 5317aa6baeeSMark Cave-Ayland if (n < len) { 5327aa6baeeSMark Cave-Ayland /* Unaligned accesses can cause FIFO wraparound */ 5337aa6baeeSMark Cave-Ayland len = len - n; 5347b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5357aa6baeeSMark Cave-Ayland s->async_buf += n; 5367aa6baeeSMark Cave-Ayland s->async_len -= n; 5377aa6baeeSMark Cave-Ayland s->ti_size += n; 5387aa6baeeSMark Cave-Ayland } 5397aa6baeeSMark Cave-Ayland 54074d71ea1SLaurent Vivier if (s->async_len == 0) { 54174d71ea1SLaurent Vivier scsi_req_continue(s->current_req); 54282141c8bSMark Cave-Ayland return; 54382141c8bSMark Cave-Ayland } 54482141c8bSMark Cave-Ayland 54582141c8bSMark Cave-Ayland if (esp_get_tc(s) == 0) { 54682141c8bSMark Cave-Ayland esp_lower_drq(s); 54782141c8bSMark Cave-Ayland esp_dma_done(s); 54882141c8bSMark Cave-Ayland } 54982141c8bSMark Cave-Ayland 55082141c8bSMark Cave-Ayland return; 55182141c8bSMark Cave-Ayland } else { 55282141c8bSMark Cave-Ayland if (s->async_len == 0) { 5534e78f3bfSMark Cave-Ayland /* Defer until the scsi layer has completed */ 55482141c8bSMark Cave-Ayland scsi_req_continue(s->current_req); 5554e78f3bfSMark Cave-Ayland s->data_in_ready = false; 55674d71ea1SLaurent Vivier return; 55774d71ea1SLaurent Vivier } 55874d71ea1SLaurent Vivier 55982141c8bSMark Cave-Ayland if (esp_get_tc(s) != 0) { 56082141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 5617aa6baeeSMark Cave-Ayland len = MIN(s->async_len, esp_get_tc(s)); 5627aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 563042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 56482141c8bSMark Cave-Ayland s->async_buf += len; 56582141c8bSMark Cave-Ayland s->async_len -= len; 56682141c8bSMark Cave-Ayland s->ti_size -= len; 56782141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 5687aa6baeeSMark Cave-Ayland 5697aa6baeeSMark Cave-Ayland if (esp_get_tc(s) == 0) { 5707aa6baeeSMark Cave-Ayland /* Indicate transfer to FIFO is complete */ 5717aa6baeeSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 5727aa6baeeSMark Cave-Ayland } 57382141c8bSMark Cave-Ayland return; 57482141c8bSMark Cave-Ayland } 57582141c8bSMark Cave-Ayland 57674d71ea1SLaurent Vivier /* Partially filled a scsi buffer. Complete immediately. */ 57782141c8bSMark Cave-Ayland esp_lower_drq(s); 57874d71ea1SLaurent Vivier esp_dma_done(s); 57974d71ea1SLaurent Vivier } 58082141c8bSMark Cave-Ayland } 58174d71ea1SLaurent Vivier 58249ab747fSPaolo Bonzini static void esp_do_dma(ESPState *s) 58349ab747fSPaolo Bonzini { 584023666daSMark Cave-Ayland uint32_t len, cmdlen; 5854ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 586023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 58749ab747fSPaolo Bonzini 5886cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 58949ab747fSPaolo Bonzini if (s->do_cmd) { 59015407433SLaurent Vivier /* 59115407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 59215407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 59315407433SLaurent Vivier */ 594023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 595023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 59674d71ea1SLaurent Vivier if (s->dma_memory_read) { 5970ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 598023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 599023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 60074d71ea1SLaurent Vivier } else { 60174d71ea1SLaurent Vivier s->pdma_cb = do_dma_pdma_cb; 60274d71ea1SLaurent Vivier esp_raise_drq(s); 60374d71ea1SLaurent Vivier return; 60474d71ea1SLaurent Vivier } 605023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 60615407433SLaurent Vivier s->ti_size = 0; 607799d90d8SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 608799d90d8SMark Cave-Ayland /* No command received */ 609023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 610799d90d8SMark Cave-Ayland return; 611799d90d8SMark Cave-Ayland } 612799d90d8SMark Cave-Ayland 613799d90d8SMark Cave-Ayland /* Command has been received */ 61415407433SLaurent Vivier s->do_cmd = 0; 615c959f218SMark Cave-Ayland do_cmd(s); 616799d90d8SMark Cave-Ayland } else { 617799d90d8SMark Cave-Ayland /* 618023666daSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 619799d90d8SMark Cave-Ayland * and then switch to commmand phase 620799d90d8SMark Cave-Ayland */ 621023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 622799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 623799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 624799d90d8SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 625799d90d8SMark Cave-Ayland esp_raise_irq(s); 626799d90d8SMark Cave-Ayland } 62749ab747fSPaolo Bonzini return; 62849ab747fSPaolo Bonzini } 6290db89536SMark Cave-Ayland if (!s->current_req) { 6300db89536SMark Cave-Ayland return; 6310db89536SMark Cave-Ayland } 63249ab747fSPaolo Bonzini if (s->async_len == 0) { 63349ab747fSPaolo Bonzini /* Defer until data is available. */ 63449ab747fSPaolo Bonzini return; 63549ab747fSPaolo Bonzini } 63649ab747fSPaolo Bonzini if (len > s->async_len) { 63749ab747fSPaolo Bonzini len = s->async_len; 63849ab747fSPaolo Bonzini } 63949ab747fSPaolo Bonzini if (to_device) { 64074d71ea1SLaurent Vivier if (s->dma_memory_read) { 64149ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, s->async_buf, len); 64249ab747fSPaolo Bonzini } else { 64374d71ea1SLaurent Vivier s->pdma_cb = do_dma_pdma_cb; 64474d71ea1SLaurent Vivier esp_raise_drq(s); 64574d71ea1SLaurent Vivier return; 64674d71ea1SLaurent Vivier } 64774d71ea1SLaurent Vivier } else { 64874d71ea1SLaurent Vivier if (s->dma_memory_write) { 64949ab747fSPaolo Bonzini s->dma_memory_write(s->dma_opaque, s->async_buf, len); 65074d71ea1SLaurent Vivier } else { 6517aa6baeeSMark Cave-Ayland /* Adjust TC for any leftover data in the FIFO */ 6527aa6baeeSMark Cave-Ayland if (!fifo8_is_empty(&s->fifo)) { 6537aa6baeeSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - fifo8_num_used(&s->fifo)); 6547aa6baeeSMark Cave-Ayland } 6557aa6baeeSMark Cave-Ayland 65682141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 657042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 658042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 65982141c8bSMark Cave-Ayland s->async_buf += len; 66082141c8bSMark Cave-Ayland s->async_len -= len; 66182141c8bSMark Cave-Ayland s->ti_size -= len; 6627aa6baeeSMark Cave-Ayland 6637aa6baeeSMark Cave-Ayland /* 6647aa6baeeSMark Cave-Ayland * MacOS toolbox uses a TI length of 16 bytes for all commands, so 6657aa6baeeSMark Cave-Ayland * commands shorter than this must be padded accordingly 6667aa6baeeSMark Cave-Ayland */ 6677aa6baeeSMark Cave-Ayland if (len < esp_get_tc(s) && esp_get_tc(s) <= ESP_FIFO_SZ) { 6687aa6baeeSMark Cave-Ayland while (fifo8_num_used(&s->fifo) < ESP_FIFO_SZ) { 669e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, 0); 6707aa6baeeSMark Cave-Ayland len++; 6717aa6baeeSMark Cave-Ayland } 6727aa6baeeSMark Cave-Ayland } 6737aa6baeeSMark Cave-Ayland 67482141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 67574d71ea1SLaurent Vivier s->pdma_cb = do_dma_pdma_cb; 67674d71ea1SLaurent Vivier esp_raise_drq(s); 67782141c8bSMark Cave-Ayland 67882141c8bSMark Cave-Ayland /* Indicate transfer to FIFO is complete */ 67982141c8bSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 68074d71ea1SLaurent Vivier return; 68174d71ea1SLaurent Vivier } 68249ab747fSPaolo Bonzini } 6836cc88d6bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 68449ab747fSPaolo Bonzini s->async_buf += len; 68549ab747fSPaolo Bonzini s->async_len -= len; 68694d5c79dSMark Cave-Ayland if (to_device) { 68749ab747fSPaolo Bonzini s->ti_size += len; 68894d5c79dSMark Cave-Ayland } else { 68949ab747fSPaolo Bonzini s->ti_size -= len; 69094d5c79dSMark Cave-Ayland } 69149ab747fSPaolo Bonzini if (s->async_len == 0) { 69249ab747fSPaolo Bonzini scsi_req_continue(s->current_req); 69394d5c79dSMark Cave-Ayland /* 69494d5c79dSMark Cave-Ayland * If there is still data to be read from the device then 69594d5c79dSMark Cave-Ayland * complete the DMA operation immediately. Otherwise defer 69694d5c79dSMark Cave-Ayland * until the scsi layer has completed. 69794d5c79dSMark Cave-Ayland */ 6986cc88d6bSMark Cave-Ayland if (to_device || esp_get_tc(s) != 0 || s->ti_size == 0) { 69949ab747fSPaolo Bonzini return; 70049ab747fSPaolo Bonzini } 70149ab747fSPaolo Bonzini } 70249ab747fSPaolo Bonzini 70349ab747fSPaolo Bonzini /* Partially filled a scsi buffer. Complete immediately. */ 70449ab747fSPaolo Bonzini esp_dma_done(s); 70582141c8bSMark Cave-Ayland esp_lower_drq(s); 70649ab747fSPaolo Bonzini } 70749ab747fSPaolo Bonzini 7081b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7091b9e48a5SMark Cave-Ayland { 7101b9e48a5SMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 7117b320a8eSMark Cave-Ayland uint32_t cmdlen; 7121b9e48a5SMark Cave-Ayland int len; 7131b9e48a5SMark Cave-Ayland 7141b9e48a5SMark Cave-Ayland if (s->do_cmd) { 7151b9e48a5SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 7161b9e48a5SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 7171b9e48a5SMark Cave-Ayland s->ti_size = 0; 7181b9e48a5SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 7191b9e48a5SMark Cave-Ayland /* No command received */ 7201b9e48a5SMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 7211b9e48a5SMark Cave-Ayland return; 7221b9e48a5SMark Cave-Ayland } 7231b9e48a5SMark Cave-Ayland 7241b9e48a5SMark Cave-Ayland /* Command has been received */ 7251b9e48a5SMark Cave-Ayland s->do_cmd = 0; 7261b9e48a5SMark Cave-Ayland do_cmd(s); 7271b9e48a5SMark Cave-Ayland } else { 7281b9e48a5SMark Cave-Ayland /* 7291b9e48a5SMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 7301b9e48a5SMark Cave-Ayland * and then switch to commmand phase 7311b9e48a5SMark Cave-Ayland */ 7321b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 7331b9e48a5SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 7341b9e48a5SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 7351b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 7361b9e48a5SMark Cave-Ayland esp_raise_irq(s); 7371b9e48a5SMark Cave-Ayland } 7381b9e48a5SMark Cave-Ayland return; 7391b9e48a5SMark Cave-Ayland } 7401b9e48a5SMark Cave-Ayland 7410db89536SMark Cave-Ayland if (!s->current_req) { 7420db89536SMark Cave-Ayland return; 7430db89536SMark Cave-Ayland } 7440db89536SMark Cave-Ayland 7451b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 7461b9e48a5SMark Cave-Ayland /* Defer until data is available. */ 7471b9e48a5SMark Cave-Ayland return; 7481b9e48a5SMark Cave-Ayland } 7491b9e48a5SMark Cave-Ayland 7501b9e48a5SMark Cave-Ayland if (to_device) { 7511b9e48a5SMark Cave-Ayland len = MIN(fifo8_num_used(&s->fifo), ESP_FIFO_SZ); 7527b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 7531b9e48a5SMark Cave-Ayland s->async_buf += len; 7541b9e48a5SMark Cave-Ayland s->async_len -= len; 7551b9e48a5SMark Cave-Ayland s->ti_size += len; 7561b9e48a5SMark Cave-Ayland } else { 7576ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 7586ef2cabcSMark Cave-Ayland fifo8_push(&s->fifo, s->async_buf[0]); 7596ef2cabcSMark Cave-Ayland s->async_buf++; 7606ef2cabcSMark Cave-Ayland s->async_len--; 7616ef2cabcSMark Cave-Ayland s->ti_size--; 7626ef2cabcSMark Cave-Ayland } 7631b9e48a5SMark Cave-Ayland } 7641b9e48a5SMark Cave-Ayland 7651b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 7661b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 7671b9e48a5SMark Cave-Ayland return; 7681b9e48a5SMark Cave-Ayland } 7691b9e48a5SMark Cave-Ayland 7701b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 7711b9e48a5SMark Cave-Ayland esp_raise_irq(s); 7721b9e48a5SMark Cave-Ayland } 7731b9e48a5SMark Cave-Ayland 7744aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 77549ab747fSPaolo Bonzini { 7764aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 7776ef2cabcSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 7784aaa6ac3SMark Cave-Ayland 77949ab747fSPaolo Bonzini trace_esp_command_complete(); 7806ef2cabcSMark Cave-Ayland 7816ef2cabcSMark Cave-Ayland /* 7826ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 7836ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 7846ef2cabcSMark Cave-Ayland */ 7856ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 78649ab747fSPaolo Bonzini if (s->ti_size != 0) { 78749ab747fSPaolo Bonzini trace_esp_command_complete_unexpected(); 78849ab747fSPaolo Bonzini } 78949ab747fSPaolo Bonzini s->ti_size = 0; 7906ef2cabcSMark Cave-Ayland } 7916ef2cabcSMark Cave-Ayland 79249ab747fSPaolo Bonzini s->async_len = 0; 7934aaa6ac3SMark Cave-Ayland if (req->status) { 79449ab747fSPaolo Bonzini trace_esp_command_complete_fail(); 79549ab747fSPaolo Bonzini } 7964aaa6ac3SMark Cave-Ayland s->status = req->status; 7976ef2cabcSMark Cave-Ayland 7986ef2cabcSMark Cave-Ayland /* 7996ef2cabcSMark Cave-Ayland * If the transfer is finished, switch to status phase. For non-DMA 8006ef2cabcSMark Cave-Ayland * transfers from the target the last byte is still in the FIFO 8016ef2cabcSMark Cave-Ayland */ 8026ef2cabcSMark Cave-Ayland if (s->ti_size == 0) { 8036ef2cabcSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 80449ab747fSPaolo Bonzini esp_dma_done(s); 80582141c8bSMark Cave-Ayland esp_lower_drq(s); 8066ef2cabcSMark Cave-Ayland } 8076ef2cabcSMark Cave-Ayland 80849ab747fSPaolo Bonzini if (s->current_req) { 80949ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 81049ab747fSPaolo Bonzini s->current_req = NULL; 81149ab747fSPaolo Bonzini s->current_dev = NULL; 81249ab747fSPaolo Bonzini } 81349ab747fSPaolo Bonzini } 81449ab747fSPaolo Bonzini 81549ab747fSPaolo Bonzini void esp_transfer_data(SCSIRequest *req, uint32_t len) 81649ab747fSPaolo Bonzini { 81749ab747fSPaolo Bonzini ESPState *s = req->hba_private; 8184e78f3bfSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8196cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 82049ab747fSPaolo Bonzini 8217f0b6e11SPaolo Bonzini assert(!s->do_cmd); 8226cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 82349ab747fSPaolo Bonzini s->async_len = len; 82449ab747fSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 8254e78f3bfSMark Cave-Ayland 8264e78f3bfSMark Cave-Ayland if (!to_device && !s->data_in_ready) { 8274e78f3bfSMark Cave-Ayland /* 8284e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 8294e78f3bfSMark Cave-Ayland * completion interrupt 8304e78f3bfSMark Cave-Ayland */ 8314e78f3bfSMark Cave-Ayland s->data_in_ready = true; 8324e78f3bfSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 8334e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8344e78f3bfSMark Cave-Ayland esp_raise_irq(s); 8354e78f3bfSMark Cave-Ayland } 8364e78f3bfSMark Cave-Ayland 8371b9e48a5SMark Cave-Ayland if (s->ti_cmd == 0) { 8381b9e48a5SMark Cave-Ayland /* 8391b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 8401b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 8411b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 8421b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 8431b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 8441b9e48a5SMark Cave-Ayland */ 8451b9e48a5SMark Cave-Ayland return; 8461b9e48a5SMark Cave-Ayland } 8471b9e48a5SMark Cave-Ayland 848880d3089SMark Cave-Ayland if (s->ti_cmd == (CMD_TI | CMD_DMA)) { 8496cc88d6bSMark Cave-Ayland if (dmalen) { 85049ab747fSPaolo Bonzini esp_do_dma(s); 8515eb7a23fSMark Cave-Ayland } else if (s->ti_size <= 0) { 85294d5c79dSMark Cave-Ayland /* 85394d5c79dSMark Cave-Ayland * If this was the last part of a DMA transfer then the 85494d5c79dSMark Cave-Ayland * completion interrupt is deferred to here. 85594d5c79dSMark Cave-Ayland */ 85649ab747fSPaolo Bonzini esp_dma_done(s); 85782141c8bSMark Cave-Ayland esp_lower_drq(s); 85849ab747fSPaolo Bonzini } 859880d3089SMark Cave-Ayland } else if (s->ti_cmd == CMD_TI) { 8601b9e48a5SMark Cave-Ayland esp_do_nodma(s); 8611b9e48a5SMark Cave-Ayland } 86249ab747fSPaolo Bonzini } 86349ab747fSPaolo Bonzini 86449ab747fSPaolo Bonzini static void handle_ti(ESPState *s) 86549ab747fSPaolo Bonzini { 8661b9e48a5SMark Cave-Ayland uint32_t dmalen; 86749ab747fSPaolo Bonzini 86849ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 86949ab747fSPaolo Bonzini s->dma_cb = handle_ti; 87049ab747fSPaolo Bonzini return; 87149ab747fSPaolo Bonzini } 87249ab747fSPaolo Bonzini 8731b9e48a5SMark Cave-Ayland s->ti_cmd = s->rregs[ESP_CMD]; 87449ab747fSPaolo Bonzini if (s->dma) { 8751b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 876b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 87749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 87849ab747fSPaolo Bonzini esp_do_dma(s); 879799d90d8SMark Cave-Ayland } else { 8801b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 8811b9e48a5SMark Cave-Ayland esp_do_nodma(s); 88249ab747fSPaolo Bonzini } 88349ab747fSPaolo Bonzini } 88449ab747fSPaolo Bonzini 88549ab747fSPaolo Bonzini void esp_hard_reset(ESPState *s) 88649ab747fSPaolo Bonzini { 88749ab747fSPaolo Bonzini memset(s->rregs, 0, ESP_REGS); 88849ab747fSPaolo Bonzini memset(s->wregs, 0, ESP_REGS); 889c9cf45c1SHannes Reinecke s->tchi_written = 0; 89049ab747fSPaolo Bonzini s->ti_size = 0; 891042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 892023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 89349ab747fSPaolo Bonzini s->dma = 0; 89449ab747fSPaolo Bonzini s->do_cmd = 0; 89549ab747fSPaolo Bonzini s->dma_cb = NULL; 89649ab747fSPaolo Bonzini 89749ab747fSPaolo Bonzini s->rregs[ESP_CFG1] = 7; 89849ab747fSPaolo Bonzini } 89949ab747fSPaolo Bonzini 90049ab747fSPaolo Bonzini static void esp_soft_reset(ESPState *s) 90149ab747fSPaolo Bonzini { 90249ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 90374d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 90449ab747fSPaolo Bonzini esp_hard_reset(s); 90549ab747fSPaolo Bonzini } 90649ab747fSPaolo Bonzini 90749ab747fSPaolo Bonzini static void parent_esp_reset(ESPState *s, int irq, int level) 90849ab747fSPaolo Bonzini { 90949ab747fSPaolo Bonzini if (level) { 91049ab747fSPaolo Bonzini esp_soft_reset(s); 91149ab747fSPaolo Bonzini } 91249ab747fSPaolo Bonzini } 91349ab747fSPaolo Bonzini 91449ab747fSPaolo Bonzini uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 91549ab747fSPaolo Bonzini { 916b630c075SMark Cave-Ayland uint32_t val; 91749ab747fSPaolo Bonzini 91849ab747fSPaolo Bonzini switch (saddr) { 91949ab747fSPaolo Bonzini case ESP_FIFO: 9201b9e48a5SMark Cave-Ayland if (s->dma_memory_read && s->dma_memory_write && 9211b9e48a5SMark Cave-Ayland (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 92249ab747fSPaolo Bonzini /* Data out. */ 923ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 92449ab747fSPaolo Bonzini s->rregs[ESP_FIFO] = 0; 925042879fcSMark Cave-Ayland } else { 9266ef2cabcSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) { 9276ef2cabcSMark Cave-Ayland if (s->ti_size) { 9286ef2cabcSMark Cave-Ayland esp_do_nodma(s); 9296ef2cabcSMark Cave-Ayland } else { 9306ef2cabcSMark Cave-Ayland /* 9316ef2cabcSMark Cave-Ayland * The last byte of a non-DMA transfer has been read out 9326ef2cabcSMark Cave-Ayland * of the FIFO so switch to status phase 9336ef2cabcSMark Cave-Ayland */ 9346ef2cabcSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 9356ef2cabcSMark Cave-Ayland } 9366ef2cabcSMark Cave-Ayland } 937c5fef911SMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo); 93849ab747fSPaolo Bonzini } 939b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 94049ab747fSPaolo Bonzini break; 94149ab747fSPaolo Bonzini case ESP_RINTR: 94294d5c79dSMark Cave-Ayland /* 94394d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 94494d5c79dSMark Cave-Ayland * except TC 94594d5c79dSMark Cave-Ayland */ 946b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 94749ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 94849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 949af947a3dSMark Cave-Ayland /* 950af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 951af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 952af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 953af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 954af947a3dSMark Cave-Ayland * transition. 955af947a3dSMark Cave-Ayland * 956af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 957af947a3dSMark Cave-Ayland */ 95849ab747fSPaolo Bonzini esp_lower_irq(s); 959b630c075SMark Cave-Ayland break; 960c9cf45c1SHannes Reinecke case ESP_TCHI: 961c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 962c9cf45c1SHannes Reinecke if (!s->tchi_written) { 963b630c075SMark Cave-Ayland val = s->chip_id; 964b630c075SMark Cave-Ayland } else { 965b630c075SMark Cave-Ayland val = s->rregs[saddr]; 966c9cf45c1SHannes Reinecke } 967b630c075SMark Cave-Ayland break; 968238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 969238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 970238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 971238ec4d7SMark Cave-Ayland break; 97249ab747fSPaolo Bonzini default: 973b630c075SMark Cave-Ayland val = s->rregs[saddr]; 97449ab747fSPaolo Bonzini break; 97549ab747fSPaolo Bonzini } 976b630c075SMark Cave-Ayland 977b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 978b630c075SMark Cave-Ayland return val; 97949ab747fSPaolo Bonzini } 98049ab747fSPaolo Bonzini 98149ab747fSPaolo Bonzini void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 98249ab747fSPaolo Bonzini { 98349ab747fSPaolo Bonzini trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 98449ab747fSPaolo Bonzini switch (saddr) { 985c9cf45c1SHannes Reinecke case ESP_TCHI: 986c9cf45c1SHannes Reinecke s->tchi_written = true; 987c9cf45c1SHannes Reinecke /* fall through */ 98849ab747fSPaolo Bonzini case ESP_TCLO: 98949ab747fSPaolo Bonzini case ESP_TCMID: 99049ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 99149ab747fSPaolo Bonzini break; 99249ab747fSPaolo Bonzini case ESP_FIFO: 99349ab747fSPaolo Bonzini if (s->do_cmd) { 994e5455b8cSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, val); 9956ef2cabcSMark Cave-Ayland 9966ef2cabcSMark Cave-Ayland /* 9976ef2cabcSMark Cave-Ayland * If any unexpected message out/command phase data is 9986ef2cabcSMark Cave-Ayland * transferred using non-DMA, raise the interrupt 9996ef2cabcSMark Cave-Ayland */ 10006ef2cabcSMark Cave-Ayland if (s->rregs[ESP_CMD] == CMD_TI) { 10016ef2cabcSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 10026ef2cabcSMark Cave-Ayland esp_raise_irq(s); 10036ef2cabcSMark Cave-Ayland } 100449ab747fSPaolo Bonzini } else { 1005e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 100649ab747fSPaolo Bonzini } 100749ab747fSPaolo Bonzini break; 100849ab747fSPaolo Bonzini case ESP_CMD: 100949ab747fSPaolo Bonzini s->rregs[saddr] = val; 101049ab747fSPaolo Bonzini if (val & CMD_DMA) { 101149ab747fSPaolo Bonzini s->dma = 1; 101249ab747fSPaolo Bonzini /* Reload DMA counter. */ 101396676c2fSMark Cave-Ayland if (esp_get_stc(s) == 0) { 101496676c2fSMark Cave-Ayland esp_set_tc(s, 0x10000); 101596676c2fSMark Cave-Ayland } else { 1016c04ed569SMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 101796676c2fSMark Cave-Ayland } 101849ab747fSPaolo Bonzini } else { 101949ab747fSPaolo Bonzini s->dma = 0; 102049ab747fSPaolo Bonzini } 102149ab747fSPaolo Bonzini switch (val & CMD_CMD) { 102249ab747fSPaolo Bonzini case CMD_NOP: 102349ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_nop(val); 102449ab747fSPaolo Bonzini break; 102549ab747fSPaolo Bonzini case CMD_FLUSH: 102649ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_flush(val); 1027042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 102849ab747fSPaolo Bonzini break; 102949ab747fSPaolo Bonzini case CMD_RESET: 103049ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_reset(val); 103149ab747fSPaolo Bonzini esp_soft_reset(s); 103249ab747fSPaolo Bonzini break; 103349ab747fSPaolo Bonzini case CMD_BUSRESET: 103449ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_bus_reset(val); 103549ab747fSPaolo Bonzini if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1036cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 103749ab747fSPaolo Bonzini esp_raise_irq(s); 103849ab747fSPaolo Bonzini } 103949ab747fSPaolo Bonzini break; 104049ab747fSPaolo Bonzini case CMD_TI: 10410097d3ecSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(val); 104249ab747fSPaolo Bonzini handle_ti(s); 104349ab747fSPaolo Bonzini break; 104449ab747fSPaolo Bonzini case CMD_ICCS: 104549ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_iccs(val); 104649ab747fSPaolo Bonzini write_response(s); 1047cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 104849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_MI; 104949ab747fSPaolo Bonzini break; 105049ab747fSPaolo Bonzini case CMD_MSGACC: 105149ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_msgacc(val); 1052cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 105349ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = 0; 105449ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 0; 105549ab747fSPaolo Bonzini esp_raise_irq(s); 105649ab747fSPaolo Bonzini break; 105749ab747fSPaolo Bonzini case CMD_PAD: 105849ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_pad(val); 105949ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC; 1060cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 106149ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = 0; 106249ab747fSPaolo Bonzini break; 106349ab747fSPaolo Bonzini case CMD_SATN: 106449ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_satn(val); 106549ab747fSPaolo Bonzini break; 106649ab747fSPaolo Bonzini case CMD_RSTATN: 106749ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_rstatn(val); 106849ab747fSPaolo Bonzini break; 106949ab747fSPaolo Bonzini case CMD_SEL: 107049ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_sel(val); 107149ab747fSPaolo Bonzini handle_s_without_atn(s); 107249ab747fSPaolo Bonzini break; 107349ab747fSPaolo Bonzini case CMD_SELATN: 107449ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_selatn(val); 107549ab747fSPaolo Bonzini handle_satn(s); 107649ab747fSPaolo Bonzini break; 107749ab747fSPaolo Bonzini case CMD_SELATNS: 107849ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_selatns(val); 107949ab747fSPaolo Bonzini handle_satn_stop(s); 108049ab747fSPaolo Bonzini break; 108149ab747fSPaolo Bonzini case CMD_ENSEL: 108249ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_ensel(val); 108349ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 108449ab747fSPaolo Bonzini break; 108549ab747fSPaolo Bonzini case CMD_DISSEL: 108649ab747fSPaolo Bonzini trace_esp_mem_writeb_cmd_dissel(val); 108749ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 108849ab747fSPaolo Bonzini esp_raise_irq(s); 108949ab747fSPaolo Bonzini break; 109049ab747fSPaolo Bonzini default: 109149ab747fSPaolo Bonzini trace_esp_error_unhandled_command(val); 109249ab747fSPaolo Bonzini break; 109349ab747fSPaolo Bonzini } 109449ab747fSPaolo Bonzini break; 109549ab747fSPaolo Bonzini case ESP_WBUSID ... ESP_WSYNO: 109649ab747fSPaolo Bonzini break; 109749ab747fSPaolo Bonzini case ESP_CFG1: 109849ab747fSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 109949ab747fSPaolo Bonzini case ESP_RES3: case ESP_RES4: 110049ab747fSPaolo Bonzini s->rregs[saddr] = val; 110149ab747fSPaolo Bonzini break; 110249ab747fSPaolo Bonzini case ESP_WCCF ... ESP_WTEST: 110349ab747fSPaolo Bonzini break; 110449ab747fSPaolo Bonzini default: 110549ab747fSPaolo Bonzini trace_esp_error_invalid_write(val, saddr); 110649ab747fSPaolo Bonzini return; 110749ab747fSPaolo Bonzini } 110849ab747fSPaolo Bonzini s->wregs[saddr] = val; 110949ab747fSPaolo Bonzini } 111049ab747fSPaolo Bonzini 111149ab747fSPaolo Bonzini static bool esp_mem_accepts(void *opaque, hwaddr addr, 11128372d383SPeter Maydell unsigned size, bool is_write, 11138372d383SPeter Maydell MemTxAttrs attrs) 111449ab747fSPaolo Bonzini { 111549ab747fSPaolo Bonzini return (size == 1) || (is_write && size == 4); 111649ab747fSPaolo Bonzini } 111749ab747fSPaolo Bonzini 11186cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 11196cc88d6bSMark Cave-Ayland { 11206cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 11216cc88d6bSMark Cave-Ayland 11226cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11236cc88d6bSMark Cave-Ayland return version_id < 5; 11246cc88d6bSMark Cave-Ayland } 11256cc88d6bSMark Cave-Ayland 11264e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 11274e78f3bfSMark Cave-Ayland { 11284e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 11294e78f3bfSMark Cave-Ayland 11304e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11314e78f3bfSMark Cave-Ayland return version_id == 5; 11324e78f3bfSMark Cave-Ayland } 11334e78f3bfSMark Cave-Ayland 1134ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 11350bd005beSMark Cave-Ayland { 1136ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1137ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 11380bd005beSMark Cave-Ayland 11390bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 11400bd005beSMark Cave-Ayland return 0; 11410bd005beSMark Cave-Ayland } 11420bd005beSMark Cave-Ayland 11430bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 11440bd005beSMark Cave-Ayland { 11450bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1146042879fcSMark Cave-Ayland int len, i; 11470bd005beSMark Cave-Ayland 11486cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11496cc88d6bSMark Cave-Ayland 11506cc88d6bSMark Cave-Ayland if (version_id < 5) { 11516cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1152042879fcSMark Cave-Ayland 1153042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1154042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1155042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1156042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1157042879fcSMark Cave-Ayland } 1158023666daSMark Cave-Ayland 1159023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1160023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1161023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1162023666daSMark Cave-Ayland } 11636cc88d6bSMark Cave-Ayland } 11646cc88d6bSMark Cave-Ayland 11650bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 11660bd005beSMark Cave-Ayland return 0; 11670bd005beSMark Cave-Ayland } 11680bd005beSMark Cave-Ayland 116949ab747fSPaolo Bonzini const VMStateDescription vmstate_esp = { 117049ab747fSPaolo Bonzini .name = "esp", 11710bd005beSMark Cave-Ayland .version_id = 5, 117249ab747fSPaolo Bonzini .minimum_version_id = 3, 11730bd005beSMark Cave-Ayland .post_load = esp_post_load, 117449ab747fSPaolo Bonzini .fields = (VMStateField[]) { 117549ab747fSPaolo Bonzini VMSTATE_BUFFER(rregs, ESPState), 117649ab747fSPaolo Bonzini VMSTATE_BUFFER(wregs, ESPState), 117749ab747fSPaolo Bonzini VMSTATE_INT32(ti_size, ESPState), 1178042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1179042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1180042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 118149ab747fSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 11824aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 11834aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 11844aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 11854aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 118649ab747fSPaolo Bonzini VMSTATE_UINT32(dma, ESPState), 1187023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1188023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1189023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1190023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1191023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1192023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 119349ab747fSPaolo Bonzini VMSTATE_UINT32(do_cmd, ESPState), 11946cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 11954e78f3bfSMark Cave-Ayland VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5), 1196023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1197042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1198023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 11991b9e48a5SMark Cave-Ayland VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5), 120049ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 120174d71ea1SLaurent Vivier }, 120249ab747fSPaolo Bonzini }; 120349ab747fSPaolo Bonzini 120449ab747fSPaolo Bonzini static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 120549ab747fSPaolo Bonzini uint64_t val, unsigned int size) 120649ab747fSPaolo Bonzini { 120749ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1208eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 120949ab747fSPaolo Bonzini uint32_t saddr; 121049ab747fSPaolo Bonzini 121149ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1212eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 121349ab747fSPaolo Bonzini } 121449ab747fSPaolo Bonzini 121549ab747fSPaolo Bonzini static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 121649ab747fSPaolo Bonzini unsigned int size) 121749ab747fSPaolo Bonzini { 121849ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1219eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 122049ab747fSPaolo Bonzini uint32_t saddr; 122149ab747fSPaolo Bonzini 122249ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1223eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 122449ab747fSPaolo Bonzini } 122549ab747fSPaolo Bonzini 122649ab747fSPaolo Bonzini static const MemoryRegionOps sysbus_esp_mem_ops = { 122749ab747fSPaolo Bonzini .read = sysbus_esp_mem_read, 122849ab747fSPaolo Bonzini .write = sysbus_esp_mem_write, 122949ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 123049ab747fSPaolo Bonzini .valid.accepts = esp_mem_accepts, 123149ab747fSPaolo Bonzini }; 123249ab747fSPaolo Bonzini 123374d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 123474d71ea1SLaurent Vivier uint64_t val, unsigned int size) 123574d71ea1SLaurent Vivier { 123674d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1237eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 123874d71ea1SLaurent Vivier 1239960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1240960ebfd9SMark Cave-Ayland 124174d71ea1SLaurent Vivier switch (size) { 124274d71ea1SLaurent Vivier case 1: 1243761bef75SMark Cave-Ayland esp_pdma_write(s, val); 124474d71ea1SLaurent Vivier break; 124574d71ea1SLaurent Vivier case 2: 1246761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1247761bef75SMark Cave-Ayland esp_pdma_write(s, val); 124874d71ea1SLaurent Vivier break; 124974d71ea1SLaurent Vivier } 125074d71ea1SLaurent Vivier s->pdma_cb(s); 125174d71ea1SLaurent Vivier } 125274d71ea1SLaurent Vivier 125374d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 125474d71ea1SLaurent Vivier unsigned int size) 125574d71ea1SLaurent Vivier { 125674d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1257eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 125874d71ea1SLaurent Vivier uint64_t val = 0; 125974d71ea1SLaurent Vivier 1260960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1261960ebfd9SMark Cave-Ayland 126274d71ea1SLaurent Vivier switch (size) { 126374d71ea1SLaurent Vivier case 1: 1264761bef75SMark Cave-Ayland val = esp_pdma_read(s); 126574d71ea1SLaurent Vivier break; 126674d71ea1SLaurent Vivier case 2: 1267761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1268761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 126974d71ea1SLaurent Vivier break; 127074d71ea1SLaurent Vivier } 12717aa6baeeSMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 127274d71ea1SLaurent Vivier s->pdma_cb(s); 127374d71ea1SLaurent Vivier } 127474d71ea1SLaurent Vivier return val; 127574d71ea1SLaurent Vivier } 127674d71ea1SLaurent Vivier 127774d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 127874d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 127974d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 128074d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 128174d71ea1SLaurent Vivier .valid.min_access_size = 1, 1282cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1283cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1284cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 128574d71ea1SLaurent Vivier }; 128674d71ea1SLaurent Vivier 128749ab747fSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 128849ab747fSPaolo Bonzini .tcq = false, 128949ab747fSPaolo Bonzini .max_target = ESP_MAX_DEVS, 129049ab747fSPaolo Bonzini .max_lun = 7, 129149ab747fSPaolo Bonzini 129249ab747fSPaolo Bonzini .transfer_data = esp_transfer_data, 129349ab747fSPaolo Bonzini .complete = esp_command_complete, 129449ab747fSPaolo Bonzini .cancel = esp_request_cancelled 129549ab747fSPaolo Bonzini }; 129649ab747fSPaolo Bonzini 129749ab747fSPaolo Bonzini static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 129849ab747fSPaolo Bonzini { 129984fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1300eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 130149ab747fSPaolo Bonzini 130249ab747fSPaolo Bonzini switch (irq) { 130349ab747fSPaolo Bonzini case 0: 130449ab747fSPaolo Bonzini parent_esp_reset(s, irq, level); 130549ab747fSPaolo Bonzini break; 130649ab747fSPaolo Bonzini case 1: 130749ab747fSPaolo Bonzini esp_dma_enable(opaque, irq, level); 130849ab747fSPaolo Bonzini break; 130949ab747fSPaolo Bonzini } 131049ab747fSPaolo Bonzini } 131149ab747fSPaolo Bonzini 1312b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 131349ab747fSPaolo Bonzini { 1314b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 131584fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1316eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1317eb169c76SMark Cave-Ayland 1318eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1319eb169c76SMark Cave-Ayland return; 1320eb169c76SMark Cave-Ayland } 132149ab747fSPaolo Bonzini 1322b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 132374d71ea1SLaurent Vivier sysbus_init_irq(sbd, &s->irq_data); 132449ab747fSPaolo Bonzini assert(sysbus->it_shift != -1); 132549ab747fSPaolo Bonzini 132649ab747fSPaolo Bonzini s->chip_id = TCHI_FAS100A; 132729776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 132874d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1329b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 133074d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1331cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 133274d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 133349ab747fSPaolo Bonzini 1334b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 133549ab747fSPaolo Bonzini 1336b1187b51SAndreas Färber scsi_bus_new(&s->bus, sizeof(s->bus), dev, &esp_scsi_info, NULL); 133749ab747fSPaolo Bonzini } 133849ab747fSPaolo Bonzini 133949ab747fSPaolo Bonzini static void sysbus_esp_hard_reset(DeviceState *dev) 134049ab747fSPaolo Bonzini { 134184fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1342eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1343eb169c76SMark Cave-Ayland 1344eb169c76SMark Cave-Ayland esp_hard_reset(s); 1345eb169c76SMark Cave-Ayland } 1346eb169c76SMark Cave-Ayland 1347eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1348eb169c76SMark Cave-Ayland { 1349eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1350eb169c76SMark Cave-Ayland 1351eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 135249ab747fSPaolo Bonzini } 135349ab747fSPaolo Bonzini 135449ab747fSPaolo Bonzini static const VMStateDescription vmstate_sysbus_esp_scsi = { 135549ab747fSPaolo Bonzini .name = "sysbusespscsi", 13560bd005beSMark Cave-Ayland .version_id = 2, 1357ea84a442SGuenter Roeck .minimum_version_id = 1, 1358ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 135949ab747fSPaolo Bonzini .fields = (VMStateField[]) { 13600bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 136149ab747fSPaolo Bonzini VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 136249ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 136349ab747fSPaolo Bonzini } 136449ab747fSPaolo Bonzini }; 136549ab747fSPaolo Bonzini 136649ab747fSPaolo Bonzini static void sysbus_esp_class_init(ObjectClass *klass, void *data) 136749ab747fSPaolo Bonzini { 136849ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 136949ab747fSPaolo Bonzini 1370b09318caSHu Tao dc->realize = sysbus_esp_realize; 137149ab747fSPaolo Bonzini dc->reset = sysbus_esp_hard_reset; 137249ab747fSPaolo Bonzini dc->vmsd = &vmstate_sysbus_esp_scsi; 1373125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 137449ab747fSPaolo Bonzini } 137549ab747fSPaolo Bonzini 137649ab747fSPaolo Bonzini static const TypeInfo sysbus_esp_info = { 137784fbefedSMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 137849ab747fSPaolo Bonzini .parent = TYPE_SYS_BUS_DEVICE, 1379eb169c76SMark Cave-Ayland .instance_init = sysbus_esp_init, 138049ab747fSPaolo Bonzini .instance_size = sizeof(SysBusESPState), 138149ab747fSPaolo Bonzini .class_init = sysbus_esp_class_init, 138249ab747fSPaolo Bonzini }; 138349ab747fSPaolo Bonzini 1384042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1385042879fcSMark Cave-Ayland { 1386042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1387042879fcSMark Cave-Ayland 1388042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1389023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1390042879fcSMark Cave-Ayland } 1391042879fcSMark Cave-Ayland 1392042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1393042879fcSMark Cave-Ayland { 1394042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1395042879fcSMark Cave-Ayland 1396042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1397023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1398042879fcSMark Cave-Ayland } 1399042879fcSMark Cave-Ayland 1400eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1401eb169c76SMark Cave-Ayland { 1402eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1403eb169c76SMark Cave-Ayland 1404eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1405eb169c76SMark Cave-Ayland dc->user_creatable = false; 1406eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1407eb169c76SMark Cave-Ayland } 1408eb169c76SMark Cave-Ayland 1409eb169c76SMark Cave-Ayland static const TypeInfo esp_info = { 1410eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1411eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1412042879fcSMark Cave-Ayland .instance_init = esp_init, 1413042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1414eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1415eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1416eb169c76SMark Cave-Ayland }; 1417eb169c76SMark Cave-Ayland 141849ab747fSPaolo Bonzini static void esp_register_types(void) 141949ab747fSPaolo Bonzini { 142049ab747fSPaolo Bonzini type_register_static(&sysbus_esp_info); 1421eb169c76SMark Cave-Ayland type_register_static(&esp_info); 142249ab747fSPaolo Bonzini } 142349ab747fSPaolo Bonzini 142449ab747fSPaolo Bonzini type_init(esp_register_types) 1425