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 186761bef75SMark Cave-Ayland static uint8_t esp_pdma_read(ESPState *s) 187761bef75SMark Cave-Ayland { 1888da90e81SMark Cave-Ayland uint8_t val; 1898da90e81SMark Cave-Ayland 19002abe246SMark Cave-Ayland if (s->do_cmd) { 191c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->cmdfifo); 19202abe246SMark Cave-Ayland } else { 193c5fef911SMark Cave-Ayland val = esp_fifo_pop(&s->fifo); 19402abe246SMark Cave-Ayland } 1958da90e81SMark Cave-Ayland 1968da90e81SMark Cave-Ayland return val; 197761bef75SMark Cave-Ayland } 198761bef75SMark Cave-Ayland 199761bef75SMark Cave-Ayland static void esp_pdma_write(ESPState *s, uint8_t val) 200761bef75SMark Cave-Ayland { 2018da90e81SMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 2028da90e81SMark Cave-Ayland 2033c421400SMark Cave-Ayland if (dmalen == 0) { 2048da90e81SMark Cave-Ayland return; 2058da90e81SMark Cave-Ayland } 2068da90e81SMark Cave-Ayland 20702abe246SMark Cave-Ayland if (s->do_cmd) { 208e5455b8cSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, val); 20902abe246SMark Cave-Ayland } else { 210e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 21102abe246SMark Cave-Ayland } 2128da90e81SMark Cave-Ayland 2138da90e81SMark Cave-Ayland dmalen--; 2148da90e81SMark Cave-Ayland esp_set_tc(s, dmalen); 215761bef75SMark Cave-Ayland } 216761bef75SMark Cave-Ayland 21777987ef5SMark Cave-Ayland static void esp_set_pdma_cb(ESPState *s, enum pdma_cb cb) 2181e794c51SMark Cave-Ayland { 2191e794c51SMark Cave-Ayland s->pdma_cb = cb; 2201e794c51SMark Cave-Ayland } 2211e794c51SMark Cave-Ayland 222c7bce09cSMark Cave-Ayland static int esp_select(ESPState *s) 2236130b188SLaurent Vivier { 2246130b188SLaurent Vivier int target; 2256130b188SLaurent Vivier 2266130b188SLaurent Vivier target = s->wregs[ESP_WBUSID] & BUSID_DID; 2276130b188SLaurent Vivier 2286130b188SLaurent Vivier s->ti_size = 0; 2296130b188SLaurent Vivier 230cf40a5e4SMark Cave-Ayland if (s->current_req) { 231cf40a5e4SMark Cave-Ayland /* Started a new command before the old one finished. Cancel it. */ 232cf40a5e4SMark Cave-Ayland scsi_req_cancel(s->current_req); 233cf40a5e4SMark Cave-Ayland } 234cf40a5e4SMark Cave-Ayland 2356130b188SLaurent Vivier s->current_dev = scsi_device_find(&s->bus, 0, target, 0); 2366130b188SLaurent Vivier if (!s->current_dev) { 2376130b188SLaurent Vivier /* No such drive */ 2386130b188SLaurent Vivier s->rregs[ESP_RSTAT] = 0; 239cf1a7a9bSMark Cave-Ayland s->rregs[ESP_RINTR] = INTR_DC; 2406130b188SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_0; 2416130b188SLaurent Vivier esp_raise_irq(s); 2426130b188SLaurent Vivier return -1; 2436130b188SLaurent Vivier } 2444e78f3bfSMark Cave-Ayland 2454e78f3bfSMark Cave-Ayland /* 2464e78f3bfSMark Cave-Ayland * Note that we deliberately don't raise the IRQ here: this will be done 2474eb86065SPaolo Bonzini * either in do_command_phase() for DATA OUT transfers or by the deferred 2484e78f3bfSMark Cave-Ayland * IRQ mechanism in esp_transfer_data() for DATA IN transfers 2494e78f3bfSMark Cave-Ayland */ 2504e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 2514e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 2526130b188SLaurent Vivier return 0; 2536130b188SLaurent Vivier } 2546130b188SLaurent Vivier 25520c8d2edSMark Cave-Ayland static uint32_t get_cmd(ESPState *s, uint32_t maxlen) 25649ab747fSPaolo Bonzini { 257023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 258042879fcSMark Cave-Ayland uint32_t dmalen, n; 25949ab747fSPaolo Bonzini int target; 26049ab747fSPaolo Bonzini 26149ab747fSPaolo Bonzini target = s->wregs[ESP_WBUSID] & BUSID_DID; 26249ab747fSPaolo Bonzini if (s->dma) { 26320c8d2edSMark Cave-Ayland dmalen = MIN(esp_get_tc(s), maxlen); 26420c8d2edSMark Cave-Ayland if (dmalen == 0) { 2656c1fef6bSPrasad J Pandit return 0; 2666c1fef6bSPrasad J Pandit } 26774d71ea1SLaurent Vivier if (s->dma_memory_read) { 26849ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, buf, dmalen); 269fbc6510eSMark Cave-Ayland dmalen = MIN(fifo8_num_free(&s->cmdfifo), dmalen); 270023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, dmalen); 27149ab747fSPaolo Bonzini } else { 27274d71ea1SLaurent Vivier return 0; 27374d71ea1SLaurent Vivier } 27474d71ea1SLaurent Vivier } else { 275023666daSMark Cave-Ayland dmalen = MIN(fifo8_num_used(&s->fifo), maxlen); 27620c8d2edSMark Cave-Ayland if (dmalen == 0) { 277d3cdc491SPrasad J Pandit return 0; 278d3cdc491SPrasad J Pandit } 2797b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, buf, dmalen); 280fbc6510eSMark Cave-Ayland n = MIN(fifo8_num_free(&s->cmdfifo), n); 2817b320a8eSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, n); 28220c8d2edSMark Cave-Ayland } 28349ab747fSPaolo Bonzini trace_esp_get_cmd(dmalen, target); 28449ab747fSPaolo Bonzini 28549ab747fSPaolo Bonzini return dmalen; 28649ab747fSPaolo Bonzini } 28749ab747fSPaolo Bonzini 2884eb86065SPaolo Bonzini static void do_command_phase(ESPState *s) 28949ab747fSPaolo Bonzini { 2907b320a8eSMark Cave-Ayland uint32_t cmdlen; 29149ab747fSPaolo Bonzini int32_t datalen; 29249ab747fSPaolo Bonzini SCSIDevice *current_lun; 2937b320a8eSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 29449ab747fSPaolo Bonzini 2954eb86065SPaolo Bonzini trace_esp_do_command_phase(s->lun); 296023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 29799545751SMark Cave-Ayland if (!cmdlen || !s->current_dev) { 29899545751SMark Cave-Ayland return; 29999545751SMark Cave-Ayland } 3007b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, buf, cmdlen); 301023666daSMark Cave-Ayland 3024eb86065SPaolo Bonzini current_lun = scsi_device_find(&s->bus, 0, s->current_dev->id, s->lun); 303b22f83d8SAlexandra Diupina if (!current_lun) { 304b22f83d8SAlexandra Diupina /* No such drive */ 305b22f83d8SAlexandra Diupina s->rregs[ESP_RSTAT] = 0; 306b22f83d8SAlexandra Diupina s->rregs[ESP_RINTR] = INTR_DC; 307b22f83d8SAlexandra Diupina s->rregs[ESP_RSEQ] = SEQ_0; 308b22f83d8SAlexandra Diupina esp_raise_irq(s); 309b22f83d8SAlexandra Diupina return; 310b22f83d8SAlexandra Diupina } 311b22f83d8SAlexandra Diupina 312fe9d8927SJohn Millikin s->current_req = scsi_req_new(current_lun, 0, s->lun, buf, cmdlen, s); 31349ab747fSPaolo Bonzini datalen = scsi_req_enqueue(s->current_req); 31449ab747fSPaolo Bonzini s->ti_size = datalen; 315023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 31649ab747fSPaolo Bonzini if (datalen != 0) { 31749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC; 3184e78f3bfSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 3191b9e48a5SMark Cave-Ayland s->ti_cmd = 0; 3206cc88d6bSMark Cave-Ayland esp_set_tc(s, 0); 32149ab747fSPaolo Bonzini if (datalen > 0) { 3224e78f3bfSMark Cave-Ayland /* 3234e78f3bfSMark Cave-Ayland * Switch to DATA IN phase but wait until initial data xfer is 3244e78f3bfSMark Cave-Ayland * complete before raising the command completion interrupt 3254e78f3bfSMark Cave-Ayland */ 3264e78f3bfSMark Cave-Ayland s->data_in_ready = false; 32749ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_DI; 32849ab747fSPaolo Bonzini } else { 32949ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_DO; 330cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 33149ab747fSPaolo Bonzini esp_raise_irq(s); 33282141c8bSMark Cave-Ayland esp_lower_drq(s); 33349ab747fSPaolo Bonzini } 3344e78f3bfSMark Cave-Ayland scsi_req_continue(s->current_req); 3354e78f3bfSMark Cave-Ayland return; 3364e78f3bfSMark Cave-Ayland } 3374e78f3bfSMark Cave-Ayland } 33849ab747fSPaolo Bonzini 3394eb86065SPaolo Bonzini static void do_message_phase(ESPState *s) 34049ab747fSPaolo Bonzini { 3414eb86065SPaolo Bonzini if (s->cmdfifo_cdb_offset) { 3424eb86065SPaolo Bonzini uint8_t message = esp_fifo_pop(&s->cmdfifo); 343023666daSMark Cave-Ayland 3444eb86065SPaolo Bonzini trace_esp_do_identify(message); 3454eb86065SPaolo Bonzini s->lun = message & 7; 346023666daSMark Cave-Ayland s->cmdfifo_cdb_offset--; 3474eb86065SPaolo Bonzini } 34849ab747fSPaolo Bonzini 349799d90d8SMark Cave-Ayland /* Ignore extended messages for now */ 350023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset) { 3514eb86065SPaolo Bonzini int len = MIN(s->cmdfifo_cdb_offset, fifo8_num_used(&s->cmdfifo)); 352fa7505c1SMark Cave-Ayland esp_fifo_pop_buf(&s->cmdfifo, NULL, len); 353023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 354023666daSMark Cave-Ayland } 3554eb86065SPaolo Bonzini } 356023666daSMark Cave-Ayland 3574eb86065SPaolo Bonzini static void do_cmd(ESPState *s) 3584eb86065SPaolo Bonzini { 3594eb86065SPaolo Bonzini do_message_phase(s); 3604eb86065SPaolo Bonzini assert(s->cmdfifo_cdb_offset == 0); 3614eb86065SPaolo Bonzini do_command_phase(s); 36249ab747fSPaolo Bonzini } 36349ab747fSPaolo Bonzini 36474d71ea1SLaurent Vivier static void satn_pdma_cb(ESPState *s) 36574d71ea1SLaurent Vivier { 366e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 367023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 368e62a959aSMark Cave-Ayland s->do_cmd = 0; 369c959f218SMark Cave-Ayland do_cmd(s); 37074d71ea1SLaurent Vivier } 37174d71ea1SLaurent Vivier } 37274d71ea1SLaurent Vivier 37349ab747fSPaolo Bonzini static void handle_satn(ESPState *s) 37449ab747fSPaolo Bonzini { 37549691315SMark Cave-Ayland int32_t cmdlen; 37649691315SMark Cave-Ayland 37749ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 37849ab747fSPaolo Bonzini s->dma_cb = handle_satn; 37949ab747fSPaolo Bonzini return; 38049ab747fSPaolo Bonzini } 38177987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_PDMA_CB); 3821bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 3831bcaf71bSMark Cave-Ayland return; 3841bcaf71bSMark Cave-Ayland } 385023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 38649691315SMark Cave-Ayland if (cmdlen > 0) { 387023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 38860720694SMark Cave-Ayland s->do_cmd = 0; 389c959f218SMark Cave-Ayland do_cmd(s); 39049691315SMark Cave-Ayland } else if (cmdlen == 0) { 3911bcaf71bSMark Cave-Ayland if (s->dma) { 3921bcaf71bSMark Cave-Ayland esp_raise_drq(s); 3931bcaf71bSMark Cave-Ayland } 394bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 39549691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 39649691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 39749691315SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_CD; 39849ab747fSPaolo Bonzini } 39994d5c79dSMark Cave-Ayland } 40049ab747fSPaolo Bonzini 40174d71ea1SLaurent Vivier static void s_without_satn_pdma_cb(ESPState *s) 40274d71ea1SLaurent Vivier { 403e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 404023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 405e62a959aSMark Cave-Ayland s->do_cmd = 0; 4064eb86065SPaolo Bonzini do_cmd(s); 40774d71ea1SLaurent Vivier } 40874d71ea1SLaurent Vivier } 40974d71ea1SLaurent Vivier 41049ab747fSPaolo Bonzini static void handle_s_without_atn(ESPState *s) 41149ab747fSPaolo Bonzini { 41249691315SMark Cave-Ayland int32_t cmdlen; 41349691315SMark Cave-Ayland 41449ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 41549ab747fSPaolo Bonzini s->dma_cb = handle_s_without_atn; 41649ab747fSPaolo Bonzini return; 41749ab747fSPaolo Bonzini } 41877987ef5SMark Cave-Ayland esp_set_pdma_cb(s, S_WITHOUT_SATN_PDMA_CB); 4191bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4201bcaf71bSMark Cave-Ayland return; 4211bcaf71bSMark Cave-Ayland } 422023666daSMark Cave-Ayland cmdlen = get_cmd(s, ESP_CMDFIFO_SZ); 42349691315SMark Cave-Ayland if (cmdlen > 0) { 424023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 0; 42560720694SMark Cave-Ayland s->do_cmd = 0; 4264eb86065SPaolo Bonzini do_cmd(s); 42749691315SMark Cave-Ayland } else if (cmdlen == 0) { 4281bcaf71bSMark Cave-Ayland if (s->dma) { 4291bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4301bcaf71bSMark Cave-Ayland } 431bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 43249691315SMark Cave-Ayland /* Target present, but no cmd yet - switch to command phase */ 43349691315SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 43449691315SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_CD; 43549ab747fSPaolo Bonzini } 43649ab747fSPaolo Bonzini } 43749ab747fSPaolo Bonzini 43874d71ea1SLaurent Vivier static void satn_stop_pdma_cb(ESPState *s) 43974d71ea1SLaurent Vivier { 440e62a959aSMark Cave-Ayland if (!esp_get_tc(s) && !fifo8_is_empty(&s->cmdfifo)) { 441023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 44274d71ea1SLaurent Vivier s->do_cmd = 1; 443023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 44474d71ea1SLaurent Vivier s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 445cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 44674d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 44774d71ea1SLaurent Vivier esp_raise_irq(s); 44874d71ea1SLaurent Vivier } 44974d71ea1SLaurent Vivier } 45074d71ea1SLaurent Vivier 45149ab747fSPaolo Bonzini static void handle_satn_stop(ESPState *s) 45249ab747fSPaolo Bonzini { 45349691315SMark Cave-Ayland int32_t cmdlen; 45449691315SMark Cave-Ayland 45549ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 45649ab747fSPaolo Bonzini s->dma_cb = handle_satn_stop; 45749ab747fSPaolo Bonzini return; 45849ab747fSPaolo Bonzini } 45977987ef5SMark Cave-Ayland esp_set_pdma_cb(s, SATN_STOP_PDMA_CB); 4601bcaf71bSMark Cave-Ayland if (esp_select(s) < 0) { 4611bcaf71bSMark Cave-Ayland return; 4621bcaf71bSMark Cave-Ayland } 463799d90d8SMark Cave-Ayland cmdlen = get_cmd(s, 1); 46449691315SMark Cave-Ayland if (cmdlen > 0) { 465023666daSMark Cave-Ayland trace_esp_handle_satn_stop(fifo8_num_used(&s->cmdfifo)); 46649ab747fSPaolo Bonzini s->do_cmd = 1; 467023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = 1; 468799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_MO; 469cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 470799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 47149ab747fSPaolo Bonzini esp_raise_irq(s); 47249691315SMark Cave-Ayland } else if (cmdlen == 0) { 4731bcaf71bSMark Cave-Ayland if (s->dma) { 4741bcaf71bSMark Cave-Ayland esp_raise_drq(s); 4751bcaf71bSMark Cave-Ayland } 476bb0bc7bbSMark Cave-Ayland s->do_cmd = 1; 477799d90d8SMark Cave-Ayland /* Target present, switch to message out phase */ 478799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_MO; 479799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_MO; 48049ab747fSPaolo Bonzini } 48149ab747fSPaolo Bonzini } 48249ab747fSPaolo Bonzini 48374d71ea1SLaurent Vivier static void write_response_pdma_cb(ESPState *s) 48474d71ea1SLaurent Vivier { 48574d71ea1SLaurent Vivier s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 486cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 48774d71ea1SLaurent Vivier s->rregs[ESP_RSEQ] = SEQ_CD; 48874d71ea1SLaurent Vivier esp_raise_irq(s); 48974d71ea1SLaurent Vivier } 49074d71ea1SLaurent Vivier 49149ab747fSPaolo Bonzini static void write_response(ESPState *s) 49249ab747fSPaolo Bonzini { 493e3922557SMark Cave-Ayland uint8_t buf[2]; 494042879fcSMark Cave-Ayland 49549ab747fSPaolo Bonzini trace_esp_write_response(s->status); 496042879fcSMark Cave-Ayland 497e3922557SMark Cave-Ayland buf[0] = s->status; 498e3922557SMark Cave-Ayland buf[1] = 0; 499042879fcSMark Cave-Ayland 50049ab747fSPaolo Bonzini if (s->dma) { 50174d71ea1SLaurent Vivier if (s->dma_memory_write) { 502e3922557SMark Cave-Ayland s->dma_memory_write(s->dma_opaque, buf, 2); 50349ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 504cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS | INTR_FC; 50549ab747fSPaolo Bonzini s->rregs[ESP_RSEQ] = SEQ_CD; 50649ab747fSPaolo Bonzini } else { 50777987ef5SMark Cave-Ayland esp_set_pdma_cb(s, WRITE_RESPONSE_PDMA_CB); 50874d71ea1SLaurent Vivier esp_raise_drq(s); 50974d71ea1SLaurent Vivier return; 51074d71ea1SLaurent Vivier } 51174d71ea1SLaurent Vivier } else { 512e3922557SMark Cave-Ayland fifo8_reset(&s->fifo); 513e3922557SMark Cave-Ayland fifo8_push_all(&s->fifo, buf, 2); 51449ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 2; 51549ab747fSPaolo Bonzini } 51649ab747fSPaolo Bonzini esp_raise_irq(s); 51749ab747fSPaolo Bonzini } 51849ab747fSPaolo Bonzini 51949ab747fSPaolo Bonzini static void esp_dma_done(ESPState *s) 52049ab747fSPaolo Bonzini { 52149ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] |= STAT_TC; 522cf47a41eSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 52349ab747fSPaolo Bonzini s->rregs[ESP_RFLAGS] = 0; 524c47b5835SMark Cave-Ayland esp_set_tc(s, 0); 52549ab747fSPaolo Bonzini esp_raise_irq(s); 52649ab747fSPaolo Bonzini } 52749ab747fSPaolo Bonzini 52874d71ea1SLaurent Vivier static void do_dma_pdma_cb(ESPState *s) 52974d71ea1SLaurent Vivier { 5304ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 53182141c8bSMark Cave-Ayland int len; 532042879fcSMark Cave-Ayland uint32_t n; 5336cc88d6bSMark Cave-Ayland 53474d71ea1SLaurent Vivier if (s->do_cmd) { 535e62a959aSMark Cave-Ayland /* Ensure we have received complete command after SATN and stop */ 536e62a959aSMark Cave-Ayland if (esp_get_tc(s) || fifo8_is_empty(&s->cmdfifo)) { 537e62a959aSMark Cave-Ayland return; 538e62a959aSMark Cave-Ayland } 539e62a959aSMark Cave-Ayland 54074d71ea1SLaurent Vivier s->ti_size = 0; 541c348458fSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 542c348458fSMark Cave-Ayland /* No command received */ 543c348458fSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 544c348458fSMark Cave-Ayland return; 545c348458fSMark Cave-Ayland } 546c348458fSMark Cave-Ayland 547c348458fSMark Cave-Ayland /* Command has been received */ 54874d71ea1SLaurent Vivier s->do_cmd = 0; 549c959f218SMark Cave-Ayland do_cmd(s); 550c348458fSMark Cave-Ayland } else { 551c348458fSMark Cave-Ayland /* 552c348458fSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 5532cb40d44SStefan Weil * and then switch to command phase 554c348458fSMark Cave-Ayland */ 555c348458fSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 556c348458fSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 557c348458fSMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 558c348458fSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 559c348458fSMark Cave-Ayland esp_raise_irq(s); 560c348458fSMark Cave-Ayland } 56174d71ea1SLaurent Vivier return; 56274d71ea1SLaurent Vivier } 56382141c8bSMark Cave-Ayland 5640db89536SMark Cave-Ayland if (!s->current_req) { 5650db89536SMark Cave-Ayland return; 5660db89536SMark Cave-Ayland } 5670db89536SMark Cave-Ayland 56882141c8bSMark Cave-Ayland if (to_device) { 56982141c8bSMark Cave-Ayland /* Copy FIFO data to device */ 5707aa6baeeSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 5717aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 5727b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5737aa6baeeSMark Cave-Ayland s->async_buf += n; 5747aa6baeeSMark Cave-Ayland s->async_len -= n; 5757aa6baeeSMark Cave-Ayland s->ti_size += n; 5767aa6baeeSMark Cave-Ayland 5777aa6baeeSMark Cave-Ayland if (n < len) { 5787aa6baeeSMark Cave-Ayland /* Unaligned accesses can cause FIFO wraparound */ 5797aa6baeeSMark Cave-Ayland len = len - n; 5807b320a8eSMark Cave-Ayland n = esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 5817aa6baeeSMark Cave-Ayland s->async_buf += n; 5827aa6baeeSMark Cave-Ayland s->async_len -= n; 5837aa6baeeSMark Cave-Ayland s->ti_size += n; 5847aa6baeeSMark Cave-Ayland } 5857aa6baeeSMark Cave-Ayland 58674d71ea1SLaurent Vivier if (s->async_len == 0) { 58774d71ea1SLaurent Vivier scsi_req_continue(s->current_req); 58882141c8bSMark Cave-Ayland return; 58982141c8bSMark Cave-Ayland } 59082141c8bSMark Cave-Ayland 59182141c8bSMark Cave-Ayland if (esp_get_tc(s) == 0) { 59282141c8bSMark Cave-Ayland esp_lower_drq(s); 59382141c8bSMark Cave-Ayland esp_dma_done(s); 59482141c8bSMark Cave-Ayland } 59582141c8bSMark Cave-Ayland 59682141c8bSMark Cave-Ayland return; 59782141c8bSMark Cave-Ayland } else { 59882141c8bSMark Cave-Ayland if (s->async_len == 0) { 5994e78f3bfSMark Cave-Ayland /* Defer until the scsi layer has completed */ 60082141c8bSMark Cave-Ayland scsi_req_continue(s->current_req); 6014e78f3bfSMark Cave-Ayland s->data_in_ready = false; 60274d71ea1SLaurent Vivier return; 60374d71ea1SLaurent Vivier } 60474d71ea1SLaurent Vivier 605*0f2eb110SMark Cave-Ayland if (esp_get_tc(s) == 0) { 606*0f2eb110SMark Cave-Ayland esp_lower_drq(s); 607*0f2eb110SMark Cave-Ayland esp_dma_done(s); 608*0f2eb110SMark Cave-Ayland } 609*0f2eb110SMark Cave-Ayland 61082141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 6117aa6baeeSMark Cave-Ayland len = MIN(s->async_len, esp_get_tc(s)); 6127aa6baeeSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 613042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 61482141c8bSMark Cave-Ayland s->async_buf += len; 61582141c8bSMark Cave-Ayland s->async_len -= len; 61682141c8bSMark Cave-Ayland s->ti_size -= len; 61782141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 61874d71ea1SLaurent Vivier } 61982141c8bSMark Cave-Ayland } 62074d71ea1SLaurent Vivier 62149ab747fSPaolo Bonzini static void esp_do_dma(ESPState *s) 62249ab747fSPaolo Bonzini { 623023666daSMark Cave-Ayland uint32_t len, cmdlen; 6244ca2ba6fSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 625023666daSMark Cave-Ayland uint8_t buf[ESP_CMDFIFO_SZ]; 62649ab747fSPaolo Bonzini 6276cc88d6bSMark Cave-Ayland len = esp_get_tc(s); 62849ab747fSPaolo Bonzini if (s->do_cmd) { 62915407433SLaurent Vivier /* 63015407433SLaurent Vivier * handle_ti_cmd() case: esp_do_dma() is called only from 63115407433SLaurent Vivier * handle_ti_cmd() with do_cmd != NULL (see the assert()) 63215407433SLaurent Vivier */ 633023666daSMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 634023666daSMark Cave-Ayland trace_esp_do_dma(cmdlen, len); 63574d71ea1SLaurent Vivier if (s->dma_memory_read) { 6360ebb5fd8SMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->cmdfifo)); 637023666daSMark Cave-Ayland s->dma_memory_read(s->dma_opaque, buf, len); 638023666daSMark Cave-Ayland fifo8_push_all(&s->cmdfifo, buf, len); 63974d71ea1SLaurent Vivier } else { 64077987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 64174d71ea1SLaurent Vivier esp_raise_drq(s); 64274d71ea1SLaurent Vivier return; 64374d71ea1SLaurent Vivier } 644023666daSMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 64515407433SLaurent Vivier s->ti_size = 0; 646799d90d8SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 647799d90d8SMark Cave-Ayland /* No command received */ 648023666daSMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 649799d90d8SMark Cave-Ayland return; 650799d90d8SMark Cave-Ayland } 651799d90d8SMark Cave-Ayland 652799d90d8SMark Cave-Ayland /* Command has been received */ 65315407433SLaurent Vivier s->do_cmd = 0; 654c959f218SMark Cave-Ayland do_cmd(s); 655799d90d8SMark Cave-Ayland } else { 656799d90d8SMark Cave-Ayland /* 657023666daSMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 6582cb40d44SStefan Weil * and then switch to command phase 659799d90d8SMark Cave-Ayland */ 660023666daSMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 661799d90d8SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 662799d90d8SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 663799d90d8SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 664799d90d8SMark Cave-Ayland esp_raise_irq(s); 665799d90d8SMark Cave-Ayland } 66649ab747fSPaolo Bonzini return; 66749ab747fSPaolo Bonzini } 6680db89536SMark Cave-Ayland if (!s->current_req) { 6690db89536SMark Cave-Ayland return; 6700db89536SMark Cave-Ayland } 67149ab747fSPaolo Bonzini if (s->async_len == 0) { 67249ab747fSPaolo Bonzini /* Defer until data is available. */ 67349ab747fSPaolo Bonzini return; 67449ab747fSPaolo Bonzini } 67549ab747fSPaolo Bonzini if (len > s->async_len) { 67649ab747fSPaolo Bonzini len = s->async_len; 67749ab747fSPaolo Bonzini } 67849ab747fSPaolo Bonzini if (to_device) { 67974d71ea1SLaurent Vivier if (s->dma_memory_read) { 68049ab747fSPaolo Bonzini s->dma_memory_read(s->dma_opaque, s->async_buf, len); 68149ab747fSPaolo Bonzini } else { 68277987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 68374d71ea1SLaurent Vivier esp_raise_drq(s); 68474d71ea1SLaurent Vivier return; 68574d71ea1SLaurent Vivier } 68674d71ea1SLaurent Vivier } else { 68774d71ea1SLaurent Vivier if (s->dma_memory_write) { 68849ab747fSPaolo Bonzini s->dma_memory_write(s->dma_opaque, s->async_buf, len); 68974d71ea1SLaurent Vivier } else { 6907aa6baeeSMark Cave-Ayland /* Adjust TC for any leftover data in the FIFO */ 6917aa6baeeSMark Cave-Ayland if (!fifo8_is_empty(&s->fifo)) { 6927aa6baeeSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - fifo8_num_used(&s->fifo)); 6937aa6baeeSMark Cave-Ayland } 6947aa6baeeSMark Cave-Ayland 69582141c8bSMark Cave-Ayland /* Copy device data to FIFO */ 696042879fcSMark Cave-Ayland len = MIN(len, fifo8_num_free(&s->fifo)); 697042879fcSMark Cave-Ayland fifo8_push_all(&s->fifo, s->async_buf, len); 69882141c8bSMark Cave-Ayland s->async_buf += len; 69982141c8bSMark Cave-Ayland s->async_len -= len; 70082141c8bSMark Cave-Ayland s->ti_size -= len; 7017aa6baeeSMark Cave-Ayland 7027aa6baeeSMark Cave-Ayland /* 7037aa6baeeSMark Cave-Ayland * MacOS toolbox uses a TI length of 16 bytes for all commands, so 7047aa6baeeSMark Cave-Ayland * commands shorter than this must be padded accordingly 7057aa6baeeSMark Cave-Ayland */ 7067aa6baeeSMark Cave-Ayland if (len < esp_get_tc(s) && esp_get_tc(s) <= ESP_FIFO_SZ) { 7077aa6baeeSMark Cave-Ayland while (fifo8_num_used(&s->fifo) < ESP_FIFO_SZ) { 708e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, 0); 7097aa6baeeSMark Cave-Ayland len++; 7107aa6baeeSMark Cave-Ayland } 7117aa6baeeSMark Cave-Ayland } 7127aa6baeeSMark Cave-Ayland 71382141c8bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 71477987ef5SMark Cave-Ayland esp_set_pdma_cb(s, DO_DMA_PDMA_CB); 71574d71ea1SLaurent Vivier esp_raise_drq(s); 71674d71ea1SLaurent Vivier return; 71774d71ea1SLaurent Vivier } 71849ab747fSPaolo Bonzini } 7196cc88d6bSMark Cave-Ayland esp_set_tc(s, esp_get_tc(s) - len); 72049ab747fSPaolo Bonzini s->async_buf += len; 72149ab747fSPaolo Bonzini s->async_len -= len; 72294d5c79dSMark Cave-Ayland if (to_device) { 72349ab747fSPaolo Bonzini s->ti_size += len; 72494d5c79dSMark Cave-Ayland } else { 72549ab747fSPaolo Bonzini s->ti_size -= len; 72694d5c79dSMark Cave-Ayland } 72749ab747fSPaolo Bonzini if (s->async_len == 0) { 72849ab747fSPaolo Bonzini scsi_req_continue(s->current_req); 72994d5c79dSMark Cave-Ayland /* 73094d5c79dSMark Cave-Ayland * If there is still data to be read from the device then 73194d5c79dSMark Cave-Ayland * complete the DMA operation immediately. Otherwise defer 73294d5c79dSMark Cave-Ayland * until the scsi layer has completed. 73394d5c79dSMark Cave-Ayland */ 7346cc88d6bSMark Cave-Ayland if (to_device || esp_get_tc(s) != 0 || s->ti_size == 0) { 73549ab747fSPaolo Bonzini return; 73649ab747fSPaolo Bonzini } 73749ab747fSPaolo Bonzini } 73849ab747fSPaolo Bonzini 73949ab747fSPaolo Bonzini /* Partially filled a scsi buffer. Complete immediately. */ 74049ab747fSPaolo Bonzini esp_dma_done(s); 74182141c8bSMark Cave-Ayland esp_lower_drq(s); 74249ab747fSPaolo Bonzini } 74349ab747fSPaolo Bonzini 7441b9e48a5SMark Cave-Ayland static void esp_do_nodma(ESPState *s) 7451b9e48a5SMark Cave-Ayland { 7461b9e48a5SMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 7477b320a8eSMark Cave-Ayland uint32_t cmdlen; 7481b9e48a5SMark Cave-Ayland int len; 7491b9e48a5SMark Cave-Ayland 7501b9e48a5SMark Cave-Ayland if (s->do_cmd) { 7511b9e48a5SMark Cave-Ayland cmdlen = fifo8_num_used(&s->cmdfifo); 7521b9e48a5SMark Cave-Ayland trace_esp_handle_ti_cmd(cmdlen); 7531b9e48a5SMark Cave-Ayland s->ti_size = 0; 7541b9e48a5SMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 7) == STAT_CD) { 7551b9e48a5SMark Cave-Ayland /* No command received */ 7561b9e48a5SMark Cave-Ayland if (s->cmdfifo_cdb_offset == fifo8_num_used(&s->cmdfifo)) { 7571b9e48a5SMark Cave-Ayland return; 7581b9e48a5SMark Cave-Ayland } 7591b9e48a5SMark Cave-Ayland 7601b9e48a5SMark Cave-Ayland /* Command has been received */ 7611b9e48a5SMark Cave-Ayland s->do_cmd = 0; 7621b9e48a5SMark Cave-Ayland do_cmd(s); 7631b9e48a5SMark Cave-Ayland } else { 7641b9e48a5SMark Cave-Ayland /* 7651b9e48a5SMark Cave-Ayland * Extra message out bytes received: update cmdfifo_cdb_offset 7662cb40d44SStefan Weil * and then switch to command phase 7671b9e48a5SMark Cave-Ayland */ 7681b9e48a5SMark Cave-Ayland s->cmdfifo_cdb_offset = fifo8_num_used(&s->cmdfifo); 7691b9e48a5SMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_CD; 7701b9e48a5SMark Cave-Ayland s->rregs[ESP_RSEQ] = SEQ_CD; 7711b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 7721b9e48a5SMark Cave-Ayland esp_raise_irq(s); 7731b9e48a5SMark Cave-Ayland } 7741b9e48a5SMark Cave-Ayland return; 7751b9e48a5SMark Cave-Ayland } 7761b9e48a5SMark Cave-Ayland 7770db89536SMark Cave-Ayland if (!s->current_req) { 7780db89536SMark Cave-Ayland return; 7790db89536SMark Cave-Ayland } 7800db89536SMark Cave-Ayland 7811b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 7821b9e48a5SMark Cave-Ayland /* Defer until data is available. */ 7831b9e48a5SMark Cave-Ayland return; 7841b9e48a5SMark Cave-Ayland } 7851b9e48a5SMark Cave-Ayland 7861b9e48a5SMark Cave-Ayland if (to_device) { 78777668e4bSMark Cave-Ayland len = MIN(s->async_len, ESP_FIFO_SZ); 78877668e4bSMark Cave-Ayland len = MIN(len, fifo8_num_used(&s->fifo)); 7897b320a8eSMark Cave-Ayland esp_fifo_pop_buf(&s->fifo, s->async_buf, len); 7901b9e48a5SMark Cave-Ayland s->async_buf += len; 7911b9e48a5SMark Cave-Ayland s->async_len -= len; 7921b9e48a5SMark Cave-Ayland s->ti_size += len; 7931b9e48a5SMark Cave-Ayland } else { 7946ef2cabcSMark Cave-Ayland if (fifo8_is_empty(&s->fifo)) { 7956ef2cabcSMark Cave-Ayland fifo8_push(&s->fifo, s->async_buf[0]); 7966ef2cabcSMark Cave-Ayland s->async_buf++; 7976ef2cabcSMark Cave-Ayland s->async_len--; 7986ef2cabcSMark Cave-Ayland s->ti_size--; 7996ef2cabcSMark Cave-Ayland } 8001b9e48a5SMark Cave-Ayland } 8011b9e48a5SMark Cave-Ayland 8021b9e48a5SMark Cave-Ayland if (s->async_len == 0) { 8031b9e48a5SMark Cave-Ayland scsi_req_continue(s->current_req); 8041b9e48a5SMark Cave-Ayland return; 8051b9e48a5SMark Cave-Ayland } 8061b9e48a5SMark Cave-Ayland 8071b9e48a5SMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8081b9e48a5SMark Cave-Ayland esp_raise_irq(s); 8091b9e48a5SMark Cave-Ayland } 8101b9e48a5SMark Cave-Ayland 81177987ef5SMark Cave-Ayland static void esp_pdma_cb(ESPState *s) 81277987ef5SMark Cave-Ayland { 81377987ef5SMark Cave-Ayland switch (s->pdma_cb) { 81477987ef5SMark Cave-Ayland case SATN_PDMA_CB: 81577987ef5SMark Cave-Ayland satn_pdma_cb(s); 81677987ef5SMark Cave-Ayland break; 81777987ef5SMark Cave-Ayland case S_WITHOUT_SATN_PDMA_CB: 81877987ef5SMark Cave-Ayland s_without_satn_pdma_cb(s); 81977987ef5SMark Cave-Ayland break; 82077987ef5SMark Cave-Ayland case SATN_STOP_PDMA_CB: 82177987ef5SMark Cave-Ayland satn_stop_pdma_cb(s); 82277987ef5SMark Cave-Ayland break; 82377987ef5SMark Cave-Ayland case WRITE_RESPONSE_PDMA_CB: 82477987ef5SMark Cave-Ayland write_response_pdma_cb(s); 82577987ef5SMark Cave-Ayland break; 82677987ef5SMark Cave-Ayland case DO_DMA_PDMA_CB: 82777987ef5SMark Cave-Ayland do_dma_pdma_cb(s); 82877987ef5SMark Cave-Ayland break; 82977987ef5SMark Cave-Ayland default: 83077987ef5SMark Cave-Ayland g_assert_not_reached(); 83177987ef5SMark Cave-Ayland } 83277987ef5SMark Cave-Ayland } 83377987ef5SMark Cave-Ayland 8344aaa6ac3SMark Cave-Ayland void esp_command_complete(SCSIRequest *req, size_t resid) 83549ab747fSPaolo Bonzini { 8364aaa6ac3SMark Cave-Ayland ESPState *s = req->hba_private; 8376ef2cabcSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8384aaa6ac3SMark Cave-Ayland 83949ab747fSPaolo Bonzini trace_esp_command_complete(); 8406ef2cabcSMark Cave-Ayland 8416ef2cabcSMark Cave-Ayland /* 8426ef2cabcSMark Cave-Ayland * Non-DMA transfers from the target will leave the last byte in 8436ef2cabcSMark Cave-Ayland * the FIFO so don't reset ti_size in this case 8446ef2cabcSMark Cave-Ayland */ 8456ef2cabcSMark Cave-Ayland if (s->dma || to_device) { 84649ab747fSPaolo Bonzini if (s->ti_size != 0) { 84749ab747fSPaolo Bonzini trace_esp_command_complete_unexpected(); 84849ab747fSPaolo Bonzini } 84949ab747fSPaolo Bonzini s->ti_size = 0; 8506ef2cabcSMark Cave-Ayland } 8516ef2cabcSMark Cave-Ayland 85249ab747fSPaolo Bonzini s->async_len = 0; 8534aaa6ac3SMark Cave-Ayland if (req->status) { 85449ab747fSPaolo Bonzini trace_esp_command_complete_fail(); 85549ab747fSPaolo Bonzini } 8564aaa6ac3SMark Cave-Ayland s->status = req->status; 8576ef2cabcSMark Cave-Ayland 8586ef2cabcSMark Cave-Ayland /* 8596ef2cabcSMark Cave-Ayland * If the transfer is finished, switch to status phase. For non-DMA 8606ef2cabcSMark Cave-Ayland * transfers from the target the last byte is still in the FIFO 8616ef2cabcSMark Cave-Ayland */ 8626ef2cabcSMark Cave-Ayland if (s->ti_size == 0) { 8630c5ae734SMark Cave-Ayland s->rregs[ESP_RSTAT] &= ~7; 8640c5ae734SMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_ST; 86549ab747fSPaolo Bonzini esp_dma_done(s); 86682141c8bSMark Cave-Ayland esp_lower_drq(s); 8676ef2cabcSMark Cave-Ayland } 8686ef2cabcSMark Cave-Ayland 86949ab747fSPaolo Bonzini if (s->current_req) { 87049ab747fSPaolo Bonzini scsi_req_unref(s->current_req); 87149ab747fSPaolo Bonzini s->current_req = NULL; 87249ab747fSPaolo Bonzini s->current_dev = NULL; 87349ab747fSPaolo Bonzini } 87449ab747fSPaolo Bonzini } 87549ab747fSPaolo Bonzini 87649ab747fSPaolo Bonzini void esp_transfer_data(SCSIRequest *req, uint32_t len) 87749ab747fSPaolo Bonzini { 87849ab747fSPaolo Bonzini ESPState *s = req->hba_private; 8794e78f3bfSMark Cave-Ayland int to_device = ((s->rregs[ESP_RSTAT] & 7) == STAT_DO); 8806cc88d6bSMark Cave-Ayland uint32_t dmalen = esp_get_tc(s); 88149ab747fSPaolo Bonzini 8827f0b6e11SPaolo Bonzini assert(!s->do_cmd); 8836cc88d6bSMark Cave-Ayland trace_esp_transfer_data(dmalen, s->ti_size); 88449ab747fSPaolo Bonzini s->async_len = len; 88549ab747fSPaolo Bonzini s->async_buf = scsi_req_get_buf(req); 8864e78f3bfSMark Cave-Ayland 8874e78f3bfSMark Cave-Ayland if (!to_device && !s->data_in_ready) { 8884e78f3bfSMark Cave-Ayland /* 8894e78f3bfSMark Cave-Ayland * Initial incoming data xfer is complete so raise command 8904e78f3bfSMark Cave-Ayland * completion interrupt 8914e78f3bfSMark Cave-Ayland */ 8924e78f3bfSMark Cave-Ayland s->data_in_ready = true; 8934e78f3bfSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_TC; 8944e78f3bfSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 8954e78f3bfSMark Cave-Ayland esp_raise_irq(s); 8964e78f3bfSMark Cave-Ayland } 8974e78f3bfSMark Cave-Ayland 8981b9e48a5SMark Cave-Ayland if (s->ti_cmd == 0) { 8991b9e48a5SMark Cave-Ayland /* 9001b9e48a5SMark Cave-Ayland * Always perform the initial transfer upon reception of the next TI 9011b9e48a5SMark Cave-Ayland * command to ensure the DMA/non-DMA status of the command is correct. 9021b9e48a5SMark Cave-Ayland * It is not possible to use s->dma directly in the section below as 9031b9e48a5SMark Cave-Ayland * some OSs send non-DMA NOP commands after a DMA transfer. Hence if the 9041b9e48a5SMark Cave-Ayland * async data transfer is delayed then s->dma is set incorrectly. 9051b9e48a5SMark Cave-Ayland */ 9061b9e48a5SMark Cave-Ayland return; 9071b9e48a5SMark Cave-Ayland } 9081b9e48a5SMark Cave-Ayland 909880d3089SMark Cave-Ayland if (s->ti_cmd == (CMD_TI | CMD_DMA)) { 9106cc88d6bSMark Cave-Ayland if (dmalen) { 91149ab747fSPaolo Bonzini esp_do_dma(s); 9125eb7a23fSMark Cave-Ayland } else if (s->ti_size <= 0) { 91394d5c79dSMark Cave-Ayland /* 91494d5c79dSMark Cave-Ayland * If this was the last part of a DMA transfer then the 91594d5c79dSMark Cave-Ayland * completion interrupt is deferred to here. 91694d5c79dSMark Cave-Ayland */ 91749ab747fSPaolo Bonzini esp_dma_done(s); 91882141c8bSMark Cave-Ayland esp_lower_drq(s); 91949ab747fSPaolo Bonzini } 920880d3089SMark Cave-Ayland } else if (s->ti_cmd == CMD_TI) { 9211b9e48a5SMark Cave-Ayland esp_do_nodma(s); 9221b9e48a5SMark Cave-Ayland } 92349ab747fSPaolo Bonzini } 92449ab747fSPaolo Bonzini 92549ab747fSPaolo Bonzini static void handle_ti(ESPState *s) 92649ab747fSPaolo Bonzini { 9271b9e48a5SMark Cave-Ayland uint32_t dmalen; 92849ab747fSPaolo Bonzini 92949ab747fSPaolo Bonzini if (s->dma && !s->dma_enabled) { 93049ab747fSPaolo Bonzini s->dma_cb = handle_ti; 93149ab747fSPaolo Bonzini return; 93249ab747fSPaolo Bonzini } 93349ab747fSPaolo Bonzini 9341b9e48a5SMark Cave-Ayland s->ti_cmd = s->rregs[ESP_CMD]; 93549ab747fSPaolo Bonzini if (s->dma) { 9361b9e48a5SMark Cave-Ayland dmalen = esp_get_tc(s); 937b76624deSMark Cave-Ayland trace_esp_handle_ti(dmalen); 93849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 93949ab747fSPaolo Bonzini esp_do_dma(s); 940799d90d8SMark Cave-Ayland } else { 9411b9e48a5SMark Cave-Ayland trace_esp_handle_ti(s->ti_size); 9421b9e48a5SMark Cave-Ayland esp_do_nodma(s); 94349ab747fSPaolo Bonzini } 94449ab747fSPaolo Bonzini } 94549ab747fSPaolo Bonzini 94649ab747fSPaolo Bonzini void esp_hard_reset(ESPState *s) 94749ab747fSPaolo Bonzini { 94849ab747fSPaolo Bonzini memset(s->rregs, 0, ESP_REGS); 94949ab747fSPaolo Bonzini memset(s->wregs, 0, ESP_REGS); 950c9cf45c1SHannes Reinecke s->tchi_written = 0; 95149ab747fSPaolo Bonzini s->ti_size = 0; 9523f26c975SMark Cave-Ayland s->async_len = 0; 953042879fcSMark Cave-Ayland fifo8_reset(&s->fifo); 954023666daSMark Cave-Ayland fifo8_reset(&s->cmdfifo); 95549ab747fSPaolo Bonzini s->dma = 0; 95649ab747fSPaolo Bonzini s->do_cmd = 0; 95749ab747fSPaolo Bonzini s->dma_cb = NULL; 95849ab747fSPaolo Bonzini 95949ab747fSPaolo Bonzini s->rregs[ESP_CFG1] = 7; 96049ab747fSPaolo Bonzini } 96149ab747fSPaolo Bonzini 96249ab747fSPaolo Bonzini static void esp_soft_reset(ESPState *s) 96349ab747fSPaolo Bonzini { 96449ab747fSPaolo Bonzini qemu_irq_lower(s->irq); 96574d71ea1SLaurent Vivier qemu_irq_lower(s->irq_data); 96649ab747fSPaolo Bonzini esp_hard_reset(s); 96749ab747fSPaolo Bonzini } 96849ab747fSPaolo Bonzini 969c6e51f1bSJohn Millikin static void esp_bus_reset(ESPState *s) 970c6e51f1bSJohn Millikin { 9714a5fc890SPeter Maydell bus_cold_reset(BUS(&s->bus)); 972c6e51f1bSJohn Millikin } 973c6e51f1bSJohn Millikin 97449ab747fSPaolo Bonzini static void parent_esp_reset(ESPState *s, int irq, int level) 97549ab747fSPaolo Bonzini { 97649ab747fSPaolo Bonzini if (level) { 97749ab747fSPaolo Bonzini esp_soft_reset(s); 97849ab747fSPaolo Bonzini } 97949ab747fSPaolo Bonzini } 98049ab747fSPaolo Bonzini 981f21fe39dSMark Cave-Ayland static void esp_run_cmd(ESPState *s) 982f21fe39dSMark Cave-Ayland { 983f21fe39dSMark Cave-Ayland uint8_t cmd = s->rregs[ESP_CMD]; 984f21fe39dSMark Cave-Ayland 985f21fe39dSMark Cave-Ayland if (cmd & CMD_DMA) { 986f21fe39dSMark Cave-Ayland s->dma = 1; 987f21fe39dSMark Cave-Ayland /* Reload DMA counter. */ 988f21fe39dSMark Cave-Ayland if (esp_get_stc(s) == 0) { 989f21fe39dSMark Cave-Ayland esp_set_tc(s, 0x10000); 990f21fe39dSMark Cave-Ayland } else { 991f21fe39dSMark Cave-Ayland esp_set_tc(s, esp_get_stc(s)); 992f21fe39dSMark Cave-Ayland } 993f21fe39dSMark Cave-Ayland } else { 994f21fe39dSMark Cave-Ayland s->dma = 0; 995f21fe39dSMark Cave-Ayland } 996f21fe39dSMark Cave-Ayland switch (cmd & CMD_CMD) { 997f21fe39dSMark Cave-Ayland case CMD_NOP: 998f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_nop(cmd); 999f21fe39dSMark Cave-Ayland break; 1000f21fe39dSMark Cave-Ayland case CMD_FLUSH: 1001f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_flush(cmd); 1002f21fe39dSMark Cave-Ayland fifo8_reset(&s->fifo); 1003f21fe39dSMark Cave-Ayland break; 1004f21fe39dSMark Cave-Ayland case CMD_RESET: 1005f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_reset(cmd); 1006f21fe39dSMark Cave-Ayland esp_soft_reset(s); 1007f21fe39dSMark Cave-Ayland break; 1008f21fe39dSMark Cave-Ayland case CMD_BUSRESET: 1009f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_bus_reset(cmd); 1010f21fe39dSMark Cave-Ayland esp_bus_reset(s); 1011f21fe39dSMark Cave-Ayland if (!(s->wregs[ESP_CFG1] & CFG1_RESREPT)) { 1012f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_RST; 1013f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1014f21fe39dSMark Cave-Ayland } 1015f21fe39dSMark Cave-Ayland break; 1016f21fe39dSMark Cave-Ayland case CMD_TI: 1017f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ti(cmd); 1018f21fe39dSMark Cave-Ayland handle_ti(s); 1019f21fe39dSMark Cave-Ayland break; 1020f21fe39dSMark Cave-Ayland case CMD_ICCS: 1021f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_iccs(cmd); 1022f21fe39dSMark Cave-Ayland write_response(s); 1023f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1024f21fe39dSMark Cave-Ayland s->rregs[ESP_RSTAT] |= STAT_MI; 1025f21fe39dSMark Cave-Ayland break; 1026f21fe39dSMark Cave-Ayland case CMD_MSGACC: 1027f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_msgacc(cmd); 1028f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_DC; 1029f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1030f21fe39dSMark Cave-Ayland s->rregs[ESP_RFLAGS] = 0; 1031f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1032f21fe39dSMark Cave-Ayland break; 1033f21fe39dSMark Cave-Ayland case CMD_PAD: 1034f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_pad(cmd); 1035f21fe39dSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC; 1036f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_FC; 1037f21fe39dSMark Cave-Ayland s->rregs[ESP_RSEQ] = 0; 1038f21fe39dSMark Cave-Ayland break; 1039f21fe39dSMark Cave-Ayland case CMD_SATN: 1040f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_satn(cmd); 1041f21fe39dSMark Cave-Ayland break; 1042f21fe39dSMark Cave-Ayland case CMD_RSTATN: 1043f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_rstatn(cmd); 1044f21fe39dSMark Cave-Ayland break; 1045f21fe39dSMark Cave-Ayland case CMD_SEL: 1046f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_sel(cmd); 1047f21fe39dSMark Cave-Ayland handle_s_without_atn(s); 1048f21fe39dSMark Cave-Ayland break; 1049f21fe39dSMark Cave-Ayland case CMD_SELATN: 1050f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatn(cmd); 1051f21fe39dSMark Cave-Ayland handle_satn(s); 1052f21fe39dSMark Cave-Ayland break; 1053f21fe39dSMark Cave-Ayland case CMD_SELATNS: 1054f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_selatns(cmd); 1055f21fe39dSMark Cave-Ayland handle_satn_stop(s); 1056f21fe39dSMark Cave-Ayland break; 1057f21fe39dSMark Cave-Ayland case CMD_ENSEL: 1058f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_ensel(cmd); 1059f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1060f21fe39dSMark Cave-Ayland break; 1061f21fe39dSMark Cave-Ayland case CMD_DISSEL: 1062f21fe39dSMark Cave-Ayland trace_esp_mem_writeb_cmd_dissel(cmd); 1063f21fe39dSMark Cave-Ayland s->rregs[ESP_RINTR] = 0; 1064f21fe39dSMark Cave-Ayland esp_raise_irq(s); 1065f21fe39dSMark Cave-Ayland break; 1066f21fe39dSMark Cave-Ayland default: 1067f21fe39dSMark Cave-Ayland trace_esp_error_unhandled_command(cmd); 1068f21fe39dSMark Cave-Ayland break; 1069f21fe39dSMark Cave-Ayland } 1070f21fe39dSMark Cave-Ayland } 1071f21fe39dSMark Cave-Ayland 107249ab747fSPaolo Bonzini uint64_t esp_reg_read(ESPState *s, uint32_t saddr) 107349ab747fSPaolo Bonzini { 1074b630c075SMark Cave-Ayland uint32_t val; 107549ab747fSPaolo Bonzini 107649ab747fSPaolo Bonzini switch (saddr) { 107749ab747fSPaolo Bonzini case ESP_FIFO: 10781b9e48a5SMark Cave-Ayland if (s->dma_memory_read && s->dma_memory_write && 10791b9e48a5SMark Cave-Ayland (s->rregs[ESP_RSTAT] & STAT_PIO_MASK) == 0) { 108049ab747fSPaolo Bonzini /* Data out. */ 1081ff589551SPrasad J Pandit qemu_log_mask(LOG_UNIMP, "esp: PIO data read not implemented\n"); 108249ab747fSPaolo Bonzini s->rregs[ESP_FIFO] = 0; 1083042879fcSMark Cave-Ayland } else { 10846ef2cabcSMark Cave-Ayland if ((s->rregs[ESP_RSTAT] & 0x7) == STAT_DI) { 10856ef2cabcSMark Cave-Ayland if (s->ti_size) { 10866ef2cabcSMark Cave-Ayland esp_do_nodma(s); 10876ef2cabcSMark Cave-Ayland } else { 10886ef2cabcSMark Cave-Ayland /* 10896ef2cabcSMark Cave-Ayland * The last byte of a non-DMA transfer has been read out 10906ef2cabcSMark Cave-Ayland * of the FIFO so switch to status phase 10916ef2cabcSMark Cave-Ayland */ 10926ef2cabcSMark Cave-Ayland s->rregs[ESP_RSTAT] = STAT_TC | STAT_ST; 10936ef2cabcSMark Cave-Ayland } 10946ef2cabcSMark Cave-Ayland } 1095c5fef911SMark Cave-Ayland s->rregs[ESP_FIFO] = esp_fifo_pop(&s->fifo); 109649ab747fSPaolo Bonzini } 1097b630c075SMark Cave-Ayland val = s->rregs[ESP_FIFO]; 109849ab747fSPaolo Bonzini break; 109949ab747fSPaolo Bonzini case ESP_RINTR: 110094d5c79dSMark Cave-Ayland /* 110194d5c79dSMark Cave-Ayland * Clear sequence step, interrupt register and all status bits 110294d5c79dSMark Cave-Ayland * except TC 110394d5c79dSMark Cave-Ayland */ 1104b630c075SMark Cave-Ayland val = s->rregs[ESP_RINTR]; 110549ab747fSPaolo Bonzini s->rregs[ESP_RINTR] = 0; 110649ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 1107af947a3dSMark Cave-Ayland /* 1108af947a3dSMark Cave-Ayland * According to the datasheet ESP_RSEQ should be cleared, but as the 1109af947a3dSMark Cave-Ayland * emulation currently defers information transfers to the next TI 1110af947a3dSMark Cave-Ayland * command leave it for now so that pedantic guests such as the old 1111af947a3dSMark Cave-Ayland * Linux 2.6 driver see the correct flags before the next SCSI phase 1112af947a3dSMark Cave-Ayland * transition. 1113af947a3dSMark Cave-Ayland * 1114af947a3dSMark Cave-Ayland * s->rregs[ESP_RSEQ] = SEQ_0; 1115af947a3dSMark Cave-Ayland */ 111649ab747fSPaolo Bonzini esp_lower_irq(s); 1117b630c075SMark Cave-Ayland break; 1118c9cf45c1SHannes Reinecke case ESP_TCHI: 1119c9cf45c1SHannes Reinecke /* Return the unique id if the value has never been written */ 1120c9cf45c1SHannes Reinecke if (!s->tchi_written) { 1121b630c075SMark Cave-Ayland val = s->chip_id; 1122b630c075SMark Cave-Ayland } else { 1123b630c075SMark Cave-Ayland val = s->rregs[saddr]; 1124c9cf45c1SHannes Reinecke } 1125b630c075SMark Cave-Ayland break; 1126238ec4d7SMark Cave-Ayland case ESP_RFLAGS: 1127238ec4d7SMark Cave-Ayland /* Bottom 5 bits indicate number of bytes in FIFO */ 1128238ec4d7SMark Cave-Ayland val = fifo8_num_used(&s->fifo); 1129238ec4d7SMark Cave-Ayland break; 113049ab747fSPaolo Bonzini default: 1131b630c075SMark Cave-Ayland val = s->rregs[saddr]; 113249ab747fSPaolo Bonzini break; 113349ab747fSPaolo Bonzini } 1134b630c075SMark Cave-Ayland 1135b630c075SMark Cave-Ayland trace_esp_mem_readb(saddr, val); 1136b630c075SMark Cave-Ayland return val; 113749ab747fSPaolo Bonzini } 113849ab747fSPaolo Bonzini 113949ab747fSPaolo Bonzini void esp_reg_write(ESPState *s, uint32_t saddr, uint64_t val) 114049ab747fSPaolo Bonzini { 114149ab747fSPaolo Bonzini trace_esp_mem_writeb(saddr, s->wregs[saddr], val); 114249ab747fSPaolo Bonzini switch (saddr) { 1143c9cf45c1SHannes Reinecke case ESP_TCHI: 1144c9cf45c1SHannes Reinecke s->tchi_written = true; 1145c9cf45c1SHannes Reinecke /* fall through */ 114649ab747fSPaolo Bonzini case ESP_TCLO: 114749ab747fSPaolo Bonzini case ESP_TCMID: 114849ab747fSPaolo Bonzini s->rregs[ESP_RSTAT] &= ~STAT_TC; 114949ab747fSPaolo Bonzini break; 115049ab747fSPaolo Bonzini case ESP_FIFO: 115149ab747fSPaolo Bonzini if (s->do_cmd) { 1152e5455b8cSMark Cave-Ayland esp_fifo_push(&s->cmdfifo, val); 11536ef2cabcSMark Cave-Ayland 11546ef2cabcSMark Cave-Ayland /* 11556ef2cabcSMark Cave-Ayland * If any unexpected message out/command phase data is 11566ef2cabcSMark Cave-Ayland * transferred using non-DMA, raise the interrupt 11576ef2cabcSMark Cave-Ayland */ 11586ef2cabcSMark Cave-Ayland if (s->rregs[ESP_CMD] == CMD_TI) { 11596ef2cabcSMark Cave-Ayland s->rregs[ESP_RINTR] |= INTR_BS; 11606ef2cabcSMark Cave-Ayland esp_raise_irq(s); 11616ef2cabcSMark Cave-Ayland } 116249ab747fSPaolo Bonzini } else { 1163e5455b8cSMark Cave-Ayland esp_fifo_push(&s->fifo, val); 116449ab747fSPaolo Bonzini } 116549ab747fSPaolo Bonzini break; 116649ab747fSPaolo Bonzini case ESP_CMD: 116749ab747fSPaolo Bonzini s->rregs[saddr] = val; 1168f21fe39dSMark Cave-Ayland esp_run_cmd(s); 116949ab747fSPaolo Bonzini break; 117049ab747fSPaolo Bonzini case ESP_WBUSID ... ESP_WSYNO: 117149ab747fSPaolo Bonzini break; 117249ab747fSPaolo Bonzini case ESP_CFG1: 117349ab747fSPaolo Bonzini case ESP_CFG2: case ESP_CFG3: 117449ab747fSPaolo Bonzini case ESP_RES3: case ESP_RES4: 117549ab747fSPaolo Bonzini s->rregs[saddr] = val; 117649ab747fSPaolo Bonzini break; 117749ab747fSPaolo Bonzini case ESP_WCCF ... ESP_WTEST: 117849ab747fSPaolo Bonzini break; 117949ab747fSPaolo Bonzini default: 118049ab747fSPaolo Bonzini trace_esp_error_invalid_write(val, saddr); 118149ab747fSPaolo Bonzini return; 118249ab747fSPaolo Bonzini } 118349ab747fSPaolo Bonzini s->wregs[saddr] = val; 118449ab747fSPaolo Bonzini } 118549ab747fSPaolo Bonzini 118649ab747fSPaolo Bonzini static bool esp_mem_accepts(void *opaque, hwaddr addr, 11878372d383SPeter Maydell unsigned size, bool is_write, 11888372d383SPeter Maydell MemTxAttrs attrs) 118949ab747fSPaolo Bonzini { 119049ab747fSPaolo Bonzini return (size == 1) || (is_write && size == 4); 119149ab747fSPaolo Bonzini } 119249ab747fSPaolo Bonzini 11936cc88d6bSMark Cave-Ayland static bool esp_is_before_version_5(void *opaque, int version_id) 11946cc88d6bSMark Cave-Ayland { 11956cc88d6bSMark Cave-Ayland ESPState *s = ESP(opaque); 11966cc88d6bSMark Cave-Ayland 11976cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 11986cc88d6bSMark Cave-Ayland return version_id < 5; 11996cc88d6bSMark Cave-Ayland } 12006cc88d6bSMark Cave-Ayland 12014e78f3bfSMark Cave-Ayland static bool esp_is_version_5(void *opaque, int version_id) 12024e78f3bfSMark Cave-Ayland { 12034e78f3bfSMark Cave-Ayland ESPState *s = ESP(opaque); 12044e78f3bfSMark Cave-Ayland 12054e78f3bfSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12060bcd5a18SMark Cave-Ayland return version_id >= 5; 12074e78f3bfSMark Cave-Ayland } 12084e78f3bfSMark Cave-Ayland 12094eb86065SPaolo Bonzini static bool esp_is_version_6(void *opaque, int version_id) 12104eb86065SPaolo Bonzini { 12114eb86065SPaolo Bonzini ESPState *s = ESP(opaque); 12124eb86065SPaolo Bonzini 12134eb86065SPaolo Bonzini version_id = MIN(version_id, s->mig_version_id); 12144eb86065SPaolo Bonzini return version_id >= 6; 12154eb86065SPaolo Bonzini } 12164eb86065SPaolo Bonzini 1217ff4a1dabSMark Cave-Ayland int esp_pre_save(void *opaque) 12180bd005beSMark Cave-Ayland { 1219ff4a1dabSMark Cave-Ayland ESPState *s = ESP(object_resolve_path_component( 1220ff4a1dabSMark Cave-Ayland OBJECT(opaque), "esp")); 12210bd005beSMark Cave-Ayland 12220bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12230bd005beSMark Cave-Ayland return 0; 12240bd005beSMark Cave-Ayland } 12250bd005beSMark Cave-Ayland 12260bd005beSMark Cave-Ayland static int esp_post_load(void *opaque, int version_id) 12270bd005beSMark Cave-Ayland { 12280bd005beSMark Cave-Ayland ESPState *s = ESP(opaque); 1229042879fcSMark Cave-Ayland int len, i; 12300bd005beSMark Cave-Ayland 12316cc88d6bSMark Cave-Ayland version_id = MIN(version_id, s->mig_version_id); 12326cc88d6bSMark Cave-Ayland 12336cc88d6bSMark Cave-Ayland if (version_id < 5) { 12346cc88d6bSMark Cave-Ayland esp_set_tc(s, s->mig_dma_left); 1235042879fcSMark Cave-Ayland 1236042879fcSMark Cave-Ayland /* Migrate ti_buf to fifo */ 1237042879fcSMark Cave-Ayland len = s->mig_ti_wptr - s->mig_ti_rptr; 1238042879fcSMark Cave-Ayland for (i = 0; i < len; i++) { 1239042879fcSMark Cave-Ayland fifo8_push(&s->fifo, s->mig_ti_buf[i]); 1240042879fcSMark Cave-Ayland } 1241023666daSMark Cave-Ayland 1242023666daSMark Cave-Ayland /* Migrate cmdbuf to cmdfifo */ 1243023666daSMark Cave-Ayland for (i = 0; i < s->mig_cmdlen; i++) { 1244023666daSMark Cave-Ayland fifo8_push(&s->cmdfifo, s->mig_cmdbuf[i]); 1245023666daSMark Cave-Ayland } 12466cc88d6bSMark Cave-Ayland } 12476cc88d6bSMark Cave-Ayland 12480bd005beSMark Cave-Ayland s->mig_version_id = vmstate_esp.version_id; 12490bd005beSMark Cave-Ayland return 0; 12500bd005beSMark Cave-Ayland } 12510bd005beSMark Cave-Ayland 1252eda59b39SMark Cave-Ayland /* 1253eda59b39SMark Cave-Ayland * PDMA (or pseudo-DMA) is only used on the Macintosh and requires the 1254eda59b39SMark Cave-Ayland * guest CPU to perform the transfers between the SCSI bus and memory 1255eda59b39SMark Cave-Ayland * itself. This is indicated by the dma_memory_read and dma_memory_write 1256eda59b39SMark Cave-Ayland * functions being NULL (in contrast to the ESP PCI device) whilst 1257eda59b39SMark Cave-Ayland * dma_enabled is still set. 1258eda59b39SMark Cave-Ayland */ 1259eda59b39SMark Cave-Ayland 1260eda59b39SMark Cave-Ayland static bool esp_pdma_needed(void *opaque) 1261eda59b39SMark Cave-Ayland { 1262eda59b39SMark Cave-Ayland ESPState *s = ESP(opaque); 1263eda59b39SMark Cave-Ayland 1264eda59b39SMark Cave-Ayland return s->dma_memory_read == NULL && s->dma_memory_write == NULL && 1265eda59b39SMark Cave-Ayland s->dma_enabled; 1266eda59b39SMark Cave-Ayland } 1267eda59b39SMark Cave-Ayland 1268eda59b39SMark Cave-Ayland static const VMStateDescription vmstate_esp_pdma = { 1269eda59b39SMark Cave-Ayland .name = "esp/pdma", 1270eda59b39SMark Cave-Ayland .version_id = 0, 1271eda59b39SMark Cave-Ayland .minimum_version_id = 0, 1272eda59b39SMark Cave-Ayland .needed = esp_pdma_needed, 12732d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 1274eda59b39SMark Cave-Ayland VMSTATE_UINT8(pdma_cb, ESPState), 1275eda59b39SMark Cave-Ayland VMSTATE_END_OF_LIST() 1276eda59b39SMark Cave-Ayland } 1277eda59b39SMark Cave-Ayland }; 1278eda59b39SMark Cave-Ayland 127949ab747fSPaolo Bonzini const VMStateDescription vmstate_esp = { 128049ab747fSPaolo Bonzini .name = "esp", 12814eb86065SPaolo Bonzini .version_id = 6, 128249ab747fSPaolo Bonzini .minimum_version_id = 3, 12830bd005beSMark Cave-Ayland .post_load = esp_post_load, 12842d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 128549ab747fSPaolo Bonzini VMSTATE_BUFFER(rregs, ESPState), 128649ab747fSPaolo Bonzini VMSTATE_BUFFER(wregs, ESPState), 128749ab747fSPaolo Bonzini VMSTATE_INT32(ti_size, ESPState), 1288042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_rptr, ESPState, esp_is_before_version_5), 1289042879fcSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_ti_wptr, ESPState, esp_is_before_version_5), 1290042879fcSMark Cave-Ayland VMSTATE_BUFFER_TEST(mig_ti_buf, ESPState, esp_is_before_version_5), 129149ab747fSPaolo Bonzini VMSTATE_UINT32(status, ESPState), 12924aaa6ac3SMark Cave-Ayland VMSTATE_UINT32_TEST(mig_deferred_status, ESPState, 12934aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 12944aaa6ac3SMark Cave-Ayland VMSTATE_BOOL_TEST(mig_deferred_complete, ESPState, 12954aaa6ac3SMark Cave-Ayland esp_is_before_version_5), 129649ab747fSPaolo Bonzini VMSTATE_UINT32(dma, ESPState), 1297023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 0, 1298023666daSMark Cave-Ayland esp_is_before_version_5, 0, 16), 1299023666daSMark Cave-Ayland VMSTATE_STATIC_BUFFER(mig_cmdbuf, ESPState, 4, 1300023666daSMark Cave-Ayland esp_is_before_version_5, 16, 1301023666daSMark Cave-Ayland sizeof(typeof_field(ESPState, mig_cmdbuf))), 1302023666daSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_cmdlen, ESPState, esp_is_before_version_5), 130349ab747fSPaolo Bonzini VMSTATE_UINT32(do_cmd, ESPState), 13046cc88d6bSMark Cave-Ayland VMSTATE_UINT32_TEST(mig_dma_left, ESPState, esp_is_before_version_5), 13054e78f3bfSMark Cave-Ayland VMSTATE_BOOL_TEST(data_in_ready, ESPState, esp_is_version_5), 1306023666daSMark Cave-Ayland VMSTATE_UINT8_TEST(cmdfifo_cdb_offset, ESPState, esp_is_version_5), 1307042879fcSMark Cave-Ayland VMSTATE_FIFO8_TEST(fifo, ESPState, esp_is_version_5), 1308023666daSMark Cave-Ayland VMSTATE_FIFO8_TEST(cmdfifo, ESPState, esp_is_version_5), 13091b9e48a5SMark Cave-Ayland VMSTATE_UINT8_TEST(ti_cmd, ESPState, esp_is_version_5), 13104eb86065SPaolo Bonzini VMSTATE_UINT8_TEST(lun, ESPState, esp_is_version_6), 131149ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 131274d71ea1SLaurent Vivier }, 13132d7b39a6SRichard Henderson .subsections = (const VMStateDescription * const []) { 1314eda59b39SMark Cave-Ayland &vmstate_esp_pdma, 1315eda59b39SMark Cave-Ayland NULL 1316eda59b39SMark Cave-Ayland } 131749ab747fSPaolo Bonzini }; 131849ab747fSPaolo Bonzini 131949ab747fSPaolo Bonzini static void sysbus_esp_mem_write(void *opaque, hwaddr addr, 132049ab747fSPaolo Bonzini uint64_t val, unsigned int size) 132149ab747fSPaolo Bonzini { 132249ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1323eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 132449ab747fSPaolo Bonzini uint32_t saddr; 132549ab747fSPaolo Bonzini 132649ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1327eb169c76SMark Cave-Ayland esp_reg_write(s, saddr, val); 132849ab747fSPaolo Bonzini } 132949ab747fSPaolo Bonzini 133049ab747fSPaolo Bonzini static uint64_t sysbus_esp_mem_read(void *opaque, hwaddr addr, 133149ab747fSPaolo Bonzini unsigned int size) 133249ab747fSPaolo Bonzini { 133349ab747fSPaolo Bonzini SysBusESPState *sysbus = opaque; 1334eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 133549ab747fSPaolo Bonzini uint32_t saddr; 133649ab747fSPaolo Bonzini 133749ab747fSPaolo Bonzini saddr = addr >> sysbus->it_shift; 1338eb169c76SMark Cave-Ayland return esp_reg_read(s, saddr); 133949ab747fSPaolo Bonzini } 134049ab747fSPaolo Bonzini 134149ab747fSPaolo Bonzini static const MemoryRegionOps sysbus_esp_mem_ops = { 134249ab747fSPaolo Bonzini .read = sysbus_esp_mem_read, 134349ab747fSPaolo Bonzini .write = sysbus_esp_mem_write, 134449ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 134549ab747fSPaolo Bonzini .valid.accepts = esp_mem_accepts, 134649ab747fSPaolo Bonzini }; 134749ab747fSPaolo Bonzini 134874d71ea1SLaurent Vivier static void sysbus_esp_pdma_write(void *opaque, hwaddr addr, 134974d71ea1SLaurent Vivier uint64_t val, unsigned int size) 135074d71ea1SLaurent Vivier { 135174d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1352eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 135374d71ea1SLaurent Vivier 1354960ebfd9SMark Cave-Ayland trace_esp_pdma_write(size); 1355960ebfd9SMark Cave-Ayland 135674d71ea1SLaurent Vivier switch (size) { 135774d71ea1SLaurent Vivier case 1: 1358761bef75SMark Cave-Ayland esp_pdma_write(s, val); 135974d71ea1SLaurent Vivier break; 136074d71ea1SLaurent Vivier case 2: 1361761bef75SMark Cave-Ayland esp_pdma_write(s, val >> 8); 1362761bef75SMark Cave-Ayland esp_pdma_write(s, val); 136374d71ea1SLaurent Vivier break; 136474d71ea1SLaurent Vivier } 1365d0243b09SMark Cave-Ayland esp_pdma_cb(s); 136674d71ea1SLaurent Vivier } 136774d71ea1SLaurent Vivier 136874d71ea1SLaurent Vivier static uint64_t sysbus_esp_pdma_read(void *opaque, hwaddr addr, 136974d71ea1SLaurent Vivier unsigned int size) 137074d71ea1SLaurent Vivier { 137174d71ea1SLaurent Vivier SysBusESPState *sysbus = opaque; 1372eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 137374d71ea1SLaurent Vivier uint64_t val = 0; 137474d71ea1SLaurent Vivier 1375960ebfd9SMark Cave-Ayland trace_esp_pdma_read(size); 1376960ebfd9SMark Cave-Ayland 137774d71ea1SLaurent Vivier switch (size) { 137874d71ea1SLaurent Vivier case 1: 1379761bef75SMark Cave-Ayland val = esp_pdma_read(s); 138074d71ea1SLaurent Vivier break; 138174d71ea1SLaurent Vivier case 2: 1382761bef75SMark Cave-Ayland val = esp_pdma_read(s); 1383761bef75SMark Cave-Ayland val = (val << 8) | esp_pdma_read(s); 138474d71ea1SLaurent Vivier break; 138574d71ea1SLaurent Vivier } 13867aa6baeeSMark Cave-Ayland if (fifo8_num_used(&s->fifo) < 2) { 1387d0243b09SMark Cave-Ayland esp_pdma_cb(s); 138874d71ea1SLaurent Vivier } 138974d71ea1SLaurent Vivier return val; 139074d71ea1SLaurent Vivier } 139174d71ea1SLaurent Vivier 1392a7a22088SMark Cave-Ayland static void *esp_load_request(QEMUFile *f, SCSIRequest *req) 1393a7a22088SMark Cave-Ayland { 1394a7a22088SMark Cave-Ayland ESPState *s = container_of(req->bus, ESPState, bus); 1395a7a22088SMark Cave-Ayland 1396a7a22088SMark Cave-Ayland scsi_req_ref(req); 1397a7a22088SMark Cave-Ayland s->current_req = req; 1398a7a22088SMark Cave-Ayland return s; 1399a7a22088SMark Cave-Ayland } 1400a7a22088SMark Cave-Ayland 140174d71ea1SLaurent Vivier static const MemoryRegionOps sysbus_esp_pdma_ops = { 140274d71ea1SLaurent Vivier .read = sysbus_esp_pdma_read, 140374d71ea1SLaurent Vivier .write = sysbus_esp_pdma_write, 140474d71ea1SLaurent Vivier .endianness = DEVICE_NATIVE_ENDIAN, 140574d71ea1SLaurent Vivier .valid.min_access_size = 1, 1406cf1b8286SMark Cave-Ayland .valid.max_access_size = 4, 1407cf1b8286SMark Cave-Ayland .impl.min_access_size = 1, 1408cf1b8286SMark Cave-Ayland .impl.max_access_size = 2, 140974d71ea1SLaurent Vivier }; 141074d71ea1SLaurent Vivier 141149ab747fSPaolo Bonzini static const struct SCSIBusInfo esp_scsi_info = { 141249ab747fSPaolo Bonzini .tcq = false, 141349ab747fSPaolo Bonzini .max_target = ESP_MAX_DEVS, 141449ab747fSPaolo Bonzini .max_lun = 7, 141549ab747fSPaolo Bonzini 1416a7a22088SMark Cave-Ayland .load_request = esp_load_request, 141749ab747fSPaolo Bonzini .transfer_data = esp_transfer_data, 141849ab747fSPaolo Bonzini .complete = esp_command_complete, 141949ab747fSPaolo Bonzini .cancel = esp_request_cancelled 142049ab747fSPaolo Bonzini }; 142149ab747fSPaolo Bonzini 142249ab747fSPaolo Bonzini static void sysbus_esp_gpio_demux(void *opaque, int irq, int level) 142349ab747fSPaolo Bonzini { 142484fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(opaque); 1425eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 142649ab747fSPaolo Bonzini 142749ab747fSPaolo Bonzini switch (irq) { 142849ab747fSPaolo Bonzini case 0: 142949ab747fSPaolo Bonzini parent_esp_reset(s, irq, level); 143049ab747fSPaolo Bonzini break; 143149ab747fSPaolo Bonzini case 1: 1432b86dc5cbSMark Cave-Ayland esp_dma_enable(s, irq, level); 143349ab747fSPaolo Bonzini break; 143449ab747fSPaolo Bonzini } 143549ab747fSPaolo Bonzini } 143649ab747fSPaolo Bonzini 1437b09318caSHu Tao static void sysbus_esp_realize(DeviceState *dev, Error **errp) 143849ab747fSPaolo Bonzini { 1439b09318caSHu Tao SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 144084fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1441eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1442eb169c76SMark Cave-Ayland 1443eb169c76SMark Cave-Ayland if (!qdev_realize(DEVICE(s), NULL, errp)) { 1444eb169c76SMark Cave-Ayland return; 1445eb169c76SMark Cave-Ayland } 144649ab747fSPaolo Bonzini 1447b09318caSHu Tao sysbus_init_irq(sbd, &s->irq); 144874d71ea1SLaurent Vivier sysbus_init_irq(sbd, &s->irq_data); 144949ab747fSPaolo Bonzini assert(sysbus->it_shift != -1); 145049ab747fSPaolo Bonzini 145149ab747fSPaolo Bonzini s->chip_id = TCHI_FAS100A; 145229776739SPaolo Bonzini memory_region_init_io(&sysbus->iomem, OBJECT(sysbus), &sysbus_esp_mem_ops, 145374d71ea1SLaurent Vivier sysbus, "esp-regs", ESP_REGS << sysbus->it_shift); 1454b09318caSHu Tao sysbus_init_mmio(sbd, &sysbus->iomem); 145574d71ea1SLaurent Vivier memory_region_init_io(&sysbus->pdma, OBJECT(sysbus), &sysbus_esp_pdma_ops, 1456cf1b8286SMark Cave-Ayland sysbus, "esp-pdma", 4); 145774d71ea1SLaurent Vivier sysbus_init_mmio(sbd, &sysbus->pdma); 145849ab747fSPaolo Bonzini 1459b09318caSHu Tao qdev_init_gpio_in(dev, sysbus_esp_gpio_demux, 2); 146049ab747fSPaolo Bonzini 1461739e95f5SPeter Maydell scsi_bus_init(&s->bus, sizeof(s->bus), dev, &esp_scsi_info); 146249ab747fSPaolo Bonzini } 146349ab747fSPaolo Bonzini 146449ab747fSPaolo Bonzini static void sysbus_esp_hard_reset(DeviceState *dev) 146549ab747fSPaolo Bonzini { 146684fbefedSMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(dev); 1467eb169c76SMark Cave-Ayland ESPState *s = ESP(&sysbus->esp); 1468eb169c76SMark Cave-Ayland 1469eb169c76SMark Cave-Ayland esp_hard_reset(s); 1470eb169c76SMark Cave-Ayland } 1471eb169c76SMark Cave-Ayland 1472eb169c76SMark Cave-Ayland static void sysbus_esp_init(Object *obj) 1473eb169c76SMark Cave-Ayland { 1474eb169c76SMark Cave-Ayland SysBusESPState *sysbus = SYSBUS_ESP(obj); 1475eb169c76SMark Cave-Ayland 1476eb169c76SMark Cave-Ayland object_initialize_child(obj, "esp", &sysbus->esp, TYPE_ESP); 147749ab747fSPaolo Bonzini } 147849ab747fSPaolo Bonzini 147949ab747fSPaolo Bonzini static const VMStateDescription vmstate_sysbus_esp_scsi = { 148049ab747fSPaolo Bonzini .name = "sysbusespscsi", 14810bd005beSMark Cave-Ayland .version_id = 2, 1482ea84a442SGuenter Roeck .minimum_version_id = 1, 1483ff4a1dabSMark Cave-Ayland .pre_save = esp_pre_save, 14842d7b39a6SRichard Henderson .fields = (const VMStateField[]) { 14850bd005beSMark Cave-Ayland VMSTATE_UINT8_V(esp.mig_version_id, SysBusESPState, 2), 148649ab747fSPaolo Bonzini VMSTATE_STRUCT(esp, SysBusESPState, 0, vmstate_esp, ESPState), 148749ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 148849ab747fSPaolo Bonzini } 148949ab747fSPaolo Bonzini }; 149049ab747fSPaolo Bonzini 149149ab747fSPaolo Bonzini static void sysbus_esp_class_init(ObjectClass *klass, void *data) 149249ab747fSPaolo Bonzini { 149349ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 149449ab747fSPaolo Bonzini 1495b09318caSHu Tao dc->realize = sysbus_esp_realize; 149649ab747fSPaolo Bonzini dc->reset = sysbus_esp_hard_reset; 149749ab747fSPaolo Bonzini dc->vmsd = &vmstate_sysbus_esp_scsi; 1498125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 149949ab747fSPaolo Bonzini } 150049ab747fSPaolo Bonzini 150149ab747fSPaolo Bonzini static const TypeInfo sysbus_esp_info = { 150284fbefedSMark Cave-Ayland .name = TYPE_SYSBUS_ESP, 150349ab747fSPaolo Bonzini .parent = TYPE_SYS_BUS_DEVICE, 1504eb169c76SMark Cave-Ayland .instance_init = sysbus_esp_init, 150549ab747fSPaolo Bonzini .instance_size = sizeof(SysBusESPState), 150649ab747fSPaolo Bonzini .class_init = sysbus_esp_class_init, 150749ab747fSPaolo Bonzini }; 150849ab747fSPaolo Bonzini 1509042879fcSMark Cave-Ayland static void esp_finalize(Object *obj) 1510042879fcSMark Cave-Ayland { 1511042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1512042879fcSMark Cave-Ayland 1513042879fcSMark Cave-Ayland fifo8_destroy(&s->fifo); 1514023666daSMark Cave-Ayland fifo8_destroy(&s->cmdfifo); 1515042879fcSMark Cave-Ayland } 1516042879fcSMark Cave-Ayland 1517042879fcSMark Cave-Ayland static void esp_init(Object *obj) 1518042879fcSMark Cave-Ayland { 1519042879fcSMark Cave-Ayland ESPState *s = ESP(obj); 1520042879fcSMark Cave-Ayland 1521042879fcSMark Cave-Ayland fifo8_create(&s->fifo, ESP_FIFO_SZ); 1522023666daSMark Cave-Ayland fifo8_create(&s->cmdfifo, ESP_CMDFIFO_SZ); 1523042879fcSMark Cave-Ayland } 1524042879fcSMark Cave-Ayland 1525eb169c76SMark Cave-Ayland static void esp_class_init(ObjectClass *klass, void *data) 1526eb169c76SMark Cave-Ayland { 1527eb169c76SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(klass); 1528eb169c76SMark Cave-Ayland 1529eb169c76SMark Cave-Ayland /* internal device for sysbusesp/pciespscsi, not user-creatable */ 1530eb169c76SMark Cave-Ayland dc->user_creatable = false; 1531eb169c76SMark Cave-Ayland set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1532eb169c76SMark Cave-Ayland } 1533eb169c76SMark Cave-Ayland 1534eb169c76SMark Cave-Ayland static const TypeInfo esp_info = { 1535eb169c76SMark Cave-Ayland .name = TYPE_ESP, 1536eb169c76SMark Cave-Ayland .parent = TYPE_DEVICE, 1537042879fcSMark Cave-Ayland .instance_init = esp_init, 1538042879fcSMark Cave-Ayland .instance_finalize = esp_finalize, 1539eb169c76SMark Cave-Ayland .instance_size = sizeof(ESPState), 1540eb169c76SMark Cave-Ayland .class_init = esp_class_init, 1541eb169c76SMark Cave-Ayland }; 1542eb169c76SMark Cave-Ayland 154349ab747fSPaolo Bonzini static void esp_register_types(void) 154449ab747fSPaolo Bonzini { 154549ab747fSPaolo Bonzini type_register_static(&sysbus_esp_info); 1546eb169c76SMark Cave-Ayland type_register_static(&esp_info); 154749ab747fSPaolo Bonzini } 154849ab747fSPaolo Bonzini 154949ab747fSPaolo Bonzini type_init(esp_register_types) 1550