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" 16827805a2SFam Zheng #include "qemu/iov.h" 170b8fa32fSMarkus Armbruster #include "qemu/module.h" 186e790746SPaolo Bonzini #include "qemu/error-report.h" 196e790746SPaolo Bonzini #include "trace.h" 206e790746SPaolo Bonzini #include "hw/block/block.h" 21*a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h" 226e790746SPaolo Bonzini #include "sysemu/blockdev.h" 236e790746SPaolo Bonzini #include "hw/virtio/virtio-blk.h" 246e790746SPaolo Bonzini #include "dataplane/virtio-blk.h" 2508e2c9f1SPaolo Bonzini #include "scsi/constants.h" 266e790746SPaolo Bonzini #ifdef __linux__ 276e790746SPaolo Bonzini # include <scsi/sg.h> 286e790746SPaolo Bonzini #endif 296e790746SPaolo Bonzini #include "hw/virtio/virtio-bus.h" 30ca77ee28SMarkus Armbruster #include "migration/qemu-file-types.h" 31783d1897SRusty Russell #include "hw/virtio/virtio-access.h" 326e790746SPaolo Bonzini 3320764be0SStefano Garzarella /* Config size before the discard support (hide associated config fields) */ 3442824b4dSChangpeng Liu #define VIRTIO_BLK_CFG_SIZE offsetof(struct virtio_blk_config, \ 3542824b4dSChangpeng Liu max_discard_sectors) 3620764be0SStefano Garzarella /* 3720764be0SStefano Garzarella * Starting from the discard feature, we can use this array to properly 3820764be0SStefano Garzarella * set the config size depending on the features enabled. 3920764be0SStefano Garzarella */ 4020764be0SStefano Garzarella static VirtIOFeature feature_sizes[] = { 4120764be0SStefano Garzarella {.flags = 1ULL << VIRTIO_BLK_F_DISCARD, 4220764be0SStefano Garzarella .end = virtio_endof(struct virtio_blk_config, discard_sector_alignment)}, 4320764be0SStefano Garzarella {.flags = 1ULL << VIRTIO_BLK_F_WRITE_ZEROES, 4420764be0SStefano Garzarella .end = virtio_endof(struct virtio_blk_config, write_zeroes_may_unmap)}, 4520764be0SStefano Garzarella {} 4620764be0SStefano Garzarella }; 4720764be0SStefano Garzarella 4820764be0SStefano Garzarella static void virtio_blk_set_config_size(VirtIOBlock *s, uint64_t host_features) 4920764be0SStefano Garzarella { 5020764be0SStefano Garzarella s->config_size = MAX(VIRTIO_BLK_CFG_SIZE, 5120764be0SStefano Garzarella virtio_feature_get_config_size(feature_sizes, host_features)); 5220764be0SStefano Garzarella 5320764be0SStefano Garzarella assert(s->config_size <= sizeof(struct virtio_blk_config)); 5420764be0SStefano Garzarella } 5542824b4dSChangpeng Liu 56d14dde5eSGreg Kurz static void virtio_blk_init_request(VirtIOBlock *s, VirtQueue *vq, 57edaffd9fSStefan Hajnoczi VirtIOBlockReq *req) 58671ec3f0SFam Zheng { 59671ec3f0SFam Zheng req->dev = s; 60edaffd9fSStefan Hajnoczi req->vq = vq; 61869d66afSStefan Hajnoczi req->qiov.size = 0; 622a6cdd6dSPaolo Bonzini req->in_len = 0; 63869d66afSStefan Hajnoczi req->next = NULL; 6495f7142aSPeter Lieven req->mr_next = NULL; 65671ec3f0SFam Zheng } 66671ec3f0SFam Zheng 67d14dde5eSGreg Kurz static void virtio_blk_free_request(VirtIOBlockReq *req) 68671ec3f0SFam Zheng { 69c84b3192SPaolo Bonzini g_free(req); 70671ec3f0SFam Zheng } 71671ec3f0SFam Zheng 7203de2f52SPaolo Bonzini static void virtio_blk_req_complete(VirtIOBlockReq *req, unsigned char status) 736e790746SPaolo Bonzini { 746e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 756e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 766e790746SPaolo Bonzini 77a576ceacSStefan Hajnoczi trace_virtio_blk_req_complete(vdev, req, status); 786e790746SPaolo Bonzini 796e790746SPaolo Bonzini stb_p(&req->in->status, status); 80edaffd9fSStefan Hajnoczi virtqueue_push(req->vq, &req->elem, req->in_len); 81eb41cf78SPaolo Bonzini if (s->dataplane_started && !s->dataplane_disabled) { 82edaffd9fSStefan Hajnoczi virtio_blk_data_plane_notify(s->dataplane, req->vq); 8303de2f52SPaolo Bonzini } else { 84edaffd9fSStefan Hajnoczi virtio_notify(vdev, req->vq); 856e790746SPaolo Bonzini } 86bf4bd461SFam Zheng } 87bf4bd461SFam Zheng 886e790746SPaolo Bonzini static int virtio_blk_handle_rw_error(VirtIOBlockReq *req, int error, 8900f639fbSStefano Garzarella bool is_read, bool acct_failed) 906e790746SPaolo Bonzini { 916e790746SPaolo Bonzini VirtIOBlock *s = req->dev; 929a6719d5SStefano Garzarella BlockErrorAction action = blk_get_error_action(s->blk, is_read, error); 936e790746SPaolo Bonzini 94a589569fSWenchao Xia if (action == BLOCK_ERROR_ACTION_STOP) { 95466138dcSFam Zheng /* Break the link as the next request is going to be parsed from the 96466138dcSFam Zheng * ring again. Otherwise we may end up doing a double completion! */ 97466138dcSFam Zheng req->mr_next = NULL; 986e790746SPaolo Bonzini req->next = s->rq; 996e790746SPaolo Bonzini s->rq = req; 100a589569fSWenchao Xia } else if (action == BLOCK_ERROR_ACTION_REPORT) { 1016e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 10200f639fbSStefano Garzarella if (acct_failed) { 10301762e03SAlberto Garcia block_acct_failed(blk_get_stats(s->blk), &req->acct); 10400f639fbSStefano Garzarella } 105671ec3f0SFam Zheng virtio_blk_free_request(req); 1066e790746SPaolo Bonzini } 1076e790746SPaolo Bonzini 1084be74634SMarkus Armbruster blk_error_action(s->blk, action, is_read, error); 109a589569fSWenchao Xia return action != BLOCK_ERROR_ACTION_IGNORE; 1106e790746SPaolo Bonzini } 1116e790746SPaolo Bonzini 1126e790746SPaolo Bonzini static void virtio_blk_rw_complete(void *opaque, int ret) 1136e790746SPaolo Bonzini { 11495f7142aSPeter Lieven VirtIOBlockReq *next = opaque; 115b9e413ddSPaolo Bonzini VirtIOBlock *s = next->dev; 116a576ceacSStefan Hajnoczi VirtIODevice *vdev = VIRTIO_DEVICE(s); 1176e790746SPaolo Bonzini 118b9e413ddSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 11995f7142aSPeter Lieven while (next) { 12095f7142aSPeter Lieven VirtIOBlockReq *req = next; 12195f7142aSPeter Lieven next = req->mr_next; 122a576ceacSStefan Hajnoczi trace_virtio_blk_rw_complete(vdev, req, ret); 1236e790746SPaolo Bonzini 12495f7142aSPeter Lieven if (req->qiov.nalloc != -1) { 125e61809edSDongli Zhang /* If nalloc is != -1 req->qiov is a local copy of the original 1269bb192a4SYaowei Bai * external iovec. It was allocated in submit_requests to be 1279bb192a4SYaowei Bai * able to merge requests. */ 12895f7142aSPeter Lieven qemu_iovec_destroy(&req->qiov); 12995f7142aSPeter Lieven } 13095f7142aSPeter Lieven 1316e790746SPaolo Bonzini if (ret) { 132bf4069fbSAnastasiia Rusakova int p = virtio_ldl_p(VIRTIO_DEVICE(s), &req->out.type); 133783d1897SRusty Russell bool is_read = !(p & VIRTIO_BLK_T_OUT); 1342a6cdd6dSPaolo Bonzini /* Note that memory may be dirtied on read failure. If the 1352a6cdd6dSPaolo Bonzini * virtio request is not completed here, as is the case for 1362a6cdd6dSPaolo Bonzini * BLOCK_ERROR_ACTION_STOP, the memory may not be copied 1372a6cdd6dSPaolo Bonzini * correctly during live migration. While this is ugly, 1382a6cdd6dSPaolo Bonzini * it is acceptable because the device is free to write to 1392a6cdd6dSPaolo Bonzini * the memory until the request is completed (which will 1402a6cdd6dSPaolo Bonzini * happen on the other side of the migration). 1412a6cdd6dSPaolo Bonzini */ 14200f639fbSStefano Garzarella if (virtio_blk_handle_rw_error(req, -ret, is_read, true)) { 14395f7142aSPeter Lieven continue; 14495f7142aSPeter Lieven } 1456e790746SPaolo Bonzini } 1466e790746SPaolo Bonzini 1476e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 148bf4069fbSAnastasiia Rusakova block_acct_done(blk_get_stats(s->blk), &req->acct); 149671ec3f0SFam Zheng virtio_blk_free_request(req); 1506e790746SPaolo Bonzini } 151b9e413ddSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 15295f7142aSPeter Lieven } 1536e790746SPaolo Bonzini 1546e790746SPaolo Bonzini static void virtio_blk_flush_complete(void *opaque, int ret) 1556e790746SPaolo Bonzini { 1566e790746SPaolo Bonzini VirtIOBlockReq *req = opaque; 157b9e413ddSPaolo Bonzini VirtIOBlock *s = req->dev; 1586e790746SPaolo Bonzini 159b9e413ddSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 1606e790746SPaolo Bonzini if (ret) { 16100f639fbSStefano Garzarella if (virtio_blk_handle_rw_error(req, -ret, 0, true)) { 162b9e413ddSPaolo Bonzini goto out; 1636e790746SPaolo Bonzini } 1646e790746SPaolo Bonzini } 1656e790746SPaolo Bonzini 1666e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 1679a6719d5SStefano Garzarella block_acct_done(blk_get_stats(s->blk), &req->acct); 168671ec3f0SFam Zheng virtio_blk_free_request(req); 169b9e413ddSPaolo Bonzini 170b9e413ddSPaolo Bonzini out: 171b9e413ddSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 1726e790746SPaolo Bonzini } 1736e790746SPaolo Bonzini 17437b06f8dSStefano Garzarella static void virtio_blk_discard_write_zeroes_complete(void *opaque, int ret) 17537b06f8dSStefano Garzarella { 17637b06f8dSStefano Garzarella VirtIOBlockReq *req = opaque; 17737b06f8dSStefano Garzarella VirtIOBlock *s = req->dev; 17837b06f8dSStefano Garzarella bool is_write_zeroes = (virtio_ldl_p(VIRTIO_DEVICE(s), &req->out.type) & 17937b06f8dSStefano Garzarella ~VIRTIO_BLK_T_BARRIER) == VIRTIO_BLK_T_WRITE_ZEROES; 18037b06f8dSStefano Garzarella 18137b06f8dSStefano Garzarella aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 18237b06f8dSStefano Garzarella if (ret) { 18337b06f8dSStefano Garzarella if (virtio_blk_handle_rw_error(req, -ret, false, is_write_zeroes)) { 18437b06f8dSStefano Garzarella goto out; 18537b06f8dSStefano Garzarella } 18637b06f8dSStefano Garzarella } 18737b06f8dSStefano Garzarella 18837b06f8dSStefano Garzarella virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 18937b06f8dSStefano Garzarella if (is_write_zeroes) { 19037b06f8dSStefano Garzarella block_acct_done(blk_get_stats(s->blk), &req->acct); 19137b06f8dSStefano Garzarella } 19237b06f8dSStefano Garzarella virtio_blk_free_request(req); 19337b06f8dSStefano Garzarella 19437b06f8dSStefano Garzarella out: 19537b06f8dSStefano Garzarella aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 19637b06f8dSStefano Garzarella } 19737b06f8dSStefano Garzarella 1981dc936aaSFam Zheng #ifdef __linux__ 1991dc936aaSFam Zheng 2001dc936aaSFam Zheng typedef struct { 2011dc936aaSFam Zheng VirtIOBlockReq *req; 2021dc936aaSFam Zheng struct sg_io_hdr hdr; 2031dc936aaSFam Zheng } VirtIOBlockIoctlReq; 2041dc936aaSFam Zheng 2051dc936aaSFam Zheng static void virtio_blk_ioctl_complete(void *opaque, int status) 2061dc936aaSFam Zheng { 2071dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req = opaque; 2081dc936aaSFam Zheng VirtIOBlockReq *req = ioctl_req->req; 2099d456654SPaolo Bonzini VirtIOBlock *s = req->dev; 2109d456654SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(s); 2111dc936aaSFam Zheng struct virtio_scsi_inhdr *scsi; 2121dc936aaSFam Zheng struct sg_io_hdr *hdr; 2131dc936aaSFam Zheng 2141dc936aaSFam Zheng scsi = (void *)req->elem.in_sg[req->elem.in_num - 2].iov_base; 2151dc936aaSFam Zheng 2161dc936aaSFam Zheng if (status) { 2171dc936aaSFam Zheng status = VIRTIO_BLK_S_UNSUPP; 2181dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 255); 2191dc936aaSFam Zheng goto out; 2201dc936aaSFam Zheng } 2211dc936aaSFam Zheng 2221dc936aaSFam Zheng hdr = &ioctl_req->hdr; 2231dc936aaSFam Zheng /* 2241dc936aaSFam Zheng * From SCSI-Generic-HOWTO: "Some lower level drivers (e.g. ide-scsi) 2251dc936aaSFam Zheng * clear the masked_status field [hence status gets cleared too, see 2261dc936aaSFam Zheng * block/scsi_ioctl.c] even when a CHECK_CONDITION or COMMAND_TERMINATED 2271dc936aaSFam Zheng * status has occurred. However they do set DRIVER_SENSE in driver_status 2281dc936aaSFam Zheng * field. Also a (sb_len_wr > 0) indicates there is a sense buffer. 2291dc936aaSFam Zheng */ 2301dc936aaSFam Zheng if (hdr->status == 0 && hdr->sb_len_wr > 0) { 2311dc936aaSFam Zheng hdr->status = CHECK_CONDITION; 2321dc936aaSFam Zheng } 2331dc936aaSFam Zheng 2341dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->errors, 2351dc936aaSFam Zheng hdr->status | (hdr->msg_status << 8) | 2361dc936aaSFam Zheng (hdr->host_status << 16) | (hdr->driver_status << 24)); 2371dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->residual, hdr->resid); 2381dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->sense_len, hdr->sb_len_wr); 2391dc936aaSFam Zheng virtio_stl_p(vdev, &scsi->data_len, hdr->dxfer_len); 2401dc936aaSFam Zheng 2411dc936aaSFam Zheng out: 242b9e413ddSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 2431dc936aaSFam Zheng virtio_blk_req_complete(req, status); 2441dc936aaSFam Zheng virtio_blk_free_request(req); 245b9e413ddSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 2461dc936aaSFam Zheng g_free(ioctl_req); 2471dc936aaSFam Zheng } 2481dc936aaSFam Zheng 2491dc936aaSFam Zheng #endif 2501dc936aaSFam Zheng 251edaffd9fSStefan Hajnoczi static VirtIOBlockReq *virtio_blk_get_request(VirtIOBlock *s, VirtQueue *vq) 2526e790746SPaolo Bonzini { 253edaffd9fSStefan Hajnoczi VirtIOBlockReq *req = virtqueue_pop(vq, sizeof(VirtIOBlockReq)); 2546e790746SPaolo Bonzini 25551b19ebeSPaolo Bonzini if (req) { 256edaffd9fSStefan Hajnoczi virtio_blk_init_request(s, vq, req); 2576e790746SPaolo Bonzini } 2586e790746SPaolo Bonzini return req; 2596e790746SPaolo Bonzini } 2606e790746SPaolo Bonzini 26175344fa4SFam Zheng static int virtio_blk_handle_scsi_req(VirtIOBlockReq *req) 2626e790746SPaolo Bonzini { 2636e790746SPaolo Bonzini int status = VIRTIO_BLK_S_OK; 2645a05cbeeSFam Zheng struct virtio_scsi_inhdr *scsi = NULL; 26575344fa4SFam Zheng VirtIOBlock *blk = req->dev; 266bf4069fbSAnastasiia Rusakova VirtIODevice *vdev = VIRTIO_DEVICE(blk); 267bf4069fbSAnastasiia Rusakova VirtQueueElement *elem = &req->elem; 268783d1897SRusty Russell 2695a05cbeeSFam Zheng #ifdef __linux__ 2705a05cbeeSFam Zheng int i; 2711dc936aaSFam Zheng VirtIOBlockIoctlReq *ioctl_req; 272a209f461SFam Zheng BlockAIOCB *acb; 2735a05cbeeSFam Zheng #endif 2746e790746SPaolo Bonzini 2756e790746SPaolo Bonzini /* 2766e790746SPaolo Bonzini * We require at least one output segment each for the virtio_blk_outhdr 2776e790746SPaolo Bonzini * and the SCSI command block. 2786e790746SPaolo Bonzini * 2796e790746SPaolo Bonzini * We also at least require the virtio_blk_inhdr, the virtio_scsi_inhdr 2806e790746SPaolo Bonzini * and the sense buffer pointer in the input segments. 2816e790746SPaolo Bonzini */ 2825a05cbeeSFam Zheng if (elem->out_num < 2 || elem->in_num < 3) { 2835a05cbeeSFam Zheng status = VIRTIO_BLK_S_IOERR; 2845a05cbeeSFam Zheng goto fail; 2856e790746SPaolo Bonzini } 2866e790746SPaolo Bonzini 2876e790746SPaolo Bonzini /* 2886e790746SPaolo Bonzini * The scsi inhdr is placed in the second-to-last input segment, just 2896e790746SPaolo Bonzini * before the regular inhdr. 2906e790746SPaolo Bonzini */ 2915a05cbeeSFam Zheng scsi = (void *)elem->in_sg[elem->in_num - 2].iov_base; 2926e790746SPaolo Bonzini 293bbe8bd4dSStefano Garzarella if (!virtio_has_feature(blk->host_features, VIRTIO_BLK_F_SCSI)) { 2946e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 2956e790746SPaolo Bonzini goto fail; 2966e790746SPaolo Bonzini } 2976e790746SPaolo Bonzini 2986e790746SPaolo Bonzini /* 2996e790746SPaolo Bonzini * No support for bidirection commands yet. 3006e790746SPaolo Bonzini */ 3015a05cbeeSFam Zheng if (elem->out_num > 2 && elem->in_num > 3) { 3026e790746SPaolo Bonzini status = VIRTIO_BLK_S_UNSUPP; 3036e790746SPaolo Bonzini goto fail; 3046e790746SPaolo Bonzini } 3056e790746SPaolo Bonzini 3066e790746SPaolo Bonzini #ifdef __linux__ 3071dc936aaSFam Zheng ioctl_req = g_new0(VirtIOBlockIoctlReq, 1); 3081dc936aaSFam Zheng ioctl_req->req = req; 3091dc936aaSFam Zheng ioctl_req->hdr.interface_id = 'S'; 3101dc936aaSFam Zheng ioctl_req->hdr.cmd_len = elem->out_sg[1].iov_len; 3111dc936aaSFam Zheng ioctl_req->hdr.cmdp = elem->out_sg[1].iov_base; 3121dc936aaSFam Zheng ioctl_req->hdr.dxfer_len = 0; 3136e790746SPaolo Bonzini 3145a05cbeeSFam Zheng if (elem->out_num > 2) { 3156e790746SPaolo Bonzini /* 3166e790746SPaolo Bonzini * If there are more than the minimally required 2 output segments 3176e790746SPaolo Bonzini * there is write payload starting from the third iovec. 3186e790746SPaolo Bonzini */ 3191dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_TO_DEV; 3201dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->out_num - 2; 3216e790746SPaolo Bonzini 3221dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 3231dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->out_sg[i + 2].iov_len; 3241dc936aaSFam Zheng } 3256e790746SPaolo Bonzini 3261dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->out_sg + 2; 3276e790746SPaolo Bonzini 3285a05cbeeSFam Zheng } else if (elem->in_num > 3) { 3296e790746SPaolo Bonzini /* 3306e790746SPaolo Bonzini * If we have more than 3 input segments the guest wants to actually 3316e790746SPaolo Bonzini * read data. 3326e790746SPaolo Bonzini */ 3331dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_FROM_DEV; 3341dc936aaSFam Zheng ioctl_req->hdr.iovec_count = elem->in_num - 3; 3351dc936aaSFam Zheng for (i = 0; i < ioctl_req->hdr.iovec_count; i++) { 3361dc936aaSFam Zheng ioctl_req->hdr.dxfer_len += elem->in_sg[i].iov_len; 3371dc936aaSFam Zheng } 3386e790746SPaolo Bonzini 3391dc936aaSFam Zheng ioctl_req->hdr.dxferp = elem->in_sg; 3406e790746SPaolo Bonzini } else { 3416e790746SPaolo Bonzini /* 3426e790746SPaolo Bonzini * Some SCSI commands don't actually transfer any data. 3436e790746SPaolo Bonzini */ 3441dc936aaSFam Zheng ioctl_req->hdr.dxfer_direction = SG_DXFER_NONE; 3456e790746SPaolo Bonzini } 3466e790746SPaolo Bonzini 3471dc936aaSFam Zheng ioctl_req->hdr.sbp = elem->in_sg[elem->in_num - 3].iov_base; 3481dc936aaSFam Zheng ioctl_req->hdr.mx_sb_len = elem->in_sg[elem->in_num - 3].iov_len; 3496e790746SPaolo Bonzini 350a209f461SFam Zheng acb = blk_aio_ioctl(blk->blk, SG_IO, &ioctl_req->hdr, 3511dc936aaSFam Zheng virtio_blk_ioctl_complete, ioctl_req); 352a209f461SFam Zheng if (!acb) { 353a209f461SFam Zheng g_free(ioctl_req); 354a209f461SFam Zheng status = VIRTIO_BLK_S_UNSUPP; 355a209f461SFam Zheng goto fail; 356a209f461SFam Zheng } 3571dc936aaSFam Zheng return -EINPROGRESS; 3586e790746SPaolo Bonzini #else 3596e790746SPaolo Bonzini abort(); 3606e790746SPaolo Bonzini #endif 3616e790746SPaolo Bonzini 3626e790746SPaolo Bonzini fail: 3636e790746SPaolo Bonzini /* Just put anything nonzero so that the ioctl fails in the guest. */ 3645a05cbeeSFam Zheng if (scsi) { 365783d1897SRusty Russell virtio_stl_p(vdev, &scsi->errors, 255); 3665a05cbeeSFam Zheng } 3675a05cbeeSFam Zheng return status; 3685a05cbeeSFam Zheng } 3695a05cbeeSFam Zheng 3705a05cbeeSFam Zheng static void virtio_blk_handle_scsi(VirtIOBlockReq *req) 3715a05cbeeSFam Zheng { 3725a05cbeeSFam Zheng int status; 3735a05cbeeSFam Zheng 37475344fa4SFam Zheng status = virtio_blk_handle_scsi_req(req); 3751dc936aaSFam Zheng if (status != -EINPROGRESS) { 3766e790746SPaolo Bonzini virtio_blk_req_complete(req, status); 377671ec3f0SFam Zheng virtio_blk_free_request(req); 3786e790746SPaolo Bonzini } 3791dc936aaSFam Zheng } 3806e790746SPaolo Bonzini 38195f7142aSPeter Lieven static inline void submit_requests(BlockBackend *blk, MultiReqBuffer *mrb, 38295f7142aSPeter Lieven int start, int num_reqs, int niov) 3836e790746SPaolo Bonzini { 38495f7142aSPeter Lieven QEMUIOVector *qiov = &mrb->reqs[start]->qiov; 38595f7142aSPeter Lieven int64_t sector_num = mrb->reqs[start]->sector_num; 38695f7142aSPeter Lieven bool is_write = mrb->is_write; 3876e790746SPaolo Bonzini 38895f7142aSPeter Lieven if (num_reqs > 1) { 38995f7142aSPeter Lieven int i; 39095f7142aSPeter Lieven struct iovec *tmp_iov = qiov->iov; 39195f7142aSPeter Lieven int tmp_niov = qiov->niov; 39295f7142aSPeter Lieven 39395f7142aSPeter Lieven /* mrb->reqs[start]->qiov was initialized from external so we can't 394b5772fddSEric Blake * modify it here. We need to initialize it locally and then add the 39595f7142aSPeter Lieven * external iovecs. */ 39695f7142aSPeter Lieven qemu_iovec_init(qiov, niov); 39795f7142aSPeter Lieven 39895f7142aSPeter Lieven for (i = 0; i < tmp_niov; i++) { 39995f7142aSPeter Lieven qemu_iovec_add(qiov, tmp_iov[i].iov_base, tmp_iov[i].iov_len); 40095f7142aSPeter Lieven } 40195f7142aSPeter Lieven 40295f7142aSPeter Lieven for (i = start + 1; i < start + num_reqs; i++) { 40395f7142aSPeter Lieven qemu_iovec_concat(qiov, &mrb->reqs[i]->qiov, 0, 40495f7142aSPeter Lieven mrb->reqs[i]->qiov.size); 40595f7142aSPeter Lieven mrb->reqs[i - 1]->mr_next = mrb->reqs[i]; 40695f7142aSPeter Lieven } 40795f7142aSPeter Lieven 408a576ceacSStefan Hajnoczi trace_virtio_blk_submit_multireq(VIRTIO_DEVICE(mrb->reqs[start]->dev), 409a576ceacSStefan Hajnoczi mrb, start, num_reqs, 410b5772fddSEric Blake sector_num << BDRV_SECTOR_BITS, 411b5772fddSEric Blake qiov->size, is_write); 41295f7142aSPeter Lieven block_acct_merge_done(blk_get_stats(blk), 41395f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ, 41495f7142aSPeter Lieven num_reqs - 1); 41595f7142aSPeter Lieven } 41695f7142aSPeter Lieven 41795f7142aSPeter Lieven if (is_write) { 418b5772fddSEric Blake blk_aio_pwritev(blk, sector_num << BDRV_SECTOR_BITS, qiov, 0, 41995f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 42095f7142aSPeter Lieven } else { 421b5772fddSEric Blake blk_aio_preadv(blk, sector_num << BDRV_SECTOR_BITS, qiov, 0, 42295f7142aSPeter Lieven virtio_blk_rw_complete, mrb->reqs[start]); 42395f7142aSPeter Lieven } 42495f7142aSPeter Lieven } 42595f7142aSPeter Lieven 42695f7142aSPeter Lieven static int multireq_compare(const void *a, const void *b) 42795f7142aSPeter Lieven { 42895f7142aSPeter Lieven const VirtIOBlockReq *req1 = *(VirtIOBlockReq **)a, 42995f7142aSPeter Lieven *req2 = *(VirtIOBlockReq **)b; 43095f7142aSPeter Lieven 43195f7142aSPeter Lieven /* 43295f7142aSPeter Lieven * Note that we can't simply subtract sector_num1 from sector_num2 43395f7142aSPeter Lieven * here as that could overflow the return value. 43495f7142aSPeter Lieven */ 43595f7142aSPeter Lieven if (req1->sector_num > req2->sector_num) { 43695f7142aSPeter Lieven return 1; 43795f7142aSPeter Lieven } else if (req1->sector_num < req2->sector_num) { 43895f7142aSPeter Lieven return -1; 43995f7142aSPeter Lieven } else { 44095f7142aSPeter Lieven return 0; 44195f7142aSPeter Lieven } 44295f7142aSPeter Lieven } 44395f7142aSPeter Lieven 444d14dde5eSGreg Kurz static void virtio_blk_submit_multireq(BlockBackend *blk, MultiReqBuffer *mrb) 44595f7142aSPeter Lieven { 44695f7142aSPeter Lieven int i = 0, start = 0, num_reqs = 0, niov = 0, nb_sectors = 0; 4475def6b80SEric Blake uint32_t max_transfer; 44895f7142aSPeter Lieven int64_t sector_num = 0; 44995f7142aSPeter Lieven 45095f7142aSPeter Lieven if (mrb->num_reqs == 1) { 45195f7142aSPeter Lieven submit_requests(blk, mrb, 0, 1, -1); 45295f7142aSPeter Lieven mrb->num_reqs = 0; 4536e790746SPaolo Bonzini return; 4546e790746SPaolo Bonzini } 4556e790746SPaolo Bonzini 4565def6b80SEric Blake max_transfer = blk_get_max_transfer(mrb->reqs[0]->dev->blk); 45795f7142aSPeter Lieven 45895f7142aSPeter Lieven qsort(mrb->reqs, mrb->num_reqs, sizeof(*mrb->reqs), 45995f7142aSPeter Lieven &multireq_compare); 46095f7142aSPeter Lieven 46195f7142aSPeter Lieven for (i = 0; i < mrb->num_reqs; i++) { 46295f7142aSPeter Lieven VirtIOBlockReq *req = mrb->reqs[i]; 46395f7142aSPeter Lieven if (num_reqs > 0) { 46449cffbc6SGonglei /* 46549cffbc6SGonglei * NOTE: We cannot merge the requests in below situations: 46649cffbc6SGonglei * 1. requests are not sequential 46749cffbc6SGonglei * 2. merge would exceed maximum number of IOVs 46849cffbc6SGonglei * 3. merge would exceed maximum transfer length of backend device 46949cffbc6SGonglei */ 47049cffbc6SGonglei if (sector_num + nb_sectors != req->sector_num || 471222565f6SStefan Hajnoczi niov > blk_get_max_iov(blk) - req->qiov.niov || 4725def6b80SEric Blake req->qiov.size > max_transfer || 4735def6b80SEric Blake nb_sectors > (max_transfer - 4745def6b80SEric Blake req->qiov.size) / BDRV_SECTOR_SIZE) { 47595f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 47695f7142aSPeter Lieven num_reqs = 0; 4776e790746SPaolo Bonzini } 4786e790746SPaolo Bonzini } 4796e790746SPaolo Bonzini 48095f7142aSPeter Lieven if (num_reqs == 0) { 48195f7142aSPeter Lieven sector_num = req->sector_num; 48295f7142aSPeter Lieven nb_sectors = niov = 0; 48395f7142aSPeter Lieven start = i; 48495f7142aSPeter Lieven } 48595f7142aSPeter Lieven 48695f7142aSPeter Lieven nb_sectors += req->qiov.size / BDRV_SECTOR_SIZE; 48795f7142aSPeter Lieven niov += req->qiov.niov; 48895f7142aSPeter Lieven num_reqs++; 48995f7142aSPeter Lieven } 49095f7142aSPeter Lieven 49195f7142aSPeter Lieven submit_requests(blk, mrb, start, num_reqs, niov); 49295f7142aSPeter Lieven mrb->num_reqs = 0; 4936e790746SPaolo Bonzini } 4946e790746SPaolo Bonzini 4956e790746SPaolo Bonzini static void virtio_blk_handle_flush(VirtIOBlockReq *req, MultiReqBuffer *mrb) 4966e790746SPaolo Bonzini { 497bf4069fbSAnastasiia Rusakova VirtIOBlock *s = req->dev; 498bf4069fbSAnastasiia Rusakova 499bf4069fbSAnastasiia Rusakova block_acct_start(blk_get_stats(s->blk), &req->acct, 0, 5005366d0c8SBenoît Canet BLOCK_ACCT_FLUSH); 5016e790746SPaolo Bonzini 5026e790746SPaolo Bonzini /* 5036e790746SPaolo Bonzini * Make sure all outstanding writes are posted to the backing device. 5046e790746SPaolo Bonzini */ 50595f7142aSPeter Lieven if (mrb->is_write && mrb->num_reqs > 0) { 506bf4069fbSAnastasiia Rusakova virtio_blk_submit_multireq(s->blk, mrb); 50795f7142aSPeter Lieven } 508bf4069fbSAnastasiia Rusakova blk_aio_flush(s->blk, virtio_blk_flush_complete, req); 5096e790746SPaolo Bonzini } 5106e790746SPaolo Bonzini 511d0e14376SMarkus Armbruster static bool virtio_blk_sect_range_ok(VirtIOBlock *dev, 512d0e14376SMarkus Armbruster uint64_t sector, size_t size) 513d0e14376SMarkus Armbruster { 5143c2daac0SMarkus Armbruster uint64_t nb_sectors = size >> BDRV_SECTOR_BITS; 5153c2daac0SMarkus Armbruster uint64_t total_sectors; 5163c2daac0SMarkus Armbruster 51775af1f34SPeter Lieven if (nb_sectors > BDRV_REQUEST_MAX_SECTORS) { 51895f7142aSPeter Lieven return false; 51995f7142aSPeter Lieven } 520d0e14376SMarkus Armbruster if (sector & dev->sector_mask) { 521d0e14376SMarkus Armbruster return false; 522d0e14376SMarkus Armbruster } 5232a30307fSMarkus Armbruster if (size % dev->conf.conf.logical_block_size) { 524d0e14376SMarkus Armbruster return false; 525d0e14376SMarkus Armbruster } 5264be74634SMarkus Armbruster blk_get_geometry(dev->blk, &total_sectors); 5273c2daac0SMarkus Armbruster if (sector > total_sectors || nb_sectors > total_sectors - sector) { 5283c2daac0SMarkus Armbruster return false; 5293c2daac0SMarkus Armbruster } 530d0e14376SMarkus Armbruster return true; 531d0e14376SMarkus Armbruster } 532d0e14376SMarkus Armbruster 53337b06f8dSStefano Garzarella static uint8_t virtio_blk_handle_discard_write_zeroes(VirtIOBlockReq *req, 53437b06f8dSStefano Garzarella struct virtio_blk_discard_write_zeroes *dwz_hdr, bool is_write_zeroes) 53537b06f8dSStefano Garzarella { 53637b06f8dSStefano Garzarella VirtIOBlock *s = req->dev; 53737b06f8dSStefano Garzarella VirtIODevice *vdev = VIRTIO_DEVICE(s); 53837b06f8dSStefano Garzarella uint64_t sector; 53937b06f8dSStefano Garzarella uint32_t num_sectors, flags, max_sectors; 54037b06f8dSStefano Garzarella uint8_t err_status; 54137b06f8dSStefano Garzarella int bytes; 54237b06f8dSStefano Garzarella 54337b06f8dSStefano Garzarella sector = virtio_ldq_p(vdev, &dwz_hdr->sector); 54437b06f8dSStefano Garzarella num_sectors = virtio_ldl_p(vdev, &dwz_hdr->num_sectors); 54537b06f8dSStefano Garzarella flags = virtio_ldl_p(vdev, &dwz_hdr->flags); 54637b06f8dSStefano Garzarella max_sectors = is_write_zeroes ? s->conf.max_write_zeroes_sectors : 54737b06f8dSStefano Garzarella s->conf.max_discard_sectors; 54837b06f8dSStefano Garzarella 54937b06f8dSStefano Garzarella /* 55037b06f8dSStefano Garzarella * max_sectors is at most BDRV_REQUEST_MAX_SECTORS, this check 55137b06f8dSStefano Garzarella * make us sure that "num_sectors << BDRV_SECTOR_BITS" can fit in 55237b06f8dSStefano Garzarella * the integer variable. 55337b06f8dSStefano Garzarella */ 55437b06f8dSStefano Garzarella if (unlikely(num_sectors > max_sectors)) { 55537b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_IOERR; 55637b06f8dSStefano Garzarella goto err; 55737b06f8dSStefano Garzarella } 55837b06f8dSStefano Garzarella 55937b06f8dSStefano Garzarella bytes = num_sectors << BDRV_SECTOR_BITS; 56037b06f8dSStefano Garzarella 56137b06f8dSStefano Garzarella if (unlikely(!virtio_blk_sect_range_ok(s, sector, bytes))) { 56237b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_IOERR; 56337b06f8dSStefano Garzarella goto err; 56437b06f8dSStefano Garzarella } 56537b06f8dSStefano Garzarella 56637b06f8dSStefano Garzarella /* 56737b06f8dSStefano Garzarella * The device MUST set the status byte to VIRTIO_BLK_S_UNSUPP for discard 56837b06f8dSStefano Garzarella * and write zeroes commands if any unknown flag is set. 56937b06f8dSStefano Garzarella */ 57037b06f8dSStefano Garzarella if (unlikely(flags & ~VIRTIO_BLK_WRITE_ZEROES_FLAG_UNMAP)) { 57137b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_UNSUPP; 57237b06f8dSStefano Garzarella goto err; 57337b06f8dSStefano Garzarella } 57437b06f8dSStefano Garzarella 57537b06f8dSStefano Garzarella if (is_write_zeroes) { /* VIRTIO_BLK_T_WRITE_ZEROES */ 57637b06f8dSStefano Garzarella int blk_aio_flags = 0; 57737b06f8dSStefano Garzarella 57837b06f8dSStefano Garzarella if (flags & VIRTIO_BLK_WRITE_ZEROES_FLAG_UNMAP) { 57937b06f8dSStefano Garzarella blk_aio_flags |= BDRV_REQ_MAY_UNMAP; 58037b06f8dSStefano Garzarella } 58137b06f8dSStefano Garzarella 58237b06f8dSStefano Garzarella block_acct_start(blk_get_stats(s->blk), &req->acct, bytes, 58337b06f8dSStefano Garzarella BLOCK_ACCT_WRITE); 58437b06f8dSStefano Garzarella 58537b06f8dSStefano Garzarella blk_aio_pwrite_zeroes(s->blk, sector << BDRV_SECTOR_BITS, 58637b06f8dSStefano Garzarella bytes, blk_aio_flags, 58737b06f8dSStefano Garzarella virtio_blk_discard_write_zeroes_complete, req); 58837b06f8dSStefano Garzarella } else { /* VIRTIO_BLK_T_DISCARD */ 58937b06f8dSStefano Garzarella /* 59037b06f8dSStefano Garzarella * The device MUST set the status byte to VIRTIO_BLK_S_UNSUPP for 59137b06f8dSStefano Garzarella * discard commands if the unmap flag is set. 59237b06f8dSStefano Garzarella */ 59337b06f8dSStefano Garzarella if (unlikely(flags & VIRTIO_BLK_WRITE_ZEROES_FLAG_UNMAP)) { 59437b06f8dSStefano Garzarella err_status = VIRTIO_BLK_S_UNSUPP; 59537b06f8dSStefano Garzarella goto err; 59637b06f8dSStefano Garzarella } 59737b06f8dSStefano Garzarella 59837b06f8dSStefano Garzarella blk_aio_pdiscard(s->blk, sector << BDRV_SECTOR_BITS, bytes, 59937b06f8dSStefano Garzarella virtio_blk_discard_write_zeroes_complete, req); 60037b06f8dSStefano Garzarella } 60137b06f8dSStefano Garzarella 60237b06f8dSStefano Garzarella return VIRTIO_BLK_S_OK; 60337b06f8dSStefano Garzarella 60437b06f8dSStefano Garzarella err: 60537b06f8dSStefano Garzarella if (is_write_zeroes) { 60637b06f8dSStefano Garzarella block_acct_invalid(blk_get_stats(s->blk), BLOCK_ACCT_WRITE); 60737b06f8dSStefano Garzarella } 60837b06f8dSStefano Garzarella return err_status; 60937b06f8dSStefano Garzarella } 61037b06f8dSStefano Garzarella 61120ea686aSGreg Kurz static int virtio_blk_handle_request(VirtIOBlockReq *req, MultiReqBuffer *mrb) 6126e790746SPaolo Bonzini { 6136e790746SPaolo Bonzini uint32_t type; 614f897bf75SStefan Hajnoczi struct iovec *in_iov = req->elem.in_sg; 6155636da76SDongli Zhang struct iovec *out_iov = req->elem.out_sg; 616f897bf75SStefan Hajnoczi unsigned in_num = req->elem.in_num; 617f897bf75SStefan Hajnoczi unsigned out_num = req->elem.out_num; 61820ea686aSGreg Kurz VirtIOBlock *s = req->dev; 61920ea686aSGreg Kurz VirtIODevice *vdev = VIRTIO_DEVICE(s); 6206e790746SPaolo Bonzini 621f897bf75SStefan Hajnoczi if (req->elem.out_num < 1 || req->elem.in_num < 1) { 62220ea686aSGreg Kurz virtio_error(vdev, "virtio-blk missing headers"); 62320ea686aSGreg Kurz return -1; 6246e790746SPaolo Bonzini } 6256e790746SPaolo Bonzini 6265636da76SDongli Zhang if (unlikely(iov_to_buf(out_iov, out_num, 0, &req->out, 627827805a2SFam Zheng sizeof(req->out)) != sizeof(req->out))) { 62820ea686aSGreg Kurz virtio_error(vdev, "virtio-blk request outhdr too short"); 62920ea686aSGreg Kurz return -1; 630827805a2SFam Zheng } 631ee17e848SFam Zheng 6325636da76SDongli Zhang iov_discard_front(&out_iov, &out_num, sizeof(req->out)); 633ee17e848SFam Zheng 63412048545SGonglei if (in_iov[in_num - 1].iov_len < sizeof(struct virtio_blk_inhdr)) { 63520ea686aSGreg Kurz virtio_error(vdev, "virtio-blk request inhdr too short"); 63620ea686aSGreg Kurz return -1; 637ee17e848SFam Zheng } 638ee17e848SFam Zheng 6392a6cdd6dSPaolo Bonzini /* We always touch the last byte, so just see how big in_iov is. */ 6402a6cdd6dSPaolo Bonzini req->in_len = iov_size(in_iov, in_num); 641ee17e848SFam Zheng req->in = (void *)in_iov[in_num - 1].iov_base 642ee17e848SFam Zheng + in_iov[in_num - 1].iov_len 643ee17e848SFam Zheng - sizeof(struct virtio_blk_inhdr); 644ee17e848SFam Zheng iov_discard_back(in_iov, &in_num, sizeof(struct virtio_blk_inhdr)); 6456e790746SPaolo Bonzini 6469a6719d5SStefano Garzarella type = virtio_ldl_p(vdev, &req->out.type); 6476e790746SPaolo Bonzini 64895f7142aSPeter Lieven /* VIRTIO_BLK_T_OUT defines the command direction. VIRTIO_BLK_T_BARRIER 649631b22eaSStefan Weil * is an optional flag. Although a guest should not send this flag if 65095f7142aSPeter Lieven * not negotiated we ignored it in the past. So keep ignoring it. */ 65195f7142aSPeter Lieven switch (type & ~(VIRTIO_BLK_T_OUT | VIRTIO_BLK_T_BARRIER)) { 65295f7142aSPeter Lieven case VIRTIO_BLK_T_IN: 65395f7142aSPeter Lieven { 65495f7142aSPeter Lieven bool is_write = type & VIRTIO_BLK_T_OUT; 6559a6719d5SStefano Garzarella req->sector_num = virtio_ldq_p(vdev, &req->out.sector); 65695f7142aSPeter Lieven 65795f7142aSPeter Lieven if (is_write) { 6585636da76SDongli Zhang qemu_iovec_init_external(&req->qiov, out_iov, out_num); 659a576ceacSStefan Hajnoczi trace_virtio_blk_handle_write(vdev, req, req->sector_num, 66095f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 66195f7142aSPeter Lieven } else { 66295f7142aSPeter Lieven qemu_iovec_init_external(&req->qiov, in_iov, in_num); 663a576ceacSStefan Hajnoczi trace_virtio_blk_handle_read(vdev, req, req->sector_num, 66495f7142aSPeter Lieven req->qiov.size / BDRV_SECTOR_SIZE); 66595f7142aSPeter Lieven } 66695f7142aSPeter Lieven 6679a6719d5SStefano Garzarella if (!virtio_blk_sect_range_ok(s, req->sector_num, req->qiov.size)) { 66895f7142aSPeter Lieven virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); 6699a6719d5SStefano Garzarella block_acct_invalid(blk_get_stats(s->blk), 67001762e03SAlberto Garcia is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 67195f7142aSPeter Lieven virtio_blk_free_request(req); 67220ea686aSGreg Kurz return 0; 67395f7142aSPeter Lieven } 67495f7142aSPeter Lieven 6759a6719d5SStefano Garzarella block_acct_start(blk_get_stats(s->blk), &req->acct, req->qiov.size, 67695f7142aSPeter Lieven is_write ? BLOCK_ACCT_WRITE : BLOCK_ACCT_READ); 67795f7142aSPeter Lieven 67895f7142aSPeter Lieven /* merge would exceed maximum number of requests or IO direction 67995f7142aSPeter Lieven * changes */ 68095f7142aSPeter Lieven if (mrb->num_reqs > 0 && (mrb->num_reqs == VIRTIO_BLK_MAX_MERGE_REQS || 681c99495acSPeter Lieven is_write != mrb->is_write || 6829a6719d5SStefano Garzarella !s->conf.request_merging)) { 6839a6719d5SStefano Garzarella virtio_blk_submit_multireq(s->blk, mrb); 68495f7142aSPeter Lieven } 68595f7142aSPeter Lieven 68695f7142aSPeter Lieven assert(mrb->num_reqs < VIRTIO_BLK_MAX_MERGE_REQS); 68795f7142aSPeter Lieven mrb->reqs[mrb->num_reqs++] = req; 68895f7142aSPeter Lieven mrb->is_write = is_write; 68995f7142aSPeter Lieven break; 69095f7142aSPeter Lieven } 69195f7142aSPeter Lieven case VIRTIO_BLK_T_FLUSH: 6926e790746SPaolo Bonzini virtio_blk_handle_flush(req, mrb); 69395f7142aSPeter Lieven break; 69495f7142aSPeter Lieven case VIRTIO_BLK_T_SCSI_CMD: 6956e790746SPaolo Bonzini virtio_blk_handle_scsi(req); 69695f7142aSPeter Lieven break; 69795f7142aSPeter Lieven case VIRTIO_BLK_T_GET_ID: 69895f7142aSPeter Lieven { 6996e790746SPaolo Bonzini /* 7006e790746SPaolo Bonzini * NB: per existing s/n string convention the string is 7016e790746SPaolo Bonzini * terminated by '\0' only when shorter than buffer. 7026e790746SPaolo Bonzini */ 7032a30307fSMarkus Armbruster const char *serial = s->conf.serial ? s->conf.serial : ""; 704a83ceea8SMarc Marí size_t size = MIN(strlen(serial) + 1, 705a83ceea8SMarc Marí MIN(iov_size(in_iov, in_num), 706a83ceea8SMarc Marí VIRTIO_BLK_ID_BYTES)); 707a83ceea8SMarc Marí iov_from_buf(in_iov, in_num, 0, serial, size); 7086e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); 709671ec3f0SFam Zheng virtio_blk_free_request(req); 71095f7142aSPeter Lieven break; 71195f7142aSPeter Lieven } 71237b06f8dSStefano Garzarella /* 71337b06f8dSStefano Garzarella * VIRTIO_BLK_T_DISCARD and VIRTIO_BLK_T_WRITE_ZEROES are defined with 71437b06f8dSStefano Garzarella * VIRTIO_BLK_T_OUT flag set. We masked this flag in the switch statement, 71537b06f8dSStefano Garzarella * so we must mask it for these requests, then we will check if it is set. 71637b06f8dSStefano Garzarella */ 71737b06f8dSStefano Garzarella case VIRTIO_BLK_T_DISCARD & ~VIRTIO_BLK_T_OUT: 71837b06f8dSStefano Garzarella case VIRTIO_BLK_T_WRITE_ZEROES & ~VIRTIO_BLK_T_OUT: 71937b06f8dSStefano Garzarella { 72037b06f8dSStefano Garzarella struct virtio_blk_discard_write_zeroes dwz_hdr; 72137b06f8dSStefano Garzarella size_t out_len = iov_size(out_iov, out_num); 72237b06f8dSStefano Garzarella bool is_write_zeroes = (type & ~VIRTIO_BLK_T_BARRIER) == 72337b06f8dSStefano Garzarella VIRTIO_BLK_T_WRITE_ZEROES; 72437b06f8dSStefano Garzarella uint8_t err_status; 72537b06f8dSStefano Garzarella 72637b06f8dSStefano Garzarella /* 72737b06f8dSStefano Garzarella * Unsupported if VIRTIO_BLK_T_OUT is not set or the request contains 72837b06f8dSStefano Garzarella * more than one segment. 72937b06f8dSStefano Garzarella */ 73037b06f8dSStefano Garzarella if (unlikely(!(type & VIRTIO_BLK_T_OUT) || 73137b06f8dSStefano Garzarella out_len > sizeof(dwz_hdr))) { 73237b06f8dSStefano Garzarella virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 73337b06f8dSStefano Garzarella virtio_blk_free_request(req); 73437b06f8dSStefano Garzarella return 0; 73537b06f8dSStefano Garzarella } 73637b06f8dSStefano Garzarella 73737b06f8dSStefano Garzarella if (unlikely(iov_to_buf(out_iov, out_num, 0, &dwz_hdr, 73837b06f8dSStefano Garzarella sizeof(dwz_hdr)) != sizeof(dwz_hdr))) { 73937b06f8dSStefano Garzarella virtio_error(vdev, "virtio-blk discard/write_zeroes header" 74037b06f8dSStefano Garzarella " too short"); 74137b06f8dSStefano Garzarella return -1; 74237b06f8dSStefano Garzarella } 74337b06f8dSStefano Garzarella 74437b06f8dSStefano Garzarella err_status = virtio_blk_handle_discard_write_zeroes(req, &dwz_hdr, 74537b06f8dSStefano Garzarella is_write_zeroes); 74637b06f8dSStefano Garzarella if (err_status != VIRTIO_BLK_S_OK) { 74737b06f8dSStefano Garzarella virtio_blk_req_complete(req, err_status); 74837b06f8dSStefano Garzarella virtio_blk_free_request(req); 74937b06f8dSStefano Garzarella } 75037b06f8dSStefano Garzarella 75137b06f8dSStefano Garzarella break; 75237b06f8dSStefano Garzarella } 75395f7142aSPeter Lieven default: 7546e790746SPaolo Bonzini virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); 755671ec3f0SFam Zheng virtio_blk_free_request(req); 7566e790746SPaolo Bonzini } 75720ea686aSGreg Kurz return 0; 7586e790746SPaolo Bonzini } 7596e790746SPaolo Bonzini 76007931698SFam Zheng bool virtio_blk_handle_vq(VirtIOBlock *s, VirtQueue *vq) 7616e790746SPaolo Bonzini { 7626e790746SPaolo Bonzini VirtIOBlockReq *req; 76395f7142aSPeter Lieven MultiReqBuffer mrb = {}; 76407931698SFam Zheng bool progress = false; 7656e790746SPaolo Bonzini 7669d456654SPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->blk)); 767fc73548eSStefan Hajnoczi blk_io_plug(s->blk); 768fc73548eSStefan Hajnoczi 7699ef9d402SStefan Hajnoczi do { 7709ef9d402SStefan Hajnoczi virtio_queue_set_notification(vq, 0); 7719ef9d402SStefan Hajnoczi 772edaffd9fSStefan Hajnoczi while ((req = virtio_blk_get_request(s, vq))) { 77307931698SFam Zheng progress = true; 77420ea686aSGreg Kurz if (virtio_blk_handle_request(req, &mrb)) { 77520ea686aSGreg Kurz virtqueue_detach_element(req->vq, &req->elem, 0); 77620ea686aSGreg Kurz virtio_blk_free_request(req); 77720ea686aSGreg Kurz break; 77820ea686aSGreg Kurz } 7796e790746SPaolo Bonzini } 7806e790746SPaolo Bonzini 7819ef9d402SStefan Hajnoczi virtio_queue_set_notification(vq, 1); 7829ef9d402SStefan Hajnoczi } while (!virtio_queue_empty(vq)); 7839ef9d402SStefan Hajnoczi 78495f7142aSPeter Lieven if (mrb.num_reqs) { 78595f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 78695f7142aSPeter Lieven } 787fc73548eSStefan Hajnoczi 788fc73548eSStefan Hajnoczi blk_io_unplug(s->blk); 7899d456654SPaolo Bonzini aio_context_release(blk_get_aio_context(s->blk)); 79007931698SFam Zheng return progress; 79107931698SFam Zheng } 79207931698SFam Zheng 79307931698SFam Zheng static void virtio_blk_handle_output_do(VirtIOBlock *s, VirtQueue *vq) 79407931698SFam Zheng { 79507931698SFam Zheng virtio_blk_handle_vq(s, vq); 7966e790746SPaolo Bonzini } 7976e790746SPaolo Bonzini 7988a2fad57SMichael S. Tsirkin static void virtio_blk_handle_output(VirtIODevice *vdev, VirtQueue *vq) 7998a2fad57SMichael S. Tsirkin { 8008a2fad57SMichael S. Tsirkin VirtIOBlock *s = (VirtIOBlock *)vdev; 8018a2fad57SMichael S. Tsirkin 8028a2fad57SMichael S. Tsirkin if (s->dataplane) { 8038a2fad57SMichael S. Tsirkin /* Some guests kick before setting VIRTIO_CONFIG_S_DRIVER_OK so start 8048a2fad57SMichael S. Tsirkin * dataplane here instead of waiting for .set_status(). 8058a2fad57SMichael S. Tsirkin */ 8069ffe337cSPaolo Bonzini virtio_device_start_ioeventfd(vdev); 8078a2fad57SMichael S. Tsirkin if (!s->dataplane_disabled) { 8088a2fad57SMichael S. Tsirkin return; 8098a2fad57SMichael S. Tsirkin } 8108a2fad57SMichael S. Tsirkin } 81107931698SFam Zheng virtio_blk_handle_output_do(s, vq); 8128a2fad57SMichael S. Tsirkin } 8138a2fad57SMichael S. Tsirkin 8146e790746SPaolo Bonzini static void virtio_blk_dma_restart_bh(void *opaque) 8156e790746SPaolo Bonzini { 8166e790746SPaolo Bonzini VirtIOBlock *s = opaque; 8176e790746SPaolo Bonzini VirtIOBlockReq *req = s->rq; 81895f7142aSPeter Lieven MultiReqBuffer mrb = {}; 8196e790746SPaolo Bonzini 8206e790746SPaolo Bonzini qemu_bh_delete(s->bh); 8216e790746SPaolo Bonzini s->bh = NULL; 8226e790746SPaolo Bonzini 8236e790746SPaolo Bonzini s->rq = NULL; 8246e790746SPaolo Bonzini 8251919631eSPaolo Bonzini aio_context_acquire(blk_get_aio_context(s->conf.conf.blk)); 8266e790746SPaolo Bonzini while (req) { 8271bdb176aSzhanghailiang VirtIOBlockReq *next = req->next; 82820ea686aSGreg Kurz if (virtio_blk_handle_request(req, &mrb)) { 82920ea686aSGreg Kurz /* Device is now broken and won't do any processing until it gets 83020ea686aSGreg Kurz * reset. Already queued requests will be lost: let's purge them. 83120ea686aSGreg Kurz */ 83220ea686aSGreg Kurz while (req) { 83320ea686aSGreg Kurz next = req->next; 83420ea686aSGreg Kurz virtqueue_detach_element(req->vq, &req->elem, 0); 83520ea686aSGreg Kurz virtio_blk_free_request(req); 83620ea686aSGreg Kurz req = next; 83720ea686aSGreg Kurz } 83820ea686aSGreg Kurz break; 83920ea686aSGreg Kurz } 8401bdb176aSzhanghailiang req = next; 8416e790746SPaolo Bonzini } 8426e790746SPaolo Bonzini 84395f7142aSPeter Lieven if (mrb.num_reqs) { 84495f7142aSPeter Lieven virtio_blk_submit_multireq(s->blk, &mrb); 84595f7142aSPeter Lieven } 846680f2002SKevin Wolf blk_dec_in_flight(s->conf.conf.blk); 8471919631eSPaolo Bonzini aio_context_release(blk_get_aio_context(s->conf.conf.blk)); 8486e790746SPaolo Bonzini } 8496e790746SPaolo Bonzini 8506e790746SPaolo Bonzini static void virtio_blk_dma_restart_cb(void *opaque, int running, 8516e790746SPaolo Bonzini RunState state) 8526e790746SPaolo Bonzini { 8536e790746SPaolo Bonzini VirtIOBlock *s = opaque; 8546e790746SPaolo Bonzini 8556e790746SPaolo Bonzini if (!running) { 8566e790746SPaolo Bonzini return; 8576e790746SPaolo Bonzini } 8586e790746SPaolo Bonzini 8596e790746SPaolo Bonzini if (!s->bh) { 860680f2002SKevin Wolf /* FIXME The data plane is not started yet, so these requests are 861680f2002SKevin Wolf * processed in the main thread. */ 8624be74634SMarkus Armbruster s->bh = aio_bh_new(blk_get_aio_context(s->conf.conf.blk), 8634407c1c5SFam Zheng virtio_blk_dma_restart_bh, s); 864680f2002SKevin Wolf blk_inc_in_flight(s->conf.conf.blk); 8656e790746SPaolo Bonzini qemu_bh_schedule(s->bh); 8666e790746SPaolo Bonzini } 8676e790746SPaolo Bonzini } 8686e790746SPaolo Bonzini 8696e790746SPaolo Bonzini static void virtio_blk_reset(VirtIODevice *vdev) 8706e790746SPaolo Bonzini { 8716e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 8726e40b3bfSAlexander Yarygin AioContext *ctx; 87326307f6aSFam Zheng VirtIOBlockReq *req; 8746e790746SPaolo Bonzini 8756e40b3bfSAlexander Yarygin ctx = blk_get_aio_context(s->blk); 8766e40b3bfSAlexander Yarygin aio_context_acquire(ctx); 8776e40b3bfSAlexander Yarygin blk_drain(s->blk); 8786e40b3bfSAlexander Yarygin 87926307f6aSFam Zheng /* We drop queued requests after blk_drain() because blk_drain() itself can 88026307f6aSFam Zheng * produce them. */ 88126307f6aSFam Zheng while (s->rq) { 88226307f6aSFam Zheng req = s->rq; 88326307f6aSFam Zheng s->rq = req->next; 88497b93c8aSStefan Hajnoczi virtqueue_detach_element(req->vq, &req->elem, 0); 88526307f6aSFam Zheng virtio_blk_free_request(req); 88626307f6aSFam Zheng } 88726307f6aSFam Zheng 8886e40b3bfSAlexander Yarygin aio_context_release(ctx); 8896e40b3bfSAlexander Yarygin 8909ffe337cSPaolo Bonzini assert(!s->dataplane_started); 8914be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, s->original_wce); 8926e790746SPaolo Bonzini } 8936e790746SPaolo Bonzini 8946e790746SPaolo Bonzini /* coalesce internal state, copy to pci i/o region 0 8956e790746SPaolo Bonzini */ 8966e790746SPaolo Bonzini static void virtio_blk_update_config(VirtIODevice *vdev, uint8_t *config) 8976e790746SPaolo Bonzini { 8986e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 8992a30307fSMarkus Armbruster BlockConf *conf = &s->conf.conf; 9006e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 9016e790746SPaolo Bonzini uint64_t capacity; 90217d0bc01SStefan Hajnoczi int64_t length; 903f7516731SMarkus Armbruster int blk_size = conf->logical_block_size; 9046e790746SPaolo Bonzini 9054be74634SMarkus Armbruster blk_get_geometry(s->blk, &capacity); 9066e790746SPaolo Bonzini memset(&blkcfg, 0, sizeof(blkcfg)); 907783d1897SRusty Russell virtio_stq_p(vdev, &blkcfg.capacity, capacity); 908783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.seg_max, 128 - 2); 909907eb3e5SMichael S. Tsirkin virtio_stw_p(vdev, &blkcfg.geometry.cylinders, conf->cyls); 910783d1897SRusty Russell virtio_stl_p(vdev, &blkcfg.blk_size, blk_size); 911f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.min_io_size, conf->min_io_size / blk_size); 912f7516731SMarkus Armbruster virtio_stw_p(vdev, &blkcfg.opt_io_size, conf->opt_io_size / blk_size); 913907eb3e5SMichael S. Tsirkin blkcfg.geometry.heads = conf->heads; 9146e790746SPaolo Bonzini /* 9156e790746SPaolo Bonzini * We must ensure that the block device capacity is a multiple of 916e03ba136SPeter Maydell * the logical block size. If that is not the case, let's use 9176e790746SPaolo Bonzini * sector_mask to adopt the geometry to have a correct picture. 9186e790746SPaolo Bonzini * For those devices where the capacity is ok for the given geometry 919e03ba136SPeter Maydell * we don't touch the sector value of the geometry, since some devices 9206e790746SPaolo Bonzini * (like s390 dasd) need a specific value. Here the capacity is already 9216e790746SPaolo Bonzini * cyls*heads*secs*blk_size and the sector value is not block size 9226e790746SPaolo Bonzini * divided by 512 - instead it is the amount of blk_size blocks 9236e790746SPaolo Bonzini * per track (cylinder). 9246e790746SPaolo Bonzini */ 92517d0bc01SStefan Hajnoczi length = blk_getlength(s->blk); 92617d0bc01SStefan Hajnoczi if (length > 0 && length / conf->heads / conf->secs % blk_size) { 927907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs & ~s->sector_mask; 9286e790746SPaolo Bonzini } else { 929907eb3e5SMichael S. Tsirkin blkcfg.geometry.sectors = conf->secs; 9306e790746SPaolo Bonzini } 9316e790746SPaolo Bonzini blkcfg.size_max = 0; 932f7516731SMarkus Armbruster blkcfg.physical_block_exp = get_physical_block_exp(conf); 9336e790746SPaolo Bonzini blkcfg.alignment_offset = 0; 9344be74634SMarkus Armbruster blkcfg.wce = blk_enable_write_cache(s->blk); 9352f270590SStefan Hajnoczi virtio_stw_p(vdev, &blkcfg.num_queues, s->conf.num_queues); 93637b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_DISCARD)) { 93737b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_discard_sectors, 93837b06f8dSStefano Garzarella s->conf.max_discard_sectors); 93937b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.discard_sector_alignment, 94037b06f8dSStefano Garzarella blk_size >> BDRV_SECTOR_BITS); 94137b06f8dSStefano Garzarella /* 94237b06f8dSStefano Garzarella * We support only one segment per request since multiple segments 94337b06f8dSStefano Garzarella * are not widely used and there are no userspace APIs that allow 94437b06f8dSStefano Garzarella * applications to submit multiple segments in a single call. 94537b06f8dSStefano Garzarella */ 94637b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_discard_seg, 1); 94737b06f8dSStefano Garzarella } 94837b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_WRITE_ZEROES)) { 94937b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_write_zeroes_sectors, 95037b06f8dSStefano Garzarella s->conf.max_write_zeroes_sectors); 95137b06f8dSStefano Garzarella blkcfg.write_zeroes_may_unmap = 1; 95237b06f8dSStefano Garzarella virtio_stl_p(vdev, &blkcfg.max_write_zeroes_seg, 1); 95337b06f8dSStefano Garzarella } 95420764be0SStefano Garzarella memcpy(config, &blkcfg, s->config_size); 9556e790746SPaolo Bonzini } 9566e790746SPaolo Bonzini 9576e790746SPaolo Bonzini static void virtio_blk_set_config(VirtIODevice *vdev, const uint8_t *config) 9586e790746SPaolo Bonzini { 9596e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 9606e790746SPaolo Bonzini struct virtio_blk_config blkcfg; 9616e790746SPaolo Bonzini 96220764be0SStefano Garzarella memcpy(&blkcfg, config, s->config_size); 9636d7e73d6SFam Zheng 9644be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 9654be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, blkcfg.wce != 0); 9664be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 9676e790746SPaolo Bonzini } 9686e790746SPaolo Bonzini 9699d5b731dSJason Wang static uint64_t virtio_blk_get_features(VirtIODevice *vdev, uint64_t features, 9709d5b731dSJason Wang Error **errp) 9716e790746SPaolo Bonzini { 9726e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 9736e790746SPaolo Bonzini 974bbe8bd4dSStefano Garzarella /* Firstly sync all virtio-blk possible supported features */ 975bbe8bd4dSStefano Garzarella features |= s->host_features; 976bbe8bd4dSStefano Garzarella 9770cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_SEG_MAX); 9780cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_GEOMETRY); 9790cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_TOPOLOGY); 9800cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_BLK_SIZE); 98195129d6fSCornelia Huck if (virtio_has_feature(features, VIRTIO_F_VERSION_1)) { 982bbe8bd4dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_SCSI)) { 983efb8206cSJason Wang error_setg(errp, "Please set scsi=off for virtio-blk devices in order to use virtio 1.0"); 984efb8206cSJason Wang return 0; 985efb8206cSJason Wang } 986efb8206cSJason Wang } else { 987c9b11f97SJason Wang virtio_clear_feature(&features, VIRTIO_F_ANY_LAYOUT); 988efb8206cSJason Wang virtio_add_feature(&features, VIRTIO_BLK_F_SCSI); 989efb8206cSJason Wang } 9906e790746SPaolo Bonzini 9914be74634SMarkus Armbruster if (blk_enable_write_cache(s->blk)) { 9920cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_WCE); 9934be74634SMarkus Armbruster } 9944be74634SMarkus Armbruster if (blk_is_read_only(s->blk)) { 9950cd09c3aSCornelia Huck virtio_add_feature(&features, VIRTIO_BLK_F_RO); 9964be74634SMarkus Armbruster } 9972f270590SStefan Hajnoczi if (s->conf.num_queues > 1) { 9982f270590SStefan Hajnoczi virtio_add_feature(&features, VIRTIO_BLK_F_MQ); 9992f270590SStefan Hajnoczi } 10006e790746SPaolo Bonzini 10016e790746SPaolo Bonzini return features; 10026e790746SPaolo Bonzini } 10036e790746SPaolo Bonzini 10046e790746SPaolo Bonzini static void virtio_blk_set_status(VirtIODevice *vdev, uint8_t status) 10056e790746SPaolo Bonzini { 10066e790746SPaolo Bonzini VirtIOBlock *s = VIRTIO_BLK(vdev); 10076e790746SPaolo Bonzini 10089ffe337cSPaolo Bonzini if (!(status & (VIRTIO_CONFIG_S_DRIVER | VIRTIO_CONFIG_S_DRIVER_OK))) { 10099ffe337cSPaolo Bonzini assert(!s->dataplane_started); 10106e790746SPaolo Bonzini } 10116e790746SPaolo Bonzini 10126e790746SPaolo Bonzini if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { 10136e790746SPaolo Bonzini return; 10146e790746SPaolo Bonzini } 10156e790746SPaolo Bonzini 1016ef5bc962SPaolo Bonzini /* A guest that supports VIRTIO_BLK_F_CONFIG_WCE must be able to send 1017ef5bc962SPaolo Bonzini * cache flushes. Thus, the "auto writethrough" behavior is never 1018ef5bc962SPaolo Bonzini * necessary for guests that support the VIRTIO_BLK_F_CONFIG_WCE feature. 1019ef5bc962SPaolo Bonzini * Leaving it enabled would break the following sequence: 1020ef5bc962SPaolo Bonzini * 1021ef5bc962SPaolo Bonzini * Guest started with "-drive cache=writethrough" 1022ef5bc962SPaolo Bonzini * Guest sets status to 0 1023ef5bc962SPaolo Bonzini * Guest sets DRIVER bit in status field 1024ef5bc962SPaolo Bonzini * Guest reads host features (WCE=0, CONFIG_WCE=1) 1025ef5bc962SPaolo Bonzini * Guest writes guest features (WCE=0, CONFIG_WCE=1) 1026ef5bc962SPaolo Bonzini * Guest writes 1 to the WCE configuration field (writeback mode) 1027ef5bc962SPaolo Bonzini * Guest sets DRIVER_OK bit in status field 1028ef5bc962SPaolo Bonzini * 10294be74634SMarkus Armbruster * s->blk would erroneously be placed in writethrough mode. 1030ef5bc962SPaolo Bonzini */ 103195129d6fSCornelia Huck if (!virtio_vdev_has_feature(vdev, VIRTIO_BLK_F_CONFIG_WCE)) { 10324be74634SMarkus Armbruster aio_context_acquire(blk_get_aio_context(s->blk)); 10334be74634SMarkus Armbruster blk_set_enable_write_cache(s->blk, 103495129d6fSCornelia Huck virtio_vdev_has_feature(vdev, 103595129d6fSCornelia Huck VIRTIO_BLK_F_WCE)); 10364be74634SMarkus Armbruster aio_context_release(blk_get_aio_context(s->blk)); 10376e790746SPaolo Bonzini } 1038ef5bc962SPaolo Bonzini } 10396e790746SPaolo Bonzini 1040b2b295a7SGreg Kurz static void virtio_blk_save_device(VirtIODevice *vdev, QEMUFile *f) 1041b2b295a7SGreg Kurz { 1042b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 1043b2b295a7SGreg Kurz VirtIOBlockReq *req = s->rq; 10446e790746SPaolo Bonzini 10456e790746SPaolo Bonzini while (req) { 10466e790746SPaolo Bonzini qemu_put_sbyte(f, 1); 104730d8bf6dSStefan Hajnoczi 104830d8bf6dSStefan Hajnoczi if (s->conf.num_queues > 1) { 104930d8bf6dSStefan Hajnoczi qemu_put_be32(f, virtio_get_queue_index(req->vq)); 105030d8bf6dSStefan Hajnoczi } 105130d8bf6dSStefan Hajnoczi 1052ab281c17SPaolo Bonzini qemu_put_virtqueue_element(f, &req->elem); 10536e790746SPaolo Bonzini req = req->next; 10546e790746SPaolo Bonzini } 10556e790746SPaolo Bonzini qemu_put_sbyte(f, 0); 10566e790746SPaolo Bonzini } 10576e790746SPaolo Bonzini 1058b2b295a7SGreg Kurz static int virtio_blk_load_device(VirtIODevice *vdev, QEMUFile *f, 1059b2b295a7SGreg Kurz int version_id) 1060b2b295a7SGreg Kurz { 1061b2b295a7SGreg Kurz VirtIOBlock *s = VIRTIO_BLK(vdev); 1062b2b295a7SGreg Kurz 10636e790746SPaolo Bonzini while (qemu_get_sbyte(f)) { 106430d8bf6dSStefan Hajnoczi unsigned nvqs = s->conf.num_queues; 106530d8bf6dSStefan Hajnoczi unsigned vq_idx = 0; 1066ab281c17SPaolo Bonzini VirtIOBlockReq *req; 106730d8bf6dSStefan Hajnoczi 106830d8bf6dSStefan Hajnoczi if (nvqs > 1) { 106930d8bf6dSStefan Hajnoczi vq_idx = qemu_get_be32(f); 107030d8bf6dSStefan Hajnoczi 107130d8bf6dSStefan Hajnoczi if (vq_idx >= nvqs) { 107230d8bf6dSStefan Hajnoczi error_report("Invalid virtqueue index in request list: %#x", 107330d8bf6dSStefan Hajnoczi vq_idx); 107430d8bf6dSStefan Hajnoczi return -EINVAL; 107530d8bf6dSStefan Hajnoczi } 107630d8bf6dSStefan Hajnoczi } 107730d8bf6dSStefan Hajnoczi 10788607f5c3SJason Wang req = qemu_get_virtqueue_element(vdev, f, sizeof(VirtIOBlockReq)); 107930d8bf6dSStefan Hajnoczi virtio_blk_init_request(s, virtio_get_queue(vdev, vq_idx), req); 10806e790746SPaolo Bonzini req->next = s->rq; 10816e790746SPaolo Bonzini s->rq = req; 10826e790746SPaolo Bonzini } 10836e790746SPaolo Bonzini 10846e790746SPaolo Bonzini return 0; 10856e790746SPaolo Bonzini } 10866e790746SPaolo Bonzini 10876e790746SPaolo Bonzini static void virtio_blk_resize(void *opaque) 10886e790746SPaolo Bonzini { 10896e790746SPaolo Bonzini VirtIODevice *vdev = VIRTIO_DEVICE(opaque); 10906e790746SPaolo Bonzini 10916e790746SPaolo Bonzini virtio_notify_config(vdev); 10926e790746SPaolo Bonzini } 10936e790746SPaolo Bonzini 10946e790746SPaolo Bonzini static const BlockDevOps virtio_block_ops = { 10956e790746SPaolo Bonzini .resize_cb = virtio_blk_resize, 10966e790746SPaolo Bonzini }; 10976e790746SPaolo Bonzini 109875884afdSAndreas Färber static void virtio_blk_device_realize(DeviceState *dev, Error **errp) 10996e790746SPaolo Bonzini { 110075884afdSAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 1101179b417eSAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 11022a30307fSMarkus Armbruster VirtIOBlkConf *conf = &s->conf; 11033ffeeef7SAndreas Färber Error *err = NULL; 11042f270590SStefan Hajnoczi unsigned i; 11056e790746SPaolo Bonzini 11064be74634SMarkus Armbruster if (!conf->conf.blk) { 110775884afdSAndreas Färber error_setg(errp, "drive property not set"); 110875884afdSAndreas Färber return; 11096e790746SPaolo Bonzini } 11104be74634SMarkus Armbruster if (!blk_is_inserted(conf->conf.blk)) { 111175884afdSAndreas Färber error_setg(errp, "Device needs media, but drive is empty"); 111275884afdSAndreas Färber return; 11136e790746SPaolo Bonzini } 11142f270590SStefan Hajnoczi if (!conf->num_queues) { 11152f270590SStefan Hajnoczi error_setg(errp, "num-queues property must be larger than 0"); 11162f270590SStefan Hajnoczi return; 11172f270590SStefan Hajnoczi } 11186040aeddSMark Kanda if (!is_power_of_2(conf->queue_size) || 11196040aeddSMark Kanda conf->queue_size > VIRTQUEUE_MAX_SIZE) { 11206040aeddSMark Kanda error_setg(errp, "invalid queue-size property (%" PRIu16 "), " 11216040aeddSMark Kanda "must be a power of 2 (max %d)", 11226040aeddSMark Kanda conf->queue_size, VIRTQUEUE_MAX_SIZE); 11236040aeddSMark Kanda return; 11246040aeddSMark Kanda } 11256e790746SPaolo Bonzini 1126ceff3e1fSMao Zhongyi if (!blkconf_apply_backend_options(&conf->conf, 1127a17c17a2SKevin Wolf blk_is_read_only(conf->conf.blk), true, 1128ceff3e1fSMao Zhongyi errp)) { 1129a17c17a2SKevin Wolf return; 1130a17c17a2SKevin Wolf } 11314be74634SMarkus Armbruster s->original_wce = blk_enable_write_cache(conf->conf.blk); 1132ceff3e1fSMao Zhongyi if (!blkconf_geometry(&conf->conf, NULL, 65535, 255, 255, errp)) { 113375884afdSAndreas Färber return; 11346e790746SPaolo Bonzini } 1135ceff3e1fSMao Zhongyi 11360eb28a42SEkaterina Tumanova blkconf_blocksizes(&conf->conf); 11376e790746SPaolo Bonzini 11380a75b60cSMark Kanda if (conf->conf.logical_block_size > 11390a75b60cSMark Kanda conf->conf.physical_block_size) { 11400a75b60cSMark Kanda error_setg(errp, 11410a75b60cSMark Kanda "logical_block_size > physical_block_size not supported"); 11420a75b60cSMark Kanda return; 11430a75b60cSMark Kanda } 11440a75b60cSMark Kanda 114537b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_DISCARD) && 114637b06f8dSStefano Garzarella (!conf->max_discard_sectors || 114737b06f8dSStefano Garzarella conf->max_discard_sectors > BDRV_REQUEST_MAX_SECTORS)) { 114837b06f8dSStefano Garzarella error_setg(errp, "invalid max-discard-sectors property (%" PRIu32 ")" 114937b06f8dSStefano Garzarella ", must be between 1 and %d", 115037b06f8dSStefano Garzarella conf->max_discard_sectors, (int)BDRV_REQUEST_MAX_SECTORS); 115137b06f8dSStefano Garzarella return; 115237b06f8dSStefano Garzarella } 115337b06f8dSStefano Garzarella 115437b06f8dSStefano Garzarella if (virtio_has_feature(s->host_features, VIRTIO_BLK_F_WRITE_ZEROES) && 115537b06f8dSStefano Garzarella (!conf->max_write_zeroes_sectors || 115637b06f8dSStefano Garzarella conf->max_write_zeroes_sectors > BDRV_REQUEST_MAX_SECTORS)) { 115737b06f8dSStefano Garzarella error_setg(errp, "invalid max-write-zeroes-sectors property (%" PRIu32 115837b06f8dSStefano Garzarella "), must be between 1 and %d", 115937b06f8dSStefano Garzarella conf->max_write_zeroes_sectors, 116037b06f8dSStefano Garzarella (int)BDRV_REQUEST_MAX_SECTORS); 116137b06f8dSStefano Garzarella return; 116237b06f8dSStefano Garzarella } 116337b06f8dSStefano Garzarella 116420764be0SStefano Garzarella virtio_blk_set_config_size(s, s->host_features); 116520764be0SStefano Garzarella 116620764be0SStefano Garzarella virtio_init(vdev, "virtio-blk", VIRTIO_ID_BLOCK, s->config_size); 11676e790746SPaolo Bonzini 11684be74634SMarkus Armbruster s->blk = conf->conf.blk; 11696e790746SPaolo Bonzini s->rq = NULL; 11702a30307fSMarkus Armbruster s->sector_mask = (s->conf.conf.logical_block_size / BDRV_SECTOR_SIZE) - 1; 11716e790746SPaolo Bonzini 11722f270590SStefan Hajnoczi for (i = 0; i < conf->num_queues; i++) { 11736040aeddSMark Kanda virtio_add_queue(vdev, conf->queue_size, virtio_blk_handle_output); 11742f270590SStefan Hajnoczi } 11752a30307fSMarkus Armbruster virtio_blk_data_plane_create(vdev, conf, &s->dataplane, &err); 11763ffeeef7SAndreas Färber if (err != NULL) { 117775884afdSAndreas Färber error_propagate(errp, err); 11786a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 117975884afdSAndreas Färber return; 11806e790746SPaolo Bonzini } 11816e790746SPaolo Bonzini 11826e790746SPaolo Bonzini s->change = qemu_add_vm_change_state_handler(virtio_blk_dma_restart_cb, s); 11834be74634SMarkus Armbruster blk_set_dev_ops(s->blk, &virtio_block_ops, s); 11844be74634SMarkus Armbruster blk_set_guest_block_size(s->blk, s->conf.conf.logical_block_size); 11856e790746SPaolo Bonzini 11864be74634SMarkus Armbruster blk_iostatus_enable(s->blk); 11876e790746SPaolo Bonzini } 11886e790746SPaolo Bonzini 1189306ec6c3SAndreas Färber static void virtio_blk_device_unrealize(DeviceState *dev, Error **errp) 11906e790746SPaolo Bonzini { 1191306ec6c3SAndreas Färber VirtIODevice *vdev = VIRTIO_DEVICE(dev); 1192306ec6c3SAndreas Färber VirtIOBlock *s = VIRTIO_BLK(dev); 1193306ec6c3SAndreas Färber 11946e790746SPaolo Bonzini virtio_blk_data_plane_destroy(s->dataplane); 11956e790746SPaolo Bonzini s->dataplane = NULL; 11966e790746SPaolo Bonzini qemu_del_vm_change_state_handler(s->change); 11974be74634SMarkus Armbruster blockdev_mark_auto_del(s->blk); 11986a1a8cc7SKONRAD Frederic virtio_cleanup(vdev); 11996e790746SPaolo Bonzini } 12006e790746SPaolo Bonzini 1201467b3f33SStefan Hajnoczi static void virtio_blk_instance_init(Object *obj) 1202467b3f33SStefan Hajnoczi { 1203467b3f33SStefan Hajnoczi VirtIOBlock *s = VIRTIO_BLK(obj); 1204467b3f33SStefan Hajnoczi 12052a30307fSMarkus Armbruster device_add_bootindex_property(obj, &s->conf.conf.bootindex, 12063342ec32SGonglei "bootindex", "/disk@0,0", 12073342ec32SGonglei DEVICE(obj), NULL); 1208467b3f33SStefan Hajnoczi } 1209467b3f33SStefan Hajnoczi 1210977a117fSHalil Pasic static const VMStateDescription vmstate_virtio_blk = { 1211977a117fSHalil Pasic .name = "virtio-blk", 1212977a117fSHalil Pasic .minimum_version_id = 2, 1213977a117fSHalil Pasic .version_id = 2, 1214977a117fSHalil Pasic .fields = (VMStateField[]) { 1215977a117fSHalil Pasic VMSTATE_VIRTIO_DEVICE, 1216977a117fSHalil Pasic VMSTATE_END_OF_LIST() 1217977a117fSHalil Pasic }, 1218977a117fSHalil Pasic }; 1219bbded32cSDr. David Alan Gilbert 12206e790746SPaolo Bonzini static Property virtio_blk_properties[] = { 12212a30307fSMarkus Armbruster DEFINE_BLOCK_PROPERTIES(VirtIOBlock, conf.conf), 12228c398252SKevin Wolf DEFINE_BLOCK_ERROR_PROPERTIES(VirtIOBlock, conf.conf), 12232a30307fSMarkus Armbruster DEFINE_BLOCK_CHS_PROPERTIES(VirtIOBlock, conf.conf), 12242a30307fSMarkus Armbruster DEFINE_PROP_STRING("serial", VirtIOBlock, conf.serial), 1225bbe8bd4dSStefano Garzarella DEFINE_PROP_BIT64("config-wce", VirtIOBlock, host_features, 1226bbe8bd4dSStefano Garzarella VIRTIO_BLK_F_CONFIG_WCE, true), 122732a877e4SStefan Hajnoczi #ifdef __linux__ 1228bbe8bd4dSStefano Garzarella DEFINE_PROP_BIT64("scsi", VirtIOBlock, host_features, 1229bbe8bd4dSStefano Garzarella VIRTIO_BLK_F_SCSI, false), 123032a877e4SStefan Hajnoczi #endif 1231c99495acSPeter Lieven DEFINE_PROP_BIT("request-merging", VirtIOBlock, conf.request_merging, 0, 1232c99495acSPeter Lieven true), 12332f270590SStefan Hajnoczi DEFINE_PROP_UINT16("num-queues", VirtIOBlock, conf.num_queues, 1), 12346040aeddSMark Kanda DEFINE_PROP_UINT16("queue-size", VirtIOBlock, conf.queue_size, 128), 1235d679ac09SFam Zheng DEFINE_PROP_LINK("iothread", VirtIOBlock, conf.iothread, TYPE_IOTHREAD, 1236d679ac09SFam Zheng IOThread *), 12375c81161fSStefano Garzarella DEFINE_PROP_BIT64("discard", VirtIOBlock, host_features, 12385c81161fSStefano Garzarella VIRTIO_BLK_F_DISCARD, true), 12395c81161fSStefano Garzarella DEFINE_PROP_BIT64("write-zeroes", VirtIOBlock, host_features, 12405c81161fSStefano Garzarella VIRTIO_BLK_F_WRITE_ZEROES, true), 124137b06f8dSStefano Garzarella DEFINE_PROP_UINT32("max-discard-sectors", VirtIOBlock, 124237b06f8dSStefano Garzarella conf.max_discard_sectors, BDRV_REQUEST_MAX_SECTORS), 124337b06f8dSStefano Garzarella DEFINE_PROP_UINT32("max-write-zeroes-sectors", VirtIOBlock, 124437b06f8dSStefano Garzarella conf.max_write_zeroes_sectors, BDRV_REQUEST_MAX_SECTORS), 12456e790746SPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 12466e790746SPaolo Bonzini }; 12476e790746SPaolo Bonzini 12486e790746SPaolo Bonzini static void virtio_blk_class_init(ObjectClass *klass, void *data) 12496e790746SPaolo Bonzini { 12506e790746SPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 12516e790746SPaolo Bonzini VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); 125275884afdSAndreas Färber 12536e790746SPaolo Bonzini dc->props = virtio_blk_properties; 1254bbded32cSDr. David Alan Gilbert dc->vmsd = &vmstate_virtio_blk; 1255125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 125675884afdSAndreas Färber vdc->realize = virtio_blk_device_realize; 1257306ec6c3SAndreas Färber vdc->unrealize = virtio_blk_device_unrealize; 12586e790746SPaolo Bonzini vdc->get_config = virtio_blk_update_config; 12596e790746SPaolo Bonzini vdc->set_config = virtio_blk_set_config; 12606e790746SPaolo Bonzini vdc->get_features = virtio_blk_get_features; 12616e790746SPaolo Bonzini vdc->set_status = virtio_blk_set_status; 12626e790746SPaolo Bonzini vdc->reset = virtio_blk_reset; 1263b2b295a7SGreg Kurz vdc->save = virtio_blk_save_device; 1264b2b295a7SGreg Kurz vdc->load = virtio_blk_load_device; 12659ffe337cSPaolo Bonzini vdc->start_ioeventfd = virtio_blk_data_plane_start; 12669ffe337cSPaolo Bonzini vdc->stop_ioeventfd = virtio_blk_data_plane_stop; 12676e790746SPaolo Bonzini } 12686e790746SPaolo Bonzini 1269b5c7ceafSChanglong Xie static const TypeInfo virtio_blk_info = { 12706e790746SPaolo Bonzini .name = TYPE_VIRTIO_BLK, 12716e790746SPaolo Bonzini .parent = TYPE_VIRTIO_DEVICE, 12726e790746SPaolo Bonzini .instance_size = sizeof(VirtIOBlock), 1273467b3f33SStefan Hajnoczi .instance_init = virtio_blk_instance_init, 12746e790746SPaolo Bonzini .class_init = virtio_blk_class_init, 12756e790746SPaolo Bonzini }; 12766e790746SPaolo Bonzini 12776e790746SPaolo Bonzini static void virtio_register_types(void) 12786e790746SPaolo Bonzini { 1279b5c7ceafSChanglong Xie type_register_static(&virtio_blk_info); 12806e790746SPaolo Bonzini } 12816e790746SPaolo Bonzini 12826e790746SPaolo Bonzini type_init(virtio_register_types) 1283