1881d588aSDmitry Fleytman /* 2881d588aSDmitry Fleytman * QEMU VMWARE PVSCSI paravirtual SCSI bus 3881d588aSDmitry Fleytman * 4881d588aSDmitry Fleytman * Copyright (c) 2012 Ravello Systems LTD (http://ravellosystems.com) 5881d588aSDmitry Fleytman * 6881d588aSDmitry Fleytman * Developed by Daynix Computing LTD (http://www.daynix.com) 7881d588aSDmitry Fleytman * 8881d588aSDmitry Fleytman * Based on implementation by Paolo Bonzini 9881d588aSDmitry Fleytman * http://lists.gnu.org/archive/html/qemu-devel/2011-08/msg00729.html 10881d588aSDmitry Fleytman * 11881d588aSDmitry Fleytman * Authors: 12881d588aSDmitry Fleytman * Paolo Bonzini <pbonzini@redhat.com> 13881d588aSDmitry Fleytman * Dmitry Fleytman <dmitry@daynix.com> 14881d588aSDmitry Fleytman * Yan Vugenfirer <yan@daynix.com> 15881d588aSDmitry Fleytman * 16881d588aSDmitry Fleytman * This work is licensed under the terms of the GNU GPL, version 2. 17881d588aSDmitry Fleytman * See the COPYING file in the top-level directory. 18881d588aSDmitry Fleytman * 19881d588aSDmitry Fleytman * NOTE about MSI-X: 20881d588aSDmitry Fleytman * MSI-X support has been removed for the moment because it leads Windows OS 21881d588aSDmitry Fleytman * to crash on startup. The crash happens because Windows driver requires 22881d588aSDmitry Fleytman * MSI-X shared memory to be part of the same BAR used for rings state 23881d588aSDmitry Fleytman * registers, etc. This is not supported by QEMU infrastructure so separate 24881d588aSDmitry Fleytman * BAR created from MSI-X purposes. Windows driver fails to deal with 2 BARs. 25881d588aSDmitry Fleytman * 26881d588aSDmitry Fleytman */ 27881d588aSDmitry Fleytman 28a4ab4792SPeter Maydell #include "qemu/osdep.h" 29da34e65cSMarkus Armbruster #include "qapi/error.h" 30db725815SMarkus Armbruster #include "qemu/main-loop.h" 310b8fa32fSMarkus Armbruster #include "qemu/module.h" 32881d588aSDmitry Fleytman #include "hw/scsi/scsi.h" 33d6454270SMarkus Armbruster #include "migration/vmstate.h" 3408e2c9f1SPaolo Bonzini #include "scsi/constants.h" 35881d588aSDmitry Fleytman #include "hw/pci/msi.h" 36a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h" 37881d588aSDmitry Fleytman #include "vmw_pvscsi.h" 38881d588aSDmitry Fleytman #include "trace.h" 39*db1015e9SEduardo Habkost #include "qom/object.h" 40881d588aSDmitry Fleytman 41881d588aSDmitry Fleytman 42881d588aSDmitry Fleytman #define PVSCSI_USE_64BIT (true) 43881d588aSDmitry Fleytman #define PVSCSI_PER_VECTOR_MASK (false) 44881d588aSDmitry Fleytman 45881d588aSDmitry Fleytman #define PVSCSI_MAX_DEVS (64) 46881d588aSDmitry Fleytman #define PVSCSI_MSIX_NUM_VECTORS (1) 47881d588aSDmitry Fleytman 4849adc5d3SPrasad J Pandit #define PVSCSI_MAX_SG_ELEM 2048 4949adc5d3SPrasad J Pandit 50881d588aSDmitry Fleytman #define PVSCSI_MAX_CMD_DATA_WORDS \ 51881d588aSDmitry Fleytman (sizeof(PVSCSICmdDescSetupRings)/sizeof(uint32_t)) 52881d588aSDmitry Fleytman 530dc40f28SPaolo Bonzini #define RS_GET_FIELD(m, field) \ 540dc40f28SPaolo Bonzini (ldl_le_pci_dma(&container_of(m, PVSCSIState, rings)->parent_obj, \ 550dc40f28SPaolo Bonzini (m)->rs_pa + offsetof(struct PVSCSIRingsState, field))) 560dc40f28SPaolo Bonzini #define RS_SET_FIELD(m, field, val) \ 570dc40f28SPaolo Bonzini (stl_le_pci_dma(&container_of(m, PVSCSIState, rings)->parent_obj, \ 580dc40f28SPaolo Bonzini (m)->rs_pa + offsetof(struct PVSCSIRingsState, field), val)) 59881d588aSDmitry Fleytman 60*db1015e9SEduardo Habkost struct PVSCSIClass { 61e2d4f3f7SShmulik Ladkani PCIDeviceClass parent_class; 621dd1305eSShmulik Ladkani DeviceRealize parent_dc_realize; 63*db1015e9SEduardo Habkost }; 64*db1015e9SEduardo Habkost typedef struct PVSCSIClass PVSCSIClass; 65e2d4f3f7SShmulik Ladkani 66881d588aSDmitry Fleytman #define TYPE_PVSCSI "pvscsi" 67*db1015e9SEduardo Habkost typedef struct PVSCSIState PVSCSIState; 68881d588aSDmitry Fleytman #define PVSCSI(obj) OBJECT_CHECK(PVSCSIState, (obj), TYPE_PVSCSI) 69881d588aSDmitry Fleytman 70bd7dff94SEduardo Habkost #define PVSCSI_CLASS(klass) \ 71e2d4f3f7SShmulik Ladkani OBJECT_CLASS_CHECK(PVSCSIClass, (klass), TYPE_PVSCSI) 72bd7dff94SEduardo Habkost #define PVSCSI_GET_CLASS(obj) \ 73e2d4f3f7SShmulik Ladkani OBJECT_GET_CLASS(PVSCSIClass, (obj), TYPE_PVSCSI) 74e2d4f3f7SShmulik Ladkani 75cb8d4c8fSStefan Weil /* Compatibility flags for migration */ 76d29d4ff8SShmulik Ladkani #define PVSCSI_COMPAT_OLD_PCI_CONFIGURATION_BIT 0 77d29d4ff8SShmulik Ladkani #define PVSCSI_COMPAT_OLD_PCI_CONFIGURATION \ 78d29d4ff8SShmulik Ladkani (1 << PVSCSI_COMPAT_OLD_PCI_CONFIGURATION_BIT) 791dd1305eSShmulik Ladkani #define PVSCSI_COMPAT_DISABLE_PCIE_BIT 1 801dd1305eSShmulik Ladkani #define PVSCSI_COMPAT_DISABLE_PCIE \ 811dd1305eSShmulik Ladkani (1 << PVSCSI_COMPAT_DISABLE_PCIE_BIT) 82d29d4ff8SShmulik Ladkani 83d29d4ff8SShmulik Ladkani #define PVSCSI_USE_OLD_PCI_CONFIGURATION(s) \ 84d29d4ff8SShmulik Ladkani ((s)->compat_flags & PVSCSI_COMPAT_OLD_PCI_CONFIGURATION) 85836fc48cSShmulik Ladkani #define PVSCSI_MSI_OFFSET(s) \ 86836fc48cSShmulik Ladkani (PVSCSI_USE_OLD_PCI_CONFIGURATION(s) ? 0x50 : 0x7c) 871dd1305eSShmulik Ladkani #define PVSCSI_EXP_EP_OFFSET (0x40) 88d29d4ff8SShmulik Ladkani 89881d588aSDmitry Fleytman typedef struct PVSCSIRingInfo { 90881d588aSDmitry Fleytman uint64_t rs_pa; 91881d588aSDmitry Fleytman uint32_t txr_len_mask; 92881d588aSDmitry Fleytman uint32_t rxr_len_mask; 93881d588aSDmitry Fleytman uint32_t msg_len_mask; 94881d588aSDmitry Fleytman uint64_t req_ring_pages_pa[PVSCSI_SETUP_RINGS_MAX_NUM_PAGES]; 95881d588aSDmitry Fleytman uint64_t cmp_ring_pages_pa[PVSCSI_SETUP_RINGS_MAX_NUM_PAGES]; 96881d588aSDmitry Fleytman uint64_t msg_ring_pages_pa[PVSCSI_SETUP_MSG_RING_MAX_NUM_PAGES]; 97881d588aSDmitry Fleytman uint64_t consumed_ptr; 98881d588aSDmitry Fleytman uint64_t filled_cmp_ptr; 99881d588aSDmitry Fleytman uint64_t filled_msg_ptr; 100881d588aSDmitry Fleytman } PVSCSIRingInfo; 101881d588aSDmitry Fleytman 102881d588aSDmitry Fleytman typedef struct PVSCSISGState { 103881d588aSDmitry Fleytman hwaddr elemAddr; 104881d588aSDmitry Fleytman hwaddr dataAddr; 105881d588aSDmitry Fleytman uint32_t resid; 106881d588aSDmitry Fleytman } PVSCSISGState; 107881d588aSDmitry Fleytman 108881d588aSDmitry Fleytman typedef QTAILQ_HEAD(, PVSCSIRequest) PVSCSIRequestList; 109881d588aSDmitry Fleytman 110*db1015e9SEduardo Habkost struct PVSCSIState { 111881d588aSDmitry Fleytman PCIDevice parent_obj; 112881d588aSDmitry Fleytman MemoryRegion io_space; 113881d588aSDmitry Fleytman SCSIBus bus; 114881d588aSDmitry Fleytman QEMUBH *completion_worker; 115881d588aSDmitry Fleytman PVSCSIRequestList pending_queue; 116881d588aSDmitry Fleytman PVSCSIRequestList completion_queue; 117881d588aSDmitry Fleytman 118881d588aSDmitry Fleytman uint64_t reg_interrupt_status; /* Interrupt status register value */ 119881d588aSDmitry Fleytman uint64_t reg_interrupt_enabled; /* Interrupt mask register value */ 120881d588aSDmitry Fleytman uint64_t reg_command_status; /* Command status register value */ 121881d588aSDmitry Fleytman 122881d588aSDmitry Fleytman /* Command data adoption mechanism */ 123881d588aSDmitry Fleytman uint64_t curr_cmd; /* Last command arrived */ 124881d588aSDmitry Fleytman uint32_t curr_cmd_data_cntr; /* Amount of data for last command */ 125881d588aSDmitry Fleytman 126881d588aSDmitry Fleytman /* Collector for current command data */ 127881d588aSDmitry Fleytman uint32_t curr_cmd_data[PVSCSI_MAX_CMD_DATA_WORDS]; 128881d588aSDmitry Fleytman 129881d588aSDmitry Fleytman uint8_t rings_info_valid; /* Whether data rings initialized */ 130881d588aSDmitry Fleytman uint8_t msg_ring_info_valid; /* Whether message ring initialized */ 131881d588aSDmitry Fleytman uint8_t use_msg; /* Whether to use message ring */ 132881d588aSDmitry Fleytman 133269fe4c3SCao jin uint8_t msi_used; /* For migration compatibility */ 134881d588aSDmitry Fleytman PVSCSIRingInfo rings; /* Data transfer rings manager */ 135881d588aSDmitry Fleytman uint32_t resetting; /* Reset in progress */ 136d29d4ff8SShmulik Ladkani 137d29d4ff8SShmulik Ladkani uint32_t compat_flags; 138*db1015e9SEduardo Habkost }; 139881d588aSDmitry Fleytman 140881d588aSDmitry Fleytman typedef struct PVSCSIRequest { 141881d588aSDmitry Fleytman SCSIRequest *sreq; 142881d588aSDmitry Fleytman PVSCSIState *dev; 143881d588aSDmitry Fleytman uint8_t sense_key; 144881d588aSDmitry Fleytman uint8_t completed; 145881d588aSDmitry Fleytman int lun; 146881d588aSDmitry Fleytman QEMUSGList sgl; 147881d588aSDmitry Fleytman PVSCSISGState sg; 148881d588aSDmitry Fleytman struct PVSCSIRingReqDesc req; 149881d588aSDmitry Fleytman struct PVSCSIRingCmpDesc cmp; 150881d588aSDmitry Fleytman QTAILQ_ENTRY(PVSCSIRequest) next; 151881d588aSDmitry Fleytman } PVSCSIRequest; 152881d588aSDmitry Fleytman 153881d588aSDmitry Fleytman /* Integer binary logarithm */ 154881d588aSDmitry Fleytman static int 155881d588aSDmitry Fleytman pvscsi_log2(uint32_t input) 156881d588aSDmitry Fleytman { 157881d588aSDmitry Fleytman int log = 0; 158881d588aSDmitry Fleytman assert(input > 0); 159881d588aSDmitry Fleytman while (input >> ++log) { 160881d588aSDmitry Fleytman } 161881d588aSDmitry Fleytman return log; 162881d588aSDmitry Fleytman } 163881d588aSDmitry Fleytman 1647f61f469SPrasad J Pandit static void 165881d588aSDmitry Fleytman pvscsi_ring_init_data(PVSCSIRingInfo *m, PVSCSICmdDescSetupRings *ri) 166881d588aSDmitry Fleytman { 167881d588aSDmitry Fleytman int i; 168881d588aSDmitry Fleytman uint32_t txr_len_log2, rxr_len_log2; 169881d588aSDmitry Fleytman uint32_t req_ring_size, cmp_ring_size; 170881d588aSDmitry Fleytman m->rs_pa = ri->ringsStatePPN << VMW_PAGE_SHIFT; 171881d588aSDmitry Fleytman 172881d588aSDmitry Fleytman req_ring_size = ri->reqRingNumPages * PVSCSI_MAX_NUM_REQ_ENTRIES_PER_PAGE; 173881d588aSDmitry Fleytman cmp_ring_size = ri->cmpRingNumPages * PVSCSI_MAX_NUM_CMP_ENTRIES_PER_PAGE; 174881d588aSDmitry Fleytman txr_len_log2 = pvscsi_log2(req_ring_size - 1); 175881d588aSDmitry Fleytman rxr_len_log2 = pvscsi_log2(cmp_ring_size - 1); 176881d588aSDmitry Fleytman 177881d588aSDmitry Fleytman m->txr_len_mask = MASK(txr_len_log2); 178881d588aSDmitry Fleytman m->rxr_len_mask = MASK(rxr_len_log2); 179881d588aSDmitry Fleytman 180881d588aSDmitry Fleytman m->consumed_ptr = 0; 181881d588aSDmitry Fleytman m->filled_cmp_ptr = 0; 182881d588aSDmitry Fleytman 183881d588aSDmitry Fleytman for (i = 0; i < ri->reqRingNumPages; i++) { 184881d588aSDmitry Fleytman m->req_ring_pages_pa[i] = ri->reqRingPPNs[i] << VMW_PAGE_SHIFT; 185881d588aSDmitry Fleytman } 186881d588aSDmitry Fleytman 187881d588aSDmitry Fleytman for (i = 0; i < ri->cmpRingNumPages; i++) { 188881d588aSDmitry Fleytman m->cmp_ring_pages_pa[i] = ri->cmpRingPPNs[i] << VMW_PAGE_SHIFT; 189881d588aSDmitry Fleytman } 190881d588aSDmitry Fleytman 1910dc40f28SPaolo Bonzini RS_SET_FIELD(m, reqProdIdx, 0); 1920dc40f28SPaolo Bonzini RS_SET_FIELD(m, reqConsIdx, 0); 1930dc40f28SPaolo Bonzini RS_SET_FIELD(m, reqNumEntriesLog2, txr_len_log2); 194881d588aSDmitry Fleytman 1950dc40f28SPaolo Bonzini RS_SET_FIELD(m, cmpProdIdx, 0); 1960dc40f28SPaolo Bonzini RS_SET_FIELD(m, cmpConsIdx, 0); 1970dc40f28SPaolo Bonzini RS_SET_FIELD(m, cmpNumEntriesLog2, rxr_len_log2); 198881d588aSDmitry Fleytman 199881d588aSDmitry Fleytman trace_pvscsi_ring_init_data(txr_len_log2, rxr_len_log2); 200881d588aSDmitry Fleytman 201881d588aSDmitry Fleytman /* Flush ring state page changes */ 202881d588aSDmitry Fleytman smp_wmb(); 203881d588aSDmitry Fleytman } 204881d588aSDmitry Fleytman 2053e831b40SPrasad J Pandit static int 206881d588aSDmitry Fleytman pvscsi_ring_init_msg(PVSCSIRingInfo *m, PVSCSICmdDescSetupMsgRing *ri) 207881d588aSDmitry Fleytman { 208881d588aSDmitry Fleytman int i; 209881d588aSDmitry Fleytman uint32_t len_log2; 210881d588aSDmitry Fleytman uint32_t ring_size; 211881d588aSDmitry Fleytman 212f6882698SP J P if (!ri->numPages || ri->numPages > PVSCSI_SETUP_MSG_RING_MAX_NUM_PAGES) { 2133e831b40SPrasad J Pandit return -1; 2143e831b40SPrasad J Pandit } 215881d588aSDmitry Fleytman ring_size = ri->numPages * PVSCSI_MAX_NUM_MSG_ENTRIES_PER_PAGE; 216881d588aSDmitry Fleytman len_log2 = pvscsi_log2(ring_size - 1); 217881d588aSDmitry Fleytman 218881d588aSDmitry Fleytman m->msg_len_mask = MASK(len_log2); 219881d588aSDmitry Fleytman 220881d588aSDmitry Fleytman m->filled_msg_ptr = 0; 221881d588aSDmitry Fleytman 222881d588aSDmitry Fleytman for (i = 0; i < ri->numPages; i++) { 223881d588aSDmitry Fleytman m->msg_ring_pages_pa[i] = ri->ringPPNs[i] << VMW_PAGE_SHIFT; 224881d588aSDmitry Fleytman } 225881d588aSDmitry Fleytman 2260dc40f28SPaolo Bonzini RS_SET_FIELD(m, msgProdIdx, 0); 2270dc40f28SPaolo Bonzini RS_SET_FIELD(m, msgConsIdx, 0); 2280dc40f28SPaolo Bonzini RS_SET_FIELD(m, msgNumEntriesLog2, len_log2); 229881d588aSDmitry Fleytman 230881d588aSDmitry Fleytman trace_pvscsi_ring_init_msg(len_log2); 231881d588aSDmitry Fleytman 232881d588aSDmitry Fleytman /* Flush ring state page changes */ 233881d588aSDmitry Fleytman smp_wmb(); 2343e831b40SPrasad J Pandit 2353e831b40SPrasad J Pandit return 0; 236881d588aSDmitry Fleytman } 237881d588aSDmitry Fleytman 238881d588aSDmitry Fleytman static void 239881d588aSDmitry Fleytman pvscsi_ring_cleanup(PVSCSIRingInfo *mgr) 240881d588aSDmitry Fleytman { 241881d588aSDmitry Fleytman mgr->rs_pa = 0; 242881d588aSDmitry Fleytman mgr->txr_len_mask = 0; 243881d588aSDmitry Fleytman mgr->rxr_len_mask = 0; 244881d588aSDmitry Fleytman mgr->msg_len_mask = 0; 245881d588aSDmitry Fleytman mgr->consumed_ptr = 0; 246881d588aSDmitry Fleytman mgr->filled_cmp_ptr = 0; 247881d588aSDmitry Fleytman mgr->filled_msg_ptr = 0; 248881d588aSDmitry Fleytman memset(mgr->req_ring_pages_pa, 0, sizeof(mgr->req_ring_pages_pa)); 249881d588aSDmitry Fleytman memset(mgr->cmp_ring_pages_pa, 0, sizeof(mgr->cmp_ring_pages_pa)); 250881d588aSDmitry Fleytman memset(mgr->msg_ring_pages_pa, 0, sizeof(mgr->msg_ring_pages_pa)); 251881d588aSDmitry Fleytman } 252881d588aSDmitry Fleytman 253881d588aSDmitry Fleytman static hwaddr 254881d588aSDmitry Fleytman pvscsi_ring_pop_req_descr(PVSCSIRingInfo *mgr) 255881d588aSDmitry Fleytman { 2560dc40f28SPaolo Bonzini uint32_t ready_ptr = RS_GET_FIELD(mgr, reqProdIdx); 257d251157aSPrasad J Pandit uint32_t ring_size = PVSCSI_MAX_NUM_PAGES_REQ_RING 258d251157aSPrasad J Pandit * PVSCSI_MAX_NUM_REQ_ENTRIES_PER_PAGE; 259881d588aSDmitry Fleytman 260d251157aSPrasad J Pandit if (ready_ptr != mgr->consumed_ptr 261d251157aSPrasad J Pandit && ready_ptr - mgr->consumed_ptr < ring_size) { 262881d588aSDmitry Fleytman uint32_t next_ready_ptr = 263881d588aSDmitry Fleytman mgr->consumed_ptr++ & mgr->txr_len_mask; 264881d588aSDmitry Fleytman uint32_t next_ready_page = 265881d588aSDmitry Fleytman next_ready_ptr / PVSCSI_MAX_NUM_REQ_ENTRIES_PER_PAGE; 266881d588aSDmitry Fleytman uint32_t inpage_idx = 267881d588aSDmitry Fleytman next_ready_ptr % PVSCSI_MAX_NUM_REQ_ENTRIES_PER_PAGE; 268881d588aSDmitry Fleytman 269881d588aSDmitry Fleytman return mgr->req_ring_pages_pa[next_ready_page] + 270881d588aSDmitry Fleytman inpage_idx * sizeof(PVSCSIRingReqDesc); 271881d588aSDmitry Fleytman } else { 272881d588aSDmitry Fleytman return 0; 273881d588aSDmitry Fleytman } 274881d588aSDmitry Fleytman } 275881d588aSDmitry Fleytman 276881d588aSDmitry Fleytman static void 277881d588aSDmitry Fleytman pvscsi_ring_flush_req(PVSCSIRingInfo *mgr) 278881d588aSDmitry Fleytman { 2790dc40f28SPaolo Bonzini RS_SET_FIELD(mgr, reqConsIdx, mgr->consumed_ptr); 280881d588aSDmitry Fleytman } 281881d588aSDmitry Fleytman 282881d588aSDmitry Fleytman static hwaddr 283881d588aSDmitry Fleytman pvscsi_ring_pop_cmp_descr(PVSCSIRingInfo *mgr) 284881d588aSDmitry Fleytman { 285881d588aSDmitry Fleytman /* 286881d588aSDmitry Fleytman * According to Linux driver code it explicitly verifies that number 287881d588aSDmitry Fleytman * of requests being processed by device is less then the size of 288881d588aSDmitry Fleytman * completion queue, so device may omit completion queue overflow 289881d588aSDmitry Fleytman * conditions check. We assume that this is true for other (Windows) 290881d588aSDmitry Fleytman * drivers as well. 291881d588aSDmitry Fleytman */ 292881d588aSDmitry Fleytman 293881d588aSDmitry Fleytman uint32_t free_cmp_ptr = 294881d588aSDmitry Fleytman mgr->filled_cmp_ptr++ & mgr->rxr_len_mask; 295881d588aSDmitry Fleytman uint32_t free_cmp_page = 296881d588aSDmitry Fleytman free_cmp_ptr / PVSCSI_MAX_NUM_CMP_ENTRIES_PER_PAGE; 297881d588aSDmitry Fleytman uint32_t inpage_idx = 298881d588aSDmitry Fleytman free_cmp_ptr % PVSCSI_MAX_NUM_CMP_ENTRIES_PER_PAGE; 299881d588aSDmitry Fleytman return mgr->cmp_ring_pages_pa[free_cmp_page] + 300881d588aSDmitry Fleytman inpage_idx * sizeof(PVSCSIRingCmpDesc); 301881d588aSDmitry Fleytman } 302881d588aSDmitry Fleytman 303881d588aSDmitry Fleytman static hwaddr 304881d588aSDmitry Fleytman pvscsi_ring_pop_msg_descr(PVSCSIRingInfo *mgr) 305881d588aSDmitry Fleytman { 306881d588aSDmitry Fleytman uint32_t free_msg_ptr = 307881d588aSDmitry Fleytman mgr->filled_msg_ptr++ & mgr->msg_len_mask; 308881d588aSDmitry Fleytman uint32_t free_msg_page = 309881d588aSDmitry Fleytman free_msg_ptr / PVSCSI_MAX_NUM_MSG_ENTRIES_PER_PAGE; 310881d588aSDmitry Fleytman uint32_t inpage_idx = 311881d588aSDmitry Fleytman free_msg_ptr % PVSCSI_MAX_NUM_MSG_ENTRIES_PER_PAGE; 312881d588aSDmitry Fleytman return mgr->msg_ring_pages_pa[free_msg_page] + 313881d588aSDmitry Fleytman inpage_idx * sizeof(PVSCSIRingMsgDesc); 314881d588aSDmitry Fleytman } 315881d588aSDmitry Fleytman 316881d588aSDmitry Fleytman static void 317881d588aSDmitry Fleytman pvscsi_ring_flush_cmp(PVSCSIRingInfo *mgr) 318881d588aSDmitry Fleytman { 319881d588aSDmitry Fleytman /* Flush descriptor changes */ 320881d588aSDmitry Fleytman smp_wmb(); 321881d588aSDmitry Fleytman 322881d588aSDmitry Fleytman trace_pvscsi_ring_flush_cmp(mgr->filled_cmp_ptr); 323881d588aSDmitry Fleytman 3240dc40f28SPaolo Bonzini RS_SET_FIELD(mgr, cmpProdIdx, mgr->filled_cmp_ptr); 325881d588aSDmitry Fleytman } 326881d588aSDmitry Fleytman 327881d588aSDmitry Fleytman static bool 328881d588aSDmitry Fleytman pvscsi_ring_msg_has_room(PVSCSIRingInfo *mgr) 329881d588aSDmitry Fleytman { 3300dc40f28SPaolo Bonzini uint32_t prodIdx = RS_GET_FIELD(mgr, msgProdIdx); 3310dc40f28SPaolo Bonzini uint32_t consIdx = RS_GET_FIELD(mgr, msgConsIdx); 332881d588aSDmitry Fleytman 333881d588aSDmitry Fleytman return (prodIdx - consIdx) < (mgr->msg_len_mask + 1); 334881d588aSDmitry Fleytman } 335881d588aSDmitry Fleytman 336881d588aSDmitry Fleytman static void 337881d588aSDmitry Fleytman pvscsi_ring_flush_msg(PVSCSIRingInfo *mgr) 338881d588aSDmitry Fleytman { 339881d588aSDmitry Fleytman /* Flush descriptor changes */ 340881d588aSDmitry Fleytman smp_wmb(); 341881d588aSDmitry Fleytman 342881d588aSDmitry Fleytman trace_pvscsi_ring_flush_msg(mgr->filled_msg_ptr); 343881d588aSDmitry Fleytman 3440dc40f28SPaolo Bonzini RS_SET_FIELD(mgr, msgProdIdx, mgr->filled_msg_ptr); 345881d588aSDmitry Fleytman } 346881d588aSDmitry Fleytman 347881d588aSDmitry Fleytman static void 348881d588aSDmitry Fleytman pvscsi_reset_state(PVSCSIState *s) 349881d588aSDmitry Fleytman { 350881d588aSDmitry Fleytman s->curr_cmd = PVSCSI_CMD_FIRST; 351881d588aSDmitry Fleytman s->curr_cmd_data_cntr = 0; 352881d588aSDmitry Fleytman s->reg_command_status = PVSCSI_COMMAND_PROCESSING_SUCCEEDED; 353881d588aSDmitry Fleytman s->reg_interrupt_status = 0; 354881d588aSDmitry Fleytman pvscsi_ring_cleanup(&s->rings); 355881d588aSDmitry Fleytman s->rings_info_valid = FALSE; 356881d588aSDmitry Fleytman s->msg_ring_info_valid = FALSE; 357881d588aSDmitry Fleytman QTAILQ_INIT(&s->pending_queue); 358881d588aSDmitry Fleytman QTAILQ_INIT(&s->completion_queue); 359881d588aSDmitry Fleytman } 360881d588aSDmitry Fleytman 361881d588aSDmitry Fleytman static void 362881d588aSDmitry Fleytman pvscsi_update_irq_status(PVSCSIState *s) 363881d588aSDmitry Fleytman { 364881d588aSDmitry Fleytman PCIDevice *d = PCI_DEVICE(s); 365881d588aSDmitry Fleytman bool should_raise = s->reg_interrupt_enabled & s->reg_interrupt_status; 366881d588aSDmitry Fleytman 367881d588aSDmitry Fleytman trace_pvscsi_update_irq_level(should_raise, s->reg_interrupt_enabled, 368881d588aSDmitry Fleytman s->reg_interrupt_status); 369881d588aSDmitry Fleytman 370269fe4c3SCao jin if (msi_enabled(d)) { 371881d588aSDmitry Fleytman if (should_raise) { 372881d588aSDmitry Fleytman trace_pvscsi_update_irq_msi(); 373881d588aSDmitry Fleytman msi_notify(d, PVSCSI_VECTOR_COMPLETION); 374881d588aSDmitry Fleytman } 375881d588aSDmitry Fleytman return; 376881d588aSDmitry Fleytman } 377881d588aSDmitry Fleytman 3789e64f8a3SMarcel Apfelbaum pci_set_irq(d, !!should_raise); 379881d588aSDmitry Fleytman } 380881d588aSDmitry Fleytman 381881d588aSDmitry Fleytman static void 382881d588aSDmitry Fleytman pvscsi_raise_completion_interrupt(PVSCSIState *s) 383881d588aSDmitry Fleytman { 384881d588aSDmitry Fleytman s->reg_interrupt_status |= PVSCSI_INTR_CMPL_0; 385881d588aSDmitry Fleytman 386881d588aSDmitry Fleytman /* Memory barrier to flush interrupt status register changes*/ 387881d588aSDmitry Fleytman smp_wmb(); 388881d588aSDmitry Fleytman 389881d588aSDmitry Fleytman pvscsi_update_irq_status(s); 390881d588aSDmitry Fleytman } 391881d588aSDmitry Fleytman 392881d588aSDmitry Fleytman static void 393881d588aSDmitry Fleytman pvscsi_raise_message_interrupt(PVSCSIState *s) 394881d588aSDmitry Fleytman { 395881d588aSDmitry Fleytman s->reg_interrupt_status |= PVSCSI_INTR_MSG_0; 396881d588aSDmitry Fleytman 397881d588aSDmitry Fleytman /* Memory barrier to flush interrupt status register changes*/ 398881d588aSDmitry Fleytman smp_wmb(); 399881d588aSDmitry Fleytman 400881d588aSDmitry Fleytman pvscsi_update_irq_status(s); 401881d588aSDmitry Fleytman } 402881d588aSDmitry Fleytman 403881d588aSDmitry Fleytman static void 404881d588aSDmitry Fleytman pvscsi_cmp_ring_put(PVSCSIState *s, struct PVSCSIRingCmpDesc *cmp_desc) 405881d588aSDmitry Fleytman { 406881d588aSDmitry Fleytman hwaddr cmp_descr_pa; 407881d588aSDmitry Fleytman 408881d588aSDmitry Fleytman cmp_descr_pa = pvscsi_ring_pop_cmp_descr(&s->rings); 409881d588aSDmitry Fleytman trace_pvscsi_cmp_ring_put(cmp_descr_pa); 4100eeef0a4SPhilippe Mathieu-Daudé cpu_physical_memory_write(cmp_descr_pa, cmp_desc, sizeof(*cmp_desc)); 411881d588aSDmitry Fleytman } 412881d588aSDmitry Fleytman 413881d588aSDmitry Fleytman static void 414881d588aSDmitry Fleytman pvscsi_msg_ring_put(PVSCSIState *s, struct PVSCSIRingMsgDesc *msg_desc) 415881d588aSDmitry Fleytman { 416881d588aSDmitry Fleytman hwaddr msg_descr_pa; 417881d588aSDmitry Fleytman 418881d588aSDmitry Fleytman msg_descr_pa = pvscsi_ring_pop_msg_descr(&s->rings); 419881d588aSDmitry Fleytman trace_pvscsi_msg_ring_put(msg_descr_pa); 4200eeef0a4SPhilippe Mathieu-Daudé cpu_physical_memory_write(msg_descr_pa, msg_desc, sizeof(*msg_desc)); 421881d588aSDmitry Fleytman } 422881d588aSDmitry Fleytman 423881d588aSDmitry Fleytman static void 424881d588aSDmitry Fleytman pvscsi_process_completion_queue(void *opaque) 425881d588aSDmitry Fleytman { 426881d588aSDmitry Fleytman PVSCSIState *s = opaque; 427881d588aSDmitry Fleytman PVSCSIRequest *pvscsi_req; 428881d588aSDmitry Fleytman bool has_completed = false; 429881d588aSDmitry Fleytman 430881d588aSDmitry Fleytman while (!QTAILQ_EMPTY(&s->completion_queue)) { 431881d588aSDmitry Fleytman pvscsi_req = QTAILQ_FIRST(&s->completion_queue); 432881d588aSDmitry Fleytman QTAILQ_REMOVE(&s->completion_queue, pvscsi_req, next); 433881d588aSDmitry Fleytman pvscsi_cmp_ring_put(s, &pvscsi_req->cmp); 434881d588aSDmitry Fleytman g_free(pvscsi_req); 435dcb07809SStefan Weil has_completed = true; 436881d588aSDmitry Fleytman } 437881d588aSDmitry Fleytman 438881d588aSDmitry Fleytman if (has_completed) { 439881d588aSDmitry Fleytman pvscsi_ring_flush_cmp(&s->rings); 440881d588aSDmitry Fleytman pvscsi_raise_completion_interrupt(s); 441881d588aSDmitry Fleytman } 442881d588aSDmitry Fleytman } 443881d588aSDmitry Fleytman 444881d588aSDmitry Fleytman static void 445881d588aSDmitry Fleytman pvscsi_reset_adapter(PVSCSIState *s) 446881d588aSDmitry Fleytman { 447881d588aSDmitry Fleytman s->resetting++; 448573c3e07SPhilippe Mathieu-Daudé qbus_reset_all(BUS(&s->bus)); 449881d588aSDmitry Fleytman s->resetting--; 450881d588aSDmitry Fleytman pvscsi_process_completion_queue(s); 451881d588aSDmitry Fleytman assert(QTAILQ_EMPTY(&s->pending_queue)); 452881d588aSDmitry Fleytman pvscsi_reset_state(s); 453881d588aSDmitry Fleytman } 454881d588aSDmitry Fleytman 455881d588aSDmitry Fleytman static void 456881d588aSDmitry Fleytman pvscsi_schedule_completion_processing(PVSCSIState *s) 457881d588aSDmitry Fleytman { 458881d588aSDmitry Fleytman /* Try putting more complete requests on the ring. */ 459881d588aSDmitry Fleytman if (!QTAILQ_EMPTY(&s->completion_queue)) { 460881d588aSDmitry Fleytman qemu_bh_schedule(s->completion_worker); 461881d588aSDmitry Fleytman } 462881d588aSDmitry Fleytman } 463881d588aSDmitry Fleytman 464881d588aSDmitry Fleytman static void 465881d588aSDmitry Fleytman pvscsi_complete_request(PVSCSIState *s, PVSCSIRequest *r) 466881d588aSDmitry Fleytman { 467881d588aSDmitry Fleytman assert(!r->completed); 468881d588aSDmitry Fleytman 469881d588aSDmitry Fleytman trace_pvscsi_complete_request(r->cmp.context, r->cmp.dataLen, 470881d588aSDmitry Fleytman r->sense_key); 471881d588aSDmitry Fleytman if (r->sreq != NULL) { 472881d588aSDmitry Fleytman scsi_req_unref(r->sreq); 473881d588aSDmitry Fleytman r->sreq = NULL; 474881d588aSDmitry Fleytman } 475881d588aSDmitry Fleytman r->completed = 1; 476881d588aSDmitry Fleytman QTAILQ_REMOVE(&s->pending_queue, r, next); 477881d588aSDmitry Fleytman QTAILQ_INSERT_TAIL(&s->completion_queue, r, next); 478881d588aSDmitry Fleytman pvscsi_schedule_completion_processing(s); 479881d588aSDmitry Fleytman } 480881d588aSDmitry Fleytman 481881d588aSDmitry Fleytman static QEMUSGList *pvscsi_get_sg_list(SCSIRequest *r) 482881d588aSDmitry Fleytman { 483881d588aSDmitry Fleytman PVSCSIRequest *req = r->hba_private; 484881d588aSDmitry Fleytman 485881d588aSDmitry Fleytman trace_pvscsi_get_sg_list(req->sgl.nsg, req->sgl.size); 486881d588aSDmitry Fleytman 487881d588aSDmitry Fleytman return &req->sgl; 488881d588aSDmitry Fleytman } 489881d588aSDmitry Fleytman 490881d588aSDmitry Fleytman static void 491881d588aSDmitry Fleytman pvscsi_get_next_sg_elem(PVSCSISGState *sg) 492881d588aSDmitry Fleytman { 493881d588aSDmitry Fleytman struct PVSCSISGElement elem; 494881d588aSDmitry Fleytman 4950eeef0a4SPhilippe Mathieu-Daudé cpu_physical_memory_read(sg->elemAddr, &elem, sizeof(elem)); 496881d588aSDmitry Fleytman if ((elem.flags & ~PVSCSI_KNOWN_FLAGS) != 0) { 497881d588aSDmitry Fleytman /* 498881d588aSDmitry Fleytman * There is PVSCSI_SGE_FLAG_CHAIN_ELEMENT flag described in 499881d588aSDmitry Fleytman * header file but its value is unknown. This flag requires 500881d588aSDmitry Fleytman * additional processing, so we put warning here to catch it 501881d588aSDmitry Fleytman * some day and make proper implementation 502881d588aSDmitry Fleytman */ 503881d588aSDmitry Fleytman trace_pvscsi_get_next_sg_elem(elem.flags); 504881d588aSDmitry Fleytman } 505881d588aSDmitry Fleytman 506881d588aSDmitry Fleytman sg->elemAddr += sizeof(elem); 507881d588aSDmitry Fleytman sg->dataAddr = elem.addr; 508881d588aSDmitry Fleytman sg->resid = elem.length; 509881d588aSDmitry Fleytman } 510881d588aSDmitry Fleytman 511881d588aSDmitry Fleytman static void 512881d588aSDmitry Fleytman pvscsi_write_sense(PVSCSIRequest *r, uint8_t *sense, int len) 513881d588aSDmitry Fleytman { 514881d588aSDmitry Fleytman r->cmp.senseLen = MIN(r->req.senseLen, len); 515881d588aSDmitry Fleytman r->sense_key = sense[(sense[0] & 2) ? 1 : 2]; 516881d588aSDmitry Fleytman cpu_physical_memory_write(r->req.senseAddr, sense, r->cmp.senseLen); 517881d588aSDmitry Fleytman } 518881d588aSDmitry Fleytman 519881d588aSDmitry Fleytman static void 520881d588aSDmitry Fleytman pvscsi_command_complete(SCSIRequest *req, uint32_t status, size_t resid) 521881d588aSDmitry Fleytman { 522881d588aSDmitry Fleytman PVSCSIRequest *pvscsi_req = req->hba_private; 523b0f49d13SPrasad Joshi PVSCSIState *s; 524881d588aSDmitry Fleytman 525881d588aSDmitry Fleytman if (!pvscsi_req) { 526881d588aSDmitry Fleytman trace_pvscsi_command_complete_not_found(req->tag); 527881d588aSDmitry Fleytman return; 528881d588aSDmitry Fleytman } 529b0f49d13SPrasad Joshi s = pvscsi_req->dev; 530881d588aSDmitry Fleytman 531881d588aSDmitry Fleytman if (resid) { 532881d588aSDmitry Fleytman /* Short transfer. */ 533881d588aSDmitry Fleytman trace_pvscsi_command_complete_data_run(); 534881d588aSDmitry Fleytman pvscsi_req->cmp.hostStatus = BTSTAT_DATARUN; 535881d588aSDmitry Fleytman } 536881d588aSDmitry Fleytman 537881d588aSDmitry Fleytman pvscsi_req->cmp.scsiStatus = status; 538881d588aSDmitry Fleytman if (pvscsi_req->cmp.scsiStatus == CHECK_CONDITION) { 539881d588aSDmitry Fleytman uint8_t sense[SCSI_SENSE_BUF_SIZE]; 540881d588aSDmitry Fleytman int sense_len = 541881d588aSDmitry Fleytman scsi_req_get_sense(pvscsi_req->sreq, sense, sizeof(sense)); 542881d588aSDmitry Fleytman 543881d588aSDmitry Fleytman trace_pvscsi_command_complete_sense_len(sense_len); 544881d588aSDmitry Fleytman pvscsi_write_sense(pvscsi_req, sense, sense_len); 545881d588aSDmitry Fleytman } 546881d588aSDmitry Fleytman qemu_sglist_destroy(&pvscsi_req->sgl); 547881d588aSDmitry Fleytman pvscsi_complete_request(s, pvscsi_req); 548881d588aSDmitry Fleytman } 549881d588aSDmitry Fleytman 550881d588aSDmitry Fleytman static void 551881d588aSDmitry Fleytman pvscsi_send_msg(PVSCSIState *s, SCSIDevice *dev, uint32_t msg_type) 552881d588aSDmitry Fleytman { 553881d588aSDmitry Fleytman if (s->msg_ring_info_valid && pvscsi_ring_msg_has_room(&s->rings)) { 554881d588aSDmitry Fleytman PVSCSIMsgDescDevStatusChanged msg = {0}; 555881d588aSDmitry Fleytman 556881d588aSDmitry Fleytman msg.type = msg_type; 557881d588aSDmitry Fleytman msg.bus = dev->channel; 558881d588aSDmitry Fleytman msg.target = dev->id; 559881d588aSDmitry Fleytman msg.lun[1] = dev->lun; 560881d588aSDmitry Fleytman 561881d588aSDmitry Fleytman pvscsi_msg_ring_put(s, (PVSCSIRingMsgDesc *)&msg); 562881d588aSDmitry Fleytman pvscsi_ring_flush_msg(&s->rings); 563881d588aSDmitry Fleytman pvscsi_raise_message_interrupt(s); 564881d588aSDmitry Fleytman } 565881d588aSDmitry Fleytman } 566881d588aSDmitry Fleytman 567881d588aSDmitry Fleytman static void 56891c8daadSIgor Mammedov pvscsi_hotplug(HotplugHandler *hotplug_dev, DeviceState *dev, Error **errp) 569881d588aSDmitry Fleytman { 57091c8daadSIgor Mammedov PVSCSIState *s = PVSCSI(hotplug_dev); 57191c8daadSIgor Mammedov 57291c8daadSIgor Mammedov pvscsi_send_msg(s, SCSI_DEVICE(dev), PVSCSI_MSG_DEV_ADDED); 573881d588aSDmitry Fleytman } 574881d588aSDmitry Fleytman 575881d588aSDmitry Fleytman static void 57691c8daadSIgor Mammedov pvscsi_hot_unplug(HotplugHandler *hotplug_dev, DeviceState *dev, Error **errp) 577881d588aSDmitry Fleytman { 57891c8daadSIgor Mammedov PVSCSIState *s = PVSCSI(hotplug_dev); 57991c8daadSIgor Mammedov 58091c8daadSIgor Mammedov pvscsi_send_msg(s, SCSI_DEVICE(dev), PVSCSI_MSG_DEV_REMOVED); 58191c8daadSIgor Mammedov qdev_simple_device_unplug_cb(hotplug_dev, dev, errp); 582881d588aSDmitry Fleytman } 583881d588aSDmitry Fleytman 584881d588aSDmitry Fleytman static void 585881d588aSDmitry Fleytman pvscsi_request_cancelled(SCSIRequest *req) 586881d588aSDmitry Fleytman { 587881d588aSDmitry Fleytman PVSCSIRequest *pvscsi_req = req->hba_private; 588881d588aSDmitry Fleytman PVSCSIState *s = pvscsi_req->dev; 589881d588aSDmitry Fleytman 590881d588aSDmitry Fleytman if (pvscsi_req->completed) { 591881d588aSDmitry Fleytman return; 592881d588aSDmitry Fleytman } 593881d588aSDmitry Fleytman 594881d588aSDmitry Fleytman if (pvscsi_req->dev->resetting) { 595881d588aSDmitry Fleytman pvscsi_req->cmp.hostStatus = BTSTAT_BUSRESET; 596881d588aSDmitry Fleytman } else { 597881d588aSDmitry Fleytman pvscsi_req->cmp.hostStatus = BTSTAT_ABORTQUEUE; 598881d588aSDmitry Fleytman } 599881d588aSDmitry Fleytman 600881d588aSDmitry Fleytman pvscsi_complete_request(s, pvscsi_req); 601881d588aSDmitry Fleytman } 602881d588aSDmitry Fleytman 603881d588aSDmitry Fleytman static SCSIDevice* 604881d588aSDmitry Fleytman pvscsi_device_find(PVSCSIState *s, int channel, int target, 605881d588aSDmitry Fleytman uint8_t *requested_lun, uint8_t *target_lun) 606881d588aSDmitry Fleytman { 607881d588aSDmitry Fleytman if (requested_lun[0] || requested_lun[2] || requested_lun[3] || 608881d588aSDmitry Fleytman requested_lun[4] || requested_lun[5] || requested_lun[6] || 609881d588aSDmitry Fleytman requested_lun[7] || (target > PVSCSI_MAX_DEVS)) { 610881d588aSDmitry Fleytman return NULL; 611881d588aSDmitry Fleytman } else { 612881d588aSDmitry Fleytman *target_lun = requested_lun[1]; 613881d588aSDmitry Fleytman return scsi_device_find(&s->bus, channel, target, *target_lun); 614881d588aSDmitry Fleytman } 615881d588aSDmitry Fleytman } 616881d588aSDmitry Fleytman 617881d588aSDmitry Fleytman static PVSCSIRequest * 618881d588aSDmitry Fleytman pvscsi_queue_pending_descriptor(PVSCSIState *s, SCSIDevice **d, 619881d588aSDmitry Fleytman struct PVSCSIRingReqDesc *descr) 620881d588aSDmitry Fleytman { 621881d588aSDmitry Fleytman PVSCSIRequest *pvscsi_req; 622881d588aSDmitry Fleytman uint8_t lun; 623881d588aSDmitry Fleytman 624881d588aSDmitry Fleytman pvscsi_req = g_malloc0(sizeof(*pvscsi_req)); 625881d588aSDmitry Fleytman pvscsi_req->dev = s; 626881d588aSDmitry Fleytman pvscsi_req->req = *descr; 627881d588aSDmitry Fleytman pvscsi_req->cmp.context = pvscsi_req->req.context; 628881d588aSDmitry Fleytman QTAILQ_INSERT_TAIL(&s->pending_queue, pvscsi_req, next); 629881d588aSDmitry Fleytman 630881d588aSDmitry Fleytman *d = pvscsi_device_find(s, descr->bus, descr->target, descr->lun, &lun); 631881d588aSDmitry Fleytman if (*d) { 632881d588aSDmitry Fleytman pvscsi_req->lun = lun; 633881d588aSDmitry Fleytman } 634881d588aSDmitry Fleytman 635881d588aSDmitry Fleytman return pvscsi_req; 636881d588aSDmitry Fleytman } 637881d588aSDmitry Fleytman 638881d588aSDmitry Fleytman static void 639881d588aSDmitry Fleytman pvscsi_convert_sglist(PVSCSIRequest *r) 640881d588aSDmitry Fleytman { 64149adc5d3SPrasad J Pandit uint32_t chunk_size, elmcnt = 0; 642881d588aSDmitry Fleytman uint64_t data_length = r->req.dataLen; 643881d588aSDmitry Fleytman PVSCSISGState sg = r->sg; 64449adc5d3SPrasad J Pandit while (data_length && elmcnt < PVSCSI_MAX_SG_ELEM) { 64549adc5d3SPrasad J Pandit while (!sg.resid && elmcnt++ < PVSCSI_MAX_SG_ELEM) { 646881d588aSDmitry Fleytman pvscsi_get_next_sg_elem(&sg); 647881d588aSDmitry Fleytman trace_pvscsi_convert_sglist(r->req.context, r->sg.dataAddr, 648881d588aSDmitry Fleytman r->sg.resid); 649881d588aSDmitry Fleytman } 65049adc5d3SPrasad J Pandit chunk_size = MIN(data_length, sg.resid); 651881d588aSDmitry Fleytman if (chunk_size) { 652881d588aSDmitry Fleytman qemu_sglist_add(&r->sgl, sg.dataAddr, chunk_size); 653881d588aSDmitry Fleytman } 654881d588aSDmitry Fleytman 655881d588aSDmitry Fleytman sg.dataAddr += chunk_size; 656881d588aSDmitry Fleytman data_length -= chunk_size; 657881d588aSDmitry Fleytman sg.resid -= chunk_size; 658881d588aSDmitry Fleytman } 659881d588aSDmitry Fleytman } 660881d588aSDmitry Fleytman 661881d588aSDmitry Fleytman static void 662881d588aSDmitry Fleytman pvscsi_build_sglist(PVSCSIState *s, PVSCSIRequest *r) 663881d588aSDmitry Fleytman { 664881d588aSDmitry Fleytman PCIDevice *d = PCI_DEVICE(s); 665881d588aSDmitry Fleytman 666df32fd1cSPaolo Bonzini pci_dma_sglist_init(&r->sgl, d, 1); 667881d588aSDmitry Fleytman if (r->req.flags & PVSCSI_FLAG_CMD_WITH_SG_LIST) { 668881d588aSDmitry Fleytman pvscsi_convert_sglist(r); 669881d588aSDmitry Fleytman } else { 670881d588aSDmitry Fleytman qemu_sglist_add(&r->sgl, r->req.dataAddr, r->req.dataLen); 671881d588aSDmitry Fleytman } 672881d588aSDmitry Fleytman } 673881d588aSDmitry Fleytman 674881d588aSDmitry Fleytman static void 675881d588aSDmitry Fleytman pvscsi_process_request_descriptor(PVSCSIState *s, 676881d588aSDmitry Fleytman struct PVSCSIRingReqDesc *descr) 677881d588aSDmitry Fleytman { 678881d588aSDmitry Fleytman SCSIDevice *d; 679881d588aSDmitry Fleytman PVSCSIRequest *r = pvscsi_queue_pending_descriptor(s, &d, descr); 680881d588aSDmitry Fleytman int64_t n; 681881d588aSDmitry Fleytman 682881d588aSDmitry Fleytman trace_pvscsi_process_req_descr(descr->cdb[0], descr->context); 683881d588aSDmitry Fleytman 684881d588aSDmitry Fleytman if (!d) { 685881d588aSDmitry Fleytman r->cmp.hostStatus = BTSTAT_SELTIMEO; 686881d588aSDmitry Fleytman trace_pvscsi_process_req_descr_unknown_device(); 687881d588aSDmitry Fleytman pvscsi_complete_request(s, r); 688881d588aSDmitry Fleytman return; 689881d588aSDmitry Fleytman } 690881d588aSDmitry Fleytman 691881d588aSDmitry Fleytman if (descr->flags & PVSCSI_FLAG_CMD_WITH_SG_LIST) { 692881d588aSDmitry Fleytman r->sg.elemAddr = descr->dataAddr; 693881d588aSDmitry Fleytman } 694881d588aSDmitry Fleytman 695881d588aSDmitry Fleytman r->sreq = scsi_req_new(d, descr->context, r->lun, descr->cdb, r); 696881d588aSDmitry Fleytman if (r->sreq->cmd.mode == SCSI_XFER_FROM_DEV && 697881d588aSDmitry Fleytman (descr->flags & PVSCSI_FLAG_CMD_DIR_TODEVICE)) { 698881d588aSDmitry Fleytman r->cmp.hostStatus = BTSTAT_BADMSG; 699881d588aSDmitry Fleytman trace_pvscsi_process_req_descr_invalid_dir(); 700881d588aSDmitry Fleytman scsi_req_cancel(r->sreq); 701881d588aSDmitry Fleytman return; 702881d588aSDmitry Fleytman } 703881d588aSDmitry Fleytman if (r->sreq->cmd.mode == SCSI_XFER_TO_DEV && 704881d588aSDmitry Fleytman (descr->flags & PVSCSI_FLAG_CMD_DIR_TOHOST)) { 705881d588aSDmitry Fleytman r->cmp.hostStatus = BTSTAT_BADMSG; 706881d588aSDmitry Fleytman trace_pvscsi_process_req_descr_invalid_dir(); 707881d588aSDmitry Fleytman scsi_req_cancel(r->sreq); 708881d588aSDmitry Fleytman return; 709881d588aSDmitry Fleytman } 710881d588aSDmitry Fleytman 711881d588aSDmitry Fleytman pvscsi_build_sglist(s, r); 712881d588aSDmitry Fleytman n = scsi_req_enqueue(r->sreq); 713881d588aSDmitry Fleytman 714881d588aSDmitry Fleytman if (n) { 715881d588aSDmitry Fleytman scsi_req_continue(r->sreq); 716881d588aSDmitry Fleytman } 717881d588aSDmitry Fleytman } 718881d588aSDmitry Fleytman 719881d588aSDmitry Fleytman static void 720881d588aSDmitry Fleytman pvscsi_process_io(PVSCSIState *s) 721881d588aSDmitry Fleytman { 722881d588aSDmitry Fleytman PVSCSIRingReqDesc descr; 723881d588aSDmitry Fleytman hwaddr next_descr_pa; 724881d588aSDmitry Fleytman 725e7ebf057SElazar Leibovich if (!s->rings_info_valid) { 726e7ebf057SElazar Leibovich return; 727e7ebf057SElazar Leibovich } 728e7ebf057SElazar Leibovich 729881d588aSDmitry Fleytman while ((next_descr_pa = pvscsi_ring_pop_req_descr(&s->rings)) != 0) { 730881d588aSDmitry Fleytman 731881d588aSDmitry Fleytman /* Only read after production index verification */ 732881d588aSDmitry Fleytman smp_rmb(); 733881d588aSDmitry Fleytman 734881d588aSDmitry Fleytman trace_pvscsi_process_io(next_descr_pa); 735881d588aSDmitry Fleytman cpu_physical_memory_read(next_descr_pa, &descr, sizeof(descr)); 736881d588aSDmitry Fleytman pvscsi_process_request_descriptor(s, &descr); 737881d588aSDmitry Fleytman } 738881d588aSDmitry Fleytman 739881d588aSDmitry Fleytman pvscsi_ring_flush_req(&s->rings); 740881d588aSDmitry Fleytman } 741881d588aSDmitry Fleytman 742881d588aSDmitry Fleytman static void 743881d588aSDmitry Fleytman pvscsi_dbg_dump_tx_rings_config(PVSCSICmdDescSetupRings *rc) 744881d588aSDmitry Fleytman { 745881d588aSDmitry Fleytman int i; 746881d588aSDmitry Fleytman trace_pvscsi_tx_rings_ppn("Rings State", rc->ringsStatePPN); 747881d588aSDmitry Fleytman 748881d588aSDmitry Fleytman trace_pvscsi_tx_rings_num_pages("Request Ring", rc->reqRingNumPages); 749881d588aSDmitry Fleytman for (i = 0; i < rc->reqRingNumPages; i++) { 750881d588aSDmitry Fleytman trace_pvscsi_tx_rings_ppn("Request Ring", rc->reqRingPPNs[i]); 751881d588aSDmitry Fleytman } 752881d588aSDmitry Fleytman 753881d588aSDmitry Fleytman trace_pvscsi_tx_rings_num_pages("Confirm Ring", rc->cmpRingNumPages); 754881d588aSDmitry Fleytman for (i = 0; i < rc->cmpRingNumPages; i++) { 7557f61f469SPrasad J Pandit trace_pvscsi_tx_rings_ppn("Confirm Ring", rc->cmpRingPPNs[i]); 756881d588aSDmitry Fleytman } 757881d588aSDmitry Fleytman } 758881d588aSDmitry Fleytman 759881d588aSDmitry Fleytman static uint64_t 760881d588aSDmitry Fleytman pvscsi_on_cmd_config(PVSCSIState *s) 761881d588aSDmitry Fleytman { 762881d588aSDmitry Fleytman trace_pvscsi_on_cmd_noimpl("PVSCSI_CMD_CONFIG"); 763881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_FAILED; 764881d588aSDmitry Fleytman } 765881d588aSDmitry Fleytman 766881d588aSDmitry Fleytman static uint64_t 767881d588aSDmitry Fleytman pvscsi_on_cmd_unplug(PVSCSIState *s) 768881d588aSDmitry Fleytman { 769881d588aSDmitry Fleytman trace_pvscsi_on_cmd_noimpl("PVSCSI_CMD_DEVICE_UNPLUG"); 770881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_FAILED; 771881d588aSDmitry Fleytman } 772881d588aSDmitry Fleytman 773881d588aSDmitry Fleytman static uint64_t 774881d588aSDmitry Fleytman pvscsi_on_issue_scsi(PVSCSIState *s) 775881d588aSDmitry Fleytman { 776881d588aSDmitry Fleytman trace_pvscsi_on_cmd_noimpl("PVSCSI_CMD_ISSUE_SCSI"); 777881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_FAILED; 778881d588aSDmitry Fleytman } 779881d588aSDmitry Fleytman 780881d588aSDmitry Fleytman static uint64_t 781881d588aSDmitry Fleytman pvscsi_on_cmd_setup_rings(PVSCSIState *s) 782881d588aSDmitry Fleytman { 783881d588aSDmitry Fleytman PVSCSICmdDescSetupRings *rc = 784881d588aSDmitry Fleytman (PVSCSICmdDescSetupRings *) s->curr_cmd_data; 785881d588aSDmitry Fleytman 786881d588aSDmitry Fleytman trace_pvscsi_on_cmd_arrived("PVSCSI_CMD_SETUP_RINGS"); 787881d588aSDmitry Fleytman 7887f61f469SPrasad J Pandit if (!rc->reqRingNumPages 7897f61f469SPrasad J Pandit || rc->reqRingNumPages > PVSCSI_SETUP_RINGS_MAX_NUM_PAGES 7907f61f469SPrasad J Pandit || !rc->cmpRingNumPages 7917f61f469SPrasad J Pandit || rc->cmpRingNumPages > PVSCSI_SETUP_RINGS_MAX_NUM_PAGES) { 7923e831b40SPrasad J Pandit return PVSCSI_COMMAND_PROCESSING_FAILED; 7933e831b40SPrasad J Pandit } 7943e831b40SPrasad J Pandit 7957f61f469SPrasad J Pandit pvscsi_dbg_dump_tx_rings_config(rc); 7967f61f469SPrasad J Pandit pvscsi_ring_init_data(&s->rings, rc); 7977f61f469SPrasad J Pandit 798881d588aSDmitry Fleytman s->rings_info_valid = TRUE; 799881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_SUCCEEDED; 800881d588aSDmitry Fleytman } 801881d588aSDmitry Fleytman 802881d588aSDmitry Fleytman static uint64_t 803881d588aSDmitry Fleytman pvscsi_on_cmd_abort(PVSCSIState *s) 804881d588aSDmitry Fleytman { 805881d588aSDmitry Fleytman PVSCSICmdDescAbortCmd *cmd = (PVSCSICmdDescAbortCmd *) s->curr_cmd_data; 806881d588aSDmitry Fleytman PVSCSIRequest *r, *next; 807881d588aSDmitry Fleytman 808881d588aSDmitry Fleytman trace_pvscsi_on_cmd_abort(cmd->context, cmd->target); 809881d588aSDmitry Fleytman 810881d588aSDmitry Fleytman QTAILQ_FOREACH_SAFE(r, &s->pending_queue, next, next) { 811881d588aSDmitry Fleytman if (r->req.context == cmd->context) { 812881d588aSDmitry Fleytman break; 813881d588aSDmitry Fleytman } 814881d588aSDmitry Fleytman } 815881d588aSDmitry Fleytman if (r) { 816881d588aSDmitry Fleytman assert(!r->completed); 817881d588aSDmitry Fleytman r->cmp.hostStatus = BTSTAT_ABORTQUEUE; 818881d588aSDmitry Fleytman scsi_req_cancel(r->sreq); 819881d588aSDmitry Fleytman } 820881d588aSDmitry Fleytman 821881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_SUCCEEDED; 822881d588aSDmitry Fleytman } 823881d588aSDmitry Fleytman 824881d588aSDmitry Fleytman static uint64_t 825881d588aSDmitry Fleytman pvscsi_on_cmd_unknown(PVSCSIState *s) 826881d588aSDmitry Fleytman { 827881d588aSDmitry Fleytman trace_pvscsi_on_cmd_unknown_data(s->curr_cmd_data[0]); 828881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_FAILED; 829881d588aSDmitry Fleytman } 830881d588aSDmitry Fleytman 831881d588aSDmitry Fleytman static uint64_t 832881d588aSDmitry Fleytman pvscsi_on_cmd_reset_device(PVSCSIState *s) 833881d588aSDmitry Fleytman { 834881d588aSDmitry Fleytman uint8_t target_lun = 0; 835881d588aSDmitry Fleytman struct PVSCSICmdDescResetDevice *cmd = 836881d588aSDmitry Fleytman (struct PVSCSICmdDescResetDevice *) s->curr_cmd_data; 837881d588aSDmitry Fleytman SCSIDevice *sdev; 838881d588aSDmitry Fleytman 839881d588aSDmitry Fleytman sdev = pvscsi_device_find(s, 0, cmd->target, cmd->lun, &target_lun); 840881d588aSDmitry Fleytman 841881d588aSDmitry Fleytman trace_pvscsi_on_cmd_reset_dev(cmd->target, (int) target_lun, sdev); 842881d588aSDmitry Fleytman 843881d588aSDmitry Fleytman if (sdev != NULL) { 844881d588aSDmitry Fleytman s->resetting++; 845f703a04cSDamien Hedde device_legacy_reset(&sdev->qdev); 846881d588aSDmitry Fleytman s->resetting--; 847881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_SUCCEEDED; 848881d588aSDmitry Fleytman } 849881d588aSDmitry Fleytman 850881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_FAILED; 851881d588aSDmitry Fleytman } 852881d588aSDmitry Fleytman 853881d588aSDmitry Fleytman static uint64_t 854881d588aSDmitry Fleytman pvscsi_on_cmd_reset_bus(PVSCSIState *s) 855881d588aSDmitry Fleytman { 856881d588aSDmitry Fleytman trace_pvscsi_on_cmd_arrived("PVSCSI_CMD_RESET_BUS"); 857881d588aSDmitry Fleytman 858881d588aSDmitry Fleytman s->resetting++; 859573c3e07SPhilippe Mathieu-Daudé qbus_reset_all(BUS(&s->bus)); 860881d588aSDmitry Fleytman s->resetting--; 861881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_SUCCEEDED; 862881d588aSDmitry Fleytman } 863881d588aSDmitry Fleytman 864881d588aSDmitry Fleytman static uint64_t 865881d588aSDmitry Fleytman pvscsi_on_cmd_setup_msg_ring(PVSCSIState *s) 866881d588aSDmitry Fleytman { 867881d588aSDmitry Fleytman PVSCSICmdDescSetupMsgRing *rc = 868881d588aSDmitry Fleytman (PVSCSICmdDescSetupMsgRing *) s->curr_cmd_data; 869881d588aSDmitry Fleytman 870881d588aSDmitry Fleytman trace_pvscsi_on_cmd_arrived("PVSCSI_CMD_SETUP_MSG_RING"); 871881d588aSDmitry Fleytman 872881d588aSDmitry Fleytman if (!s->use_msg) { 873881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_FAILED; 874881d588aSDmitry Fleytman } 875881d588aSDmitry Fleytman 876881d588aSDmitry Fleytman if (s->rings_info_valid) { 8773e831b40SPrasad J Pandit if (pvscsi_ring_init_msg(&s->rings, rc) < 0) { 8783e831b40SPrasad J Pandit return PVSCSI_COMMAND_PROCESSING_FAILED; 8793e831b40SPrasad J Pandit } 880881d588aSDmitry Fleytman s->msg_ring_info_valid = TRUE; 881881d588aSDmitry Fleytman } 882881d588aSDmitry Fleytman return sizeof(PVSCSICmdDescSetupMsgRing) / sizeof(uint32_t); 883881d588aSDmitry Fleytman } 884881d588aSDmitry Fleytman 885881d588aSDmitry Fleytman static uint64_t 886881d588aSDmitry Fleytman pvscsi_on_cmd_adapter_reset(PVSCSIState *s) 887881d588aSDmitry Fleytman { 888881d588aSDmitry Fleytman trace_pvscsi_on_cmd_arrived("PVSCSI_CMD_ADAPTER_RESET"); 889881d588aSDmitry Fleytman 890881d588aSDmitry Fleytman pvscsi_reset_adapter(s); 891881d588aSDmitry Fleytman return PVSCSI_COMMAND_PROCESSING_SUCCEEDED; 892881d588aSDmitry Fleytman } 893881d588aSDmitry Fleytman 894881d588aSDmitry Fleytman static const struct { 895881d588aSDmitry Fleytman int data_size; 896881d588aSDmitry Fleytman uint64_t (*handler_fn)(PVSCSIState *s); 897881d588aSDmitry Fleytman } pvscsi_commands[] = { 898881d588aSDmitry Fleytman [PVSCSI_CMD_FIRST] = { 899881d588aSDmitry Fleytman .data_size = 0, 900881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_unknown, 901881d588aSDmitry Fleytman }, 902881d588aSDmitry Fleytman 903881d588aSDmitry Fleytman /* Not implemented, data size defined based on what arrives on windows */ 904881d588aSDmitry Fleytman [PVSCSI_CMD_CONFIG] = { 905881d588aSDmitry Fleytman .data_size = 6 * sizeof(uint32_t), 906881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_config, 907881d588aSDmitry Fleytman }, 908881d588aSDmitry Fleytman 909881d588aSDmitry Fleytman /* Command not implemented, data size is unknown */ 910881d588aSDmitry Fleytman [PVSCSI_CMD_ISSUE_SCSI] = { 911881d588aSDmitry Fleytman .data_size = 0, 912881d588aSDmitry Fleytman .handler_fn = pvscsi_on_issue_scsi, 913881d588aSDmitry Fleytman }, 914881d588aSDmitry Fleytman 915881d588aSDmitry Fleytman /* Command not implemented, data size is unknown */ 916881d588aSDmitry Fleytman [PVSCSI_CMD_DEVICE_UNPLUG] = { 917881d588aSDmitry Fleytman .data_size = 0, 918881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_unplug, 919881d588aSDmitry Fleytman }, 920881d588aSDmitry Fleytman 921881d588aSDmitry Fleytman [PVSCSI_CMD_SETUP_RINGS] = { 922881d588aSDmitry Fleytman .data_size = sizeof(PVSCSICmdDescSetupRings), 923881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_setup_rings, 924881d588aSDmitry Fleytman }, 925881d588aSDmitry Fleytman 926881d588aSDmitry Fleytman [PVSCSI_CMD_RESET_DEVICE] = { 927881d588aSDmitry Fleytman .data_size = sizeof(struct PVSCSICmdDescResetDevice), 928881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_reset_device, 929881d588aSDmitry Fleytman }, 930881d588aSDmitry Fleytman 931881d588aSDmitry Fleytman [PVSCSI_CMD_RESET_BUS] = { 932881d588aSDmitry Fleytman .data_size = 0, 933881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_reset_bus, 934881d588aSDmitry Fleytman }, 935881d588aSDmitry Fleytman 936881d588aSDmitry Fleytman [PVSCSI_CMD_SETUP_MSG_RING] = { 937881d588aSDmitry Fleytman .data_size = sizeof(PVSCSICmdDescSetupMsgRing), 938881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_setup_msg_ring, 939881d588aSDmitry Fleytman }, 940881d588aSDmitry Fleytman 941881d588aSDmitry Fleytman [PVSCSI_CMD_ADAPTER_RESET] = { 942881d588aSDmitry Fleytman .data_size = 0, 943881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_adapter_reset, 944881d588aSDmitry Fleytman }, 945881d588aSDmitry Fleytman 946881d588aSDmitry Fleytman [PVSCSI_CMD_ABORT_CMD] = { 947881d588aSDmitry Fleytman .data_size = sizeof(struct PVSCSICmdDescAbortCmd), 948881d588aSDmitry Fleytman .handler_fn = pvscsi_on_cmd_abort, 949881d588aSDmitry Fleytman }, 950881d588aSDmitry Fleytman }; 951881d588aSDmitry Fleytman 952881d588aSDmitry Fleytman static void 953881d588aSDmitry Fleytman pvscsi_do_command_processing(PVSCSIState *s) 954881d588aSDmitry Fleytman { 955881d588aSDmitry Fleytman size_t bytes_arrived = s->curr_cmd_data_cntr * sizeof(uint32_t); 956881d588aSDmitry Fleytman 957881d588aSDmitry Fleytman assert(s->curr_cmd < PVSCSI_CMD_LAST); 958881d588aSDmitry Fleytman if (bytes_arrived >= pvscsi_commands[s->curr_cmd].data_size) { 959881d588aSDmitry Fleytman s->reg_command_status = pvscsi_commands[s->curr_cmd].handler_fn(s); 960881d588aSDmitry Fleytman s->curr_cmd = PVSCSI_CMD_FIRST; 961881d588aSDmitry Fleytman s->curr_cmd_data_cntr = 0; 962881d588aSDmitry Fleytman } 963881d588aSDmitry Fleytman } 964881d588aSDmitry Fleytman 965881d588aSDmitry Fleytman static void 966881d588aSDmitry Fleytman pvscsi_on_command_data(PVSCSIState *s, uint32_t value) 967881d588aSDmitry Fleytman { 968881d588aSDmitry Fleytman size_t bytes_arrived = s->curr_cmd_data_cntr * sizeof(uint32_t); 969881d588aSDmitry Fleytman 970881d588aSDmitry Fleytman assert(bytes_arrived < sizeof(s->curr_cmd_data)); 971881d588aSDmitry Fleytman s->curr_cmd_data[s->curr_cmd_data_cntr++] = value; 972881d588aSDmitry Fleytman 973881d588aSDmitry Fleytman pvscsi_do_command_processing(s); 974881d588aSDmitry Fleytman } 975881d588aSDmitry Fleytman 976881d588aSDmitry Fleytman static void 977881d588aSDmitry Fleytman pvscsi_on_command(PVSCSIState *s, uint64_t cmd_id) 978881d588aSDmitry Fleytman { 979881d588aSDmitry Fleytman if ((cmd_id > PVSCSI_CMD_FIRST) && (cmd_id < PVSCSI_CMD_LAST)) { 980881d588aSDmitry Fleytman s->curr_cmd = cmd_id; 981881d588aSDmitry Fleytman } else { 982881d588aSDmitry Fleytman s->curr_cmd = PVSCSI_CMD_FIRST; 983881d588aSDmitry Fleytman trace_pvscsi_on_cmd_unknown(cmd_id); 984881d588aSDmitry Fleytman } 985881d588aSDmitry Fleytman 986881d588aSDmitry Fleytman s->curr_cmd_data_cntr = 0; 987881d588aSDmitry Fleytman s->reg_command_status = PVSCSI_COMMAND_NOT_ENOUGH_DATA; 988881d588aSDmitry Fleytman 989881d588aSDmitry Fleytman pvscsi_do_command_processing(s); 990881d588aSDmitry Fleytman } 991881d588aSDmitry Fleytman 992881d588aSDmitry Fleytman static void 993881d588aSDmitry Fleytman pvscsi_io_write(void *opaque, hwaddr addr, 994881d588aSDmitry Fleytman uint64_t val, unsigned size) 995881d588aSDmitry Fleytman { 996881d588aSDmitry Fleytman PVSCSIState *s = opaque; 997881d588aSDmitry Fleytman 998881d588aSDmitry Fleytman switch (addr) { 999881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_COMMAND: 1000881d588aSDmitry Fleytman pvscsi_on_command(s, val); 1001881d588aSDmitry Fleytman break; 1002881d588aSDmitry Fleytman 1003881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_COMMAND_DATA: 1004881d588aSDmitry Fleytman pvscsi_on_command_data(s, (uint32_t) val); 1005881d588aSDmitry Fleytman break; 1006881d588aSDmitry Fleytman 1007881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_INTR_STATUS: 1008881d588aSDmitry Fleytman trace_pvscsi_io_write("PVSCSI_REG_OFFSET_INTR_STATUS", val); 1009881d588aSDmitry Fleytman s->reg_interrupt_status &= ~val; 1010881d588aSDmitry Fleytman pvscsi_update_irq_status(s); 1011881d588aSDmitry Fleytman pvscsi_schedule_completion_processing(s); 1012881d588aSDmitry Fleytman break; 1013881d588aSDmitry Fleytman 1014881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_INTR_MASK: 1015881d588aSDmitry Fleytman trace_pvscsi_io_write("PVSCSI_REG_OFFSET_INTR_MASK", val); 1016881d588aSDmitry Fleytman s->reg_interrupt_enabled = val; 1017881d588aSDmitry Fleytman pvscsi_update_irq_status(s); 1018881d588aSDmitry Fleytman break; 1019881d588aSDmitry Fleytman 1020881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_KICK_NON_RW_IO: 1021881d588aSDmitry Fleytman trace_pvscsi_io_write("PVSCSI_REG_OFFSET_KICK_NON_RW_IO", val); 1022881d588aSDmitry Fleytman pvscsi_process_io(s); 1023881d588aSDmitry Fleytman break; 1024881d588aSDmitry Fleytman 1025881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_KICK_RW_IO: 1026881d588aSDmitry Fleytman trace_pvscsi_io_write("PVSCSI_REG_OFFSET_KICK_RW_IO", val); 1027881d588aSDmitry Fleytman pvscsi_process_io(s); 1028881d588aSDmitry Fleytman break; 1029881d588aSDmitry Fleytman 1030881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_DEBUG: 1031881d588aSDmitry Fleytman trace_pvscsi_io_write("PVSCSI_REG_OFFSET_DEBUG", val); 1032881d588aSDmitry Fleytman break; 1033881d588aSDmitry Fleytman 1034881d588aSDmitry Fleytman default: 1035881d588aSDmitry Fleytman trace_pvscsi_io_write_unknown(addr, size, val); 1036881d588aSDmitry Fleytman break; 1037881d588aSDmitry Fleytman } 1038881d588aSDmitry Fleytman 1039881d588aSDmitry Fleytman } 1040881d588aSDmitry Fleytman 1041881d588aSDmitry Fleytman static uint64_t 1042881d588aSDmitry Fleytman pvscsi_io_read(void *opaque, hwaddr addr, unsigned size) 1043881d588aSDmitry Fleytman { 1044881d588aSDmitry Fleytman PVSCSIState *s = opaque; 1045881d588aSDmitry Fleytman 1046881d588aSDmitry Fleytman switch (addr) { 1047881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_INTR_STATUS: 1048881d588aSDmitry Fleytman trace_pvscsi_io_read("PVSCSI_REG_OFFSET_INTR_STATUS", 1049881d588aSDmitry Fleytman s->reg_interrupt_status); 1050881d588aSDmitry Fleytman return s->reg_interrupt_status; 1051881d588aSDmitry Fleytman 1052881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_INTR_MASK: 1053881d588aSDmitry Fleytman trace_pvscsi_io_read("PVSCSI_REG_OFFSET_INTR_MASK", 1054881d588aSDmitry Fleytman s->reg_interrupt_status); 1055881d588aSDmitry Fleytman return s->reg_interrupt_enabled; 1056881d588aSDmitry Fleytman 1057881d588aSDmitry Fleytman case PVSCSI_REG_OFFSET_COMMAND_STATUS: 1058881d588aSDmitry Fleytman trace_pvscsi_io_read("PVSCSI_REG_OFFSET_COMMAND_STATUS", 1059881d588aSDmitry Fleytman s->reg_interrupt_status); 1060881d588aSDmitry Fleytman return s->reg_command_status; 1061881d588aSDmitry Fleytman 1062881d588aSDmitry Fleytman default: 1063881d588aSDmitry Fleytman trace_pvscsi_io_read_unknown(addr, size); 1064881d588aSDmitry Fleytman return 0; 1065881d588aSDmitry Fleytman } 1066881d588aSDmitry Fleytman } 1067881d588aSDmitry Fleytman 1068881d588aSDmitry Fleytman 1069b2e1fffbSCao jin static void 1070881d588aSDmitry Fleytman pvscsi_init_msi(PVSCSIState *s) 1071881d588aSDmitry Fleytman { 1072881d588aSDmitry Fleytman int res; 1073881d588aSDmitry Fleytman PCIDevice *d = PCI_DEVICE(s); 1074881d588aSDmitry Fleytman 1075836fc48cSShmulik Ladkani res = msi_init(d, PVSCSI_MSI_OFFSET(s), PVSCSI_MSIX_NUM_VECTORS, 10761108b2f8SCao jin PVSCSI_USE_64BIT, PVSCSI_PER_VECTOR_MASK, NULL); 1077881d588aSDmitry Fleytman if (res < 0) { 1078881d588aSDmitry Fleytman trace_pvscsi_init_msi_fail(res); 1079881d588aSDmitry Fleytman s->msi_used = false; 1080881d588aSDmitry Fleytman } else { 1081881d588aSDmitry Fleytman s->msi_used = true; 1082881d588aSDmitry Fleytman } 1083881d588aSDmitry Fleytman } 1084881d588aSDmitry Fleytman 1085881d588aSDmitry Fleytman static void 1086881d588aSDmitry Fleytman pvscsi_cleanup_msi(PVSCSIState *s) 1087881d588aSDmitry Fleytman { 1088881d588aSDmitry Fleytman PCIDevice *d = PCI_DEVICE(s); 1089881d588aSDmitry Fleytman 1090881d588aSDmitry Fleytman msi_uninit(d); 1091881d588aSDmitry Fleytman } 1092881d588aSDmitry Fleytman 1093881d588aSDmitry Fleytman static const MemoryRegionOps pvscsi_ops = { 1094881d588aSDmitry Fleytman .read = pvscsi_io_read, 1095881d588aSDmitry Fleytman .write = pvscsi_io_write, 1096881d588aSDmitry Fleytman .endianness = DEVICE_LITTLE_ENDIAN, 1097881d588aSDmitry Fleytman .impl = { 1098881d588aSDmitry Fleytman .min_access_size = 4, 1099881d588aSDmitry Fleytman .max_access_size = 4, 1100881d588aSDmitry Fleytman }, 1101881d588aSDmitry Fleytman }; 1102881d588aSDmitry Fleytman 1103881d588aSDmitry Fleytman static const struct SCSIBusInfo pvscsi_scsi_info = { 1104881d588aSDmitry Fleytman .tcq = true, 1105881d588aSDmitry Fleytman .max_target = PVSCSI_MAX_DEVS, 1106881d588aSDmitry Fleytman .max_channel = 0, 1107881d588aSDmitry Fleytman .max_lun = 0, 1108881d588aSDmitry Fleytman 1109881d588aSDmitry Fleytman .get_sg_list = pvscsi_get_sg_list, 1110881d588aSDmitry Fleytman .complete = pvscsi_command_complete, 1111881d588aSDmitry Fleytman .cancel = pvscsi_request_cancelled, 1112881d588aSDmitry Fleytman }; 1113881d588aSDmitry Fleytman 1114fafeb41cSMao Zhongyi static void 1115fafeb41cSMao Zhongyi pvscsi_realizefn(PCIDevice *pci_dev, Error **errp) 1116881d588aSDmitry Fleytman { 1117881d588aSDmitry Fleytman PVSCSIState *s = PVSCSI(pci_dev); 1118881d588aSDmitry Fleytman 1119881d588aSDmitry Fleytman trace_pvscsi_state("init"); 1120881d588aSDmitry Fleytman 1121d29d4ff8SShmulik Ladkani /* PCI subsystem ID, subsystem vendor ID, revision */ 1122d29d4ff8SShmulik Ladkani if (PVSCSI_USE_OLD_PCI_CONFIGURATION(s)) { 1123d29d4ff8SShmulik Ladkani pci_set_word(pci_dev->config + PCI_SUBSYSTEM_ID, 0x1000); 1124d29d4ff8SShmulik Ladkani } else { 1125d29d4ff8SShmulik Ladkani pci_set_word(pci_dev->config + PCI_SUBSYSTEM_VENDOR_ID, 1126d29d4ff8SShmulik Ladkani PCI_VENDOR_ID_VMWARE); 1127d29d4ff8SShmulik Ladkani pci_set_word(pci_dev->config + PCI_SUBSYSTEM_ID, 1128d29d4ff8SShmulik Ladkani PCI_DEVICE_ID_VMWARE_PVSCSI); 1129d29d4ff8SShmulik Ladkani pci_config_set_revision(pci_dev->config, 0x2); 1130d29d4ff8SShmulik Ladkani } 1131881d588aSDmitry Fleytman 1132881d588aSDmitry Fleytman /* PCI latency timer = 255 */ 1133881d588aSDmitry Fleytman pci_dev->config[PCI_LATENCY_TIMER] = 0xff; 1134881d588aSDmitry Fleytman 1135881d588aSDmitry Fleytman /* Interrupt pin A */ 1136881d588aSDmitry Fleytman pci_config_set_interrupt_pin(pci_dev->config, 1); 1137881d588aSDmitry Fleytman 113829776739SPaolo Bonzini memory_region_init_io(&s->io_space, OBJECT(s), &pvscsi_ops, s, 1139881d588aSDmitry Fleytman "pvscsi-io", PVSCSI_MEM_SPACE_SIZE); 1140881d588aSDmitry Fleytman pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->io_space); 1141881d588aSDmitry Fleytman 1142881d588aSDmitry Fleytman pvscsi_init_msi(s); 1143881d588aSDmitry Fleytman 1144fd56e061SDavid Gibson if (pci_is_express(pci_dev) && pci_bus_is_express(pci_get_bus(pci_dev))) { 11451dd1305eSShmulik Ladkani pcie_endpoint_cap_init(pci_dev, PVSCSI_EXP_EP_OFFSET); 11461dd1305eSShmulik Ladkani } 11471dd1305eSShmulik Ladkani 1148881d588aSDmitry Fleytman s->completion_worker = qemu_bh_new(pvscsi_process_completion_queue, s); 1149881d588aSDmitry Fleytman 1150b1187b51SAndreas Färber scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(pci_dev), 1151b1187b51SAndreas Färber &pvscsi_scsi_info, NULL); 115291c8daadSIgor Mammedov /* override default SCSI bus hotplug-handler, with pvscsi's one */ 11539bc6bfdfSMarkus Armbruster qbus_set_hotplug_handler(BUS(&s->bus), OBJECT(s)); 1154881d588aSDmitry Fleytman pvscsi_reset_state(s); 1155881d588aSDmitry Fleytman } 1156881d588aSDmitry Fleytman 1157881d588aSDmitry Fleytman static void 1158881d588aSDmitry Fleytman pvscsi_uninit(PCIDevice *pci_dev) 1159881d588aSDmitry Fleytman { 1160881d588aSDmitry Fleytman PVSCSIState *s = PVSCSI(pci_dev); 1161881d588aSDmitry Fleytman 1162881d588aSDmitry Fleytman trace_pvscsi_state("uninit"); 1163881d588aSDmitry Fleytman qemu_bh_delete(s->completion_worker); 1164881d588aSDmitry Fleytman 1165881d588aSDmitry Fleytman pvscsi_cleanup_msi(s); 1166881d588aSDmitry Fleytman } 1167881d588aSDmitry Fleytman 1168881d588aSDmitry Fleytman static void 1169881d588aSDmitry Fleytman pvscsi_reset(DeviceState *dev) 1170881d588aSDmitry Fleytman { 1171881d588aSDmitry Fleytman PCIDevice *d = PCI_DEVICE(dev); 1172881d588aSDmitry Fleytman PVSCSIState *s = PVSCSI(d); 1173881d588aSDmitry Fleytman 1174881d588aSDmitry Fleytman trace_pvscsi_state("reset"); 1175881d588aSDmitry Fleytman pvscsi_reset_adapter(s); 1176881d588aSDmitry Fleytman } 1177881d588aSDmitry Fleytman 117844b1ff31SDr. David Alan Gilbert static int 1179881d588aSDmitry Fleytman pvscsi_pre_save(void *opaque) 1180881d588aSDmitry Fleytman { 1181881d588aSDmitry Fleytman PVSCSIState *s = (PVSCSIState *) opaque; 1182881d588aSDmitry Fleytman 1183881d588aSDmitry Fleytman trace_pvscsi_state("presave"); 1184881d588aSDmitry Fleytman 1185881d588aSDmitry Fleytman assert(QTAILQ_EMPTY(&s->pending_queue)); 1186881d588aSDmitry Fleytman assert(QTAILQ_EMPTY(&s->completion_queue)); 118744b1ff31SDr. David Alan Gilbert 118844b1ff31SDr. David Alan Gilbert return 0; 1189881d588aSDmitry Fleytman } 1190881d588aSDmitry Fleytman 1191881d588aSDmitry Fleytman static int 1192881d588aSDmitry Fleytman pvscsi_post_load(void *opaque, int version_id) 1193881d588aSDmitry Fleytman { 1194881d588aSDmitry Fleytman trace_pvscsi_state("postload"); 1195881d588aSDmitry Fleytman return 0; 1196881d588aSDmitry Fleytman } 1197881d588aSDmitry Fleytman 11981dd1305eSShmulik Ladkani static bool pvscsi_vmstate_need_pcie_device(void *opaque) 11991dd1305eSShmulik Ladkani { 12001dd1305eSShmulik Ladkani PVSCSIState *s = PVSCSI(opaque); 12011dd1305eSShmulik Ladkani 12021dd1305eSShmulik Ladkani return !(s->compat_flags & PVSCSI_COMPAT_DISABLE_PCIE); 12031dd1305eSShmulik Ladkani } 12041dd1305eSShmulik Ladkani 12051dd1305eSShmulik Ladkani static bool pvscsi_vmstate_test_pci_device(void *opaque, int version_id) 12061dd1305eSShmulik Ladkani { 12071dd1305eSShmulik Ladkani return !pvscsi_vmstate_need_pcie_device(opaque); 12081dd1305eSShmulik Ladkani } 12091dd1305eSShmulik Ladkani 12101dd1305eSShmulik Ladkani static const VMStateDescription vmstate_pvscsi_pcie_device = { 12111dd1305eSShmulik Ladkani .name = "pvscsi/pcie", 12121dd1305eSShmulik Ladkani .needed = pvscsi_vmstate_need_pcie_device, 12131dd1305eSShmulik Ladkani .fields = (VMStateField[]) { 121420daa90aSDr. David Alan Gilbert VMSTATE_PCI_DEVICE(parent_obj, PVSCSIState), 12151dd1305eSShmulik Ladkani VMSTATE_END_OF_LIST() 12161dd1305eSShmulik Ladkani } 12171dd1305eSShmulik Ladkani }; 12181dd1305eSShmulik Ladkani 1219881d588aSDmitry Fleytman static const VMStateDescription vmstate_pvscsi = { 12206783ecf1SPeter Maydell .name = "pvscsi", 1221881d588aSDmitry Fleytman .version_id = 0, 1222881d588aSDmitry Fleytman .minimum_version_id = 0, 1223881d588aSDmitry Fleytman .pre_save = pvscsi_pre_save, 1224881d588aSDmitry Fleytman .post_load = pvscsi_post_load, 1225881d588aSDmitry Fleytman .fields = (VMStateField[]) { 12261dd1305eSShmulik Ladkani VMSTATE_STRUCT_TEST(parent_obj, PVSCSIState, 12271dd1305eSShmulik Ladkani pvscsi_vmstate_test_pci_device, 0, 12281dd1305eSShmulik Ladkani vmstate_pci_device, PCIDevice), 1229881d588aSDmitry Fleytman VMSTATE_UINT8(msi_used, PVSCSIState), 1230881d588aSDmitry Fleytman VMSTATE_UINT32(resetting, PVSCSIState), 1231881d588aSDmitry Fleytman VMSTATE_UINT64(reg_interrupt_status, PVSCSIState), 1232881d588aSDmitry Fleytman VMSTATE_UINT64(reg_interrupt_enabled, PVSCSIState), 1233881d588aSDmitry Fleytman VMSTATE_UINT64(reg_command_status, PVSCSIState), 1234881d588aSDmitry Fleytman VMSTATE_UINT64(curr_cmd, PVSCSIState), 1235881d588aSDmitry Fleytman VMSTATE_UINT32(curr_cmd_data_cntr, PVSCSIState), 1236881d588aSDmitry Fleytman VMSTATE_UINT32_ARRAY(curr_cmd_data, PVSCSIState, 1237881d588aSDmitry Fleytman ARRAY_SIZE(((PVSCSIState *)NULL)->curr_cmd_data)), 1238881d588aSDmitry Fleytman VMSTATE_UINT8(rings_info_valid, PVSCSIState), 1239881d588aSDmitry Fleytman VMSTATE_UINT8(msg_ring_info_valid, PVSCSIState), 1240881d588aSDmitry Fleytman VMSTATE_UINT8(use_msg, PVSCSIState), 1241881d588aSDmitry Fleytman 1242881d588aSDmitry Fleytman VMSTATE_UINT64(rings.rs_pa, PVSCSIState), 1243881d588aSDmitry Fleytman VMSTATE_UINT32(rings.txr_len_mask, PVSCSIState), 1244881d588aSDmitry Fleytman VMSTATE_UINT32(rings.rxr_len_mask, PVSCSIState), 1245881d588aSDmitry Fleytman VMSTATE_UINT64_ARRAY(rings.req_ring_pages_pa, PVSCSIState, 1246881d588aSDmitry Fleytman PVSCSI_SETUP_RINGS_MAX_NUM_PAGES), 1247881d588aSDmitry Fleytman VMSTATE_UINT64_ARRAY(rings.cmp_ring_pages_pa, PVSCSIState, 1248881d588aSDmitry Fleytman PVSCSI_SETUP_RINGS_MAX_NUM_PAGES), 1249881d588aSDmitry Fleytman VMSTATE_UINT64(rings.consumed_ptr, PVSCSIState), 1250881d588aSDmitry Fleytman VMSTATE_UINT64(rings.filled_cmp_ptr, PVSCSIState), 1251881d588aSDmitry Fleytman 1252881d588aSDmitry Fleytman VMSTATE_END_OF_LIST() 12531dd1305eSShmulik Ladkani }, 12541dd1305eSShmulik Ladkani .subsections = (const VMStateDescription*[]) { 12551dd1305eSShmulik Ladkani &vmstate_pvscsi_pcie_device, 12561dd1305eSShmulik Ladkani NULL 1257881d588aSDmitry Fleytman } 1258881d588aSDmitry Fleytman }; 1259881d588aSDmitry Fleytman 1260881d588aSDmitry Fleytman static Property pvscsi_properties[] = { 1261881d588aSDmitry Fleytman DEFINE_PROP_UINT8("use_msg", PVSCSIState, use_msg, 1), 1262952970baSShmulik Ladkani DEFINE_PROP_BIT("x-old-pci-configuration", PVSCSIState, compat_flags, 1263952970baSShmulik Ladkani PVSCSI_COMPAT_OLD_PCI_CONFIGURATION_BIT, false), 1264d5da3ef2SShmulik Ladkani DEFINE_PROP_BIT("x-disable-pcie", PVSCSIState, compat_flags, 1265d5da3ef2SShmulik Ladkani PVSCSI_COMPAT_DISABLE_PCIE_BIT, false), 1266881d588aSDmitry Fleytman DEFINE_PROP_END_OF_LIST(), 1267881d588aSDmitry Fleytman }; 1268881d588aSDmitry Fleytman 12691dd1305eSShmulik Ladkani static void pvscsi_realize(DeviceState *qdev, Error **errp) 12701dd1305eSShmulik Ladkani { 1271bd7dff94SEduardo Habkost PVSCSIClass *pvs_c = PVSCSI_GET_CLASS(qdev); 12721dd1305eSShmulik Ladkani PCIDevice *pci_dev = PCI_DEVICE(qdev); 12731dd1305eSShmulik Ladkani PVSCSIState *s = PVSCSI(qdev); 12741dd1305eSShmulik Ladkani 12751dd1305eSShmulik Ladkani if (!(s->compat_flags & PVSCSI_COMPAT_DISABLE_PCIE)) { 12761dd1305eSShmulik Ladkani pci_dev->cap_present |= QEMU_PCI_CAP_EXPRESS; 12771dd1305eSShmulik Ladkani } 12781dd1305eSShmulik Ladkani 12791dd1305eSShmulik Ladkani pvs_c->parent_dc_realize(qdev, errp); 12801dd1305eSShmulik Ladkani } 12811dd1305eSShmulik Ladkani 1282881d588aSDmitry Fleytman static void pvscsi_class_init(ObjectClass *klass, void *data) 1283881d588aSDmitry Fleytman { 1284881d588aSDmitry Fleytman DeviceClass *dc = DEVICE_CLASS(klass); 1285881d588aSDmitry Fleytman PCIDeviceClass *k = PCI_DEVICE_CLASS(klass); 1286bd7dff94SEduardo Habkost PVSCSIClass *pvs_k = PVSCSI_CLASS(klass); 128791c8daadSIgor Mammedov HotplugHandlerClass *hc = HOTPLUG_HANDLER_CLASS(klass); 1288881d588aSDmitry Fleytman 1289fafeb41cSMao Zhongyi k->realize = pvscsi_realizefn; 1290881d588aSDmitry Fleytman k->exit = pvscsi_uninit; 1291881d588aSDmitry Fleytman k->vendor_id = PCI_VENDOR_ID_VMWARE; 1292881d588aSDmitry Fleytman k->device_id = PCI_DEVICE_ID_VMWARE_PVSCSI; 1293881d588aSDmitry Fleytman k->class_id = PCI_CLASS_STORAGE_SCSI; 1294881d588aSDmitry Fleytman k->subsystem_id = 0x1000; 1295bf853881SPhilippe Mathieu-Daudé device_class_set_parent_realize(dc, pvscsi_realize, 1296bf853881SPhilippe Mathieu-Daudé &pvs_k->parent_dc_realize); 1297881d588aSDmitry Fleytman dc->reset = pvscsi_reset; 1298881d588aSDmitry Fleytman dc->vmsd = &vmstate_pvscsi; 12994f67d30bSMarc-André Lureau device_class_set_props(dc, pvscsi_properties); 1300125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 130191c8daadSIgor Mammedov hc->unplug = pvscsi_hot_unplug; 130291c8daadSIgor Mammedov hc->plug = pvscsi_hotplug; 1303881d588aSDmitry Fleytman } 1304881d588aSDmitry Fleytman 1305881d588aSDmitry Fleytman static const TypeInfo pvscsi_info = { 13066783ecf1SPeter Maydell .name = TYPE_PVSCSI, 1307881d588aSDmitry Fleytman .parent = TYPE_PCI_DEVICE, 1308e2d4f3f7SShmulik Ladkani .class_size = sizeof(PVSCSIClass), 1309881d588aSDmitry Fleytman .instance_size = sizeof(PVSCSIState), 1310881d588aSDmitry Fleytman .class_init = pvscsi_class_init, 131191c8daadSIgor Mammedov .interfaces = (InterfaceInfo[]) { 131291c8daadSIgor Mammedov { TYPE_HOTPLUG_HANDLER }, 1313a5fa336fSEduardo Habkost { INTERFACE_PCIE_DEVICE }, 1314a5fa336fSEduardo Habkost { INTERFACE_CONVENTIONAL_PCI_DEVICE }, 131591c8daadSIgor Mammedov { } 131691c8daadSIgor Mammedov } 1317881d588aSDmitry Fleytman }; 1318881d588aSDmitry Fleytman 1319881d588aSDmitry Fleytman static void 1320881d588aSDmitry Fleytman pvscsi_register_types(void) 1321881d588aSDmitry Fleytman { 1322881d588aSDmitry Fleytman type_register_static(&pvscsi_info); 1323881d588aSDmitry Fleytman } 1324881d588aSDmitry Fleytman 1325881d588aSDmitry Fleytman type_init(pvscsi_register_types); 1326