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" 216e790746SPaolo Bonzini #include "sysemu/blockdev.h" 226e790746SPaolo Bonzini #include "hw/virtio/virtio-blk.h" 236e790746SPaolo Bonzini #include "dataplane/virtio-blk.h" 2408e2c9f1SPaolo Bonzini #include "scsi/constants.h" 256e790746SPaolo Bonzini #ifdef __linux__ 266e790746SPaolo Bonzini # include <scsi/sg.h> 276e790746SPaolo Bonzini #endif 286e790746SPaolo Bonzini #include "hw/virtio/virtio-bus.h" 29783d1897SRusty Russell #include "hw/virtio/virtio-access.h" 306e790746SPaolo Bonzini 3120764be0SStefano Garzarella /* Config size before the discard support (hide associated config fields) */ 3242824b4dSChangpeng Liu #define VIRTIO_BLK_CFG_SIZE offsetof(struct virtio_blk_config, \ 3342824b4dSChangpeng Liu max_discard_sectors) 3420764be0SStefano Garzarella /* 3520764be0SStefano Garzarella * Starting from the discard feature, we can use this array to properly 3620764be0SStefano Garzarella * set the config size depending on the features enabled. 3720764be0SStefano Garzarella */ 3820764be0SStefano Garzarella static VirtIOFeature feature_sizes[] = { 3920764be0SStefano Garzarella {.flags = 1ULL << VIRTIO_BLK_F_DISCARD, 4020764be0SStefano Garzarella .end = virtio_endof(struct virtio_blk_config, discard_sector_alignment)}, 4120764be0SStefano Garzarella {.flags = 1ULL << VIRTIO_BLK_F_WRITE_ZEROES, 4220764be0SStefano Garzarella .end = virtio_endof(struct virtio_blk_config, write_zeroes_may_unmap)}, 4320764be0SStefano Garzarella {} 4420764be0SStefano Garzarella }; 4520764be0SStefano Garzarella 4620764be0SStefano Garzarella static void virtio_blk_set_config_size(VirtIOBlock *s, uint64_t host_features) 4720764be0SStefano Garzarella { 4820764be0SStefano Garzarella s->config_size = MAX(VIRTIO_BLK_CFG_SIZE, 4920764be0SStefano Garzarella virtio_feature_get_config_size(feature_sizes, host_features)); 5020764be0SStefano Garzarella 5120764be0SStefano Garzarella assert(s->config_size <= sizeof(struct virtio_blk_config)); 5220764be0SStefano Garzarella } 5342824b4dSChangpeng Liu 54d14dde5eSGreg Kurz static void virtio_blk_init_request(VirtIOBlock *s, VirtQueue *vq, 55edaffd9fSStefan Hajnoczi VirtIOBlockReq *req) 56671ec3f0SFam Zheng { 57671ec3f0SFam Zheng req->dev = s; 58edaffd9fSStefan Hajnoczi req->vq = vq; 59869d66afSStefan Hajnoczi req->qiov.size = 0; 602a6cdd6dSPaolo Bonzini req->in_len = 0; 61869d66afSStefan Hajnoczi req->next = NULL; 6295f7142aSPeter Lieven req->mr_next = NULL; 63671ec3f0SFam Zheng } 64671ec3f0SFam Zheng 65d14dde5eSGreg Kurz static void virtio_blk_free_request(VirtIOBlockReq *req) 66671ec3f0SFam Zheng { 67c84b3192SPaolo Bonzini g_free(req); 68671ec3f0SFam Zheng } 69671ec3f0SFam Zheng 7003de2f52SPaolo Bonzini static void virtio_blk_req_complete(VirtIOBlockReq *req, unsigned char status) 716e790746SPaolo Bonzini { 726e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 736e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 746e790746SPaolo Bonzini 75a576ceacSStefan Hajnoczi trace_virtio_blk_req_complete(vdev, req, status); 766e790746SPaolo Bonzini 776e790746SPaolo Bonzini stb_p(&req->in->status, status); 78edaffd9fSStefan Hajnoczi virtqueue_push(req->vq, &req->elem, req->in_len); 79eb41cf78SPaolo Bonzini if (s->dataplane_started && !s->dataplane_disabled) { 80edaffd9fSStefan Hajnoczi virtio_blk_data_plane_notify(s->dataplane, req->vq); 8103de2f52SPaolo Bonzini } else { 82edaffd9fSStefan Hajnoczi virtio_notify(vdev, req->vq); 836e790746SPaolo Bonzini } 84bf4bd461SFam Zheng } 85bf4bd461SFam Zheng 866e790746SPaolo Bonzini static int virtio_blk_handle_rw_error(VirtIOBlockReq *req, int error, 8700f639fbSStefano Garzarella bool is_read, bool acct_failed) 886e790746SPaolo Bonzini { 896e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 909a6719d5SStefano Garzarella BlockErrorAction action = blk_get_error_action(s->blk, is_read, error); 916e790746SPaolo Bonzini 92a589569fSWenchao Xia if (action == BLOCK_ERROR_ACTION_STOP) { 93466138dcSFam Zheng /* Break the link as the next request is going to be parsed from the 94466138dcSFam Zheng * ring again. Otherwise we may end up doing a double completion! */ 95466138dcSFam Zheng req->mr_next = NULL; 966e790746SPaolo Bonzini req->next = s->rq; 976e790746SPaolo Bonzini s->rq = req; 98a589569fSWenchao Xia } else if (action == BLOCK_ERROR_ACTION_REPORT) { 996e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 10000f639fbSStefano Garzarella if (acct_failed) { 10101762e03SAlberto Garcia block_acct_failed(blk_get_stats(s->blk), &req->acct); 10200f639fbSStefano Garzarella } 103671ec3f0SFam Zheng virtio_blk_free_request(req); 1046e790746SPaolo Bonzini } 1056e790746SPaolo Bonzini 1064be74634SMarkus Armbruster blk_error_action(s->blk, action, is_read, error); 107a589569fSWenchao Xia return action != BLOCK_ERROR_ACTION_IGNORE; 1086e790746SPaolo Bonzini } 1096e790746SPaolo Bonzini 1106e790746SPaolo Bonzini static void virtio_blk_rw_complete(void *opaque, int ret) 1116e790746SPaolo Bonzini { 11295f7142aSPeter Lieven VirtIOBlockReq *next = opaque; 113b9e413ddSPaolo Bonzini VirtIOBlock *s = next->dev; 114a576ceacSStefan Hajnoczi VirtIODevice *vdev = VIRTIO_DEVICE(s); 1156e790746SPaolo Bonzini 116b9e413ddSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 11795f7142aSPeter Lieven while (next) { 11895f7142aSPeter Lieven VirtIOBlockReq *req = next; 11995f7142aSPeter Lieven next = req->mr_next; 120a576ceacSStefan Hajnoczi trace_virtio_blk_rw_complete(vdev, req, ret); 1216e790746SPaolo Bonzini 12295f7142aSPeter Lieven if (req->qiov.nalloc != -1) { 123e61809edSDongli Zhang /* If nalloc is != -1 req->qiov is a local copy of the original 1249bb192a4SYaowei Bai * external iovec. It was allocated in submit_requests to be 1259bb192a4SYaowei Bai * able to merge requests. */ 12695f7142aSPeter Lieven qemu_iovec_destroy(&req->qiov); 12795f7142aSPeter Lieven } 12895f7142aSPeter Lieven 1296e790746SPaolo Bonzini if (ret) { 130*bf4069fbSAnastasiia Rusakova int p = virtio_ldl_p(VIRTIO_DEVICE(s), &req->out.type); 131783d1897SRusty Russell bool is_read = !(p & VIRTIO_BLK_T_OUT); 1322a6cdd6dSPaolo Bonzini /* Note that memory may be dirtied on read failure. If the 1332a6cdd6dSPaolo Bonzini * virtio request is not completed here, as is the case for 1342a6cdd6dSPaolo Bonzini * BLOCK_ERROR_ACTION_STOP, the memory may not be copied 1352a6cdd6dSPaolo Bonzini * correctly during live migration. While this is ugly, 1362a6cdd6dSPaolo Bonzini * it is acceptable because the device is free to write to 1372a6cdd6dSPaolo Bonzini * the memory until the request is completed (which will 1382a6cdd6dSPaolo Bonzini * happen on the other side of the migration). 1392a6cdd6dSPaolo Bonzini */ 14000f639fbSStefano Garzarella if (virtio_blk_handle_rw_error(req, -ret, is_read, true)) { 14195f7142aSPeter Lieven continue; 14295f7142aSPeter Lieven } 1436e790746SPaolo Bonzini } 1446e790746SPaolo Bonzini 1456e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 146*bf4069fbSAnastasiia Rusakova block_acct_done(blk_get_stats(s->blk), &req->acct); 147671ec3f0SFam Zheng virtio_blk_free_request(req); 1486e790746SPaolo Bonzini } 149b9e413ddSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 15095f7142aSPeter Lieven } 1516e790746SPaolo Bonzini 1526e790746SPaolo Bonzini static void virtio_blk_flush_complete(void *opaque, int ret) 1536e790746SPaolo Bonzini { 1546e790746SPaolo Bonzini VirtIOBlockReq *req = opaque; 155b9e413ddSPaolo Bonzini VirtIOBlock *s = req->dev; 1566e790746SPaolo Bonzini 157b9e413ddSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 1586e790746SPaolo Bonzini if (ret) { 15900f639fbSStefano Garzarella if (virtio_blk_handle_rw_error(req, -ret, 0, true)) { 160b9e413ddSPaolo Bonzini goto out; 1616e790746SPaolo Bonzini } 1626e790746SPaolo Bonzini } 1636e790746SPaolo Bonzini 1646e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1659a6719d5SStefano Garzarella block_acct_done(blk_get_stats(s->blk), &req->acct); 166671ec3f0SFam Zheng virtio_blk_free_request(req); 167b9e413ddSPaolo Bonzini 168b9e413ddSPaolo Bonzini out: 169b9e413ddSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 1706e790746SPaolo Bonzini } 1716e790746SPaolo Bonzini 17237b06f8dSStefano Garzarella static void virtio_blk_discard_write_zeroes_complete(void *opaque, int ret) 17337b06f8dSStefano Garzarella { 17437b06f8dSStefano Garzarella VirtIOBlockReq *req = opaque; 17537b06f8dSStefano Garzarella VirtIOBlock *s = req->dev; 17637b06f8dSStefano Garzarella bool is_write_zeroes = (virtio_ldl_p(VIRTIO_DEVICE(s), &req->out.type) & 17737b06f8dSStefano Garzarella ~VIRTIO_BLK_T_BARRIER) == VIRTIO_BLK_T_WRITE_ZEROES; 17837b06f8dSStefano Garzarella 17937b06f8dSStefano Garzarella aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 18037b06f8dSStefano Garzarella if (ret) { 18137b06f8dSStefano Garzarella if (virtio_blk_handle_rw_error(req, -ret, false, is_write_zeroes)) { 18237b06f8dSStefano Garzarella goto out; 18337b06f8dSStefano Garzarella } 18437b06f8dSStefano Garzarella } 18537b06f8dSStefano Garzarella 18637b06f8dSStefano Garzarella virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 18737b06f8dSStefano Garzarella if (is_write_zeroes) { 18837b06f8dSStefano Garzarella block_acct_done(blk_get_stats(s->blk), &req->acct); 18937b06f8dSStefano Garzarella } 19037b06f8dSStefano Garzarella virtio_blk_free_request(req); 19137b06f8dSStefano Garzarella 19237b06f8dSStefano Garzarella out: 19337b06f8dSStefano Garzarella aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 19437b06f8dSStefano Garzarella } 19537b06f8dSStefano Garzarella 1961dc936aaSFam Zheng #ifdef __linux__ 1971dc936aaSFam Zheng 1981dc936aaSFam Zheng typedef struct { 1991dc936aaSFam Zheng VirtIOBlockReq *req; 2001dc936aaSFam Zheng struct sg_io_hdr hdr; 2011dc936aaSFam Zheng } VirtIOBlockIoctlReq; 2021dc936aaSFam Zheng 2031dc936aaSFam Zheng static void virtio_blk_ioctl_complete(void *opaque, int status) 2041dc936aaSFam Zheng { 2051dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req = opaque; 2061dc936aaSFam Zheng VirtIOBlockReq *req = ioctl_req->req; 2079d456654SPaolo Bonzini VirtIOBlock *s = req->dev; 2089d456654SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 2091dc936aaSFam Zheng struct virtio_scsi_inhdr *scsi; 2101dc936aaSFam Zheng struct sg_io_hdr *hdr; 2111dc936aaSFam Zheng 2121dc936aaSFam Zheng scsi = (void *)req->elem.in_sg[req->elem.in_num - 2].iov_base; 2131dc936aaSFam Zheng 2141dc936aaSFam Zheng if (status) { 2151dc936aaSFam Zheng status = VIRTIO_BLK_S_UNSUPP; 2161dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 255); 2171dc936aaSFam Zheng goto out; 2181dc936aaSFam Zheng } 2191dc936aaSFam Zheng 2201dc936aaSFam Zheng hdr = &ioctl_req->hdr; 2211dc936aaSFam Zheng /* 2221dc936aaSFam Zheng * From SCSI-Generic-HOWTO: "Some lower level drivers (e.g. ide-scsi) 2231dc936aaSFam Zheng * clear the masked_status field [hence status gets cleared too, see 2241dc936aaSFam Zheng * block/scsi_ioctl.c] even when a CHECK_CONDITION or COMMAND_TERMINATED 2251dc936aaSFam Zheng * status has occurred. However they do set DRIVER_SENSE in driver_status 2261dc936aaSFam Zheng * field. Also a (sb_len_wr > 0) indicates there is a sense buffer. 2271dc936aaSFam Zheng */ 2281dc936aaSFam Zheng if (hdr->status == 0 && hdr->sb_len_wr > 0) { 2291dc936aaSFam Zheng hdr->status = CHECK_CONDITION; 2301dc936aaSFam Zheng } 2311dc936aaSFam Zheng 2321dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 2331dc936aaSFam Zheng hdr->status | (hdr->msg_status << 8) | 2341dc936aaSFam Zheng (hdr->host_status << 16) | (hdr->driver_status << 24)); 2351dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->residual, hdr->resid); 2361dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->sense_len, hdr->sb_len_wr); 2371dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->data_len, hdr->dxfer_len); 2381dc936aaSFam Zheng 2391dc936aaSFam Zheng out: 240b9e413ddSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 2411dc936aaSFam Zheng virtio_blk_req_complete(req, status); 2421dc936aaSFam Zheng virtio_blk_free_request(req); 243b9e413ddSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 2441dc936aaSFam Zheng g_free(ioctl_req); 2451dc936aaSFam Zheng } 2461dc936aaSFam Zheng 2471dc936aaSFam Zheng #endif 2481dc936aaSFam Zheng 249edaffd9fSStefan Hajnoczi static VirtIOBlockReq *virtio_blk_get_request(VirtIOBlock *s, VirtQueue *vq) 2506e790746SPaolo Bonzini { 251edaffd9fSStefan Hajnoczi VirtIOBlockReq *req = virtqueue_pop(vq, sizeof(VirtIOBlockReq)); 2526e790746SPaolo Bonzini 25351b19ebeSPaolo Bonzini if (req) { 254edaffd9fSStefan Hajnoczi virtio_blk_init_request(s, vq, req); 2556e790746SPaolo Bonzini } 2566e790746SPaolo Bonzini return req; 2576e790746SPaolo Bonzini } 2586e790746SPaolo Bonzini 25975344fa4SFam Zheng static int virtio_blk_handle_scsi_req(VirtIOBlockReq *req) 2606e790746SPaolo Bonzini { 2616e790746SPaolo Bonzini int status = VIRTIO_BLK_S_OK; 2625a05cbeeSFam Zheng struct virtio_scsi_inhdr *scsi = NULL; 26375344fa4SFam Zheng VirtIOBlock *blk = req->dev; 264*bf4069fbSAnastasiia Rusakova VirtIODevice *vdev = VIRTIO_DEVICE(blk); 265*bf4069fbSAnastasiia Rusakova VirtQueueElement *elem = &req->elem; 266783d1897SRusty Russell 2675a05cbeeSFam Zheng #ifdef __linux__ 2685a05cbeeSFam Zheng int i; 2691dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req; 270a209f461SFam Zheng BlockAIOCB *acb; 2715a05cbeeSFam Zheng #endif 2726e790746SPaolo Bonzini 2736e790746SPaolo Bonzini /* 2746e790746SPaolo Bonzini * We require at least one output segment each for the virtio_blk_outhdr 2756e790746SPaolo Bonzini * and the SCSI command block. 2766e790746SPaolo Bonzini * 2776e790746SPaolo Bonzini * We also at least require the virtio_blk_inhdr, the virtio_scsi_inhdr 2786e790746SPaolo Bonzini * and the sense buffer pointer in the input segments. 2796e790746SPaolo Bonzini */ 2805a05cbeeSFam Zheng if (elem->out_num < 2 || elem->in_num < 3) { 2815a05cbeeSFam Zheng status = VIRTIO_BLK_S_IOERR; 2825a05cbeeSFam Zheng goto fail; 2836e790746SPaolo Bonzini } 2846e790746SPaolo Bonzini 2856e790746SPaolo Bonzini /* 2866e790746SPaolo Bonzini * The scsi inhdr is placed in the second-to-last input segment, just 2876e790746SPaolo Bonzini * before the regular inhdr. 2886e790746SPaolo Bonzini */ 2895a05cbeeSFam Zheng scsi = (void *)elem->in_sg[elem->in_num - 2].iov_base; 2906e790746SPaolo Bonzini 291bbe8bd4dSStefano Garzarella if (!virtio_has_feature(blk->host_features, VIRTIO_BLK_F_SCSI)) { 2926e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2936e790746SPaolo Bonzini goto fail; 2946e790746SPaolo Bonzini } 2956e790746SPaolo Bonzini 2966e790746SPaolo Bonzini /* 2976e790746SPaolo Bonzini * No support for bidirection commands yet. 2986e790746SPaolo Bonzini */ 2995a05cbeeSFam Zheng if (elem->out_num > 2 && elem->in_num > 3) { 3006e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 3016e790746SPaolo Bonzini goto fail; 3026e790746SPaolo Bonzini } 3036e790746SPaolo Bonzini 3046e790746SPaolo Bonzini #ifdef __linux__ 3051dc936aaSFam Zheng ioctl_req = g_new0(VirtIOBlockIoctlReq, 1); 3061dc936aaSFam Zheng ioctl_req->req = req; 3071dc936aaSFam Zheng ioctl_req->hdr.interface_id = 'S'; 3081dc936aaSFam Zheng ioctl_req->hdr.cmd_len = elem->out_sg[1].iov_len; 3091dc936aaSFam Zheng ioctl_req->hdr.cmdp = elem->out_sg[1].iov_base; 3101dc936aaSFam Zheng ioctl_req->hdr.dxfer_len = 0; 3116e790746SPaolo Bonzini 3125a05cbeeSFam Zheng if (elem->out_num > 2) { 3136e790746SPaolo Bonzini /* 3146e790746SPaolo Bonzini * If there are more than the minimally required 2 output segments 3156e790746SPaolo Bonzini * there is write payload starting from the third iovec. 3166e790746SPaolo Bonzini */ 3171dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_TO_DEV; 3181dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->out_num - 2; 3196e790746SPaolo Bonzini 3201dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 3211dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->out_sg[i + 2].iov_len; 3221dc936aaSFam Zheng } 3236e790746SPaolo Bonzini 3241dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->out_sg + 2; 3256e790746SPaolo Bonzini 3265a05cbeeSFam Zheng } else if (elem->in_num > 3) { 3276e790746SPaolo Bonzini /* 3286e790746SPaolo Bonzini * If we have more than 3 input segments the guest wants to actually 3296e790746SPaolo Bonzini * read data. 3306e790746SPaolo Bonzini */ 3311dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_FROM_DEV; 3321dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->in_num - 3; 3331dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 3341dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->in_sg[i].iov_len; 3351dc936aaSFam Zheng } 3366e790746SPaolo Bonzini 3371dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->in_sg; 3386e790746SPaolo Bonzini } else { 3396e790746SPaolo Bonzini /* 3406e790746SPaolo Bonzini * Some SCSI commands don't actually transfer any data. 3416e790746SPaolo Bonzini */ 3421dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_NONE; 3436e790746SPaolo Bonzini } 3446e790746SPaolo Bonzini 3451dc936aaSFam Zheng ioctl_req->hdr.sbp = elem->in_sg[elem->in_num - 3].iov_base; 3461dc936aaSFam Zheng ioctl_req->hdr.mx_sb_len = elem->in_sg[elem->in_num - 3].iov_len; 3476e790746SPaolo Bonzini 348a209f461SFam Zheng acb = blk_aio_ioctl(blk->blk, SG_IO, &ioctl_req->hdr, 3491dc936aaSFam Zheng virtio_blk_ioctl_complete, ioctl_req); 350a209f461SFam Zheng if (!acb) { 351a209f461SFam Zheng g_free(ioctl_req); 352a209f461SFam Zheng status = VIRTIO_BLK_S_UNSUPP; 353a209f461SFam Zheng goto fail; 354a209f461SFam Zheng } 3551dc936aaSFam Zheng return -EINPROGRESS; 3566e790746SPaolo Bonzini #else 3576e790746SPaolo Bonzini abort(); 3586e790746SPaolo Bonzini #endif 3596e790746SPaolo Bonzini 3606e790746SPaolo Bonzini fail: 3616e790746SPaolo Bonzini /* Just put anything nonzero so that the ioctl fails in the guest. */ 3625a05cbeeSFam Zheng if (scsi) { 363783d1897SRusty Russell virtio_stl_p(vdev, &scsi->errors, 255); 3645a05cbeeSFam Zheng } 3655a05cbeeSFam Zheng return status; 3665a05cbeeSFam Zheng } 3675a05cbeeSFam Zheng 3685a05cbeeSFam Zheng static void virtio_blk_handle_scsi(VirtIOBlockReq *req) 3695a05cbeeSFam Zheng { 3705a05cbeeSFam Zheng int status; 3715a05cbeeSFam Zheng 37275344fa4SFam Zheng status = virtio_blk_handle_scsi_req(req); 3731dc936aaSFam Zheng if (status != -EINPROGRESS) { 3746e790746SPaolo Bonzini virtio_blk_req_complete(req, status); 375671ec3f0SFam Zheng virtio_blk_free_request(req); 3766e790746SPaolo Bonzini } 3771dc936aaSFam Zheng } 3786e790746SPaolo Bonzini 37995f7142aSPeter Lieven static inline void submit_requests(BlockBackend *blk, MultiReqBuffer *mrb, 38095f7142aSPeter Lieven int start, int num_reqs, int niov) 3816e790746SPaolo Bonzini { 38295f7142aSPeter Lieven QEMUIOVector *qiov = &mrb->reqs[start]->qiov; 38395f7142aSPeter Lieven int64_t sector_num = mrb->reqs[start]->sector_num; 38495f7142aSPeter Lieven bool is_write = mrb->is_write; 3856e790746SPaolo Bonzini 38695f7142aSPeter Lieven if (num_reqs > 1) { 38795f7142aSPeter Lieven int i; 38895f7142aSPeter Lieven struct iovec *tmp_iov = qiov->iov; 38995f7142aSPeter Lieven int tmp_niov = qiov->niov; 39095f7142aSPeter Lieven 39195f7142aSPeter Lieven /* mrb->reqs[start]->qiov was initialized from external so we can't 392b5772fddSEric Blake * modify it here. We need to initialize it locally and then add the 39395f7142aSPeter Lieven * external iovecs. */ 39495f7142aSPeter Lieven qemu_iovec_init(qiov, niov); 39595f7142aSPeter Lieven 39695f7142aSPeter Lieven for (i = 0; i < tmp_niov; i++) { 39795f7142aSPeter Lieven qemu_iovec_add(qiov, tmp_iov[i].iov_base, tmp_iov[i].iov_len); 39895f7142aSPeter Lieven } 39995f7142aSPeter Lieven 40095f7142aSPeter Lieven for (i = start + 1; i < start + num_reqs; i++) { 40195f7142aSPeter Lieven qemu_iovec_concat(qiov, &mrb->reqs[i]->qiov, 0, 40295f7142aSPeter Lieven mrb->reqs[i]->qiov.size); 40395f7142aSPeter Lieven mrb->reqs[i - 1]->mr_next = mrb->reqs[i]; 40495f7142aSPeter Lieven } 40595f7142aSPeter Lieven 406a576ceacSStefan Hajnoczi trace_virtio_blk_submit_multireq(VIRTIO_DEVICE(mrb->reqs[start]->dev), 407a576ceacSStefan Hajnoczi mrb, start, num_reqs, 408b5772fddSEric Blake sector_num << BDRV_SECTOR_BITS, 409b5772fddSEric Blake qiov->size, is_write); 41095f7142aSPeter Lieven block_acct_merge_done(blk_get_stats(blk), 41195f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ, 41295f7142aSPeter Lieven num_reqs - 1); 41395f7142aSPeter Lieven } 41495f7142aSPeter Lieven 41595f7142aSPeter Lieven if (is_write) { 416b5772fddSEric Blake blk_aio_pwritev(blk, sector_num << BDRV_SECTOR_BITS, qiov, 0, 41795f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 41895f7142aSPeter Lieven } else { 419b5772fddSEric Blake blk_aio_preadv(blk, sector_num << BDRV_SECTOR_BITS, qiov, 0, 42095f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 42195f7142aSPeter Lieven } 42295f7142aSPeter Lieven } 42395f7142aSPeter Lieven 42495f7142aSPeter Lieven static int multireq_compare(const void *a, const void *b) 42595f7142aSPeter Lieven { 42695f7142aSPeter Lieven const VirtIOBlockReq *req1 = *(VirtIOBlockReq **)a, 42795f7142aSPeter Lieven *req2 = *(VirtIOBlockReq **)b; 42895f7142aSPeter Lieven 42995f7142aSPeter Lieven /* 43095f7142aSPeter Lieven * Note that we can't simply subtract sector_num1 from sector_num2 43195f7142aSPeter Lieven * here as that could overflow the return value. 43295f7142aSPeter Lieven */ 43395f7142aSPeter Lieven if (req1->sector_num > req2->sector_num) { 43495f7142aSPeter Lieven return 1; 43595f7142aSPeter Lieven } else if (req1->sector_num < req2->sector_num) { 43695f7142aSPeter Lieven return -1; 43795f7142aSPeter Lieven } else { 43895f7142aSPeter Lieven return 0; 43995f7142aSPeter Lieven } 44095f7142aSPeter Lieven } 44195f7142aSPeter Lieven 442d14dde5eSGreg Kurz static void virtio_blk_submit_multireq(BlockBackend *blk, MultiReqBuffer *mrb) 44395f7142aSPeter Lieven { 44495f7142aSPeter Lieven int i = 0, start = 0, num_reqs = 0, niov = 0, nb_sectors = 0; 4455def6b80SEric Blake uint32_t max_transfer; 44695f7142aSPeter Lieven int64_t sector_num = 0; 44795f7142aSPeter Lieven 44895f7142aSPeter Lieven if (mrb->num_reqs == 1) { 44995f7142aSPeter Lieven submit_requests(blk, mrb, 0, 1, -1); 45095f7142aSPeter Lieven mrb->num_reqs = 0; 4516e790746SPaolo Bonzini return; 4526e790746SPaolo Bonzini } 4536e790746SPaolo Bonzini 4545def6b80SEric Blake max_transfer = blk_get_max_transfer(mrb->reqs[0]->dev->blk); 45595f7142aSPeter Lieven 45695f7142aSPeter Lieven qsort(mrb->reqs, mrb->num_reqs, sizeof(*mrb->reqs), 45795f7142aSPeter Lieven &multireq_compare); 45895f7142aSPeter Lieven 45995f7142aSPeter Lieven for (i = 0; i < mrb->num_reqs; i++) { 46095f7142aSPeter Lieven VirtIOBlockReq *req = mrb->reqs[i]; 46195f7142aSPeter Lieven if (num_reqs > 0) { 46249cffbc6SGonglei /* 46349cffbc6SGonglei * NOTE: We cannot merge the requests in below situations: 46449cffbc6SGonglei * 1. requests are not sequential 46549cffbc6SGonglei * 2. merge would exceed maximum number of IOVs 46649cffbc6SGonglei * 3. merge would exceed maximum transfer length of backend device 46749cffbc6SGonglei */ 46849cffbc6SGonglei if (sector_num + nb_sectors != req->sector_num || 469222565f6SStefan Hajnoczi niov > blk_get_max_iov(blk) - req->qiov.niov || 4705def6b80SEric Blake req->qiov.size > max_transfer || 4715def6b80SEric Blake nb_sectors > (max_transfer - 4725def6b80SEric Blake req->qiov.size) / BDRV_SECTOR_SIZE) { 47395f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 47495f7142aSPeter Lieven num_reqs = 0; 4756e790746SPaolo Bonzini } 4766e790746SPaolo Bonzini } 4776e790746SPaolo Bonzini 47895f7142aSPeter Lieven if (num_reqs == 0) { 47995f7142aSPeter Lieven sector_num = req->sector_num; 48095f7142aSPeter Lieven nb_sectors = niov = 0; 48195f7142aSPeter Lieven start = i; 48295f7142aSPeter Lieven } 48395f7142aSPeter Lieven 48495f7142aSPeter Lieven nb_sectors += req->qiov.size / BDRV_SECTOR_SIZE; 48595f7142aSPeter Lieven niov += req->qiov.niov; 48695f7142aSPeter Lieven num_reqs++; 48795f7142aSPeter Lieven } 48895f7142aSPeter Lieven 48995f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 49095f7142aSPeter Lieven mrb->num_reqs = 0; 4916e790746SPaolo Bonzini } 4926e790746SPaolo Bonzini 4936e790746SPaolo Bonzini static void virtio_blk_handle_flush(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4946e790746SPaolo Bonzini { 495*bf4069fbSAnastasiia Rusakova VirtIOBlock *s = req->dev; 496*bf4069fbSAnastasiia Rusakova 497*bf4069fbSAnastasiia Rusakova block_acct_start(blk_get_stats(s->blk), &req->acct, 0, 4985366d0c8SBenoît Canet BLOCK_ACCT_FLUSH); 4996e790746SPaolo Bonzini 5006e790746SPaolo Bonzini /* 5016e790746SPaolo Bonzini * Make sure all outstanding writes are posted to the backing device. 5026e790746SPaolo Bonzini */ 50395f7142aSPeter Lieven if (mrb->is_write && mrb->num_reqs > 0) { 504*bf4069fbSAnastasiia Rusakova virtio_blk_submit_multireq(s->blk, mrb); 50595f7142aSPeter Lieven } 506*bf4069fbSAnastasiia Rusakova blk_aio_flush(s->blk, virtio_blk_flush_complete, req); 5076e790746SPaolo Bonzini } 5086e790746SPaolo Bonzini 509d0e14376SMarkus Armbruster static bool virtio_blk_sect_range_ok(VirtIOBlock *dev, 510d0e14376SMarkus Armbruster uint64_t sector, size_t size) 511d0e14376SMarkus Armbruster { 5123c2daac0SMarkus Armbruster uint64_t nb_sectors = size >> BDRV_SECTOR_BITS; 5133c2daac0SMarkus Armbruster uint64_t total_sectors; 5143c2daac0SMarkus Armbruster 51575af1f34SPeter Lieven if (nb_sectors > BDRV_REQUEST_MAX_SECTORS) { 51695f7142aSPeter Lieven return false; 51795f7142aSPeter Lieven } 518d0e14376SMarkus Armbruster if (sector & dev->sector_mask) { 519d0e14376SMarkus Armbruster return false; 520d0e14376SMarkus Armbruster } 5212a30307fSMarkus Armbruster if (size % dev->conf.conf.logical_block_size) { 522d0e14376SMarkus Armbruster return false; 523d0e14376SMarkus Armbruster } 5244be74634SMarkus Armbruster blk_get_geometry(dev->blk, &total_sectors); 5253c2daac0SMarkus Armbruster if (sector > total_sectors || nb_sectors > total_sectors - sector) { 5263c2daac0SMarkus Armbruster return false; 5273c2daac0SMarkus Armbruster } 528d0e14376SMarkus Armbruster return true; 529d0e14376SMarkus Armbruster } 530d0e14376SMarkus Armbruster 53137b06f8dSStefano Garzarella static uint8_t virtio_blk_handle_discard_write_zeroes(VirtIOBlockReq *req, 53237b06f8dSStefano Garzarella struct virtio_blk_discard_write_zeroes *dwz_hdr, bool is_write_zeroes) 53337b06f8dSStefano Garzarella { 53437b06f8dSStefano Garzarella VirtIOBlock *s = req->dev; 53537b06f8dSStefano Garzarella VirtIODevice *vdev = VIRTIO_DEVICE(s); 53637b06f8dSStefano Garzarella uint64_t sector; 53737b06f8dSStefano Garzarella uint32_t num_sectors, flags, max_sectors; 53837b06f8dSStefano Garzarella uint8_t err_status; 53937b06f8dSStefano Garzarella int bytes; 54037b06f8dSStefano Garzarella 54137b06f8dSStefano Garzarella sector = virtio_ldq_p(vdev, &dwz_hdr->sector); 54237b06f8dSStefano Garzarella num_sectors = virtio_ldl_p(vdev, &dwz_hdr->num_sectors); 54337b06f8dSStefano Garzarella flags = virtio_ldl_p(vdev, &dwz_hdr->flags); 54437b06f8dSStefano Garzarella max_sectors = is_write_zeroes ? s->conf.max_write_zeroes_sectors : 54537b06f8dSStefano Garzarella s->conf.max_discard_sectors; 54637b06f8dSStefano Garzarella 54737b06f8dSStefano Garzarella /* 54837b06f8dSStefano Garzarella * max_sectors is at most BDRV_REQUEST_MAX_SECTORS, this check 54937b06f8dSStefano Garzarella * make us sure that "num_sectors << BDRV_SECTOR_BITS" can fit in 55037b06f8dSStefano Garzarella * the integer variable. 55137b06f8dSStefano Garzarella */ 55237b06f8dSStefano Garzarella if (unlikely(num_sectors > max_sectors)) { 55337b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_IOERR; 55437b06f8dSStefano Garzarella goto err; 55537b06f8dSStefano Garzarella } 55637b06f8dSStefano Garzarella 55737b06f8dSStefano Garzarella bytes = num_sectors << BDRV_SECTOR_BITS; 55837b06f8dSStefano Garzarella 55937b06f8dSStefano Garzarella if (unlikely(!virtio_blk_sect_range_ok(s, sector, bytes))) { 56037b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_IOERR; 56137b06f8dSStefano Garzarella goto err; 56237b06f8dSStefano Garzarella } 56337b06f8dSStefano Garzarella 56437b06f8dSStefano Garzarella /* 56537b06f8dSStefano Garzarella * The device MUST set the status byte to VIRTIO_BLK_S_UNSUPP for discard 56637b06f8dSStefano Garzarella * and write zeroes commands if any unknown flag is set. 56737b06f8dSStefano Garzarella */ 56837b06f8dSStefano Garzarella if (unlikely(flags & ~VIRTIO_BLK_WRITE_ZEROES_FLAG_UNMAP)) { 56937b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_UNSUPP; 57037b06f8dSStefano Garzarella goto err; 57137b06f8dSStefano Garzarella } 57237b06f8dSStefano Garzarella 57337b06f8dSStefano Garzarella if (is_write_zeroes) { /* VIRTIO_BLK_T_WRITE_ZEROES */ 57437b06f8dSStefano Garzarella int blk_aio_flags = 0; 57537b06f8dSStefano Garzarella 57637b06f8dSStefano Garzarella if (flags & VIRTIO_BLK_WRITE_ZEROES_FLAG_UNMAP) { 57737b06f8dSStefano Garzarella blk_aio_flags |= BDRV_REQ_MAY_UNMAP; 57837b06f8dSStefano Garzarella } 57937b06f8dSStefano Garzarella 58037b06f8dSStefano Garzarella block_acct_start(blk_get_stats(s->blk), &req->acct, bytes, 58137b06f8dSStefano Garzarella BLOCK_ACCT_WRITE); 58237b06f8dSStefano Garzarella 58337b06f8dSStefano Garzarella blk_aio_pwrite_zeroes(s->blk, sector << BDRV_SECTOR_BITS, 58437b06f8dSStefano Garzarella bytes, blk_aio_flags, 58537b06f8dSStefano Garzarella virtio_blk_discard_write_zeroes_complete, req); 58637b06f8dSStefano Garzarella } else { /* VIRTIO_BLK_T_DISCARD */ 58737b06f8dSStefano Garzarella /* 58837b06f8dSStefano Garzarella * The device MUST set the status byte to VIRTIO_BLK_S_UNSUPP for 58937b06f8dSStefano Garzarella * discard commands if the unmap flag is set. 59037b06f8dSStefano Garzarella */ 59137b06f8dSStefano Garzarella if (unlikely(flags & VIRTIO_BLK_WRITE_ZEROES_FLAG_UNMAP)) { 59237b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_UNSUPP; 59337b06f8dSStefano Garzarella goto err; 59437b06f8dSStefano Garzarella } 59537b06f8dSStefano Garzarella 59637b06f8dSStefano Garzarella blk_aio_pdiscard(s->blk, sector << BDRV_SECTOR_BITS, bytes, 59737b06f8dSStefano Garzarella virtio_blk_discard_write_zeroes_complete, req); 59837b06f8dSStefano Garzarella } 59937b06f8dSStefano Garzarella 60037b06f8dSStefano Garzarella return VIRTIO_BLK_S_OK; 60137b06f8dSStefano Garzarella 60237b06f8dSStefano Garzarella err: 60337b06f8dSStefano Garzarella if (is_write_zeroes) { 60437b06f8dSStefano Garzarella block_acct_invalid(blk_get_stats(s->blk), BLOCK_ACCT_WRITE); 60537b06f8dSStefano Garzarella } 60637b06f8dSStefano Garzarella return err_status; 60737b06f8dSStefano Garzarella } 60837b06f8dSStefano Garzarella 60920ea686aSGreg Kurz static int virtio_blk_handle_request(VirtIOBlockReq *req, MultiReqBuffer *mrb) 6106e790746SPaolo Bonzini { 6116e790746SPaolo Bonzini uint32_t type; 612f897bf75SStefan Hajnoczi struct iovec *in_iov = req->elem.in_sg; 6135636da76SDongli Zhang struct iovec *out_iov = req->elem.out_sg; 614f897bf75SStefan Hajnoczi unsigned in_num = req->elem.in_num; 615f897bf75SStefan Hajnoczi unsigned out_num = req->elem.out_num; 61620ea686aSGreg Kurz VirtIOBlock *s = req->dev; 61720ea686aSGreg Kurz VirtIODevice *vdev = VIRTIO_DEVICE(s); 6186e790746SPaolo Bonzini 619f897bf75SStefan Hajnoczi if (req->elem.out_num < 1 || req->elem.in_num < 1) { 62020ea686aSGreg Kurz virtio_error(vdev, "virtio-blk missing headers"); 62120ea686aSGreg Kurz return -1; 6226e790746SPaolo Bonzini } 6236e790746SPaolo Bonzini 6245636da76SDongli Zhang if (unlikely(iov_to_buf(out_iov, out_num, 0, &req->out, 625827805a2SFam Zheng sizeof(req->out)) != sizeof(req->out))) { 62620ea686aSGreg Kurz virtio_error(vdev, "virtio-blk request outhdr too short"); 62720ea686aSGreg Kurz return -1; 628827805a2SFam Zheng } 629ee17e848SFam Zheng 6305636da76SDongli Zhang iov_discard_front(&out_iov, &out_num, sizeof(req->out)); 631ee17e848SFam Zheng 63212048545SGonglei if (in_iov[in_num - 1].iov_len < sizeof(struct virtio_blk_inhdr)) { 63320ea686aSGreg Kurz virtio_error(vdev, "virtio-blk request inhdr too short"); 63420ea686aSGreg Kurz return -1; 635ee17e848SFam Zheng } 636ee17e848SFam Zheng 6372a6cdd6dSPaolo Bonzini /* We always touch the last byte, so just see how big in_iov is. */ 6382a6cdd6dSPaolo Bonzini req->in_len = iov_size(in_iov, in_num); 639ee17e848SFam Zheng req->in = (void *)in_iov[in_num - 1].iov_base 640ee17e848SFam Zheng + in_iov[in_num - 1].iov_len 641ee17e848SFam Zheng - sizeof(struct virtio_blk_inhdr); 642ee17e848SFam Zheng iov_discard_back(in_iov, &in_num, sizeof(struct virtio_blk_inhdr)); 6436e790746SPaolo Bonzini 6449a6719d5SStefano Garzarella type = virtio_ldl_p(vdev, &req->out.type); 6456e790746SPaolo Bonzini 64695f7142aSPeter Lieven /* VIRTIO_BLK_T_OUT defines the command direction. VIRTIO_BLK_T_BARRIER 647631b22eaSStefan Weil * is an optional flag. Although a guest should not send this flag if 64895f7142aSPeter Lieven * not negotiated we ignored it in the past. So keep ignoring it. */ 64995f7142aSPeter Lieven switch (type & ~(VIRTIO_BLK_T_OUT | VIRTIO_BLK_T_BARRIER)) { 65095f7142aSPeter Lieven case VIRTIO_BLK_T_IN: 65195f7142aSPeter Lieven { 65295f7142aSPeter Lieven bool is_write = type & VIRTIO_BLK_T_OUT; 6539a6719d5SStefano Garzarella req->sector_num = virtio_ldq_p(vdev, &req->out.sector); 65495f7142aSPeter Lieven 65595f7142aSPeter Lieven if (is_write) { 6565636da76SDongli Zhang qemu_iovec_init_external(&req->qiov, out_iov, out_num); 657a576ceacSStefan Hajnoczi trace_virtio_blk_handle_write(vdev, req, req->sector_num, 65895f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 65995f7142aSPeter Lieven } else { 66095f7142aSPeter Lieven qemu_iovec_init_external(&req->qiov, in_iov, in_num); 661a576ceacSStefan Hajnoczi trace_virtio_blk_handle_read(vdev, req, req->sector_num, 66295f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 66395f7142aSPeter Lieven } 66495f7142aSPeter Lieven 6659a6719d5SStefano Garzarella if (!virtio_blk_sect_range_ok(s, req->sector_num, req->qiov.size)) { 66695f7142aSPeter Lieven virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 6679a6719d5SStefano Garzarella block_acct_invalid(blk_get_stats(s->blk), 66801762e03SAlberto Garcia is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 66995f7142aSPeter Lieven virtio_blk_free_request(req); 67020ea686aSGreg Kurz return 0; 67195f7142aSPeter Lieven } 67295f7142aSPeter Lieven 6739a6719d5SStefano Garzarella block_acct_start(blk_get_stats(s->blk), &req->acct, req->qiov.size, 67495f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 67595f7142aSPeter Lieven 67695f7142aSPeter Lieven /* merge would exceed maximum number of requests or IO direction 67795f7142aSPeter Lieven * changes */ 67895f7142aSPeter Lieven if (mrb->num_reqs > 0 && (mrb->num_reqs == VIRTIO_BLK_MAX_MERGE_REQS || 679c99495acSPeter Lieven is_write != mrb->is_write || 6809a6719d5SStefano Garzarella !s->conf.request_merging)) { 6819a6719d5SStefano Garzarella virtio_blk_submit_multireq(s->blk, mrb); 68295f7142aSPeter Lieven } 68395f7142aSPeter Lieven 68495f7142aSPeter Lieven assert(mrb->num_reqs < VIRTIO_BLK_MAX_MERGE_REQS); 68595f7142aSPeter Lieven mrb->reqs[mrb->num_reqs++] = req; 68695f7142aSPeter Lieven mrb->is_write = is_write; 68795f7142aSPeter Lieven break; 68895f7142aSPeter Lieven } 68995f7142aSPeter Lieven case VIRTIO_BLK_T_FLUSH: 6906e790746SPaolo Bonzini virtio_blk_handle_flush(req, mrb); 69195f7142aSPeter Lieven break; 69295f7142aSPeter Lieven case VIRTIO_BLK_T_SCSI_CMD: 6936e790746SPaolo Bonzini virtio_blk_handle_scsi(req); 69495f7142aSPeter Lieven break; 69595f7142aSPeter Lieven case VIRTIO_BLK_T_GET_ID: 69695f7142aSPeter Lieven { 6976e790746SPaolo Bonzini /* 6986e790746SPaolo Bonzini * NB: per existing s/n string convention the string is 6996e790746SPaolo Bonzini * terminated by '\0' only when shorter than buffer. 7006e790746SPaolo Bonzini */ 7012a30307fSMarkus Armbruster const char *serial = s->conf.serial ? s->conf.serial : ""; 702a83ceea8SMarc Marí size_t size = MIN(strlen(serial) + 1, 703a83ceea8SMarc Marí MIN(iov_size(in_iov, in_num), 704a83ceea8SMarc Marí VIRTIO_BLK_ID_BYTES)); 705a83ceea8SMarc Marí iov_from_buf(in_iov, in_num, 0, serial, size); 7066e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 707671ec3f0SFam Zheng virtio_blk_free_request(req); 70895f7142aSPeter Lieven break; 70995f7142aSPeter Lieven } 71037b06f8dSStefano Garzarella /* 71137b06f8dSStefano Garzarella * VIRTIO_BLK_T_DISCARD and VIRTIO_BLK_T_WRITE_ZEROES are defined with 71237b06f8dSStefano Garzarella * VIRTIO_BLK_T_OUT flag set. We masked this flag in the switch statement, 71337b06f8dSStefano Garzarella * so we must mask it for these requests, then we will check if it is set. 71437b06f8dSStefano Garzarella */ 71537b06f8dSStefano Garzarella case VIRTIO_BLK_T_DISCARD & ~VIRTIO_BLK_T_OUT: 71637b06f8dSStefano Garzarella case VIRTIO_BLK_T_WRITE_ZEROES & ~VIRTIO_BLK_T_OUT: 71737b06f8dSStefano Garzarella { 71837b06f8dSStefano Garzarella struct virtio_blk_discard_write_zeroes dwz_hdr; 71937b06f8dSStefano Garzarella size_t out_len = iov_size(out_iov, out_num); 72037b06f8dSStefano Garzarella bool is_write_zeroes = (type & ~VIRTIO_BLK_T_BARRIER) == 72137b06f8dSStefano Garzarella VIRTIO_BLK_T_WRITE_ZEROES; 72237b06f8dSStefano Garzarella uint8_t err_status; 72337b06f8dSStefano Garzarella 72437b06f8dSStefano Garzarella /* 72537b06f8dSStefano Garzarella * Unsupported if VIRTIO_BLK_T_OUT is not set or the request contains 72637b06f8dSStefano Garzarella * more than one segment. 72737b06f8dSStefano Garzarella */ 72837b06f8dSStefano Garzarella if (unlikely(!(type & VIRTIO_BLK_T_OUT) || 72937b06f8dSStefano Garzarella out_len > sizeof(dwz_hdr))) { 73037b06f8dSStefano Garzarella virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 73137b06f8dSStefano Garzarella virtio_blk_free_request(req); 73237b06f8dSStefano Garzarella return 0; 73337b06f8dSStefano Garzarella } 73437b06f8dSStefano Garzarella 73537b06f8dSStefano Garzarella if (unlikely(iov_to_buf(out_iov, out_num, 0, &dwz_hdr, 73637b06f8dSStefano Garzarella sizeof(dwz_hdr)) != sizeof(dwz_hdr))) { 73737b06f8dSStefano Garzarella virtio_error(vdev, "virtio-blk discard/write_zeroes header" 73837b06f8dSStefano Garzarella " too short"); 73937b06f8dSStefano Garzarella return -1; 74037b06f8dSStefano Garzarella } 74137b06f8dSStefano Garzarella 74237b06f8dSStefano Garzarella err_status = virtio_blk_handle_discard_write_zeroes(req, &dwz_hdr, 74337b06f8dSStefano Garzarella is_write_zeroes); 74437b06f8dSStefano Garzarella if (err_status != VIRTIO_BLK_S_OK) { 74537b06f8dSStefano Garzarella virtio_blk_req_complete(req, err_status); 74637b06f8dSStefano Garzarella virtio_blk_free_request(req); 74737b06f8dSStefano Garzarella } 74837b06f8dSStefano Garzarella 74937b06f8dSStefano Garzarella break; 75037b06f8dSStefano Garzarella } 75195f7142aSPeter Lieven default: 7526e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 753671ec3f0SFam Zheng virtio_blk_free_request(req); 7546e790746SPaolo Bonzini } 75520ea686aSGreg Kurz return 0; 7566e790746SPaolo Bonzini } 7576e790746SPaolo Bonzini 75807931698SFam Zheng bool virtio_blk_handle_vq(VirtIOBlock *s, VirtQueue *vq) 7596e790746SPaolo Bonzini { 7606e790746SPaolo Bonzini VirtIOBlockReq *req; 76195f7142aSPeter Lieven MultiReqBuffer mrb = {}; 76207931698SFam Zheng bool progress = false; 7636e790746SPaolo Bonzini 7649d456654SPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->blk)); 765fc73548eSStefan Hajnoczi blk_io_plug(s->blk); 766fc73548eSStefan Hajnoczi 7679ef9d402SStefan Hajnoczi do { 7689ef9d402SStefan Hajnoczi virtio_queue_set_notification(vq, 0); 7699ef9d402SStefan Hajnoczi 770edaffd9fSStefan Hajnoczi while ((req = virtio_blk_get_request(s, vq))) { 77107931698SFam Zheng progress = true; 77220ea686aSGreg Kurz if (virtio_blk_handle_request(req, &mrb)) { 77320ea686aSGreg Kurz virtqueue_detach_element(req->vq, &req->elem, 0); 77420ea686aSGreg Kurz virtio_blk_free_request(req); 77520ea686aSGreg Kurz break; 77620ea686aSGreg Kurz } 7776e790746SPaolo Bonzini } 7786e790746SPaolo Bonzini 7799ef9d402SStefan Hajnoczi virtio_queue_set_notification(vq, 1); 7809ef9d402SStefan Hajnoczi } while (!virtio_queue_empty(vq)); 7819ef9d402SStefan Hajnoczi 78295f7142aSPeter Lieven if (mrb.num_reqs) { 78395f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 78495f7142aSPeter Lieven } 785fc73548eSStefan Hajnoczi 786fc73548eSStefan Hajnoczi blk_io_unplug(s->blk); 7879d456654SPaolo Bonzini aio_context_release(blk_get_aio_context(s->blk)); 78807931698SFam Zheng return progress; 78907931698SFam Zheng } 79007931698SFam Zheng 79107931698SFam Zheng static void virtio_blk_handle_output_do(VirtIOBlock *s, VirtQueue *vq) 79207931698SFam Zheng { 79307931698SFam Zheng virtio_blk_handle_vq(s, vq); 7946e790746SPaolo Bonzini } 7956e790746SPaolo Bonzini 7968a2fad57SMichael S. Tsirkin static void virtio_blk_handle_output(VirtIODevice *vdev, VirtQueue *vq) 7978a2fad57SMichael S. Tsirkin { 7988a2fad57SMichael S. Tsirkin VirtIOBlock *s = (VirtIOBlock *)vdev; 7998a2fad57SMichael S. Tsirkin 8008a2fad57SMichael S. Tsirkin if (s->dataplane) { 8018a2fad57SMichael S. Tsirkin /* Some guests kick before setting VIRTIO_CONFIG_S_DRIVER_OK so start 8028a2fad57SMichael S. Tsirkin * dataplane here instead of waiting for .set_status(). 8038a2fad57SMichael S. Tsirkin */ 8049ffe337cSPaolo Bonzini virtio_device_start_ioeventfd(vdev); 8058a2fad57SMichael S. Tsirkin if (!s->dataplane_disabled) { 8068a2fad57SMichael S. Tsirkin return; 8078a2fad57SMichael S. Tsirkin } 8088a2fad57SMichael S. Tsirkin } 80907931698SFam Zheng virtio_blk_handle_output_do(s, vq); 8108a2fad57SMichael S. Tsirkin } 8118a2fad57SMichael S. Tsirkin 8126e790746SPaolo Bonzini static void virtio_blk_dma_restart_bh(void *opaque) 8136e790746SPaolo Bonzini { 8146e790746SPaolo Bonzini VirtIOBlock *s = opaque; 8156e790746SPaolo Bonzini VirtIOBlockReq *req = s->rq; 81695f7142aSPeter Lieven MultiReqBuffer mrb = {}; 8176e790746SPaolo Bonzini 8186e790746SPaolo Bonzini qemu_bh_delete(s->bh); 8196e790746SPaolo Bonzini s->bh = NULL; 8206e790746SPaolo Bonzini 8216e790746SPaolo Bonzini s->rq = NULL; 8226e790746SPaolo Bonzini 8231919631eSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 8246e790746SPaolo Bonzini while (req) { 8251bdb176aSzhanghailiang VirtIOBlockReq *next = req->next; 82620ea686aSGreg Kurz if (virtio_blk_handle_request(req, &mrb)) { 82720ea686aSGreg Kurz /* Device is now broken and won't do any processing until it gets 82820ea686aSGreg Kurz * reset. Already queued requests will be lost: let's purge them. 82920ea686aSGreg Kurz */ 83020ea686aSGreg Kurz while (req) { 83120ea686aSGreg Kurz next = req->next; 83220ea686aSGreg Kurz virtqueue_detach_element(req->vq, &req->elem, 0); 83320ea686aSGreg Kurz virtio_blk_free_request(req); 83420ea686aSGreg Kurz req = next; 83520ea686aSGreg Kurz } 83620ea686aSGreg Kurz break; 83720ea686aSGreg Kurz } 8381bdb176aSzhanghailiang req = next; 8396e790746SPaolo Bonzini } 8406e790746SPaolo Bonzini 84195f7142aSPeter Lieven if (mrb.num_reqs) { 84295f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 84395f7142aSPeter Lieven } 844680f2002SKevin Wolf blk_dec_in_flight(s->conf.conf.blk); 8451919631eSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 8466e790746SPaolo Bonzini } 8476e790746SPaolo Bonzini 8486e790746SPaolo Bonzini static void virtio_blk_dma_restart_cb(void *opaque, int running, 8496e790746SPaolo Bonzini RunState state) 8506e790746SPaolo Bonzini { 8516e790746SPaolo Bonzini VirtIOBlock *s = opaque; 8526e790746SPaolo Bonzini 8536e790746SPaolo Bonzini if (!running) { 8546e790746SPaolo Bonzini return; 8556e790746SPaolo Bonzini } 8566e790746SPaolo Bonzini 8576e790746SPaolo Bonzini if (!s->bh) { 858680f2002SKevin Wolf /* FIXME The data plane is not started yet, so these requests are 859680f2002SKevin Wolf * processed in the main thread. */ 8604be74634SMarkus Armbruster s->bh = aio_bh_new(blk_get_aio_context(s->conf.conf.blk), 8614407c1c5SFam Zheng virtio_blk_dma_restart_bh, s); 862680f2002SKevin Wolf blk_inc_in_flight(s->conf.conf.blk); 8636e790746SPaolo Bonzini qemu_bh_schedule(s->bh); 8646e790746SPaolo Bonzini } 8656e790746SPaolo Bonzini } 8666e790746SPaolo Bonzini 8676e790746SPaolo Bonzini static void virtio_blk_reset(VirtIODevice *vdev) 8686e790746SPaolo Bonzini { 8696e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 8706e40b3bfSAlexander Yarygin AioContext *ctx; 87126307f6aSFam Zheng VirtIOBlockReq *req; 8726e790746SPaolo Bonzini 8736e40b3bfSAlexander Yarygin ctx = blk_get_aio_context(s->blk); 8746e40b3bfSAlexander Yarygin aio_context_acquire(ctx); 8756e40b3bfSAlexander Yarygin blk_drain(s->blk); 8766e40b3bfSAlexander Yarygin 87726307f6aSFam Zheng /* We drop queued requests after blk_drain() because blk_drain() itself can 87826307f6aSFam Zheng * produce them. */ 87926307f6aSFam Zheng while (s->rq) { 88026307f6aSFam Zheng req = s->rq; 88126307f6aSFam Zheng s->rq = req->next; 88297b93c8aSStefan Hajnoczi virtqueue_detach_element(req->vq, &req->elem, 0); 88326307f6aSFam Zheng virtio_blk_free_request(req); 88426307f6aSFam Zheng } 88526307f6aSFam Zheng 8866e40b3bfSAlexander Yarygin aio_context_release(ctx); 8876e40b3bfSAlexander Yarygin 8889ffe337cSPaolo Bonzini assert(!s->dataplane_started); 8894be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, s->original_wce); 8906e790746SPaolo Bonzini } 8916e790746SPaolo Bonzini 8926e790746SPaolo Bonzini /* coalesce internal state, copy to pci i/o region 0 8936e790746SPaolo Bonzini */ 8946e790746SPaolo Bonzini static void virtio_blk_update_config(VirtIODevice *vdev, uint8_t *config) 8956e790746SPaolo Bonzini { 8966e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 8972a30307fSMarkus Armbruster BlockConf *conf = &s->conf.conf; 8986e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 8996e790746SPaolo Bonzini uint64_t capacity; 90017d0bc01SStefan Hajnoczi int64_t length; 901f7516731SMarkus Armbruster int blk_size = conf->logical_block_size; 9026e790746SPaolo Bonzini 9034be74634SMarkus Armbruster blk_get_geometry(s->blk, &capacity); 9046e790746SPaolo Bonzini memset(&blkcfg, 0, sizeof(blkcfg)); 905783d1897SRusty Russell virtio_stq_p(vdev, &blkcfg.capacity, capacity); 906783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.seg_max, 128 - 2); 907907eb3e5SMichael S. Tsirkin virtio_stw_p(vdev, &blkcfg.geometry.cylinders, conf->cyls); 908783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.blk_size, blk_size); 909f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.min_io_size, conf->min_io_size / blk_size); 910f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.opt_io_size, conf->opt_io_size / blk_size); 911907eb3e5SMichael S. Tsirkin blkcfg.geometry.heads = conf->heads; 9126e790746SPaolo Bonzini /* 9136e790746SPaolo Bonzini * We must ensure that the block device capacity is a multiple of 914e03ba136SPeter Maydell * the logical block size. If that is not the case, let's use 9156e790746SPaolo Bonzini * sector_mask to adopt the geometry to have a correct picture. 9166e790746SPaolo Bonzini * For those devices where the capacity is ok for the given geometry 917e03ba136SPeter Maydell * we don't touch the sector value of the geometry, since some devices 9186e790746SPaolo Bonzini * (like s390 dasd) need a specific value. Here the capacity is already 9196e790746SPaolo Bonzini * cyls*heads*secs*blk_size and the sector value is not block size 9206e790746SPaolo Bonzini * divided by 512 - instead it is the amount of blk_size blocks 9216e790746SPaolo Bonzini * per track (cylinder). 9226e790746SPaolo Bonzini */ 92317d0bc01SStefan Hajnoczi length = blk_getlength(s->blk); 92417d0bc01SStefan Hajnoczi if (length > 0 && length / conf->heads / conf->secs % blk_size) { 925907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs & ~s->sector_mask; 9266e790746SPaolo Bonzini } else { 927907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs; 9286e790746SPaolo Bonzini } 9296e790746SPaolo Bonzini blkcfg.size_max = 0; 930f7516731SMarkus Armbruster blkcfg.physical_block_exp = get_physical_block_exp(conf); 9316e790746SPaolo Bonzini blkcfg.alignment_offset = 0; 9324be74634SMarkus Armbruster blkcfg.wce = blk_enable_write_cache(s->blk); 9332f270590SStefan Hajnoczi virtio_stw_p(vdev, &blkcfg.num_queues, s->conf.num_queues); 93437b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_DISCARD)) { 93537b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_discard_sectors, 93637b06f8dSStefano Garzarella s->conf.max_discard_sectors); 93737b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.discard_sector_alignment, 93837b06f8dSStefano Garzarella blk_size >> BDRV_SECTOR_BITS); 93937b06f8dSStefano Garzarella /* 94037b06f8dSStefano Garzarella * We support only one segment per request since multiple segments 94137b06f8dSStefano Garzarella * are not widely used and there are no userspace APIs that allow 94237b06f8dSStefano Garzarella * applications to submit multiple segments in a single call. 94337b06f8dSStefano Garzarella */ 94437b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_discard_seg, 1); 94537b06f8dSStefano Garzarella } 94637b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_WRITE_ZEROES)) { 94737b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_write_zeroes_sectors, 94837b06f8dSStefano Garzarella s->conf.max_write_zeroes_sectors); 94937b06f8dSStefano Garzarella blkcfg.write_zeroes_may_unmap = 1; 95037b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_write_zeroes_seg, 1); 95137b06f8dSStefano Garzarella } 95220764be0SStefano Garzarella memcpy(config, &blkcfg, s->config_size); 9536e790746SPaolo Bonzini } 9546e790746SPaolo Bonzini 9556e790746SPaolo Bonzini static void virtio_blk_set_config(VirtIODevice *vdev, const uint8_t *config) 9566e790746SPaolo Bonzini { 9576e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 9586e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 9596e790746SPaolo Bonzini 96020764be0SStefano Garzarella memcpy(&blkcfg, config, s->config_size); 9616d7e73d6SFam Zheng 9624be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 9634be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, blkcfg.wce != 0); 9644be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 9656e790746SPaolo Bonzini } 9666e790746SPaolo Bonzini 9679d5b731dSJason Wang static uint64_t virtio_blk_get_features(VirtIODevice *vdev, uint64_t features, 9689d5b731dSJason Wang Error **errp) 9696e790746SPaolo Bonzini { 9706e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 9716e790746SPaolo Bonzini 972bbe8bd4dSStefano Garzarella /* Firstly sync all virtio-blk possible supported features */ 973bbe8bd4dSStefano Garzarella features |= s->host_features; 974bbe8bd4dSStefano Garzarella 9750cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_SEG_MAX); 9760cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_GEOMETRY); 9770cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_TOPOLOGY); 9780cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_BLK_SIZE); 97995129d6fSCornelia Huck if (virtio_has_feature(features, VIRTIO_F_VERSION_1)) { 980bbe8bd4dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_SCSI)) { 981efb8206cSJason Wang error_setg(errp, "Please set scsi=off for virtio-blk devices in order to use virtio 1.0"); 982efb8206cSJason Wang return 0; 983efb8206cSJason Wang } 984efb8206cSJason Wang } else { 985c9b11f97SJason Wang virtio_clear_feature(&features, VIRTIO_F_ANY_LAYOUT); 986efb8206cSJason Wang virtio_add_feature(&features, VIRTIO_BLK_F_SCSI); 987efb8206cSJason Wang } 9886e790746SPaolo Bonzini 9894be74634SMarkus Armbruster if (blk_enable_write_cache(s->blk)) { 9900cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_WCE); 9914be74634SMarkus Armbruster } 9924be74634SMarkus Armbruster if (blk_is_read_only(s->blk)) { 9930cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_RO); 9944be74634SMarkus Armbruster } 9952f270590SStefan Hajnoczi if (s->conf.num_queues > 1) { 9962f270590SStefan Hajnoczi virtio_add_feature(&features, VIRTIO_BLK_F_MQ); 9972f270590SStefan Hajnoczi } 9986e790746SPaolo Bonzini 9996e790746SPaolo Bonzini return features; 10006e790746SPaolo Bonzini } 10016e790746SPaolo Bonzini 10026e790746SPaolo Bonzini static void virtio_blk_set_status(VirtIODevice *vdev, uint8_t status) 10036e790746SPaolo Bonzini { 10046e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 10056e790746SPaolo Bonzini 10069ffe337cSPaolo Bonzini if (!(status & (VIRTIO_CONFIG_S_DRIVER | VIRTIO_CONFIG_S_DRIVER_OK))) { 10079ffe337cSPaolo Bonzini assert(!s->dataplane_started); 10086e790746SPaolo Bonzini } 10096e790746SPaolo Bonzini 10106e790746SPaolo Bonzini if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { 10116e790746SPaolo Bonzini return; 10126e790746SPaolo Bonzini } 10136e790746SPaolo Bonzini 1014ef5bc962SPaolo Bonzini /* A guest that supports VIRTIO_BLK_F_CONFIG_WCE must be able to send 1015ef5bc962SPaolo Bonzini * cache flushes. Thus, the "auto writethrough" behavior is never 1016ef5bc962SPaolo Bonzini * necessary for guests that support the VIRTIO_BLK_F_CONFIG_WCE feature. 1017ef5bc962SPaolo Bonzini * Leaving it enabled would break the following sequence: 1018ef5bc962SPaolo Bonzini * 1019ef5bc962SPaolo Bonzini * Guest started with "-drive cache=writethrough" 1020ef5bc962SPaolo Bonzini * Guest sets status to 0 1021ef5bc962SPaolo Bonzini * Guest sets DRIVER bit in status field 1022ef5bc962SPaolo Bonzini * Guest reads host features (WCE=0, CONFIG_WCE=1) 1023ef5bc962SPaolo Bonzini * Guest writes guest features (WCE=0, CONFIG_WCE=1) 1024ef5bc962SPaolo Bonzini * Guest writes 1 to the WCE configuration field (writeback mode) 1025ef5bc962SPaolo Bonzini * Guest sets DRIVER_OK bit in status field 1026ef5bc962SPaolo Bonzini * 10274be74634SMarkus Armbruster * s->blk would erroneously be placed in writethrough mode. 1028ef5bc962SPaolo Bonzini */ 102995129d6fSCornelia Huck if (!virtio_vdev_has_feature(vdev, VIRTIO_BLK_F_CONFIG_WCE)) { 10304be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 10314be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, 103295129d6fSCornelia Huck virtio_vdev_has_feature(vdev, 103395129d6fSCornelia Huck VIRTIO_BLK_F_WCE)); 10344be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 10356e790746SPaolo Bonzini } 1036ef5bc962SPaolo Bonzini } 10376e790746SPaolo Bonzini 1038b2b295a7SGreg Kurz static void virtio_blk_save_device(VirtIODevice *vdev, QEMUFile *f) 1039b2b295a7SGreg Kurz { 1040b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 1041b2b295a7SGreg Kurz VirtIOBlockReq *req = s->rq; 10426e790746SPaolo Bonzini 10436e790746SPaolo Bonzini while (req) { 10446e790746SPaolo Bonzini qemu_put_sbyte(f, 1); 104530d8bf6dSStefan Hajnoczi 104630d8bf6dSStefan Hajnoczi if (s->conf.num_queues > 1) { 104730d8bf6dSStefan Hajnoczi qemu_put_be32(f, virtio_get_queue_index(req->vq)); 104830d8bf6dSStefan Hajnoczi } 104930d8bf6dSStefan Hajnoczi 1050ab281c17SPaolo Bonzini qemu_put_virtqueue_element(f, &req->elem); 10516e790746SPaolo Bonzini req = req->next; 10526e790746SPaolo Bonzini } 10536e790746SPaolo Bonzini qemu_put_sbyte(f, 0); 10546e790746SPaolo Bonzini } 10556e790746SPaolo Bonzini 1056b2b295a7SGreg Kurz static int virtio_blk_load_device(VirtIODevice *vdev, QEMUFile *f, 1057b2b295a7SGreg Kurz int version_id) 1058b2b295a7SGreg Kurz { 1059b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 1060b2b295a7SGreg Kurz 10616e790746SPaolo Bonzini while (qemu_get_sbyte(f)) { 106230d8bf6dSStefan Hajnoczi unsigned nvqs = s->conf.num_queues; 106330d8bf6dSStefan Hajnoczi unsigned vq_idx = 0; 1064ab281c17SPaolo Bonzini VirtIOBlockReq *req; 106530d8bf6dSStefan Hajnoczi 106630d8bf6dSStefan Hajnoczi if (nvqs > 1) { 106730d8bf6dSStefan Hajnoczi vq_idx = qemu_get_be32(f); 106830d8bf6dSStefan Hajnoczi 106930d8bf6dSStefan Hajnoczi if (vq_idx >= nvqs) { 107030d8bf6dSStefan Hajnoczi error_report("Invalid virtqueue index in request list: %#x", 107130d8bf6dSStefan Hajnoczi vq_idx); 107230d8bf6dSStefan Hajnoczi return -EINVAL; 107330d8bf6dSStefan Hajnoczi } 107430d8bf6dSStefan Hajnoczi } 107530d8bf6dSStefan Hajnoczi 10768607f5c3SJason Wang req = qemu_get_virtqueue_element(vdev, f, sizeof(VirtIOBlockReq)); 107730d8bf6dSStefan Hajnoczi virtio_blk_init_request(s, virtio_get_queue(vdev, vq_idx), req); 10786e790746SPaolo Bonzini req->next = s->rq; 10796e790746SPaolo Bonzini s->rq = req; 10806e790746SPaolo Bonzini } 10816e790746SPaolo Bonzini 10826e790746SPaolo Bonzini return 0; 10836e790746SPaolo Bonzini } 10846e790746SPaolo Bonzini 10856e790746SPaolo Bonzini static void virtio_blk_resize(void *opaque) 10866e790746SPaolo Bonzini { 10876e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 10886e790746SPaolo Bonzini 10896e790746SPaolo Bonzini virtio_notify_config(vdev); 10906e790746SPaolo Bonzini } 10916e790746SPaolo Bonzini 10926e790746SPaolo Bonzini static const BlockDevOps virtio_block_ops = { 10936e790746SPaolo Bonzini .resize_cb = virtio_blk_resize, 10946e790746SPaolo Bonzini }; 10956e790746SPaolo Bonzini 109675884afdSAndreas Färber static void virtio_blk_device_realize(DeviceState *dev, Error **errp) 10976e790746SPaolo Bonzini { 109875884afdSAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 1099179b417eSAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 11002a30307fSMarkus Armbruster VirtIOBlkConf *conf = &s->conf; 11013ffeeef7SAndreas Färber Error *err = NULL; 11022f270590SStefan Hajnoczi unsigned i; 11036e790746SPaolo Bonzini 11044be74634SMarkus Armbruster if (!conf->conf.blk) { 110575884afdSAndreas Färber error_setg(errp, "drive property not set"); 110675884afdSAndreas Färber return; 11076e790746SPaolo Bonzini } 11084be74634SMarkus Armbruster if (!blk_is_inserted(conf->conf.blk)) { 110975884afdSAndreas Färber error_setg(errp, "Device needs media, but drive is empty"); 111075884afdSAndreas Färber return; 11116e790746SPaolo Bonzini } 11122f270590SStefan Hajnoczi if (!conf->num_queues) { 11132f270590SStefan Hajnoczi error_setg(errp, "num-queues property must be larger than 0"); 11142f270590SStefan Hajnoczi return; 11152f270590SStefan Hajnoczi } 11166040aeddSMark Kanda if (!is_power_of_2(conf->queue_size) || 11176040aeddSMark Kanda conf->queue_size > VIRTQUEUE_MAX_SIZE) { 11186040aeddSMark Kanda error_setg(errp, "invalid queue-size property (%" PRIu16 "), " 11196040aeddSMark Kanda "must be a power of 2 (max %d)", 11206040aeddSMark Kanda conf->queue_size, VIRTQUEUE_MAX_SIZE); 11216040aeddSMark Kanda return; 11226040aeddSMark Kanda } 11236e790746SPaolo Bonzini 1124ceff3e1fSMao Zhongyi if (!blkconf_apply_backend_options(&conf->conf, 1125a17c17a2SKevin Wolf blk_is_read_only(conf->conf.blk), true, 1126ceff3e1fSMao Zhongyi errp)) { 1127a17c17a2SKevin Wolf return; 1128a17c17a2SKevin Wolf } 11294be74634SMarkus Armbruster s->original_wce = blk_enable_write_cache(conf->conf.blk); 1130ceff3e1fSMao Zhongyi if (!blkconf_geometry(&conf->conf, NULL, 65535, 255, 255, errp)) { 113175884afdSAndreas Färber return; 11326e790746SPaolo Bonzini } 1133ceff3e1fSMao Zhongyi 11340eb28a42SEkaterina Tumanova blkconf_blocksizes(&conf->conf); 11356e790746SPaolo Bonzini 11360a75b60cSMark Kanda if (conf->conf.logical_block_size > 11370a75b60cSMark Kanda conf->conf.physical_block_size) { 11380a75b60cSMark Kanda error_setg(errp, 11390a75b60cSMark Kanda "logical_block_size > physical_block_size not supported"); 11400a75b60cSMark Kanda return; 11410a75b60cSMark Kanda } 11420a75b60cSMark Kanda 114337b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_DISCARD) && 114437b06f8dSStefano Garzarella (!conf->max_discard_sectors || 114537b06f8dSStefano Garzarella conf->max_discard_sectors > BDRV_REQUEST_MAX_SECTORS)) { 114637b06f8dSStefano Garzarella error_setg(errp, "invalid max-discard-sectors property (%" PRIu32 ")" 114737b06f8dSStefano Garzarella ", must be between 1 and %d", 114837b06f8dSStefano Garzarella conf->max_discard_sectors, (int)BDRV_REQUEST_MAX_SECTORS); 114937b06f8dSStefano Garzarella return; 115037b06f8dSStefano Garzarella } 115137b06f8dSStefano Garzarella 115237b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_WRITE_ZEROES) && 115337b06f8dSStefano Garzarella (!conf->max_write_zeroes_sectors || 115437b06f8dSStefano Garzarella conf->max_write_zeroes_sectors > BDRV_REQUEST_MAX_SECTORS)) { 115537b06f8dSStefano Garzarella error_setg(errp, "invalid max-write-zeroes-sectors property (%" PRIu32 115637b06f8dSStefano Garzarella "), must be between 1 and %d", 115737b06f8dSStefano Garzarella conf->max_write_zeroes_sectors, 115837b06f8dSStefano Garzarella (int)BDRV_REQUEST_MAX_SECTORS); 115937b06f8dSStefano Garzarella return; 116037b06f8dSStefano Garzarella } 116137b06f8dSStefano Garzarella 116220764be0SStefano Garzarella virtio_blk_set_config_size(s, s->host_features); 116320764be0SStefano Garzarella 116420764be0SStefano Garzarella virtio_init(vdev, "virtio-blk", VIRTIO_ID_BLOCK, s->config_size); 11656e790746SPaolo Bonzini 11664be74634SMarkus Armbruster s->blk = conf->conf.blk; 11676e790746SPaolo Bonzini s->rq = NULL; 11682a30307fSMarkus Armbruster s->sector_mask = (s->conf.conf.logical_block_size / BDRV_SECTOR_SIZE) - 1; 11696e790746SPaolo Bonzini 11702f270590SStefan Hajnoczi for (i = 0; i < conf->num_queues; i++) { 11716040aeddSMark Kanda virtio_add_queue(vdev, conf->queue_size, virtio_blk_handle_output); 11722f270590SStefan Hajnoczi } 11732a30307fSMarkus Armbruster virtio_blk_data_plane_create(vdev, conf, &s->dataplane, &err); 11743ffeeef7SAndreas Färber if (err != NULL) { 117575884afdSAndreas Färber error_propagate(errp, err); 11766a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 117775884afdSAndreas Färber return; 11786e790746SPaolo Bonzini } 11796e790746SPaolo Bonzini 11806e790746SPaolo Bonzini s->change = qemu_add_vm_change_state_handler(virtio_blk_dma_restart_cb, s); 11814be74634SMarkus Armbruster blk_set_dev_ops(s->blk, &virtio_block_ops, s); 11824be74634SMarkus Armbruster blk_set_guest_block_size(s->blk, s->conf.conf.logical_block_size); 11836e790746SPaolo Bonzini 11844be74634SMarkus Armbruster blk_iostatus_enable(s->blk); 11856e790746SPaolo Bonzini } 11866e790746SPaolo Bonzini 1187306ec6c3SAndreas Färber static void virtio_blk_device_unrealize(DeviceState *dev, Error **errp) 11886e790746SPaolo Bonzini { 1189306ec6c3SAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 1190306ec6c3SAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 1191306ec6c3SAndreas Färber 11926e790746SPaolo Bonzini virtio_blk_data_plane_destroy(s->dataplane); 11936e790746SPaolo Bonzini s->dataplane = NULL; 11946e790746SPaolo Bonzini qemu_del_vm_change_state_handler(s->change); 11954be74634SMarkus Armbruster blockdev_mark_auto_del(s->blk); 11966a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 11976e790746SPaolo Bonzini } 11986e790746SPaolo Bonzini 1199467b3f33SStefan Hajnoczi static void virtio_blk_instance_init(Object *obj) 1200467b3f33SStefan Hajnoczi { 1201467b3f33SStefan Hajnoczi VirtIOBlock *s = VIRTIO_BLK(obj); 1202467b3f33SStefan Hajnoczi 12032a30307fSMarkus Armbruster device_add_bootindex_property(obj, &s->conf.conf.bootindex, 12043342ec32SGonglei "bootindex", "/disk@0,0", 12053342ec32SGonglei DEVICE(obj), NULL); 1206467b3f33SStefan Hajnoczi } 1207467b3f33SStefan Hajnoczi 1208977a117fSHalil Pasic static const VMStateDescription vmstate_virtio_blk = { 1209977a117fSHalil Pasic .name = "virtio-blk", 1210977a117fSHalil Pasic .minimum_version_id = 2, 1211977a117fSHalil Pasic .version_id = 2, 1212977a117fSHalil Pasic .fields = (VMStateField[]) { 1213977a117fSHalil Pasic VMSTATE_VIRTIO_DEVICE, 1214977a117fSHalil Pasic VMSTATE_END_OF_LIST() 1215977a117fSHalil Pasic }, 1216977a117fSHalil Pasic }; 1217bbded32cSDr. David Alan Gilbert 12186e790746SPaolo Bonzini static Property virtio_blk_properties[] = { 12192a30307fSMarkus Armbruster DEFINE_BLOCK_PROPERTIES(VirtIOBlock, conf.conf), 12208c398252SKevin Wolf DEFINE_BLOCK_ERROR_PROPERTIES(VirtIOBlock, conf.conf), 12212a30307fSMarkus Armbruster DEFINE_BLOCK_CHS_PROPERTIES(VirtIOBlock, conf.conf), 12222a30307fSMarkus Armbruster DEFINE_PROP_STRING("serial", VirtIOBlock, conf.serial), 1223bbe8bd4dSStefano Garzarella DEFINE_PROP_BIT64("config-wce", VirtIOBlock, host_features, 1224bbe8bd4dSStefano Garzarella VIRTIO_BLK_F_CONFIG_WCE, true), 122532a877e4SStefan Hajnoczi #ifdef __linux__ 1226bbe8bd4dSStefano Garzarella DEFINE_PROP_BIT64("scsi", VirtIOBlock, host_features, 1227bbe8bd4dSStefano Garzarella VIRTIO_BLK_F_SCSI, false), 122832a877e4SStefan Hajnoczi #endif 1229c99495acSPeter Lieven DEFINE_PROP_BIT("request-merging", VirtIOBlock, conf.request_merging, 0, 1230c99495acSPeter Lieven true), 12312f270590SStefan Hajnoczi DEFINE_PROP_UINT16("num-queues", VirtIOBlock, conf.num_queues, 1), 12326040aeddSMark Kanda DEFINE_PROP_UINT16("queue-size", VirtIOBlock, conf.queue_size, 128), 1233d679ac09SFam Zheng DEFINE_PROP_LINK("iothread", VirtIOBlock, conf.iothread, TYPE_IOTHREAD, 1234d679ac09SFam Zheng IOThread *), 12355c81161fSStefano Garzarella DEFINE_PROP_BIT64("discard", VirtIOBlock, host_features, 12365c81161fSStefano Garzarella VIRTIO_BLK_F_DISCARD, true), 12375c81161fSStefano Garzarella DEFINE_PROP_BIT64("write-zeroes", VirtIOBlock, host_features, 12385c81161fSStefano Garzarella VIRTIO_BLK_F_WRITE_ZEROES, true), 123937b06f8dSStefano Garzarella DEFINE_PROP_UINT32("max-discard-sectors", VirtIOBlock, 124037b06f8dSStefano Garzarella conf.max_discard_sectors, BDRV_REQUEST_MAX_SECTORS), 124137b06f8dSStefano Garzarella DEFINE_PROP_UINT32("max-write-zeroes-sectors", VirtIOBlock, 124237b06f8dSStefano Garzarella conf.max_write_zeroes_sectors, BDRV_REQUEST_MAX_SECTORS), 12436e790746SPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 12446e790746SPaolo Bonzini }; 12456e790746SPaolo Bonzini 12466e790746SPaolo Bonzini static void virtio_blk_class_init(ObjectClass *klass, void *data) 12476e790746SPaolo Bonzini { 12486e790746SPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 12496e790746SPaolo Bonzini VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); 125075884afdSAndreas Färber 12516e790746SPaolo Bonzini dc->props = virtio_blk_properties; 1252bbded32cSDr. David Alan Gilbert dc->vmsd = &vmstate_virtio_blk; 1253125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 125475884afdSAndreas Färber vdc->realize = virtio_blk_device_realize; 1255306ec6c3SAndreas Färber vdc->unrealize = virtio_blk_device_unrealize; 12566e790746SPaolo Bonzini vdc->get_config = virtio_blk_update_config; 12576e790746SPaolo Bonzini vdc->set_config = virtio_blk_set_config; 12586e790746SPaolo Bonzini vdc->get_features = virtio_blk_get_features; 12596e790746SPaolo Bonzini vdc->set_status = virtio_blk_set_status; 12606e790746SPaolo Bonzini vdc->reset = virtio_blk_reset; 1261b2b295a7SGreg Kurz vdc->save = virtio_blk_save_device; 1262b2b295a7SGreg Kurz vdc->load = virtio_blk_load_device; 12639ffe337cSPaolo Bonzini vdc->start_ioeventfd = virtio_blk_data_plane_start; 12649ffe337cSPaolo Bonzini vdc->stop_ioeventfd = virtio_blk_data_plane_stop; 12656e790746SPaolo Bonzini } 12666e790746SPaolo Bonzini 1267b5c7ceafSChanglong Xie static const TypeInfo virtio_blk_info = { 12686e790746SPaolo Bonzini .name = TYPE_VIRTIO_BLK, 12696e790746SPaolo Bonzini .parent = TYPE_VIRTIO_DEVICE, 12706e790746SPaolo Bonzini .instance_size = sizeof(VirtIOBlock), 1271467b3f33SStefan Hajnoczi .instance_init = virtio_blk_instance_init, 12726e790746SPaolo Bonzini .class_init = virtio_blk_class_init, 12736e790746SPaolo Bonzini }; 12746e790746SPaolo Bonzini 12756e790746SPaolo Bonzini static void virtio_register_types(void) 12766e790746SPaolo Bonzini { 1277b5c7ceafSChanglong Xie type_register_static(&virtio_blk_info); 12786e790746SPaolo Bonzini } 12796e790746SPaolo Bonzini 12806e790746SPaolo Bonzini type_init(virtio_register_types) 1281