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