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