]>
Commit | Line | Data |
---|---|---|
6e02c38d AL |
1 | /* |
2 | * Virtio Block Device | |
3 | * | |
4 | * Copyright IBM, Corp. 2007 | |
5 | * | |
6 | * Authors: | |
7 | * Anthony Liguori <[email protected]> | |
8 | * | |
9 | * This work is licensed under the terms of the GNU GPL, version 2. See | |
10 | * the COPYING file in the top-level directory. | |
11 | * | |
12 | */ | |
13 | ||
5a61cb60 | 14 | #include "qemu-common.h" |
827805a2 | 15 | #include "qemu/iov.h" |
1de7afc9 | 16 | #include "qemu/error-report.h" |
6d519a5f | 17 | #include "trace.h" |
0d09e41a | 18 | #include "hw/block/block.h" |
4be74634 | 19 | #include "sysemu/block-backend.h" |
9c17d615 | 20 | #include "sysemu/blockdev.h" |
0d09e41a | 21 | #include "hw/virtio/virtio-blk.h" |
52b53c04 FZ |
22 | #include "dataplane/virtio-blk.h" |
23 | #include "migration/migration.h" | |
0d09e41a | 24 | #include "block/scsi.h" |
1063b8b1 CH |
25 | #ifdef __linux__ |
26 | # include <scsi/sg.h> | |
27 | #endif | |
0d09e41a | 28 | #include "hw/virtio/virtio-bus.h" |
783d1897 | 29 | #include "hw/virtio/virtio-access.h" |
6e02c38d | 30 | |
f897bf75 | 31 | VirtIOBlockReq *virtio_blk_alloc_request(VirtIOBlock *s) |
671ec3f0 | 32 | { |
869d66af | 33 | VirtIOBlockReq *req = g_slice_new(VirtIOBlockReq); |
671ec3f0 | 34 | req->dev = s; |
869d66af SH |
35 | req->qiov.size = 0; |
36 | req->next = NULL; | |
671ec3f0 FZ |
37 | return req; |
38 | } | |
39 | ||
f897bf75 | 40 | void virtio_blk_free_request(VirtIOBlockReq *req) |
671ec3f0 FZ |
41 | { |
42 | if (req) { | |
671ec3f0 FZ |
43 | g_slice_free(VirtIOBlockReq, req); |
44 | } | |
45 | } | |
46 | ||
bf4bd461 FZ |
47 | static void virtio_blk_complete_request(VirtIOBlockReq *req, |
48 | unsigned char status) | |
869a5c6d AL |
49 | { |
50 | VirtIOBlock *s = req->dev; | |
1cc91b7d | 51 | VirtIODevice *vdev = VIRTIO_DEVICE(s); |
869a5c6d | 52 | |
6d519a5f SH |
53 | trace_virtio_blk_req_complete(req, status); |
54 | ||
92e3c2a3 | 55 | stb_p(&req->in->status, status); |
f897bf75 | 56 | virtqueue_push(s->vq, &req->elem, req->qiov.size + sizeof(*req->in)); |
1cc91b7d | 57 | virtio_notify(vdev, s->vq); |
869a5c6d AL |
58 | } |
59 | ||
bf4bd461 FZ |
60 | static void virtio_blk_req_complete(VirtIOBlockReq *req, unsigned char status) |
61 | { | |
62 | req->dev->complete_request(req, status); | |
63 | } | |
64 | ||
f35d68f0 | 65 | static int virtio_blk_handle_rw_error(VirtIOBlockReq *req, int error, |
1ceee0d5 | 66 | bool is_read) |
869a5c6d | 67 | { |
4be74634 MA |
68 | BlockErrorAction action = blk_get_error_action(req->dev->blk, |
69 | is_read, error); | |
869a5c6d AL |
70 | VirtIOBlock *s = req->dev; |
71 | ||
a589569f | 72 | if (action == BLOCK_ERROR_ACTION_STOP) { |
869a5c6d AL |
73 | req->next = s->rq; |
74 | s->rq = req; | |
a589569f | 75 | } else if (action == BLOCK_ERROR_ACTION_REPORT) { |
869a5c6d | 76 | virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); |
4be74634 | 77 | block_acct_done(blk_get_stats(s->blk), &req->acct); |
671ec3f0 | 78 | virtio_blk_free_request(req); |
869a5c6d AL |
79 | } |
80 | ||
4be74634 | 81 | blk_error_action(s->blk, action, is_read, error); |
a589569f | 82 | return action != BLOCK_ERROR_ACTION_IGNORE; |
869a5c6d AL |
83 | } |
84 | ||
6e02c38d AL |
85 | static void virtio_blk_rw_complete(void *opaque, int ret) |
86 | { | |
87 | VirtIOBlockReq *req = opaque; | |
6e02c38d | 88 | |
6d519a5f SH |
89 | trace_virtio_blk_rw_complete(req, ret); |
90 | ||
f35d68f0 | 91 | if (ret) { |
783d1897 RR |
92 | int p = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); |
93 | bool is_read = !(p & VIRTIO_BLK_T_OUT); | |
f35d68f0 | 94 | if (virtio_blk_handle_rw_error(req, -ret, is_read)) |
869a5c6d | 95 | return; |
6e02c38d AL |
96 | } |
97 | ||
f35d68f0 | 98 | virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); |
4be74634 | 99 | block_acct_done(blk_get_stats(req->dev->blk), &req->acct); |
671ec3f0 | 100 | virtio_blk_free_request(req); |
869a5c6d | 101 | } |
6e02c38d | 102 | |
aa659be3 CH |
103 | static void virtio_blk_flush_complete(void *opaque, int ret) |
104 | { | |
105 | VirtIOBlockReq *req = opaque; | |
106 | ||
8c269b54 KW |
107 | if (ret) { |
108 | if (virtio_blk_handle_rw_error(req, -ret, 0)) { | |
109 | return; | |
110 | } | |
111 | } | |
112 | ||
113 | virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); | |
4be74634 | 114 | block_acct_done(blk_get_stats(req->dev->blk), &req->acct); |
671ec3f0 | 115 | virtio_blk_free_request(req); |
6e02c38d AL |
116 | } |
117 | ||
118 | static VirtIOBlockReq *virtio_blk_get_request(VirtIOBlock *s) | |
119 | { | |
869a5c6d | 120 | VirtIOBlockReq *req = virtio_blk_alloc_request(s); |
6e02c38d | 121 | |
f897bf75 | 122 | if (!virtqueue_pop(s->vq, &req->elem)) { |
671ec3f0 FZ |
123 | virtio_blk_free_request(req); |
124 | return NULL; | |
6e02c38d AL |
125 | } |
126 | ||
127 | return req; | |
128 | } | |
129 | ||
5a05cbee FZ |
130 | int virtio_blk_handle_scsi_req(VirtIOBlock *blk, |
131 | VirtQueueElement *elem) | |
1063b8b1 | 132 | { |
5a05cbee FZ |
133 | int status = VIRTIO_BLK_S_OK; |
134 | struct virtio_scsi_inhdr *scsi = NULL; | |
783d1897 RR |
135 | VirtIODevice *vdev = VIRTIO_DEVICE(blk); |
136 | ||
47ce9ef7 | 137 | #ifdef __linux__ |
1063b8b1 | 138 | int i; |
5a05cbee | 139 | struct sg_io_hdr hdr; |
47ce9ef7 | 140 | #endif |
1063b8b1 CH |
141 | |
142 | /* | |
143 | * We require at least one output segment each for the virtio_blk_outhdr | |
144 | * and the SCSI command block. | |
145 | * | |
146 | * We also at least require the virtio_blk_inhdr, the virtio_scsi_inhdr | |
147 | * and the sense buffer pointer in the input segments. | |
148 | */ | |
5a05cbee FZ |
149 | if (elem->out_num < 2 || elem->in_num < 3) { |
150 | status = VIRTIO_BLK_S_IOERR; | |
151 | goto fail; | |
1063b8b1 CH |
152 | } |
153 | ||
154 | /* | |
f34e73cd PB |
155 | * The scsi inhdr is placed in the second-to-last input segment, just |
156 | * before the regular inhdr. | |
1063b8b1 | 157 | */ |
5a05cbee | 158 | scsi = (void *)elem->in_sg[elem->in_num - 2].iov_base; |
f34e73cd | 159 | |
2a30307f | 160 | if (!blk->conf.scsi) { |
f34e73cd PB |
161 | status = VIRTIO_BLK_S_UNSUPP; |
162 | goto fail; | |
1063b8b1 CH |
163 | } |
164 | ||
165 | /* | |
f34e73cd | 166 | * No support for bidirection commands yet. |
1063b8b1 | 167 | */ |
5a05cbee | 168 | if (elem->out_num > 2 && elem->in_num > 3) { |
f34e73cd PB |
169 | status = VIRTIO_BLK_S_UNSUPP; |
170 | goto fail; | |
171 | } | |
1063b8b1 | 172 | |
f34e73cd | 173 | #ifdef __linux__ |
1063b8b1 CH |
174 | memset(&hdr, 0, sizeof(struct sg_io_hdr)); |
175 | hdr.interface_id = 'S'; | |
5a05cbee FZ |
176 | hdr.cmd_len = elem->out_sg[1].iov_len; |
177 | hdr.cmdp = elem->out_sg[1].iov_base; | |
1063b8b1 CH |
178 | hdr.dxfer_len = 0; |
179 | ||
5a05cbee | 180 | if (elem->out_num > 2) { |
1063b8b1 CH |
181 | /* |
182 | * If there are more than the minimally required 2 output segments | |
183 | * there is write payload starting from the third iovec. | |
184 | */ | |
185 | hdr.dxfer_direction = SG_DXFER_TO_DEV; | |
5a05cbee | 186 | hdr.iovec_count = elem->out_num - 2; |
1063b8b1 CH |
187 | |
188 | for (i = 0; i < hdr.iovec_count; i++) | |
5a05cbee | 189 | hdr.dxfer_len += elem->out_sg[i + 2].iov_len; |
1063b8b1 | 190 | |
5a05cbee | 191 | hdr.dxferp = elem->out_sg + 2; |
1063b8b1 | 192 | |
5a05cbee | 193 | } else if (elem->in_num > 3) { |
1063b8b1 CH |
194 | /* |
195 | * If we have more than 3 input segments the guest wants to actually | |
196 | * read data. | |
197 | */ | |
198 | hdr.dxfer_direction = SG_DXFER_FROM_DEV; | |
5a05cbee | 199 | hdr.iovec_count = elem->in_num - 3; |
1063b8b1 | 200 | for (i = 0; i < hdr.iovec_count; i++) |
5a05cbee | 201 | hdr.dxfer_len += elem->in_sg[i].iov_len; |
1063b8b1 | 202 | |
5a05cbee | 203 | hdr.dxferp = elem->in_sg; |
1063b8b1 CH |
204 | } else { |
205 | /* | |
206 | * Some SCSI commands don't actually transfer any data. | |
207 | */ | |
208 | hdr.dxfer_direction = SG_DXFER_NONE; | |
209 | } | |
210 | ||
5a05cbee FZ |
211 | hdr.sbp = elem->in_sg[elem->in_num - 3].iov_base; |
212 | hdr.mx_sb_len = elem->in_sg[elem->in_num - 3].iov_len; | |
1063b8b1 | 213 | |
4be74634 | 214 | status = blk_ioctl(blk->blk, SG_IO, &hdr); |
5a05cbee | 215 | if (status) { |
1063b8b1 | 216 | status = VIRTIO_BLK_S_UNSUPP; |
f34e73cd | 217 | goto fail; |
1063b8b1 CH |
218 | } |
219 | ||
5bb23927 PB |
220 | /* |
221 | * From SCSI-Generic-HOWTO: "Some lower level drivers (e.g. ide-scsi) | |
222 | * clear the masked_status field [hence status gets cleared too, see | |
223 | * block/scsi_ioctl.c] even when a CHECK_CONDITION or COMMAND_TERMINATED | |
224 | * status has occurred. However they do set DRIVER_SENSE in driver_status | |
225 | * field. Also a (sb_len_wr > 0) indicates there is a sense buffer. | |
226 | */ | |
227 | if (hdr.status == 0 && hdr.sb_len_wr > 0) { | |
228 | hdr.status = CHECK_CONDITION; | |
229 | } | |
230 | ||
783d1897 RR |
231 | virtio_stl_p(vdev, &scsi->errors, |
232 | hdr.status | (hdr.msg_status << 8) | | |
233 | (hdr.host_status << 16) | (hdr.driver_status << 24)); | |
234 | virtio_stl_p(vdev, &scsi->residual, hdr.resid); | |
235 | virtio_stl_p(vdev, &scsi->sense_len, hdr.sb_len_wr); | |
236 | virtio_stl_p(vdev, &scsi->data_len, hdr.dxfer_len); | |
1063b8b1 | 237 | |
5a05cbee | 238 | return status; |
1063b8b1 | 239 | #else |
f34e73cd PB |
240 | abort(); |
241 | #endif | |
242 | ||
243 | fail: | |
244 | /* Just put anything nonzero so that the ioctl fails in the guest. */ | |
5a05cbee | 245 | if (scsi) { |
783d1897 | 246 | virtio_stl_p(vdev, &scsi->errors, 255); |
5a05cbee FZ |
247 | } |
248 | return status; | |
249 | } | |
250 | ||
251 | static void virtio_blk_handle_scsi(VirtIOBlockReq *req) | |
252 | { | |
253 | int status; | |
254 | ||
f897bf75 | 255 | status = virtio_blk_handle_scsi_req(req->dev, &req->elem); |
f34e73cd | 256 | virtio_blk_req_complete(req, status); |
671ec3f0 | 257 | virtio_blk_free_request(req); |
1063b8b1 | 258 | } |
1063b8b1 | 259 | |
4be74634 | 260 | void virtio_submit_multiwrite(BlockBackend *blk, MultiReqBuffer *mrb) |
869a5c6d | 261 | { |
91553dcc | 262 | int i, ret; |
91553dcc | 263 | |
c20fd872 CH |
264 | if (!mrb->num_writes) { |
265 | return; | |
266 | } | |
267 | ||
4be74634 | 268 | ret = blk_aio_multiwrite(blk, mrb->blkreq, mrb->num_writes); |
91553dcc | 269 | if (ret != 0) { |
c20fd872 CH |
270 | for (i = 0; i < mrb->num_writes; i++) { |
271 | if (mrb->blkreq[i].error) { | |
272 | virtio_blk_rw_complete(mrb->blkreq[i].opaque, -EIO); | |
91553dcc KW |
273 | } |
274 | } | |
275 | } | |
c20fd872 CH |
276 | |
277 | mrb->num_writes = 0; | |
91553dcc | 278 | } |
87b245db | 279 | |
c20fd872 | 280 | static void virtio_blk_handle_flush(VirtIOBlockReq *req, MultiReqBuffer *mrb) |
aa659be3 | 281 | { |
4be74634 | 282 | block_acct_start(blk_get_stats(req->dev->blk), &req->acct, 0, |
5366d0c8 | 283 | BLOCK_ACCT_FLUSH); |
a597e79c | 284 | |
618fbb84 CH |
285 | /* |
286 | * Make sure all outstanding writes are posted to the backing device. | |
287 | */ | |
4be74634 MA |
288 | virtio_submit_multiwrite(req->dev->blk, mrb); |
289 | blk_aio_flush(req->dev->blk, virtio_blk_flush_complete, req); | |
aa659be3 CH |
290 | } |
291 | ||
d0e14376 MA |
292 | static bool virtio_blk_sect_range_ok(VirtIOBlock *dev, |
293 | uint64_t sector, size_t size) | |
294 | { | |
3c2daac0 MA |
295 | uint64_t nb_sectors = size >> BDRV_SECTOR_BITS; |
296 | uint64_t total_sectors; | |
297 | ||
d0e14376 MA |
298 | if (sector & dev->sector_mask) { |
299 | return false; | |
300 | } | |
2a30307f | 301 | if (size % dev->conf.conf.logical_block_size) { |
d0e14376 MA |
302 | return false; |
303 | } | |
4be74634 | 304 | blk_get_geometry(dev->blk, &total_sectors); |
3c2daac0 MA |
305 | if (sector > total_sectors || nb_sectors > total_sectors - sector) { |
306 | return false; | |
307 | } | |
d0e14376 MA |
308 | return true; |
309 | } | |
310 | ||
c20fd872 | 311 | static void virtio_blk_handle_write(VirtIOBlockReq *req, MultiReqBuffer *mrb) |
91553dcc | 312 | { |
c20fd872 | 313 | BlockRequest *blkreq; |
92e3c2a3 | 314 | uint64_t sector; |
c20fd872 | 315 | |
783d1897 | 316 | sector = virtio_ldq_p(VIRTIO_DEVICE(req->dev), &req->out.sector); |
6d519a5f | 317 | |
92e3c2a3 AJ |
318 | trace_virtio_blk_handle_write(req, sector, req->qiov.size / 512); |
319 | ||
d0e14376 | 320 | if (!virtio_blk_sect_range_ok(req->dev, sector, req->qiov.size)) { |
42e38c1f MA |
321 | virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); |
322 | virtio_blk_free_request(req); | |
52c05023 CH |
323 | return; |
324 | } | |
8cfacf07 | 325 | |
4be74634 | 326 | block_acct_start(blk_get_stats(req->dev->blk), &req->acct, req->qiov.size, |
5366d0c8 | 327 | BLOCK_ACCT_WRITE); |
42e38c1f | 328 | |
c20fd872 | 329 | if (mrb->num_writes == 32) { |
4be74634 | 330 | virtio_submit_multiwrite(req->dev->blk, mrb); |
87b245db | 331 | } |
91553dcc | 332 | |
c20fd872 | 333 | blkreq = &mrb->blkreq[mrb->num_writes]; |
92e3c2a3 | 334 | blkreq->sector = sector; |
c20fd872 CH |
335 | blkreq->nb_sectors = req->qiov.size / BDRV_SECTOR_SIZE; |
336 | blkreq->qiov = &req->qiov; | |
337 | blkreq->cb = virtio_blk_rw_complete; | |
338 | blkreq->opaque = req; | |
339 | blkreq->error = 0; | |
91553dcc | 340 | |
c20fd872 | 341 | mrb->num_writes++; |
d28a1b6e | 342 | } |
869a5c6d | 343 | |
d28a1b6e AL |
344 | static void virtio_blk_handle_read(VirtIOBlockReq *req) |
345 | { | |
92e3c2a3 AJ |
346 | uint64_t sector; |
347 | ||
783d1897 | 348 | sector = virtio_ldq_p(VIRTIO_DEVICE(req->dev), &req->out.sector); |
87b245db | 349 | |
81b6b9fa SH |
350 | trace_virtio_blk_handle_read(req, sector, req->qiov.size / 512); |
351 | ||
d0e14376 | 352 | if (!virtio_blk_sect_range_ok(req->dev, sector, req->qiov.size)) { |
42e38c1f MA |
353 | virtio_blk_req_complete(req, VIRTIO_BLK_S_IOERR); |
354 | virtio_blk_free_request(req); | |
52c05023 CH |
355 | return; |
356 | } | |
42e38c1f | 357 | |
4be74634 | 358 | block_acct_start(blk_get_stats(req->dev->blk), &req->acct, req->qiov.size, |
5366d0c8 | 359 | BLOCK_ACCT_READ); |
4be74634 MA |
360 | blk_aio_readv(req->dev->blk, sector, &req->qiov, |
361 | req->qiov.size / BDRV_SECTOR_SIZE, | |
362 | virtio_blk_rw_complete, req); | |
869a5c6d AL |
363 | } |
364 | ||
fee65db7 | 365 | void virtio_blk_handle_request(VirtIOBlockReq *req, MultiReqBuffer *mrb) |
bc6694d4 | 366 | { |
92e3c2a3 | 367 | uint32_t type; |
f897bf75 SH |
368 | struct iovec *in_iov = req->elem.in_sg; |
369 | struct iovec *iov = req->elem.out_sg; | |
370 | unsigned in_num = req->elem.in_num; | |
371 | unsigned out_num = req->elem.out_num; | |
92e3c2a3 | 372 | |
f897bf75 | 373 | if (req->elem.out_num < 1 || req->elem.in_num < 1) { |
870cef1d | 374 | error_report("virtio-blk missing headers"); |
bc6694d4 KW |
375 | exit(1); |
376 | } | |
377 | ||
827805a2 FZ |
378 | if (unlikely(iov_to_buf(iov, out_num, 0, &req->out, |
379 | sizeof(req->out)) != sizeof(req->out))) { | |
380 | error_report("virtio-blk request outhdr too short"); | |
381 | exit(1); | |
382 | } | |
ee17e848 | 383 | |
827805a2 | 384 | iov_discard_front(&iov, &out_num, sizeof(req->out)); |
ee17e848 FZ |
385 | |
386 | if (in_num < 1 || | |
387 | in_iov[in_num - 1].iov_len < sizeof(struct virtio_blk_inhdr)) { | |
388 | error_report("virtio-blk request inhdr too short"); | |
389 | exit(1); | |
390 | } | |
391 | ||
392 | req->in = (void *)in_iov[in_num - 1].iov_base | |
393 | + in_iov[in_num - 1].iov_len | |
394 | - sizeof(struct virtio_blk_inhdr); | |
395 | iov_discard_back(in_iov, &in_num, sizeof(struct virtio_blk_inhdr)); | |
bc6694d4 | 396 | |
783d1897 | 397 | type = virtio_ldl_p(VIRTIO_DEVICE(req->dev), &req->out.type); |
92e3c2a3 AJ |
398 | |
399 | if (type & VIRTIO_BLK_T_FLUSH) { | |
c20fd872 | 400 | virtio_blk_handle_flush(req, mrb); |
92e3c2a3 | 401 | } else if (type & VIRTIO_BLK_T_SCSI_CMD) { |
bc6694d4 | 402 | virtio_blk_handle_scsi(req); |
92e3c2a3 | 403 | } else if (type & VIRTIO_BLK_T_GET_ID) { |
2930b313 | 404 | VirtIOBlock *s = req->dev; |
405 | ||
a8686a9b MA |
406 | /* |
407 | * NB: per existing s/n string convention the string is | |
408 | * terminated by '\0' only when shorter than buffer. | |
409 | */ | |
2a30307f | 410 | const char *serial = s->conf.serial ? s->conf.serial : ""; |
a83ceea8 MM |
411 | size_t size = MIN(strlen(serial) + 1, |
412 | MIN(iov_size(in_iov, in_num), | |
413 | VIRTIO_BLK_ID_BYTES)); | |
414 | iov_from_buf(in_iov, in_num, 0, serial, size); | |
2930b313 | 415 | virtio_blk_req_complete(req, VIRTIO_BLK_S_OK); |
671ec3f0 | 416 | virtio_blk_free_request(req); |
92e3c2a3 | 417 | } else if (type & VIRTIO_BLK_T_OUT) { |
a83ceea8 | 418 | qemu_iovec_init_external(&req->qiov, iov, out_num); |
c20fd872 | 419 | virtio_blk_handle_write(req, mrb); |
9e72c450 AZ |
420 | } else if (type == VIRTIO_BLK_T_IN || type == VIRTIO_BLK_T_BARRIER) { |
421 | /* VIRTIO_BLK_T_IN is 0, so we can't just & it. */ | |
a83ceea8 | 422 | qemu_iovec_init_external(&req->qiov, in_iov, in_num); |
bc6694d4 | 423 | virtio_blk_handle_read(req); |
9e72c450 AZ |
424 | } else { |
425 | virtio_blk_req_complete(req, VIRTIO_BLK_S_UNSUPP); | |
671ec3f0 | 426 | virtio_blk_free_request(req); |
bc6694d4 KW |
427 | } |
428 | } | |
429 | ||
6e02c38d AL |
430 | static void virtio_blk_handle_output(VirtIODevice *vdev, VirtQueue *vq) |
431 | { | |
1cc91b7d | 432 | VirtIOBlock *s = VIRTIO_BLK(vdev); |
6e02c38d | 433 | VirtIOBlockReq *req; |
bc6694d4 KW |
434 | MultiReqBuffer mrb = { |
435 | .num_writes = 0, | |
bc6694d4 | 436 | }; |
6e02c38d | 437 | |
392808b4 SH |
438 | /* Some guests kick before setting VIRTIO_CONFIG_S_DRIVER_OK so start |
439 | * dataplane here instead of waiting for .set_status(). | |
440 | */ | |
441 | if (s->dataplane) { | |
442 | virtio_blk_data_plane_start(s->dataplane); | |
443 | return; | |
444 | } | |
392808b4 | 445 | |
6e02c38d | 446 | while ((req = virtio_blk_get_request(s))) { |
bc6694d4 | 447 | virtio_blk_handle_request(req, &mrb); |
6e02c38d | 448 | } |
91553dcc | 449 | |
4be74634 | 450 | virtio_submit_multiwrite(s->blk, &mrb); |
91553dcc | 451 | |
6e02c38d AL |
452 | /* |
453 | * FIXME: Want to check for completions before returning to guest mode, | |
454 | * so cached reads and writes are reported as quickly as possible. But | |
455 | * that should be done in the generic block layer. | |
456 | */ | |
457 | } | |
458 | ||
213189ab | 459 | static void virtio_blk_dma_restart_bh(void *opaque) |
869a5c6d AL |
460 | { |
461 | VirtIOBlock *s = opaque; | |
462 | VirtIOBlockReq *req = s->rq; | |
f1b52868 KW |
463 | MultiReqBuffer mrb = { |
464 | .num_writes = 0, | |
f1b52868 | 465 | }; |
869a5c6d | 466 | |
213189ab MA |
467 | qemu_bh_delete(s->bh); |
468 | s->bh = NULL; | |
869a5c6d AL |
469 | |
470 | s->rq = NULL; | |
471 | ||
472 | while (req) { | |
1bdb176a | 473 | VirtIOBlockReq *next = req->next; |
f1b52868 | 474 | virtio_blk_handle_request(req, &mrb); |
1bdb176a | 475 | req = next; |
869a5c6d | 476 | } |
f1b52868 | 477 | |
4be74634 | 478 | virtio_submit_multiwrite(s->blk, &mrb); |
869a5c6d AL |
479 | } |
480 | ||
1dfb4dd9 LC |
481 | static void virtio_blk_dma_restart_cb(void *opaque, int running, |
482 | RunState state) | |
213189ab MA |
483 | { |
484 | VirtIOBlock *s = opaque; | |
485 | ||
392808b4 | 486 | if (!running) { |
213189ab | 487 | return; |
392808b4 | 488 | } |
213189ab MA |
489 | |
490 | if (!s->bh) { | |
4be74634 | 491 | s->bh = aio_bh_new(blk_get_aio_context(s->conf.conf.blk), |
4407c1c5 | 492 | virtio_blk_dma_restart_bh, s); |
213189ab MA |
493 | qemu_bh_schedule(s->bh); |
494 | } | |
495 | } | |
496 | ||
6e02c38d AL |
497 | static void virtio_blk_reset(VirtIODevice *vdev) |
498 | { | |
1cc91b7d | 499 | VirtIOBlock *s = VIRTIO_BLK(vdev); |
392808b4 SH |
500 | |
501 | if (s->dataplane) { | |
502 | virtio_blk_data_plane_stop(s->dataplane); | |
503 | } | |
392808b4 | 504 | |
6e02c38d AL |
505 | /* |
506 | * This should cancel pending requests, but can't do nicely until there | |
507 | * are per-device request lists. | |
508 | */ | |
4be74634 MA |
509 | blk_drain_all(); |
510 | blk_set_enable_write_cache(s->blk, s->original_wce); | |
6e02c38d AL |
511 | } |
512 | ||
bf011293 | 513 | /* coalesce internal state, copy to pci i/o region 0 |
514 | */ | |
6e02c38d AL |
515 | static void virtio_blk_update_config(VirtIODevice *vdev, uint8_t *config) |
516 | { | |
1cc91b7d | 517 | VirtIOBlock *s = VIRTIO_BLK(vdev); |
2a30307f | 518 | BlockConf *conf = &s->conf.conf; |
6e02c38d AL |
519 | struct virtio_blk_config blkcfg; |
520 | uint64_t capacity; | |
f7516731 | 521 | int blk_size = conf->logical_block_size; |
6e02c38d | 522 | |
4be74634 | 523 | blk_get_geometry(s->blk, &capacity); |
5c5dafdc | 524 | memset(&blkcfg, 0, sizeof(blkcfg)); |
783d1897 RR |
525 | virtio_stq_p(vdev, &blkcfg.capacity, capacity); |
526 | virtio_stl_p(vdev, &blkcfg.seg_max, 128 - 2); | |
f7516731 | 527 | virtio_stw_p(vdev, &blkcfg.cylinders, conf->cyls); |
783d1897 | 528 | virtio_stl_p(vdev, &blkcfg.blk_size, blk_size); |
f7516731 MA |
529 | virtio_stw_p(vdev, &blkcfg.min_io_size, conf->min_io_size / blk_size); |
530 | virtio_stw_p(vdev, &blkcfg.opt_io_size, conf->opt_io_size / blk_size); | |
531 | blkcfg.heads = conf->heads; | |
136be99e CB |
532 | /* |
533 | * We must ensure that the block device capacity is a multiple of | |
e03ba136 | 534 | * the logical block size. If that is not the case, let's use |
136be99e CB |
535 | * sector_mask to adopt the geometry to have a correct picture. |
536 | * For those devices where the capacity is ok for the given geometry | |
e03ba136 | 537 | * we don't touch the sector value of the geometry, since some devices |
136be99e CB |
538 | * (like s390 dasd) need a specific value. Here the capacity is already |
539 | * cyls*heads*secs*blk_size and the sector value is not block size | |
540 | * divided by 512 - instead it is the amount of blk_size blocks | |
541 | * per track (cylinder). | |
542 | */ | |
4be74634 | 543 | if (blk_getlength(s->blk) / conf->heads / conf->secs % blk_size) { |
f7516731 | 544 | blkcfg.sectors = conf->secs & ~s->sector_mask; |
136be99e | 545 | } else { |
f7516731 | 546 | blkcfg.sectors = conf->secs; |
136be99e | 547 | } |
c7085da7 | 548 | blkcfg.size_max = 0; |
f7516731 | 549 | blkcfg.physical_block_exp = get_physical_block_exp(conf); |
9752c371 | 550 | blkcfg.alignment_offset = 0; |
4be74634 | 551 | blkcfg.wce = blk_enable_write_cache(s->blk); |
37d5ddd6 | 552 | memcpy(config, &blkcfg, sizeof(struct virtio_blk_config)); |
6e02c38d AL |
553 | } |
554 | ||
13e3dce0 PB |
555 | static void virtio_blk_set_config(VirtIODevice *vdev, const uint8_t *config) |
556 | { | |
1cc91b7d | 557 | VirtIOBlock *s = VIRTIO_BLK(vdev); |
13e3dce0 PB |
558 | struct virtio_blk_config blkcfg; |
559 | ||
560 | memcpy(&blkcfg, config, sizeof(blkcfg)); | |
6d7e73d6 | 561 | |
4be74634 MA |
562 | aio_context_acquire(blk_get_aio_context(s->blk)); |
563 | blk_set_enable_write_cache(s->blk, blkcfg.wce != 0); | |
564 | aio_context_release(blk_get_aio_context(s->blk)); | |
13e3dce0 PB |
565 | } |
566 | ||
8172539d | 567 | static uint32_t virtio_blk_get_features(VirtIODevice *vdev, uint32_t features) |
6e02c38d | 568 | { |
1cc91b7d | 569 | VirtIOBlock *s = VIRTIO_BLK(vdev); |
1063b8b1 CH |
570 | |
571 | features |= (1 << VIRTIO_BLK_F_SEG_MAX); | |
572 | features |= (1 << VIRTIO_BLK_F_GEOMETRY); | |
9752c371 | 573 | features |= (1 << VIRTIO_BLK_F_TOPOLOGY); |
8cfacf07 | 574 | features |= (1 << VIRTIO_BLK_F_BLK_SIZE); |
a6c5c84a | 575 | features |= (1 << VIRTIO_BLK_F_SCSI); |
aa659be3 | 576 | |
2a30307f | 577 | if (s->conf.config_wce) { |
8a873ba7 SH |
578 | features |= (1 << VIRTIO_BLK_F_CONFIG_WCE); |
579 | } | |
4be74634 | 580 | if (blk_enable_write_cache(s->blk)) { |
13e3dce0 | 581 | features |= (1 << VIRTIO_BLK_F_WCE); |
4be74634 MA |
582 | } |
583 | if (blk_is_read_only(s->blk)) { | |
c79662f7 | 584 | features |= 1 << VIRTIO_BLK_F_RO; |
4be74634 | 585 | } |
1063b8b1 CH |
586 | |
587 | return features; | |
6e02c38d AL |
588 | } |
589 | ||
9315cbfd PB |
590 | static void virtio_blk_set_status(VirtIODevice *vdev, uint8_t status) |
591 | { | |
1cc91b7d | 592 | VirtIOBlock *s = VIRTIO_BLK(vdev); |
9315cbfd PB |
593 | uint32_t features; |
594 | ||
cf139388 SH |
595 | if (s->dataplane && !(status & (VIRTIO_CONFIG_S_DRIVER | |
596 | VIRTIO_CONFIG_S_DRIVER_OK))) { | |
392808b4 SH |
597 | virtio_blk_data_plane_stop(s->dataplane); |
598 | } | |
392808b4 | 599 | |
9315cbfd PB |
600 | if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { |
601 | return; | |
602 | } | |
603 | ||
604 | features = vdev->guest_features; | |
ef5bc962 PB |
605 | |
606 | /* A guest that supports VIRTIO_BLK_F_CONFIG_WCE must be able to send | |
607 | * cache flushes. Thus, the "auto writethrough" behavior is never | |
608 | * necessary for guests that support the VIRTIO_BLK_F_CONFIG_WCE feature. | |
609 | * Leaving it enabled would break the following sequence: | |
610 | * | |
611 | * Guest started with "-drive cache=writethrough" | |
612 | * Guest sets status to 0 | |
613 | * Guest sets DRIVER bit in status field | |
614 | * Guest reads host features (WCE=0, CONFIG_WCE=1) | |
615 | * Guest writes guest features (WCE=0, CONFIG_WCE=1) | |
616 | * Guest writes 1 to the WCE configuration field (writeback mode) | |
617 | * Guest sets DRIVER_OK bit in status field | |
618 | * | |
4be74634 | 619 | * s->blk would erroneously be placed in writethrough mode. |
ef5bc962 PB |
620 | */ |
621 | if (!(features & (1 << VIRTIO_BLK_F_CONFIG_WCE))) { | |
4be74634 MA |
622 | aio_context_acquire(blk_get_aio_context(s->blk)); |
623 | blk_set_enable_write_cache(s->blk, | |
624 | !!(features & (1 << VIRTIO_BLK_F_WCE))); | |
625 | aio_context_release(blk_get_aio_context(s->blk)); | |
ef5bc962 | 626 | } |
9315cbfd PB |
627 | } |
628 | ||
6e02c38d AL |
629 | static void virtio_blk_save(QEMUFile *f, void *opaque) |
630 | { | |
b2b295a7 | 631 | VirtIODevice *vdev = VIRTIO_DEVICE(opaque); |
869a5c6d | 632 | |
1cc91b7d | 633 | virtio_save(vdev, f); |
b2b295a7 | 634 | } |
869a5c6d | 635 | |
b2b295a7 GK |
636 | static void virtio_blk_save_device(VirtIODevice *vdev, QEMUFile *f) |
637 | { | |
638 | VirtIOBlock *s = VIRTIO_BLK(vdev); | |
639 | VirtIOBlockReq *req = s->rq; | |
640 | ||
869a5c6d AL |
641 | while (req) { |
642 | qemu_put_sbyte(f, 1); | |
f897bf75 | 643 | qemu_put_buffer(f, (unsigned char *)&req->elem, |
671ec3f0 | 644 | sizeof(VirtQueueElement)); |
869a5c6d AL |
645 | req = req->next; |
646 | } | |
647 | qemu_put_sbyte(f, 0); | |
6e02c38d AL |
648 | } |
649 | ||
650 | static int virtio_blk_load(QEMUFile *f, void *opaque, int version_id) | |
651 | { | |
652 | VirtIOBlock *s = opaque; | |
1cc91b7d | 653 | VirtIODevice *vdev = VIRTIO_DEVICE(s); |
6e02c38d | 654 | |
869a5c6d | 655 | if (version_id != 2) |
6e02c38d AL |
656 | return -EINVAL; |
657 | ||
b2b295a7 GK |
658 | return virtio_load(vdev, f, version_id); |
659 | } | |
660 | ||
661 | static int virtio_blk_load_device(VirtIODevice *vdev, QEMUFile *f, | |
662 | int version_id) | |
663 | { | |
664 | VirtIOBlock *s = VIRTIO_BLK(vdev); | |
2a633c46 | 665 | |
869a5c6d AL |
666 | while (qemu_get_sbyte(f)) { |
667 | VirtIOBlockReq *req = virtio_blk_alloc_request(s); | |
f897bf75 | 668 | qemu_get_buffer(f, (unsigned char *)&req->elem, |
671ec3f0 | 669 | sizeof(VirtQueueElement)); |
869a5c6d | 670 | req->next = s->rq; |
20a81e4d | 671 | s->rq = req; |
b6a4805b | 672 | |
f897bf75 SH |
673 | virtqueue_map_sg(req->elem.in_sg, req->elem.in_addr, |
674 | req->elem.in_num, 1); | |
675 | virtqueue_map_sg(req->elem.out_sg, req->elem.out_addr, | |
676 | req->elem.out_num, 0); | |
869a5c6d | 677 | } |
6e02c38d AL |
678 | |
679 | return 0; | |
680 | } | |
681 | ||
145feb17 | 682 | static void virtio_blk_resize(void *opaque) |
e5051fc7 | 683 | { |
1cc91b7d | 684 | VirtIODevice *vdev = VIRTIO_DEVICE(opaque); |
e5051fc7 | 685 | |
1cc91b7d | 686 | virtio_notify_config(vdev); |
e5051fc7 CH |
687 | } |
688 | ||
0e49de52 | 689 | static const BlockDevOps virtio_block_ops = { |
145feb17 | 690 | .resize_cb = virtio_blk_resize, |
0e49de52 MA |
691 | }; |
692 | ||
84db52d0 SH |
693 | /* Disable dataplane thread during live migration since it does not |
694 | * update the dirty memory bitmap yet. | |
695 | */ | |
696 | static void virtio_blk_migration_state_changed(Notifier *notifier, void *data) | |
697 | { | |
698 | VirtIOBlock *s = container_of(notifier, VirtIOBlock, | |
699 | migration_state_notifier); | |
700 | MigrationState *mig = data; | |
3ffeeef7 | 701 | Error *err = NULL; |
84db52d0 SH |
702 | |
703 | if (migration_in_setup(mig)) { | |
704 | if (!s->dataplane) { | |
705 | return; | |
706 | } | |
707 | virtio_blk_data_plane_destroy(s->dataplane); | |
708 | s->dataplane = NULL; | |
709 | } else if (migration_has_finished(mig) || | |
710 | migration_has_failed(mig)) { | |
711 | if (s->dataplane) { | |
712 | return; | |
713 | } | |
4be74634 | 714 | blk_drain_all(); /* complete in-flight non-dataplane requests */ |
2a30307f | 715 | virtio_blk_data_plane_create(VIRTIO_DEVICE(s), &s->conf, |
3ffeeef7 AF |
716 | &s->dataplane, &err); |
717 | if (err != NULL) { | |
718 | error_report("%s", error_get_pretty(err)); | |
719 | error_free(err); | |
720 | } | |
84db52d0 SH |
721 | } |
722 | } | |
84db52d0 | 723 | |
75884afd | 724 | static void virtio_blk_device_realize(DeviceState *dev, Error **errp) |
1c028ddf | 725 | { |
75884afd | 726 | VirtIODevice *vdev = VIRTIO_DEVICE(dev); |
179b417e | 727 | VirtIOBlock *s = VIRTIO_BLK(dev); |
2a30307f | 728 | VirtIOBlkConf *conf = &s->conf; |
3ffeeef7 | 729 | Error *err = NULL; |
6e02c38d | 730 | static int virtio_blk_id; |
cf21e106 | 731 | |
4be74634 | 732 | if (!conf->conf.blk) { |
75884afd AF |
733 | error_setg(errp, "drive property not set"); |
734 | return; | |
d75d25e3 | 735 | } |
4be74634 | 736 | if (!blk_is_inserted(conf->conf.blk)) { |
75884afd AF |
737 | error_setg(errp, "Device needs media, but drive is empty"); |
738 | return; | |
98f28ad7 | 739 | } |
d75d25e3 | 740 | |
2a30307f | 741 | blkconf_serial(&conf->conf, &conf->serial); |
4be74634 | 742 | s->original_wce = blk_enable_write_cache(conf->conf.blk); |
2a30307f | 743 | blkconf_geometry(&conf->conf, NULL, 65535, 255, 255, &err); |
5ff5efb4 FZ |
744 | if (err) { |
745 | error_propagate(errp, err); | |
75884afd | 746 | return; |
b7eb0c9f | 747 | } |
a8686a9b | 748 | |
05ff6865 FK |
749 | virtio_init(vdev, "virtio-blk", VIRTIO_ID_BLOCK, |
750 | sizeof(struct virtio_blk_config)); | |
6e02c38d | 751 | |
4be74634 | 752 | s->blk = conf->conf.blk; |
869a5c6d | 753 | s->rq = NULL; |
2a30307f | 754 | s->sector_mask = (s->conf.conf.logical_block_size / BDRV_SECTOR_SIZE) - 1; |
e63e7fde | 755 | |
05ff6865 | 756 | s->vq = virtio_add_queue(vdev, 128, virtio_blk_handle_output); |
bf4bd461 | 757 | s->complete_request = virtio_blk_complete_request; |
2a30307f | 758 | virtio_blk_data_plane_create(vdev, conf, &s->dataplane, &err); |
3ffeeef7 | 759 | if (err != NULL) { |
75884afd | 760 | error_propagate(errp, err); |
6a1a8cc7 | 761 | virtio_cleanup(vdev); |
75884afd | 762 | return; |
392808b4 | 763 | } |
84db52d0 SH |
764 | s->migration_state_notifier.notify = virtio_blk_migration_state_changed; |
765 | add_migration_state_change_notifier(&s->migration_state_notifier); | |
6e02c38d | 766 | |
69b302b2 | 767 | s->change = qemu_add_vm_change_state_handler(virtio_blk_dma_restart_cb, s); |
179b417e | 768 | register_savevm(dev, "virtio-blk", virtio_blk_id++, 2, |
6e02c38d | 769 | virtio_blk_save, virtio_blk_load, s); |
4be74634 MA |
770 | blk_set_dev_ops(s->blk, &virtio_block_ops, s); |
771 | blk_set_guest_block_size(s->blk, s->conf.conf.logical_block_size); | |
6e02c38d | 772 | |
4be74634 | 773 | blk_iostatus_enable(s->blk); |
1c028ddf FK |
774 | } |
775 | ||
306ec6c3 | 776 | static void virtio_blk_device_unrealize(DeviceState *dev, Error **errp) |
1c028ddf | 777 | { |
306ec6c3 AF |
778 | VirtIODevice *vdev = VIRTIO_DEVICE(dev); |
779 | VirtIOBlock *s = VIRTIO_BLK(dev); | |
780 | ||
84db52d0 | 781 | remove_migration_state_change_notifier(&s->migration_state_notifier); |
1c028ddf FK |
782 | virtio_blk_data_plane_destroy(s->dataplane); |
783 | s->dataplane = NULL; | |
1c028ddf | 784 | qemu_del_vm_change_state_handler(s->change); |
306ec6c3 | 785 | unregister_savevm(dev, "virtio-blk", s); |
4be74634 | 786 | blockdev_mark_auto_del(s->blk); |
6a1a8cc7 | 787 | virtio_cleanup(vdev); |
1c028ddf FK |
788 | } |
789 | ||
467b3f33 SH |
790 | static void virtio_blk_instance_init(Object *obj) |
791 | { | |
792 | VirtIOBlock *s = VIRTIO_BLK(obj); | |
793 | ||
794 | object_property_add_link(obj, "iothread", TYPE_IOTHREAD, | |
2a30307f | 795 | (Object **)&s->conf.iothread, |
467b3f33 SH |
796 | qdev_prop_allow_set_link_before_realize, |
797 | OBJ_PROP_LINK_UNREF_ON_RELEASE, NULL); | |
2a30307f | 798 | device_add_bootindex_property(obj, &s->conf.conf.bootindex, |
3342ec32 GA |
799 | "bootindex", "/disk@0,0", |
800 | DEVICE(obj), NULL); | |
467b3f33 SH |
801 | } |
802 | ||
1c028ddf | 803 | static Property virtio_blk_properties[] = { |
2a30307f MA |
804 | DEFINE_BLOCK_PROPERTIES(VirtIOBlock, conf.conf), |
805 | DEFINE_BLOCK_CHS_PROPERTIES(VirtIOBlock, conf.conf), | |
806 | DEFINE_PROP_STRING("serial", VirtIOBlock, conf.serial), | |
807 | DEFINE_PROP_BIT("config-wce", VirtIOBlock, conf.config_wce, 0, true), | |
32a877e4 | 808 | #ifdef __linux__ |
2a30307f | 809 | DEFINE_PROP_BIT("scsi", VirtIOBlock, conf.scsi, 0, true), |
32a877e4 | 810 | #endif |
2a30307f | 811 | DEFINE_PROP_BIT("x-data-plane", VirtIOBlock, conf.data_plane, 0, false), |
1c028ddf FK |
812 | DEFINE_PROP_END_OF_LIST(), |
813 | }; | |
814 | ||
815 | static void virtio_blk_class_init(ObjectClass *klass, void *data) | |
816 | { | |
817 | DeviceClass *dc = DEVICE_CLASS(klass); | |
818 | VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); | |
75884afd | 819 | |
1c028ddf | 820 | dc->props = virtio_blk_properties; |
125ee0ed | 821 | set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); |
75884afd | 822 | vdc->realize = virtio_blk_device_realize; |
306ec6c3 | 823 | vdc->unrealize = virtio_blk_device_unrealize; |
1c028ddf FK |
824 | vdc->get_config = virtio_blk_update_config; |
825 | vdc->set_config = virtio_blk_set_config; | |
826 | vdc->get_features = virtio_blk_get_features; | |
827 | vdc->set_status = virtio_blk_set_status; | |
828 | vdc->reset = virtio_blk_reset; | |
b2b295a7 GK |
829 | vdc->save = virtio_blk_save_device; |
830 | vdc->load = virtio_blk_load_device; | |
1c028ddf FK |
831 | } |
832 | ||
833 | static const TypeInfo virtio_device_info = { | |
834 | .name = TYPE_VIRTIO_BLK, | |
835 | .parent = TYPE_VIRTIO_DEVICE, | |
836 | .instance_size = sizeof(VirtIOBlock), | |
467b3f33 | 837 | .instance_init = virtio_blk_instance_init, |
1c028ddf FK |
838 | .class_init = virtio_blk_class_init, |
839 | }; | |
840 | ||
841 | static void virtio_register_types(void) | |
842 | { | |
843 | type_register_static(&virtio_device_info); | |
844 | } | |
845 | ||
846 | type_init(virtio_register_types) |