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; 12449c60d16SMark Cave-Ayland uint32_t n, n2; 12549c60d16SMark Cave-Ayland int len; 1267b320a8eSMark Cave-Ayland 1277b320a8eSMark Cave-Ayland if (maxlen == 0) { 1287b320a8eSMark Cave-Ayland return 0; 1297b320a8eSMark Cave-Ayland } 1307b320a8eSMark Cave-Ayland 13149c60d16SMark Cave-Ayland len = maxlen; 13249c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n); 1337b320a8eSMark Cave-Ayland if (dest) { 1347b320a8eSMark Cave-Ayland memcpy(dest, buf, n); 1357b320a8eSMark Cave-Ayland } 1367b320a8eSMark Cave-Ayland 13749c60d16SMark Cave-Ayland /* Add FIFO wraparound if needed */ 13849c60d16SMark Cave-Ayland len -= n; 13949c60d16SMark Cave-Ayland len = MIN(len, fifo8_num_used(fifo)); 14049c60d16SMark Cave-Ayland if (len) { 14149c60d16SMark Cave-Ayland buf = fifo8_pop_buf(fifo, len, &n2); 14249c60d16SMark Cave-Ayland if (dest) { 14349c60d16SMark Cave-Ayland memcpy(&dest[n], buf, n2); 14449c60d16SMark Cave-Ayland } 14549c60d16SMark Cave-Ayland n += n2; 14649c60d16SMark Cave-Ayland } 14749c60d16SMark Cave-Ayland 1487b320a8eSMark Cave-Ayland return n; 1497b320a8eSMark Cave-Ayland } 1507b320a8eSMark Cave-Ayland 151c47b5835SMark Cave-Ayland static uint32_t esp_get_tc(ESPState *s) 152c47b5835SMark Cave-Ayland { 153c47b5835SMark Cave-Ayland uint32_t dmalen; 154c47b5835SMark Cave-Ayland 155c47b5835SMark Cave-Ayland dmalen = s->rregs[ESP_TCLO]; 156c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCMID] << 8; 157c47b5835SMark Cave-Ayland dmalen |= s->rregs[ESP_TCHI] << 16; 158c47b5835SMark Cave-Ayland 159c47b5835SMark Cave-Ayland return dmalen; 160c47b5835SMark Cave-Ayland } 161c47b5835SMark Cave-Ayland 162c47b5835SMark Cave-Ayland static void esp_set_tc(ESPState *s, uint32_t dmalen) 163c47b5835SMark Cave-Ayland { 164c5d7df28SMark Cave-Ayland uint32_t old_tc = esp_get_tc(s); 165c5d7df28SMark Cave-Ayland 166c47b5835SMark Cave-Ayland s->rregs[ESP_TCLO] = dmalen; 167c47b5835SMark Cave-Ayland s->rregs[ESP_TCMID] = dmalen >> 8; 168c47b5835SMark Cave-Ayland s->rregs[ESP_TCHI] = dmalen >> 16; 169c5d7df28SMark Cave-Ayland 170c5d7df28SMark Cave-Ayland if (old_tc && dmalen == 0) { 171c5d7df28SMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 172c5d7df28SMark Cave-Ayland } 173c47b5835SMark Cave-Ayland } 174c47b5835SMark Cave-Ayland 175c04ed569SMark Cave-Ayland static uint32_t esp_get_stc(ESPState *s) 176c04ed569SMark Cave-Ayland { 177c04ed569SMark Cave-Ayland uint32_t dmalen; 178c04ed569SMark Cave-Ayland 179c04ed569SMark Cave-Ayland dmalen = s->wregs[ESP_TCLO]; 180c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCMID] << 8; 181c04ed569SMark Cave-Ayland dmalen |= s->wregs[ESP_TCHI] << 16; 182c04ed569SMark Cave-Ayland 183c04ed569SMark Cave-Ayland return dmalen; 184c04ed569SMark Cave-Ayland } 185c04ed569SMark Cave-Ayland 186*abc139cdSMark Cave-Ayland static const char *esp_phase_names[8] = { 187*abc139cdSMark Cave-Ayland "DATA OUT", "DATA IN", "COMMAND", "STATUS", 188*abc139cdSMark Cave-Ayland "(reserved)", "(reserved)", "MESSAGE OUT", "MESSAGE IN" 189*abc139cdSMark Cave-Ayland }; 190*abc139cdSMark Cave-Ayland 191*abc139cdSMark Cave-Ayland static void esp_set_phase(ESPState *s, uint8_t phase) 192*abc139cdSMark Cave-Ayland { 193*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] &= ~7; 194*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= phase; 195*abc139cdSMark Cave-Ayland 196*abc139cdSMark Cave-Ayland trace_esp_set_phase(esp_phase_names[phase]); 197*abc139cdSMark Cave-Ayland } 198*abc139cdSMark Cave-Ayland 199761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 200761bef75SMark Cave-Ayland { 2018da90e81SMark Cave-Ayland uint8_t val; 2028da90e81SMark Cave-Ayland 203c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->fifo); 2048da90e81SMark Cave-Ayland return val; 205761bef75SMark Cave-Ayland } 206761bef75SMark Cave-Ayland 207761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 208761bef75SMark Cave-Ayland { 2098da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 2108da90e81SMark Cave-Ayland 2113c421400SMark Cave-Ayland if (dmalen == 0) { 2128da90e81SMark Cave-Ayland return; 2138da90e81SMark Cave-Ayland } 2148da90e81SMark Cave-Ayland 215e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 2168da90e81SMark Cave-Ayland 2178da90e81SMark Cave-Ayland dmalen--; 2188da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 219761bef75SMark Cave-Ayland } 220761bef75SMark Cave-Ayland 22177987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb) 2221e794c51SMark Cave-Ayland { 2231e794c51SMark Cave-Ayland s->pdma_cb = cb; 2241e794c51SMark Cave-Ayland } 2251e794c51SMark Cave-Ayland 226c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2276130b188SLaurent Vivier { 2286130b188SLaurent Vivier int target; 2296130b188SLaurent Vivier 2306130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2316130b188SLaurent Vivier 2326130b188SLaurent Vivier s->ti_size = 0; 2336130b188SLaurent Vivier 234cf40a5e4SMark Cave-Ayland if (s->current_req) { 235cf40a5e4SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 236cf40a5e4SMark Cave-Ayland scsi_req_cancel(s->current_req); 237cf40a5e4SMark Cave-Ayland } 238cf40a5e4SMark Cave-Ayland 2396130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 2406130b188SLaurent Vivier if (!s->current_dev) { 2416130b188SLaurent Vivier /* No such drive */ 2426130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 243cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 2446130b188SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_0; 2456130b188SLaurent Vivier esp_raise_irq(s); 2466130b188SLaurent Vivier return -1; 2476130b188SLaurent Vivier } 2484e78f3bfSMark Cave-Ayland 2494e78f3bfSMark Cave-Ayland /* 2504e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 2514eb86065SPaolo Bonzini * either in do_command_phase() for DATA OUT transfers or by the deferred 2524e78f3bfSMark Cave-Ayland * IRQ mechanism in esp_transfer_data() for DATA IN transfers 2534e78f3bfSMark Cave-Ayland */ 2544e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 2554e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 2566130b188SLaurent Vivier return 0; 2576130b188SLaurent Vivier } 2586130b188SLaurent Vivier 25920c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen) 26049ab747fSPaolo Bonzini { 261023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 262042879fcSMark Cave-Ayland uint32_t dmalen, n; 26349ab747fSPaolo Bonzini int target; 26449ab747fSPaolo Bonzini 26549ab747fSPaolo Bonzini target = s->wregs[ESP_WBUSID] & BUSID_DID; 26649ab747fSPaolo Bonzini if (s->dma) { 26720c8d2edSMark Cave-Ayland dmalen = MIN(esp_get_tc(s), maxlen); 26820c8d2edSMark Cave-Ayland if (dmalen == 0) { 2696c1fef6bSPrasad J Pandit return 0; 2706c1fef6bSPrasad J Pandit } 27174d71ea1SLaurent Vivier if (s->dma_memory_read) { 27249ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, buf, dmalen); 273fbc6510eSMark Cave-Ayland dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen); 274023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, dmalen); 275a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - dmalen); 27649ab747fSPaolo Bonzini } else { 27774d71ea1SLaurent Vivier return 0; 27874d71ea1SLaurent Vivier } 27974d71ea1SLaurent Vivier } else { 280023666daSMark Cave-Ayland dmalen = MIN(fifo8_num_used(&s->fifo), maxlen); 28120c8d2edSMark Cave-Ayland if (dmalen == 0) { 282d3cdc491SPrasad J Pandit return 0; 283d3cdc491SPrasad J Pandit } 2847b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, dmalen); 285fbc6510eSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 2867b320a8eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 28720c8d2edSMark Cave-Ayland } 28849ab747fSPaolo Bonzini trace_esp_get_cmd(dmalen, target); 28949ab747fSPaolo Bonzini 29049ab747fSPaolo Bonzini return dmalen; 29149ab747fSPaolo Bonzini } 29249ab747fSPaolo Bonzini 2934eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 29449ab747fSPaolo Bonzini { 2957b320a8eSMark Cave-Ayland uint32_t cmdlen; 29649ab747fSPaolo Bonzini int32_t datalen; 29749ab747fSPaolo Bonzini SCSIDevice *current_lun; 2987b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 29949ab747fSPaolo Bonzini 3004eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 301023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 30299545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 30399545751SMark Cave-Ayland return; 30499545751SMark Cave-Ayland } 3057b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen); 306023666daSMark Cave-Ayland 3074eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 308b22f83d8SAlexandra Diupina if (!current_lun) { 309b22f83d8SAlexandra Diupina /* No such drive */ 310b22f83d8SAlexandra Diupina s->rregs[ESP_RSTAT] = 0; 311b22f83d8SAlexandra Diupina s->rregs[ESP_RINTR] = INTR_DC; 312b22f83d8SAlexandra Diupina s->rregs[ESP_RSEQ] = SEQ_0; 313b22f83d8SAlexandra Diupina esp_raise_irq(s); 314b22f83d8SAlexandra Diupina return; 315b22f83d8SAlexandra Diupina } 316b22f83d8SAlexandra Diupina 317fe9d8927SJohn Millikin s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s); 31849ab747fSPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 31949ab747fSPaolo Bonzini s->ti_size = datalen; 320023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 32149ab747fSPaolo Bonzini if (datalen != 0) { 32249ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC; 3234e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 3241b9e48a5SMark Cave-Ayland s->ti_cmd = 0; 3256cc88d6bSMark Cave-Ayland esp_set_tc(s, 0); 32649ab747fSPaolo Bonzini if (datalen > 0) { 3274e78f3bfSMark Cave-Ayland /* 3284e78f3bfSMark Cave-Ayland * Switch to DATA IN phase but wait until initial data xfer is 3294e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3304e78f3bfSMark Cave-Ayland */ 3314e78f3bfSMark Cave-Ayland s->data_in_ready = false; 332*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DI); 33349ab747fSPaolo Bonzini } else { 334*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_DO); 335cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 33649ab747fSPaolo Bonzini esp_raise_irq(s); 33782141c8bSMark Cave-Ayland esp_lower_drq(s); 33849ab747fSPaolo Bonzini } 3394e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3404e78f3bfSMark Cave-Ayland return; 3414e78f3bfSMark Cave-Ayland } 3424e78f3bfSMark Cave-Ayland } 34349ab747fSPaolo Bonzini 3444eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 34549ab747fSPaolo Bonzini { 3464eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3474eb86065SPaolo Bonzini uint8_t message = esp_fifo_pop(&s->cmdfifo); 348023666daSMark Cave-Ayland 3494eb86065SPaolo Bonzini trace_esp_do_identify(message); 3504eb86065SPaolo Bonzini s->lun = message & 7; 351023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3524eb86065SPaolo Bonzini } 35349ab747fSPaolo Bonzini 354799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 355023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3564eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 357fa7505c1SMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, NULL, len); 358023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 359023666daSMark Cave-Ayland } 3604eb86065SPaolo Bonzini } 361023666daSMark Cave-Ayland 3624eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3634eb86065SPaolo Bonzini { 3644eb86065SPaolo Bonzini do_message_phase(s); 3654eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3664eb86065SPaolo Bonzini do_command_phase(s); 36749ab747fSPaolo Bonzini } 36849ab747fSPaolo Bonzini 36974d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s) 37074d71ea1SLaurent Vivier { 3712572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 3722572689bSMark Cave-Ayland int n; 3732572689bSMark Cave-Ayland 3742572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 3752572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 3762572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 3772572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 3782572689bSMark Cave-Ayland 379e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 380023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 381e62a959aSMark Cave-Ayland s->do_cmd = 0; 382c959f218SMark Cave-Ayland do_cmd(s); 38374d71ea1SLaurent Vivier } 38474d71ea1SLaurent Vivier } 38574d71ea1SLaurent Vivier 38649ab747fSPaolo Bonzini static void handle_satn(ESPState *s) 38749ab747fSPaolo Bonzini { 38849691315SMark Cave-Ayland int32_t cmdlen; 38949691315SMark Cave-Ayland 39049ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 39149ab747fSPaolo Bonzini s->dma_cb = handle_satn; 39249ab747fSPaolo Bonzini return; 39349ab747fSPaolo Bonzini } 39477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_PDMA_CB); 3951bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3961bcaf71bSMark Cave-Ayland return; 3971bcaf71bSMark Cave-Ayland } 398023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 39949691315SMark Cave-Ayland if (cmdlen > 0) { 400023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 40160720694SMark Cave-Ayland s->do_cmd = 0; 402c959f218SMark Cave-Ayland do_cmd(s); 40349691315SMark Cave-Ayland } else if (cmdlen == 0) { 4041bcaf71bSMark Cave-Ayland if (s->dma) { 4051bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4061bcaf71bSMark Cave-Ayland } 407bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 40849691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 40949691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 410*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 41149ab747fSPaolo Bonzini } 41294d5c79dSMark Cave-Ayland } 41349ab747fSPaolo Bonzini 41474d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s) 41574d71ea1SLaurent Vivier { 4162572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 4172572689bSMark Cave-Ayland int n; 4182572689bSMark Cave-Ayland 4192572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 4202572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 4212572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 4222572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 4232572689bSMark Cave-Ayland 424e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 425023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 426e62a959aSMark Cave-Ayland s->do_cmd = 0; 4274eb86065SPaolo Bonzini do_cmd(s); 42874d71ea1SLaurent Vivier } 42974d71ea1SLaurent Vivier } 43074d71ea1SLaurent Vivier 43149ab747fSPaolo Bonzini static void handle_s_without_atn(ESPState *s) 43249ab747fSPaolo Bonzini { 43349691315SMark Cave-Ayland int32_t cmdlen; 43449691315SMark Cave-Ayland 43549ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 43649ab747fSPaolo Bonzini s->dma_cb = handle_s_without_atn; 43749ab747fSPaolo Bonzini return; 43849ab747fSPaolo Bonzini } 43977987ef5SMark Cave-Ayland esp_set_pdma_cb(s, S_WITHOUT_SATN_PDMA_CB); 4401bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4411bcaf71bSMark Cave-Ayland return; 4421bcaf71bSMark Cave-Ayland } 443023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 44449691315SMark Cave-Ayland if (cmdlen > 0) { 445023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 44660720694SMark Cave-Ayland s->do_cmd = 0; 4474eb86065SPaolo Bonzini do_cmd(s); 44849691315SMark Cave-Ayland } else if (cmdlen == 0) { 4491bcaf71bSMark Cave-Ayland if (s->dma) { 4501bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4511bcaf71bSMark Cave-Ayland } 452bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 45349691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 45449691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 455*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 45649ab747fSPaolo Bonzini } 45749ab747fSPaolo Bonzini } 45849ab747fSPaolo Bonzini 45974d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s) 46074d71ea1SLaurent Vivier { 4612572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 4622572689bSMark Cave-Ayland int n; 4632572689bSMark Cave-Ayland 4642572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 4652572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 4662572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 4672572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 4682572689bSMark Cave-Ayland 469e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 470023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 47174d71ea1SLaurent Vivier s->do_cmd = 1; 472023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 473*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 474*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 475cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 47674d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 47774d71ea1SLaurent Vivier esp_raise_irq(s); 47874d71ea1SLaurent Vivier } 47974d71ea1SLaurent Vivier } 48074d71ea1SLaurent Vivier 48149ab747fSPaolo Bonzini static void handle_satn_stop(ESPState *s) 48249ab747fSPaolo Bonzini { 48349691315SMark Cave-Ayland int32_t cmdlen; 48449691315SMark Cave-Ayland 48549ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 48649ab747fSPaolo Bonzini s->dma_cb = handle_satn_stop; 48749ab747fSPaolo Bonzini return; 48849ab747fSPaolo Bonzini } 48977987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_STOP_PDMA_CB); 4901bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4911bcaf71bSMark Cave-Ayland return; 4921bcaf71bSMark Cave-Ayland } 493799d90d8SMark Cave-Ayland cmdlen = get_cmd(s, 1); 49449691315SMark Cave-Ayland if (cmdlen > 0) { 495023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 49649ab747fSPaolo Bonzini s->do_cmd = 1; 497023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 498*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 499cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 500799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 50149ab747fSPaolo Bonzini esp_raise_irq(s); 50249691315SMark Cave-Ayland } else if (cmdlen == 0) { 5031bcaf71bSMark Cave-Ayland if (s->dma) { 5041bcaf71bSMark Cave-Ayland esp_raise_drq(s); 5051bcaf71bSMark Cave-Ayland } 506bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 507799d90d8SMark Cave-Ayland /* Target present, switch to message out phase */ 508799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 509*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MO); 51049ab747fSPaolo Bonzini } 51149ab747fSPaolo Bonzini } 51249ab747fSPaolo Bonzini 51374d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s) 51474d71ea1SLaurent Vivier { 515*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 516*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 517cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 51874d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 51974d71ea1SLaurent Vivier esp_raise_irq(s); 52074d71ea1SLaurent Vivier } 52174d71ea1SLaurent Vivier 52249ab747fSPaolo Bonzini static void write_response(ESPState *s) 52349ab747fSPaolo Bonzini { 524e3922557SMark Cave-Ayland uint8_t buf[2]; 525042879fcSMark Cave-Ayland 52649ab747fSPaolo Bonzini trace_esp_write_response(s->status); 527042879fcSMark Cave-Ayland 528e3922557SMark Cave-Ayland buf[0] = s->status; 529e3922557SMark Cave-Ayland buf[1] = 0; 530042879fcSMark Cave-Ayland 53149ab747fSPaolo Bonzini if (s->dma) { 53274d71ea1SLaurent Vivier if (s->dma_memory_write) { 533e3922557SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, 2); 534*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 535*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 536cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 53749ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = SEQ_CD; 53849ab747fSPaolo Bonzini } else { 53977987ef5SMark Cave-Ayland esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB); 54074d71ea1SLaurent Vivier esp_raise_drq(s); 54174d71ea1SLaurent Vivier return; 54274d71ea1SLaurent Vivier } 54374d71ea1SLaurent Vivier } else { 544e3922557SMark Cave-Ayland fifo8_reset(&s->fifo); 545e3922557SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, 2); 54649ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 2; 54749ab747fSPaolo Bonzini } 54849ab747fSPaolo Bonzini esp_raise_irq(s); 54949ab747fSPaolo Bonzini } 55049ab747fSPaolo Bonzini 55149ab747fSPaolo Bonzini static void esp_dma_done(ESPState *s) 55249ab747fSPaolo Bonzini { 55349ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_TC; 554cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 55549ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 0; 556c47b5835SMark Cave-Ayland esp_set_tc(s, 0); 55749ab747fSPaolo Bonzini esp_raise_irq(s); 55849ab747fSPaolo Bonzini } 55949ab747fSPaolo Bonzini 56074d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s) 56174d71ea1SLaurent Vivier { 5624ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 5632572689bSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 56482141c8bSMark Cave-Ayland int len; 565042879fcSMark Cave-Ayland uint32_t n; 5666cc88d6bSMark Cave-Ayland 56774d71ea1SLaurent Vivier if (s->do_cmd) { 5682572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 5692572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 5702572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 5712572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 5722572689bSMark Cave-Ayland 573e62a959aSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 574e62a959aSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 575e62a959aSMark Cave-Ayland return; 576e62a959aSMark Cave-Ayland } 577e62a959aSMark Cave-Ayland 57874d71ea1SLaurent Vivier s->ti_size = 0; 579c348458fSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 580c348458fSMark Cave-Ayland /* No command received */ 581c348458fSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 582c348458fSMark Cave-Ayland return; 583c348458fSMark Cave-Ayland } 584c348458fSMark Cave-Ayland 585c348458fSMark Cave-Ayland /* Command has been received */ 58674d71ea1SLaurent Vivier s->do_cmd = 0; 587c959f218SMark Cave-Ayland do_cmd(s); 588c348458fSMark Cave-Ayland } else { 589c348458fSMark Cave-Ayland /* 590c348458fSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 5912cb40d44SStefan Weil * and then switch to command phase 592c348458fSMark Cave-Ayland */ 593c348458fSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 594*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 595*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 596c348458fSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 597c348458fSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 598c348458fSMark Cave-Ayland esp_raise_irq(s); 599c348458fSMark Cave-Ayland } 60074d71ea1SLaurent Vivier return; 60174d71ea1SLaurent Vivier } 60282141c8bSMark Cave-Ayland 6030db89536SMark Cave-Ayland if (!s->current_req) { 6040db89536SMark Cave-Ayland return; 6050db89536SMark Cave-Ayland } 6060db89536SMark Cave-Ayland 60782141c8bSMark Cave-Ayland if (to_device) { 60882141c8bSMark Cave-Ayland /* Copy FIFO data to device */ 6097aa6baeeSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 6107aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 6117b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 6127aa6baeeSMark Cave-Ayland s->async_buf += n; 6137aa6baeeSMark Cave-Ayland s->async_len -= n; 6147aa6baeeSMark Cave-Ayland s->ti_size += n; 6157aa6baeeSMark Cave-Ayland 6167aa6baeeSMark Cave-Ayland if (n < len) { 6177aa6baeeSMark Cave-Ayland /* Unaligned accesses can cause FIFO wraparound */ 6187aa6baeeSMark Cave-Ayland len = len - n; 6197b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 6207aa6baeeSMark Cave-Ayland s->async_buf += n; 6217aa6baeeSMark Cave-Ayland s->async_len -= n; 6227aa6baeeSMark Cave-Ayland s->ti_size += n; 6237aa6baeeSMark Cave-Ayland } 6247aa6baeeSMark Cave-Ayland 62574d71ea1SLaurent Vivier if (s->async_len == 0) { 62674d71ea1SLaurent Vivier scsi_req_continue(s->current_req); 62782141c8bSMark Cave-Ayland return; 62882141c8bSMark Cave-Ayland } 62982141c8bSMark Cave-Ayland 63082141c8bSMark Cave-Ayland if (esp_get_tc(s) == 0) { 63182141c8bSMark Cave-Ayland esp_lower_drq(s); 63282141c8bSMark Cave-Ayland esp_dma_done(s); 63382141c8bSMark Cave-Ayland } 63482141c8bSMark Cave-Ayland 63582141c8bSMark Cave-Ayland return; 63682141c8bSMark Cave-Ayland } else { 63782141c8bSMark Cave-Ayland if (s->async_len == 0) { 6384e78f3bfSMark Cave-Ayland /* Defer until the scsi layer has completed */ 63982141c8bSMark Cave-Ayland scsi_req_continue(s->current_req); 6404e78f3bfSMark Cave-Ayland s->data_in_ready = false; 64174d71ea1SLaurent Vivier return; 64274d71ea1SLaurent Vivier } 64374d71ea1SLaurent Vivier 6440f2eb110SMark Cave-Ayland if (esp_get_tc(s) == 0) { 6450f2eb110SMark Cave-Ayland esp_lower_drq(s); 6460f2eb110SMark Cave-Ayland esp_dma_done(s); 6470f2eb110SMark Cave-Ayland } 6480f2eb110SMark Cave-Ayland 64982141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 6507aa6baeeSMark Cave-Ayland len = MIN(s->async_len, esp_get_tc(s)); 6517aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 652042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 65382141c8bSMark Cave-Ayland s->async_buf += len; 65482141c8bSMark Cave-Ayland s->async_len -= len; 65582141c8bSMark Cave-Ayland s->ti_size -= len; 65682141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 65774d71ea1SLaurent Vivier } 65882141c8bSMark Cave-Ayland } 65974d71ea1SLaurent Vivier 66049ab747fSPaolo Bonzini static void esp_do_dma(ESPState *s) 66149ab747fSPaolo Bonzini { 662023666daSMark Cave-Ayland uint32_t len, cmdlen; 6634ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 664023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 66549ab747fSPaolo Bonzini 6666cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 66749ab747fSPaolo Bonzini if (s->do_cmd) { 66815407433SLaurent Vivier /* 66915407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 67015407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 67115407433SLaurent Vivier */ 672023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 673023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 67474d71ea1SLaurent Vivier if (s->dma_memory_read) { 6750ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 676023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 677023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 678a0347651SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 67974d71ea1SLaurent Vivier } else { 68077987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 68174d71ea1SLaurent Vivier esp_raise_drq(s); 68274d71ea1SLaurent Vivier return; 68374d71ea1SLaurent Vivier } 684023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 68515407433SLaurent Vivier s->ti_size = 0; 686799d90d8SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 687799d90d8SMark Cave-Ayland /* No command received */ 688023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 689799d90d8SMark Cave-Ayland return; 690799d90d8SMark Cave-Ayland } 691799d90d8SMark Cave-Ayland 692799d90d8SMark Cave-Ayland /* Command has been received */ 69315407433SLaurent Vivier s->do_cmd = 0; 694c959f218SMark Cave-Ayland do_cmd(s); 695799d90d8SMark Cave-Ayland } else { 696799d90d8SMark Cave-Ayland /* 697023666daSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 6982cb40d44SStefan Weil * and then switch to command phase 699799d90d8SMark Cave-Ayland */ 700023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 701*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 702*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 703799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 704799d90d8SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 705799d90d8SMark Cave-Ayland esp_raise_irq(s); 706799d90d8SMark Cave-Ayland } 70749ab747fSPaolo Bonzini return; 70849ab747fSPaolo Bonzini } 7090db89536SMark Cave-Ayland if (!s->current_req) { 7100db89536SMark Cave-Ayland return; 7110db89536SMark Cave-Ayland } 71249ab747fSPaolo Bonzini if (s->async_len == 0) { 71349ab747fSPaolo Bonzini /* Defer until data is available. */ 71449ab747fSPaolo Bonzini return; 71549ab747fSPaolo Bonzini } 71649ab747fSPaolo Bonzini if (len > s->async_len) { 71749ab747fSPaolo Bonzini len = s->async_len; 71849ab747fSPaolo Bonzini } 71949ab747fSPaolo Bonzini if (to_device) { 72074d71ea1SLaurent Vivier if (s->dma_memory_read) { 72149ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, s->async_buf, len); 722f3666223SMark Cave-Ayland 723f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 724f3666223SMark Cave-Ayland s->async_buf += len; 725f3666223SMark Cave-Ayland s->async_len -= len; 726f3666223SMark Cave-Ayland s->ti_size += len; 727f3666223SMark Cave-Ayland 728f3666223SMark Cave-Ayland if (s->async_len == 0) { 729f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 730f3666223SMark Cave-Ayland /* 731f3666223SMark Cave-Ayland * If there is still data to be read from the device then 732f3666223SMark Cave-Ayland * complete the DMA operation immediately. Otherwise defer 733f3666223SMark Cave-Ayland * until the scsi layer has completed. 734f3666223SMark Cave-Ayland */ 735f3666223SMark Cave-Ayland return; 736f3666223SMark Cave-Ayland } 737f3666223SMark Cave-Ayland 738f3666223SMark Cave-Ayland /* Partially filled a scsi buffer. Complete immediately. */ 739f3666223SMark Cave-Ayland esp_dma_done(s); 740f3666223SMark Cave-Ayland esp_lower_drq(s); 74149ab747fSPaolo Bonzini } else { 74277987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 74374d71ea1SLaurent Vivier esp_raise_drq(s); 74474d71ea1SLaurent Vivier } 74574d71ea1SLaurent Vivier } else { 74674d71ea1SLaurent Vivier if (s->dma_memory_write) { 74749ab747fSPaolo Bonzini s->dma_memory_write(s->dma_opaque, s->async_buf, len); 748f3666223SMark Cave-Ayland 749f3666223SMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 750f3666223SMark Cave-Ayland s->async_buf += len; 751f3666223SMark Cave-Ayland s->async_len -= len; 752f3666223SMark Cave-Ayland s->ti_size -= len; 753f3666223SMark Cave-Ayland 754f3666223SMark Cave-Ayland if (s->async_len == 0) { 755f3666223SMark Cave-Ayland scsi_req_continue(s->current_req); 756f3666223SMark Cave-Ayland /* 757f3666223SMark Cave-Ayland * If there is still data to be read from the device then 758f3666223SMark Cave-Ayland * complete the DMA operation immediately. Otherwise defer 759f3666223SMark Cave-Ayland * until the scsi layer has completed. 760f3666223SMark Cave-Ayland */ 761f3666223SMark Cave-Ayland if (esp_get_tc(s) != 0 || s->ti_size == 0) { 762f3666223SMark Cave-Ayland return; 763f3666223SMark Cave-Ayland } 764f3666223SMark Cave-Ayland } 765f3666223SMark Cave-Ayland 766f3666223SMark Cave-Ayland /* Partially filled a scsi buffer. Complete immediately. */ 767f3666223SMark Cave-Ayland esp_dma_done(s); 768f3666223SMark Cave-Ayland esp_lower_drq(s); 76974d71ea1SLaurent Vivier } else { 7707aa6baeeSMark Cave-Ayland /* Adjust TC for any leftover data in the FIFO */ 7717aa6baeeSMark Cave-Ayland if (!fifo8_is_empty(&s->fifo)) { 7727aa6baeeSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - fifo8_num_used(&s->fifo)); 7737aa6baeeSMark Cave-Ayland } 7747aa6baeeSMark Cave-Ayland 77582141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 776042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 777042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 77882141c8bSMark Cave-Ayland s->async_buf += len; 77982141c8bSMark Cave-Ayland s->async_len -= len; 78082141c8bSMark Cave-Ayland s->ti_size -= len; 7817aa6baeeSMark Cave-Ayland 7827aa6baeeSMark Cave-Ayland /* 7837aa6baeeSMark Cave-Ayland * MacOS toolbox uses a TI length of 16 bytes for all commands, so 7847aa6baeeSMark Cave-Ayland * commands shorter than this must be padded accordingly 7857aa6baeeSMark Cave-Ayland */ 7867aa6baeeSMark Cave-Ayland if (len < esp_get_tc(s) && esp_get_tc(s) <= ESP_FIFO_SZ) { 7877aa6baeeSMark Cave-Ayland while (fifo8_num_used(&s->fifo) < ESP_FIFO_SZ) { 788e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, 0); 7897aa6baeeSMark Cave-Ayland len++; 7907aa6baeeSMark Cave-Ayland } 7917aa6baeeSMark Cave-Ayland } 7927aa6baeeSMark Cave-Ayland 79382141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 79477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 79574d71ea1SLaurent Vivier esp_raise_drq(s); 79674d71ea1SLaurent Vivier } 79749ab747fSPaolo Bonzini } 79849ab747fSPaolo Bonzini } 79949ab747fSPaolo Bonzini 8001b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 8011b9e48a5SMark Cave-Ayland { 8021b9e48a5SMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8032572689bSMark Cave-Ayland uint8_t buf[ESP_FIFO_SZ]; 8047b320a8eSMark Cave-Ayland uint32_t cmdlen; 8052572689bSMark Cave-Ayland int len, n; 8061b9e48a5SMark Cave-Ayland 8071b9e48a5SMark Cave-Ayland if (s->do_cmd) { 8082572689bSMark Cave-Ayland /* Copy FIFO into cmdfifo */ 8092572689bSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, fifo8_num_used(&s->fifo)); 8102572689bSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 8112572689bSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 8122572689bSMark Cave-Ayland 8131b9e48a5SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 8141b9e48a5SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 8151b9e48a5SMark Cave-Ayland s->ti_size = 0; 8161b9e48a5SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 8171b9e48a5SMark Cave-Ayland /* No command received */ 8181b9e48a5SMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 8191b9e48a5SMark Cave-Ayland return; 8201b9e48a5SMark Cave-Ayland } 8211b9e48a5SMark Cave-Ayland 8221b9e48a5SMark Cave-Ayland /* Command has been received */ 8231b9e48a5SMark Cave-Ayland s->do_cmd = 0; 8241b9e48a5SMark Cave-Ayland do_cmd(s); 8251b9e48a5SMark Cave-Ayland } else { 8261b9e48a5SMark Cave-Ayland /* 8271b9e48a5SMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 8282cb40d44SStefan Weil * and then switch to command phase 8291b9e48a5SMark Cave-Ayland */ 8301b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 831*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_CD); 832*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 8331b9e48a5SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 8341b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8351b9e48a5SMark Cave-Ayland esp_raise_irq(s); 8361b9e48a5SMark Cave-Ayland } 8371b9e48a5SMark Cave-Ayland return; 8381b9e48a5SMark Cave-Ayland } 8391b9e48a5SMark Cave-Ayland 8400db89536SMark Cave-Ayland if (!s->current_req) { 8410db89536SMark Cave-Ayland return; 8420db89536SMark Cave-Ayland } 8430db89536SMark Cave-Ayland 8441b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8451b9e48a5SMark Cave-Ayland /* Defer until data is available. */ 8461b9e48a5SMark Cave-Ayland return; 8471b9e48a5SMark Cave-Ayland } 8481b9e48a5SMark Cave-Ayland 8491b9e48a5SMark Cave-Ayland if (to_device) { 85077668e4bSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 85177668e4bSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 8527b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 8531b9e48a5SMark Cave-Ayland s->async_buf += len; 8541b9e48a5SMark Cave-Ayland s->async_len -= len; 8551b9e48a5SMark Cave-Ayland s->ti_size += len; 8561b9e48a5SMark Cave-Ayland } else { 8576ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 8586ef2cabcSMark Cave-Ayland fifo8_push(&s->fifo, s->async_buf[0]); 8596ef2cabcSMark Cave-Ayland s->async_buf++; 8606ef2cabcSMark Cave-Ayland s->async_len--; 8616ef2cabcSMark Cave-Ayland s->ti_size--; 8626ef2cabcSMark Cave-Ayland } 8631b9e48a5SMark Cave-Ayland } 8641b9e48a5SMark Cave-Ayland 8651b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8661b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 8671b9e48a5SMark Cave-Ayland return; 8681b9e48a5SMark Cave-Ayland } 8691b9e48a5SMark Cave-Ayland 8701b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8711b9e48a5SMark Cave-Ayland esp_raise_irq(s); 8721b9e48a5SMark Cave-Ayland } 8731b9e48a5SMark Cave-Ayland 87477987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s) 87577987ef5SMark Cave-Ayland { 87677987ef5SMark Cave-Ayland switch (s->pdma_cb) { 87777987ef5SMark Cave-Ayland case SATN_PDMA_CB: 87877987ef5SMark Cave-Ayland satn_pdma_cb(s); 87977987ef5SMark Cave-Ayland break; 88077987ef5SMark Cave-Ayland case S_WITHOUT_SATN_PDMA_CB: 88177987ef5SMark Cave-Ayland s_without_satn_pdma_cb(s); 88277987ef5SMark Cave-Ayland break; 88377987ef5SMark Cave-Ayland case SATN_STOP_PDMA_CB: 88477987ef5SMark Cave-Ayland satn_stop_pdma_cb(s); 88577987ef5SMark Cave-Ayland break; 88677987ef5SMark Cave-Ayland case WRITE_RESPONSE_PDMA_CB: 88777987ef5SMark Cave-Ayland write_response_pdma_cb(s); 88877987ef5SMark Cave-Ayland break; 88977987ef5SMark Cave-Ayland case DO_DMA_PDMA_CB: 89077987ef5SMark Cave-Ayland do_dma_pdma_cb(s); 89177987ef5SMark Cave-Ayland break; 89277987ef5SMark Cave-Ayland default: 89377987ef5SMark Cave-Ayland g_assert_not_reached(); 89477987ef5SMark Cave-Ayland } 89577987ef5SMark Cave-Ayland } 89677987ef5SMark Cave-Ayland 8974aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 89849ab747fSPaolo Bonzini { 8994aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 9006ef2cabcSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 9014aaa6ac3SMark Cave-Ayland 90249ab747fSPaolo Bonzini trace_esp_command_complete(); 9036ef2cabcSMark Cave-Ayland 9046ef2cabcSMark Cave-Ayland /* 9056ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 9066ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 9076ef2cabcSMark Cave-Ayland */ 9086ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 90949ab747fSPaolo Bonzini if (s->ti_size != 0) { 91049ab747fSPaolo Bonzini trace_esp_command_complete_unexpected(); 91149ab747fSPaolo Bonzini } 91249ab747fSPaolo Bonzini s->ti_size = 0; 9136ef2cabcSMark Cave-Ayland } 9146ef2cabcSMark Cave-Ayland 91549ab747fSPaolo Bonzini s->async_len = 0; 9164aaa6ac3SMark Cave-Ayland if (req->status) { 91749ab747fSPaolo Bonzini trace_esp_command_complete_fail(); 91849ab747fSPaolo Bonzini } 9194aaa6ac3SMark Cave-Ayland s->status = req->status; 9206ef2cabcSMark Cave-Ayland 9216ef2cabcSMark Cave-Ayland /* 9226ef2cabcSMark Cave-Ayland * If the transfer is finished, switch to status phase. For non-DMA 9236ef2cabcSMark Cave-Ayland * transfers from the target the last byte is still in the FIFO 9246ef2cabcSMark Cave-Ayland */ 9256ef2cabcSMark Cave-Ayland if (s->ti_size == 0) { 926*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 92749ab747fSPaolo Bonzini esp_dma_done(s); 92882141c8bSMark Cave-Ayland esp_lower_drq(s); 9296ef2cabcSMark Cave-Ayland } 9306ef2cabcSMark Cave-Ayland 93149ab747fSPaolo Bonzini if (s->current_req) { 93249ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 93349ab747fSPaolo Bonzini s->current_req = NULL; 93449ab747fSPaolo Bonzini s->current_dev = NULL; 93549ab747fSPaolo Bonzini } 93649ab747fSPaolo Bonzini } 93749ab747fSPaolo Bonzini 93849ab747fSPaolo Bonzini void esp_transfer_data(SCSIRequest *req, uint32_t len) 93949ab747fSPaolo Bonzini { 94049ab747fSPaolo Bonzini ESPState *s = req->hba_private; 9414e78f3bfSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 9426cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 94349ab747fSPaolo Bonzini 9447f0b6e11SPaolo Bonzini assert(!s->do_cmd); 9456cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 94649ab747fSPaolo Bonzini s->async_len = len; 94749ab747fSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 9484e78f3bfSMark Cave-Ayland 9494e78f3bfSMark Cave-Ayland if (!to_device && !s->data_in_ready) { 9504e78f3bfSMark Cave-Ayland /* 9514e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 9524e78f3bfSMark Cave-Ayland * completion interrupt 9534e78f3bfSMark Cave-Ayland */ 9544e78f3bfSMark Cave-Ayland s->data_in_ready = true; 9554e78f3bfSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 9564e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 9574e78f3bfSMark Cave-Ayland esp_raise_irq(s); 9584e78f3bfSMark Cave-Ayland } 9594e78f3bfSMark Cave-Ayland 9601b9e48a5SMark Cave-Ayland if (s->ti_cmd == 0) { 9611b9e48a5SMark Cave-Ayland /* 9621b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 9631b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 9641b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 9651b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 9661b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 9671b9e48a5SMark Cave-Ayland */ 9681b9e48a5SMark Cave-Ayland return; 9691b9e48a5SMark Cave-Ayland } 9701b9e48a5SMark Cave-Ayland 971880d3089SMark Cave-Ayland if (s->ti_cmd == (CMD_TI | CMD_DMA)) { 9726cc88d6bSMark Cave-Ayland if (dmalen) { 97349ab747fSPaolo Bonzini esp_do_dma(s); 9745eb7a23fSMark Cave-Ayland } else if (s->ti_size <= 0) { 97594d5c79dSMark Cave-Ayland /* 97694d5c79dSMark Cave-Ayland * If this was the last part of a DMA transfer then the 97794d5c79dSMark Cave-Ayland * completion interrupt is deferred to here. 97894d5c79dSMark Cave-Ayland */ 97949ab747fSPaolo Bonzini esp_dma_done(s); 98082141c8bSMark Cave-Ayland esp_lower_drq(s); 98149ab747fSPaolo Bonzini } 982880d3089SMark Cave-Ayland } else if (s->ti_cmd == CMD_TI) { 9831b9e48a5SMark Cave-Ayland esp_do_nodma(s); 9841b9e48a5SMark Cave-Ayland } 98549ab747fSPaolo Bonzini } 98649ab747fSPaolo Bonzini 98749ab747fSPaolo Bonzini static void handle_ti(ESPState *s) 98849ab747fSPaolo Bonzini { 9891b9e48a5SMark Cave-Ayland uint32_t dmalen; 99049ab747fSPaolo Bonzini 99149ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 99249ab747fSPaolo Bonzini s->dma_cb = handle_ti; 99349ab747fSPaolo Bonzini return; 99449ab747fSPaolo Bonzini } 99549ab747fSPaolo Bonzini 9961b9e48a5SMark Cave-Ayland s->ti_cmd = s->rregs[ESP_CMD]; 99749ab747fSPaolo Bonzini if (s->dma) { 9981b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 999b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 100049ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 100149ab747fSPaolo Bonzini esp_do_dma(s); 1002799d90d8SMark Cave-Ayland } else { 10031b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 10041b9e48a5SMark Cave-Ayland esp_do_nodma(s); 100549ab747fSPaolo Bonzini } 100649ab747fSPaolo Bonzini } 100749ab747fSPaolo Bonzini 100849ab747fSPaolo Bonzini void esp_hard_reset(ESPState *s) 100949ab747fSPaolo Bonzini { 101049ab747fSPaolo Bonzini memset(s->rregs, 0, ESP_REGS); 101149ab747fSPaolo Bonzini memset(s->wregs, 0, ESP_REGS); 1012c9cf45c1SHannes Reinecke s->tchi_written = 0; 101349ab747fSPaolo Bonzini s->ti_size = 0; 10143f26c975SMark Cave-Ayland s->async_len = 0; 1015042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 1016023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 101749ab747fSPaolo Bonzini s->dma = 0; 101849ab747fSPaolo Bonzini s->do_cmd = 0; 101949ab747fSPaolo Bonzini s->dma_cb = NULL; 102049ab747fSPaolo Bonzini 102149ab747fSPaolo Bonzini s->rregs[ESP_CFG1] = 7; 102249ab747fSPaolo Bonzini } 102349ab747fSPaolo Bonzini 102449ab747fSPaolo Bonzini static void esp_soft_reset(ESPState *s) 102549ab747fSPaolo Bonzini { 102649ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 102774d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 102849ab747fSPaolo Bonzini esp_hard_reset(s); 102949ab747fSPaolo Bonzini } 103049ab747fSPaolo Bonzini 1031c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s) 1032c6e51f1bSJohn Millikin { 10334a5fc890SPeter Maydell bus_cold_reset(BUS(&s->bus)); 1034c6e51f1bSJohn Millikin } 1035c6e51f1bSJohn Millikin 103649ab747fSPaolo Bonzini static void parent_esp_reset(ESPState *s, int irq, int level) 103749ab747fSPaolo Bonzini { 103849ab747fSPaolo Bonzini if (level) { 103949ab747fSPaolo Bonzini esp_soft_reset(s); 104049ab747fSPaolo Bonzini } 104149ab747fSPaolo Bonzini } 104249ab747fSPaolo Bonzini 1043f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s) 1044f21fe39dSMark Cave-Ayland { 1045f21fe39dSMark Cave-Ayland uint8_t cmd = s->rregs[ESP_CMD]; 1046f21fe39dSMark Cave-Ayland 1047f21fe39dSMark Cave-Ayland if (cmd & CMD_DMA) { 1048f21fe39dSMark Cave-Ayland s->dma = 1; 1049f21fe39dSMark Cave-Ayland /* Reload DMA counter. */ 1050f21fe39dSMark Cave-Ayland if (esp_get_stc(s) == 0) { 1051f21fe39dSMark Cave-Ayland esp_set_tc(s, 0x10000); 1052f21fe39dSMark Cave-Ayland } else { 1053f21fe39dSMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 1054f21fe39dSMark Cave-Ayland } 1055f21fe39dSMark Cave-Ayland } else { 1056f21fe39dSMark Cave-Ayland s->dma = 0; 1057f21fe39dSMark Cave-Ayland } 1058f21fe39dSMark Cave-Ayland switch (cmd & CMD_CMD) { 1059f21fe39dSMark Cave-Ayland case CMD_NOP: 1060f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_nop(cmd); 1061f21fe39dSMark Cave-Ayland break; 1062f21fe39dSMark Cave-Ayland case CMD_FLUSH: 1063f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_flush(cmd); 1064f21fe39dSMark Cave-Ayland fifo8_reset(&s->fifo); 1065f21fe39dSMark Cave-Ayland break; 1066f21fe39dSMark Cave-Ayland case CMD_RESET: 1067f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_reset(cmd); 1068f21fe39dSMark Cave-Ayland esp_soft_reset(s); 1069f21fe39dSMark Cave-Ayland break; 1070f21fe39dSMark Cave-Ayland case CMD_BUSRESET: 1071f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_bus_reset(cmd); 1072f21fe39dSMark Cave-Ayland esp_bus_reset(s); 1073f21fe39dSMark Cave-Ayland if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1074f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 1075f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1076f21fe39dSMark Cave-Ayland } 1077f21fe39dSMark Cave-Ayland break; 1078f21fe39dSMark Cave-Ayland case CMD_TI: 1079f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(cmd); 1080f21fe39dSMark Cave-Ayland handle_ti(s); 1081f21fe39dSMark Cave-Ayland break; 1082f21fe39dSMark Cave-Ayland case CMD_ICCS: 1083f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_iccs(cmd); 1084f21fe39dSMark Cave-Ayland write_response(s); 1085f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1086*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_MI); 1087f21fe39dSMark Cave-Ayland break; 1088f21fe39dSMark Cave-Ayland case CMD_MSGACC: 1089f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_msgacc(cmd); 1090f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 1091f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1092f21fe39dSMark Cave-Ayland s->rregs[ESP_RFLAGS] = 0; 1093f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1094f21fe39dSMark Cave-Ayland break; 1095f21fe39dSMark Cave-Ayland case CMD_PAD: 1096f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_pad(cmd); 1097f21fe39dSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC; 1098f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1099f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1100f21fe39dSMark Cave-Ayland break; 1101f21fe39dSMark Cave-Ayland case CMD_SATN: 1102f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_satn(cmd); 1103f21fe39dSMark Cave-Ayland break; 1104f21fe39dSMark Cave-Ayland case CMD_RSTATN: 1105f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_rstatn(cmd); 1106f21fe39dSMark Cave-Ayland break; 1107f21fe39dSMark Cave-Ayland case CMD_SEL: 1108f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_sel(cmd); 1109f21fe39dSMark Cave-Ayland handle_s_without_atn(s); 1110f21fe39dSMark Cave-Ayland break; 1111f21fe39dSMark Cave-Ayland case CMD_SELATN: 1112f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatn(cmd); 1113f21fe39dSMark Cave-Ayland handle_satn(s); 1114f21fe39dSMark Cave-Ayland break; 1115f21fe39dSMark Cave-Ayland case CMD_SELATNS: 1116f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatns(cmd); 1117f21fe39dSMark Cave-Ayland handle_satn_stop(s); 1118f21fe39dSMark Cave-Ayland break; 1119f21fe39dSMark Cave-Ayland case CMD_ENSEL: 1120f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ensel(cmd); 1121f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1122f21fe39dSMark Cave-Ayland break; 1123f21fe39dSMark Cave-Ayland case CMD_DISSEL: 1124f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_dissel(cmd); 1125f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1126f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1127f21fe39dSMark Cave-Ayland break; 1128f21fe39dSMark Cave-Ayland default: 1129f21fe39dSMark Cave-Ayland trace_esp_error_unhandled_command(cmd); 1130f21fe39dSMark Cave-Ayland break; 1131f21fe39dSMark Cave-Ayland } 1132f21fe39dSMark Cave-Ayland } 1133f21fe39dSMark Cave-Ayland 113449ab747fSPaolo Bonzini uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 113549ab747fSPaolo Bonzini { 1136b630c075SMark Cave-Ayland uint32_t val; 113749ab747fSPaolo Bonzini 113849ab747fSPaolo Bonzini switch (saddr) { 113949ab747fSPaolo Bonzini case ESP_FIFO: 11401b9e48a5SMark Cave-Ayland if (s->dma_memory_read && s->dma_memory_write && 11411b9e48a5SMark Cave-Ayland (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 114249ab747fSPaolo Bonzini /* Data out. */ 1143ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 114449ab747fSPaolo Bonzini s->rregs[ESP_FIFO] = 0; 1145042879fcSMark Cave-Ayland } else { 11466ef2cabcSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) { 11476ef2cabcSMark Cave-Ayland if (s->ti_size) { 11486ef2cabcSMark Cave-Ayland esp_do_nodma(s); 11496ef2cabcSMark Cave-Ayland } else { 11506ef2cabcSMark Cave-Ayland /* 11516ef2cabcSMark Cave-Ayland * The last byte of a non-DMA transfer has been read out 11526ef2cabcSMark Cave-Ayland * of the FIFO so switch to status phase 11536ef2cabcSMark Cave-Ayland */ 1154*abc139cdSMark Cave-Ayland esp_set_phase(s, STAT_ST); 1155*abc139cdSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 11566ef2cabcSMark Cave-Ayland } 11576ef2cabcSMark Cave-Ayland } 1158c5fef911SMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo); 115949ab747fSPaolo Bonzini } 1160b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 116149ab747fSPaolo Bonzini break; 116249ab747fSPaolo Bonzini case ESP_RINTR: 116394d5c79dSMark Cave-Ayland /* 116494d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 116594d5c79dSMark Cave-Ayland * except TC 116694d5c79dSMark Cave-Ayland */ 1167b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 116849ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 116949ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 1170af947a3dSMark Cave-Ayland /* 1171af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 1172af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 1173af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 1174af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 1175af947a3dSMark Cave-Ayland * transition. 1176af947a3dSMark Cave-Ayland * 1177af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 1178af947a3dSMark Cave-Ayland */ 117949ab747fSPaolo Bonzini esp_lower_irq(s); 1180b630c075SMark Cave-Ayland break; 1181c9cf45c1SHannes Reinecke case ESP_TCHI: 1182c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 1183c9cf45c1SHannes Reinecke if (!s->tchi_written) { 1184b630c075SMark Cave-Ayland val = s->chip_id; 1185b630c075SMark Cave-Ayland } else { 1186b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1187c9cf45c1SHannes Reinecke } 1188b630c075SMark Cave-Ayland break; 1189238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1190238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1191238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1192238ec4d7SMark Cave-Ayland break; 119349ab747fSPaolo Bonzini default: 1194b630c075SMark Cave-Ayland val = s->rregs[saddr]; 119549ab747fSPaolo Bonzini break; 119649ab747fSPaolo Bonzini } 1197b630c075SMark Cave-Ayland 1198b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1199b630c075SMark Cave-Ayland return val; 120049ab747fSPaolo Bonzini } 120149ab747fSPaolo Bonzini 120249ab747fSPaolo Bonzini void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 120349ab747fSPaolo Bonzini { 120449ab747fSPaolo Bonzini trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 120549ab747fSPaolo Bonzini switch (saddr) { 1206c9cf45c1SHannes Reinecke case ESP_TCHI: 1207c9cf45c1SHannes Reinecke s->tchi_written = true; 1208c9cf45c1SHannes Reinecke /* fall through */ 120949ab747fSPaolo Bonzini case ESP_TCLO: 121049ab747fSPaolo Bonzini case ESP_TCMID: 121149ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 121249ab747fSPaolo Bonzini break; 121349ab747fSPaolo Bonzini case ESP_FIFO: 121449ab747fSPaolo Bonzini if (s->do_cmd) { 12152572689bSMark Cave-Ayland if (!fifo8_is_full(&s->fifo)) { 12162572689bSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 12172572689bSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, fifo8_pop(&s->fifo)); 12182572689bSMark Cave-Ayland } 12196ef2cabcSMark Cave-Ayland 12206ef2cabcSMark Cave-Ayland /* 12216ef2cabcSMark Cave-Ayland * If any unexpected message out/command phase data is 12226ef2cabcSMark Cave-Ayland * transferred using non-DMA, raise the interrupt 12236ef2cabcSMark Cave-Ayland */ 12246ef2cabcSMark Cave-Ayland if (s->rregs[ESP_CMD] == CMD_TI) { 12256ef2cabcSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 12266ef2cabcSMark Cave-Ayland esp_raise_irq(s); 12276ef2cabcSMark Cave-Ayland } 122849ab747fSPaolo Bonzini } else { 1229e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 123049ab747fSPaolo Bonzini } 123149ab747fSPaolo Bonzini break; 123249ab747fSPaolo Bonzini case ESP_CMD: 123349ab747fSPaolo Bonzini s->rregs[saddr] = val; 1234f21fe39dSMark Cave-Ayland esp_run_cmd(s); 123549ab747fSPaolo Bonzini break; 123649ab747fSPaolo Bonzini case ESP_WBUSID ... ESP_WSYNO: 123749ab747fSPaolo Bonzini break; 123849ab747fSPaolo Bonzini case ESP_CFG1: 123949ab747fSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 124049ab747fSPaolo Bonzini case ESP_RES3: case ESP_RES4: 124149ab747fSPaolo Bonzini s->rregs[saddr] = val; 124249ab747fSPaolo Bonzini break; 124349ab747fSPaolo Bonzini case ESP_WCCF ... ESP_WTEST: 124449ab747fSPaolo Bonzini break; 124549ab747fSPaolo Bonzini default: 124649ab747fSPaolo Bonzini trace_esp_error_invalid_write(val, saddr); 124749ab747fSPaolo Bonzini return; 124849ab747fSPaolo Bonzini } 124949ab747fSPaolo Bonzini s->wregs[saddr] = val; 125049ab747fSPaolo Bonzini } 125149ab747fSPaolo Bonzini 125249ab747fSPaolo Bonzini static bool esp_mem_accepts(void *opaque, hwaddr addr, 12538372d383SPeter Maydell unsigned size, bool is_write, 12548372d383SPeter Maydell MemTxAttrs attrs) 125549ab747fSPaolo Bonzini { 125649ab747fSPaolo Bonzini return (size == 1) || (is_write && size == 4); 125749ab747fSPaolo Bonzini } 125849ab747fSPaolo Bonzini 12596cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 12606cc88d6bSMark Cave-Ayland { 12616cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 12626cc88d6bSMark Cave-Ayland 12636cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12646cc88d6bSMark Cave-Ayland return version_id < 5; 12656cc88d6bSMark Cave-Ayland } 12666cc88d6bSMark Cave-Ayland 12674e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 12684e78f3bfSMark Cave-Ayland { 12694e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 12704e78f3bfSMark Cave-Ayland 12714e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12720bcd5a18SMark Cave-Ayland return version_id >= 5; 12734e78f3bfSMark Cave-Ayland } 12744e78f3bfSMark Cave-Ayland 12754eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 12764eb86065SPaolo Bonzini { 12774eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 12784eb86065SPaolo Bonzini 12794eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 12804eb86065SPaolo Bonzini return version_id >= 6; 12814eb86065SPaolo Bonzini } 12824eb86065SPaolo Bonzini 1283ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 12840bd005beSMark Cave-Ayland { 1285ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1286ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 12870bd005beSMark Cave-Ayland 12880bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12890bd005beSMark Cave-Ayland return 0; 12900bd005beSMark Cave-Ayland } 12910bd005beSMark Cave-Ayland 12920bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 12930bd005beSMark Cave-Ayland { 12940bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1295042879fcSMark Cave-Ayland int len, i; 12960bd005beSMark Cave-Ayland 12976cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12986cc88d6bSMark Cave-Ayland 12996cc88d6bSMark Cave-Ayland if (version_id < 5) { 13006cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1301042879fcSMark Cave-Ayland 1302042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1303042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1304042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1305042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1306042879fcSMark Cave-Ayland } 1307023666daSMark Cave-Ayland 1308023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1309023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1310023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1311023666daSMark Cave-Ayland } 13126cc88d6bSMark Cave-Ayland } 13136cc88d6bSMark Cave-Ayland 13140bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 13150bd005beSMark Cave-Ayland return 0; 13160bd005beSMark Cave-Ayland } 13170bd005beSMark Cave-Ayland 1318eda59b39SMark Cave-Ayland /* 1319eda59b39SMark Cave-Ayland * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the 1320eda59b39SMark Cave-Ayland * guest CPU to perform the transfers between the SCSI bus and memory 1321eda59b39SMark Cave-Ayland * itself. This is indicated by the dma_memory_read and dma_memory_write 1322eda59b39SMark Cave-Ayland * functions being NULL (in contrast to the ESP PCI device) whilst 1323eda59b39SMark Cave-Ayland * dma_enabled is still set. 1324eda59b39SMark Cave-Ayland */ 1325eda59b39SMark Cave-Ayland 1326eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque) 1327eda59b39SMark Cave-Ayland { 1328eda59b39SMark Cave-Ayland ESPState *s = ESP(opaque); 1329eda59b39SMark Cave-Ayland 1330eda59b39SMark Cave-Ayland return s->dma_memory_read == NULL && s->dma_memory_write == NULL && 1331eda59b39SMark Cave-Ayland s->dma_enabled; 1332eda59b39SMark Cave-Ayland } 1333eda59b39SMark Cave-Ayland 1334eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = { 1335eda59b39SMark Cave-Ayland .name = "esp/pdma", 1336eda59b39SMark Cave-Ayland .version_id = 0, 1337eda59b39SMark Cave-Ayland .minimum_version_id = 0, 1338eda59b39SMark Cave-Ayland .needed = esp_pdma_needed, 13392d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1340eda59b39SMark Cave-Ayland VMSTATE_UINT8(pdma_cb, ESPState), 1341eda59b39SMark Cave-Ayland VMSTATE_END_OF_LIST() 1342eda59b39SMark Cave-Ayland } 1343eda59b39SMark Cave-Ayland }; 1344eda59b39SMark Cave-Ayland 134549ab747fSPaolo Bonzini const VMStateDescription vmstate_esp = { 134649ab747fSPaolo Bonzini .name = "esp", 13474eb86065SPaolo Bonzini .version_id = 6, 134849ab747fSPaolo Bonzini .minimum_version_id = 3, 13490bd005beSMark Cave-Ayland .post_load = esp_post_load, 13502d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 135149ab747fSPaolo Bonzini VMSTATE_BUFFER(rregs, ESPState), 135249ab747fSPaolo Bonzini VMSTATE_BUFFER(wregs, ESPState), 135349ab747fSPaolo Bonzini VMSTATE_INT32(ti_size, ESPState), 1354042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1355042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1356042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 135749ab747fSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 13584aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 13594aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 13604aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 13614aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 136249ab747fSPaolo Bonzini VMSTATE_UINT32(dma, ESPState), 1363023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1364023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1365023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1366023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1367023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1368023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 136949ab747fSPaolo Bonzini VMSTATE_UINT32(do_cmd, ESPState), 13706cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 13714e78f3bfSMark Cave-Ayland VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5), 1372023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1373042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1374023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 13751b9e48a5SMark Cave-Ayland VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5), 13764eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 137749ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 137874d71ea1SLaurent Vivier }, 13792d7b39a6SRichard Henderson .subsections = (const VMStateDescription * const []) { 1380eda59b39SMark Cave-Ayland &vmstate_esp_pdma, 1381eda59b39SMark Cave-Ayland NULL 1382eda59b39SMark Cave-Ayland } 138349ab747fSPaolo Bonzini }; 138449ab747fSPaolo Bonzini 138549ab747fSPaolo Bonzini static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 138649ab747fSPaolo Bonzini uint64_t val, unsigned int size) 138749ab747fSPaolo Bonzini { 138849ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1389eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 139049ab747fSPaolo Bonzini uint32_t saddr; 139149ab747fSPaolo Bonzini 139249ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1393eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 139449ab747fSPaolo Bonzini } 139549ab747fSPaolo Bonzini 139649ab747fSPaolo Bonzini static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 139749ab747fSPaolo Bonzini unsigned int size) 139849ab747fSPaolo Bonzini { 139949ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1400eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 140149ab747fSPaolo Bonzini uint32_t saddr; 140249ab747fSPaolo Bonzini 140349ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1404eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 140549ab747fSPaolo Bonzini } 140649ab747fSPaolo Bonzini 140749ab747fSPaolo Bonzini static const MemoryRegionOps sysbus_esp_mem_ops = { 140849ab747fSPaolo Bonzini .read = sysbus_esp_mem_read, 140949ab747fSPaolo Bonzini .write = sysbus_esp_mem_write, 141049ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 141149ab747fSPaolo Bonzini .valid.accepts = esp_mem_accepts, 141249ab747fSPaolo Bonzini }; 141349ab747fSPaolo Bonzini 141474d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 141574d71ea1SLaurent Vivier uint64_t val, unsigned int size) 141674d71ea1SLaurent Vivier { 141774d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1418eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 141974d71ea1SLaurent Vivier 1420960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1421960ebfd9SMark Cave-Ayland 142274d71ea1SLaurent Vivier switch (size) { 142374d71ea1SLaurent Vivier case 1: 1424761bef75SMark Cave-Ayland esp_pdma_write(s, val); 142574d71ea1SLaurent Vivier break; 142674d71ea1SLaurent Vivier case 2: 1427761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1428761bef75SMark Cave-Ayland esp_pdma_write(s, val); 142974d71ea1SLaurent Vivier break; 143074d71ea1SLaurent Vivier } 1431d0243b09SMark Cave-Ayland esp_pdma_cb(s); 143274d71ea1SLaurent Vivier } 143374d71ea1SLaurent Vivier 143474d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 143574d71ea1SLaurent Vivier unsigned int size) 143674d71ea1SLaurent Vivier { 143774d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1438eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 143974d71ea1SLaurent Vivier uint64_t val = 0; 144074d71ea1SLaurent Vivier 1441960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1442960ebfd9SMark Cave-Ayland 144374d71ea1SLaurent Vivier switch (size) { 144474d71ea1SLaurent Vivier case 1: 1445761bef75SMark Cave-Ayland val = esp_pdma_read(s); 144674d71ea1SLaurent Vivier break; 144774d71ea1SLaurent Vivier case 2: 1448761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1449761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 145074d71ea1SLaurent Vivier break; 145174d71ea1SLaurent Vivier } 14527aa6baeeSMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 1453d0243b09SMark Cave-Ayland esp_pdma_cb(s); 145474d71ea1SLaurent Vivier } 145574d71ea1SLaurent Vivier return val; 145674d71ea1SLaurent Vivier } 145774d71ea1SLaurent Vivier 1458a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1459a7a22088SMark Cave-Ayland { 1460a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1461a7a22088SMark Cave-Ayland 1462a7a22088SMark Cave-Ayland scsi_req_ref(req); 1463a7a22088SMark Cave-Ayland s->current_req = req; 1464a7a22088SMark Cave-Ayland return s; 1465a7a22088SMark Cave-Ayland } 1466a7a22088SMark Cave-Ayland 146774d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 146874d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 146974d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 147074d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 147174d71ea1SLaurent Vivier .valid.min_access_size = 1, 1472cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1473cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1474cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 147574d71ea1SLaurent Vivier }; 147674d71ea1SLaurent Vivier 147749ab747fSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 147849ab747fSPaolo Bonzini .tcq = false, 147949ab747fSPaolo Bonzini .max_target = ESP_MAX_DEVS, 148049ab747fSPaolo Bonzini .max_lun = 7, 148149ab747fSPaolo Bonzini 1482a7a22088SMark Cave-Ayland .load_request = esp_load_request, 148349ab747fSPaolo Bonzini .transfer_data = esp_transfer_data, 148449ab747fSPaolo Bonzini .complete = esp_command_complete, 148549ab747fSPaolo Bonzini .cancel = esp_request_cancelled 148649ab747fSPaolo Bonzini }; 148749ab747fSPaolo Bonzini 148849ab747fSPaolo Bonzini static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 148949ab747fSPaolo Bonzini { 149084fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1491eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 149249ab747fSPaolo Bonzini 149349ab747fSPaolo Bonzini switch (irq) { 149449ab747fSPaolo Bonzini case 0: 149549ab747fSPaolo Bonzini parent_esp_reset(s, irq, level); 149649ab747fSPaolo Bonzini break; 149749ab747fSPaolo Bonzini case 1: 1498b86dc5cbSMark Cave-Ayland esp_dma_enable(s, irq, level); 149949ab747fSPaolo Bonzini break; 150049ab747fSPaolo Bonzini } 150149ab747fSPaolo Bonzini } 150249ab747fSPaolo Bonzini 1503b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 150449ab747fSPaolo Bonzini { 1505b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 150684fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1507eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1508eb169c76SMark Cave-Ayland 1509eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1510eb169c76SMark Cave-Ayland return; 1511eb169c76SMark Cave-Ayland } 151249ab747fSPaolo Bonzini 1513b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 151474d71ea1SLaurent Vivier sysbus_init_irq(sbd, &s->irq_data); 151549ab747fSPaolo Bonzini assert(sysbus->it_shift != -1); 151649ab747fSPaolo Bonzini 151749ab747fSPaolo Bonzini s->chip_id = TCHI_FAS100A; 151829776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 151974d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1520b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 152174d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1522cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 152374d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 152449ab747fSPaolo Bonzini 1525b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 152649ab747fSPaolo Bonzini 1527739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 152849ab747fSPaolo Bonzini } 152949ab747fSPaolo Bonzini 153049ab747fSPaolo Bonzini static void sysbus_esp_hard_reset(DeviceState *dev) 153149ab747fSPaolo Bonzini { 153284fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1533eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1534eb169c76SMark Cave-Ayland 1535eb169c76SMark Cave-Ayland esp_hard_reset(s); 1536eb169c76SMark Cave-Ayland } 1537eb169c76SMark Cave-Ayland 1538eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1539eb169c76SMark Cave-Ayland { 1540eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1541eb169c76SMark Cave-Ayland 1542eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 154349ab747fSPaolo Bonzini } 154449ab747fSPaolo Bonzini 154549ab747fSPaolo Bonzini static const VMStateDescription vmstate_sysbus_esp_scsi = { 154649ab747fSPaolo Bonzini .name = "sysbusespscsi", 15470bd005beSMark Cave-Ayland .version_id = 2, 1548ea84a442SGuenter Roeck .minimum_version_id = 1, 1549ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 15502d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 15510bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 155249ab747fSPaolo Bonzini VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 155349ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 155449ab747fSPaolo Bonzini } 155549ab747fSPaolo Bonzini }; 155649ab747fSPaolo Bonzini 155749ab747fSPaolo Bonzini static void sysbus_esp_class_init(ObjectClass *klass, void *data) 155849ab747fSPaolo Bonzini { 155949ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 156049ab747fSPaolo Bonzini 1561b09318caSHu Tao dc->realize = sysbus_esp_realize; 156249ab747fSPaolo Bonzini dc->reset = sysbus_esp_hard_reset; 156349ab747fSPaolo Bonzini dc->vmsd = &vmstate_sysbus_esp_scsi; 1564125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 156549ab747fSPaolo Bonzini } 156649ab747fSPaolo Bonzini 156749ab747fSPaolo Bonzini static const TypeInfo sysbus_esp_info = { 156884fbefedSMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 156949ab747fSPaolo Bonzini .parent = TYPE_SYS_BUS_DEVICE, 1570eb169c76SMark Cave-Ayland .instance_init = sysbus_esp_init, 157149ab747fSPaolo Bonzini .instance_size = sizeof(SysBusESPState), 157249ab747fSPaolo Bonzini .class_init = sysbus_esp_class_init, 157349ab747fSPaolo Bonzini }; 157449ab747fSPaolo Bonzini 1575042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1576042879fcSMark Cave-Ayland { 1577042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1578042879fcSMark Cave-Ayland 1579042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1580023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1581042879fcSMark Cave-Ayland } 1582042879fcSMark Cave-Ayland 1583042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1584042879fcSMark Cave-Ayland { 1585042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1586042879fcSMark Cave-Ayland 1587042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1588023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1589042879fcSMark Cave-Ayland } 1590042879fcSMark Cave-Ayland 1591eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1592eb169c76SMark Cave-Ayland { 1593eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1594eb169c76SMark Cave-Ayland 1595eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1596eb169c76SMark Cave-Ayland dc->user_creatable = false; 1597eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1598eb169c76SMark Cave-Ayland } 1599eb169c76SMark Cave-Ayland 1600eb169c76SMark Cave-Ayland static const TypeInfo esp_info = { 1601eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1602eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1603042879fcSMark Cave-Ayland .instance_init = esp_init, 1604042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1605eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1606eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1607eb169c76SMark Cave-Ayland }; 1608eb169c76SMark Cave-Ayland 160949ab747fSPaolo Bonzini static void esp_register_types(void) 161049ab747fSPaolo Bonzini { 161149ab747fSPaolo Bonzini type_register_static(&sysbus_esp_info); 1612eb169c76SMark Cave-Ayland type_register_static(&esp_info); 161349ab747fSPaolo Bonzini } 161449ab747fSPaolo Bonzini 161549ab747fSPaolo Bonzini type_init(esp_register_types) 1616