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 1480c71a24SPeter Maydell #include "qemu/osdep.h" 15da34e65cSMarkus Armbruster #include "qapi/error.h" 166e790746SPaolo Bonzini #include "qemu-common.h" 17827805a2SFam Zheng #include "qemu/iov.h" 186e790746SPaolo Bonzini #include "qemu/error-report.h" 196e790746SPaolo Bonzini #include "trace.h" 206e790746SPaolo Bonzini #include "hw/block/block.h" 214be74634SMarkus Armbruster #include "sysemu/block-backend.h" 226e790746SPaolo Bonzini #include "sysemu/blockdev.h" 236e790746SPaolo Bonzini #include "hw/virtio/virtio-blk.h" 246e790746SPaolo Bonzini #include "dataplane/virtio-blk.h" 256e790746SPaolo Bonzini #include "block/scsi.h" 266e790746SPaolo Bonzini #ifdef __linux__ 276e790746SPaolo Bonzini # include <scsi/sg.h> 286e790746SPaolo Bonzini #endif 296e790746SPaolo Bonzini #include "hw/virtio/virtio-bus.h" 30783d1897SRusty Russell #include "hw/virtio/virtio-access.h" 316e790746SPaolo Bonzini 32edaffd9fSStefan Hajnoczi void virtio_blk_init_request(VirtIOBlock *s, VirtQueue *vq, 33edaffd9fSStefan Hajnoczi VirtIOBlockReq *req) 34671ec3f0SFam Zheng { 35671ec3f0SFam Zheng req->dev = s; 36edaffd9fSStefan Hajnoczi req->vq = vq; 37869d66afSStefan Hajnoczi req->qiov.size = 0; 382a6cdd6dSPaolo Bonzini req->in_len = 0; 39869d66afSStefan Hajnoczi req->next = NULL; 4095f7142aSPeter Lieven req->mr_next = NULL; 41671ec3f0SFam Zheng } 42671ec3f0SFam Zheng 43f897bf75SStefan Hajnoczi void virtio_blk_free_request(VirtIOBlockReq *req) 44671ec3f0SFam Zheng { 45671ec3f0SFam Zheng if (req) { 46c84b3192SPaolo Bonzini g_free(req); 47671ec3f0SFam Zheng } 48671ec3f0SFam Zheng } 49671ec3f0SFam Zheng 5003de2f52SPaolo Bonzini static void virtio_blk_req_complete(VirtIOBlockReq *req, unsigned char status) 516e790746SPaolo Bonzini { 526e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 536e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 546e790746SPaolo Bonzini 556e790746SPaolo Bonzini trace_virtio_blk_req_complete(req, status); 566e790746SPaolo Bonzini 576e790746SPaolo Bonzini stb_p(&req->in->status, status); 58edaffd9fSStefan Hajnoczi virtqueue_push(req->vq, &req->elem, req->in_len); 59eb41cf78SPaolo Bonzini if (s->dataplane_started && !s->dataplane_disabled) { 60edaffd9fSStefan Hajnoczi virtio_blk_data_plane_notify(s->dataplane, req->vq); 6103de2f52SPaolo Bonzini } else { 62edaffd9fSStefan Hajnoczi virtio_notify(vdev, req->vq); 636e790746SPaolo Bonzini } 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) { 74466138dcSFam Zheng /* Break the link as the next request is going to be parsed from the 75466138dcSFam Zheng * ring again. Otherwise we may end up doing a double completion! */ 76466138dcSFam Zheng req->mr_next = NULL; 776e790746SPaolo Bonzini req->next = s->rq; 786e790746SPaolo Bonzini s->rq = req; 79a589569fSWenchao Xia } else if (action == BLOCK_ERROR_ACTION_REPORT) { 806e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 8101762e03SAlberto Garcia block_acct_failed(blk_get_stats(s->blk), &req->acct); 82671ec3f0SFam Zheng virtio_blk_free_request(req); 836e790746SPaolo Bonzini } 846e790746SPaolo Bonzini 854be74634SMarkus Armbruster blk_error_action(s->blk, action, is_read, error); 86a589569fSWenchao Xia return action != BLOCK_ERROR_ACTION_IGNORE; 876e790746SPaolo Bonzini } 886e790746SPaolo Bonzini 896e790746SPaolo Bonzini static void virtio_blk_rw_complete(void *opaque, int ret) 906e790746SPaolo Bonzini { 9195f7142aSPeter Lieven VirtIOBlockReq *next = opaque; 926e790746SPaolo Bonzini 9395f7142aSPeter Lieven while (next) { 9495f7142aSPeter Lieven VirtIOBlockReq *req = next; 9595f7142aSPeter Lieven next = req->mr_next; 966e790746SPaolo Bonzini trace_virtio_blk_rw_complete(req, ret); 976e790746SPaolo Bonzini 9895f7142aSPeter Lieven if (req->qiov.nalloc != -1) { 9995f7142aSPeter Lieven /* If nalloc is != 1 req->qiov is a local copy of the original 10095f7142aSPeter Lieven * external iovec. It was allocated in submit_merged_requests 10195f7142aSPeter Lieven * to be able to merge requests. */ 10295f7142aSPeter Lieven qemu_iovec_destroy(&req->qiov); 10395f7142aSPeter Lieven } 10495f7142aSPeter Lieven 1056e790746SPaolo Bonzini if (ret) { 106783d1897SRusty Russell int p = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); 107783d1897SRusty Russell bool is_read = !(p & VIRTIO_BLK_T_OUT); 1082a6cdd6dSPaolo Bonzini /* Note that memory may be dirtied on read failure. If the 1092a6cdd6dSPaolo Bonzini * virtio request is not completed here, as is the case for 1102a6cdd6dSPaolo Bonzini * BLOCK_ERROR_ACTION_STOP, the memory may not be copied 1112a6cdd6dSPaolo Bonzini * correctly during live migration. While this is ugly, 1122a6cdd6dSPaolo Bonzini * it is acceptable because the device is free to write to 1132a6cdd6dSPaolo Bonzini * the memory until the request is completed (which will 1142a6cdd6dSPaolo Bonzini * happen on the other side of the migration). 1152a6cdd6dSPaolo Bonzini */ 11695f7142aSPeter Lieven if (virtio_blk_handle_rw_error(req, -ret, is_read)) { 11795f7142aSPeter Lieven continue; 11895f7142aSPeter Lieven } 1196e790746SPaolo Bonzini } 1206e790746SPaolo Bonzini 1216e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1224be74634SMarkus Armbruster block_acct_done(blk_get_stats(req->dev->blk), &req->acct); 123671ec3f0SFam Zheng virtio_blk_free_request(req); 1246e790746SPaolo Bonzini } 12595f7142aSPeter Lieven } 1266e790746SPaolo Bonzini 1276e790746SPaolo Bonzini static void virtio_blk_flush_complete(void *opaque, int ret) 1286e790746SPaolo Bonzini { 1296e790746SPaolo Bonzini VirtIOBlockReq *req = opaque; 1306e790746SPaolo Bonzini 1316e790746SPaolo Bonzini if (ret) { 1326e790746SPaolo Bonzini if (virtio_blk_handle_rw_error(req, -ret, 0)) { 1336e790746SPaolo Bonzini return; 1346e790746SPaolo Bonzini } 1356e790746SPaolo Bonzini } 1366e790746SPaolo Bonzini 1376e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1384be74634SMarkus Armbruster block_acct_done(blk_get_stats(req->dev->blk), &req->acct); 139671ec3f0SFam Zheng virtio_blk_free_request(req); 1406e790746SPaolo Bonzini } 1416e790746SPaolo Bonzini 1421dc936aaSFam Zheng #ifdef __linux__ 1431dc936aaSFam Zheng 1441dc936aaSFam Zheng typedef struct { 1451dc936aaSFam Zheng VirtIOBlockReq *req; 1461dc936aaSFam Zheng struct sg_io_hdr hdr; 1471dc936aaSFam Zheng } VirtIOBlockIoctlReq; 1481dc936aaSFam Zheng 1491dc936aaSFam Zheng static void virtio_blk_ioctl_complete(void *opaque, int status) 1501dc936aaSFam Zheng { 1511dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req = opaque; 1521dc936aaSFam Zheng VirtIOBlockReq *req = ioctl_req->req; 1531dc936aaSFam Zheng VirtIODevice *vdev = VIRTIO_DEVICE(req->dev); 1541dc936aaSFam Zheng struct virtio_scsi_inhdr *scsi; 1551dc936aaSFam Zheng struct sg_io_hdr *hdr; 1561dc936aaSFam Zheng 1571dc936aaSFam Zheng scsi = (void *)req->elem.in_sg[req->elem.in_num - 2].iov_base; 1581dc936aaSFam Zheng 1591dc936aaSFam Zheng if (status) { 1601dc936aaSFam Zheng status = VIRTIO_BLK_S_UNSUPP; 1611dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 255); 1621dc936aaSFam Zheng goto out; 1631dc936aaSFam Zheng } 1641dc936aaSFam Zheng 1651dc936aaSFam Zheng hdr = &ioctl_req->hdr; 1661dc936aaSFam Zheng /* 1671dc936aaSFam Zheng * From SCSI-Generic-HOWTO: "Some lower level drivers (e.g. ide-scsi) 1681dc936aaSFam Zheng * clear the masked_status field [hence status gets cleared too, see 1691dc936aaSFam Zheng * block/scsi_ioctl.c] even when a CHECK_CONDITION or COMMAND_TERMINATED 1701dc936aaSFam Zheng * status has occurred. However they do set DRIVER_SENSE in driver_status 1711dc936aaSFam Zheng * field. Also a (sb_len_wr > 0) indicates there is a sense buffer. 1721dc936aaSFam Zheng */ 1731dc936aaSFam Zheng if (hdr->status == 0 && hdr->sb_len_wr > 0) { 1741dc936aaSFam Zheng hdr->status = CHECK_CONDITION; 1751dc936aaSFam Zheng } 1761dc936aaSFam Zheng 1771dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 1781dc936aaSFam Zheng hdr->status | (hdr->msg_status << 8) | 1791dc936aaSFam Zheng (hdr->host_status << 16) | (hdr->driver_status << 24)); 1801dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->residual, hdr->resid); 1811dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->sense_len, hdr->sb_len_wr); 1821dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->data_len, hdr->dxfer_len); 1831dc936aaSFam Zheng 1841dc936aaSFam Zheng out: 1851dc936aaSFam Zheng virtio_blk_req_complete(req, status); 1861dc936aaSFam Zheng virtio_blk_free_request(req); 1871dc936aaSFam Zheng g_free(ioctl_req); 1881dc936aaSFam Zheng } 1891dc936aaSFam Zheng 1901dc936aaSFam Zheng #endif 1911dc936aaSFam Zheng 192edaffd9fSStefan Hajnoczi static VirtIOBlockReq *virtio_blk_get_request(VirtIOBlock *s, VirtQueue *vq) 1936e790746SPaolo Bonzini { 194edaffd9fSStefan Hajnoczi VirtIOBlockReq *req = virtqueue_pop(vq, sizeof(VirtIOBlockReq)); 1956e790746SPaolo Bonzini 19651b19ebeSPaolo Bonzini if (req) { 197edaffd9fSStefan Hajnoczi virtio_blk_init_request(s, vq, req); 1986e790746SPaolo Bonzini } 1996e790746SPaolo Bonzini return req; 2006e790746SPaolo Bonzini } 2016e790746SPaolo Bonzini 20275344fa4SFam Zheng static int virtio_blk_handle_scsi_req(VirtIOBlockReq *req) 2036e790746SPaolo Bonzini { 2046e790746SPaolo Bonzini int status = VIRTIO_BLK_S_OK; 2055a05cbeeSFam Zheng struct virtio_scsi_inhdr *scsi = NULL; 20675344fa4SFam Zheng VirtIODevice *vdev = VIRTIO_DEVICE(req->dev); 20775344fa4SFam Zheng VirtQueueElement *elem = &req->elem; 20875344fa4SFam Zheng VirtIOBlock *blk = req->dev; 209783d1897SRusty Russell 2105a05cbeeSFam Zheng #ifdef __linux__ 2115a05cbeeSFam Zheng int i; 2121dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req; 213a209f461SFam Zheng BlockAIOCB *acb; 2145a05cbeeSFam Zheng #endif 2156e790746SPaolo Bonzini 2166e790746SPaolo Bonzini /* 2176e790746SPaolo Bonzini * We require at least one output segment each for the virtio_blk_outhdr 2186e790746SPaolo Bonzini * and the SCSI command block. 2196e790746SPaolo Bonzini * 2206e790746SPaolo Bonzini * We also at least require the virtio_blk_inhdr, the virtio_scsi_inhdr 2216e790746SPaolo Bonzini * and the sense buffer pointer in the input segments. 2226e790746SPaolo Bonzini */ 2235a05cbeeSFam Zheng if (elem->out_num < 2 || elem->in_num < 3) { 2245a05cbeeSFam Zheng status = VIRTIO_BLK_S_IOERR; 2255a05cbeeSFam Zheng goto fail; 2266e790746SPaolo Bonzini } 2276e790746SPaolo Bonzini 2286e790746SPaolo Bonzini /* 2296e790746SPaolo Bonzini * The scsi inhdr is placed in the second-to-last input segment, just 2306e790746SPaolo Bonzini * before the regular inhdr. 2316e790746SPaolo Bonzini */ 2325a05cbeeSFam Zheng scsi = (void *)elem->in_sg[elem->in_num - 2].iov_base; 2336e790746SPaolo Bonzini 2342a30307fSMarkus Armbruster if (!blk->conf.scsi) { 2356e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2366e790746SPaolo Bonzini goto fail; 2376e790746SPaolo Bonzini } 2386e790746SPaolo Bonzini 2396e790746SPaolo Bonzini /* 2406e790746SPaolo Bonzini * No support for bidirection commands yet. 2416e790746SPaolo Bonzini */ 2425a05cbeeSFam Zheng if (elem->out_num > 2 && elem->in_num > 3) { 2436e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2446e790746SPaolo Bonzini goto fail; 2456e790746SPaolo Bonzini } 2466e790746SPaolo Bonzini 2476e790746SPaolo Bonzini #ifdef __linux__ 2481dc936aaSFam Zheng ioctl_req = g_new0(VirtIOBlockIoctlReq, 1); 2491dc936aaSFam Zheng ioctl_req->req = req; 2501dc936aaSFam Zheng ioctl_req->hdr.interface_id = 'S'; 2511dc936aaSFam Zheng ioctl_req->hdr.cmd_len = elem->out_sg[1].iov_len; 2521dc936aaSFam Zheng ioctl_req->hdr.cmdp = elem->out_sg[1].iov_base; 2531dc936aaSFam Zheng ioctl_req->hdr.dxfer_len = 0; 2546e790746SPaolo Bonzini 2555a05cbeeSFam Zheng if (elem->out_num > 2) { 2566e790746SPaolo Bonzini /* 2576e790746SPaolo Bonzini * If there are more than the minimally required 2 output segments 2586e790746SPaolo Bonzini * there is write payload starting from the third iovec. 2596e790746SPaolo Bonzini */ 2601dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_TO_DEV; 2611dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->out_num - 2; 2626e790746SPaolo Bonzini 2631dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 2641dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->out_sg[i + 2].iov_len; 2651dc936aaSFam Zheng } 2666e790746SPaolo Bonzini 2671dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->out_sg + 2; 2686e790746SPaolo Bonzini 2695a05cbeeSFam Zheng } else if (elem->in_num > 3) { 2706e790746SPaolo Bonzini /* 2716e790746SPaolo Bonzini * If we have more than 3 input segments the guest wants to actually 2726e790746SPaolo Bonzini * read data. 2736e790746SPaolo Bonzini */ 2741dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_FROM_DEV; 2751dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->in_num - 3; 2761dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 2771dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->in_sg[i].iov_len; 2781dc936aaSFam Zheng } 2796e790746SPaolo Bonzini 2801dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->in_sg; 2816e790746SPaolo Bonzini } else { 2826e790746SPaolo Bonzini /* 2836e790746SPaolo Bonzini * Some SCSI commands don't actually transfer any data. 2846e790746SPaolo Bonzini */ 2851dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_NONE; 2866e790746SPaolo Bonzini } 2876e790746SPaolo Bonzini 2881dc936aaSFam Zheng ioctl_req->hdr.sbp = elem->in_sg[elem->in_num - 3].iov_base; 2891dc936aaSFam Zheng ioctl_req->hdr.mx_sb_len = elem->in_sg[elem->in_num - 3].iov_len; 2906e790746SPaolo Bonzini 291a209f461SFam Zheng acb = blk_aio_ioctl(blk->blk, SG_IO, &ioctl_req->hdr, 2921dc936aaSFam Zheng virtio_blk_ioctl_complete, ioctl_req); 293a209f461SFam Zheng if (!acb) { 294a209f461SFam Zheng g_free(ioctl_req); 295a209f461SFam Zheng status = VIRTIO_BLK_S_UNSUPP; 296a209f461SFam Zheng goto fail; 297a209f461SFam Zheng } 2981dc936aaSFam Zheng return -EINPROGRESS; 2996e790746SPaolo Bonzini #else 3006e790746SPaolo Bonzini abort(); 3016e790746SPaolo Bonzini #endif 3026e790746SPaolo Bonzini 3036e790746SPaolo Bonzini fail: 3046e790746SPaolo Bonzini /* Just put anything nonzero so that the ioctl fails in the guest. */ 3055a05cbeeSFam Zheng if (scsi) { 306783d1897SRusty Russell virtio_stl_p(vdev, &scsi->errors, 255); 3075a05cbeeSFam Zheng } 3085a05cbeeSFam Zheng return status; 3095a05cbeeSFam Zheng } 3105a05cbeeSFam Zheng 3115a05cbeeSFam Zheng static void virtio_blk_handle_scsi(VirtIOBlockReq *req) 3125a05cbeeSFam Zheng { 3135a05cbeeSFam Zheng int status; 3145a05cbeeSFam Zheng 31575344fa4SFam Zheng status = virtio_blk_handle_scsi_req(req); 3161dc936aaSFam Zheng if (status != -EINPROGRESS) { 3176e790746SPaolo Bonzini virtio_blk_req_complete(req, status); 318671ec3f0SFam Zheng virtio_blk_free_request(req); 3196e790746SPaolo Bonzini } 3201dc936aaSFam Zheng } 3216e790746SPaolo Bonzini 32295f7142aSPeter Lieven static inline void submit_requests(BlockBackend *blk, MultiReqBuffer *mrb, 32395f7142aSPeter Lieven int start, int num_reqs, int niov) 3246e790746SPaolo Bonzini { 32595f7142aSPeter Lieven QEMUIOVector *qiov = &mrb->reqs[start]->qiov; 32695f7142aSPeter Lieven int64_t sector_num = mrb->reqs[start]->sector_num; 32795f7142aSPeter Lieven bool is_write = mrb->is_write; 3286e790746SPaolo Bonzini 32995f7142aSPeter Lieven if (num_reqs > 1) { 33095f7142aSPeter Lieven int i; 33195f7142aSPeter Lieven struct iovec *tmp_iov = qiov->iov; 33295f7142aSPeter Lieven int tmp_niov = qiov->niov; 33395f7142aSPeter Lieven 33495f7142aSPeter Lieven /* mrb->reqs[start]->qiov was initialized from external so we can't 335b5772fddSEric Blake * modify it here. We need to initialize it locally and then add the 33695f7142aSPeter Lieven * external iovecs. */ 33795f7142aSPeter Lieven qemu_iovec_init(qiov, niov); 33895f7142aSPeter Lieven 33995f7142aSPeter Lieven for (i = 0; i < tmp_niov; i++) { 34095f7142aSPeter Lieven qemu_iovec_add(qiov, tmp_iov[i].iov_base, tmp_iov[i].iov_len); 34195f7142aSPeter Lieven } 34295f7142aSPeter Lieven 34395f7142aSPeter Lieven for (i = start + 1; i < start + num_reqs; i++) { 34495f7142aSPeter Lieven qemu_iovec_concat(qiov, &mrb->reqs[i]->qiov, 0, 34595f7142aSPeter Lieven mrb->reqs[i]->qiov.size); 34695f7142aSPeter Lieven mrb->reqs[i - 1]->mr_next = mrb->reqs[i]; 34795f7142aSPeter Lieven } 34895f7142aSPeter Lieven 349b5772fddSEric Blake trace_virtio_blk_submit_multireq(mrb, start, num_reqs, 350b5772fddSEric Blake sector_num << BDRV_SECTOR_BITS, 351b5772fddSEric Blake qiov->size, is_write); 35295f7142aSPeter Lieven block_acct_merge_done(blk_get_stats(blk), 35395f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ, 35495f7142aSPeter Lieven num_reqs - 1); 35595f7142aSPeter Lieven } 35695f7142aSPeter Lieven 35795f7142aSPeter Lieven if (is_write) { 358b5772fddSEric Blake blk_aio_pwritev(blk, sector_num << BDRV_SECTOR_BITS, qiov, 0, 35995f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 36095f7142aSPeter Lieven } else { 361b5772fddSEric Blake blk_aio_preadv(blk, sector_num << BDRV_SECTOR_BITS, qiov, 0, 36295f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 36395f7142aSPeter Lieven } 36495f7142aSPeter Lieven } 36595f7142aSPeter Lieven 36695f7142aSPeter Lieven static int multireq_compare(const void *a, const void *b) 36795f7142aSPeter Lieven { 36895f7142aSPeter Lieven const VirtIOBlockReq *req1 = *(VirtIOBlockReq **)a, 36995f7142aSPeter Lieven *req2 = *(VirtIOBlockReq **)b; 37095f7142aSPeter Lieven 37195f7142aSPeter Lieven /* 37295f7142aSPeter Lieven * Note that we can't simply subtract sector_num1 from sector_num2 37395f7142aSPeter Lieven * here as that could overflow the return value. 37495f7142aSPeter Lieven */ 37595f7142aSPeter Lieven if (req1->sector_num > req2->sector_num) { 37695f7142aSPeter Lieven return 1; 37795f7142aSPeter Lieven } else if (req1->sector_num < req2->sector_num) { 37895f7142aSPeter Lieven return -1; 37995f7142aSPeter Lieven } else { 38095f7142aSPeter Lieven return 0; 38195f7142aSPeter Lieven } 38295f7142aSPeter Lieven } 38395f7142aSPeter Lieven 38495f7142aSPeter Lieven void virtio_blk_submit_multireq(BlockBackend *blk, MultiReqBuffer *mrb) 38595f7142aSPeter Lieven { 38695f7142aSPeter Lieven int i = 0, start = 0, num_reqs = 0, niov = 0, nb_sectors = 0; 38795f7142aSPeter Lieven int max_xfer_len = 0; 38895f7142aSPeter Lieven int64_t sector_num = 0; 38995f7142aSPeter Lieven 39095f7142aSPeter Lieven if (mrb->num_reqs == 1) { 39195f7142aSPeter Lieven submit_requests(blk, mrb, 0, 1, -1); 39295f7142aSPeter Lieven mrb->num_reqs = 0; 3936e790746SPaolo Bonzini return; 3946e790746SPaolo Bonzini } 3956e790746SPaolo Bonzini 39695f7142aSPeter Lieven max_xfer_len = blk_get_max_transfer_length(mrb->reqs[0]->dev->blk); 39775af1f34SPeter Lieven max_xfer_len = MIN_NON_ZERO(max_xfer_len, BDRV_REQUEST_MAX_SECTORS); 39895f7142aSPeter Lieven 39995f7142aSPeter Lieven qsort(mrb->reqs, mrb->num_reqs, sizeof(*mrb->reqs), 40095f7142aSPeter Lieven &multireq_compare); 40195f7142aSPeter Lieven 40295f7142aSPeter Lieven for (i = 0; i < mrb->num_reqs; i++) { 40395f7142aSPeter Lieven VirtIOBlockReq *req = mrb->reqs[i]; 40495f7142aSPeter Lieven if (num_reqs > 0) { 40549cffbc6SGonglei /* 40649cffbc6SGonglei * NOTE: We cannot merge the requests in below situations: 40749cffbc6SGonglei * 1. requests are not sequential 40849cffbc6SGonglei * 2. merge would exceed maximum number of IOVs 40949cffbc6SGonglei * 3. merge would exceed maximum transfer length of backend device 41049cffbc6SGonglei */ 41149cffbc6SGonglei if (sector_num + nb_sectors != req->sector_num || 412222565f6SStefan Hajnoczi niov > blk_get_max_iov(blk) - req->qiov.niov || 41349cffbc6SGonglei req->qiov.size / BDRV_SECTOR_SIZE > max_xfer_len || 41449cffbc6SGonglei nb_sectors > max_xfer_len - req->qiov.size / BDRV_SECTOR_SIZE) { 41595f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 41695f7142aSPeter Lieven num_reqs = 0; 4176e790746SPaolo Bonzini } 4186e790746SPaolo Bonzini } 4196e790746SPaolo Bonzini 42095f7142aSPeter Lieven if (num_reqs == 0) { 42195f7142aSPeter Lieven sector_num = req->sector_num; 42295f7142aSPeter Lieven nb_sectors = niov = 0; 42395f7142aSPeter Lieven start = i; 42495f7142aSPeter Lieven } 42595f7142aSPeter Lieven 42695f7142aSPeter Lieven nb_sectors += req->qiov.size / BDRV_SECTOR_SIZE; 42795f7142aSPeter Lieven niov += req->qiov.niov; 42895f7142aSPeter Lieven num_reqs++; 42995f7142aSPeter Lieven } 43095f7142aSPeter Lieven 43195f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 43295f7142aSPeter Lieven mrb->num_reqs = 0; 4336e790746SPaolo Bonzini } 4346e790746SPaolo Bonzini 4356e790746SPaolo Bonzini static void virtio_blk_handle_flush(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4366e790746SPaolo Bonzini { 4374be74634SMarkus Armbruster block_acct_start(blk_get_stats(req->dev->blk), &req->acct, 0, 4385366d0c8SBenoît Canet BLOCK_ACCT_FLUSH); 4396e790746SPaolo Bonzini 4406e790746SPaolo Bonzini /* 4416e790746SPaolo Bonzini * Make sure all outstanding writes are posted to the backing device. 4426e790746SPaolo Bonzini */ 44395f7142aSPeter Lieven if (mrb->is_write && mrb->num_reqs > 0) { 44495f7142aSPeter Lieven virtio_blk_submit_multireq(req->dev->blk, mrb); 44595f7142aSPeter Lieven } 4464be74634SMarkus Armbruster blk_aio_flush(req->dev->blk, virtio_blk_flush_complete, req); 4476e790746SPaolo Bonzini } 4486e790746SPaolo Bonzini 449d0e14376SMarkus Armbruster static bool virtio_blk_sect_range_ok(VirtIOBlock *dev, 450d0e14376SMarkus Armbruster uint64_t sector, size_t size) 451d0e14376SMarkus Armbruster { 4523c2daac0SMarkus Armbruster uint64_t nb_sectors = size >> BDRV_SECTOR_BITS; 4533c2daac0SMarkus Armbruster uint64_t total_sectors; 4543c2daac0SMarkus Armbruster 45575af1f34SPeter Lieven if (nb_sectors > BDRV_REQUEST_MAX_SECTORS) { 45695f7142aSPeter Lieven return false; 45795f7142aSPeter Lieven } 458d0e14376SMarkus Armbruster if (sector & dev->sector_mask) { 459d0e14376SMarkus Armbruster return false; 460d0e14376SMarkus Armbruster } 4612a30307fSMarkus Armbruster if (size % dev->conf.conf.logical_block_size) { 462d0e14376SMarkus Armbruster return false; 463d0e14376SMarkus Armbruster } 4644be74634SMarkus Armbruster blk_get_geometry(dev->blk, &total_sectors); 4653c2daac0SMarkus Armbruster if (sector > total_sectors || nb_sectors > total_sectors - sector) { 4663c2daac0SMarkus Armbruster return false; 4673c2daac0SMarkus Armbruster } 468d0e14376SMarkus Armbruster return true; 469d0e14376SMarkus Armbruster } 470d0e14376SMarkus Armbruster 471fee65db7SFam Zheng void virtio_blk_handle_request(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4726e790746SPaolo Bonzini { 4736e790746SPaolo Bonzini uint32_t type; 474f897bf75SStefan Hajnoczi struct iovec *in_iov = req->elem.in_sg; 475f897bf75SStefan Hajnoczi struct iovec *iov = req->elem.out_sg; 476f897bf75SStefan Hajnoczi unsigned in_num = req->elem.in_num; 477f897bf75SStefan Hajnoczi unsigned out_num = req->elem.out_num; 4786e790746SPaolo Bonzini 479f897bf75SStefan Hajnoczi if (req->elem.out_num < 1 || req->elem.in_num < 1) { 4806e790746SPaolo Bonzini error_report("virtio-blk missing headers"); 4816e790746SPaolo Bonzini exit(1); 4826e790746SPaolo Bonzini } 4836e790746SPaolo Bonzini 484827805a2SFam Zheng if (unlikely(iov_to_buf(iov, out_num, 0, &req->out, 485827805a2SFam Zheng sizeof(req->out)) != sizeof(req->out))) { 486827805a2SFam Zheng error_report("virtio-blk request outhdr too short"); 487827805a2SFam Zheng exit(1); 488827805a2SFam Zheng } 489ee17e848SFam Zheng 490827805a2SFam Zheng iov_discard_front(&iov, &out_num, sizeof(req->out)); 491ee17e848SFam Zheng 49212048545SGonglei if (in_iov[in_num - 1].iov_len < sizeof(struct virtio_blk_inhdr)) { 493ee17e848SFam Zheng error_report("virtio-blk request inhdr too short"); 494ee17e848SFam Zheng exit(1); 495ee17e848SFam Zheng } 496ee17e848SFam Zheng 4972a6cdd6dSPaolo Bonzini /* We always touch the last byte, so just see how big in_iov is. */ 4982a6cdd6dSPaolo Bonzini req->in_len = iov_size(in_iov, in_num); 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 507631b22eaSStefan Weil * is an optional flag. Although 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); 52901762e03SAlberto Garcia block_acct_invalid(blk_get_stats(req->dev->blk), 53001762e03SAlberto Garcia is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 53195f7142aSPeter Lieven virtio_blk_free_request(req); 53295f7142aSPeter Lieven return; 53395f7142aSPeter Lieven } 53495f7142aSPeter Lieven 53595f7142aSPeter Lieven block_acct_start(blk_get_stats(req->dev->blk), 53695f7142aSPeter Lieven &req->acct, req->qiov.size, 53795f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 53895f7142aSPeter Lieven 53995f7142aSPeter Lieven /* merge would exceed maximum number of requests or IO direction 54095f7142aSPeter Lieven * changes */ 54195f7142aSPeter Lieven if (mrb->num_reqs > 0 && (mrb->num_reqs == VIRTIO_BLK_MAX_MERGE_REQS || 542c99495acSPeter Lieven is_write != mrb->is_write || 543c99495acSPeter Lieven !req->dev->conf.request_merging)) { 54495f7142aSPeter Lieven virtio_blk_submit_multireq(req->dev->blk, mrb); 54595f7142aSPeter Lieven } 54695f7142aSPeter Lieven 54795f7142aSPeter Lieven assert(mrb->num_reqs < VIRTIO_BLK_MAX_MERGE_REQS); 54895f7142aSPeter Lieven mrb->reqs[mrb->num_reqs++] = req; 54995f7142aSPeter Lieven mrb->is_write = is_write; 55095f7142aSPeter Lieven break; 55195f7142aSPeter Lieven } 55295f7142aSPeter Lieven case VIRTIO_BLK_T_FLUSH: 5536e790746SPaolo Bonzini virtio_blk_handle_flush(req, mrb); 55495f7142aSPeter Lieven break; 55595f7142aSPeter Lieven case VIRTIO_BLK_T_SCSI_CMD: 5566e790746SPaolo Bonzini virtio_blk_handle_scsi(req); 55795f7142aSPeter Lieven break; 55895f7142aSPeter Lieven case VIRTIO_BLK_T_GET_ID: 55995f7142aSPeter Lieven { 5606e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 5616e790746SPaolo Bonzini 5626e790746SPaolo Bonzini /* 5636e790746SPaolo Bonzini * NB: per existing s/n string convention the string is 5646e790746SPaolo Bonzini * terminated by '\0' only when shorter than buffer. 5656e790746SPaolo Bonzini */ 5662a30307fSMarkus Armbruster const char *serial = s->conf.serial ? s->conf.serial : ""; 567a83ceea8SMarc Marí size_t size = MIN(strlen(serial) + 1, 568a83ceea8SMarc Marí MIN(iov_size(in_iov, in_num), 569a83ceea8SMarc Marí VIRTIO_BLK_ID_BYTES)); 570a83ceea8SMarc Marí iov_from_buf(in_iov, in_num, 0, serial, size); 5716e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 572671ec3f0SFam Zheng virtio_blk_free_request(req); 57395f7142aSPeter Lieven break; 57495f7142aSPeter Lieven } 57595f7142aSPeter Lieven default: 5766e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 577671ec3f0SFam Zheng virtio_blk_free_request(req); 5786e790746SPaolo Bonzini } 5796e790746SPaolo Bonzini } 5806e790746SPaolo Bonzini 5818a2fad57SMichael S. Tsirkin void virtio_blk_handle_vq(VirtIOBlock *s, VirtQueue *vq) 5826e790746SPaolo Bonzini { 5836e790746SPaolo Bonzini VirtIOBlockReq *req; 58495f7142aSPeter Lieven MultiReqBuffer mrb = {}; 5856e790746SPaolo Bonzini 586fc73548eSStefan Hajnoczi blk_io_plug(s->blk); 587fc73548eSStefan Hajnoczi 588edaffd9fSStefan Hajnoczi while ((req = virtio_blk_get_request(s, vq))) { 5896e790746SPaolo Bonzini virtio_blk_handle_request(req, &mrb); 5906e790746SPaolo Bonzini } 5916e790746SPaolo Bonzini 59295f7142aSPeter Lieven if (mrb.num_reqs) { 59395f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 59495f7142aSPeter Lieven } 595fc73548eSStefan Hajnoczi 596fc73548eSStefan Hajnoczi blk_io_unplug(s->blk); 5976e790746SPaolo Bonzini } 5986e790746SPaolo Bonzini 5998a2fad57SMichael S. Tsirkin static void virtio_blk_handle_output(VirtIODevice *vdev, VirtQueue *vq) 6008a2fad57SMichael S. Tsirkin { 6018a2fad57SMichael S. Tsirkin VirtIOBlock *s = (VirtIOBlock *)vdev; 6028a2fad57SMichael S. Tsirkin 6038a2fad57SMichael S. Tsirkin if (s->dataplane) { 6048a2fad57SMichael S. Tsirkin /* Some guests kick before setting VIRTIO_CONFIG_S_DRIVER_OK so start 6058a2fad57SMichael S. Tsirkin * dataplane here instead of waiting for .set_status(). 6068a2fad57SMichael S. Tsirkin */ 6078a2fad57SMichael S. Tsirkin virtio_blk_data_plane_start(s->dataplane); 6088a2fad57SMichael S. Tsirkin if (!s->dataplane_disabled) { 6098a2fad57SMichael S. Tsirkin return; 6108a2fad57SMichael S. Tsirkin } 6118a2fad57SMichael S. Tsirkin } 6128a2fad57SMichael S. Tsirkin virtio_blk_handle_vq(s, vq); 6138a2fad57SMichael S. Tsirkin } 6148a2fad57SMichael S. Tsirkin 6156e790746SPaolo Bonzini static void virtio_blk_dma_restart_bh(void *opaque) 6166e790746SPaolo Bonzini { 6176e790746SPaolo Bonzini VirtIOBlock *s = opaque; 6186e790746SPaolo Bonzini VirtIOBlockReq *req = s->rq; 61995f7142aSPeter Lieven MultiReqBuffer mrb = {}; 6206e790746SPaolo Bonzini 6216e790746SPaolo Bonzini qemu_bh_delete(s->bh); 6226e790746SPaolo Bonzini s->bh = NULL; 6236e790746SPaolo Bonzini 6246e790746SPaolo Bonzini s->rq = NULL; 6256e790746SPaolo Bonzini 6266e790746SPaolo Bonzini while (req) { 6271bdb176aSzhanghailiang VirtIOBlockReq *next = req->next; 6286e790746SPaolo Bonzini virtio_blk_handle_request(req, &mrb); 6291bdb176aSzhanghailiang req = next; 6306e790746SPaolo Bonzini } 6316e790746SPaolo Bonzini 63295f7142aSPeter Lieven if (mrb.num_reqs) { 63395f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 63495f7142aSPeter Lieven } 6356e790746SPaolo Bonzini } 6366e790746SPaolo Bonzini 6376e790746SPaolo Bonzini static void virtio_blk_dma_restart_cb(void *opaque, int running, 6386e790746SPaolo Bonzini RunState state) 6396e790746SPaolo Bonzini { 6406e790746SPaolo Bonzini VirtIOBlock *s = opaque; 6416e790746SPaolo Bonzini 6426e790746SPaolo Bonzini if (!running) { 6436e790746SPaolo Bonzini return; 6446e790746SPaolo Bonzini } 6456e790746SPaolo Bonzini 6466e790746SPaolo Bonzini if (!s->bh) { 6474be74634SMarkus Armbruster s->bh = aio_bh_new(blk_get_aio_context(s->conf.conf.blk), 6484407c1c5SFam Zheng virtio_blk_dma_restart_bh, s); 6496e790746SPaolo Bonzini qemu_bh_schedule(s->bh); 6506e790746SPaolo Bonzini } 6516e790746SPaolo Bonzini } 6526e790746SPaolo Bonzini 6536e790746SPaolo Bonzini static void virtio_blk_reset(VirtIODevice *vdev) 6546e790746SPaolo Bonzini { 6556e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 6566e40b3bfSAlexander Yarygin AioContext *ctx; 6576e790746SPaolo Bonzini 6586e790746SPaolo Bonzini /* 6596e790746SPaolo Bonzini * This should cancel pending requests, but can't do nicely until there 6606e790746SPaolo Bonzini * are per-device request lists. 6616e790746SPaolo Bonzini */ 6626e40b3bfSAlexander Yarygin ctx = blk_get_aio_context(s->blk); 6636e40b3bfSAlexander Yarygin aio_context_acquire(ctx); 6646e40b3bfSAlexander Yarygin blk_drain(s->blk); 6656e40b3bfSAlexander Yarygin 6666e40b3bfSAlexander Yarygin if (s->dataplane) { 6676e40b3bfSAlexander Yarygin virtio_blk_data_plane_stop(s->dataplane); 6686e40b3bfSAlexander Yarygin } 6696e40b3bfSAlexander Yarygin aio_context_release(ctx); 6706e40b3bfSAlexander Yarygin 6714be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, s->original_wce); 6726e790746SPaolo Bonzini } 6736e790746SPaolo Bonzini 6746e790746SPaolo Bonzini /* coalesce internal state, copy to pci i/o region 0 6756e790746SPaolo Bonzini */ 6766e790746SPaolo Bonzini static void virtio_blk_update_config(VirtIODevice *vdev, uint8_t *config) 6776e790746SPaolo Bonzini { 6786e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 6792a30307fSMarkus Armbruster BlockConf *conf = &s->conf.conf; 6806e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 6816e790746SPaolo Bonzini uint64_t capacity; 682f7516731SMarkus Armbruster int blk_size = conf->logical_block_size; 6836e790746SPaolo Bonzini 6844be74634SMarkus Armbruster blk_get_geometry(s->blk, &capacity); 6856e790746SPaolo Bonzini memset(&blkcfg, 0, sizeof(blkcfg)); 686783d1897SRusty Russell virtio_stq_p(vdev, &blkcfg.capacity, capacity); 687783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.seg_max, 128 - 2); 688907eb3e5SMichael S. Tsirkin virtio_stw_p(vdev, &blkcfg.geometry.cylinders, conf->cyls); 689783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.blk_size, blk_size); 690f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.min_io_size, conf->min_io_size / blk_size); 691f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.opt_io_size, conf->opt_io_size / blk_size); 692907eb3e5SMichael S. Tsirkin blkcfg.geometry.heads = conf->heads; 6936e790746SPaolo Bonzini /* 6946e790746SPaolo Bonzini * We must ensure that the block device capacity is a multiple of 695e03ba136SPeter Maydell * the logical block size. If that is not the case, let's use 6966e790746SPaolo Bonzini * sector_mask to adopt the geometry to have a correct picture. 6976e790746SPaolo Bonzini * For those devices where the capacity is ok for the given geometry 698e03ba136SPeter Maydell * we don't touch the sector value of the geometry, since some devices 6996e790746SPaolo Bonzini * (like s390 dasd) need a specific value. Here the capacity is already 7006e790746SPaolo Bonzini * cyls*heads*secs*blk_size and the sector value is not block size 7016e790746SPaolo Bonzini * divided by 512 - instead it is the amount of blk_size blocks 7026e790746SPaolo Bonzini * per track (cylinder). 7036e790746SPaolo Bonzini */ 7044be74634SMarkus Armbruster if (blk_getlength(s->blk) / conf->heads / conf->secs % blk_size) { 705907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs & ~s->sector_mask; 7066e790746SPaolo Bonzini } else { 707907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs; 7086e790746SPaolo Bonzini } 7096e790746SPaolo Bonzini blkcfg.size_max = 0; 710f7516731SMarkus Armbruster blkcfg.physical_block_exp = get_physical_block_exp(conf); 7116e790746SPaolo Bonzini blkcfg.alignment_offset = 0; 7124be74634SMarkus Armbruster blkcfg.wce = blk_enable_write_cache(s->blk); 7136e790746SPaolo Bonzini memcpy(config, &blkcfg, sizeof(struct virtio_blk_config)); 7146e790746SPaolo Bonzini } 7156e790746SPaolo Bonzini 7166e790746SPaolo Bonzini static void virtio_blk_set_config(VirtIODevice *vdev, const uint8_t *config) 7176e790746SPaolo Bonzini { 7186e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7196e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 7206e790746SPaolo Bonzini 7216e790746SPaolo Bonzini memcpy(&blkcfg, config, sizeof(blkcfg)); 7226d7e73d6SFam Zheng 7234be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 7244be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, blkcfg.wce != 0); 7254be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 7266e790746SPaolo Bonzini } 7276e790746SPaolo Bonzini 7289d5b731dSJason Wang static uint64_t virtio_blk_get_features(VirtIODevice *vdev, uint64_t features, 7299d5b731dSJason Wang Error **errp) 7306e790746SPaolo Bonzini { 7316e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7326e790746SPaolo Bonzini 7330cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_SEG_MAX); 7340cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_GEOMETRY); 7350cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_TOPOLOGY); 7360cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_BLK_SIZE); 73795129d6fSCornelia Huck if (virtio_has_feature(features, VIRTIO_F_VERSION_1)) { 738efb8206cSJason Wang if (s->conf.scsi) { 739efb8206cSJason Wang error_setg(errp, "Please set scsi=off for virtio-blk devices in order to use virtio 1.0"); 740efb8206cSJason Wang return 0; 741efb8206cSJason Wang } 742efb8206cSJason Wang } else { 743c9b11f97SJason Wang virtio_clear_feature(&features, VIRTIO_F_ANY_LAYOUT); 744efb8206cSJason Wang virtio_add_feature(&features, VIRTIO_BLK_F_SCSI); 745efb8206cSJason Wang } 7466e790746SPaolo Bonzini 7472a30307fSMarkus Armbruster if (s->conf.config_wce) { 7480cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_CONFIG_WCE); 7496e790746SPaolo Bonzini } 7504be74634SMarkus Armbruster if (blk_enable_write_cache(s->blk)) { 7510cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_WCE); 7524be74634SMarkus Armbruster } 7534be74634SMarkus Armbruster if (blk_is_read_only(s->blk)) { 7540cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_RO); 7554be74634SMarkus Armbruster } 7566e790746SPaolo Bonzini 7576e790746SPaolo Bonzini return features; 7586e790746SPaolo Bonzini } 7596e790746SPaolo Bonzini 7606e790746SPaolo Bonzini static void virtio_blk_set_status(VirtIODevice *vdev, uint8_t status) 7616e790746SPaolo Bonzini { 7626e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7636e790746SPaolo Bonzini 7646e790746SPaolo Bonzini if (s->dataplane && !(status & (VIRTIO_CONFIG_S_DRIVER | 7656e790746SPaolo Bonzini VIRTIO_CONFIG_S_DRIVER_OK))) { 7666e790746SPaolo Bonzini virtio_blk_data_plane_stop(s->dataplane); 7676e790746SPaolo Bonzini } 7686e790746SPaolo Bonzini 7696e790746SPaolo Bonzini if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { 7706e790746SPaolo Bonzini return; 7716e790746SPaolo Bonzini } 7726e790746SPaolo Bonzini 773ef5bc962SPaolo Bonzini /* A guest that supports VIRTIO_BLK_F_CONFIG_WCE must be able to send 774ef5bc962SPaolo Bonzini * cache flushes. Thus, the "auto writethrough" behavior is never 775ef5bc962SPaolo Bonzini * necessary for guests that support the VIRTIO_BLK_F_CONFIG_WCE feature. 776ef5bc962SPaolo Bonzini * Leaving it enabled would break the following sequence: 777ef5bc962SPaolo Bonzini * 778ef5bc962SPaolo Bonzini * Guest started with "-drive cache=writethrough" 779ef5bc962SPaolo Bonzini * Guest sets status to 0 780ef5bc962SPaolo Bonzini * Guest sets DRIVER bit in status field 781ef5bc962SPaolo Bonzini * Guest reads host features (WCE=0, CONFIG_WCE=1) 782ef5bc962SPaolo Bonzini * Guest writes guest features (WCE=0, CONFIG_WCE=1) 783ef5bc962SPaolo Bonzini * Guest writes 1 to the WCE configuration field (writeback mode) 784ef5bc962SPaolo Bonzini * Guest sets DRIVER_OK bit in status field 785ef5bc962SPaolo Bonzini * 7864be74634SMarkus Armbruster * s->blk would erroneously be placed in writethrough mode. 787ef5bc962SPaolo Bonzini */ 78895129d6fSCornelia Huck if (!virtio_vdev_has_feature(vdev, VIRTIO_BLK_F_CONFIG_WCE)) { 7894be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 7904be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, 79195129d6fSCornelia Huck virtio_vdev_has_feature(vdev, 79295129d6fSCornelia Huck VIRTIO_BLK_F_WCE)); 7934be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 7946e790746SPaolo Bonzini } 795ef5bc962SPaolo Bonzini } 7966e790746SPaolo Bonzini 7976e790746SPaolo Bonzini static void virtio_blk_save(QEMUFile *f, void *opaque) 7986e790746SPaolo Bonzini { 799b2b295a7SGreg Kurz VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 8006e790746SPaolo Bonzini 8016e790746SPaolo Bonzini virtio_save(vdev, f); 802b2b295a7SGreg Kurz } 803b2b295a7SGreg Kurz 804b2b295a7SGreg Kurz static void virtio_blk_save_device(VirtIODevice *vdev, QEMUFile *f) 805b2b295a7SGreg Kurz { 806b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 807b2b295a7SGreg Kurz VirtIOBlockReq *req = s->rq; 8086e790746SPaolo Bonzini 8096e790746SPaolo Bonzini while (req) { 8106e790746SPaolo Bonzini qemu_put_sbyte(f, 1); 811*30d8bf6dSStefan Hajnoczi 812*30d8bf6dSStefan Hajnoczi if (s->conf.num_queues > 1) { 813*30d8bf6dSStefan Hajnoczi qemu_put_be32(f, virtio_get_queue_index(req->vq)); 814*30d8bf6dSStefan Hajnoczi } 815*30d8bf6dSStefan Hajnoczi 816ab281c17SPaolo Bonzini qemu_put_virtqueue_element(f, &req->elem); 8176e790746SPaolo Bonzini req = req->next; 8186e790746SPaolo Bonzini } 8196e790746SPaolo Bonzini qemu_put_sbyte(f, 0); 8206e790746SPaolo Bonzini } 8216e790746SPaolo Bonzini 8226e790746SPaolo Bonzini static int virtio_blk_load(QEMUFile *f, void *opaque, int version_id) 8236e790746SPaolo Bonzini { 8246e790746SPaolo Bonzini VirtIOBlock *s = opaque; 8256e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 8266e790746SPaolo Bonzini 8276e790746SPaolo Bonzini if (version_id != 2) 8286e790746SPaolo Bonzini return -EINVAL; 8296e790746SPaolo Bonzini 830b2b295a7SGreg Kurz return virtio_load(vdev, f, version_id); 8316e790746SPaolo Bonzini } 8326e790746SPaolo Bonzini 833b2b295a7SGreg Kurz static int virtio_blk_load_device(VirtIODevice *vdev, QEMUFile *f, 834b2b295a7SGreg Kurz int version_id) 835b2b295a7SGreg Kurz { 836b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 837b2b295a7SGreg Kurz 8386e790746SPaolo Bonzini while (qemu_get_sbyte(f)) { 839*30d8bf6dSStefan Hajnoczi unsigned nvqs = s->conf.num_queues; 840*30d8bf6dSStefan Hajnoczi unsigned vq_idx = 0; 841ab281c17SPaolo Bonzini VirtIOBlockReq *req; 842*30d8bf6dSStefan Hajnoczi 843*30d8bf6dSStefan Hajnoczi if (nvqs > 1) { 844*30d8bf6dSStefan Hajnoczi vq_idx = qemu_get_be32(f); 845*30d8bf6dSStefan Hajnoczi 846*30d8bf6dSStefan Hajnoczi if (vq_idx >= nvqs) { 847*30d8bf6dSStefan Hajnoczi error_report("Invalid virtqueue index in request list: %#x", 848*30d8bf6dSStefan Hajnoczi vq_idx); 849*30d8bf6dSStefan Hajnoczi return -EINVAL; 850*30d8bf6dSStefan Hajnoczi } 851*30d8bf6dSStefan Hajnoczi } 852*30d8bf6dSStefan Hajnoczi 853ab281c17SPaolo Bonzini req = qemu_get_virtqueue_element(f, sizeof(VirtIOBlockReq)); 854*30d8bf6dSStefan Hajnoczi virtio_blk_init_request(s, virtio_get_queue(vdev, vq_idx), req); 8556e790746SPaolo Bonzini req->next = s->rq; 8566e790746SPaolo Bonzini s->rq = req; 8576e790746SPaolo Bonzini } 8586e790746SPaolo Bonzini 8596e790746SPaolo Bonzini return 0; 8606e790746SPaolo Bonzini } 8616e790746SPaolo Bonzini 8626e790746SPaolo Bonzini static void virtio_blk_resize(void *opaque) 8636e790746SPaolo Bonzini { 8646e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 8656e790746SPaolo Bonzini 8666e790746SPaolo Bonzini virtio_notify_config(vdev); 8676e790746SPaolo Bonzini } 8686e790746SPaolo Bonzini 8696e790746SPaolo Bonzini static const BlockDevOps virtio_block_ops = { 8706e790746SPaolo Bonzini .resize_cb = virtio_blk_resize, 8716e790746SPaolo Bonzini }; 8726e790746SPaolo Bonzini 87375884afdSAndreas Färber static void virtio_blk_device_realize(DeviceState *dev, Error **errp) 8746e790746SPaolo Bonzini { 87575884afdSAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 876179b417eSAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 8772a30307fSMarkus Armbruster VirtIOBlkConf *conf = &s->conf; 8783ffeeef7SAndreas Färber Error *err = NULL; 8796e790746SPaolo Bonzini static int virtio_blk_id; 8806e790746SPaolo Bonzini 8814be74634SMarkus Armbruster if (!conf->conf.blk) { 88275884afdSAndreas Färber error_setg(errp, "drive property not set"); 88375884afdSAndreas Färber return; 8846e790746SPaolo Bonzini } 8854be74634SMarkus Armbruster if (!blk_is_inserted(conf->conf.blk)) { 88675884afdSAndreas Färber error_setg(errp, "Device needs media, but drive is empty"); 88775884afdSAndreas Färber return; 8886e790746SPaolo Bonzini } 8896e790746SPaolo Bonzini 8902a30307fSMarkus Armbruster blkconf_serial(&conf->conf, &conf->serial); 8914be74634SMarkus Armbruster s->original_wce = blk_enable_write_cache(conf->conf.blk); 8922a30307fSMarkus Armbruster blkconf_geometry(&conf->conf, NULL, 65535, 255, 255, &err); 8935ff5efb4SFam Zheng if (err) { 8945ff5efb4SFam Zheng error_propagate(errp, err); 89575884afdSAndreas Färber return; 8966e790746SPaolo Bonzini } 8970eb28a42SEkaterina Tumanova blkconf_blocksizes(&conf->conf); 8986e790746SPaolo Bonzini 8996e790746SPaolo Bonzini virtio_init(vdev, "virtio-blk", VIRTIO_ID_BLOCK, 9006e790746SPaolo Bonzini sizeof(struct virtio_blk_config)); 9016e790746SPaolo Bonzini 9024be74634SMarkus Armbruster s->blk = conf->conf.blk; 9036e790746SPaolo Bonzini s->rq = NULL; 9042a30307fSMarkus Armbruster s->sector_mask = (s->conf.conf.logical_block_size / BDRV_SECTOR_SIZE) - 1; 9056e790746SPaolo Bonzini 90684419863SStefan Hajnoczi conf->num_queues = 1; 9076e790746SPaolo Bonzini s->vq = virtio_add_queue(vdev, 128, virtio_blk_handle_output); 9082a30307fSMarkus Armbruster virtio_blk_data_plane_create(vdev, conf, &s->dataplane, &err); 9093ffeeef7SAndreas Färber if (err != NULL) { 91075884afdSAndreas Färber error_propagate(errp, err); 9116a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 91275884afdSAndreas Färber return; 9136e790746SPaolo Bonzini } 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 9296e790746SPaolo Bonzini virtio_blk_data_plane_destroy(s->dataplane); 9306e790746SPaolo Bonzini s->dataplane = NULL; 9316e790746SPaolo Bonzini qemu_del_vm_change_state_handler(s->change); 932306ec6c3SAndreas Färber unregister_savevm(dev, "virtio-blk", s); 9334be74634SMarkus Armbruster blockdev_mark_auto_del(s->blk); 9346a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 9356e790746SPaolo Bonzini } 9366e790746SPaolo Bonzini 937467b3f33SStefan Hajnoczi static void virtio_blk_instance_init(Object *obj) 938467b3f33SStefan Hajnoczi { 939467b3f33SStefan Hajnoczi VirtIOBlock *s = VIRTIO_BLK(obj); 940467b3f33SStefan Hajnoczi 941467b3f33SStefan Hajnoczi object_property_add_link(obj, "iothread", TYPE_IOTHREAD, 9422a30307fSMarkus Armbruster (Object **)&s->conf.iothread, 943467b3f33SStefan Hajnoczi qdev_prop_allow_set_link_before_realize, 944467b3f33SStefan Hajnoczi OBJ_PROP_LINK_UNREF_ON_RELEASE, NULL); 9452a30307fSMarkus Armbruster device_add_bootindex_property(obj, &s->conf.conf.bootindex, 9463342ec32SGonglei "bootindex", "/disk@0,0", 9473342ec32SGonglei DEVICE(obj), NULL); 948467b3f33SStefan Hajnoczi } 949467b3f33SStefan Hajnoczi 9506e790746SPaolo Bonzini static Property virtio_blk_properties[] = { 9512a30307fSMarkus Armbruster DEFINE_BLOCK_PROPERTIES(VirtIOBlock, conf.conf), 9522a30307fSMarkus Armbruster DEFINE_BLOCK_CHS_PROPERTIES(VirtIOBlock, conf.conf), 9532a30307fSMarkus Armbruster DEFINE_PROP_STRING("serial", VirtIOBlock, conf.serial), 9542a30307fSMarkus Armbruster DEFINE_PROP_BIT("config-wce", VirtIOBlock, conf.config_wce, 0, true), 95532a877e4SStefan Hajnoczi #ifdef __linux__ 956ed65fd1aSCornelia Huck DEFINE_PROP_BIT("scsi", VirtIOBlock, conf.scsi, 0, false), 95732a877e4SStefan Hajnoczi #endif 958c99495acSPeter Lieven DEFINE_PROP_BIT("request-merging", VirtIOBlock, conf.request_merging, 0, 959c99495acSPeter Lieven true), 9606e790746SPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 9616e790746SPaolo Bonzini }; 9626e790746SPaolo Bonzini 9636e790746SPaolo Bonzini static void virtio_blk_class_init(ObjectClass *klass, void *data) 9646e790746SPaolo Bonzini { 9656e790746SPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 9666e790746SPaolo Bonzini VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); 96775884afdSAndreas Färber 9686e790746SPaolo Bonzini dc->props = virtio_blk_properties; 969125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 97075884afdSAndreas Färber vdc->realize = virtio_blk_device_realize; 971306ec6c3SAndreas Färber vdc->unrealize = virtio_blk_device_unrealize; 9726e790746SPaolo Bonzini vdc->get_config = virtio_blk_update_config; 9736e790746SPaolo Bonzini vdc->set_config = virtio_blk_set_config; 9746e790746SPaolo Bonzini vdc->get_features = virtio_blk_get_features; 9756e790746SPaolo Bonzini vdc->set_status = virtio_blk_set_status; 9766e790746SPaolo Bonzini vdc->reset = virtio_blk_reset; 977b2b295a7SGreg Kurz vdc->save = virtio_blk_save_device; 978b2b295a7SGreg Kurz vdc->load = virtio_blk_load_device; 9796e790746SPaolo Bonzini } 9806e790746SPaolo Bonzini 9816e790746SPaolo Bonzini static const TypeInfo virtio_device_info = { 9826e790746SPaolo Bonzini .name = TYPE_VIRTIO_BLK, 9836e790746SPaolo Bonzini .parent = TYPE_VIRTIO_DEVICE, 9846e790746SPaolo Bonzini .instance_size = sizeof(VirtIOBlock), 985467b3f33SStefan Hajnoczi .instance_init = virtio_blk_instance_init, 9866e790746SPaolo Bonzini .class_init = virtio_blk_class_init, 9876e790746SPaolo Bonzini }; 9886e790746SPaolo Bonzini 9896e790746SPaolo Bonzini static void virtio_register_types(void) 9906e790746SPaolo Bonzini { 9916e790746SPaolo Bonzini type_register_static(&virtio_device_info); 9926e790746SPaolo Bonzini } 9936e790746SPaolo Bonzini 9946e790746SPaolo Bonzini type_init(virtio_register_types) 995