]> git.proxmox.com Git - mirror_qemu.git/blame - hw/scsi/virtio-scsi.c
target-sparc: fix 32-bit truncation in fpackfix
[mirror_qemu.git] / hw / scsi / virtio-scsi.c
CommitLineData
973abc7f
SH
1/*
2 * Virtio SCSI HBA
3 *
4 * Copyright IBM, Corp. 2010
5 * Copyright Red Hat, Inc. 2011
6 *
7 * Authors:
8 * Stefan Hajnoczi <stefanha@linux.vnet.ibm.com>
9 * Paolo Bonzini <pbonzini@redhat.com>
10 *
11 * This work is licensed under the terms of the GNU GPL, version 2 or later.
12 * See the COPYING file in the top-level directory.
13 *
14 */
15
019adbd3 16#include "standard-headers/linux/virtio_ids.h"
0d09e41a 17#include "hw/virtio/virtio-scsi.h"
b4a42f81 18#include "qemu/error-report.h"
36b15c79 19#include "qemu/iov.h"
4be74634 20#include "sysemu/block-backend.h"
0d09e41a
PB
21#include <hw/scsi/scsi.h>
22#include <block/scsi.h>
23#include <hw/virtio/virtio-bus.h>
8c085dbe 24#include "hw/virtio/virtio-access.h"
dfb37cf7 25#include "migration/migration.h"
973abc7f 26
2ccdcd8d
PB
27static inline int virtio_scsi_get_lun(uint8_t *lun)
28{
29 return ((lun[2] << 8) | lun[3]) & 0x3FFF;
30}
31
32static inline SCSIDevice *virtio_scsi_device_find(VirtIOSCSI *s, uint8_t *lun)
33{
34 if (lun[0] != 1) {
35 return NULL;
36 }
37 if (lun[2] != 0 && !(lun[2] >= 0x40 && lun[2] < 0x80)) {
38 return NULL;
39 }
40 return scsi_device_find(&s->bus, 0, lun[1], virtio_scsi_get_lun(lun));
41}
42
c505333d 43VirtIOSCSIReq *virtio_scsi_init_req(VirtIOSCSI *s, VirtQueue *vq)
36b15c79
PB
44{
45 VirtIOSCSIReq *req;
faf1e1fb
FZ
46 VirtIOSCSICommon *vs = (VirtIOSCSICommon *)s;
47 const size_t zero_skip = offsetof(VirtIOSCSIReq, elem)
48 + sizeof(VirtQueueElement);
36b15c79 49
633dccb4 50 req = g_malloc(sizeof(*req) + vs->cdb_size);
36b15c79
PB
51 req->vq = vq;
52 req->dev = s;
36b15c79 53 qemu_sglist_init(&req->qsgl, DEVICE(s), 8, &address_space_memory);
3eff1f46 54 qemu_iovec_init(&req->resp_iov, 1);
faf1e1fb 55 memset((uint8_t *)req + zero_skip, 0, sizeof(*req) - zero_skip);
36b15c79
PB
56 return req;
57}
58
aa8e8f83 59void virtio_scsi_free_req(VirtIOSCSIReq *req)
36b15c79 60{
3eff1f46 61 qemu_iovec_destroy(&req->resp_iov);
36b15c79 62 qemu_sglist_destroy(&req->qsgl);
633dccb4 63 g_free(req);
36b15c79
PB
64}
65
326799c0
SH
66static void virtio_scsi_complete_req(VirtIOSCSIReq *req)
67{
68 VirtIOSCSI *s = req->dev;
69 VirtQueue *vq = req->vq;
0ac8e139 70 VirtIODevice *vdev = VIRTIO_DEVICE(s);
3eff1f46
PB
71
72 qemu_iovec_from_buf(&req->resp_iov, 0, &req->resp, req->resp_size);
63c7e542
FZ
73 if (req->vring) {
74 assert(req->vq == NULL);
75 virtio_scsi_vring_push_notify(req);
76 } else {
77 virtqueue_push(vq, &req->elem, req->qsgl.size + req->resp_iov.size);
78 virtio_notify(vdev, vq);
79 }
80
326799c0
SH
81 if (req->sreq) {
82 req->sreq->hba_private = NULL;
83 scsi_req_unref(req->sreq);
84 }
36b15c79 85 virtio_scsi_free_req(req);
326799c0
SH
86}
87
88static void virtio_scsi_bad_req(void)
89{
90 error_report("wrong size for virtio-scsi headers");
91 exit(1);
92}
93
57fbae6e
PB
94static size_t qemu_sgl_concat(VirtIOSCSIReq *req, struct iovec *iov,
95 hwaddr *addr, int num, size_t skip)
326799c0 96{
f487b677 97 QEMUSGList *qsgl = &req->qsgl;
57fbae6e
PB
98 size_t copied = 0;
99
100 while (num) {
101 if (skip >= iov->iov_len) {
102 skip -= iov->iov_len;
103 } else {
104 qemu_sglist_add(qsgl, *addr + skip, iov->iov_len - skip);
105 copied += iov->iov_len - skip;
106 skip = 0;
107 }
108 iov++;
109 addr++;
110 num--;
326799c0 111 }
57fbae6e
PB
112
113 assert(skip == 0);
114 return copied;
326799c0
SH
115}
116
36b15c79
PB
117static int virtio_scsi_parse_req(VirtIOSCSIReq *req,
118 unsigned req_size, unsigned resp_size)
326799c0 119{
55783a55 120 VirtIODevice *vdev = (VirtIODevice *) req->dev;
3eff1f46 121 size_t in_size, out_size;
36b15c79 122
3eff1f46
PB
123 if (iov_to_buf(req->elem.out_sg, req->elem.out_num, 0,
124 &req->req, req_size) < req_size) {
36b15c79
PB
125 return -EINVAL;
126 }
36b15c79 127
3eff1f46
PB
128 if (qemu_iovec_concat_iov(&req->resp_iov,
129 req->elem.in_sg, req->elem.in_num, 0,
130 resp_size) < resp_size) {
36b15c79
PB
131 return -EINVAL;
132 }
55783a55 133
489c7901 134 req->resp_size = resp_size;
326799c0 135
55783a55
PB
136 /* Old BIOSes left some padding by mistake after the req_size/resp_size.
137 * As a workaround, always consider the first buffer as the virtio-scsi
138 * request/response, making the payload start at the second element
139 * of the iovec.
140 *
141 * The actual length of the response header, stored in req->resp_size,
142 * does not change.
143 *
144 * TODO: always disable this workaround for virtio 1.0 devices.
145 */
95129d6f 146 if (!virtio_vdev_has_feature(vdev, VIRTIO_F_ANY_LAYOUT)) {
2034e324
FZ
147 if (req->elem.out_num) {
148 req_size = req->elem.out_sg[0].iov_len;
149 }
150 if (req->elem.in_num) {
151 resp_size = req->elem.in_sg[0].iov_len;
152 }
55783a55
PB
153 }
154
3eff1f46
PB
155 out_size = qemu_sgl_concat(req, req->elem.out_sg,
156 &req->elem.out_addr[0], req->elem.out_num,
157 req_size);
158 in_size = qemu_sgl_concat(req, req->elem.in_sg,
159 &req->elem.in_addr[0], req->elem.in_num,
160 resp_size);
161
162 if (out_size && in_size) {
163 return -ENOTSUP;
164 }
165
166 if (out_size) {
167 req->mode = SCSI_XFER_TO_DEV;
168 } else if (in_size) {
169 req->mode = SCSI_XFER_FROM_DEV;
326799c0 170 }
36b15c79
PB
171
172 return 0;
326799c0
SH
173}
174
175static VirtIOSCSIReq *virtio_scsi_pop_req(VirtIOSCSI *s, VirtQueue *vq)
176{
36b15c79 177 VirtIOSCSIReq *req = virtio_scsi_init_req(s, vq);
326799c0 178 if (!virtqueue_pop(vq, &req->elem)) {
36b15c79 179 virtio_scsi_free_req(req);
326799c0
SH
180 return NULL;
181 }
326799c0
SH
182 return req;
183}
184
5db1764c
PB
185static void virtio_scsi_save_request(QEMUFile *f, SCSIRequest *sreq)
186{
187 VirtIOSCSIReq *req = sreq->hba_private;
292c8e50 188 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(req->dev);
d2ad7dd4 189 uint32_t n = virtio_queue_get_id(req->vq) - 2;
5db1764c 190
292c8e50 191 assert(n < vs->conf.num_queues);
fcf104a7 192 qemu_put_be32s(f, &n);
5db1764c
PB
193 qemu_put_buffer(f, (unsigned char *)&req->elem, sizeof(req->elem));
194}
195
196static void *virtio_scsi_load_request(QEMUFile *f, SCSIRequest *sreq)
197{
198 SCSIBus *bus = sreq->bus;
199 VirtIOSCSI *s = container_of(bus, VirtIOSCSI, bus);
292c8e50 200 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(s);
5db1764c 201 VirtIOSCSIReq *req;
fcf104a7 202 uint32_t n;
5db1764c 203
fcf104a7 204 qemu_get_be32s(f, &n);
292c8e50 205 assert(n < vs->conf.num_queues);
36b15c79 206 req = virtio_scsi_init_req(s, vs->cmd_vqs[n]);
5db1764c 207 qemu_get_buffer(f, (unsigned char *)&req->elem, sizeof(req->elem));
4ada5331
MT
208
209 virtqueue_map(&req->elem);
1cc93345 210
36b15c79
PB
211 if (virtio_scsi_parse_req(req, sizeof(VirtIOSCSICmdReq) + vs->cdb_size,
212 sizeof(VirtIOSCSICmdResp) + vs->sense_size) < 0) {
213 error_report("invalid SCSI request migration data");
214 exit(1);
215 }
5db1764c
PB
216
217 scsi_req_ref(sreq);
218 req->sreq = sreq;
219 if (req->sreq->cmd.mode != SCSI_XFER_NONE) {
3eff1f46 220 assert(req->sreq->cmd.mode == req->mode);
5db1764c
PB
221 }
222 return req;
223}
224
49e7e31a
FZ
225typedef struct {
226 Notifier notifier;
227 VirtIOSCSIReq *tmf_req;
228} VirtIOSCSICancelNotifier;
229
230static void virtio_scsi_cancel_notify(Notifier *notifier, void *data)
231{
232 VirtIOSCSICancelNotifier *n = container_of(notifier,
233 VirtIOSCSICancelNotifier,
234 notifier);
235
236 if (--n->tmf_req->remaining == 0) {
237 virtio_scsi_complete_req(n->tmf_req);
238 }
633dccb4 239 g_free(n);
49e7e31a
FZ
240}
241
242/* Return 0 if the request is ready to be completed and return to guest;
243 * -EINPROGRESS if the request is submitted and will be completed later, in the
244 * case of async cancellation. */
245static int virtio_scsi_do_tmf(VirtIOSCSI *s, VirtIOSCSIReq *req)
326799c0 246{
3eff1f46 247 SCSIDevice *d = virtio_scsi_device_find(s, req->req.tmf.lun);
06114d72 248 SCSIRequest *r, *next;
0866aca1 249 BusChild *kid;
06114d72 250 int target;
49e7e31a 251 int ret = 0;
06114d72 252
05430559
FZ
253 if (s->dataplane_started) {
254 assert(blk_get_aio_context(d->conf.blk) == s->ctx);
63c7e542 255 }
06114d72 256 /* Here VIRTIO_SCSI_S_OK means "FUNCTION COMPLETE". */
3eff1f46 257 req->resp.tmf.response = VIRTIO_SCSI_S_OK;
06114d72 258
8c085dbe 259 virtio_tswap32s(VIRTIO_DEVICE(s), &req->req.tmf.subtype);
3eff1f46 260 switch (req->req.tmf.subtype) {
06114d72
PB
261 case VIRTIO_SCSI_T_TMF_ABORT_TASK:
262 case VIRTIO_SCSI_T_TMF_QUERY_TASK:
263 if (!d) {
264 goto fail;
265 }
3eff1f46 266 if (d->lun != virtio_scsi_get_lun(req->req.tmf.lun)) {
06114d72
PB
267 goto incorrect_lun;
268 }
269 QTAILQ_FOREACH_SAFE(r, &d->requests, next, next) {
4dd7c82c 270 VirtIOSCSIReq *cmd_req = r->hba_private;
3eff1f46 271 if (cmd_req && cmd_req->req.cmd.tag == req->req.tmf.tag) {
06114d72
PB
272 break;
273 }
274 }
4dd7c82c
PB
275 if (r) {
276 /*
277 * Assert that the request has not been completed yet, we
278 * check for it in the loop above.
279 */
280 assert(r->hba_private);
3eff1f46 281 if (req->req.tmf.subtype == VIRTIO_SCSI_T_TMF_QUERY_TASK) {
06114d72
PB
282 /* "If the specified command is present in the task set, then
283 * return a service response set to FUNCTION SUCCEEDED".
284 */
3eff1f46 285 req->resp.tmf.response = VIRTIO_SCSI_S_FUNCTION_SUCCEEDED;
06114d72 286 } else {
49e7e31a
FZ
287 VirtIOSCSICancelNotifier *notifier;
288
289 req->remaining = 1;
633dccb4 290 notifier = g_new(VirtIOSCSICancelNotifier, 1);
49e7e31a
FZ
291 notifier->tmf_req = req;
292 notifier->notifier.notify = virtio_scsi_cancel_notify;
293 scsi_req_cancel_async(r, &notifier->notifier);
294 ret = -EINPROGRESS;
06114d72
PB
295 }
296 }
297 break;
298
299 case VIRTIO_SCSI_T_TMF_LOGICAL_UNIT_RESET:
300 if (!d) {
301 goto fail;
302 }
3eff1f46 303 if (d->lun != virtio_scsi_get_lun(req->req.tmf.lun)) {
06114d72
PB
304 goto incorrect_lun;
305 }
306 s->resetting++;
307 qdev_reset_all(&d->qdev);
308 s->resetting--;
309 break;
310
311 case VIRTIO_SCSI_T_TMF_ABORT_TASK_SET:
312 case VIRTIO_SCSI_T_TMF_CLEAR_TASK_SET:
313 case VIRTIO_SCSI_T_TMF_QUERY_TASK_SET:
314 if (!d) {
315 goto fail;
316 }
3eff1f46 317 if (d->lun != virtio_scsi_get_lun(req->req.tmf.lun)) {
06114d72
PB
318 goto incorrect_lun;
319 }
49e7e31a
FZ
320
321 /* Add 1 to "remaining" until virtio_scsi_do_tmf returns.
322 * This way, if the bus starts calling back to the notifiers
323 * even before we finish the loop, virtio_scsi_cancel_notify
324 * will not complete the TMF too early.
325 */
326 req->remaining = 1;
06114d72
PB
327 QTAILQ_FOREACH_SAFE(r, &d->requests, next, next) {
328 if (r->hba_private) {
3eff1f46 329 if (req->req.tmf.subtype == VIRTIO_SCSI_T_TMF_QUERY_TASK_SET) {
06114d72
PB
330 /* "If there is any command present in the task set, then
331 * return a service response set to FUNCTION SUCCEEDED".
332 */
3eff1f46 333 req->resp.tmf.response = VIRTIO_SCSI_S_FUNCTION_SUCCEEDED;
06114d72
PB
334 break;
335 } else {
49e7e31a
FZ
336 VirtIOSCSICancelNotifier *notifier;
337
338 req->remaining++;
633dccb4 339 notifier = g_new(VirtIOSCSICancelNotifier, 1);
49e7e31a
FZ
340 notifier->notifier.notify = virtio_scsi_cancel_notify;
341 notifier->tmf_req = req;
342 scsi_req_cancel_async(r, &notifier->notifier);
06114d72
PB
343 }
344 }
345 }
49e7e31a
FZ
346 if (--req->remaining > 0) {
347 ret = -EINPROGRESS;
348 }
06114d72
PB
349 break;
350
351 case VIRTIO_SCSI_T_TMF_I_T_NEXUS_RESET:
3eff1f46 352 target = req->req.tmf.lun[1];
06114d72 353 s->resetting++;
0866aca1
AL
354 QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
355 d = DO_UPCAST(SCSIDevice, qdev, kid->child);
06114d72
PB
356 if (d->channel == 0 && d->id == target) {
357 qdev_reset_all(&d->qdev);
358 }
359 }
360 s->resetting--;
361 break;
362
363 case VIRTIO_SCSI_T_TMF_CLEAR_ACA:
364 default:
3eff1f46 365 req->resp.tmf.response = VIRTIO_SCSI_S_FUNCTION_REJECTED;
06114d72 366 break;
326799c0
SH
367 }
368
49e7e31a 369 return ret;
06114d72
PB
370
371incorrect_lun:
3eff1f46 372 req->resp.tmf.response = VIRTIO_SCSI_S_INCORRECT_LUN;
49e7e31a 373 return ret;
06114d72
PB
374
375fail:
3eff1f46 376 req->resp.tmf.response = VIRTIO_SCSI_S_BAD_TARGET;
49e7e31a 377 return ret;
326799c0
SH
378}
379
dc56b7c4 380void virtio_scsi_handle_ctrl_req(VirtIOSCSI *s, VirtIOSCSIReq *req)
973abc7f 381{
dc56b7c4 382 VirtIODevice *vdev = (VirtIODevice *)s;
024d9adc 383 uint32_t type;
49e7e31a 384 int r = 0;
326799c0 385
dc56b7c4
FZ
386 if (iov_to_buf(req->elem.out_sg, req->elem.out_num, 0,
387 &type, sizeof(type)) < sizeof(type)) {
388 virtio_scsi_bad_req();
389 return;
390 }
36b15c79 391
024d9adc
BW
392 virtio_tswap32s(vdev, &type);
393 if (type == VIRTIO_SCSI_T_TMF) {
dc56b7c4
FZ
394 if (virtio_scsi_parse_req(req, sizeof(VirtIOSCSICtrlTMFReq),
395 sizeof(VirtIOSCSICtrlTMFResp)) < 0) {
06114d72 396 virtio_scsi_bad_req();
dc56b7c4 397 } else {
49e7e31a 398 r = virtio_scsi_do_tmf(s, req);
b0b4ea17 399 }
06114d72 400
024d9adc
BW
401 } else if (type == VIRTIO_SCSI_T_AN_QUERY ||
402 type == VIRTIO_SCSI_T_AN_SUBSCRIBE) {
dc56b7c4
FZ
403 if (virtio_scsi_parse_req(req, sizeof(VirtIOSCSICtrlANReq),
404 sizeof(VirtIOSCSICtrlANResp)) < 0) {
405 virtio_scsi_bad_req();
406 } else {
407 req->resp.an.event_actual = 0;
408 req->resp.an.response = VIRTIO_SCSI_S_OK;
06114d72 409 }
dc56b7c4 410 }
49e7e31a
FZ
411 if (r == 0) {
412 virtio_scsi_complete_req(req);
413 } else {
414 assert(r == -EINPROGRESS);
415 }
dc56b7c4
FZ
416}
417
418static void virtio_scsi_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq)
419{
420 VirtIOSCSI *s = (VirtIOSCSI *)vdev;
421 VirtIOSCSIReq *req;
422
dfb37cf7 423 if (s->ctx && !s->dataplane_disabled) {
63c7e542
FZ
424 virtio_scsi_dataplane_start(s);
425 return;
426 }
dc56b7c4
FZ
427 while ((req = virtio_scsi_pop_req(s, vq))) {
428 virtio_scsi_handle_ctrl_req(s, req);
326799c0
SH
429 }
430}
431
a3de269c
PB
432static void virtio_scsi_complete_cmd_req(VirtIOSCSIReq *req)
433{
3eff1f46
PB
434 /* Sense data is not in req->resp and is copied separately
435 * in virtio_scsi_command_complete.
436 */
437 req->resp_size = sizeof(VirtIOSCSICmdResp);
a3de269c
PB
438 virtio_scsi_complete_req(req);
439}
440
2ccdcd8d
PB
441static void virtio_scsi_command_complete(SCSIRequest *r, uint32_t status,
442 size_t resid)
443{
444 VirtIOSCSIReq *req = r->hba_private;
489c7901 445 uint8_t sense[SCSI_SENSE_BUF_SIZE];
474ee55a 446 uint32_t sense_len;
8c085dbe 447 VirtIODevice *vdev = VIRTIO_DEVICE(req->dev);
2ccdcd8d 448
e9c0f0f5
EF
449 if (r->io_canceled) {
450 return;
451 }
452
3eff1f46
PB
453 req->resp.cmd.response = VIRTIO_SCSI_S_OK;
454 req->resp.cmd.status = status;
455 if (req->resp.cmd.status == GOOD) {
8c085dbe 456 req->resp.cmd.resid = virtio_tswap32(vdev, resid);
2ccdcd8d 457 } else {
3eff1f46 458 req->resp.cmd.resid = 0;
489c7901 459 sense_len = scsi_req_get_sense(r, sense, sizeof(sense));
3eff1f46
PB
460 sense_len = MIN(sense_len, req->resp_iov.size - sizeof(req->resp.cmd));
461 qemu_iovec_from_buf(&req->resp_iov, sizeof(req->resp.cmd),
b7890c40 462 sense, sense_len);
8c085dbe 463 req->resp.cmd.sense_len = virtio_tswap32(vdev, sense_len);
2ccdcd8d 464 }
a3de269c 465 virtio_scsi_complete_cmd_req(req);
2ccdcd8d
PB
466}
467
33cbb2c5
PB
468static int virtio_scsi_parse_cdb(SCSIDevice *dev, SCSICommand *cmd,
469 uint8_t *buf, void *hba_private)
470{
471 VirtIOSCSIReq *req = hba_private;
472
473 if (cmd->len == 0) {
03325525 474 cmd->len = MIN(VIRTIO_SCSI_CDB_DEFAULT_SIZE, SCSI_CMD_BUF_SIZE);
33cbb2c5
PB
475 memcpy(cmd->buf, buf, cmd->len);
476 }
477
478 /* Extract the direction and mode directly from the request, for
479 * host device passthrough.
480 */
481 cmd->xfer = req->qsgl.size;
9df7bfdd 482 cmd->mode = req->mode;
33cbb2c5
PB
483 return 0;
484}
485
2ccdcd8d
PB
486static QEMUSGList *virtio_scsi_get_sg_list(SCSIRequest *r)
487{
488 VirtIOSCSIReq *req = r->hba_private;
489
490 return &req->qsgl;
491}
492
493static void virtio_scsi_request_cancelled(SCSIRequest *r)
494{
495 VirtIOSCSIReq *req = r->hba_private;
496
497 if (!req) {
498 return;
499 }
06114d72 500 if (req->dev->resetting) {
3eff1f46 501 req->resp.cmd.response = VIRTIO_SCSI_S_RESET;
06114d72 502 } else {
3eff1f46 503 req->resp.cmd.response = VIRTIO_SCSI_S_ABORTED;
06114d72 504 }
a3de269c 505 virtio_scsi_complete_cmd_req(req);
2ccdcd8d
PB
506}
507
508static void virtio_scsi_fail_cmd_req(VirtIOSCSIReq *req)
326799c0 509{
3eff1f46 510 req->resp.cmd.response = VIRTIO_SCSI_S_FAILURE;
a3de269c 511 virtio_scsi_complete_cmd_req(req);
973abc7f
SH
512}
513
359eea71 514bool virtio_scsi_handle_cmd_req_prepare(VirtIOSCSI *s, VirtIOSCSIReq *req)
bf359a44
FZ
515{
516 VirtIOSCSICommon *vs = &s->parent_obj;
bf359a44
FZ
517 SCSIDevice *d;
518 int rc;
519
520 rc = virtio_scsi_parse_req(req, sizeof(VirtIOSCSICmdReq) + vs->cdb_size,
521 sizeof(VirtIOSCSICmdResp) + vs->sense_size);
522 if (rc < 0) {
523 if (rc == -ENOTSUP) {
524 virtio_scsi_fail_cmd_req(req);
525 } else {
526 virtio_scsi_bad_req();
527 }
359eea71 528 return false;
bf359a44
FZ
529 }
530
531 d = virtio_scsi_device_find(s, req->req.cmd.lun);
532 if (!d) {
533 req->resp.cmd.response = VIRTIO_SCSI_S_BAD_TARGET;
534 virtio_scsi_complete_cmd_req(req);
359eea71 535 return false;
bf359a44 536 }
05430559
FZ
537 if (s->dataplane_started) {
538 assert(blk_get_aio_context(d->conf.blk) == s->ctx);
63c7e542 539 }
bf359a44
FZ
540 req->sreq = scsi_req_new(d, req->req.cmd.tag,
541 virtio_scsi_get_lun(req->req.cmd.lun),
bb72463b 542 req->req.cmd.cdb, req);
bf359a44
FZ
543
544 if (req->sreq->cmd.mode != SCSI_XFER_NONE
545 && (req->sreq->cmd.mode != req->mode ||
546 req->sreq->cmd.xfer > req->qsgl.size)) {
547 req->resp.cmd.response = VIRTIO_SCSI_S_OVERRUN;
548 virtio_scsi_complete_cmd_req(req);
359eea71 549 return false;
bf359a44 550 }
5170f40b 551 scsi_req_ref(req->sreq);
4be74634 552 blk_io_plug(d->conf.blk);
359eea71
FZ
553 return true;
554}
bf359a44 555
359eea71
FZ
556void virtio_scsi_handle_cmd_req_submit(VirtIOSCSI *s, VirtIOSCSIReq *req)
557{
35e4e96c
PB
558 SCSIRequest *sreq = req->sreq;
559 if (scsi_req_enqueue(sreq)) {
560 scsi_req_continue(sreq);
bf359a44 561 }
4be74634 562 blk_io_unplug(sreq->dev->conf.blk);
35e4e96c 563 scsi_req_unref(sreq);
bf359a44
FZ
564}
565
973abc7f
SH
566static void virtio_scsi_handle_cmd(VirtIODevice *vdev, VirtQueue *vq)
567{
292c8e50 568 /* use non-QOM casts in the data path */
326799c0 569 VirtIOSCSI *s = (VirtIOSCSI *)vdev;
1880ad4f
FZ
570 VirtIOSCSIReq *req, *next;
571 QTAILQ_HEAD(, VirtIOSCSIReq) reqs = QTAILQ_HEAD_INITIALIZER(reqs);
326799c0 572
dfb37cf7 573 if (s->ctx && !s->dataplane_disabled) {
63c7e542
FZ
574 virtio_scsi_dataplane_start(s);
575 return;
576 }
326799c0 577 while ((req = virtio_scsi_pop_req(s, vq))) {
359eea71 578 if (virtio_scsi_handle_cmd_req_prepare(s, req)) {
1880ad4f 579 QTAILQ_INSERT_TAIL(&reqs, req, next);
359eea71 580 }
326799c0 581 }
1880ad4f
FZ
582
583 QTAILQ_FOREACH_SAFE(req, &reqs, next, next) {
584 virtio_scsi_handle_cmd_req_submit(s, req);
585 }
973abc7f
SH
586}
587
588static void virtio_scsi_get_config(VirtIODevice *vdev,
589 uint8_t *config)
590{
591 VirtIOSCSIConfig *scsiconf = (VirtIOSCSIConfig *)config;
292c8e50 592 VirtIOSCSICommon *s = VIRTIO_SCSI_COMMON(vdev);
973abc7f 593
8c085dbe
RR
594 virtio_stl_p(vdev, &scsiconf->num_queues, s->conf.num_queues);
595 virtio_stl_p(vdev, &scsiconf->seg_max, 128 - 2);
596 virtio_stl_p(vdev, &scsiconf->max_sectors, s->conf.max_sectors);
597 virtio_stl_p(vdev, &scsiconf->cmd_per_lun, s->conf.cmd_per_lun);
598 virtio_stl_p(vdev, &scsiconf->event_info_size, sizeof(VirtIOSCSIEvent));
599 virtio_stl_p(vdev, &scsiconf->sense_size, s->sense_size);
600 virtio_stl_p(vdev, &scsiconf->cdb_size, s->cdb_size);
601 virtio_stw_p(vdev, &scsiconf->max_channel, VIRTIO_SCSI_MAX_CHANNEL);
602 virtio_stw_p(vdev, &scsiconf->max_target, VIRTIO_SCSI_MAX_TARGET);
603 virtio_stl_p(vdev, &scsiconf->max_lun, VIRTIO_SCSI_MAX_LUN);
973abc7f
SH
604}
605
606static void virtio_scsi_set_config(VirtIODevice *vdev,
607 const uint8_t *config)
608{
609 VirtIOSCSIConfig *scsiconf = (VirtIOSCSIConfig *)config;
292c8e50 610 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(vdev);
973abc7f 611
8c085dbe
RR
612 if ((uint32_t) virtio_ldl_p(vdev, &scsiconf->sense_size) >= 65536 ||
613 (uint32_t) virtio_ldl_p(vdev, &scsiconf->cdb_size) >= 256) {
973abc7f
SH
614 error_report("bad data written to virtio-scsi configuration space");
615 exit(1);
616 }
617
8c085dbe
RR
618 vs->sense_size = virtio_ldl_p(vdev, &scsiconf->sense_size);
619 vs->cdb_size = virtio_ldl_p(vdev, &scsiconf->cdb_size);
973abc7f
SH
620}
621
019a3edb 622static uint64_t virtio_scsi_get_features(VirtIODevice *vdev,
9d5b731d
JW
623 uint64_t requested_features,
624 Error **errp)
973abc7f 625{
da2f84d1
SZ
626 VirtIOSCSI *s = VIRTIO_SCSI(vdev);
627
628 /* Firstly sync all virtio-scsi possible supported features */
629 requested_features |= s->host_features;
973abc7f
SH
630 return requested_features;
631}
632
633static void virtio_scsi_reset(VirtIODevice *vdev)
634{
292c8e50
PB
635 VirtIOSCSI *s = VIRTIO_SCSI(vdev);
636 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(vdev);
973abc7f 637
63c7e542
FZ
638 if (s->ctx) {
639 virtio_scsi_dataplane_stop(s);
640 }
47a150a4
PB
641 s->resetting++;
642 qbus_reset_all(&s->bus.qbus);
643 s->resetting--;
644
03325525
MT
645 vs->sense_size = VIRTIO_SCSI_SENSE_DEFAULT_SIZE;
646 vs->cdb_size = VIRTIO_SCSI_CDB_DEFAULT_SIZE;
2baa1beb 647 s->events_dropped = false;
973abc7f
SH
648}
649
5db1764c
PB
650/* The device does not have anything to save beyond the virtio data.
651 * Request data is saved with callbacks from SCSI devices.
652 */
653static void virtio_scsi_save(QEMUFile *f, void *opaque)
654{
0ac8e139 655 VirtIODevice *vdev = VIRTIO_DEVICE(opaque);
10a06fd6
PB
656 VirtIOSCSI *s = VIRTIO_SCSI(vdev);
657
658 if (s->dataplane_started) {
659 virtio_scsi_dataplane_stop(s);
660 }
0ac8e139 661 virtio_save(vdev, f);
5db1764c
PB
662}
663
664static int virtio_scsi_load(QEMUFile *f, void *opaque, int version_id)
665{
0ac8e139 666 VirtIODevice *vdev = VIRTIO_DEVICE(opaque);
2a633c46
OW
667 int ret;
668
1b5fc0de 669 ret = virtio_load(vdev, f, version_id);
2a633c46
OW
670 if (ret) {
671 return ret;
672 }
5db1764c
PB
673 return 0;
674}
675
20e6dca1
FZ
676void virtio_scsi_push_event(VirtIOSCSI *s, SCSIDevice *dev,
677 uint32_t event, uint32_t reason)
b6866fee 678{
292c8e50 679 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(s);
91e7fcca 680 VirtIOSCSIReq *req;
b6866fee 681 VirtIOSCSIEvent *evt;
0ac8e139 682 VirtIODevice *vdev = VIRTIO_DEVICE(s);
b6866fee 683
0ac8e139 684 if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
cd41a671
PB
685 return;
686 }
687
63c7e542
FZ
688 if (s->dataplane_started) {
689 assert(s->ctx);
690 aio_context_acquire(s->ctx);
691 }
692
693 if (s->dataplane_started) {
694 req = virtio_scsi_pop_req_vring(s, s->event_vring);
695 } else {
696 req = virtio_scsi_pop_req(s, vs->event_vq);
697 }
64f64855
PB
698 if (!req) {
699 s->events_dropped = true;
63c7e542 700 goto out;
64f64855 701 }
b6866fee 702
64f64855
PB
703 if (s->events_dropped) {
704 event |= VIRTIO_SCSI_T_EVENTS_MISSED;
705 s->events_dropped = false;
706 }
707
dfecbb95 708 if (virtio_scsi_parse_req(req, 0, sizeof(VirtIOSCSIEvent))) {
64f64855
PB
709 virtio_scsi_bad_req();
710 }
711
3eff1f46 712 evt = &req->resp.event;
64f64855 713 memset(evt, 0, sizeof(VirtIOSCSIEvent));
424baff5
CLG
714 evt->event = virtio_tswap32(vdev, event);
715 evt->reason = virtio_tswap32(vdev, reason);
64f64855 716 if (!dev) {
49fb65c7 717 assert(event == VIRTIO_SCSI_T_EVENTS_MISSED);
64f64855 718 } else {
b6866fee
CM
719 evt->lun[0] = 1;
720 evt->lun[1] = dev->id;
721
722 /* Linux wants us to keep the same encoding we use for REPORT LUNS. */
723 if (dev->lun >= 256) {
724 evt->lun[2] = (dev->lun >> 8) | 0x40;
725 }
726 evt->lun[3] = dev->lun & 0xFF;
64f64855
PB
727 }
728 virtio_scsi_complete_req(req);
63c7e542
FZ
729out:
730 if (s->dataplane_started) {
731 aio_context_release(s->ctx);
732 }
64f64855
PB
733}
734
735static void virtio_scsi_handle_event(VirtIODevice *vdev, VirtQueue *vq)
736{
0ac8e139 737 VirtIOSCSI *s = VIRTIO_SCSI(vdev);
64f64855 738
dfb37cf7 739 if (s->ctx && !s->dataplane_disabled) {
63c7e542
FZ
740 virtio_scsi_dataplane_start(s);
741 return;
742 }
64f64855
PB
743 if (s->events_dropped) {
744 virtio_scsi_push_event(s, NULL, VIRTIO_SCSI_T_NO_EVENT, 0);
b6866fee
CM
745 }
746}
747
feda01e4
PB
748static void virtio_scsi_change(SCSIBus *bus, SCSIDevice *dev, SCSISense sense)
749{
750 VirtIOSCSI *s = container_of(bus, VirtIOSCSI, bus);
0ac8e139 751 VirtIODevice *vdev = VIRTIO_DEVICE(s);
feda01e4 752
95129d6f 753 if (virtio_vdev_has_feature(vdev, VIRTIO_SCSI_F_CHANGE) &&
feda01e4
PB
754 dev->type != TYPE_ROM) {
755 virtio_scsi_push_event(s, dev, VIRTIO_SCSI_T_PARAM_CHANGE,
756 sense.asc | (sense.ascq << 8));
757 }
758}
759
02206e52
IM
760static void virtio_scsi_hotplug(HotplugHandler *hotplug_dev, DeviceState *dev,
761 Error **errp)
b6866fee 762{
02206e52 763 VirtIODevice *vdev = VIRTIO_DEVICE(hotplug_dev);
3e2b2a9c
FZ
764 VirtIOSCSI *s = VIRTIO_SCSI(vdev);
765 SCSIDevice *sd = SCSI_DEVICE(dev);
766
767 if (s->ctx && !s->dataplane_disabled) {
768 if (blk_op_is_blocked(sd->conf.blk, BLOCK_OP_TYPE_DATAPLANE, errp)) {
769 return;
770 }
771 blk_op_block_all(sd->conf.blk, s->blocker);
05430559
FZ
772 aio_context_acquire(s->ctx);
773 blk_set_aio_context(sd->conf.blk, s->ctx);
774 aio_context_release(s->ctx);
3e2b2a9c 775 }
b6866fee 776
95129d6f 777 if (virtio_vdev_has_feature(vdev, VIRTIO_SCSI_F_HOTPLUG)) {
3e2b2a9c 778 virtio_scsi_push_event(s, sd,
02206e52 779 VIRTIO_SCSI_T_TRANSPORT_RESET,
b6866fee
CM
780 VIRTIO_SCSI_EVT_RESET_RESCAN);
781 }
782}
783
02206e52
IM
784static void virtio_scsi_hotunplug(HotplugHandler *hotplug_dev, DeviceState *dev,
785 Error **errp)
b6866fee 786{
02206e52 787 VirtIODevice *vdev = VIRTIO_DEVICE(hotplug_dev);
3e2b2a9c
FZ
788 VirtIOSCSI *s = VIRTIO_SCSI(vdev);
789 SCSIDevice *sd = SCSI_DEVICE(dev);
b6866fee 790
95129d6f 791 if (virtio_vdev_has_feature(vdev, VIRTIO_SCSI_F_HOTPLUG)) {
3e2b2a9c 792 virtio_scsi_push_event(s, sd,
02206e52 793 VIRTIO_SCSI_T_TRANSPORT_RESET,
b6866fee
CM
794 VIRTIO_SCSI_EVT_RESET_REMOVED);
795 }
3e2b2a9c
FZ
796
797 if (s->ctx) {
798 blk_op_unblock_all(sd->conf.blk, s->blocker);
799 }
02206e52 800 qdev_simple_device_unplug_cb(hotplug_dev, dev, errp);
b6866fee
CM
801}
802
2ccdcd8d
PB
803static struct SCSIBusInfo virtio_scsi_scsi_info = {
804 .tcq = true,
805 .max_channel = VIRTIO_SCSI_MAX_CHANNEL,
806 .max_target = VIRTIO_SCSI_MAX_TARGET,
807 .max_lun = VIRTIO_SCSI_MAX_LUN,
808
809 .complete = virtio_scsi_command_complete,
810 .cancel = virtio_scsi_request_cancelled,
feda01e4 811 .change = virtio_scsi_change,
33cbb2c5 812 .parse_cdb = virtio_scsi_parse_cdb,
2ccdcd8d 813 .get_sg_list = virtio_scsi_get_sg_list,
5db1764c
PB
814 .save_request = virtio_scsi_save_request,
815 .load_request = virtio_scsi_load_request,
2ccdcd8d
PB
816};
817
91d670fb
ML
818void virtio_scsi_common_realize(DeviceState *dev, Error **errp,
819 HandleOutput ctrl, HandleOutput evt,
820 HandleOutput cmd)
973abc7f 821{
71a6520b
AF
822 VirtIODevice *vdev = VIRTIO_DEVICE(dev);
823 VirtIOSCSICommon *s = VIRTIO_SCSI_COMMON(dev);
d2ad7dd4 824 int i;
973abc7f 825
7598f0f3 826 virtio_init(vdev, "virtio-scsi", VIRTIO_ID_SCSI,
763684be 827 sizeof(VirtIOSCSIConfig));
3ab1dfdd 828
0ba1f531 829 if (s->conf.num_queues == 0 ||
87b3bd1c 830 s->conf.num_queues > VIRTIO_QUEUE_MAX - 2) {
0ba1f531 831 error_setg(errp, "Invalid number of queues (= %" PRIu32 "), "
c9f65528 832 "must be a positive integer less than %d.",
87b3bd1c 833 s->conf.num_queues, VIRTIO_QUEUE_MAX - 2);
93bd49af 834 virtio_cleanup(vdev);
c9f65528
FZ
835 return;
836 }
3c55fe2a 837 s->cmd_vqs = g_new0(VirtQueue *, s->conf.num_queues);
03325525
MT
838 s->sense_size = VIRTIO_SCSI_SENSE_DEFAULT_SIZE;
839 s->cdb_size = VIRTIO_SCSI_CDB_DEFAULT_SIZE;
3ab1dfdd 840
0ac8e139 841 s->ctrl_vq = virtio_add_queue(vdev, VIRTIO_SCSI_VQ_SIZE,
91d670fb 842 ctrl);
0ac8e139 843 s->event_vq = virtio_add_queue(vdev, VIRTIO_SCSI_VQ_SIZE,
91d670fb 844 evt);
394e2e4c 845 for (i = 0; i < s->conf.num_queues; i++) {
0ac8e139 846 s->cmd_vqs[i] = virtio_add_queue(vdev, VIRTIO_SCSI_VQ_SIZE,
91d670fb 847 cmd);
d2ad7dd4 848 }
9786b592
FZ
849
850 if (s->conf.iothread) {
851 virtio_scsi_set_iothread(VIRTIO_SCSI(s), s->conf.iothread);
852 }
292c8e50
PB
853}
854
dfb37cf7
FZ
855/* Disable dataplane thread during live migration since it does not
856 * update the dirty memory bitmap yet.
857 */
858static void virtio_scsi_migration_state_changed(Notifier *notifier, void *data)
859{
860 VirtIOSCSI *s = container_of(notifier, VirtIOSCSI,
861 migration_state_notifier);
862 MigrationState *mig = data;
863
864 if (migration_in_setup(mig)) {
865 if (!s->dataplane_started) {
866 return;
867 }
868 virtio_scsi_dataplane_stop(s);
869 s->dataplane_disabled = true;
870 } else if (migration_has_finished(mig) ||
871 migration_has_failed(mig)) {
872 if (s->dataplane_started) {
873 return;
874 }
4be74634 875 blk_drain_all(); /* complete in-flight non-dataplane requests */
dfb37cf7
FZ
876 s->dataplane_disabled = false;
877 }
878}
879
71a6520b 880static void virtio_scsi_device_realize(DeviceState *dev, Error **errp)
292c8e50 881{
71a6520b 882 VirtIODevice *vdev = VIRTIO_DEVICE(dev);
7598f0f3 883 VirtIOSCSI *s = VIRTIO_SCSI(dev);
292c8e50 884 static int virtio_scsi_id;
caad4eb3 885 Error *err = NULL;
292c8e50 886
91d670fb
ML
887 virtio_scsi_common_realize(dev, &err, virtio_scsi_handle_ctrl,
888 virtio_scsi_handle_event,
889 virtio_scsi_handle_cmd);
71a6520b
AF
890 if (err != NULL) {
891 error_propagate(errp, err);
892 return;
292c8e50
PB
893 }
894
7598f0f3 895 scsi_bus_new(&s->bus, sizeof(s->bus), dev,
b1187b51 896 &virtio_scsi_scsi_info, vdev->bus_name);
02206e52
IM
897 /* override default SCSI bus hotplug-handler, with virtio-scsi's one */
898 qbus_set_hotplug_handler(BUS(&s->bus), dev, &error_abort);
6f32a6b4 899
7598f0f3 900 if (!dev->hotplugged) {
caad4eb3
AF
901 scsi_bus_legacy_handle_cmdline(&s->bus, &err);
902 if (err != NULL) {
71a6520b
AF
903 error_propagate(errp, err);
904 return;
caad4eb3 905 }
2ccdcd8d
PB
906 }
907
7598f0f3 908 register_savevm(dev, "virtio-scsi", virtio_scsi_id++, 1,
5db1764c 909 virtio_scsi_save, virtio_scsi_load, s);
dfb37cf7
FZ
910 s->migration_state_notifier.notify = virtio_scsi_migration_state_changed;
911 add_migration_state_change_notifier(&s->migration_state_notifier);
f6758f7d
HR
912
913 error_setg(&s->blocker, "block device is in use by data plane");
3ab1dfdd
FK
914}
915
19d339f1
FZ
916static void virtio_scsi_instance_init(Object *obj)
917{
918 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(obj);
919
920 object_property_add_link(obj, "iothread", TYPE_IOTHREAD,
921 (Object **)&vs->conf.iothread,
922 qdev_prop_allow_set_link_before_realize,
923 OBJ_PROP_LINK_UNREF_ON_RELEASE, &error_abort);
924}
925
306ec6c3 926void virtio_scsi_common_unrealize(DeviceState *dev, Error **errp)
292c8e50 927{
306ec6c3
AF
928 VirtIODevice *vdev = VIRTIO_DEVICE(dev);
929 VirtIOSCSICommon *vs = VIRTIO_SCSI_COMMON(dev);
292c8e50
PB
930
931 g_free(vs->cmd_vqs);
6a1a8cc7 932 virtio_cleanup(vdev);
292c8e50
PB
933}
934
306ec6c3 935static void virtio_scsi_device_unrealize(DeviceState *dev, Error **errp)
3ab1dfdd 936{
306ec6c3
AF
937 VirtIOSCSI *s = VIRTIO_SCSI(dev);
938
f6758f7d
HR
939 error_free(s->blocker);
940
306ec6c3 941 unregister_savevm(dev, "virtio-scsi", s);
dfb37cf7 942 remove_migration_state_change_notifier(&s->migration_state_notifier);
3ab1dfdd 943
306ec6c3 944 virtio_scsi_common_unrealize(dev, errp);
3ab1dfdd
FK
945}
946
947static Property virtio_scsi_properties[] = {
0c63237a
SZ
948 DEFINE_PROP_UINT32("num_queues", VirtIOSCSI, parent_obj.conf.num_queues, 1),
949 DEFINE_PROP_UINT32("max_sectors", VirtIOSCSI, parent_obj.conf.max_sectors,
950 0xFFFF),
951 DEFINE_PROP_UINT32("cmd_per_lun", VirtIOSCSI, parent_obj.conf.cmd_per_lun,
952 128),
0c63237a
SZ
953 DEFINE_PROP_BIT("hotplug", VirtIOSCSI, host_features,
954 VIRTIO_SCSI_F_HOTPLUG, true),
955 DEFINE_PROP_BIT("param_change", VirtIOSCSI, host_features,
956 VIRTIO_SCSI_F_CHANGE, true),
3ab1dfdd
FK
957 DEFINE_PROP_END_OF_LIST(),
958};
959
292c8e50
PB
960static void virtio_scsi_common_class_init(ObjectClass *klass, void *data)
961{
962 VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
125ee0ed 963 DeviceClass *dc = DEVICE_CLASS(klass);
292c8e50
PB
964
965 vdc->get_config = virtio_scsi_get_config;
125ee0ed 966 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
292c8e50
PB
967}
968
3ab1dfdd
FK
969static void virtio_scsi_class_init(ObjectClass *klass, void *data)
970{
971 DeviceClass *dc = DEVICE_CLASS(klass);
972 VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
02206e52 973 HotplugHandlerClass *hc = HOTPLUG_HANDLER_CLASS(klass);
71a6520b 974
3ab1dfdd 975 dc->props = virtio_scsi_properties;
125ee0ed 976 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
71a6520b 977 vdc->realize = virtio_scsi_device_realize;
306ec6c3 978 vdc->unrealize = virtio_scsi_device_unrealize;
3ab1dfdd
FK
979 vdc->set_config = virtio_scsi_set_config;
980 vdc->get_features = virtio_scsi_get_features;
981 vdc->reset = virtio_scsi_reset;
02206e52
IM
982 hc->plug = virtio_scsi_hotplug;
983 hc->unplug = virtio_scsi_hotunplug;
3ab1dfdd
FK
984}
985
292c8e50
PB
986static const TypeInfo virtio_scsi_common_info = {
987 .name = TYPE_VIRTIO_SCSI_COMMON,
988 .parent = TYPE_VIRTIO_DEVICE,
989 .instance_size = sizeof(VirtIOSCSICommon),
a27292b5 990 .abstract = true,
292c8e50
PB
991 .class_init = virtio_scsi_common_class_init,
992};
993
3ab1dfdd
FK
994static const TypeInfo virtio_scsi_info = {
995 .name = TYPE_VIRTIO_SCSI,
292c8e50 996 .parent = TYPE_VIRTIO_SCSI_COMMON,
3ab1dfdd 997 .instance_size = sizeof(VirtIOSCSI),
19d339f1 998 .instance_init = virtio_scsi_instance_init,
3ab1dfdd 999 .class_init = virtio_scsi_class_init,
02206e52
IM
1000 .interfaces = (InterfaceInfo[]) {
1001 { TYPE_HOTPLUG_HANDLER },
1002 { }
1003 }
3ab1dfdd
FK
1004};
1005
1006static void virtio_register_types(void)
1007{
292c8e50 1008 type_register_static(&virtio_scsi_common_info);
3ab1dfdd
FK
1009 type_register_static(&virtio_scsi_info);
1010}
1011
1012type_init(virtio_register_types)