16e790746SPaolo Bonzini /* 26e790746SPaolo Bonzini * Virtio Block Device 36e790746SPaolo Bonzini * 46e790746SPaolo Bonzini * Copyright IBM, Corp. 2007 56e790746SPaolo Bonzini * 66e790746SPaolo Bonzini * Authors: 76e790746SPaolo Bonzini * Anthony Liguori <aliguori@us.ibm.com> 86e790746SPaolo Bonzini * 96e790746SPaolo Bonzini * This work is licensed under the terms of the GNU GPL, version 2. See 106e790746SPaolo Bonzini * the COPYING file in the top-level directory. 116e790746SPaolo Bonzini * 126e790746SPaolo Bonzini */ 136e790746SPaolo Bonzini 146e790746SPaolo Bonzini #include "qemu-common.h" 15827805a2SFam Zheng #include "qemu/iov.h" 166e790746SPaolo Bonzini #include "qemu/error-report.h" 176e790746SPaolo Bonzini #include "trace.h" 186e790746SPaolo Bonzini #include "hw/block/block.h" 194be74634SMarkus Armbruster #include "sysemu/block-backend.h" 206e790746SPaolo Bonzini #include "sysemu/blockdev.h" 216e790746SPaolo Bonzini #include "hw/virtio/virtio-blk.h" 226e790746SPaolo Bonzini #include "dataplane/virtio-blk.h" 2384db52d0SStefan Hajnoczi #include "migration/migration.h" 246e790746SPaolo Bonzini #include "block/scsi.h" 256e790746SPaolo Bonzini #ifdef __linux__ 266e790746SPaolo Bonzini # include <scsi/sg.h> 276e790746SPaolo Bonzini #endif 286e790746SPaolo Bonzini #include "hw/virtio/virtio-bus.h" 29783d1897SRusty Russell #include "hw/virtio/virtio-access.h" 306e790746SPaolo Bonzini 31f897bf75SStefan Hajnoczi VirtIOBlockReq *virtio_blk_alloc_request(VirtIOBlock *s) 32671ec3f0SFam Zheng { 33869d66afSStefan Hajnoczi VirtIOBlockReq *req = g_slice_new(VirtIOBlockReq); 34671ec3f0SFam Zheng req->dev = s; 35869d66afSStefan Hajnoczi req->qiov.size = 0; 36869d66afSStefan Hajnoczi req->next = NULL; 3795f7142aSPeter Lieven req->mr_next = NULL; 38671ec3f0SFam Zheng return req; 39671ec3f0SFam Zheng } 40671ec3f0SFam Zheng 41f897bf75SStefan Hajnoczi void virtio_blk_free_request(VirtIOBlockReq *req) 42671ec3f0SFam Zheng { 43671ec3f0SFam Zheng if (req) { 44671ec3f0SFam Zheng g_slice_free(VirtIOBlockReq, req); 45671ec3f0SFam Zheng } 46671ec3f0SFam Zheng } 47671ec3f0SFam Zheng 48bf4bd461SFam Zheng static void virtio_blk_complete_request(VirtIOBlockReq *req, 49bf4bd461SFam Zheng unsigned char status) 506e790746SPaolo Bonzini { 516e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 526e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 536e790746SPaolo Bonzini 546e790746SPaolo Bonzini trace_virtio_blk_req_complete(req, status); 556e790746SPaolo Bonzini 566e790746SPaolo Bonzini stb_p(&req->in->status, status); 57f897bf75SStefan Hajnoczi virtqueue_push(s->vq, &req->elem, req->qiov.size + sizeof(*req->in)); 586e790746SPaolo Bonzini virtio_notify(vdev, s->vq); 596e790746SPaolo Bonzini } 606e790746SPaolo Bonzini 61bf4bd461SFam Zheng static void virtio_blk_req_complete(VirtIOBlockReq *req, unsigned char status) 62bf4bd461SFam Zheng { 63bf4bd461SFam Zheng req->dev->complete_request(req, status); 64bf4bd461SFam Zheng } 65bf4bd461SFam Zheng 666e790746SPaolo Bonzini static int virtio_blk_handle_rw_error(VirtIOBlockReq *req, int error, 676e790746SPaolo Bonzini bool is_read) 686e790746SPaolo Bonzini { 694be74634SMarkus Armbruster BlockErrorAction action = blk_get_error_action(req->dev->blk, 704be74634SMarkus Armbruster is_read, error); 716e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 726e790746SPaolo Bonzini 73a589569fSWenchao Xia if (action == BLOCK_ERROR_ACTION_STOP) { 746e790746SPaolo Bonzini req->next = s->rq; 756e790746SPaolo Bonzini s->rq = req; 76a589569fSWenchao Xia } else if (action == BLOCK_ERROR_ACTION_REPORT) { 776e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 784be74634SMarkus Armbruster block_acct_done(blk_get_stats(s->blk), &req->acct); 79671ec3f0SFam Zheng virtio_blk_free_request(req); 806e790746SPaolo Bonzini } 816e790746SPaolo Bonzini 824be74634SMarkus Armbruster blk_error_action(s->blk, action, is_read, error); 83a589569fSWenchao Xia return action != BLOCK_ERROR_ACTION_IGNORE; 846e790746SPaolo Bonzini } 856e790746SPaolo Bonzini 866e790746SPaolo Bonzini static void virtio_blk_rw_complete(void *opaque, int ret) 876e790746SPaolo Bonzini { 8895f7142aSPeter Lieven VirtIOBlockReq *next = opaque; 896e790746SPaolo Bonzini 9095f7142aSPeter Lieven while (next) { 9195f7142aSPeter Lieven VirtIOBlockReq *req = next; 9295f7142aSPeter Lieven next = req->mr_next; 936e790746SPaolo Bonzini trace_virtio_blk_rw_complete(req, ret); 946e790746SPaolo Bonzini 9595f7142aSPeter Lieven if (req->qiov.nalloc != -1) { 9695f7142aSPeter Lieven /* If nalloc is != 1 req->qiov is a local copy of the original 9795f7142aSPeter Lieven * external iovec. It was allocated in submit_merged_requests 9895f7142aSPeter Lieven * to be able to merge requests. */ 9995f7142aSPeter Lieven qemu_iovec_destroy(&req->qiov); 10095f7142aSPeter Lieven } 10195f7142aSPeter Lieven 1026e790746SPaolo Bonzini if (ret) { 103783d1897SRusty Russell int p = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); 104783d1897SRusty Russell bool is_read = !(p & VIRTIO_BLK_T_OUT); 10595f7142aSPeter Lieven if (virtio_blk_handle_rw_error(req, -ret, is_read)) { 10695f7142aSPeter Lieven continue; 10795f7142aSPeter Lieven } 1086e790746SPaolo Bonzini } 1096e790746SPaolo Bonzini 1106e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1114be74634SMarkus Armbruster block_acct_done(blk_get_stats(req->dev->blk), &req->acct); 112671ec3f0SFam Zheng virtio_blk_free_request(req); 1136e790746SPaolo Bonzini } 11495f7142aSPeter Lieven } 1156e790746SPaolo Bonzini 1166e790746SPaolo Bonzini static void virtio_blk_flush_complete(void *opaque, int ret) 1176e790746SPaolo Bonzini { 1186e790746SPaolo Bonzini VirtIOBlockReq *req = opaque; 1196e790746SPaolo Bonzini 1206e790746SPaolo Bonzini if (ret) { 1216e790746SPaolo Bonzini if (virtio_blk_handle_rw_error(req, -ret, 0)) { 1226e790746SPaolo Bonzini return; 1236e790746SPaolo Bonzini } 1246e790746SPaolo Bonzini } 1256e790746SPaolo Bonzini 1266e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1274be74634SMarkus Armbruster block_acct_done(blk_get_stats(req->dev->blk), &req->acct); 128671ec3f0SFam Zheng virtio_blk_free_request(req); 1296e790746SPaolo Bonzini } 1306e790746SPaolo Bonzini 1311dc936aaSFam Zheng #ifdef __linux__ 1321dc936aaSFam Zheng 1331dc936aaSFam Zheng typedef struct { 1341dc936aaSFam Zheng VirtIOBlockReq *req; 1351dc936aaSFam Zheng struct sg_io_hdr hdr; 1361dc936aaSFam Zheng } VirtIOBlockIoctlReq; 1371dc936aaSFam Zheng 1381dc936aaSFam Zheng static void virtio_blk_ioctl_complete(void *opaque, int status) 1391dc936aaSFam Zheng { 1401dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req = opaque; 1411dc936aaSFam Zheng VirtIOBlockReq *req = ioctl_req->req; 1421dc936aaSFam Zheng VirtIODevice *vdev = VIRTIO_DEVICE(req->dev); 1431dc936aaSFam Zheng struct virtio_scsi_inhdr *scsi; 1441dc936aaSFam Zheng struct sg_io_hdr *hdr; 1451dc936aaSFam Zheng 1461dc936aaSFam Zheng scsi = (void *)req->elem.in_sg[req->elem.in_num - 2].iov_base; 1471dc936aaSFam Zheng 1481dc936aaSFam Zheng if (status) { 1491dc936aaSFam Zheng status = VIRTIO_BLK_S_UNSUPP; 1501dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 255); 1511dc936aaSFam Zheng goto out; 1521dc936aaSFam Zheng } 1531dc936aaSFam Zheng 1541dc936aaSFam Zheng hdr = &ioctl_req->hdr; 1551dc936aaSFam Zheng /* 1561dc936aaSFam Zheng * From SCSI-Generic-HOWTO: "Some lower level drivers (e.g. ide-scsi) 1571dc936aaSFam Zheng * clear the masked_status field [hence status gets cleared too, see 1581dc936aaSFam Zheng * block/scsi_ioctl.c] even when a CHECK_CONDITION or COMMAND_TERMINATED 1591dc936aaSFam Zheng * status has occurred. However they do set DRIVER_SENSE in driver_status 1601dc936aaSFam Zheng * field. Also a (sb_len_wr > 0) indicates there is a sense buffer. 1611dc936aaSFam Zheng */ 1621dc936aaSFam Zheng if (hdr->status == 0 && hdr->sb_len_wr > 0) { 1631dc936aaSFam Zheng hdr->status = CHECK_CONDITION; 1641dc936aaSFam Zheng } 1651dc936aaSFam Zheng 1661dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 1671dc936aaSFam Zheng hdr->status | (hdr->msg_status << 8) | 1681dc936aaSFam Zheng (hdr->host_status << 16) | (hdr->driver_status << 24)); 1691dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->residual, hdr->resid); 1701dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->sense_len, hdr->sb_len_wr); 1711dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->data_len, hdr->dxfer_len); 1721dc936aaSFam Zheng 1731dc936aaSFam Zheng out: 1741dc936aaSFam Zheng virtio_blk_req_complete(req, status); 1751dc936aaSFam Zheng virtio_blk_free_request(req); 1761dc936aaSFam Zheng g_free(ioctl_req); 1771dc936aaSFam Zheng } 1781dc936aaSFam Zheng 1791dc936aaSFam Zheng #endif 1801dc936aaSFam Zheng 1816e790746SPaolo Bonzini static VirtIOBlockReq *virtio_blk_get_request(VirtIOBlock *s) 1826e790746SPaolo Bonzini { 1836e790746SPaolo Bonzini VirtIOBlockReq *req = virtio_blk_alloc_request(s); 1846e790746SPaolo Bonzini 185f897bf75SStefan Hajnoczi if (!virtqueue_pop(s->vq, &req->elem)) { 186671ec3f0SFam Zheng virtio_blk_free_request(req); 1876e790746SPaolo Bonzini return NULL; 1886e790746SPaolo Bonzini } 1896e790746SPaolo Bonzini 1906e790746SPaolo Bonzini return req; 1916e790746SPaolo Bonzini } 1926e790746SPaolo Bonzini 19375344fa4SFam Zheng static int virtio_blk_handle_scsi_req(VirtIOBlockReq *req) 1946e790746SPaolo Bonzini { 1956e790746SPaolo Bonzini int status = VIRTIO_BLK_S_OK; 1965a05cbeeSFam Zheng struct virtio_scsi_inhdr *scsi = NULL; 19775344fa4SFam Zheng VirtIODevice *vdev = VIRTIO_DEVICE(req->dev); 19875344fa4SFam Zheng VirtQueueElement *elem = &req->elem; 19975344fa4SFam Zheng VirtIOBlock *blk = req->dev; 200783d1897SRusty Russell 2015a05cbeeSFam Zheng #ifdef __linux__ 2025a05cbeeSFam Zheng int i; 2031dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req; 204*a209f461SFam Zheng BlockAIOCB *acb; 2055a05cbeeSFam Zheng #endif 2066e790746SPaolo Bonzini 2076e790746SPaolo Bonzini /* 2086e790746SPaolo Bonzini * We require at least one output segment each for the virtio_blk_outhdr 2096e790746SPaolo Bonzini * and the SCSI command block. 2106e790746SPaolo Bonzini * 2116e790746SPaolo Bonzini * We also at least require the virtio_blk_inhdr, the virtio_scsi_inhdr 2126e790746SPaolo Bonzini * and the sense buffer pointer in the input segments. 2136e790746SPaolo Bonzini */ 2145a05cbeeSFam Zheng if (elem->out_num < 2 || elem->in_num < 3) { 2155a05cbeeSFam Zheng status = VIRTIO_BLK_S_IOERR; 2165a05cbeeSFam Zheng goto fail; 2176e790746SPaolo Bonzini } 2186e790746SPaolo Bonzini 2196e790746SPaolo Bonzini /* 2206e790746SPaolo Bonzini * The scsi inhdr is placed in the second-to-last input segment, just 2216e790746SPaolo Bonzini * before the regular inhdr. 2226e790746SPaolo Bonzini */ 2235a05cbeeSFam Zheng scsi = (void *)elem->in_sg[elem->in_num - 2].iov_base; 2246e790746SPaolo Bonzini 2252a30307fSMarkus Armbruster if (!blk->conf.scsi) { 2266e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2276e790746SPaolo Bonzini goto fail; 2286e790746SPaolo Bonzini } 2296e790746SPaolo Bonzini 2306e790746SPaolo Bonzini /* 2316e790746SPaolo Bonzini * No support for bidirection commands yet. 2326e790746SPaolo Bonzini */ 2335a05cbeeSFam Zheng if (elem->out_num > 2 && elem->in_num > 3) { 2346e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2356e790746SPaolo Bonzini goto fail; 2366e790746SPaolo Bonzini } 2376e790746SPaolo Bonzini 2386e790746SPaolo Bonzini #ifdef __linux__ 2391dc936aaSFam Zheng ioctl_req = g_new0(VirtIOBlockIoctlReq, 1); 2401dc936aaSFam Zheng ioctl_req->req = req; 2411dc936aaSFam Zheng ioctl_req->hdr.interface_id = 'S'; 2421dc936aaSFam Zheng ioctl_req->hdr.cmd_len = elem->out_sg[1].iov_len; 2431dc936aaSFam Zheng ioctl_req->hdr.cmdp = elem->out_sg[1].iov_base; 2441dc936aaSFam Zheng ioctl_req->hdr.dxfer_len = 0; 2456e790746SPaolo Bonzini 2465a05cbeeSFam Zheng if (elem->out_num > 2) { 2476e790746SPaolo Bonzini /* 2486e790746SPaolo Bonzini * If there are more than the minimally required 2 output segments 2496e790746SPaolo Bonzini * there is write payload starting from the third iovec. 2506e790746SPaolo Bonzini */ 2511dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_TO_DEV; 2521dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->out_num - 2; 2536e790746SPaolo Bonzini 2541dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 2551dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->out_sg[i + 2].iov_len; 2561dc936aaSFam Zheng } 2576e790746SPaolo Bonzini 2581dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->out_sg + 2; 2596e790746SPaolo Bonzini 2605a05cbeeSFam Zheng } else if (elem->in_num > 3) { 2616e790746SPaolo Bonzini /* 2626e790746SPaolo Bonzini * If we have more than 3 input segments the guest wants to actually 2636e790746SPaolo Bonzini * read data. 2646e790746SPaolo Bonzini */ 2651dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_FROM_DEV; 2661dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->in_num - 3; 2671dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 2681dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->in_sg[i].iov_len; 2691dc936aaSFam Zheng } 2706e790746SPaolo Bonzini 2711dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->in_sg; 2726e790746SPaolo Bonzini } else { 2736e790746SPaolo Bonzini /* 2746e790746SPaolo Bonzini * Some SCSI commands don't actually transfer any data. 2756e790746SPaolo Bonzini */ 2761dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_NONE; 2776e790746SPaolo Bonzini } 2786e790746SPaolo Bonzini 2791dc936aaSFam Zheng ioctl_req->hdr.sbp = elem->in_sg[elem->in_num - 3].iov_base; 2801dc936aaSFam Zheng ioctl_req->hdr.mx_sb_len = elem->in_sg[elem->in_num - 3].iov_len; 2816e790746SPaolo Bonzini 282*a209f461SFam Zheng acb = blk_aio_ioctl(blk->blk, SG_IO, &ioctl_req->hdr, 2831dc936aaSFam Zheng virtio_blk_ioctl_complete, ioctl_req); 284*a209f461SFam Zheng if (!acb) { 285*a209f461SFam Zheng g_free(ioctl_req); 286*a209f461SFam Zheng status = VIRTIO_BLK_S_UNSUPP; 287*a209f461SFam Zheng goto fail; 288*a209f461SFam Zheng } 2891dc936aaSFam Zheng return -EINPROGRESS; 2906e790746SPaolo Bonzini #else 2916e790746SPaolo Bonzini abort(); 2926e790746SPaolo Bonzini #endif 2936e790746SPaolo Bonzini 2946e790746SPaolo Bonzini fail: 2956e790746SPaolo Bonzini /* Just put anything nonzero so that the ioctl fails in the guest. */ 2965a05cbeeSFam Zheng if (scsi) { 297783d1897SRusty Russell virtio_stl_p(vdev, &scsi->errors, 255); 2985a05cbeeSFam Zheng } 2995a05cbeeSFam Zheng return status; 3005a05cbeeSFam Zheng } 3015a05cbeeSFam Zheng 3025a05cbeeSFam Zheng static void virtio_blk_handle_scsi(VirtIOBlockReq *req) 3035a05cbeeSFam Zheng { 3045a05cbeeSFam Zheng int status; 3055a05cbeeSFam Zheng 30675344fa4SFam Zheng status = virtio_blk_handle_scsi_req(req); 3071dc936aaSFam Zheng if (status != -EINPROGRESS) { 3086e790746SPaolo Bonzini virtio_blk_req_complete(req, status); 309671ec3f0SFam Zheng virtio_blk_free_request(req); 3106e790746SPaolo Bonzini } 3111dc936aaSFam Zheng } 3126e790746SPaolo Bonzini 31395f7142aSPeter Lieven static inline void submit_requests(BlockBackend *blk, MultiReqBuffer *mrb, 31495f7142aSPeter Lieven int start, int num_reqs, int niov) 3156e790746SPaolo Bonzini { 31695f7142aSPeter Lieven QEMUIOVector *qiov = &mrb->reqs[start]->qiov; 31795f7142aSPeter Lieven int64_t sector_num = mrb->reqs[start]->sector_num; 31895f7142aSPeter Lieven int nb_sectors = mrb->reqs[start]->qiov.size / BDRV_SECTOR_SIZE; 31995f7142aSPeter Lieven bool is_write = mrb->is_write; 3206e790746SPaolo Bonzini 32195f7142aSPeter Lieven if (num_reqs > 1) { 32295f7142aSPeter Lieven int i; 32395f7142aSPeter Lieven struct iovec *tmp_iov = qiov->iov; 32495f7142aSPeter Lieven int tmp_niov = qiov->niov; 32595f7142aSPeter Lieven 32695f7142aSPeter Lieven /* mrb->reqs[start]->qiov was initialized from external so we can't 32795f7142aSPeter Lieven * modifiy it here. We need to initialize it locally and then add the 32895f7142aSPeter Lieven * external iovecs. */ 32995f7142aSPeter Lieven qemu_iovec_init(qiov, niov); 33095f7142aSPeter Lieven 33195f7142aSPeter Lieven for (i = 0; i < tmp_niov; i++) { 33295f7142aSPeter Lieven qemu_iovec_add(qiov, tmp_iov[i].iov_base, tmp_iov[i].iov_len); 33395f7142aSPeter Lieven } 33495f7142aSPeter Lieven 33595f7142aSPeter Lieven for (i = start + 1; i < start + num_reqs; i++) { 33695f7142aSPeter Lieven qemu_iovec_concat(qiov, &mrb->reqs[i]->qiov, 0, 33795f7142aSPeter Lieven mrb->reqs[i]->qiov.size); 33895f7142aSPeter Lieven mrb->reqs[i - 1]->mr_next = mrb->reqs[i]; 33995f7142aSPeter Lieven nb_sectors += mrb->reqs[i]->qiov.size / BDRV_SECTOR_SIZE; 34095f7142aSPeter Lieven } 34195f7142aSPeter Lieven assert(nb_sectors == qiov->size / BDRV_SECTOR_SIZE); 34295f7142aSPeter Lieven 34395f7142aSPeter Lieven trace_virtio_blk_submit_multireq(mrb, start, num_reqs, sector_num, 34495f7142aSPeter Lieven nb_sectors, is_write); 34595f7142aSPeter Lieven block_acct_merge_done(blk_get_stats(blk), 34695f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ, 34795f7142aSPeter Lieven num_reqs - 1); 34895f7142aSPeter Lieven } 34995f7142aSPeter Lieven 35095f7142aSPeter Lieven if (is_write) { 35195f7142aSPeter Lieven blk_aio_writev(blk, sector_num, qiov, nb_sectors, 35295f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 35395f7142aSPeter Lieven } else { 35495f7142aSPeter Lieven blk_aio_readv(blk, sector_num, qiov, nb_sectors, 35595f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 35695f7142aSPeter Lieven } 35795f7142aSPeter Lieven } 35895f7142aSPeter Lieven 35995f7142aSPeter Lieven static int multireq_compare(const void *a, const void *b) 36095f7142aSPeter Lieven { 36195f7142aSPeter Lieven const VirtIOBlockReq *req1 = *(VirtIOBlockReq **)a, 36295f7142aSPeter Lieven *req2 = *(VirtIOBlockReq **)b; 36395f7142aSPeter Lieven 36495f7142aSPeter Lieven /* 36595f7142aSPeter Lieven * Note that we can't simply subtract sector_num1 from sector_num2 36695f7142aSPeter Lieven * here as that could overflow the return value. 36795f7142aSPeter Lieven */ 36895f7142aSPeter Lieven if (req1->sector_num > req2->sector_num) { 36995f7142aSPeter Lieven return 1; 37095f7142aSPeter Lieven } else if (req1->sector_num < req2->sector_num) { 37195f7142aSPeter Lieven return -1; 37295f7142aSPeter Lieven } else { 37395f7142aSPeter Lieven return 0; 37495f7142aSPeter Lieven } 37595f7142aSPeter Lieven } 37695f7142aSPeter Lieven 37795f7142aSPeter Lieven void virtio_blk_submit_multireq(BlockBackend *blk, MultiReqBuffer *mrb) 37895f7142aSPeter Lieven { 37995f7142aSPeter Lieven int i = 0, start = 0, num_reqs = 0, niov = 0, nb_sectors = 0; 38095f7142aSPeter Lieven int max_xfer_len = 0; 38195f7142aSPeter Lieven int64_t sector_num = 0; 38295f7142aSPeter Lieven 38395f7142aSPeter Lieven if (mrb->num_reqs == 1) { 38495f7142aSPeter Lieven submit_requests(blk, mrb, 0, 1, -1); 38595f7142aSPeter Lieven mrb->num_reqs = 0; 3866e790746SPaolo Bonzini return; 3876e790746SPaolo Bonzini } 3886e790746SPaolo Bonzini 38995f7142aSPeter Lieven max_xfer_len = blk_get_max_transfer_length(mrb->reqs[0]->dev->blk); 39075af1f34SPeter Lieven max_xfer_len = MIN_NON_ZERO(max_xfer_len, BDRV_REQUEST_MAX_SECTORS); 39195f7142aSPeter Lieven 39295f7142aSPeter Lieven qsort(mrb->reqs, mrb->num_reqs, sizeof(*mrb->reqs), 39395f7142aSPeter Lieven &multireq_compare); 39495f7142aSPeter Lieven 39595f7142aSPeter Lieven for (i = 0; i < mrb->num_reqs; i++) { 39695f7142aSPeter Lieven VirtIOBlockReq *req = mrb->reqs[i]; 39795f7142aSPeter Lieven if (num_reqs > 0) { 39895f7142aSPeter Lieven bool merge = true; 39995f7142aSPeter Lieven 40095f7142aSPeter Lieven /* merge would exceed maximum number of IOVs */ 40195f7142aSPeter Lieven if (niov + req->qiov.niov > IOV_MAX) { 40295f7142aSPeter Lieven merge = false; 4036e790746SPaolo Bonzini } 40495f7142aSPeter Lieven 40595f7142aSPeter Lieven /* merge would exceed maximum transfer length of backend device */ 40695f7142aSPeter Lieven if (req->qiov.size / BDRV_SECTOR_SIZE + nb_sectors > max_xfer_len) { 40795f7142aSPeter Lieven merge = false; 40895f7142aSPeter Lieven } 40995f7142aSPeter Lieven 41095f7142aSPeter Lieven /* requests are not sequential */ 41195f7142aSPeter Lieven if (sector_num + nb_sectors != req->sector_num) { 41295f7142aSPeter Lieven merge = false; 41395f7142aSPeter Lieven } 41495f7142aSPeter Lieven 41595f7142aSPeter Lieven if (!merge) { 41695f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 41795f7142aSPeter Lieven num_reqs = 0; 4186e790746SPaolo Bonzini } 4196e790746SPaolo Bonzini } 4206e790746SPaolo Bonzini 42195f7142aSPeter Lieven if (num_reqs == 0) { 42295f7142aSPeter Lieven sector_num = req->sector_num; 42395f7142aSPeter Lieven nb_sectors = niov = 0; 42495f7142aSPeter Lieven start = i; 42595f7142aSPeter Lieven } 42695f7142aSPeter Lieven 42795f7142aSPeter Lieven nb_sectors += req->qiov.size / BDRV_SECTOR_SIZE; 42895f7142aSPeter Lieven niov += req->qiov.niov; 42995f7142aSPeter Lieven num_reqs++; 43095f7142aSPeter Lieven } 43195f7142aSPeter Lieven 43295f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 43395f7142aSPeter Lieven mrb->num_reqs = 0; 4346e790746SPaolo Bonzini } 4356e790746SPaolo Bonzini 4366e790746SPaolo Bonzini static void virtio_blk_handle_flush(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4376e790746SPaolo Bonzini { 4384be74634SMarkus Armbruster block_acct_start(blk_get_stats(req->dev->blk), &req->acct, 0, 4395366d0c8SBenoît Canet BLOCK_ACCT_FLUSH); 4406e790746SPaolo Bonzini 4416e790746SPaolo Bonzini /* 4426e790746SPaolo Bonzini * Make sure all outstanding writes are posted to the backing device. 4436e790746SPaolo Bonzini */ 44495f7142aSPeter Lieven if (mrb->is_write && mrb->num_reqs > 0) { 44595f7142aSPeter Lieven virtio_blk_submit_multireq(req->dev->blk, mrb); 44695f7142aSPeter Lieven } 4474be74634SMarkus Armbruster blk_aio_flush(req->dev->blk, virtio_blk_flush_complete, req); 4486e790746SPaolo Bonzini } 4496e790746SPaolo Bonzini 450d0e14376SMarkus Armbruster static bool virtio_blk_sect_range_ok(VirtIOBlock *dev, 451d0e14376SMarkus Armbruster uint64_t sector, size_t size) 452d0e14376SMarkus Armbruster { 4533c2daac0SMarkus Armbruster uint64_t nb_sectors = size >> BDRV_SECTOR_BITS; 4543c2daac0SMarkus Armbruster uint64_t total_sectors; 4553c2daac0SMarkus Armbruster 45675af1f34SPeter Lieven if (nb_sectors > BDRV_REQUEST_MAX_SECTORS) { 45795f7142aSPeter Lieven return false; 45895f7142aSPeter Lieven } 459d0e14376SMarkus Armbruster if (sector & dev->sector_mask) { 460d0e14376SMarkus Armbruster return false; 461d0e14376SMarkus Armbruster } 4622a30307fSMarkus Armbruster if (size % dev->conf.conf.logical_block_size) { 463d0e14376SMarkus Armbruster return false; 464d0e14376SMarkus Armbruster } 4654be74634SMarkus Armbruster blk_get_geometry(dev->blk, &total_sectors); 4663c2daac0SMarkus Armbruster if (sector > total_sectors || nb_sectors > total_sectors - sector) { 4673c2daac0SMarkus Armbruster return false; 4683c2daac0SMarkus Armbruster } 469d0e14376SMarkus Armbruster return true; 470d0e14376SMarkus Armbruster } 471d0e14376SMarkus Armbruster 472fee65db7SFam Zheng void virtio_blk_handle_request(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4736e790746SPaolo Bonzini { 4746e790746SPaolo Bonzini uint32_t type; 475f897bf75SStefan Hajnoczi struct iovec *in_iov = req->elem.in_sg; 476f897bf75SStefan Hajnoczi struct iovec *iov = req->elem.out_sg; 477f897bf75SStefan Hajnoczi unsigned in_num = req->elem.in_num; 478f897bf75SStefan Hajnoczi unsigned out_num = req->elem.out_num; 4796e790746SPaolo Bonzini 480f897bf75SStefan Hajnoczi if (req->elem.out_num < 1 || req->elem.in_num < 1) { 4816e790746SPaolo Bonzini error_report("virtio-blk missing headers"); 4826e790746SPaolo Bonzini exit(1); 4836e790746SPaolo Bonzini } 4846e790746SPaolo Bonzini 485827805a2SFam Zheng if (unlikely(iov_to_buf(iov, out_num, 0, &req->out, 486827805a2SFam Zheng sizeof(req->out)) != sizeof(req->out))) { 487827805a2SFam Zheng error_report("virtio-blk request outhdr too short"); 488827805a2SFam Zheng exit(1); 489827805a2SFam Zheng } 490ee17e848SFam Zheng 491827805a2SFam Zheng iov_discard_front(&iov, &out_num, sizeof(req->out)); 492ee17e848SFam Zheng 493ee17e848SFam Zheng if (in_num < 1 || 494ee17e848SFam Zheng in_iov[in_num - 1].iov_len < sizeof(struct virtio_blk_inhdr)) { 495ee17e848SFam Zheng error_report("virtio-blk request inhdr too short"); 496ee17e848SFam Zheng exit(1); 497ee17e848SFam Zheng } 498ee17e848SFam Zheng 499ee17e848SFam Zheng req->in = (void *)in_iov[in_num - 1].iov_base 500ee17e848SFam Zheng + in_iov[in_num - 1].iov_len 501ee17e848SFam Zheng - sizeof(struct virtio_blk_inhdr); 502ee17e848SFam Zheng iov_discard_back(in_iov, &in_num, sizeof(struct virtio_blk_inhdr)); 5036e790746SPaolo Bonzini 504783d1897SRusty Russell type = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); 5056e790746SPaolo Bonzini 50695f7142aSPeter Lieven /* VIRTIO_BLK_T_OUT defines the command direction. VIRTIO_BLK_T_BARRIER 50795f7142aSPeter Lieven * is an optional flag. Altough a guest should not send this flag if 50895f7142aSPeter Lieven * not negotiated we ignored it in the past. So keep ignoring it. */ 50995f7142aSPeter Lieven switch (type & ~(VIRTIO_BLK_T_OUT | VIRTIO_BLK_T_BARRIER)) { 51095f7142aSPeter Lieven case VIRTIO_BLK_T_IN: 51195f7142aSPeter Lieven { 51295f7142aSPeter Lieven bool is_write = type & VIRTIO_BLK_T_OUT; 51395f7142aSPeter Lieven req->sector_num = virtio_ldq_p(VIRTIO_DEVICE(req->dev), 51495f7142aSPeter Lieven &req->out.sector); 51595f7142aSPeter Lieven 51695f7142aSPeter Lieven if (is_write) { 51795f7142aSPeter Lieven qemu_iovec_init_external(&req->qiov, iov, out_num); 51895f7142aSPeter Lieven trace_virtio_blk_handle_write(req, req->sector_num, 51995f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 52095f7142aSPeter Lieven } else { 52195f7142aSPeter Lieven qemu_iovec_init_external(&req->qiov, in_iov, in_num); 52295f7142aSPeter Lieven trace_virtio_blk_handle_read(req, req->sector_num, 52395f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 52495f7142aSPeter Lieven } 52595f7142aSPeter Lieven 52695f7142aSPeter Lieven if (!virtio_blk_sect_range_ok(req->dev, req->sector_num, 52795f7142aSPeter Lieven req->qiov.size)) { 52895f7142aSPeter Lieven virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 52995f7142aSPeter Lieven virtio_blk_free_request(req); 53095f7142aSPeter Lieven return; 53195f7142aSPeter Lieven } 53295f7142aSPeter Lieven 53395f7142aSPeter Lieven block_acct_start(blk_get_stats(req->dev->blk), 53495f7142aSPeter Lieven &req->acct, req->qiov.size, 53595f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 53695f7142aSPeter Lieven 53795f7142aSPeter Lieven /* merge would exceed maximum number of requests or IO direction 53895f7142aSPeter Lieven * changes */ 53995f7142aSPeter Lieven if (mrb->num_reqs > 0 && (mrb->num_reqs == VIRTIO_BLK_MAX_MERGE_REQS || 540c99495acSPeter Lieven is_write != mrb->is_write || 541c99495acSPeter Lieven !req->dev->conf.request_merging)) { 54295f7142aSPeter Lieven virtio_blk_submit_multireq(req->dev->blk, mrb); 54395f7142aSPeter Lieven } 54495f7142aSPeter Lieven 54595f7142aSPeter Lieven assert(mrb->num_reqs < VIRTIO_BLK_MAX_MERGE_REQS); 54695f7142aSPeter Lieven mrb->reqs[mrb->num_reqs++] = req; 54795f7142aSPeter Lieven mrb->is_write = is_write; 54895f7142aSPeter Lieven break; 54995f7142aSPeter Lieven } 55095f7142aSPeter Lieven case VIRTIO_BLK_T_FLUSH: 5516e790746SPaolo Bonzini virtio_blk_handle_flush(req, mrb); 55295f7142aSPeter Lieven break; 55395f7142aSPeter Lieven case VIRTIO_BLK_T_SCSI_CMD: 5546e790746SPaolo Bonzini virtio_blk_handle_scsi(req); 55595f7142aSPeter Lieven break; 55695f7142aSPeter Lieven case VIRTIO_BLK_T_GET_ID: 55795f7142aSPeter Lieven { 5586e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 5596e790746SPaolo Bonzini 5606e790746SPaolo Bonzini /* 5616e790746SPaolo Bonzini * NB: per existing s/n string convention the string is 5626e790746SPaolo Bonzini * terminated by '\0' only when shorter than buffer. 5636e790746SPaolo Bonzini */ 5642a30307fSMarkus Armbruster const char *serial = s->conf.serial ? s->conf.serial : ""; 565a83ceea8SMarc Marí size_t size = MIN(strlen(serial) + 1, 566a83ceea8SMarc Marí MIN(iov_size(in_iov, in_num), 567a83ceea8SMarc Marí VIRTIO_BLK_ID_BYTES)); 568a83ceea8SMarc Marí iov_from_buf(in_iov, in_num, 0, serial, size); 5696e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 570671ec3f0SFam Zheng virtio_blk_free_request(req); 57195f7142aSPeter Lieven break; 57295f7142aSPeter Lieven } 57395f7142aSPeter Lieven default: 5746e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 575671ec3f0SFam Zheng virtio_blk_free_request(req); 5766e790746SPaolo Bonzini } 5776e790746SPaolo Bonzini } 5786e790746SPaolo Bonzini 5796e790746SPaolo Bonzini static void virtio_blk_handle_output(VirtIODevice *vdev, VirtQueue *vq) 5806e790746SPaolo Bonzini { 5816e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 5826e790746SPaolo Bonzini VirtIOBlockReq *req; 58395f7142aSPeter Lieven MultiReqBuffer mrb = {}; 5846e790746SPaolo Bonzini 5856e790746SPaolo Bonzini /* Some guests kick before setting VIRTIO_CONFIG_S_DRIVER_OK so start 5866e790746SPaolo Bonzini * dataplane here instead of waiting for .set_status(). 5876e790746SPaolo Bonzini */ 5886e790746SPaolo Bonzini if (s->dataplane) { 5896e790746SPaolo Bonzini virtio_blk_data_plane_start(s->dataplane); 5906e790746SPaolo Bonzini return; 5916e790746SPaolo Bonzini } 5926e790746SPaolo Bonzini 5936e790746SPaolo Bonzini while ((req = virtio_blk_get_request(s))) { 5946e790746SPaolo Bonzini virtio_blk_handle_request(req, &mrb); 5956e790746SPaolo Bonzini } 5966e790746SPaolo Bonzini 59795f7142aSPeter Lieven if (mrb.num_reqs) { 59895f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 59995f7142aSPeter Lieven } 6006e790746SPaolo Bonzini 6016e790746SPaolo Bonzini /* 6026e790746SPaolo Bonzini * FIXME: Want to check for completions before returning to guest mode, 6036e790746SPaolo Bonzini * so cached reads and writes are reported as quickly as possible. But 6046e790746SPaolo Bonzini * that should be done in the generic block layer. 6056e790746SPaolo Bonzini */ 6066e790746SPaolo Bonzini } 6076e790746SPaolo Bonzini 6086e790746SPaolo Bonzini static void virtio_blk_dma_restart_bh(void *opaque) 6096e790746SPaolo Bonzini { 6106e790746SPaolo Bonzini VirtIOBlock *s = opaque; 6116e790746SPaolo Bonzini VirtIOBlockReq *req = s->rq; 61295f7142aSPeter Lieven MultiReqBuffer mrb = {}; 6136e790746SPaolo Bonzini 6146e790746SPaolo Bonzini qemu_bh_delete(s->bh); 6156e790746SPaolo Bonzini s->bh = NULL; 6166e790746SPaolo Bonzini 6176e790746SPaolo Bonzini s->rq = NULL; 6186e790746SPaolo Bonzini 6196e790746SPaolo Bonzini while (req) { 6201bdb176aSzhanghailiang VirtIOBlockReq *next = req->next; 6216e790746SPaolo Bonzini virtio_blk_handle_request(req, &mrb); 6221bdb176aSzhanghailiang req = next; 6236e790746SPaolo Bonzini } 6246e790746SPaolo Bonzini 62595f7142aSPeter Lieven if (mrb.num_reqs) { 62695f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 62795f7142aSPeter Lieven } 6286e790746SPaolo Bonzini } 6296e790746SPaolo Bonzini 6306e790746SPaolo Bonzini static void virtio_blk_dma_restart_cb(void *opaque, int running, 6316e790746SPaolo Bonzini RunState state) 6326e790746SPaolo Bonzini { 6336e790746SPaolo Bonzini VirtIOBlock *s = opaque; 6346e790746SPaolo Bonzini 6356e790746SPaolo Bonzini if (!running) { 6366e790746SPaolo Bonzini return; 6376e790746SPaolo Bonzini } 6386e790746SPaolo Bonzini 6396e790746SPaolo Bonzini if (!s->bh) { 6404be74634SMarkus Armbruster s->bh = aio_bh_new(blk_get_aio_context(s->conf.conf.blk), 6414407c1c5SFam Zheng virtio_blk_dma_restart_bh, s); 6426e790746SPaolo Bonzini qemu_bh_schedule(s->bh); 6436e790746SPaolo Bonzini } 6446e790746SPaolo Bonzini } 6456e790746SPaolo Bonzini 6466e790746SPaolo Bonzini static void virtio_blk_reset(VirtIODevice *vdev) 6476e790746SPaolo Bonzini { 6486e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 6496e790746SPaolo Bonzini 6506e790746SPaolo Bonzini if (s->dataplane) { 6516e790746SPaolo Bonzini virtio_blk_data_plane_stop(s->dataplane); 6526e790746SPaolo Bonzini } 6536e790746SPaolo Bonzini 6546e790746SPaolo Bonzini /* 6556e790746SPaolo Bonzini * This should cancel pending requests, but can't do nicely until there 6566e790746SPaolo Bonzini * are per-device request lists. 6576e790746SPaolo Bonzini */ 6584be74634SMarkus Armbruster blk_drain_all(); 6594be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, s->original_wce); 6606e790746SPaolo Bonzini } 6616e790746SPaolo Bonzini 6626e790746SPaolo Bonzini /* coalesce internal state, copy to pci i/o region 0 6636e790746SPaolo Bonzini */ 6646e790746SPaolo Bonzini static void virtio_blk_update_config(VirtIODevice *vdev, uint8_t *config) 6656e790746SPaolo Bonzini { 6666e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 6672a30307fSMarkus Armbruster BlockConf *conf = &s->conf.conf; 6686e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 6696e790746SPaolo Bonzini uint64_t capacity; 670f7516731SMarkus Armbruster int blk_size = conf->logical_block_size; 6716e790746SPaolo Bonzini 6724be74634SMarkus Armbruster blk_get_geometry(s->blk, &capacity); 6736e790746SPaolo Bonzini memset(&blkcfg, 0, sizeof(blkcfg)); 674783d1897SRusty Russell virtio_stq_p(vdev, &blkcfg.capacity, capacity); 675783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.seg_max, 128 - 2); 676f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.cylinders, conf->cyls); 677783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.blk_size, blk_size); 678f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.min_io_size, conf->min_io_size / blk_size); 679f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.opt_io_size, conf->opt_io_size / blk_size); 680f7516731SMarkus Armbruster blkcfg.heads = conf->heads; 6816e790746SPaolo Bonzini /* 6826e790746SPaolo Bonzini * We must ensure that the block device capacity is a multiple of 683e03ba136SPeter Maydell * the logical block size. If that is not the case, let's use 6846e790746SPaolo Bonzini * sector_mask to adopt the geometry to have a correct picture. 6856e790746SPaolo Bonzini * For those devices where the capacity is ok for the given geometry 686e03ba136SPeter Maydell * we don't touch the sector value of the geometry, since some devices 6876e790746SPaolo Bonzini * (like s390 dasd) need a specific value. Here the capacity is already 6886e790746SPaolo Bonzini * cyls*heads*secs*blk_size and the sector value is not block size 6896e790746SPaolo Bonzini * divided by 512 - instead it is the amount of blk_size blocks 6906e790746SPaolo Bonzini * per track (cylinder). 6916e790746SPaolo Bonzini */ 6924be74634SMarkus Armbruster if (blk_getlength(s->blk) / conf->heads / conf->secs % blk_size) { 693f7516731SMarkus Armbruster blkcfg.sectors = conf->secs & ~s->sector_mask; 6946e790746SPaolo Bonzini } else { 695f7516731SMarkus Armbruster blkcfg.sectors = conf->secs; 6966e790746SPaolo Bonzini } 6976e790746SPaolo Bonzini blkcfg.size_max = 0; 698f7516731SMarkus Armbruster blkcfg.physical_block_exp = get_physical_block_exp(conf); 6996e790746SPaolo Bonzini blkcfg.alignment_offset = 0; 7004be74634SMarkus Armbruster blkcfg.wce = blk_enable_write_cache(s->blk); 7016e790746SPaolo Bonzini memcpy(config, &blkcfg, sizeof(struct virtio_blk_config)); 7026e790746SPaolo Bonzini } 7036e790746SPaolo Bonzini 7046e790746SPaolo Bonzini static void virtio_blk_set_config(VirtIODevice *vdev, const uint8_t *config) 7056e790746SPaolo Bonzini { 7066e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7076e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 7086e790746SPaolo Bonzini 7096e790746SPaolo Bonzini memcpy(&blkcfg, config, sizeof(blkcfg)); 7106d7e73d6SFam Zheng 7114be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 7124be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, blkcfg.wce != 0); 7134be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 7146e790746SPaolo Bonzini } 7156e790746SPaolo Bonzini 7166e790746SPaolo Bonzini static uint32_t virtio_blk_get_features(VirtIODevice *vdev, uint32_t features) 7176e790746SPaolo Bonzini { 7186e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7196e790746SPaolo Bonzini 7206e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_SEG_MAX); 7216e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_GEOMETRY); 7226e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_TOPOLOGY); 7236e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_BLK_SIZE); 7246e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_SCSI); 7256e790746SPaolo Bonzini 7262a30307fSMarkus Armbruster if (s->conf.config_wce) { 7276e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_CONFIG_WCE); 7286e790746SPaolo Bonzini } 7294be74634SMarkus Armbruster if (blk_enable_write_cache(s->blk)) { 7306e790746SPaolo Bonzini features |= (1 << VIRTIO_BLK_F_WCE); 7314be74634SMarkus Armbruster } 7324be74634SMarkus Armbruster if (blk_is_read_only(s->blk)) { 7336e790746SPaolo Bonzini features |= 1 << VIRTIO_BLK_F_RO; 7344be74634SMarkus Armbruster } 7356e790746SPaolo Bonzini 7366e790746SPaolo Bonzini return features; 7376e790746SPaolo Bonzini } 7386e790746SPaolo Bonzini 7396e790746SPaolo Bonzini static void virtio_blk_set_status(VirtIODevice *vdev, uint8_t status) 7406e790746SPaolo Bonzini { 7416e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7426e790746SPaolo Bonzini uint32_t features; 7436e790746SPaolo Bonzini 7446e790746SPaolo Bonzini if (s->dataplane && !(status & (VIRTIO_CONFIG_S_DRIVER | 7456e790746SPaolo Bonzini VIRTIO_CONFIG_S_DRIVER_OK))) { 7466e790746SPaolo Bonzini virtio_blk_data_plane_stop(s->dataplane); 7476e790746SPaolo Bonzini } 7486e790746SPaolo Bonzini 7496e790746SPaolo Bonzini if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { 7506e790746SPaolo Bonzini return; 7516e790746SPaolo Bonzini } 7526e790746SPaolo Bonzini 7536e790746SPaolo Bonzini features = vdev->guest_features; 754ef5bc962SPaolo Bonzini 755ef5bc962SPaolo Bonzini /* A guest that supports VIRTIO_BLK_F_CONFIG_WCE must be able to send 756ef5bc962SPaolo Bonzini * cache flushes. Thus, the "auto writethrough" behavior is never 757ef5bc962SPaolo Bonzini * necessary for guests that support the VIRTIO_BLK_F_CONFIG_WCE feature. 758ef5bc962SPaolo Bonzini * Leaving it enabled would break the following sequence: 759ef5bc962SPaolo Bonzini * 760ef5bc962SPaolo Bonzini * Guest started with "-drive cache=writethrough" 761ef5bc962SPaolo Bonzini * Guest sets status to 0 762ef5bc962SPaolo Bonzini * Guest sets DRIVER bit in status field 763ef5bc962SPaolo Bonzini * Guest reads host features (WCE=0, CONFIG_WCE=1) 764ef5bc962SPaolo Bonzini * Guest writes guest features (WCE=0, CONFIG_WCE=1) 765ef5bc962SPaolo Bonzini * Guest writes 1 to the WCE configuration field (writeback mode) 766ef5bc962SPaolo Bonzini * Guest sets DRIVER_OK bit in status field 767ef5bc962SPaolo Bonzini * 7684be74634SMarkus Armbruster * s->blk would erroneously be placed in writethrough mode. 769ef5bc962SPaolo Bonzini */ 770ef5bc962SPaolo Bonzini if (!(features & (1 << VIRTIO_BLK_F_CONFIG_WCE))) { 7714be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 7724be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, 7736d7e73d6SFam Zheng !!(features & (1 << VIRTIO_BLK_F_WCE))); 7744be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 7756e790746SPaolo Bonzini } 776ef5bc962SPaolo Bonzini } 7776e790746SPaolo Bonzini 7786e790746SPaolo Bonzini static void virtio_blk_save(QEMUFile *f, void *opaque) 7796e790746SPaolo Bonzini { 780b2b295a7SGreg Kurz VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 7816e790746SPaolo Bonzini 7826e790746SPaolo Bonzini virtio_save(vdev, f); 783b2b295a7SGreg Kurz } 784b2b295a7SGreg Kurz 785b2b295a7SGreg Kurz static void virtio_blk_save_device(VirtIODevice *vdev, QEMUFile *f) 786b2b295a7SGreg Kurz { 787b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 788b2b295a7SGreg Kurz VirtIOBlockReq *req = s->rq; 7896e790746SPaolo Bonzini 7906e790746SPaolo Bonzini while (req) { 7916e790746SPaolo Bonzini qemu_put_sbyte(f, 1); 792f897bf75SStefan Hajnoczi qemu_put_buffer(f, (unsigned char *)&req->elem, 793671ec3f0SFam Zheng sizeof(VirtQueueElement)); 7946e790746SPaolo Bonzini req = req->next; 7956e790746SPaolo Bonzini } 7966e790746SPaolo Bonzini qemu_put_sbyte(f, 0); 7976e790746SPaolo Bonzini } 7986e790746SPaolo Bonzini 7996e790746SPaolo Bonzini static int virtio_blk_load(QEMUFile *f, void *opaque, int version_id) 8006e790746SPaolo Bonzini { 8016e790746SPaolo Bonzini VirtIOBlock *s = opaque; 8026e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 8036e790746SPaolo Bonzini 8046e790746SPaolo Bonzini if (version_id != 2) 8056e790746SPaolo Bonzini return -EINVAL; 8066e790746SPaolo Bonzini 807b2b295a7SGreg Kurz return virtio_load(vdev, f, version_id); 8086e790746SPaolo Bonzini } 8096e790746SPaolo Bonzini 810b2b295a7SGreg Kurz static int virtio_blk_load_device(VirtIODevice *vdev, QEMUFile *f, 811b2b295a7SGreg Kurz int version_id) 812b2b295a7SGreg Kurz { 813b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 814b2b295a7SGreg Kurz 8156e790746SPaolo Bonzini while (qemu_get_sbyte(f)) { 8166e790746SPaolo Bonzini VirtIOBlockReq *req = virtio_blk_alloc_request(s); 817f897bf75SStefan Hajnoczi qemu_get_buffer(f, (unsigned char *)&req->elem, 818671ec3f0SFam Zheng sizeof(VirtQueueElement)); 8196e790746SPaolo Bonzini req->next = s->rq; 8206e790746SPaolo Bonzini s->rq = req; 8216e790746SPaolo Bonzini 822f897bf75SStefan Hajnoczi virtqueue_map_sg(req->elem.in_sg, req->elem.in_addr, 823f897bf75SStefan Hajnoczi req->elem.in_num, 1); 824f897bf75SStefan Hajnoczi virtqueue_map_sg(req->elem.out_sg, req->elem.out_addr, 825f897bf75SStefan Hajnoczi req->elem.out_num, 0); 8266e790746SPaolo Bonzini } 8276e790746SPaolo Bonzini 8286e790746SPaolo Bonzini return 0; 8296e790746SPaolo Bonzini } 8306e790746SPaolo Bonzini 8316e790746SPaolo Bonzini static void virtio_blk_resize(void *opaque) 8326e790746SPaolo Bonzini { 8336e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 8346e790746SPaolo Bonzini 8356e790746SPaolo Bonzini virtio_notify_config(vdev); 8366e790746SPaolo Bonzini } 8376e790746SPaolo Bonzini 8386e790746SPaolo Bonzini static const BlockDevOps virtio_block_ops = { 8396e790746SPaolo Bonzini .resize_cb = virtio_blk_resize, 8406e790746SPaolo Bonzini }; 8416e790746SPaolo Bonzini 84284db52d0SStefan Hajnoczi /* Disable dataplane thread during live migration since it does not 84384db52d0SStefan Hajnoczi * update the dirty memory bitmap yet. 84484db52d0SStefan Hajnoczi */ 84584db52d0SStefan Hajnoczi static void virtio_blk_migration_state_changed(Notifier *notifier, void *data) 84684db52d0SStefan Hajnoczi { 84784db52d0SStefan Hajnoczi VirtIOBlock *s = container_of(notifier, VirtIOBlock, 84884db52d0SStefan Hajnoczi migration_state_notifier); 84984db52d0SStefan Hajnoczi MigrationState *mig = data; 8503ffeeef7SAndreas Färber Error *err = NULL; 85184db52d0SStefan Hajnoczi 85284db52d0SStefan Hajnoczi if (migration_in_setup(mig)) { 85384db52d0SStefan Hajnoczi if (!s->dataplane) { 85484db52d0SStefan Hajnoczi return; 85584db52d0SStefan Hajnoczi } 85684db52d0SStefan Hajnoczi virtio_blk_data_plane_destroy(s->dataplane); 85784db52d0SStefan Hajnoczi s->dataplane = NULL; 85884db52d0SStefan Hajnoczi } else if (migration_has_finished(mig) || 85984db52d0SStefan Hajnoczi migration_has_failed(mig)) { 86084db52d0SStefan Hajnoczi if (s->dataplane) { 86184db52d0SStefan Hajnoczi return; 86284db52d0SStefan Hajnoczi } 8634be74634SMarkus Armbruster blk_drain_all(); /* complete in-flight non-dataplane requests */ 8642a30307fSMarkus Armbruster virtio_blk_data_plane_create(VIRTIO_DEVICE(s), &s->conf, 8653ffeeef7SAndreas Färber &s->dataplane, &err); 8663ffeeef7SAndreas Färber if (err != NULL) { 867565f65d2SMarkus Armbruster error_report_err(err); 8683ffeeef7SAndreas Färber } 86984db52d0SStefan Hajnoczi } 87084db52d0SStefan Hajnoczi } 87184db52d0SStefan Hajnoczi 87275884afdSAndreas Färber static void virtio_blk_device_realize(DeviceState *dev, Error **errp) 8736e790746SPaolo Bonzini { 87475884afdSAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 875179b417eSAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 8762a30307fSMarkus Armbruster VirtIOBlkConf *conf = &s->conf; 8773ffeeef7SAndreas Färber Error *err = NULL; 8786e790746SPaolo Bonzini static int virtio_blk_id; 8796e790746SPaolo Bonzini 8804be74634SMarkus Armbruster if (!conf->conf.blk) { 88175884afdSAndreas Färber error_setg(errp, "drive property not set"); 88275884afdSAndreas Färber return; 8836e790746SPaolo Bonzini } 8844be74634SMarkus Armbruster if (!blk_is_inserted(conf->conf.blk)) { 88575884afdSAndreas Färber error_setg(errp, "Device needs media, but drive is empty"); 88675884afdSAndreas Färber return; 8876e790746SPaolo Bonzini } 8886e790746SPaolo Bonzini 8892a30307fSMarkus Armbruster blkconf_serial(&conf->conf, &conf->serial); 8904be74634SMarkus Armbruster s->original_wce = blk_enable_write_cache(conf->conf.blk); 8912a30307fSMarkus Armbruster blkconf_geometry(&conf->conf, NULL, 65535, 255, 255, &err); 8925ff5efb4SFam Zheng if (err) { 8935ff5efb4SFam Zheng error_propagate(errp, err); 89475884afdSAndreas Färber return; 8956e790746SPaolo Bonzini } 8966e790746SPaolo Bonzini 8976e790746SPaolo Bonzini virtio_init(vdev, "virtio-blk", VIRTIO_ID_BLOCK, 8986e790746SPaolo Bonzini sizeof(struct virtio_blk_config)); 8996e790746SPaolo Bonzini 9004be74634SMarkus Armbruster s->blk = conf->conf.blk; 9016e790746SPaolo Bonzini s->rq = NULL; 9022a30307fSMarkus Armbruster s->sector_mask = (s->conf.conf.logical_block_size / BDRV_SECTOR_SIZE) - 1; 9036e790746SPaolo Bonzini 9046e790746SPaolo Bonzini s->vq = virtio_add_queue(vdev, 128, virtio_blk_handle_output); 905bf4bd461SFam Zheng s->complete_request = virtio_blk_complete_request; 9062a30307fSMarkus Armbruster virtio_blk_data_plane_create(vdev, conf, &s->dataplane, &err); 9073ffeeef7SAndreas Färber if (err != NULL) { 90875884afdSAndreas Färber error_propagate(errp, err); 9096a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 91075884afdSAndreas Färber return; 9116e790746SPaolo Bonzini } 91284db52d0SStefan Hajnoczi s->migration_state_notifier.notify = virtio_blk_migration_state_changed; 91384db52d0SStefan Hajnoczi add_migration_state_change_notifier(&s->migration_state_notifier); 9146e790746SPaolo Bonzini 9156e790746SPaolo Bonzini s->change = qemu_add_vm_change_state_handler(virtio_blk_dma_restart_cb, s); 916179b417eSAndreas Färber register_savevm(dev, "virtio-blk", virtio_blk_id++, 2, 9176e790746SPaolo Bonzini virtio_blk_save, virtio_blk_load, s); 9184be74634SMarkus Armbruster blk_set_dev_ops(s->blk, &virtio_block_ops, s); 9194be74634SMarkus Armbruster blk_set_guest_block_size(s->blk, s->conf.conf.logical_block_size); 9206e790746SPaolo Bonzini 9214be74634SMarkus Armbruster blk_iostatus_enable(s->blk); 9226e790746SPaolo Bonzini } 9236e790746SPaolo Bonzini 924306ec6c3SAndreas Färber static void virtio_blk_device_unrealize(DeviceState *dev, Error **errp) 9256e790746SPaolo Bonzini { 926306ec6c3SAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 927306ec6c3SAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 928306ec6c3SAndreas Färber 92984db52d0SStefan Hajnoczi remove_migration_state_change_notifier(&s->migration_state_notifier); 9306e790746SPaolo Bonzini virtio_blk_data_plane_destroy(s->dataplane); 9316e790746SPaolo Bonzini s->dataplane = NULL; 9326e790746SPaolo Bonzini qemu_del_vm_change_state_handler(s->change); 933306ec6c3SAndreas Färber unregister_savevm(dev, "virtio-blk", s); 9344be74634SMarkus Armbruster blockdev_mark_auto_del(s->blk); 9356a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 9366e790746SPaolo Bonzini } 9376e790746SPaolo Bonzini 938467b3f33SStefan Hajnoczi static void virtio_blk_instance_init(Object *obj) 939467b3f33SStefan Hajnoczi { 940467b3f33SStefan Hajnoczi VirtIOBlock *s = VIRTIO_BLK(obj); 941467b3f33SStefan Hajnoczi 942467b3f33SStefan Hajnoczi object_property_add_link(obj, "iothread", TYPE_IOTHREAD, 9432a30307fSMarkus Armbruster (Object **)&s->conf.iothread, 944467b3f33SStefan Hajnoczi qdev_prop_allow_set_link_before_realize, 945467b3f33SStefan Hajnoczi OBJ_PROP_LINK_UNREF_ON_RELEASE, NULL); 9462a30307fSMarkus Armbruster device_add_bootindex_property(obj, &s->conf.conf.bootindex, 9473342ec32SGonglei "bootindex", "/disk@0,0", 9483342ec32SGonglei DEVICE(obj), NULL); 949467b3f33SStefan Hajnoczi } 950467b3f33SStefan Hajnoczi 9516e790746SPaolo Bonzini static Property virtio_blk_properties[] = { 9522a30307fSMarkus Armbruster DEFINE_BLOCK_PROPERTIES(VirtIOBlock, conf.conf), 9532a30307fSMarkus Armbruster DEFINE_BLOCK_CHS_PROPERTIES(VirtIOBlock, conf.conf), 9542a30307fSMarkus Armbruster DEFINE_PROP_STRING("serial", VirtIOBlock, conf.serial), 9552a30307fSMarkus Armbruster DEFINE_PROP_BIT("config-wce", VirtIOBlock, conf.config_wce, 0, true), 95632a877e4SStefan Hajnoczi #ifdef __linux__ 9572a30307fSMarkus Armbruster DEFINE_PROP_BIT("scsi", VirtIOBlock, conf.scsi, 0, true), 95832a877e4SStefan Hajnoczi #endif 959c99495acSPeter Lieven DEFINE_PROP_BIT("request-merging", VirtIOBlock, conf.request_merging, 0, 960c99495acSPeter Lieven true), 9612a30307fSMarkus Armbruster DEFINE_PROP_BIT("x-data-plane", VirtIOBlock, conf.data_plane, 0, false), 9626e790746SPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 9636e790746SPaolo Bonzini }; 9646e790746SPaolo Bonzini 9656e790746SPaolo Bonzini static void virtio_blk_class_init(ObjectClass *klass, void *data) 9666e790746SPaolo Bonzini { 9676e790746SPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 9686e790746SPaolo Bonzini VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); 96975884afdSAndreas Färber 9706e790746SPaolo Bonzini dc->props = virtio_blk_properties; 971125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 97275884afdSAndreas Färber vdc->realize = virtio_blk_device_realize; 973306ec6c3SAndreas Färber vdc->unrealize = virtio_blk_device_unrealize; 9746e790746SPaolo Bonzini vdc->get_config = virtio_blk_update_config; 9756e790746SPaolo Bonzini vdc->set_config = virtio_blk_set_config; 9766e790746SPaolo Bonzini vdc->get_features = virtio_blk_get_features; 9776e790746SPaolo Bonzini vdc->set_status = virtio_blk_set_status; 9786e790746SPaolo Bonzini vdc->reset = virtio_blk_reset; 979b2b295a7SGreg Kurz vdc->save = virtio_blk_save_device; 980b2b295a7SGreg Kurz vdc->load = virtio_blk_load_device; 9816e790746SPaolo Bonzini } 9826e790746SPaolo Bonzini 9836e790746SPaolo Bonzini static const TypeInfo virtio_device_info = { 9846e790746SPaolo Bonzini .name = TYPE_VIRTIO_BLK, 9856e790746SPaolo Bonzini .parent = TYPE_VIRTIO_DEVICE, 9866e790746SPaolo Bonzini .instance_size = sizeof(VirtIOBlock), 987467b3f33SStefan Hajnoczi .instance_init = virtio_blk_instance_init, 9886e790746SPaolo Bonzini .class_init = virtio_blk_class_init, 9896e790746SPaolo Bonzini }; 9906e790746SPaolo Bonzini 9916e790746SPaolo Bonzini static void virtio_register_types(void) 9926e790746SPaolo Bonzini { 9936e790746SPaolo Bonzini type_register_static(&virtio_device_info); 9946e790746SPaolo Bonzini } 9956e790746SPaolo Bonzini 9966e790746SPaolo Bonzini type_init(virtio_register_types) 997