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 14*80c71a24SPeter Maydell #include "qemu/osdep.h" 156e790746SPaolo Bonzini #include "qemu-common.h" 16827805a2SFam Zheng #include "qemu/iov.h" 176e790746SPaolo Bonzini #include "qemu/error-report.h" 186e790746SPaolo Bonzini #include "trace.h" 196e790746SPaolo Bonzini #include "hw/block/block.h" 204be74634SMarkus Armbruster #include "sysemu/block-backend.h" 216e790746SPaolo Bonzini #include "sysemu/blockdev.h" 226e790746SPaolo Bonzini #include "hw/virtio/virtio-blk.h" 236e790746SPaolo Bonzini #include "dataplane/virtio-blk.h" 2484db52d0SStefan Hajnoczi #include "migration/migration.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 32f897bf75SStefan Hajnoczi VirtIOBlockReq *virtio_blk_alloc_request(VirtIOBlock *s) 33671ec3f0SFam Zheng { 34c84b3192SPaolo Bonzini VirtIOBlockReq *req = g_new(VirtIOBlockReq, 1); 35671ec3f0SFam Zheng req->dev = s; 36869d66afSStefan Hajnoczi req->qiov.size = 0; 372a6cdd6dSPaolo Bonzini req->in_len = 0; 38869d66afSStefan Hajnoczi req->next = NULL; 3995f7142aSPeter Lieven req->mr_next = NULL; 40671ec3f0SFam Zheng return req; 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 50bf4bd461SFam Zheng static void virtio_blk_complete_request(VirtIOBlockReq *req, 51bf4bd461SFam Zheng unsigned char status) 526e790746SPaolo Bonzini { 536e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 546e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 556e790746SPaolo Bonzini 566e790746SPaolo Bonzini trace_virtio_blk_req_complete(req, status); 576e790746SPaolo Bonzini 586e790746SPaolo Bonzini stb_p(&req->in->status, status); 592a6cdd6dSPaolo Bonzini virtqueue_push(s->vq, &req->elem, req->in_len); 606e790746SPaolo Bonzini virtio_notify(vdev, s->vq); 616e790746SPaolo Bonzini } 626e790746SPaolo Bonzini 63bf4bd461SFam Zheng static void virtio_blk_req_complete(VirtIOBlockReq *req, unsigned char status) 64bf4bd461SFam Zheng { 65bf4bd461SFam Zheng req->dev->complete_request(req, status); 66bf4bd461SFam Zheng } 67bf4bd461SFam Zheng 686e790746SPaolo Bonzini static int virtio_blk_handle_rw_error(VirtIOBlockReq *req, int error, 696e790746SPaolo Bonzini bool is_read) 706e790746SPaolo Bonzini { 714be74634SMarkus Armbruster BlockErrorAction action = blk_get_error_action(req->dev->blk, 724be74634SMarkus Armbruster is_read, error); 736e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 746e790746SPaolo Bonzini 75a589569fSWenchao Xia if (action == BLOCK_ERROR_ACTION_STOP) { 76466138dcSFam Zheng /* Break the link as the next request is going to be parsed from the 77466138dcSFam Zheng * ring again. Otherwise we may end up doing a double completion! */ 78466138dcSFam Zheng req->mr_next = NULL; 796e790746SPaolo Bonzini req->next = s->rq; 806e790746SPaolo Bonzini s->rq = req; 81a589569fSWenchao Xia } else if (action == BLOCK_ERROR_ACTION_REPORT) { 826e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 8301762e03SAlberto Garcia block_acct_failed(blk_get_stats(s->blk), &req->acct); 84671ec3f0SFam Zheng virtio_blk_free_request(req); 856e790746SPaolo Bonzini } 866e790746SPaolo Bonzini 874be74634SMarkus Armbruster blk_error_action(s->blk, action, is_read, error); 88a589569fSWenchao Xia return action != BLOCK_ERROR_ACTION_IGNORE; 896e790746SPaolo Bonzini } 906e790746SPaolo Bonzini 916e790746SPaolo Bonzini static void virtio_blk_rw_complete(void *opaque, int ret) 926e790746SPaolo Bonzini { 9395f7142aSPeter Lieven VirtIOBlockReq *next = opaque; 946e790746SPaolo Bonzini 9595f7142aSPeter Lieven while (next) { 9695f7142aSPeter Lieven VirtIOBlockReq *req = next; 9795f7142aSPeter Lieven next = req->mr_next; 986e790746SPaolo Bonzini trace_virtio_blk_rw_complete(req, ret); 996e790746SPaolo Bonzini 10095f7142aSPeter Lieven if (req->qiov.nalloc != -1) { 10195f7142aSPeter Lieven /* If nalloc is != 1 req->qiov is a local copy of the original 10295f7142aSPeter Lieven * external iovec. It was allocated in submit_merged_requests 10395f7142aSPeter Lieven * to be able to merge requests. */ 10495f7142aSPeter Lieven qemu_iovec_destroy(&req->qiov); 10595f7142aSPeter Lieven } 10695f7142aSPeter Lieven 1076e790746SPaolo Bonzini if (ret) { 108783d1897SRusty Russell int p = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); 109783d1897SRusty Russell bool is_read = !(p & VIRTIO_BLK_T_OUT); 1102a6cdd6dSPaolo Bonzini /* Note that memory may be dirtied on read failure. If the 1112a6cdd6dSPaolo Bonzini * virtio request is not completed here, as is the case for 1122a6cdd6dSPaolo Bonzini * BLOCK_ERROR_ACTION_STOP, the memory may not be copied 1132a6cdd6dSPaolo Bonzini * correctly during live migration. While this is ugly, 1142a6cdd6dSPaolo Bonzini * it is acceptable because the device is free to write to 1152a6cdd6dSPaolo Bonzini * the memory until the request is completed (which will 1162a6cdd6dSPaolo Bonzini * happen on the other side of the migration). 1172a6cdd6dSPaolo Bonzini */ 11895f7142aSPeter Lieven if (virtio_blk_handle_rw_error(req, -ret, is_read)) { 11995f7142aSPeter Lieven continue; 12095f7142aSPeter Lieven } 1216e790746SPaolo Bonzini } 1226e790746SPaolo Bonzini 1236e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1244be74634SMarkus Armbruster block_acct_done(blk_get_stats(req->dev->blk), &req->acct); 125671ec3f0SFam Zheng virtio_blk_free_request(req); 1266e790746SPaolo Bonzini } 12795f7142aSPeter Lieven } 1286e790746SPaolo Bonzini 1296e790746SPaolo Bonzini static void virtio_blk_flush_complete(void *opaque, int ret) 1306e790746SPaolo Bonzini { 1316e790746SPaolo Bonzini VirtIOBlockReq *req = opaque; 1326e790746SPaolo Bonzini 1336e790746SPaolo Bonzini if (ret) { 1346e790746SPaolo Bonzini if (virtio_blk_handle_rw_error(req, -ret, 0)) { 1356e790746SPaolo Bonzini return; 1366e790746SPaolo Bonzini } 1376e790746SPaolo Bonzini } 1386e790746SPaolo Bonzini 1396e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1404be74634SMarkus Armbruster block_acct_done(blk_get_stats(req->dev->blk), &req->acct); 141671ec3f0SFam Zheng virtio_blk_free_request(req); 1426e790746SPaolo Bonzini } 1436e790746SPaolo Bonzini 1441dc936aaSFam Zheng #ifdef __linux__ 1451dc936aaSFam Zheng 1461dc936aaSFam Zheng typedef struct { 1471dc936aaSFam Zheng VirtIOBlockReq *req; 1481dc936aaSFam Zheng struct sg_io_hdr hdr; 1491dc936aaSFam Zheng } VirtIOBlockIoctlReq; 1501dc936aaSFam Zheng 1511dc936aaSFam Zheng static void virtio_blk_ioctl_complete(void *opaque, int status) 1521dc936aaSFam Zheng { 1531dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req = opaque; 1541dc936aaSFam Zheng VirtIOBlockReq *req = ioctl_req->req; 1551dc936aaSFam Zheng VirtIODevice *vdev = VIRTIO_DEVICE(req->dev); 1561dc936aaSFam Zheng struct virtio_scsi_inhdr *scsi; 1571dc936aaSFam Zheng struct sg_io_hdr *hdr; 1581dc936aaSFam Zheng 1591dc936aaSFam Zheng scsi = (void *)req->elem.in_sg[req->elem.in_num - 2].iov_base; 1601dc936aaSFam Zheng 1611dc936aaSFam Zheng if (status) { 1621dc936aaSFam Zheng status = VIRTIO_BLK_S_UNSUPP; 1631dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 255); 1641dc936aaSFam Zheng goto out; 1651dc936aaSFam Zheng } 1661dc936aaSFam Zheng 1671dc936aaSFam Zheng hdr = &ioctl_req->hdr; 1681dc936aaSFam Zheng /* 1691dc936aaSFam Zheng * From SCSI-Generic-HOWTO: "Some lower level drivers (e.g. ide-scsi) 1701dc936aaSFam Zheng * clear the masked_status field [hence status gets cleared too, see 1711dc936aaSFam Zheng * block/scsi_ioctl.c] even when a CHECK_CONDITION or COMMAND_TERMINATED 1721dc936aaSFam Zheng * status has occurred. However they do set DRIVER_SENSE in driver_status 1731dc936aaSFam Zheng * field. Also a (sb_len_wr > 0) indicates there is a sense buffer. 1741dc936aaSFam Zheng */ 1751dc936aaSFam Zheng if (hdr->status == 0 && hdr->sb_len_wr > 0) { 1761dc936aaSFam Zheng hdr->status = CHECK_CONDITION; 1771dc936aaSFam Zheng } 1781dc936aaSFam Zheng 1791dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 1801dc936aaSFam Zheng hdr->status | (hdr->msg_status << 8) | 1811dc936aaSFam Zheng (hdr->host_status << 16) | (hdr->driver_status << 24)); 1821dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->residual, hdr->resid); 1831dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->sense_len, hdr->sb_len_wr); 1841dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->data_len, hdr->dxfer_len); 1851dc936aaSFam Zheng 1861dc936aaSFam Zheng out: 1871dc936aaSFam Zheng virtio_blk_req_complete(req, status); 1881dc936aaSFam Zheng virtio_blk_free_request(req); 1891dc936aaSFam Zheng g_free(ioctl_req); 1901dc936aaSFam Zheng } 1911dc936aaSFam Zheng 1921dc936aaSFam Zheng #endif 1931dc936aaSFam Zheng 1946e790746SPaolo Bonzini static VirtIOBlockReq *virtio_blk_get_request(VirtIOBlock *s) 1956e790746SPaolo Bonzini { 1966e790746SPaolo Bonzini VirtIOBlockReq *req = virtio_blk_alloc_request(s); 1976e790746SPaolo Bonzini 198f897bf75SStefan Hajnoczi if (!virtqueue_pop(s->vq, &req->elem)) { 199671ec3f0SFam Zheng virtio_blk_free_request(req); 2006e790746SPaolo Bonzini return NULL; 2016e790746SPaolo Bonzini } 2026e790746SPaolo Bonzini 2036e790746SPaolo Bonzini return req; 2046e790746SPaolo Bonzini } 2056e790746SPaolo Bonzini 20675344fa4SFam Zheng static int virtio_blk_handle_scsi_req(VirtIOBlockReq *req) 2076e790746SPaolo Bonzini { 2086e790746SPaolo Bonzini int status = VIRTIO_BLK_S_OK; 2095a05cbeeSFam Zheng struct virtio_scsi_inhdr *scsi = NULL; 21075344fa4SFam Zheng VirtIODevice *vdev = VIRTIO_DEVICE(req->dev); 21175344fa4SFam Zheng VirtQueueElement *elem = &req->elem; 21275344fa4SFam Zheng VirtIOBlock *blk = req->dev; 213783d1897SRusty Russell 2145a05cbeeSFam Zheng #ifdef __linux__ 2155a05cbeeSFam Zheng int i; 2161dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req; 217a209f461SFam Zheng BlockAIOCB *acb; 2185a05cbeeSFam Zheng #endif 2196e790746SPaolo Bonzini 2206e790746SPaolo Bonzini /* 2216e790746SPaolo Bonzini * We require at least one output segment each for the virtio_blk_outhdr 2226e790746SPaolo Bonzini * and the SCSI command block. 2236e790746SPaolo Bonzini * 2246e790746SPaolo Bonzini * We also at least require the virtio_blk_inhdr, the virtio_scsi_inhdr 2256e790746SPaolo Bonzini * and the sense buffer pointer in the input segments. 2266e790746SPaolo Bonzini */ 2275a05cbeeSFam Zheng if (elem->out_num < 2 || elem->in_num < 3) { 2285a05cbeeSFam Zheng status = VIRTIO_BLK_S_IOERR; 2295a05cbeeSFam Zheng goto fail; 2306e790746SPaolo Bonzini } 2316e790746SPaolo Bonzini 2326e790746SPaolo Bonzini /* 2336e790746SPaolo Bonzini * The scsi inhdr is placed in the second-to-last input segment, just 2346e790746SPaolo Bonzini * before the regular inhdr. 2356e790746SPaolo Bonzini */ 2365a05cbeeSFam Zheng scsi = (void *)elem->in_sg[elem->in_num - 2].iov_base; 2376e790746SPaolo Bonzini 2382a30307fSMarkus Armbruster if (!blk->conf.scsi) { 2396e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2406e790746SPaolo Bonzini goto fail; 2416e790746SPaolo Bonzini } 2426e790746SPaolo Bonzini 2436e790746SPaolo Bonzini /* 2446e790746SPaolo Bonzini * No support for bidirection commands yet. 2456e790746SPaolo Bonzini */ 2465a05cbeeSFam Zheng if (elem->out_num > 2 && elem->in_num > 3) { 2476e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2486e790746SPaolo Bonzini goto fail; 2496e790746SPaolo Bonzini } 2506e790746SPaolo Bonzini 2516e790746SPaolo Bonzini #ifdef __linux__ 2521dc936aaSFam Zheng ioctl_req = g_new0(VirtIOBlockIoctlReq, 1); 2531dc936aaSFam Zheng ioctl_req->req = req; 2541dc936aaSFam Zheng ioctl_req->hdr.interface_id = 'S'; 2551dc936aaSFam Zheng ioctl_req->hdr.cmd_len = elem->out_sg[1].iov_len; 2561dc936aaSFam Zheng ioctl_req->hdr.cmdp = elem->out_sg[1].iov_base; 2571dc936aaSFam Zheng ioctl_req->hdr.dxfer_len = 0; 2586e790746SPaolo Bonzini 2595a05cbeeSFam Zheng if (elem->out_num > 2) { 2606e790746SPaolo Bonzini /* 2616e790746SPaolo Bonzini * If there are more than the minimally required 2 output segments 2626e790746SPaolo Bonzini * there is write payload starting from the third iovec. 2636e790746SPaolo Bonzini */ 2641dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_TO_DEV; 2651dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->out_num - 2; 2666e790746SPaolo Bonzini 2671dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 2681dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->out_sg[i + 2].iov_len; 2691dc936aaSFam Zheng } 2706e790746SPaolo Bonzini 2711dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->out_sg + 2; 2726e790746SPaolo Bonzini 2735a05cbeeSFam Zheng } else if (elem->in_num > 3) { 2746e790746SPaolo Bonzini /* 2756e790746SPaolo Bonzini * If we have more than 3 input segments the guest wants to actually 2766e790746SPaolo Bonzini * read data. 2776e790746SPaolo Bonzini */ 2781dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_FROM_DEV; 2791dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->in_num - 3; 2801dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 2811dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->in_sg[i].iov_len; 2821dc936aaSFam Zheng } 2836e790746SPaolo Bonzini 2841dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->in_sg; 2856e790746SPaolo Bonzini } else { 2866e790746SPaolo Bonzini /* 2876e790746SPaolo Bonzini * Some SCSI commands don't actually transfer any data. 2886e790746SPaolo Bonzini */ 2891dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_NONE; 2906e790746SPaolo Bonzini } 2916e790746SPaolo Bonzini 2921dc936aaSFam Zheng ioctl_req->hdr.sbp = elem->in_sg[elem->in_num - 3].iov_base; 2931dc936aaSFam Zheng ioctl_req->hdr.mx_sb_len = elem->in_sg[elem->in_num - 3].iov_len; 2946e790746SPaolo Bonzini 295a209f461SFam Zheng acb = blk_aio_ioctl(blk->blk, SG_IO, &ioctl_req->hdr, 2961dc936aaSFam Zheng virtio_blk_ioctl_complete, ioctl_req); 297a209f461SFam Zheng if (!acb) { 298a209f461SFam Zheng g_free(ioctl_req); 299a209f461SFam Zheng status = VIRTIO_BLK_S_UNSUPP; 300a209f461SFam Zheng goto fail; 301a209f461SFam Zheng } 3021dc936aaSFam Zheng return -EINPROGRESS; 3036e790746SPaolo Bonzini #else 3046e790746SPaolo Bonzini abort(); 3056e790746SPaolo Bonzini #endif 3066e790746SPaolo Bonzini 3076e790746SPaolo Bonzini fail: 3086e790746SPaolo Bonzini /* Just put anything nonzero so that the ioctl fails in the guest. */ 3095a05cbeeSFam Zheng if (scsi) { 310783d1897SRusty Russell virtio_stl_p(vdev, &scsi->errors, 255); 3115a05cbeeSFam Zheng } 3125a05cbeeSFam Zheng return status; 3135a05cbeeSFam Zheng } 3145a05cbeeSFam Zheng 3155a05cbeeSFam Zheng static void virtio_blk_handle_scsi(VirtIOBlockReq *req) 3165a05cbeeSFam Zheng { 3175a05cbeeSFam Zheng int status; 3185a05cbeeSFam Zheng 31975344fa4SFam Zheng status = virtio_blk_handle_scsi_req(req); 3201dc936aaSFam Zheng if (status != -EINPROGRESS) { 3216e790746SPaolo Bonzini virtio_blk_req_complete(req, status); 322671ec3f0SFam Zheng virtio_blk_free_request(req); 3236e790746SPaolo Bonzini } 3241dc936aaSFam Zheng } 3256e790746SPaolo Bonzini 32695f7142aSPeter Lieven static inline void submit_requests(BlockBackend *blk, MultiReqBuffer *mrb, 32795f7142aSPeter Lieven int start, int num_reqs, int niov) 3286e790746SPaolo Bonzini { 32995f7142aSPeter Lieven QEMUIOVector *qiov = &mrb->reqs[start]->qiov; 33095f7142aSPeter Lieven int64_t sector_num = mrb->reqs[start]->sector_num; 33195f7142aSPeter Lieven int nb_sectors = mrb->reqs[start]->qiov.size / BDRV_SECTOR_SIZE; 33295f7142aSPeter Lieven bool is_write = mrb->is_write; 3336e790746SPaolo Bonzini 33495f7142aSPeter Lieven if (num_reqs > 1) { 33595f7142aSPeter Lieven int i; 33695f7142aSPeter Lieven struct iovec *tmp_iov = qiov->iov; 33795f7142aSPeter Lieven int tmp_niov = qiov->niov; 33895f7142aSPeter Lieven 33995f7142aSPeter Lieven /* mrb->reqs[start]->qiov was initialized from external so we can't 34095f7142aSPeter Lieven * modifiy it here. We need to initialize it locally and then add the 34195f7142aSPeter Lieven * external iovecs. */ 34295f7142aSPeter Lieven qemu_iovec_init(qiov, niov); 34395f7142aSPeter Lieven 34495f7142aSPeter Lieven for (i = 0; i < tmp_niov; i++) { 34595f7142aSPeter Lieven qemu_iovec_add(qiov, tmp_iov[i].iov_base, tmp_iov[i].iov_len); 34695f7142aSPeter Lieven } 34795f7142aSPeter Lieven 34895f7142aSPeter Lieven for (i = start + 1; i < start + num_reqs; i++) { 34995f7142aSPeter Lieven qemu_iovec_concat(qiov, &mrb->reqs[i]->qiov, 0, 35095f7142aSPeter Lieven mrb->reqs[i]->qiov.size); 35195f7142aSPeter Lieven mrb->reqs[i - 1]->mr_next = mrb->reqs[i]; 35295f7142aSPeter Lieven nb_sectors += mrb->reqs[i]->qiov.size / BDRV_SECTOR_SIZE; 35395f7142aSPeter Lieven } 35495f7142aSPeter Lieven assert(nb_sectors == qiov->size / BDRV_SECTOR_SIZE); 35595f7142aSPeter Lieven 35695f7142aSPeter Lieven trace_virtio_blk_submit_multireq(mrb, start, num_reqs, sector_num, 35795f7142aSPeter Lieven nb_sectors, is_write); 35895f7142aSPeter Lieven block_acct_merge_done(blk_get_stats(blk), 35995f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ, 36095f7142aSPeter Lieven num_reqs - 1); 36195f7142aSPeter Lieven } 36295f7142aSPeter Lieven 36395f7142aSPeter Lieven if (is_write) { 36495f7142aSPeter Lieven blk_aio_writev(blk, sector_num, qiov, nb_sectors, 36595f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 36695f7142aSPeter Lieven } else { 36795f7142aSPeter Lieven blk_aio_readv(blk, sector_num, qiov, nb_sectors, 36895f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 36995f7142aSPeter Lieven } 37095f7142aSPeter Lieven } 37195f7142aSPeter Lieven 37295f7142aSPeter Lieven static int multireq_compare(const void *a, const void *b) 37395f7142aSPeter Lieven { 37495f7142aSPeter Lieven const VirtIOBlockReq *req1 = *(VirtIOBlockReq **)a, 37595f7142aSPeter Lieven *req2 = *(VirtIOBlockReq **)b; 37695f7142aSPeter Lieven 37795f7142aSPeter Lieven /* 37895f7142aSPeter Lieven * Note that we can't simply subtract sector_num1 from sector_num2 37995f7142aSPeter Lieven * here as that could overflow the return value. 38095f7142aSPeter Lieven */ 38195f7142aSPeter Lieven if (req1->sector_num > req2->sector_num) { 38295f7142aSPeter Lieven return 1; 38395f7142aSPeter Lieven } else if (req1->sector_num < req2->sector_num) { 38495f7142aSPeter Lieven return -1; 38595f7142aSPeter Lieven } else { 38695f7142aSPeter Lieven return 0; 38795f7142aSPeter Lieven } 38895f7142aSPeter Lieven } 38995f7142aSPeter Lieven 39095f7142aSPeter Lieven void virtio_blk_submit_multireq(BlockBackend *blk, MultiReqBuffer *mrb) 39195f7142aSPeter Lieven { 39295f7142aSPeter Lieven int i = 0, start = 0, num_reqs = 0, niov = 0, nb_sectors = 0; 39395f7142aSPeter Lieven int max_xfer_len = 0; 39495f7142aSPeter Lieven int64_t sector_num = 0; 39595f7142aSPeter Lieven 39695f7142aSPeter Lieven if (mrb->num_reqs == 1) { 39795f7142aSPeter Lieven submit_requests(blk, mrb, 0, 1, -1); 39895f7142aSPeter Lieven mrb->num_reqs = 0; 3996e790746SPaolo Bonzini return; 4006e790746SPaolo Bonzini } 4016e790746SPaolo Bonzini 40295f7142aSPeter Lieven max_xfer_len = blk_get_max_transfer_length(mrb->reqs[0]->dev->blk); 40375af1f34SPeter Lieven max_xfer_len = MIN_NON_ZERO(max_xfer_len, BDRV_REQUEST_MAX_SECTORS); 40495f7142aSPeter Lieven 40595f7142aSPeter Lieven qsort(mrb->reqs, mrb->num_reqs, sizeof(*mrb->reqs), 40695f7142aSPeter Lieven &multireq_compare); 40795f7142aSPeter Lieven 40895f7142aSPeter Lieven for (i = 0; i < mrb->num_reqs; i++) { 40995f7142aSPeter Lieven VirtIOBlockReq *req = mrb->reqs[i]; 41095f7142aSPeter Lieven if (num_reqs > 0) { 41149cffbc6SGonglei /* 41249cffbc6SGonglei * NOTE: We cannot merge the requests in below situations: 41349cffbc6SGonglei * 1. requests are not sequential 41449cffbc6SGonglei * 2. merge would exceed maximum number of IOVs 41549cffbc6SGonglei * 3. merge would exceed maximum transfer length of backend device 41649cffbc6SGonglei */ 41749cffbc6SGonglei if (sector_num + nb_sectors != req->sector_num || 418222565f6SStefan Hajnoczi niov > blk_get_max_iov(blk) - req->qiov.niov || 41949cffbc6SGonglei req->qiov.size / BDRV_SECTOR_SIZE > max_xfer_len || 42049cffbc6SGonglei nb_sectors > max_xfer_len - req->qiov.size / BDRV_SECTOR_SIZE) { 42195f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 42295f7142aSPeter Lieven num_reqs = 0; 4236e790746SPaolo Bonzini } 4246e790746SPaolo Bonzini } 4256e790746SPaolo Bonzini 42695f7142aSPeter Lieven if (num_reqs == 0) { 42795f7142aSPeter Lieven sector_num = req->sector_num; 42895f7142aSPeter Lieven nb_sectors = niov = 0; 42995f7142aSPeter Lieven start = i; 43095f7142aSPeter Lieven } 43195f7142aSPeter Lieven 43295f7142aSPeter Lieven nb_sectors += req->qiov.size / BDRV_SECTOR_SIZE; 43395f7142aSPeter Lieven niov += req->qiov.niov; 43495f7142aSPeter Lieven num_reqs++; 43595f7142aSPeter Lieven } 43695f7142aSPeter Lieven 43795f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 43895f7142aSPeter Lieven mrb->num_reqs = 0; 4396e790746SPaolo Bonzini } 4406e790746SPaolo Bonzini 4416e790746SPaolo Bonzini static void virtio_blk_handle_flush(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4426e790746SPaolo Bonzini { 4434be74634SMarkus Armbruster block_acct_start(blk_get_stats(req->dev->blk), &req->acct, 0, 4445366d0c8SBenoît Canet BLOCK_ACCT_FLUSH); 4456e790746SPaolo Bonzini 4466e790746SPaolo Bonzini /* 4476e790746SPaolo Bonzini * Make sure all outstanding writes are posted to the backing device. 4486e790746SPaolo Bonzini */ 44995f7142aSPeter Lieven if (mrb->is_write && mrb->num_reqs > 0) { 45095f7142aSPeter Lieven virtio_blk_submit_multireq(req->dev->blk, mrb); 45195f7142aSPeter Lieven } 4524be74634SMarkus Armbruster blk_aio_flush(req->dev->blk, virtio_blk_flush_complete, req); 4536e790746SPaolo Bonzini } 4546e790746SPaolo Bonzini 455d0e14376SMarkus Armbruster static bool virtio_blk_sect_range_ok(VirtIOBlock *dev, 456d0e14376SMarkus Armbruster uint64_t sector, size_t size) 457d0e14376SMarkus Armbruster { 4583c2daac0SMarkus Armbruster uint64_t nb_sectors = size >> BDRV_SECTOR_BITS; 4593c2daac0SMarkus Armbruster uint64_t total_sectors; 4603c2daac0SMarkus Armbruster 46175af1f34SPeter Lieven if (nb_sectors > BDRV_REQUEST_MAX_SECTORS) { 46295f7142aSPeter Lieven return false; 46395f7142aSPeter Lieven } 464d0e14376SMarkus Armbruster if (sector & dev->sector_mask) { 465d0e14376SMarkus Armbruster return false; 466d0e14376SMarkus Armbruster } 4672a30307fSMarkus Armbruster if (size % dev->conf.conf.logical_block_size) { 468d0e14376SMarkus Armbruster return false; 469d0e14376SMarkus Armbruster } 4704be74634SMarkus Armbruster blk_get_geometry(dev->blk, &total_sectors); 4713c2daac0SMarkus Armbruster if (sector > total_sectors || nb_sectors > total_sectors - sector) { 4723c2daac0SMarkus Armbruster return false; 4733c2daac0SMarkus Armbruster } 474d0e14376SMarkus Armbruster return true; 475d0e14376SMarkus Armbruster } 476d0e14376SMarkus Armbruster 477fee65db7SFam Zheng void virtio_blk_handle_request(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4786e790746SPaolo Bonzini { 4796e790746SPaolo Bonzini uint32_t type; 480f897bf75SStefan Hajnoczi struct iovec *in_iov = req->elem.in_sg; 481f897bf75SStefan Hajnoczi struct iovec *iov = req->elem.out_sg; 482f897bf75SStefan Hajnoczi unsigned in_num = req->elem.in_num; 483f897bf75SStefan Hajnoczi unsigned out_num = req->elem.out_num; 4846e790746SPaolo Bonzini 485f897bf75SStefan Hajnoczi if (req->elem.out_num < 1 || req->elem.in_num < 1) { 4866e790746SPaolo Bonzini error_report("virtio-blk missing headers"); 4876e790746SPaolo Bonzini exit(1); 4886e790746SPaolo Bonzini } 4896e790746SPaolo Bonzini 490827805a2SFam Zheng if (unlikely(iov_to_buf(iov, out_num, 0, &req->out, 491827805a2SFam Zheng sizeof(req->out)) != sizeof(req->out))) { 492827805a2SFam Zheng error_report("virtio-blk request outhdr too short"); 493827805a2SFam Zheng exit(1); 494827805a2SFam Zheng } 495ee17e848SFam Zheng 496827805a2SFam Zheng iov_discard_front(&iov, &out_num, sizeof(req->out)); 497ee17e848SFam Zheng 49812048545SGonglei if (in_iov[in_num - 1].iov_len < sizeof(struct virtio_blk_inhdr)) { 499ee17e848SFam Zheng error_report("virtio-blk request inhdr too short"); 500ee17e848SFam Zheng exit(1); 501ee17e848SFam Zheng } 502ee17e848SFam Zheng 5032a6cdd6dSPaolo Bonzini /* We always touch the last byte, so just see how big in_iov is. */ 5042a6cdd6dSPaolo Bonzini req->in_len = iov_size(in_iov, in_num); 505ee17e848SFam Zheng req->in = (void *)in_iov[in_num - 1].iov_base 506ee17e848SFam Zheng + in_iov[in_num - 1].iov_len 507ee17e848SFam Zheng - sizeof(struct virtio_blk_inhdr); 508ee17e848SFam Zheng iov_discard_back(in_iov, &in_num, sizeof(struct virtio_blk_inhdr)); 5096e790746SPaolo Bonzini 510783d1897SRusty Russell type = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); 5116e790746SPaolo Bonzini 51295f7142aSPeter Lieven /* VIRTIO_BLK_T_OUT defines the command direction. VIRTIO_BLK_T_BARRIER 513631b22eaSStefan Weil * is an optional flag. Although a guest should not send this flag if 51495f7142aSPeter Lieven * not negotiated we ignored it in the past. So keep ignoring it. */ 51595f7142aSPeter Lieven switch (type & ~(VIRTIO_BLK_T_OUT | VIRTIO_BLK_T_BARRIER)) { 51695f7142aSPeter Lieven case VIRTIO_BLK_T_IN: 51795f7142aSPeter Lieven { 51895f7142aSPeter Lieven bool is_write = type & VIRTIO_BLK_T_OUT; 51995f7142aSPeter Lieven req->sector_num = virtio_ldq_p(VIRTIO_DEVICE(req->dev), 52095f7142aSPeter Lieven &req->out.sector); 52195f7142aSPeter Lieven 52295f7142aSPeter Lieven if (is_write) { 52395f7142aSPeter Lieven qemu_iovec_init_external(&req->qiov, iov, out_num); 52495f7142aSPeter Lieven trace_virtio_blk_handle_write(req, req->sector_num, 52595f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 52695f7142aSPeter Lieven } else { 52795f7142aSPeter Lieven qemu_iovec_init_external(&req->qiov, in_iov, in_num); 52895f7142aSPeter Lieven trace_virtio_blk_handle_read(req, req->sector_num, 52995f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 53095f7142aSPeter Lieven } 53195f7142aSPeter Lieven 53295f7142aSPeter Lieven if (!virtio_blk_sect_range_ok(req->dev, req->sector_num, 53395f7142aSPeter Lieven req->qiov.size)) { 53495f7142aSPeter Lieven virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 53501762e03SAlberto Garcia block_acct_invalid(blk_get_stats(req->dev->blk), 53601762e03SAlberto Garcia is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 53795f7142aSPeter Lieven virtio_blk_free_request(req); 53895f7142aSPeter Lieven return; 53995f7142aSPeter Lieven } 54095f7142aSPeter Lieven 54195f7142aSPeter Lieven block_acct_start(blk_get_stats(req->dev->blk), 54295f7142aSPeter Lieven &req->acct, req->qiov.size, 54395f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 54495f7142aSPeter Lieven 54595f7142aSPeter Lieven /* merge would exceed maximum number of requests or IO direction 54695f7142aSPeter Lieven * changes */ 54795f7142aSPeter Lieven if (mrb->num_reqs > 0 && (mrb->num_reqs == VIRTIO_BLK_MAX_MERGE_REQS || 548c99495acSPeter Lieven is_write != mrb->is_write || 549c99495acSPeter Lieven !req->dev->conf.request_merging)) { 55095f7142aSPeter Lieven virtio_blk_submit_multireq(req->dev->blk, mrb); 55195f7142aSPeter Lieven } 55295f7142aSPeter Lieven 55395f7142aSPeter Lieven assert(mrb->num_reqs < VIRTIO_BLK_MAX_MERGE_REQS); 55495f7142aSPeter Lieven mrb->reqs[mrb->num_reqs++] = req; 55595f7142aSPeter Lieven mrb->is_write = is_write; 55695f7142aSPeter Lieven break; 55795f7142aSPeter Lieven } 55895f7142aSPeter Lieven case VIRTIO_BLK_T_FLUSH: 5596e790746SPaolo Bonzini virtio_blk_handle_flush(req, mrb); 56095f7142aSPeter Lieven break; 56195f7142aSPeter Lieven case VIRTIO_BLK_T_SCSI_CMD: 5626e790746SPaolo Bonzini virtio_blk_handle_scsi(req); 56395f7142aSPeter Lieven break; 56495f7142aSPeter Lieven case VIRTIO_BLK_T_GET_ID: 56595f7142aSPeter Lieven { 5666e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 5676e790746SPaolo Bonzini 5686e790746SPaolo Bonzini /* 5696e790746SPaolo Bonzini * NB: per existing s/n string convention the string is 5706e790746SPaolo Bonzini * terminated by '\0' only when shorter than buffer. 5716e790746SPaolo Bonzini */ 5722a30307fSMarkus Armbruster const char *serial = s->conf.serial ? s->conf.serial : ""; 573a83ceea8SMarc Marí size_t size = MIN(strlen(serial) + 1, 574a83ceea8SMarc Marí MIN(iov_size(in_iov, in_num), 575a83ceea8SMarc Marí VIRTIO_BLK_ID_BYTES)); 576a83ceea8SMarc Marí iov_from_buf(in_iov, in_num, 0, serial, size); 5776e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 578671ec3f0SFam Zheng virtio_blk_free_request(req); 57995f7142aSPeter Lieven break; 58095f7142aSPeter Lieven } 58195f7142aSPeter Lieven default: 5826e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 583671ec3f0SFam Zheng virtio_blk_free_request(req); 5846e790746SPaolo Bonzini } 5856e790746SPaolo Bonzini } 5866e790746SPaolo Bonzini 5876e790746SPaolo Bonzini static void virtio_blk_handle_output(VirtIODevice *vdev, VirtQueue *vq) 5886e790746SPaolo Bonzini { 5896e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 5906e790746SPaolo Bonzini VirtIOBlockReq *req; 59195f7142aSPeter Lieven MultiReqBuffer mrb = {}; 5926e790746SPaolo Bonzini 5936e790746SPaolo Bonzini /* Some guests kick before setting VIRTIO_CONFIG_S_DRIVER_OK so start 5946e790746SPaolo Bonzini * dataplane here instead of waiting for .set_status(). 5956e790746SPaolo Bonzini */ 5966e790746SPaolo Bonzini if (s->dataplane) { 5976e790746SPaolo Bonzini virtio_blk_data_plane_start(s->dataplane); 5986e790746SPaolo Bonzini return; 5996e790746SPaolo Bonzini } 6006e790746SPaolo Bonzini 601fc73548eSStefan Hajnoczi blk_io_plug(s->blk); 602fc73548eSStefan Hajnoczi 6036e790746SPaolo Bonzini while ((req = virtio_blk_get_request(s))) { 6046e790746SPaolo Bonzini virtio_blk_handle_request(req, &mrb); 6056e790746SPaolo Bonzini } 6066e790746SPaolo Bonzini 60795f7142aSPeter Lieven if (mrb.num_reqs) { 60895f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 60995f7142aSPeter Lieven } 610fc73548eSStefan Hajnoczi 611fc73548eSStefan Hajnoczi blk_io_unplug(s->blk); 6126e790746SPaolo Bonzini } 6136e790746SPaolo Bonzini 6146e790746SPaolo Bonzini static void virtio_blk_dma_restart_bh(void *opaque) 6156e790746SPaolo Bonzini { 6166e790746SPaolo Bonzini VirtIOBlock *s = opaque; 6176e790746SPaolo Bonzini VirtIOBlockReq *req = s->rq; 61895f7142aSPeter Lieven MultiReqBuffer mrb = {}; 6196e790746SPaolo Bonzini 6206e790746SPaolo Bonzini qemu_bh_delete(s->bh); 6216e790746SPaolo Bonzini s->bh = NULL; 6226e790746SPaolo Bonzini 6236e790746SPaolo Bonzini s->rq = NULL; 6246e790746SPaolo Bonzini 6256e790746SPaolo Bonzini while (req) { 6261bdb176aSzhanghailiang VirtIOBlockReq *next = req->next; 6276e790746SPaolo Bonzini virtio_blk_handle_request(req, &mrb); 6281bdb176aSzhanghailiang req = next; 6296e790746SPaolo Bonzini } 6306e790746SPaolo Bonzini 63195f7142aSPeter Lieven if (mrb.num_reqs) { 63295f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 63395f7142aSPeter Lieven } 6346e790746SPaolo Bonzini } 6356e790746SPaolo Bonzini 6366e790746SPaolo Bonzini static void virtio_blk_dma_restart_cb(void *opaque, int running, 6376e790746SPaolo Bonzini RunState state) 6386e790746SPaolo Bonzini { 6396e790746SPaolo Bonzini VirtIOBlock *s = opaque; 6406e790746SPaolo Bonzini 6416e790746SPaolo Bonzini if (!running) { 6426e790746SPaolo Bonzini return; 6436e790746SPaolo Bonzini } 6446e790746SPaolo Bonzini 6456e790746SPaolo Bonzini if (!s->bh) { 6464be74634SMarkus Armbruster s->bh = aio_bh_new(blk_get_aio_context(s->conf.conf.blk), 6474407c1c5SFam Zheng virtio_blk_dma_restart_bh, s); 6486e790746SPaolo Bonzini qemu_bh_schedule(s->bh); 6496e790746SPaolo Bonzini } 6506e790746SPaolo Bonzini } 6516e790746SPaolo Bonzini 6526e790746SPaolo Bonzini static void virtio_blk_reset(VirtIODevice *vdev) 6536e790746SPaolo Bonzini { 6546e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 6556e40b3bfSAlexander Yarygin AioContext *ctx; 6566e790746SPaolo Bonzini 6576e790746SPaolo Bonzini /* 6586e790746SPaolo Bonzini * This should cancel pending requests, but can't do nicely until there 6596e790746SPaolo Bonzini * are per-device request lists. 6606e790746SPaolo Bonzini */ 6616e40b3bfSAlexander Yarygin ctx = blk_get_aio_context(s->blk); 6626e40b3bfSAlexander Yarygin aio_context_acquire(ctx); 6636e40b3bfSAlexander Yarygin blk_drain(s->blk); 6646e40b3bfSAlexander Yarygin 6656e40b3bfSAlexander Yarygin if (s->dataplane) { 6666e40b3bfSAlexander Yarygin virtio_blk_data_plane_stop(s->dataplane); 6676e40b3bfSAlexander Yarygin } 6686e40b3bfSAlexander Yarygin aio_context_release(ctx); 6696e40b3bfSAlexander Yarygin 6704be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, s->original_wce); 6716e790746SPaolo Bonzini } 6726e790746SPaolo Bonzini 6736e790746SPaolo Bonzini /* coalesce internal state, copy to pci i/o region 0 6746e790746SPaolo Bonzini */ 6756e790746SPaolo Bonzini static void virtio_blk_update_config(VirtIODevice *vdev, uint8_t *config) 6766e790746SPaolo Bonzini { 6776e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 6782a30307fSMarkus Armbruster BlockConf *conf = &s->conf.conf; 6796e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 6806e790746SPaolo Bonzini uint64_t capacity; 681f7516731SMarkus Armbruster int blk_size = conf->logical_block_size; 6826e790746SPaolo Bonzini 6834be74634SMarkus Armbruster blk_get_geometry(s->blk, &capacity); 6846e790746SPaolo Bonzini memset(&blkcfg, 0, sizeof(blkcfg)); 685783d1897SRusty Russell virtio_stq_p(vdev, &blkcfg.capacity, capacity); 686783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.seg_max, 128 - 2); 687907eb3e5SMichael S. Tsirkin virtio_stw_p(vdev, &blkcfg.geometry.cylinders, conf->cyls); 688783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.blk_size, blk_size); 689f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.min_io_size, conf->min_io_size / blk_size); 690f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.opt_io_size, conf->opt_io_size / blk_size); 691907eb3e5SMichael S. Tsirkin blkcfg.geometry.heads = conf->heads; 6926e790746SPaolo Bonzini /* 6936e790746SPaolo Bonzini * We must ensure that the block device capacity is a multiple of 694e03ba136SPeter Maydell * the logical block size. If that is not the case, let's use 6956e790746SPaolo Bonzini * sector_mask to adopt the geometry to have a correct picture. 6966e790746SPaolo Bonzini * For those devices where the capacity is ok for the given geometry 697e03ba136SPeter Maydell * we don't touch the sector value of the geometry, since some devices 6986e790746SPaolo Bonzini * (like s390 dasd) need a specific value. Here the capacity is already 6996e790746SPaolo Bonzini * cyls*heads*secs*blk_size and the sector value is not block size 7006e790746SPaolo Bonzini * divided by 512 - instead it is the amount of blk_size blocks 7016e790746SPaolo Bonzini * per track (cylinder). 7026e790746SPaolo Bonzini */ 7034be74634SMarkus Armbruster if (blk_getlength(s->blk) / conf->heads / conf->secs % blk_size) { 704907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs & ~s->sector_mask; 7056e790746SPaolo Bonzini } else { 706907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs; 7076e790746SPaolo Bonzini } 7086e790746SPaolo Bonzini blkcfg.size_max = 0; 709f7516731SMarkus Armbruster blkcfg.physical_block_exp = get_physical_block_exp(conf); 7106e790746SPaolo Bonzini blkcfg.alignment_offset = 0; 7114be74634SMarkus Armbruster blkcfg.wce = blk_enable_write_cache(s->blk); 7126e790746SPaolo Bonzini memcpy(config, &blkcfg, sizeof(struct virtio_blk_config)); 7136e790746SPaolo Bonzini } 7146e790746SPaolo Bonzini 7156e790746SPaolo Bonzini static void virtio_blk_set_config(VirtIODevice *vdev, const uint8_t *config) 7166e790746SPaolo Bonzini { 7176e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7186e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 7196e790746SPaolo Bonzini 7206e790746SPaolo Bonzini memcpy(&blkcfg, config, sizeof(blkcfg)); 7216d7e73d6SFam Zheng 7224be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 7234be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, blkcfg.wce != 0); 7244be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 7256e790746SPaolo Bonzini } 7266e790746SPaolo Bonzini 7279d5b731dSJason Wang static uint64_t virtio_blk_get_features(VirtIODevice *vdev, uint64_t features, 7289d5b731dSJason Wang Error **errp) 7296e790746SPaolo Bonzini { 7306e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7316e790746SPaolo Bonzini 7320cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_SEG_MAX); 7330cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_GEOMETRY); 7340cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_TOPOLOGY); 7350cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_BLK_SIZE); 73695129d6fSCornelia Huck if (virtio_has_feature(features, VIRTIO_F_VERSION_1)) { 737efb8206cSJason Wang if (s->conf.scsi) { 738efb8206cSJason Wang error_setg(errp, "Please set scsi=off for virtio-blk devices in order to use virtio 1.0"); 739efb8206cSJason Wang return 0; 740efb8206cSJason Wang } 741efb8206cSJason Wang } else { 742c9b11f97SJason Wang virtio_clear_feature(&features, VIRTIO_F_ANY_LAYOUT); 743efb8206cSJason Wang virtio_add_feature(&features, VIRTIO_BLK_F_SCSI); 744efb8206cSJason Wang } 7456e790746SPaolo Bonzini 7462a30307fSMarkus Armbruster if (s->conf.config_wce) { 7470cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_CONFIG_WCE); 7486e790746SPaolo Bonzini } 7494be74634SMarkus Armbruster if (blk_enable_write_cache(s->blk)) { 7500cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_WCE); 7514be74634SMarkus Armbruster } 7524be74634SMarkus Armbruster if (blk_is_read_only(s->blk)) { 7530cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_RO); 7544be74634SMarkus Armbruster } 7556e790746SPaolo Bonzini 7566e790746SPaolo Bonzini return features; 7576e790746SPaolo Bonzini } 7586e790746SPaolo Bonzini 7596e790746SPaolo Bonzini static void virtio_blk_set_status(VirtIODevice *vdev, uint8_t status) 7606e790746SPaolo Bonzini { 7616e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 7626e790746SPaolo Bonzini 7636e790746SPaolo Bonzini if (s->dataplane && !(status & (VIRTIO_CONFIG_S_DRIVER | 7646e790746SPaolo Bonzini VIRTIO_CONFIG_S_DRIVER_OK))) { 7656e790746SPaolo Bonzini virtio_blk_data_plane_stop(s->dataplane); 7666e790746SPaolo Bonzini } 7676e790746SPaolo Bonzini 7686e790746SPaolo Bonzini if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { 7696e790746SPaolo Bonzini return; 7706e790746SPaolo Bonzini } 7716e790746SPaolo Bonzini 772ef5bc962SPaolo Bonzini /* A guest that supports VIRTIO_BLK_F_CONFIG_WCE must be able to send 773ef5bc962SPaolo Bonzini * cache flushes. Thus, the "auto writethrough" behavior is never 774ef5bc962SPaolo Bonzini * necessary for guests that support the VIRTIO_BLK_F_CONFIG_WCE feature. 775ef5bc962SPaolo Bonzini * Leaving it enabled would break the following sequence: 776ef5bc962SPaolo Bonzini * 777ef5bc962SPaolo Bonzini * Guest started with "-drive cache=writethrough" 778ef5bc962SPaolo Bonzini * Guest sets status to 0 779ef5bc962SPaolo Bonzini * Guest sets DRIVER bit in status field 780ef5bc962SPaolo Bonzini * Guest reads host features (WCE=0, CONFIG_WCE=1) 781ef5bc962SPaolo Bonzini * Guest writes guest features (WCE=0, CONFIG_WCE=1) 782ef5bc962SPaolo Bonzini * Guest writes 1 to the WCE configuration field (writeback mode) 783ef5bc962SPaolo Bonzini * Guest sets DRIVER_OK bit in status field 784ef5bc962SPaolo Bonzini * 7854be74634SMarkus Armbruster * s->blk would erroneously be placed in writethrough mode. 786ef5bc962SPaolo Bonzini */ 78795129d6fSCornelia Huck if (!virtio_vdev_has_feature(vdev, VIRTIO_BLK_F_CONFIG_WCE)) { 7884be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 7894be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, 79095129d6fSCornelia Huck virtio_vdev_has_feature(vdev, 79195129d6fSCornelia Huck VIRTIO_BLK_F_WCE)); 7924be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 7936e790746SPaolo Bonzini } 794ef5bc962SPaolo Bonzini } 7956e790746SPaolo Bonzini 7966e790746SPaolo Bonzini static void virtio_blk_save(QEMUFile *f, void *opaque) 7976e790746SPaolo Bonzini { 798b2b295a7SGreg Kurz VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 79910a06fd6SPavel Butsykin VirtIOBlock *s = VIRTIO_BLK(vdev); 80010a06fd6SPavel Butsykin 80110a06fd6SPavel Butsykin if (s->dataplane) { 80210a06fd6SPavel Butsykin virtio_blk_data_plane_stop(s->dataplane); 80310a06fd6SPavel Butsykin } 8046e790746SPaolo Bonzini 8056e790746SPaolo Bonzini virtio_save(vdev, f); 806b2b295a7SGreg Kurz } 807b2b295a7SGreg Kurz 808b2b295a7SGreg Kurz static void virtio_blk_save_device(VirtIODevice *vdev, QEMUFile *f) 809b2b295a7SGreg Kurz { 810b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 811b2b295a7SGreg Kurz VirtIOBlockReq *req = s->rq; 8126e790746SPaolo Bonzini 8136e790746SPaolo Bonzini while (req) { 8146e790746SPaolo Bonzini qemu_put_sbyte(f, 1); 815f897bf75SStefan Hajnoczi qemu_put_buffer(f, (unsigned char *)&req->elem, 816671ec3f0SFam Zheng sizeof(VirtQueueElement)); 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)) { 8396e790746SPaolo Bonzini VirtIOBlockReq *req = virtio_blk_alloc_request(s); 840f897bf75SStefan Hajnoczi qemu_get_buffer(f, (unsigned char *)&req->elem, 841671ec3f0SFam Zheng sizeof(VirtQueueElement)); 8426e790746SPaolo Bonzini req->next = s->rq; 8436e790746SPaolo Bonzini s->rq = req; 8446e790746SPaolo Bonzini 8453d8db153SMichael S. Tsirkin virtqueue_map(&req->elem); 8466e790746SPaolo Bonzini } 8476e790746SPaolo Bonzini 8486e790746SPaolo Bonzini return 0; 8496e790746SPaolo Bonzini } 8506e790746SPaolo Bonzini 8516e790746SPaolo Bonzini static void virtio_blk_resize(void *opaque) 8526e790746SPaolo Bonzini { 8536e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 8546e790746SPaolo Bonzini 8556e790746SPaolo Bonzini virtio_notify_config(vdev); 8566e790746SPaolo Bonzini } 8576e790746SPaolo Bonzini 8586e790746SPaolo Bonzini static const BlockDevOps virtio_block_ops = { 8596e790746SPaolo Bonzini .resize_cb = virtio_blk_resize, 8606e790746SPaolo Bonzini }; 8616e790746SPaolo Bonzini 86284db52d0SStefan Hajnoczi /* Disable dataplane thread during live migration since it does not 86384db52d0SStefan Hajnoczi * update the dirty memory bitmap yet. 86484db52d0SStefan Hajnoczi */ 86584db52d0SStefan Hajnoczi static void virtio_blk_migration_state_changed(Notifier *notifier, void *data) 86684db52d0SStefan Hajnoczi { 86784db52d0SStefan Hajnoczi VirtIOBlock *s = container_of(notifier, VirtIOBlock, 86884db52d0SStefan Hajnoczi migration_state_notifier); 86984db52d0SStefan Hajnoczi MigrationState *mig = data; 8703ffeeef7SAndreas Färber Error *err = NULL; 87184db52d0SStefan Hajnoczi 87284db52d0SStefan Hajnoczi if (migration_in_setup(mig)) { 87384db52d0SStefan Hajnoczi if (!s->dataplane) { 87484db52d0SStefan Hajnoczi return; 87584db52d0SStefan Hajnoczi } 87684db52d0SStefan Hajnoczi virtio_blk_data_plane_destroy(s->dataplane); 87784db52d0SStefan Hajnoczi s->dataplane = NULL; 87884db52d0SStefan Hajnoczi } else if (migration_has_finished(mig) || 87984db52d0SStefan Hajnoczi migration_has_failed(mig)) { 88084db52d0SStefan Hajnoczi if (s->dataplane) { 88184db52d0SStefan Hajnoczi return; 88284db52d0SStefan Hajnoczi } 8834be74634SMarkus Armbruster blk_drain_all(); /* complete in-flight non-dataplane requests */ 8842a30307fSMarkus Armbruster virtio_blk_data_plane_create(VIRTIO_DEVICE(s), &s->conf, 8853ffeeef7SAndreas Färber &s->dataplane, &err); 8863ffeeef7SAndreas Färber if (err != NULL) { 887565f65d2SMarkus Armbruster error_report_err(err); 8883ffeeef7SAndreas Färber } 88984db52d0SStefan Hajnoczi } 89084db52d0SStefan Hajnoczi } 89184db52d0SStefan Hajnoczi 89275884afdSAndreas Färber static void virtio_blk_device_realize(DeviceState *dev, Error **errp) 8936e790746SPaolo Bonzini { 89475884afdSAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 895179b417eSAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 8962a30307fSMarkus Armbruster VirtIOBlkConf *conf = &s->conf; 8973ffeeef7SAndreas Färber Error *err = NULL; 8986e790746SPaolo Bonzini static int virtio_blk_id; 8996e790746SPaolo Bonzini 9004be74634SMarkus Armbruster if (!conf->conf.blk) { 90175884afdSAndreas Färber error_setg(errp, "drive property not set"); 90275884afdSAndreas Färber return; 9036e790746SPaolo Bonzini } 9044be74634SMarkus Armbruster if (!blk_is_inserted(conf->conf.blk)) { 90575884afdSAndreas Färber error_setg(errp, "Device needs media, but drive is empty"); 90675884afdSAndreas Färber return; 9076e790746SPaolo Bonzini } 9086e790746SPaolo Bonzini 9092a30307fSMarkus Armbruster blkconf_serial(&conf->conf, &conf->serial); 9104be74634SMarkus Armbruster s->original_wce = blk_enable_write_cache(conf->conf.blk); 9112a30307fSMarkus Armbruster blkconf_geometry(&conf->conf, NULL, 65535, 255, 255, &err); 9125ff5efb4SFam Zheng if (err) { 9135ff5efb4SFam Zheng error_propagate(errp, err); 91475884afdSAndreas Färber return; 9156e790746SPaolo Bonzini } 9160eb28a42SEkaterina Tumanova blkconf_blocksizes(&conf->conf); 9176e790746SPaolo Bonzini 9186e790746SPaolo Bonzini virtio_init(vdev, "virtio-blk", VIRTIO_ID_BLOCK, 9196e790746SPaolo Bonzini sizeof(struct virtio_blk_config)); 9206e790746SPaolo Bonzini 9214be74634SMarkus Armbruster s->blk = conf->conf.blk; 9226e790746SPaolo Bonzini s->rq = NULL; 9232a30307fSMarkus Armbruster s->sector_mask = (s->conf.conf.logical_block_size / BDRV_SECTOR_SIZE) - 1; 9246e790746SPaolo Bonzini 9256e790746SPaolo Bonzini s->vq = virtio_add_queue(vdev, 128, virtio_blk_handle_output); 926bf4bd461SFam Zheng s->complete_request = virtio_blk_complete_request; 9272a30307fSMarkus Armbruster virtio_blk_data_plane_create(vdev, conf, &s->dataplane, &err); 9283ffeeef7SAndreas Färber if (err != NULL) { 92975884afdSAndreas Färber error_propagate(errp, err); 9306a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 93175884afdSAndreas Färber return; 9326e790746SPaolo Bonzini } 93384db52d0SStefan Hajnoczi s->migration_state_notifier.notify = virtio_blk_migration_state_changed; 93484db52d0SStefan Hajnoczi add_migration_state_change_notifier(&s->migration_state_notifier); 9356e790746SPaolo Bonzini 9366e790746SPaolo Bonzini s->change = qemu_add_vm_change_state_handler(virtio_blk_dma_restart_cb, s); 937179b417eSAndreas Färber register_savevm(dev, "virtio-blk", virtio_blk_id++, 2, 9386e790746SPaolo Bonzini virtio_blk_save, virtio_blk_load, s); 9394be74634SMarkus Armbruster blk_set_dev_ops(s->blk, &virtio_block_ops, s); 9404be74634SMarkus Armbruster blk_set_guest_block_size(s->blk, s->conf.conf.logical_block_size); 9416e790746SPaolo Bonzini 9424be74634SMarkus Armbruster blk_iostatus_enable(s->blk); 9436e790746SPaolo Bonzini } 9446e790746SPaolo Bonzini 945306ec6c3SAndreas Färber static void virtio_blk_device_unrealize(DeviceState *dev, Error **errp) 9466e790746SPaolo Bonzini { 947306ec6c3SAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 948306ec6c3SAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 949306ec6c3SAndreas Färber 95084db52d0SStefan Hajnoczi remove_migration_state_change_notifier(&s->migration_state_notifier); 9516e790746SPaolo Bonzini virtio_blk_data_plane_destroy(s->dataplane); 9526e790746SPaolo Bonzini s->dataplane = NULL; 9536e790746SPaolo Bonzini qemu_del_vm_change_state_handler(s->change); 954306ec6c3SAndreas Färber unregister_savevm(dev, "virtio-blk", s); 9554be74634SMarkus Armbruster blockdev_mark_auto_del(s->blk); 9566a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 9576e790746SPaolo Bonzini } 9586e790746SPaolo Bonzini 959467b3f33SStefan Hajnoczi static void virtio_blk_instance_init(Object *obj) 960467b3f33SStefan Hajnoczi { 961467b3f33SStefan Hajnoczi VirtIOBlock *s = VIRTIO_BLK(obj); 962467b3f33SStefan Hajnoczi 963467b3f33SStefan Hajnoczi object_property_add_link(obj, "iothread", TYPE_IOTHREAD, 9642a30307fSMarkus Armbruster (Object **)&s->conf.iothread, 965467b3f33SStefan Hajnoczi qdev_prop_allow_set_link_before_realize, 966467b3f33SStefan Hajnoczi OBJ_PROP_LINK_UNREF_ON_RELEASE, NULL); 9672a30307fSMarkus Armbruster device_add_bootindex_property(obj, &s->conf.conf.bootindex, 9683342ec32SGonglei "bootindex", "/disk@0,0", 9693342ec32SGonglei DEVICE(obj), NULL); 970467b3f33SStefan Hajnoczi } 971467b3f33SStefan Hajnoczi 9726e790746SPaolo Bonzini static Property virtio_blk_properties[] = { 9732a30307fSMarkus Armbruster DEFINE_BLOCK_PROPERTIES(VirtIOBlock, conf.conf), 9742a30307fSMarkus Armbruster DEFINE_BLOCK_CHS_PROPERTIES(VirtIOBlock, conf.conf), 9752a30307fSMarkus Armbruster DEFINE_PROP_STRING("serial", VirtIOBlock, conf.serial), 9762a30307fSMarkus Armbruster DEFINE_PROP_BIT("config-wce", VirtIOBlock, conf.config_wce, 0, true), 97732a877e4SStefan Hajnoczi #ifdef __linux__ 978ed65fd1aSCornelia Huck DEFINE_PROP_BIT("scsi", VirtIOBlock, conf.scsi, 0, false), 97932a877e4SStefan Hajnoczi #endif 980c99495acSPeter Lieven DEFINE_PROP_BIT("request-merging", VirtIOBlock, conf.request_merging, 0, 981c99495acSPeter Lieven true), 9826e790746SPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 9836e790746SPaolo Bonzini }; 9846e790746SPaolo Bonzini 9856e790746SPaolo Bonzini static void virtio_blk_class_init(ObjectClass *klass, void *data) 9866e790746SPaolo Bonzini { 9876e790746SPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 9886e790746SPaolo Bonzini VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); 98975884afdSAndreas Färber 9906e790746SPaolo Bonzini dc->props = virtio_blk_properties; 991125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 99275884afdSAndreas Färber vdc->realize = virtio_blk_device_realize; 993306ec6c3SAndreas Färber vdc->unrealize = virtio_blk_device_unrealize; 9946e790746SPaolo Bonzini vdc->get_config = virtio_blk_update_config; 9956e790746SPaolo Bonzini vdc->set_config = virtio_blk_set_config; 9966e790746SPaolo Bonzini vdc->get_features = virtio_blk_get_features; 9976e790746SPaolo Bonzini vdc->set_status = virtio_blk_set_status; 9986e790746SPaolo Bonzini vdc->reset = virtio_blk_reset; 999b2b295a7SGreg Kurz vdc->save = virtio_blk_save_device; 1000b2b295a7SGreg Kurz vdc->load = virtio_blk_load_device; 10016e790746SPaolo Bonzini } 10026e790746SPaolo Bonzini 10036e790746SPaolo Bonzini static const TypeInfo virtio_device_info = { 10046e790746SPaolo Bonzini .name = TYPE_VIRTIO_BLK, 10056e790746SPaolo Bonzini .parent = TYPE_VIRTIO_DEVICE, 10066e790746SPaolo Bonzini .instance_size = sizeof(VirtIOBlock), 1007467b3f33SStefan Hajnoczi .instance_init = virtio_blk_instance_init, 10086e790746SPaolo Bonzini .class_init = virtio_blk_class_init, 10096e790746SPaolo Bonzini }; 10106e790746SPaolo Bonzini 10116e790746SPaolo Bonzini static void virtio_register_types(void) 10126e790746SPaolo Bonzini { 10136e790746SPaolo Bonzini type_register_static(&virtio_device_info); 10146e790746SPaolo Bonzini } 10156e790746SPaolo Bonzini 10166e790746SPaolo Bonzini type_init(virtio_register_types) 1017