?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
graph-lock: TSA annotations for lock/unlock functions
[qemu.git] / hw / scsi / scsi-disk.c
blobe493c288140329f52e626ec08723713d5d10e737
1 /*
2 * SCSI Device emulation
3 *
4 * Copyright (c) 2006 CodeSourcery.
5 * Based on code by Fabrice Bellard
6 *
7 * Written by Paul Brook
8 * Modifications:
9 * 2009-Dec-12 Artyom Tarasenko : implemented stamdard inquiry for the case
10 * when the allocation length of CDB is smaller
11 * than 36.
12 * 2009-Oct-13 Artyom Tarasenko : implemented the block descriptor in the
13 * MODE SENSE response.
14 *
15 * This code is licensed under the LGPL.
16 *
17 * Note that this file only handles the SCSI architecture model and device
18 * commands. Emulation of interface/link layer protocols is handled by
19 * the host adapter emulator.
20 */
21
22 #include "qemu/osdep.h"
23 #include "qemu/units.h"
24 #include "qapi/error.h"
25 #include "qemu/error-report.h"
26 #include "qemu/main-loop.h"
27 #include "qemu/module.h"
28 #include "qemu/hw-version.h"
29 #include "qemu/memalign.h"
30 #include "hw/scsi/scsi.h"
31 #include "migration/qemu-file-types.h"
32 #include "migration/vmstate.h"
33 #include "hw/scsi/emulation.h"
34 #include "scsi/constants.h"
35 #include "sysemu/block-backend.h"
36 #include "sysemu/blockdev.h"
37 #include "hw/block/block.h"
38 #include "hw/qdev-properties.h"
39 #include "hw/qdev-properties-system.h"
40 #include "sysemu/dma.h"
41 #include "sysemu/sysemu.h"
42 #include "qemu/cutils.h"
43 #include "trace.h"
44 #include "qom/object.h"
45
46 #ifdef __linux
47 #include <scsi/sg.h>
48 #endif
49
50 #define SCSI_WRITE_SAME_MAX (512 * KiB)
51 #define SCSI_DMA_BUF_SIZE (128 * KiB)
52 #define SCSI_MAX_INQUIRY_LEN 256
53 #define SCSI_MAX_MODE_LEN 256
54
55 #define DEFAULT_DISCARD_GRANULARITY (4 * KiB)
56 #define DEFAULT_MAX_UNMAP_SIZE (1 * GiB)
57 #define DEFAULT_MAX_IO_SIZE INT_MAX /* 2 GB - 1 block */
58
59 #define TYPE_SCSI_DISK_BASE "scsi-disk-base"
60
61 OBJECT_DECLARE_TYPE(SCSIDiskState, SCSIDiskClass, SCSI_DISK_BASE)
62
63 struct SCSIDiskClass {
64 SCSIDeviceClass parent_class;
65 DMAIOFunc *dma_readv;
66 DMAIOFunc *dma_writev;
67 bool (*need_fua_emulation)(SCSICommand *cmd);
68 void (*update_sense)(SCSIRequest *r);
69 };
70
71 typedef struct SCSIDiskReq {
72 SCSIRequest req;
73 /* Both sector and sector_count are in terms of BDRV_SECTOR_SIZE bytes. */
74 uint64_t sector;
75 uint32_t sector_count;
76 uint32_t buflen;
77 bool started;
78 bool need_fua_emulation;
79 struct iovec iov;
80 QEMUIOVector qiov;
81 BlockAcctCookie acct;
82 } SCSIDiskReq;
83
84 #define SCSI_DISK_F_REMOVABLE 0
85 #define SCSI_DISK_F_DPOFUA 1
86 #define SCSI_DISK_F_NO_REMOVABLE_DEVOPS 2
87
88 struct SCSIDiskState {
89 SCSIDevice qdev;
90 uint32_t features;
91 bool media_changed;
92 bool media_event;
93 bool eject_request;
94 uint16_t port_index;
95 uint64_t max_unmap_size;
96 uint64_t max_io_size;
97 uint32_t quirks;
98 QEMUBH *bh;
99 char *version;
100 char *serial;
101 char *vendor;
102 char *product;
103 char *device_id;
104 bool tray_open;
105 bool tray_locked;
106 /*
107 * 0x0000 - rotation rate not reported
108 * 0x0001 - non-rotating medium (SSD)
109 * 0x0002-0x0400 - reserved
110 * 0x0401-0xffe - rotations per minute
111 * 0xffff - reserved
112 */
113 uint16_t rotation_rate;
114 };
115
116 static void scsi_free_request(SCSIRequest *req)
117 {
118 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
119
120 qemu_vfree(r->iov.iov_base);
121 }
122
123 /* Helper function for command completion with sense. */
124 static void scsi_check_condition(SCSIDiskReq *r, SCSISense sense)
125 {
126 trace_scsi_disk_check_condition(r->req.tag, sense.key, sense.asc,
127 sense.ascq);
128 scsi_req_build_sense(&r->req, sense);
129 scsi_req_complete(&r->req, CHECK_CONDITION);
130 }
131
132 static void scsi_init_iovec(SCSIDiskReq *r, size_t size)
133 {
134 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
135
136 if (!r->iov.iov_base) {
137 r->buflen = size;
138 r->iov.iov_base = blk_blockalign(s->qdev.conf.blk, r->buflen);
139 }
140 r->iov.iov_len = MIN(r->sector_count * BDRV_SECTOR_SIZE, r->buflen);
141 qemu_iovec_init_external(&r->qiov, &r->iov, 1);
142 }
143
144 static void scsi_disk_save_request(QEMUFile *f, SCSIRequest *req)
145 {
146 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
147
148 qemu_put_be64s(f, &r->sector);
149 qemu_put_be32s(f, &r->sector_count);
150 qemu_put_be32s(f, &r->buflen);
151 if (r->buflen) {
152 if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
153 qemu_put_buffer(f, r->iov.iov_base, r->iov.iov_len);
154 } else if (!req->retry) {
155 uint32_t len = r->iov.iov_len;
156 qemu_put_be32s(f, &len);
157 qemu_put_buffer(f, r->iov.iov_base, r->iov.iov_len);
158 }
159 }
160 }
161
162 static void scsi_disk_load_request(QEMUFile *f, SCSIRequest *req)
163 {
164 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
165
166 qemu_get_be64s(f, &r->sector);
167 qemu_get_be32s(f, &r->sector_count);
168 qemu_get_be32s(f, &r->buflen);
169 if (r->buflen) {
170 scsi_init_iovec(r, r->buflen);
171 if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
172 qemu_get_buffer(f, r->iov.iov_base, r->iov.iov_len);
173 } else if (!r->req.retry) {
174 uint32_t len;
175 qemu_get_be32s(f, &len);
176 r->iov.iov_len = len;
177 assert(r->iov.iov_len <= r->buflen);
178 qemu_get_buffer(f, r->iov.iov_base, r->iov.iov_len);
179 }
180 }
181
182 qemu_iovec_init_external(&r->qiov, &r->iov, 1);
183 }
184
185 /*
186 * scsi_handle_rw_error has two return values. False means that the error
187 * must be ignored, true means that the error has been processed and the
188 * caller should not do anything else for this request. Note that
189 * scsi_handle_rw_error always manages its reference counts, independent
190 * of the return value.
191 */
192 static bool scsi_handle_rw_error(SCSIDiskReq *r, int ret, bool acct_failed)
193 {
194 bool is_read = (r->req.cmd.mode == SCSI_XFER_FROM_DEV);
195 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
196 SCSIDiskClass *sdc = (SCSIDiskClass *) object_get_class(OBJECT(s));
197 SCSISense sense = SENSE_CODE(NO_SENSE);
198 int error = 0;
199 bool req_has_sense = false;
200 BlockErrorAction action;
201 int status;
202
203 if (ret < 0) {
204 status = scsi_sense_from_errno(-ret, &sense);
205 error = -ret;
206 } else {
207 /* A passthrough command has completed with nonzero status. */
208 status = ret;
209 if (status == CHECK_CONDITION) {
210 req_has_sense = true;
211 error = scsi_sense_buf_to_errno(r->req.sense, sizeof(r->req.sense));
212 } else {
213 error = EINVAL;
214 }
215 }
216
217 /*
218 * Check whether the error has to be handled by the guest or should
219 * rather follow the rerror=/werror= settings. Guest-handled errors
220 * are usually retried immediately, so do not post them to QMP and
221 * do not account them as failed I/O.
222 */
223 if (req_has_sense &&
224 scsi_sense_buf_is_guest_recoverable(r->req.sense, sizeof(r->req.sense))) {
225 action = BLOCK_ERROR_ACTION_REPORT;
226 acct_failed = false;
227 } else {
228 action = blk_get_error_action(s->qdev.conf.blk, is_read, error);
229 blk_error_action(s->qdev.conf.blk, action, is_read, error);
230 }
231
232 switch (action) {
233 case BLOCK_ERROR_ACTION_REPORT:
234 if (acct_failed) {
235 block_acct_failed(blk_get_stats(s->qdev.conf.blk), &r->acct);
236 }
237 if (req_has_sense) {
238 sdc->update_sense(&r->req);
239 } else if (status == CHECK_CONDITION) {
240 scsi_req_build_sense(&r->req, sense);
241 }
242 scsi_req_complete(&r->req, status);
243 return true;
244
245 case BLOCK_ERROR_ACTION_IGNORE:
246 return false;
247
248 case BLOCK_ERROR_ACTION_STOP:
249 scsi_req_retry(&r->req);
250 return true;
251
252 default:
253 g_assert_not_reached();
254 }
255 }
256
257 static bool scsi_disk_req_check_error(SCSIDiskReq *r, int ret, bool acct_failed)
258 {
259 if (r->req.io_canceled) {
260 scsi_req_cancel_complete(&r->req);
261 return true;
262 }
263
264 if (ret < 0) {
265 return scsi_handle_rw_error(r, ret, acct_failed);
266 }
267
268 return false;
269 }
270
271 static void scsi_aio_complete(void *opaque, int ret)
272 {
273 SCSIDiskReq *r = (SCSIDiskReq *)opaque;
274 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
275
276 assert(r->req.aiocb != NULL);
277 r->req.aiocb = NULL;
278 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
279 if (scsi_disk_req_check_error(r, ret, true)) {
280 goto done;
281 }
282
283 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
284 scsi_req_complete(&r->req, GOOD);
285
286 done:
287 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
288 scsi_req_unref(&r->req);
289 }
290
291 static bool scsi_is_cmd_fua(SCSICommand *cmd)
292 {
293 switch (cmd->buf[0]) {
294 case READ_10:
295 case READ_12:
296 case READ_16:
297 case WRITE_10:
298 case WRITE_12:
299 case WRITE_16:
300 return (cmd->buf[1] & 8) != 0;
301
302 case VERIFY_10:
303 case VERIFY_12:
304 case VERIFY_16:
305 case WRITE_VERIFY_10:
306 case WRITE_VERIFY_12:
307 case WRITE_VERIFY_16:
308 return true;
309
310 case READ_6:
311 case WRITE_6:
312 default:
313 return false;
314 }
315 }
316
317 static void scsi_write_do_fua(SCSIDiskReq *r)
318 {
319 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
320
321 assert(r->req.aiocb == NULL);
322 assert(!r->req.io_canceled);
323
324 if (r->need_fua_emulation) {
325 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct, 0,
326 BLOCK_ACCT_FLUSH);
327 r->req.aiocb = blk_aio_flush(s->qdev.conf.blk, scsi_aio_complete, r);
328 return;
329 }
330
331 scsi_req_complete(&r->req, GOOD);
332 scsi_req_unref(&r->req);
333 }
334
335 static void scsi_dma_complete_noio(SCSIDiskReq *r, int ret)
336 {
337 assert(r->req.aiocb == NULL);
338 if (scsi_disk_req_check_error(r, ret, false)) {
339 goto done;
340 }
341
342 r->sector += r->sector_count;
343 r->sector_count = 0;
344 if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
345 scsi_write_do_fua(r);
346 return;
347 } else {
348 scsi_req_complete(&r->req, GOOD);
349 }
350
351 done:
352 scsi_req_unref(&r->req);
353 }
354
355 static void scsi_dma_complete(void *opaque, int ret)
356 {
357 SCSIDiskReq *r = (SCSIDiskReq *)opaque;
358 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
359
360 assert(r->req.aiocb != NULL);
361 r->req.aiocb = NULL;
362
363 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
364 if (ret < 0) {
365 block_acct_failed(blk_get_stats(s->qdev.conf.blk), &r->acct);
366 } else {
367 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
368 }
369 scsi_dma_complete_noio(r, ret);
370 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
371 }
372
373 static void scsi_read_complete_noio(SCSIDiskReq *r, int ret)
374 {
375 uint32_t n;
376
377 assert(r->req.aiocb == NULL);
378 if (scsi_disk_req_check_error(r, ret, false)) {
379 goto done;
380 }
381
382 n = r->qiov.size / BDRV_SECTOR_SIZE;
383 r->sector += n;
384 r->sector_count -= n;
385 scsi_req_data(&r->req, r->qiov.size);
386
387 done:
388 scsi_req_unref(&r->req);
389 }
390
391 static void scsi_read_complete(void *opaque, int ret)
392 {
393 SCSIDiskReq *r = (SCSIDiskReq *)opaque;
394 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
395
396 assert(r->req.aiocb != NULL);
397 r->req.aiocb = NULL;
398
399 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
400 if (ret < 0) {
401 block_acct_failed(blk_get_stats(s->qdev.conf.blk), &r->acct);
402 } else {
403 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
404 trace_scsi_disk_read_complete(r->req.tag, r->qiov.size);
405 }
406 scsi_read_complete_noio(r, ret);
407 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
408 }
409
410 /* Actually issue a read to the block device. */
411 static void scsi_do_read(SCSIDiskReq *r, int ret)
412 {
413 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
414 SCSIDiskClass *sdc = (SCSIDiskClass *) object_get_class(OBJECT(s));
415
416 assert (r->req.aiocb == NULL);
417 if (scsi_disk_req_check_error(r, ret, false)) {
418 goto done;
419 }
420
421 /* The request is used as the AIO opaque value, so add a ref. */
422 scsi_req_ref(&r->req);
423
424 if (r->req.sg) {
425 dma_acct_start(s->qdev.conf.blk, &r->acct, r->req.sg, BLOCK_ACCT_READ);
426 r->req.residual -= r->req.sg->size;
427 r->req.aiocb = dma_blk_io(blk_get_aio_context(s->qdev.conf.blk),
428 r->req.sg, r->sector << BDRV_SECTOR_BITS,
429 BDRV_SECTOR_SIZE,
430 sdc->dma_readv, r, scsi_dma_complete, r,
431 DMA_DIRECTION_FROM_DEVICE);
432 } else {
433 scsi_init_iovec(r, SCSI_DMA_BUF_SIZE);
434 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct,
435 r->qiov.size, BLOCK_ACCT_READ);
436 r->req.aiocb = sdc->dma_readv(r->sector << BDRV_SECTOR_BITS, &r->qiov,
437 scsi_read_complete, r, r);
438 }
439
440 done:
441 scsi_req_unref(&r->req);
442 }
443
444 static void scsi_do_read_cb(void *opaque, int ret)
445 {
446 SCSIDiskReq *r = (SCSIDiskReq *)opaque;
447 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
448
449 assert (r->req.aiocb != NULL);
450 r->req.aiocb = NULL;
451
452 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
453 if (ret < 0) {
454 block_acct_failed(blk_get_stats(s->qdev.conf.blk), &r->acct);
455 } else {
456 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
457 }
458 scsi_do_read(opaque, ret);
459 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
460 }
461
462 /* Read more data from scsi device into buffer. */
463 static void scsi_read_data(SCSIRequest *req)
464 {
465 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
466 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
467 bool first;
468
469 trace_scsi_disk_read_data_count(r->sector_count);
470 if (r->sector_count == 0) {
471 /* This also clears the sense buffer for REQUEST SENSE. */
472 scsi_req_complete(&r->req, GOOD);
473 return;
474 }
475
476 /* No data transfer may already be in progress */
477 assert(r->req.aiocb == NULL);
478
479 /* The request is used as the AIO opaque value, so add a ref. */
480 scsi_req_ref(&r->req);
481 if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
482 trace_scsi_disk_read_data_invalid();
483 scsi_read_complete_noio(r, -EINVAL);
484 return;
485 }
486
487 if (!blk_is_available(req->dev->conf.blk)) {
488 scsi_read_complete_noio(r, -ENOMEDIUM);
489 return;
490 }
491
492 first = !r->started;
493 r->started = true;
494 if (first && r->need_fua_emulation) {
495 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct, 0,
496 BLOCK_ACCT_FLUSH);
497 r->req.aiocb = blk_aio_flush(s->qdev.conf.blk, scsi_do_read_cb, r);
498 } else {
499 scsi_do_read(r, 0);
500 }
501 }
502
503 static void scsi_write_complete_noio(SCSIDiskReq *r, int ret)
504 {
505 uint32_t n;
506
507 assert (r->req.aiocb == NULL);
508 if (scsi_disk_req_check_error(r, ret, false)) {
509 goto done;
510 }
511
512 n = r->qiov.size / BDRV_SECTOR_SIZE;
513 r->sector += n;
514 r->sector_count -= n;
515 if (r->sector_count == 0) {
516 scsi_write_do_fua(r);
517 return;
518 } else {
519 scsi_init_iovec(r, SCSI_DMA_BUF_SIZE);
520 trace_scsi_disk_write_complete_noio(r->req.tag, r->qiov.size);
521 scsi_req_data(&r->req, r->qiov.size);
522 }
523
524 done:
525 scsi_req_unref(&r->req);
526 }
527
528 static void scsi_write_complete(void * opaque, int ret)
529 {
530 SCSIDiskReq *r = (SCSIDiskReq *)opaque;
531 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
532
533 assert (r->req.aiocb != NULL);
534 r->req.aiocb = NULL;
535
536 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
537 if (ret < 0) {
538 block_acct_failed(blk_get_stats(s->qdev.conf.blk), &r->acct);
539 } else {
540 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
541 }
542 scsi_write_complete_noio(r, ret);
543 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
544 }
545
546 static void scsi_write_data(SCSIRequest *req)
547 {
548 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
549 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
550 SCSIDiskClass *sdc = (SCSIDiskClass *) object_get_class(OBJECT(s));
551
552 /* No data transfer may already be in progress */
553 assert(r->req.aiocb == NULL);
554
555 /* The request is used as the AIO opaque value, so add a ref. */
556 scsi_req_ref(&r->req);
557 if (r->req.cmd.mode != SCSI_XFER_TO_DEV) {
558 trace_scsi_disk_write_data_invalid();
559 scsi_write_complete_noio(r, -EINVAL);
560 return;
561 }
562
563 if (!r->req.sg && !r->qiov.size) {
564 /* Called for the first time. Ask the driver to send us more data. */
565 r->started = true;
566 scsi_write_complete_noio(r, 0);
567 return;
568 }
569 if (!blk_is_available(req->dev->conf.blk)) {
570 scsi_write_complete_noio(r, -ENOMEDIUM);
571 return;
572 }
573
574 if (r->req.cmd.buf[0] == VERIFY_10 || r->req.cmd.buf[0] == VERIFY_12 ||
575 r->req.cmd.buf[0] == VERIFY_16) {
576 if (r->req.sg) {
577 scsi_dma_complete_noio(r, 0);
578 } else {
579 scsi_write_complete_noio(r, 0);
580 }
581 return;
582 }
583
584 if (r->req.sg) {
585 dma_acct_start(s->qdev.conf.blk, &r->acct, r->req.sg, BLOCK_ACCT_WRITE);
586 r->req.residual -= r->req.sg->size;
587 r->req.aiocb = dma_blk_io(blk_get_aio_context(s->qdev.conf.blk),
588 r->req.sg, r->sector << BDRV_SECTOR_BITS,
589 BDRV_SECTOR_SIZE,
590 sdc->dma_writev, r, scsi_dma_complete, r,
591 DMA_DIRECTION_TO_DEVICE);
592 } else {
593 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct,
594 r->qiov.size, BLOCK_ACCT_WRITE);
595 r->req.aiocb = sdc->dma_writev(r->sector << BDRV_SECTOR_BITS, &r->qiov,
596 scsi_write_complete, r, r);
597 }
598 }
599
600 /* Return a pointer to the data buffer. */
601 static uint8_t *scsi_get_buf(SCSIRequest *req)
602 {
603 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
604
605 return (uint8_t *)r->iov.iov_base;
606 }
607
608 static int scsi_disk_emulate_vpd_page(SCSIRequest *req, uint8_t *outbuf)
609 {
610 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
611 uint8_t page_code = req->cmd.buf[2];
612 int start, buflen = 0;
613
614 outbuf[buflen++] = s->qdev.type & 0x1f;
615 outbuf[buflen++] = page_code;
616 outbuf[buflen++] = 0x00;
617 outbuf[buflen++] = 0x00;
618 start = buflen;
619
620 switch (page_code) {
621 case 0x00: /* Supported page codes, mandatory */
622 {
623 trace_scsi_disk_emulate_vpd_page_00(req->cmd.xfer);
624 outbuf[buflen++] = 0x00; /* list of supported pages (this page) */
625 if (s->serial) {
626 outbuf[buflen++] = 0x80; /* unit serial number */
627 }
628 outbuf[buflen++] = 0x83; /* device identification */
629 if (s->qdev.type == TYPE_DISK) {
630 outbuf[buflen++] = 0xb0; /* block limits */
631 outbuf[buflen++] = 0xb1; /* block device characteristics */
632 outbuf[buflen++] = 0xb2; /* thin provisioning */
633 }
634 break;
635 }
636 case 0x80: /* Device serial number, optional */
637 {
638 int l;
639
640 if (!s->serial) {
641 trace_scsi_disk_emulate_vpd_page_80_not_supported();
642 return -1;
643 }
644
645 l = strlen(s->serial);
646 if (l > 36) {
647 l = 36;
648 }
649
650 trace_scsi_disk_emulate_vpd_page_80(req->cmd.xfer);
651 memcpy(outbuf + buflen, s->serial, l);
652 buflen += l;
653 break;
654 }
655
656 case 0x83: /* Device identification page, mandatory */
657 {
658 int id_len = s->device_id ? MIN(strlen(s->device_id), 255 - 8) : 0;
659
660 trace_scsi_disk_emulate_vpd_page_83(req->cmd.xfer);
661
662 if (id_len) {
663 outbuf[buflen++] = 0x2; /* ASCII */
664 outbuf[buflen++] = 0; /* not officially assigned */
665 outbuf[buflen++] = 0; /* reserved */
666 outbuf[buflen++] = id_len; /* length of data following */
667 memcpy(outbuf + buflen, s->device_id, id_len);
668 buflen += id_len;
669 }
670
671 if (s->qdev.wwn) {
672 outbuf[buflen++] = 0x1; /* Binary */
673 outbuf[buflen++] = 0x3; /* NAA */
674 outbuf[buflen++] = 0; /* reserved */
675 outbuf[buflen++] = 8;
676 stq_be_p(&outbuf[buflen], s->qdev.wwn);
677 buflen += 8;
678 }
679
680 if (s->qdev.port_wwn) {
681 outbuf[buflen++] = 0x61; /* SAS / Binary */
682 outbuf[buflen++] = 0x93; /* PIV / Target port / NAA */
683 outbuf[buflen++] = 0; /* reserved */
684 outbuf[buflen++] = 8;
685 stq_be_p(&outbuf[buflen], s->qdev.port_wwn);
686 buflen += 8;
687 }
688
689 if (s->port_index) {
690 outbuf[buflen++] = 0x61; /* SAS / Binary */
691
692 /* PIV/Target port/relative target port */
693 outbuf[buflen++] = 0x94;
694
695 outbuf[buflen++] = 0; /* reserved */
696 outbuf[buflen++] = 4;
697 stw_be_p(&outbuf[buflen + 2], s->port_index);
698 buflen += 4;
699 }
700 break;
701 }
702 case 0xb0: /* block limits */
703 {
704 SCSIBlockLimits bl = {};
705
706 if (s->qdev.type == TYPE_ROM) {
707 trace_scsi_disk_emulate_vpd_page_b0_not_supported();
708 return -1;
709 }
710 bl.wsnz = 1;
711 bl.unmap_sectors =
712 s->qdev.conf.discard_granularity / s->qdev.blocksize;
713 bl.min_io_size =
714 s->qdev.conf.min_io_size / s->qdev.blocksize;
715 bl.opt_io_size =
716 s->qdev.conf.opt_io_size / s->qdev.blocksize;
717 bl.max_unmap_sectors =
718 s->max_unmap_size / s->qdev.blocksize;
719 bl.max_io_sectors =
720 s->max_io_size / s->qdev.blocksize;
721 /* 255 descriptors fit in 4 KiB with an 8-byte header */
722 bl.max_unmap_descr = 255;
723
724 if (s->qdev.type == TYPE_DISK) {
725 int max_transfer_blk = blk_get_max_transfer(s->qdev.conf.blk);
726 int max_io_sectors_blk =
727 max_transfer_blk / s->qdev.blocksize;
728
729 bl.max_io_sectors =
730 MIN_NON_ZERO(max_io_sectors_blk, bl.max_io_sectors);
731 }
732 buflen += scsi_emulate_block_limits(outbuf + buflen, &bl);
733 break;
734 }
735 case 0xb1: /* block device characteristics */
736 {
737 buflen = 0x40;
738 outbuf[4] = (s->rotation_rate >> 8) & 0xff;
739 outbuf[5] = s->rotation_rate & 0xff;
740 outbuf[6] = 0; /* PRODUCT TYPE */
741 outbuf[7] = 0; /* WABEREQ | WACEREQ | NOMINAL FORM FACTOR */
742 outbuf[8] = 0; /* VBULS */
743 break;
744 }
745 case 0xb2: /* thin provisioning */
746 {
747 buflen = 8;
748 outbuf[4] = 0;
749 outbuf[5] = 0xe0; /* unmap & write_same 10/16 all supported */
750 outbuf[6] = s->qdev.conf.discard_granularity ? 2 : 1;
751 outbuf[7] = 0;
752 break;
753 }
754 default:
755 return -1;
756 }
757 /* done with EVPD */
758 assert(buflen - start <= 255);
759 outbuf[start - 1] = buflen - start;
760 return buflen;
761 }
762
763 static int scsi_disk_emulate_inquiry(SCSIRequest *req, uint8_t *outbuf)
764 {
765 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
766 int buflen = 0;
767
768 if (req->cmd.buf[1] & 0x1) {
769 /* Vital product data */
770 return scsi_disk_emulate_vpd_page(req, outbuf);
771 }
772
773 /* Standard INQUIRY data */
774 if (req->cmd.buf[2] != 0) {
775 return -1;
776 }
777
778 /* PAGE CODE == 0 */
779 buflen = req->cmd.xfer;
780 if (buflen > SCSI_MAX_INQUIRY_LEN) {
781 buflen = SCSI_MAX_INQUIRY_LEN;
782 }
783
784 outbuf[0] = s->qdev.type & 0x1f;
785 outbuf[1] = (s->features & (1 << SCSI_DISK_F_REMOVABLE)) ? 0x80 : 0;
786
787 strpadcpy((char *) &outbuf[16], 16, s->product, ' ');
788 strpadcpy((char *) &outbuf[8], 8, s->vendor, ' ');
789
790 memset(&outbuf[32], 0, 4);
791 memcpy(&outbuf[32], s->version, MIN(4, strlen(s->version)));
792 /*
793 * We claim conformance to SPC-3, which is required for guests
794 * to ask for modern features like READ CAPACITY(16) or the
795 * block characteristics VPD page by default. Not all of SPC-3
796 * is actually implemented, but we're good enough.
797 */
798 outbuf[2] = s->qdev.default_scsi_version;
799 outbuf[3] = 2 | 0x10; /* Format 2, HiSup */
800
801 if (buflen > 36) {
802 outbuf[4] = buflen - 5; /* Additional Length = (Len - 1) - 4 */
803 } else {
804 /* If the allocation length of CDB is too small,
805 the additional length is not adjusted */
806 outbuf[4] = 36 - 5;
807 }
808
809 /* Sync data transfer and TCQ. */
810 outbuf[7] = 0x10 | (req->bus->info->tcq ? 0x02 : 0);
811 return buflen;
812 }
813
814 static inline bool media_is_dvd(SCSIDiskState *s)
815 {
816 uint64_t nb_sectors;
817 if (s->qdev.type != TYPE_ROM) {
818 return false;
819 }
820 if (!blk_is_available(s->qdev.conf.blk)) {
821 return false;
822 }
823 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
824 return nb_sectors > CD_MAX_SECTORS;
825 }
826
827 static inline bool media_is_cd(SCSIDiskState *s)
828 {
829 uint64_t nb_sectors;
830 if (s->qdev.type != TYPE_ROM) {
831 return false;
832 }
833 if (!blk_is_available(s->qdev.conf.blk)) {
834 return false;
835 }
836 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
837 return nb_sectors <= CD_MAX_SECTORS;
838 }
839
840 static int scsi_read_disc_information(SCSIDiskState *s, SCSIDiskReq *r,
841 uint8_t *outbuf)
842 {
843 uint8_t type = r->req.cmd.buf[1] & 7;
844
845 if (s->qdev.type != TYPE_ROM) {
846 return -1;
847 }
848
849 /* Types 1/2 are only defined for Blu-Ray. */
850 if (type != 0) {
851 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
852 return -1;
853 }
854
855 memset(outbuf, 0, 34);
856 outbuf[1] = 32;
857 outbuf[2] = 0xe; /* last session complete, disc finalized */
858 outbuf[3] = 1; /* first track on disc */
859 outbuf[4] = 1; /* # of sessions */
860 outbuf[5] = 1; /* first track of last session */
861 outbuf[6] = 1; /* last track of last session */
862 outbuf[7] = 0x20; /* unrestricted use */
863 outbuf[8] = 0x00; /* CD-ROM or DVD-ROM */
864 /* 9-10-11: most significant byte corresponding bytes 4-5-6 */
865 /* 12-23: not meaningful for CD-ROM or DVD-ROM */
866 /* 24-31: disc bar code */
867 /* 32: disc application code */
868 /* 33: number of OPC tables */
869
870 return 34;
871 }
872
873 static int scsi_read_dvd_structure(SCSIDiskState *s, SCSIDiskReq *r,
874 uint8_t *outbuf)
875 {
876 static const int rds_caps_size[5] = {
877 [0] = 2048 + 4,
878 [1] = 4 + 4,
879 [3] = 188 + 4,
880 [4] = 2048 + 4,
881 };
882
883 uint8_t media = r->req.cmd.buf[1];
884 uint8_t layer = r->req.cmd.buf[6];
885 uint8_t format = r->req.cmd.buf[7];
886 int size = -1;
887
888 if (s->qdev.type != TYPE_ROM) {
889 return -1;
890 }
891 if (media != 0) {
892 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
893 return -1;
894 }
895
896 if (format != 0xff) {
897 if (!blk_is_available(s->qdev.conf.blk)) {
898 scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
899 return -1;
900 }
901 if (media_is_cd(s)) {
902 scsi_check_condition(r, SENSE_CODE(INCOMPATIBLE_FORMAT));
903 return -1;
904 }
905 if (format >= ARRAY_SIZE(rds_caps_size)) {
906 return -1;
907 }
908 size = rds_caps_size[format];
909 memset(outbuf, 0, size);
910 }
911
912 switch (format) {
913 case 0x00: {
914 /* Physical format information */
915 uint64_t nb_sectors;
916 if (layer != 0) {
917 goto fail;
918 }
919 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
920
921 outbuf[4] = 1; /* DVD-ROM, part version 1 */
922 outbuf[5] = 0xf; /* 120mm disc, minimum rate unspecified */
923 outbuf[6] = 1; /* one layer, read-only (per MMC-2 spec) */
924 outbuf[7] = 0; /* default densities */
925
926 stl_be_p(&outbuf[12], (nb_sectors >> 2) - 1); /* end sector */
927 stl_be_p(&outbuf[16], (nb_sectors >> 2) - 1); /* l0 end sector */
928 break;
929 }
930
931 case 0x01: /* DVD copyright information, all zeros */
932 break;
933
934 case 0x03: /* BCA information - invalid field for no BCA info */
935 return -1;
936
937 case 0x04: /* DVD disc manufacturing information, all zeros */
938 break;
939
940 case 0xff: { /* List capabilities */
941 int i;
942 size = 4;
943 for (i = 0; i < ARRAY_SIZE(rds_caps_size); i++) {
944 if (!rds_caps_size[i]) {
945 continue;
946 }
947 outbuf[size] = i;
948 outbuf[size + 1] = 0x40; /* Not writable, readable */
949 stw_be_p(&outbuf[size + 2], rds_caps_size[i]);
950 size += 4;
951 }
952 break;
953 }
954
955 default:
956 return -1;
957 }
958
959 /* Size of buffer, not including 2 byte size field */
960 stw_be_p(outbuf, size - 2);
961 return size;
962
963 fail:
964 return -1;
965 }
966
967 static int scsi_event_status_media(SCSIDiskState *s, uint8_t *outbuf)
968 {
969 uint8_t event_code, media_status;
970
971 media_status = 0;
972 if (s->tray_open) {
973 media_status = MS_TRAY_OPEN;
974 } else if (blk_is_inserted(s->qdev.conf.blk)) {
975 media_status = MS_MEDIA_PRESENT;
976 }
977
978 /* Event notification descriptor */
979 event_code = MEC_NO_CHANGE;
980 if (media_status != MS_TRAY_OPEN) {
981 if (s->media_event) {
982 event_code = MEC_NEW_MEDIA;
983 s->media_event = false;
984 } else if (s->eject_request) {
985 event_code = MEC_EJECT_REQUESTED;
986 s->eject_request = false;
987 }
988 }
989
990 outbuf[0] = event_code;
991 outbuf[1] = media_status;
992
993 /* These fields are reserved, just clear them. */
994 outbuf[2] = 0;
995 outbuf[3] = 0;
996 return 4;
997 }
998
999 static int scsi_get_event_status_notification(SCSIDiskState *s, SCSIDiskReq *r,
1000 uint8_t *outbuf)
1001 {
1002 int size;
1003 uint8_t *buf = r->req.cmd.buf;
1004 uint8_t notification_class_request = buf[4];
1005 if (s->qdev.type != TYPE_ROM) {
1006 return -1;
1007 }
1008 if ((buf[1] & 1) == 0) {
1009 /* asynchronous */
1010 return -1;
1011 }
1012
1013 size = 4;
1014 outbuf[0] = outbuf[1] = 0;
1015 outbuf[3] = 1 << GESN_MEDIA; /* supported events */
1016 if (notification_class_request & (1 << GESN_MEDIA)) {
1017 outbuf[2] = GESN_MEDIA;
1018 size += scsi_event_status_media(s, &outbuf[size]);
1019 } else {
1020 outbuf[2] = 0x80;
1021 }
1022 stw_be_p(outbuf, size - 4);
1023 return size;
1024 }
1025
1026 static int scsi_get_configuration(SCSIDiskState *s, uint8_t *outbuf)
1027 {
1028 int current;
1029
1030 if (s->qdev.type != TYPE_ROM) {
1031 return -1;
1032 }
1033
1034 if (media_is_dvd(s)) {
1035 current = MMC_PROFILE_DVD_ROM;
1036 } else if (media_is_cd(s)) {
1037 current = MMC_PROFILE_CD_ROM;
1038 } else {
1039 current = MMC_PROFILE_NONE;
1040 }
1041
1042 memset(outbuf, 0, 40);
1043 stl_be_p(&outbuf[0], 36); /* Bytes after the data length field */
1044 stw_be_p(&outbuf[6], current);
1045 /* outbuf[8] - outbuf[19]: Feature 0 - Profile list */
1046 outbuf[10] = 0x03; /* persistent, current */
1047 outbuf[11] = 8; /* two profiles */
1048 stw_be_p(&outbuf[12], MMC_PROFILE_DVD_ROM);
1049 outbuf[14] = (current == MMC_PROFILE_DVD_ROM);
1050 stw_be_p(&outbuf[16], MMC_PROFILE_CD_ROM);
1051 outbuf[18] = (current == MMC_PROFILE_CD_ROM);
1052 /* outbuf[20] - outbuf[31]: Feature 1 - Core feature */
1053 stw_be_p(&outbuf[20], 1);
1054 outbuf[22] = 0x08 | 0x03; /* version 2, persistent, current */
1055 outbuf[23] = 8;
1056 stl_be_p(&outbuf[24], 1); /* SCSI */
1057 outbuf[28] = 1; /* DBE = 1, mandatory */
1058 /* outbuf[32] - outbuf[39]: Feature 3 - Removable media feature */
1059 stw_be_p(&outbuf[32], 3);
1060 outbuf[34] = 0x08 | 0x03; /* version 2, persistent, current */
1061 outbuf[35] = 4;
1062 outbuf[36] = 0x39; /* tray, load=1, eject=1, unlocked at powerup, lock=1 */
1063 /* TODO: Random readable, CD read, DVD read, drive serial number,
1064 power management */
1065 return 40;
1066 }
1067
1068 static int scsi_emulate_mechanism_status(SCSIDiskState *s, uint8_t *outbuf)
1069 {
1070 if (s->qdev.type != TYPE_ROM) {
1071 return -1;
1072 }
1073 memset(outbuf, 0, 8);
1074 outbuf[5] = 1; /* CD-ROM */
1075 return 8;
1076 }
1077
1078 static int mode_sense_page(SCSIDiskState *s, int page, uint8_t **p_outbuf,
1079 int page_control)
1080 {
1081 static const int mode_sense_valid[0x3f] = {
1082 [MODE_PAGE_VENDOR_SPECIFIC] = (1 << TYPE_DISK) | (1 << TYPE_ROM),
1083 [MODE_PAGE_HD_GEOMETRY] = (1 << TYPE_DISK),
1084 [MODE_PAGE_FLEXIBLE_DISK_GEOMETRY] = (1 << TYPE_DISK),
1085 [MODE_PAGE_CACHING] = (1 << TYPE_DISK) | (1 << TYPE_ROM),
1086 [MODE_PAGE_R_W_ERROR] = (1 << TYPE_DISK) | (1 << TYPE_ROM),
1087 [MODE_PAGE_AUDIO_CTL] = (1 << TYPE_ROM),
1088 [MODE_PAGE_CAPABILITIES] = (1 << TYPE_ROM),
1089 [MODE_PAGE_APPLE_VENDOR] = (1 << TYPE_ROM),
1090 };
1091
1092 uint8_t *p = *p_outbuf + 2;
1093 int length;
1094
1095 assert(page < ARRAY_SIZE(mode_sense_valid));
1096 if ((mode_sense_valid[page] & (1 << s->qdev.type)) == 0) {
1097 return -1;
1098 }
1099
1100 /*
1101 * If Changeable Values are requested, a mask denoting those mode parameters
1102 * that are changeable shall be returned. As we currently don't support
1103 * parameter changes via MODE_SELECT all bits are returned set to zero.
1104 * The buffer was already menset to zero by the caller of this function.
1105 *
1106 * The offsets here are off by two compared to the descriptions in the
1107 * SCSI specs, because those include a 2-byte header. This is unfortunate,
1108 * but it is done so that offsets are consistent within our implementation
1109 * of MODE SENSE and MODE SELECT. MODE SELECT has to deal with both
1110 * 2-byte and 4-byte headers.
1111 */
1112 switch (page) {
1113 case MODE_PAGE_HD_GEOMETRY:
1114 length = 0x16;
1115 if (page_control == 1) { /* Changeable Values */
1116 break;
1117 }
1118 /* if a geometry hint is available, use it */
1119 p[0] = (s->qdev.conf.cyls >> 16) & 0xff;
1120 p[1] = (s->qdev.conf.cyls >> 8) & 0xff;
1121 p[2] = s->qdev.conf.cyls & 0xff;
1122 p[3] = s->qdev.conf.heads & 0xff;
1123 /* Write precomp start cylinder, disabled */
1124 p[4] = (s->qdev.conf.cyls >> 16) & 0xff;
1125 p[5] = (s->qdev.conf.cyls >> 8) & 0xff;
1126 p[6] = s->qdev.conf.cyls & 0xff;
1127 /* Reduced current start cylinder, disabled */
1128 p[7] = (s->qdev.conf.cyls >> 16) & 0xff;
1129 p[8] = (s->qdev.conf.cyls >> 8) & 0xff;
1130 p[9] = s->qdev.conf.cyls & 0xff;
1131 /* Device step rate [ns], 200ns */
1132 p[10] = 0;
1133 p[11] = 200;
1134 /* Landing zone cylinder */
1135 p[12] = 0xff;
1136 p[13] = 0xff;
1137 p[14] = 0xff;
1138 /* Medium rotation rate [rpm], 5400 rpm */
1139 p[18] = (5400 >> 8) & 0xff;
1140 p[19] = 5400 & 0xff;
1141 break;
1142
1143 case MODE_PAGE_FLEXIBLE_DISK_GEOMETRY:
1144 length = 0x1e;
1145 if (page_control == 1) { /* Changeable Values */
1146 break;
1147 }
1148 /* Transfer rate [kbit/s], 5Mbit/s */
1149 p[0] = 5000 >> 8;
1150 p[1] = 5000 & 0xff;
1151 /* if a geometry hint is available, use it */
1152 p[2] = s->qdev.conf.heads & 0xff;
1153 p[3] = s->qdev.conf.secs & 0xff;
1154 p[4] = s->qdev.blocksize >> 8;
1155 p[6] = (s->qdev.conf.cyls >> 8) & 0xff;
1156 p[7] = s->qdev.conf.cyls & 0xff;
1157 /* Write precomp start cylinder, disabled */
1158 p[8] = (s->qdev.conf.cyls >> 8) & 0xff;
1159 p[9] = s->qdev.conf.cyls & 0xff;
1160 /* Reduced current start cylinder, disabled */
1161 p[10] = (s->qdev.conf.cyls >> 8) & 0xff;
1162 p[11] = s->qdev.conf.cyls & 0xff;
1163 /* Device step rate [100us], 100us */
1164 p[12] = 0;
1165 p[13] = 1;
1166 /* Device step pulse width [us], 1us */
1167 p[14] = 1;
1168 /* Device head settle delay [100us], 100us */
1169 p[15] = 0;
1170 p[16] = 1;
1171 /* Motor on delay [0.1s], 0.1s */
1172 p[17] = 1;
1173 /* Motor off delay [0.1s], 0.1s */
1174 p[18] = 1;
1175 /* Medium rotation rate [rpm], 5400 rpm */
1176 p[26] = (5400 >> 8) & 0xff;
1177 p[27] = 5400 & 0xff;
1178 break;
1179
1180 case MODE_PAGE_CACHING:
1181 length = 0x12;
1182 if (page_control == 1 || /* Changeable Values */
1183 blk_enable_write_cache(s->qdev.conf.blk)) {
1184 p[0] = 4; /* WCE */
1185 }
1186 break;
1187
1188 case MODE_PAGE_R_W_ERROR:
1189 length = 10;
1190 if (page_control == 1) { /* Changeable Values */
1191 if (s->qdev.type == TYPE_ROM) {
1192 /* Automatic Write Reallocation Enabled */
1193 p[0] = 0x80;
1194 }
1195 break;
1196 }
1197 p[0] = 0x80; /* Automatic Write Reallocation Enabled */
1198 if (s->qdev.type == TYPE_ROM) {
1199 p[1] = 0x20; /* Read Retry Count */
1200 }
1201 break;
1202
1203 case MODE_PAGE_AUDIO_CTL:
1204 length = 14;
1205 break;
1206
1207 case MODE_PAGE_CAPABILITIES:
1208 length = 0x14;
1209 if (page_control == 1) { /* Changeable Values */
1210 break;
1211 }
1212
1213 p[0] = 0x3b; /* CD-R & CD-RW read */
1214 p[1] = 0; /* Writing not supported */
1215 p[2] = 0x7f; /* Audio, composite, digital out,
1216 mode 2 form 1&2, multi session */
1217 p[3] = 0xff; /* CD DA, DA accurate, RW supported,
1218 RW corrected, C2 errors, ISRC,
1219 UPC, Bar code */
1220 p[4] = 0x2d | (s->tray_locked ? 2 : 0);
1221 /* Locking supported, jumper present, eject, tray */
1222 p[5] = 0; /* no volume & mute control, no
1223 changer */
1224 p[6] = (50 * 176) >> 8; /* 50x read speed */
1225 p[7] = (50 * 176) & 0xff;
1226 p[8] = 2 >> 8; /* Two volume levels */
1227 p[9] = 2 & 0xff;
1228 p[10] = 2048 >> 8; /* 2M buffer */
1229 p[11] = 2048 & 0xff;
1230 p[12] = (16 * 176) >> 8; /* 16x read speed current */
1231 p[13] = (16 * 176) & 0xff;
1232 p[16] = (16 * 176) >> 8; /* 16x write speed */
1233 p[17] = (16 * 176) & 0xff;
1234 p[18] = (16 * 176) >> 8; /* 16x write speed current */
1235 p[19] = (16 * 176) & 0xff;
1236 break;
1237
1238 case MODE_PAGE_APPLE_VENDOR:
1239 if (s->quirks & (1 << SCSI_DISK_QUIRK_MODE_PAGE_APPLE_VENDOR)) {
1240 length = 0x1e;
1241 if (page_control == 1) { /* Changeable Values */
1242 break;
1243 }
1244
1245 memset(p, 0, length);
1246 strcpy((char *)p + 8, "APPLE COMPUTER, INC ");
1247 break;
1248 } else {
1249 return -1;
1250 }
1251
1252 case MODE_PAGE_VENDOR_SPECIFIC:
1253 if (s->qdev.type == TYPE_DISK && (s->quirks &
1254 (1 << SCSI_DISK_QUIRK_MODE_PAGE_VENDOR_SPECIFIC_APPLE))) {
1255 length = 0x2;
1256 if (page_control == 1) { /* Changeable Values */
1257 p[0] = 0xff;
1258 p[1] = 0xff;
1259 break;
1260 }
1261 p[0] = 0;
1262 p[1] = 0;
1263 break;
1264 } else {
1265 return -1;
1266 }
1267
1268 default:
1269 return -1;
1270 }
1271
1272 assert(length < 256);
1273 (*p_outbuf)[0] = page;
1274 (*p_outbuf)[1] = length;
1275 *p_outbuf += length + 2;
1276 return length + 2;
1277 }
1278
1279 static int scsi_disk_emulate_mode_sense(SCSIDiskReq *r, uint8_t *outbuf)
1280 {
1281 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1282 uint64_t nb_sectors;
1283 bool dbd;
1284 int page, buflen, ret, page_control;
1285 uint8_t *p;
1286 uint8_t dev_specific_param;
1287
1288 dbd = (r->req.cmd.buf[1] & 0x8) != 0;
1289 page = r->req.cmd.buf[2] & 0x3f;
1290 page_control = (r->req.cmd.buf[2] & 0xc0) >> 6;
1291
1292 trace_scsi_disk_emulate_mode_sense((r->req.cmd.buf[0] == MODE_SENSE) ? 6 :
1293 10, page, r->req.cmd.xfer, page_control);
1294 memset(outbuf, 0, r->req.cmd.xfer);
1295 p = outbuf;
1296
1297 if (s->qdev.type == TYPE_DISK) {
1298 dev_specific_param = s->features & (1 << SCSI_DISK_F_DPOFUA) ? 0x10 : 0;
1299 if (!blk_is_writable(s->qdev.conf.blk)) {
1300 dev_specific_param |= 0x80; /* Readonly. */
1301 }
1302 } else {
1303 if (s->quirks & (1 << SCSI_DISK_QUIRK_MODE_SENSE_ROM_USE_DBD)) {
1304 /* Use DBD from the request... */
1305 dev_specific_param = 0x00;
1306
1307 /*
1308 * ... unless we receive a request for MODE_PAGE_APPLE_VENDOR
1309 * which should never return a block descriptor even though DBD is
1310 * not set, otherwise CDROM detection fails in MacOS
1311 */
1312 if (s->quirks & (1 << SCSI_DISK_QUIRK_MODE_PAGE_APPLE_VENDOR) &&
1313 page == MODE_PAGE_APPLE_VENDOR) {
1314 dbd = true;
1315 }
1316 } else {
1317 /*
1318 * MMC prescribes that CD/DVD drives have no block descriptors,
1319 * and defines no device-specific parameter.
1320 */
1321 dev_specific_param = 0x00;
1322 dbd = true;
1323 }
1324 }
1325
1326 if (r->req.cmd.buf[0] == MODE_SENSE) {
1327 p[1] = 0; /* Default media type. */
1328 p[2] = dev_specific_param;
1329 p[3] = 0; /* Block descriptor length. */
1330 p += 4;
1331 } else { /* MODE_SENSE_10 */
1332 p[2] = 0; /* Default media type. */
1333 p[3] = dev_specific_param;
1334 p[6] = p[7] = 0; /* Block descriptor length. */
1335 p += 8;
1336 }
1337
1338 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
1339 if (!dbd && nb_sectors) {
1340 if (r->req.cmd.buf[0] == MODE_SENSE) {
1341 outbuf[3] = 8; /* Block descriptor length */
1342 } else { /* MODE_SENSE_10 */
1343 outbuf[7] = 8; /* Block descriptor length */
1344 }
1345 nb_sectors /= (s->qdev.blocksize / BDRV_SECTOR_SIZE);
1346 if (nb_sectors > 0xffffff) {
1347 nb_sectors = 0;
1348 }
1349 p[0] = 0; /* media density code */
1350 p[1] = (nb_sectors >> 16) & 0xff;
1351 p[2] = (nb_sectors >> 8) & 0xff;
1352 p[3] = nb_sectors & 0xff;
1353 p[4] = 0; /* reserved */
1354 p[5] = 0; /* bytes 5-7 are the sector size in bytes */
1355 p[6] = s->qdev.blocksize >> 8;
1356 p[7] = 0;
1357 p += 8;
1358 }
1359
1360 if (page_control == 3) {
1361 /* Saved Values */
1362 scsi_check_condition(r, SENSE_CODE(SAVING_PARAMS_NOT_SUPPORTED));
1363 return -1;
1364 }
1365
1366 if (page == 0x3f) {
1367 for (page = 0; page <= 0x3e; page++) {
1368 mode_sense_page(s, page, &p, page_control);
1369 }
1370 } else {
1371 ret = mode_sense_page(s, page, &p, page_control);
1372 if (ret == -1) {
1373 return -1;
1374 }
1375 }
1376
1377 buflen = p - outbuf;
1378 /*
1379 * The mode data length field specifies the length in bytes of the
1380 * following data that is available to be transferred. The mode data
1381 * length does not include itself.
1382 */
1383 if (r->req.cmd.buf[0] == MODE_SENSE) {
1384 outbuf[0] = buflen - 1;
1385 } else { /* MODE_SENSE_10 */
1386 outbuf[0] = ((buflen - 2) >> 8) & 0xff;
1387 outbuf[1] = (buflen - 2) & 0xff;
1388 }
1389 return buflen;
1390 }
1391
1392 static int scsi_disk_emulate_read_toc(SCSIRequest *req, uint8_t *outbuf)
1393 {
1394 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
1395 int start_track, format, msf, toclen;
1396 uint64_t nb_sectors;
1397
1398 msf = req->cmd.buf[1] & 2;
1399 format = req->cmd.buf[2] & 0xf;
1400 start_track = req->cmd.buf[6];
1401 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
1402 trace_scsi_disk_emulate_read_toc(start_track, format, msf >> 1);
1403 nb_sectors /= s->qdev.blocksize / BDRV_SECTOR_SIZE;
1404 switch (format) {
1405 case 0:
1406 toclen = cdrom_read_toc(nb_sectors, outbuf, msf, start_track);
1407 break;
1408 case 1:
1409 /* multi session : only a single session defined */
1410 toclen = 12;
1411 memset(outbuf, 0, 12);
1412 outbuf[1] = 0x0a;
1413 outbuf[2] = 0x01;
1414 outbuf[3] = 0x01;
1415 break;
1416 case 2:
1417 toclen = cdrom_read_toc_raw(nb_sectors, outbuf, msf, start_track);
1418 break;
1419 default:
1420 return -1;
1421 }
1422 return toclen;
1423 }
1424
1425 static int scsi_disk_emulate_start_stop(SCSIDiskReq *r)
1426 {
1427 SCSIRequest *req = &r->req;
1428 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
1429 bool start = req->cmd.buf[4] & 1;
1430 bool loej = req->cmd.buf[4] & 2; /* load on start, eject on !start */
1431 int pwrcnd = req->cmd.buf[4] & 0xf0;
1432
1433 if (pwrcnd) {
1434 /* eject/load only happens for power condition == 0 */
1435 return 0;
1436 }
1437
1438 if ((s->features & (1 << SCSI_DISK_F_REMOVABLE)) && loej) {
1439 if (!start && !s->tray_open && s->tray_locked) {
1440 scsi_check_condition(r,
1441 blk_is_inserted(s->qdev.conf.blk)
1442 ? SENSE_CODE(ILLEGAL_REQ_REMOVAL_PREVENTED)
1443 : SENSE_CODE(NOT_READY_REMOVAL_PREVENTED));
1444 return -1;
1445 }
1446
1447 if (s->tray_open != !start) {
1448 blk_eject(s->qdev.conf.blk, !start);
1449 s->tray_open = !start;
1450 }
1451 }
1452 return 0;
1453 }
1454
1455 static void scsi_disk_emulate_read_data(SCSIRequest *req)
1456 {
1457 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
1458 int buflen = r->iov.iov_len;
1459
1460 if (buflen) {
1461 trace_scsi_disk_emulate_read_data(buflen);
1462 r->iov.iov_len = 0;
1463 r->started = true;
1464 scsi_req_data(&r->req, buflen);
1465 return;
1466 }
1467
1468 /* This also clears the sense buffer for REQUEST SENSE. */
1469 scsi_req_complete(&r->req, GOOD);
1470 }
1471
1472 static int scsi_disk_check_mode_select(SCSIDiskState *s, int page,
1473 uint8_t *inbuf, int inlen)
1474 {
1475 uint8_t mode_current[SCSI_MAX_MODE_LEN];
1476 uint8_t mode_changeable[SCSI_MAX_MODE_LEN];
1477 uint8_t *p;
1478 int len, expected_len, changeable_len, i;
1479
1480 /* The input buffer does not include the page header, so it is
1481 * off by 2 bytes.
1482 */
1483 expected_len = inlen + 2;
1484 if (expected_len > SCSI_MAX_MODE_LEN) {
1485 return -1;
1486 }
1487
1488 /* MODE_PAGE_ALLS is only valid for MODE SENSE commands */
1489 if (page == MODE_PAGE_ALLS) {
1490 return -1;
1491 }
1492
1493 p = mode_current;
1494 memset(mode_current, 0, inlen + 2);
1495 len = mode_sense_page(s, page, &p, 0);
1496 if (len < 0 || len != expected_len) {
1497 return -1;
1498 }
1499
1500 p = mode_changeable;
1501 memset(mode_changeable, 0, inlen + 2);
1502 changeable_len = mode_sense_page(s, page, &p, 1);
1503 assert(changeable_len == len);
1504
1505 /* Check that unchangeable bits are the same as what MODE SENSE
1506 * would return.
1507 */
1508 for (i = 2; i < len; i++) {
1509 if (((mode_current[i] ^ inbuf[i - 2]) & ~mode_changeable[i]) != 0) {
1510 return -1;
1511 }
1512 }
1513 return 0;
1514 }
1515
1516 static void scsi_disk_apply_mode_select(SCSIDiskState *s, int page, uint8_t *p)
1517 {
1518 switch (page) {
1519 case MODE_PAGE_CACHING:
1520 blk_set_enable_write_cache(s->qdev.conf.blk, (p[0] & 4) != 0);
1521 break;
1522
1523 default:
1524 break;
1525 }
1526 }
1527
1528 static int mode_select_pages(SCSIDiskReq *r, uint8_t *p, int len, bool change)
1529 {
1530 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1531
1532 while (len > 0) {
1533 int page, subpage, page_len;
1534
1535 /* Parse both possible formats for the mode page headers. */
1536 page = p[0] & 0x3f;
1537 if (p[0] & 0x40) {
1538 if (len < 4) {
1539 goto invalid_param_len;
1540 }
1541 subpage = p[1];
1542 page_len = lduw_be_p(&p[2]);
1543 p += 4;
1544 len -= 4;
1545 } else {
1546 if (len < 2) {
1547 goto invalid_param_len;
1548 }
1549 subpage = 0;
1550 page_len = p[1];
1551 p += 2;
1552 len -= 2;
1553 }
1554
1555 if (subpage) {
1556 goto invalid_param;
1557 }
1558 if (page_len > len) {
1559 if (!(s->quirks & SCSI_DISK_QUIRK_MODE_PAGE_TRUNCATED)) {
1560 goto invalid_param_len;
1561 }
1562 trace_scsi_disk_mode_select_page_truncated(page, page_len, len);
1563 }
1564
1565 if (!change) {
1566 if (scsi_disk_check_mode_select(s, page, p, page_len) < 0) {
1567 goto invalid_param;
1568 }
1569 } else {
1570 scsi_disk_apply_mode_select(s, page, p);
1571 }
1572
1573 p += page_len;
1574 len -= page_len;
1575 }
1576 return 0;
1577
1578 invalid_param:
1579 scsi_check_condition(r, SENSE_CODE(INVALID_PARAM));
1580 return -1;
1581
1582 invalid_param_len:
1583 scsi_check_condition(r, SENSE_CODE(INVALID_PARAM_LEN));
1584 return -1;
1585 }
1586
1587 static void scsi_disk_emulate_mode_select(SCSIDiskReq *r, uint8_t *inbuf)
1588 {
1589 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1590 uint8_t *p = inbuf;
1591 int cmd = r->req.cmd.buf[0];
1592 int len = r->req.cmd.xfer;
1593 int hdr_len = (cmd == MODE_SELECT ? 4 : 8);
1594 int bd_len, bs;
1595 int pass;
1596
1597 if ((r->req.cmd.buf[1] & 0x11) != 0x10) {
1598 if (!(s->quirks &
1599 (1 << SCSI_DISK_QUIRK_MODE_PAGE_VENDOR_SPECIFIC_APPLE))) {
1600 /* We only support PF=1, SP=0. */
1601 goto invalid_field;
1602 }
1603 }
1604
1605 if (len < hdr_len) {
1606 goto invalid_param_len;
1607 }
1608
1609 bd_len = (cmd == MODE_SELECT ? p[3] : lduw_be_p(&p[6]));
1610 len -= hdr_len;
1611 p += hdr_len;
1612 if (len < bd_len) {
1613 goto invalid_param_len;
1614 }
1615 if (bd_len != 0 && bd_len != 8) {
1616 goto invalid_param;
1617 }
1618
1619 /* Allow changing the block size */
1620 if (bd_len) {
1621 bs = p[5] << 16 | p[6] << 8 | p[7];
1622
1623 /*
1624 * Since the existing code only checks/updates bits 8-15 of the block
1625 * size, restrict ourselves to the same requirement for now to ensure
1626 * that a block size set by a block descriptor and then read back by
1627 * a subsequent SCSI command will be the same
1628 */
1629 if (bs && !(bs & ~0xff00) && bs != s->qdev.blocksize) {
1630 s->qdev.blocksize = bs;
1631 trace_scsi_disk_mode_select_set_blocksize(s->qdev.blocksize);
1632 }
1633 }
1634
1635 len -= bd_len;
1636 p += bd_len;
1637
1638 /* Ensure no change is made if there is an error! */
1639 for (pass = 0; pass < 2; pass++) {
1640 if (mode_select_pages(r, p, len, pass == 1) < 0) {
1641 assert(pass == 0);
1642 return;
1643 }
1644 }
1645 if (!blk_enable_write_cache(s->qdev.conf.blk)) {
1646 /* The request is used as the AIO opaque value, so add a ref. */
1647 scsi_req_ref(&r->req);
1648 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct, 0,
1649 BLOCK_ACCT_FLUSH);
1650 r->req.aiocb = blk_aio_flush(s->qdev.conf.blk, scsi_aio_complete, r);
1651 return;
1652 }
1653
1654 scsi_req_complete(&r->req, GOOD);
1655 return;
1656
1657 invalid_param:
1658 scsi_check_condition(r, SENSE_CODE(INVALID_PARAM));
1659 return;
1660
1661 invalid_param_len:
1662 scsi_check_condition(r, SENSE_CODE(INVALID_PARAM_LEN));
1663 return;
1664
1665 invalid_field:
1666 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
1667 }
1668
1669 /* sector_num and nb_sectors expected to be in qdev blocksize */
1670 static inline bool check_lba_range(SCSIDiskState *s,
1671 uint64_t sector_num, uint32_t nb_sectors)
1672 {
1673 /*
1674 * The first line tests that no overflow happens when computing the last
1675 * sector. The second line tests that the last accessed sector is in
1676 * range.
1677 *
1678 * Careful, the computations should not underflow for nb_sectors == 0,
1679 * and a 0-block read to the first LBA beyond the end of device is
1680 * valid.
1681 */
1682 return (sector_num <= sector_num + nb_sectors &&
1683 sector_num + nb_sectors <= s->qdev.max_lba + 1);
1684 }
1685
1686 typedef struct UnmapCBData {
1687 SCSIDiskReq *r;
1688 uint8_t *inbuf;
1689 int count;
1690 } UnmapCBData;
1691
1692 static void scsi_unmap_complete(void *opaque, int ret);
1693
1694 static void scsi_unmap_complete_noio(UnmapCBData *data, int ret)
1695 {
1696 SCSIDiskReq *r = data->r;
1697 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1698
1699 assert(r->req.aiocb == NULL);
1700
1701 if (data->count > 0) {
1702 uint64_t sector_num = ldq_be_p(&data->inbuf[0]);
1703 uint32_t nb_sectors = ldl_be_p(&data->inbuf[8]) & 0xffffffffULL;
1704 r->sector = sector_num * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
1705 r->sector_count = nb_sectors * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
1706
1707 if (!check_lba_range(s, sector_num, nb_sectors)) {
1708 block_acct_invalid(blk_get_stats(s->qdev.conf.blk),
1709 BLOCK_ACCT_UNMAP);
1710 scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
1711 goto done;
1712 }
1713
1714 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct,
1715 r->sector_count * BDRV_SECTOR_SIZE,
1716 BLOCK_ACCT_UNMAP);
1717
1718 r->req.aiocb = blk_aio_pdiscard(s->qdev.conf.blk,
1719 r->sector * BDRV_SECTOR_SIZE,
1720 r->sector_count * BDRV_SECTOR_SIZE,
1721 scsi_unmap_complete, data);
1722 data->count--;
1723 data->inbuf += 16;
1724 return;
1725 }
1726
1727 scsi_req_complete(&r->req, GOOD);
1728
1729 done:
1730 scsi_req_unref(&r->req);
1731 g_free(data);
1732 }
1733
1734 static void scsi_unmap_complete(void *opaque, int ret)
1735 {
1736 UnmapCBData *data = opaque;
1737 SCSIDiskReq *r = data->r;
1738 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1739
1740 assert(r->req.aiocb != NULL);
1741 r->req.aiocb = NULL;
1742
1743 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
1744 if (scsi_disk_req_check_error(r, ret, true)) {
1745 scsi_req_unref(&r->req);
1746 g_free(data);
1747 } else {
1748 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
1749 scsi_unmap_complete_noio(data, ret);
1750 }
1751 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
1752 }
1753
1754 static void scsi_disk_emulate_unmap(SCSIDiskReq *r, uint8_t *inbuf)
1755 {
1756 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1757 uint8_t *p = inbuf;
1758 int len = r->req.cmd.xfer;
1759 UnmapCBData *data;
1760
1761 /* Reject ANCHOR=1. */
1762 if (r->req.cmd.buf[1] & 0x1) {
1763 goto invalid_field;
1764 }
1765
1766 if (len < 8) {
1767 goto invalid_param_len;
1768 }
1769 if (len < lduw_be_p(&p[0]) + 2) {
1770 goto invalid_param_len;
1771 }
1772 if (len < lduw_be_p(&p[2]) + 8) {
1773 goto invalid_param_len;
1774 }
1775 if (lduw_be_p(&p[2]) & 15) {
1776 goto invalid_param_len;
1777 }
1778
1779 if (!blk_is_writable(s->qdev.conf.blk)) {
1780 block_acct_invalid(blk_get_stats(s->qdev.conf.blk), BLOCK_ACCT_UNMAP);
1781 scsi_check_condition(r, SENSE_CODE(WRITE_PROTECTED));
1782 return;
1783 }
1784
1785 data = g_new0(UnmapCBData, 1);
1786 data->r = r;
1787 data->inbuf = &p[8];
1788 data->count = lduw_be_p(&p[2]) >> 4;
1789
1790 /* The matching unref is in scsi_unmap_complete, before data is freed. */
1791 scsi_req_ref(&r->req);
1792 scsi_unmap_complete_noio(data, 0);
1793 return;
1794
1795 invalid_param_len:
1796 block_acct_invalid(blk_get_stats(s->qdev.conf.blk), BLOCK_ACCT_UNMAP);
1797 scsi_check_condition(r, SENSE_CODE(INVALID_PARAM_LEN));
1798 return;
1799
1800 invalid_field:
1801 block_acct_invalid(blk_get_stats(s->qdev.conf.blk), BLOCK_ACCT_UNMAP);
1802 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
1803 }
1804
1805 typedef struct WriteSameCBData {
1806 SCSIDiskReq *r;
1807 int64_t sector;
1808 int nb_sectors;
1809 QEMUIOVector qiov;
1810 struct iovec iov;
1811 } WriteSameCBData;
1812
1813 static void scsi_write_same_complete(void *opaque, int ret)
1814 {
1815 WriteSameCBData *data = opaque;
1816 SCSIDiskReq *r = data->r;
1817 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1818
1819 assert(r->req.aiocb != NULL);
1820 r->req.aiocb = NULL;
1821 aio_context_acquire(blk_get_aio_context(s->qdev.conf.blk));
1822 if (scsi_disk_req_check_error(r, ret, true)) {
1823 goto done;
1824 }
1825
1826 block_acct_done(blk_get_stats(s->qdev.conf.blk), &r->acct);
1827
1828 data->nb_sectors -= data->iov.iov_len / BDRV_SECTOR_SIZE;
1829 data->sector += data->iov.iov_len / BDRV_SECTOR_SIZE;
1830 data->iov.iov_len = MIN(data->nb_sectors * BDRV_SECTOR_SIZE,
1831 data->iov.iov_len);
1832 if (data->iov.iov_len) {
1833 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct,
1834 data->iov.iov_len, BLOCK_ACCT_WRITE);
1835 /* Reinitialize qiov, to handle unaligned WRITE SAME request
1836 * where final qiov may need smaller size */
1837 qemu_iovec_init_external(&data->qiov, &data->iov, 1);
1838 r->req.aiocb = blk_aio_pwritev(s->qdev.conf.blk,
1839 data->sector << BDRV_SECTOR_BITS,
1840 &data->qiov, 0,
1841 scsi_write_same_complete, data);
1842 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
1843 return;
1844 }
1845
1846 scsi_req_complete(&r->req, GOOD);
1847
1848 done:
1849 scsi_req_unref(&r->req);
1850 qemu_vfree(data->iov.iov_base);
1851 g_free(data);
1852 aio_context_release(blk_get_aio_context(s->qdev.conf.blk));
1853 }
1854
1855 static void scsi_disk_emulate_write_same(SCSIDiskReq *r, uint8_t *inbuf)
1856 {
1857 SCSIRequest *req = &r->req;
1858 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
1859 uint32_t nb_sectors = scsi_data_cdb_xfer(r->req.cmd.buf);
1860 WriteSameCBData *data;
1861 uint8_t *buf;
1862 int i, l;
1863
1864 /* Fail if PBDATA=1 or LBDATA=1 or ANCHOR=1. */
1865 if (nb_sectors == 0 || (req->cmd.buf[1] & 0x16)) {
1866 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
1867 return;
1868 }
1869
1870 if (!blk_is_writable(s->qdev.conf.blk)) {
1871 scsi_check_condition(r, SENSE_CODE(WRITE_PROTECTED));
1872 return;
1873 }
1874 if (!check_lba_range(s, r->req.cmd.lba, nb_sectors)) {
1875 scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
1876 return;
1877 }
1878
1879 if ((req->cmd.buf[1] & 0x1) || buffer_is_zero(inbuf, s->qdev.blocksize)) {
1880 int flags = (req->cmd.buf[1] & 0x8) ? BDRV_REQ_MAY_UNMAP : 0;
1881
1882 /* The request is used as the AIO opaque value, so add a ref. */
1883 scsi_req_ref(&r->req);
1884 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct,
1885 nb_sectors * s->qdev.blocksize,
1886 BLOCK_ACCT_WRITE);
1887 r->req.aiocb = blk_aio_pwrite_zeroes(s->qdev.conf.blk,
1888 r->req.cmd.lba * s->qdev.blocksize,
1889 nb_sectors * s->qdev.blocksize,
1890 flags, scsi_aio_complete, r);
1891 return;
1892 }
1893
1894 data = g_new0(WriteSameCBData, 1);
1895 data->r = r;
1896 data->sector = r->req.cmd.lba * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
1897 data->nb_sectors = nb_sectors * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
1898 data->iov.iov_len = MIN(data->nb_sectors * BDRV_SECTOR_SIZE,
1899 SCSI_WRITE_SAME_MAX);
1900 data->iov.iov_base = buf = blk_blockalign(s->qdev.conf.blk,
1901 data->iov.iov_len);
1902 qemu_iovec_init_external(&data->qiov, &data->iov, 1);
1903
1904 for (i = 0; i < data->iov.iov_len; i += l) {
1905 l = MIN(s->qdev.blocksize, data->iov.iov_len - i);
1906 memcpy(&buf[i], inbuf, l);
1907 }
1908
1909 scsi_req_ref(&r->req);
1910 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct,
1911 data->iov.iov_len, BLOCK_ACCT_WRITE);
1912 r->req.aiocb = blk_aio_pwritev(s->qdev.conf.blk,
1913 data->sector << BDRV_SECTOR_BITS,
1914 &data->qiov, 0,
1915 scsi_write_same_complete, data);
1916 }
1917
1918 static void scsi_disk_emulate_write_data(SCSIRequest *req)
1919 {
1920 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
1921
1922 if (r->iov.iov_len) {
1923 int buflen = r->iov.iov_len;
1924 trace_scsi_disk_emulate_write_data(buflen);
1925 r->iov.iov_len = 0;
1926 scsi_req_data(&r->req, buflen);
1927 return;
1928 }
1929
1930 switch (req->cmd.buf[0]) {
1931 case MODE_SELECT:
1932 case MODE_SELECT_10:
1933 /* This also clears the sense buffer for REQUEST SENSE. */
1934 scsi_disk_emulate_mode_select(r, r->iov.iov_base);
1935 break;
1936
1937 case UNMAP:
1938 scsi_disk_emulate_unmap(r, r->iov.iov_base);
1939 break;
1940
1941 case VERIFY_10:
1942 case VERIFY_12:
1943 case VERIFY_16:
1944 if (r->req.status == -1) {
1945 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
1946 }
1947 break;
1948
1949 case WRITE_SAME_10:
1950 case WRITE_SAME_16:
1951 scsi_disk_emulate_write_same(r, r->iov.iov_base);
1952 break;
1953
1954 default:
1955 abort();
1956 }
1957 }
1958
1959 static int32_t scsi_disk_emulate_command(SCSIRequest *req, uint8_t *buf)
1960 {
1961 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
1962 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
1963 uint64_t nb_sectors;
1964 uint8_t *outbuf;
1965 int buflen;
1966
1967 switch (req->cmd.buf[0]) {
1968 case INQUIRY:
1969 case MODE_SENSE:
1970 case MODE_SENSE_10:
1971 case RESERVE:
1972 case RESERVE_10:
1973 case RELEASE:
1974 case RELEASE_10:
1975 case START_STOP:
1976 case ALLOW_MEDIUM_REMOVAL:
1977 case GET_CONFIGURATION:
1978 case GET_EVENT_STATUS_NOTIFICATION:
1979 case MECHANISM_STATUS:
1980 case REQUEST_SENSE:
1981 break;
1982
1983 default:
1984 if (!blk_is_available(s->qdev.conf.blk)) {
1985 scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
1986 return 0;
1987 }
1988 break;
1989 }
1990
1991 /*
1992 * FIXME: we shouldn't return anything bigger than 4k, but the code
1993 * requires the buffer to be as big as req->cmd.xfer in several
1994 * places. So, do not allow CDBs with a very large ALLOCATION
1995 * LENGTH. The real fix would be to modify scsi_read_data and
1996 * dma_buf_read, so that they return data beyond the buflen
1997 * as all zeros.
1998 */
1999 if (req->cmd.xfer > 65536) {
2000 goto illegal_request;
2001 }
2002 r->buflen = MAX(4096, req->cmd.xfer);
2003
2004 if (!r->iov.iov_base) {
2005 r->iov.iov_base = blk_blockalign(s->qdev.conf.blk, r->buflen);
2006 }
2007
2008 outbuf = r->iov.iov_base;
2009 memset(outbuf, 0, r->buflen);
2010 switch (req->cmd.buf[0]) {
2011 case TEST_UNIT_READY:
2012 assert(blk_is_available(s->qdev.conf.blk));
2013 break;
2014 case INQUIRY:
2015 buflen = scsi_disk_emulate_inquiry(req, outbuf);
2016 if (buflen < 0) {
2017 goto illegal_request;
2018 }
2019 break;
2020 case MODE_SENSE:
2021 case MODE_SENSE_10:
2022 buflen = scsi_disk_emulate_mode_sense(r, outbuf);
2023 if (buflen < 0) {
2024 goto illegal_request;
2025 }
2026 break;
2027 case READ_TOC:
2028 buflen = scsi_disk_emulate_read_toc(req, outbuf);
2029 if (buflen < 0) {
2030 goto illegal_request;
2031 }
2032 break;
2033 case RESERVE:
2034 if (req->cmd.buf[1] & 1) {
2035 goto illegal_request;
2036 }
2037 break;
2038 case RESERVE_10:
2039 if (req->cmd.buf[1] & 3) {
2040 goto illegal_request;
2041 }
2042 break;
2043 case RELEASE:
2044 if (req->cmd.buf[1] & 1) {
2045 goto illegal_request;
2046 }
2047 break;
2048 case RELEASE_10:
2049 if (req->cmd.buf[1] & 3) {
2050 goto illegal_request;
2051 }
2052 break;
2053 case START_STOP:
2054 if (scsi_disk_emulate_start_stop(r) < 0) {
2055 return 0;
2056 }
2057 break;
2058 case ALLOW_MEDIUM_REMOVAL:
2059 s->tray_locked = req->cmd.buf[4] & 1;
2060 blk_lock_medium(s->qdev.conf.blk, req->cmd.buf[4] & 1);
2061 break;
2062 case READ_CAPACITY_10:
2063 /* The normal LEN field for this command is zero. */
2064 memset(outbuf, 0, 8);
2065 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
2066 if (!nb_sectors) {
2067 scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
2068 return 0;
2069 }
2070 if ((req->cmd.buf[8] & 1) == 0 && req->cmd.lba) {
2071 goto illegal_request;
2072 }
2073 nb_sectors /= s->qdev.blocksize / BDRV_SECTOR_SIZE;
2074 /* Returned value is the address of the last sector. */
2075 nb_sectors--;
2076 /* Remember the new size for read/write sanity checking. */
2077 s->qdev.max_lba = nb_sectors;
2078 /* Clip to 2TB, instead of returning capacity modulo 2TB. */
2079 if (nb_sectors > UINT32_MAX) {
2080 nb_sectors = UINT32_MAX;
2081 }
2082 outbuf[0] = (nb_sectors >> 24) & 0xff;
2083 outbuf[1] = (nb_sectors >> 16) & 0xff;
2084 outbuf[2] = (nb_sectors >> 8) & 0xff;
2085 outbuf[3] = nb_sectors & 0xff;
2086 outbuf[4] = 0;
2087 outbuf[5] = 0;
2088 outbuf[6] = s->qdev.blocksize >> 8;
2089 outbuf[7] = 0;
2090 break;
2091 case REQUEST_SENSE:
2092 /* Just return "NO SENSE". */
2093 buflen = scsi_convert_sense(NULL, 0, outbuf, r->buflen,
2094 (req->cmd.buf[1] & 1) == 0);
2095 if (buflen < 0) {
2096 goto illegal_request;
2097 }
2098 break;
2099 case MECHANISM_STATUS:
2100 buflen = scsi_emulate_mechanism_status(s, outbuf);
2101 if (buflen < 0) {
2102 goto illegal_request;
2103 }
2104 break;
2105 case GET_CONFIGURATION:
2106 buflen = scsi_get_configuration(s, outbuf);
2107 if (buflen < 0) {
2108 goto illegal_request;
2109 }
2110 break;
2111 case GET_EVENT_STATUS_NOTIFICATION:
2112 buflen = scsi_get_event_status_notification(s, r, outbuf);
2113 if (buflen < 0) {
2114 goto illegal_request;
2115 }
2116 break;
2117 case READ_DISC_INFORMATION:
2118 buflen = scsi_read_disc_information(s, r, outbuf);
2119 if (buflen < 0) {
2120 goto illegal_request;
2121 }
2122 break;
2123 case READ_DVD_STRUCTURE:
2124 buflen = scsi_read_dvd_structure(s, r, outbuf);
2125 if (buflen < 0) {
2126 goto illegal_request;
2127 }
2128 break;
2129 case SERVICE_ACTION_IN_16:
2130 /* Service Action In subcommands. */
2131 if ((req->cmd.buf[1] & 31) == SAI_READ_CAPACITY_16) {
2132 trace_scsi_disk_emulate_command_SAI_16();
2133 memset(outbuf, 0, req->cmd.xfer);
2134 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
2135 if (!nb_sectors) {
2136 scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
2137 return 0;
2138 }
2139 if ((req->cmd.buf[14] & 1) == 0 && req->cmd.lba) {
2140 goto illegal_request;
2141 }
2142 nb_sectors /= s->qdev.blocksize / BDRV_SECTOR_SIZE;
2143 /* Returned value is the address of the last sector. */
2144 nb_sectors--;
2145 /* Remember the new size for read/write sanity checking. */
2146 s->qdev.max_lba = nb_sectors;
2147 outbuf[0] = (nb_sectors >> 56) & 0xff;
2148 outbuf[1] = (nb_sectors >> 48) & 0xff;
2149 outbuf[2] = (nb_sectors >> 40) & 0xff;
2150 outbuf[3] = (nb_sectors >> 32) & 0xff;
2151 outbuf[4] = (nb_sectors >> 24) & 0xff;
2152 outbuf[5] = (nb_sectors >> 16) & 0xff;
2153 outbuf[6] = (nb_sectors >> 8) & 0xff;
2154 outbuf[7] = nb_sectors & 0xff;
2155 outbuf[8] = 0;
2156 outbuf[9] = 0;
2157 outbuf[10] = s->qdev.blocksize >> 8;
2158 outbuf[11] = 0;
2159 outbuf[12] = 0;
2160 outbuf[13] = get_physical_block_exp(&s->qdev.conf);
2161
2162 /* set TPE bit if the format supports discard */
2163 if (s->qdev.conf.discard_granularity) {
2164 outbuf[14] = 0x80;
2165 }
2166
2167 /* Protection, exponent and lowest lba field left blank. */
2168 break;
2169 }
2170 trace_scsi_disk_emulate_command_SAI_unsupported();
2171 goto illegal_request;
2172 case SYNCHRONIZE_CACHE:
2173 /* The request is used as the AIO opaque value, so add a ref. */
2174 scsi_req_ref(&r->req);
2175 block_acct_start(blk_get_stats(s->qdev.conf.blk), &r->acct, 0,
2176 BLOCK_ACCT_FLUSH);
2177 r->req.aiocb = blk_aio_flush(s->qdev.conf.blk, scsi_aio_complete, r);
2178 return 0;
2179 case SEEK_10:
2180 trace_scsi_disk_emulate_command_SEEK_10(r->req.cmd.lba);
2181 if (r->req.cmd.lba > s->qdev.max_lba) {
2182 goto illegal_lba;
2183 }
2184 break;
2185 case MODE_SELECT:
2186 trace_scsi_disk_emulate_command_MODE_SELECT(r->req.cmd.xfer);
2187 break;
2188 case MODE_SELECT_10:
2189 trace_scsi_disk_emulate_command_MODE_SELECT_10(r->req.cmd.xfer);
2190 break;
2191 case UNMAP:
2192 trace_scsi_disk_emulate_command_UNMAP(r->req.cmd.xfer);
2193 break;
2194 case VERIFY_10:
2195 case VERIFY_12:
2196 case VERIFY_16:
2197 trace_scsi_disk_emulate_command_VERIFY((req->cmd.buf[1] >> 1) & 3);
2198 if (req->cmd.buf[1] & 6) {
2199 goto illegal_request;
2200 }
2201 break;
2202 case WRITE_SAME_10:
2203 case WRITE_SAME_16:
2204 trace_scsi_disk_emulate_command_WRITE_SAME(
2205 req->cmd.buf[0] == WRITE_SAME_10 ? 10 : 16, r->req.cmd.xfer);
2206 break;
2207 case FORMAT_UNIT:
2208 trace_scsi_disk_emulate_command_FORMAT_UNIT(r->req.cmd.xfer);
2209 break;
2210 default:
2211 trace_scsi_disk_emulate_command_UNKNOWN(buf[0],
2212 scsi_command_name(buf[0]));
2213 scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
2214 return 0;
2215 }
2216 assert(!r->req.aiocb);
2217 r->iov.iov_len = MIN(r->buflen, req->cmd.xfer);
2218 if (r->iov.iov_len == 0) {
2219 scsi_req_complete(&r->req, GOOD);
2220 }
2221 if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
2222 assert(r->iov.iov_len == req->cmd.xfer);
2223 return -r->iov.iov_len;
2224 } else {
2225 return r->iov.iov_len;
2226 }
2227
2228 illegal_request:
2229 if (r->req.status == -1) {
2230 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
2231 }
2232 return 0;
2233
2234 illegal_lba:
2235 scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
2236 return 0;
2237 }
2238
2239 /* Execute a scsi command. Returns the length of the data expected by the
2240 command. This will be Positive for data transfers from the device
2241 (eg. disk reads), negative for transfers to the device (eg. disk writes),
2242 and zero if the command does not transfer any data. */
2243
2244 static int32_t scsi_disk_dma_command(SCSIRequest *req, uint8_t *buf)
2245 {
2246 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
2247 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
2248 SCSIDiskClass *sdc = (SCSIDiskClass *) object_get_class(OBJECT(s));
2249 uint32_t len;
2250 uint8_t command;
2251
2252 command = buf[0];
2253
2254 if (!blk_is_available(s->qdev.conf.blk)) {
2255 scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
2256 return 0;
2257 }
2258
2259 len = scsi_data_cdb_xfer(r->req.cmd.buf);
2260 switch (command) {
2261 case READ_6:
2262 case READ_10:
2263 case READ_12:
2264 case READ_16:
2265 trace_scsi_disk_dma_command_READ(r->req.cmd.lba, len);
2266 /* Protection information is not supported. For SCSI versions 2 and
2267 * older (as determined by snooping the guest's INQUIRY commands),
2268 * there is no RD/WR/VRPROTECT, so skip this check in these versions.
2269 */
2270 if (s->qdev.scsi_version > 2 && (r->req.cmd.buf[1] & 0xe0)) {
2271 goto illegal_request;
2272 }
2273 if (!check_lba_range(s, r->req.cmd.lba, len)) {
2274 goto illegal_lba;
2275 }
2276 r->sector = r->req.cmd.lba * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
2277 r->sector_count = len * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
2278 break;
2279 case WRITE_6:
2280 case WRITE_10:
2281 case WRITE_12:
2282 case WRITE_16:
2283 case WRITE_VERIFY_10:
2284 case WRITE_VERIFY_12:
2285 case WRITE_VERIFY_16:
2286 if (!blk_is_writable(s->qdev.conf.blk)) {
2287 scsi_check_condition(r, SENSE_CODE(WRITE_PROTECTED));
2288 return 0;
2289 }
2290 trace_scsi_disk_dma_command_WRITE(
2291 (command & 0xe) == 0xe ? "And Verify " : "",
2292 r->req.cmd.lba, len);
2293 /* fall through */
2294 case VERIFY_10:
2295 case VERIFY_12:
2296 case VERIFY_16:
2297 /* We get here only for BYTCHK == 0x01 and only for scsi-block.
2298 * As far as DMA is concerned, we can treat it the same as a write;
2299 * scsi_block_do_sgio will send VERIFY commands.
2300 */
2301 if (s->qdev.scsi_version > 2 && (r->req.cmd.buf[1] & 0xe0)) {
2302 goto illegal_request;
2303 }
2304 if (!check_lba_range(s, r->req.cmd.lba, len)) {
2305 goto illegal_lba;
2306 }
2307 r->sector = r->req.cmd.lba * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
2308 r->sector_count = len * (s->qdev.blocksize / BDRV_SECTOR_SIZE);
2309 break;
2310 default:
2311 abort();
2312 illegal_request:
2313 scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
2314 return 0;
2315 illegal_lba:
2316 scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
2317 return 0;
2318 }
2319 r->need_fua_emulation = sdc->need_fua_emulation(&r->req.cmd);
2320 if (r->sector_count == 0) {
2321 scsi_req_complete(&r->req, GOOD);
2322 }
2323 assert(r->iov.iov_len == 0);
2324 if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
2325 return -r->sector_count * BDRV_SECTOR_SIZE;
2326 } else {
2327 return r->sector_count * BDRV_SECTOR_SIZE;
2328 }
2329 }
2330
2331 static void scsi_disk_reset(DeviceState *dev)
2332 {
2333 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev.qdev, dev);
2334 uint64_t nb_sectors;
2335
2336 scsi_device_purge_requests(&s->qdev, SENSE_CODE(RESET));
2337
2338 blk_get_geometry(s->qdev.conf.blk, &nb_sectors);
2339 nb_sectors /= s->qdev.blocksize / BDRV_SECTOR_SIZE;
2340 if (nb_sectors) {
2341 nb_sectors--;
2342 }
2343 s->qdev.max_lba = nb_sectors;
2344 /* reset tray statuses */
2345 s->tray_locked = 0;
2346 s->tray_open = 0;
2347
2348 s->qdev.scsi_version = s->qdev.default_scsi_version;
2349 }
2350
2351 static void scsi_disk_resize_cb(void *opaque)
2352 {
2353 SCSIDiskState *s = opaque;
2354
2355 /* SPC lists this sense code as available only for
2356 * direct-access devices.
2357 */
2358 if (s->qdev.type == TYPE_DISK) {
2359 scsi_device_report_change(&s->qdev, SENSE_CODE(CAPACITY_CHANGED));
2360 }
2361 }
2362
2363 static void scsi_cd_change_media_cb(void *opaque, bool load, Error **errp)
2364 {
2365 SCSIDiskState *s = opaque;
2366
2367 /*
2368 * When a CD gets changed, we have to report an ejected state and
2369 * then a loaded state to guests so that they detect tray
2370 * open/close and media change events. Guests that do not use
2371 * GET_EVENT_STATUS_NOTIFICATION to detect such tray open/close
2372 * states rely on this behavior.
2373 *
2374 * media_changed governs the state machine used for unit attention
2375 * report. media_event is used by GET EVENT STATUS NOTIFICATION.
2376 */
2377 s->media_changed = load;
2378 s->tray_open = !load;
2379 scsi_device_set_ua(&s->qdev, SENSE_CODE(UNIT_ATTENTION_NO_MEDIUM));
2380 s->media_event = true;
2381 s->eject_request = false;
2382 }
2383
2384 static void scsi_cd_eject_request_cb(void *opaque, bool force)
2385 {
2386 SCSIDiskState *s = opaque;
2387
2388 s->eject_request = true;
2389 if (force) {
2390 s->tray_locked = false;
2391 }
2392 }
2393
2394 static bool scsi_cd_is_tray_open(void *opaque)
2395 {
2396 return ((SCSIDiskState *)opaque)->tray_open;
2397 }
2398
2399 static bool scsi_cd_is_medium_locked(void *opaque)
2400 {
2401 return ((SCSIDiskState *)opaque)->tray_locked;
2402 }
2403
2404 static const BlockDevOps scsi_disk_removable_block_ops = {
2405 .change_media_cb = scsi_cd_change_media_cb,
2406 .eject_request_cb = scsi_cd_eject_request_cb,
2407 .is_tray_open = scsi_cd_is_tray_open,
2408 .is_medium_locked = scsi_cd_is_medium_locked,
2409
2410 .resize_cb = scsi_disk_resize_cb,
2411 };
2412
2413 static const BlockDevOps scsi_disk_block_ops = {
2414 .resize_cb = scsi_disk_resize_cb,
2415 };
2416
2417 static void scsi_disk_unit_attention_reported(SCSIDevice *dev)
2418 {
2419 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
2420 if (s->media_changed) {
2421 s->media_changed = false;
2422 scsi_device_set_ua(&s->qdev, SENSE_CODE(MEDIUM_CHANGED));
2423 }
2424 }
2425
2426 static void scsi_realize(SCSIDevice *dev, Error **errp)
2427 {
2428 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
2429 bool read_only;
2430
2431 if (!s->qdev.conf.blk) {
2432 error_setg(errp, "drive property not set");
2433 return;
2434 }
2435
2436 if (!(s->features & (1 << SCSI_DISK_F_REMOVABLE)) &&
2437 !blk_is_inserted(s->qdev.conf.blk)) {
2438 error_setg(errp, "Device needs media, but drive is empty");
2439 return;
2440 }
2441
2442 if (!blkconf_blocksizes(&s->qdev.conf, errp)) {
2443 return;
2444 }
2445
2446 if (blk_get_aio_context(s->qdev.conf.blk) != qemu_get_aio_context() &&
2447 !s->qdev.hba_supports_iothread)
2448 {
2449 error_setg(errp, "HBA does not support iothreads");
2450 return;
2451 }
2452
2453 if (dev->type == TYPE_DISK) {
2454 if (!blkconf_geometry(&dev->conf, NULL, 65535, 255, 255, errp)) {
2455 return;
2456 }
2457 }
2458
2459 read_only = !blk_supports_write_perm(s->qdev.conf.blk);
2460 if (dev->type == TYPE_ROM) {
2461 read_only = true;
2462 }
2463
2464 if (!blkconf_apply_backend_options(&dev->conf, read_only,
2465 dev->type == TYPE_DISK, errp)) {
2466 return;
2467 }
2468
2469 if (s->qdev.conf.discard_granularity == -1) {
2470 s->qdev.conf.discard_granularity =
2471 MAX(s->qdev.conf.logical_block_size, DEFAULT_DISCARD_GRANULARITY);
2472 }
2473
2474 if (!s->version) {
2475 s->version = g_strdup(qemu_hw_version());
2476 }
2477 if (!s->vendor) {
2478 s->vendor = g_strdup("QEMU");
2479 }
2480 if (!s->device_id) {
2481 if (s->serial) {
2482 s->device_id = g_strdup_printf("%.20s", s->serial);
2483 } else {
2484 const char *str = blk_name(s->qdev.conf.blk);
2485 if (str && *str) {
2486 s->device_id = g_strdup(str);
2487 }
2488 }
2489 }
2490
2491 if (blk_is_sg(s->qdev.conf.blk)) {
2492 error_setg(errp, "unwanted /dev/sg*");
2493 return;
2494 }
2495
2496 if ((s->features & (1 << SCSI_DISK_F_REMOVABLE)) &&
2497 !(s->features & (1 << SCSI_DISK_F_NO_REMOVABLE_DEVOPS))) {
2498 blk_set_dev_ops(s->qdev.conf.blk, &scsi_disk_removable_block_ops, s);
2499 } else {
2500 blk_set_dev_ops(s->qdev.conf.blk, &scsi_disk_block_ops, s);
2501 }
2502
2503 blk_iostatus_enable(s->qdev.conf.blk);
2504
2505 add_boot_device_lchs(&dev->qdev, NULL,
2506 dev->conf.lcyls,
2507 dev->conf.lheads,
2508 dev->conf.lsecs);
2509 }
2510
2511 static void scsi_unrealize(SCSIDevice *dev)
2512 {
2513 del_boot_device_lchs(&dev->qdev, NULL);
2514 }
2515
2516 static void scsi_hd_realize(SCSIDevice *dev, Error **errp)
2517 {
2518 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
2519 AioContext *ctx = NULL;
2520 /* can happen for devices without drive. The error message for missing
2521 * backend will be issued in scsi_realize
2522 */
2523 if (s->qdev.conf.blk) {
2524 ctx = blk_get_aio_context(s->qdev.conf.blk);
2525 aio_context_acquire(ctx);
2526 if (!blkconf_blocksizes(&s->qdev.conf, errp)) {
2527 goto out;
2528 }
2529 }
2530 s->qdev.blocksize = s->qdev.conf.logical_block_size;
2531 s->qdev.type = TYPE_DISK;
2532 if (!s->product) {
2533 s->product = g_strdup("QEMU HARDDISK");
2534 }
2535 scsi_realize(&s->qdev, errp);
2536 out:
2537 if (ctx) {
2538 aio_context_release(ctx);
2539 }
2540 }
2541
2542 static void scsi_cd_realize(SCSIDevice *dev, Error **errp)
2543 {
2544 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
2545 AioContext *ctx;
2546 int ret;
2547 uint32_t blocksize = 2048;
2548
2549 if (!dev->conf.blk) {
2550 /* Anonymous BlockBackend for an empty drive. As we put it into
2551 * dev->conf, qdev takes care of detaching on unplug. */
2552 dev->conf.blk = blk_new(qemu_get_aio_context(), 0, BLK_PERM_ALL);
2553 ret = blk_attach_dev(dev->conf.blk, &dev->qdev);
2554 assert(ret == 0);
2555 }
2556
2557 if (dev->conf.physical_block_size != 0) {
2558 blocksize = dev->conf.physical_block_size;
2559 }
2560
2561 ctx = blk_get_aio_context(dev->conf.blk);
2562 aio_context_acquire(ctx);
2563 s->qdev.blocksize = blocksize;
2564 s->qdev.type = TYPE_ROM;
2565 s->features |= 1 << SCSI_DISK_F_REMOVABLE;
2566 if (!s->product) {
2567 s->product = g_strdup("QEMU CD-ROM");
2568 }
2569 scsi_realize(&s->qdev, errp);
2570 aio_context_release(ctx);
2571 }
2572
2573
2574 static const SCSIReqOps scsi_disk_emulate_reqops = {
2575 .size = sizeof(SCSIDiskReq),
2576 .free_req = scsi_free_request,
2577 .send_command = scsi_disk_emulate_command,
2578 .read_data = scsi_disk_emulate_read_data,
2579 .write_data = scsi_disk_emulate_write_data,
2580 .get_buf = scsi_get_buf,
2581 };
2582
2583 static const SCSIReqOps scsi_disk_dma_reqops = {
2584 .size = sizeof(SCSIDiskReq),
2585 .free_req = scsi_free_request,
2586 .send_command = scsi_disk_dma_command,
2587 .read_data = scsi_read_data,
2588 .write_data = scsi_write_data,
2589 .get_buf = scsi_get_buf,
2590 .load_request = scsi_disk_load_request,
2591 .save_request = scsi_disk_save_request,
2592 };
2593
2594 static const SCSIReqOps *const scsi_disk_reqops_dispatch[256] = {
2595 [TEST_UNIT_READY] = &scsi_disk_emulate_reqops,
2596 [INQUIRY] = &scsi_disk_emulate_reqops,
2597 [MODE_SENSE] = &scsi_disk_emulate_reqops,
2598 [MODE_SENSE_10] = &scsi_disk_emulate_reqops,
2599 [START_STOP] = &scsi_disk_emulate_reqops,
2600 [ALLOW_MEDIUM_REMOVAL] = &scsi_disk_emulate_reqops,
2601 [READ_CAPACITY_10] = &scsi_disk_emulate_reqops,
2602 [READ_TOC] = &scsi_disk_emulate_reqops,
2603 [READ_DVD_STRUCTURE] = &scsi_disk_emulate_reqops,
2604 [READ_DISC_INFORMATION] = &scsi_disk_emulate_reqops,
2605 [GET_CONFIGURATION] = &scsi_disk_emulate_reqops,
2606 [GET_EVENT_STATUS_NOTIFICATION] = &scsi_disk_emulate_reqops,
2607 [MECHANISM_STATUS] = &scsi_disk_emulate_reqops,
2608 [SERVICE_ACTION_IN_16] = &scsi_disk_emulate_reqops,
2609 [REQUEST_SENSE] = &scsi_disk_emulate_reqops,
2610 [SYNCHRONIZE_CACHE] = &scsi_disk_emulate_reqops,
2611 [SEEK_10] = &scsi_disk_emulate_reqops,
2612 [MODE_SELECT] = &scsi_disk_emulate_reqops,
2613 [MODE_SELECT_10] = &scsi_disk_emulate_reqops,
2614 [UNMAP] = &scsi_disk_emulate_reqops,
2615 [WRITE_SAME_10] = &scsi_disk_emulate_reqops,
2616 [WRITE_SAME_16] = &scsi_disk_emulate_reqops,
2617 [VERIFY_10] = &scsi_disk_emulate_reqops,
2618 [VERIFY_12] = &scsi_disk_emulate_reqops,
2619 [VERIFY_16] = &scsi_disk_emulate_reqops,
2620 [FORMAT_UNIT] = &scsi_disk_emulate_reqops,
2621
2622 [READ_6] = &scsi_disk_dma_reqops,
2623 [READ_10] = &scsi_disk_dma_reqops,
2624 [READ_12] = &scsi_disk_dma_reqops,
2625 [READ_16] = &scsi_disk_dma_reqops,
2626 [WRITE_6] = &scsi_disk_dma_reqops,
2627 [WRITE_10] = &scsi_disk_dma_reqops,
2628 [WRITE_12] = &scsi_disk_dma_reqops,
2629 [WRITE_16] = &scsi_disk_dma_reqops,
2630 [WRITE_VERIFY_10] = &scsi_disk_dma_reqops,
2631 [WRITE_VERIFY_12] = &scsi_disk_dma_reqops,
2632 [WRITE_VERIFY_16] = &scsi_disk_dma_reqops,
2633 };
2634
2635 static void scsi_disk_new_request_dump(uint32_t lun, uint32_t tag, uint8_t *buf)
2636 {
2637 int i;
2638 int len = scsi_cdb_length(buf);
2639 char *line_buffer, *p;
2640
2641 assert(len > 0 && len <= 16);
2642 line_buffer = g_malloc(len * 5 + 1);
2643
2644 for (i = 0, p = line_buffer; i < len; i++) {
2645 p += sprintf(p, " 0x%02x", buf[i]);
2646 }
2647 trace_scsi_disk_new_request(lun, tag, line_buffer);
2648
2649 g_free(line_buffer);
2650 }
2651
2652 static SCSIRequest *scsi_new_request(SCSIDevice *d, uint32_t tag, uint32_t lun,
2653 uint8_t *buf, void *hba_private)
2654 {
2655 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, d);
2656 SCSIRequest *req;
2657 const SCSIReqOps *ops;
2658 uint8_t command;
2659
2660 command = buf[0];
2661 ops = scsi_disk_reqops_dispatch[command];
2662 if (!ops) {
2663 ops = &scsi_disk_emulate_reqops;
2664 }
2665 req = scsi_req_alloc(ops, &s->qdev, tag, lun, hba_private);
2666
2667 if (trace_event_get_state_backends(TRACE_SCSI_DISK_NEW_REQUEST)) {
2668 scsi_disk_new_request_dump(lun, tag, buf);
2669 }
2670
2671 return req;
2672 }
2673
2674 #ifdef __linux__
2675 static int get_device_type(SCSIDiskState *s)
2676 {
2677 uint8_t cmd[16];
2678 uint8_t buf[36];
2679 int ret;
2680
2681 memset(cmd, 0, sizeof(cmd));
2682 memset(buf, 0, sizeof(buf));
2683 cmd[0] = INQUIRY;
2684 cmd[4] = sizeof(buf);
2685
2686 ret = scsi_SG_IO_FROM_DEV(s->qdev.conf.blk, cmd, sizeof(cmd),
2687 buf, sizeof(buf), s->qdev.io_timeout);
2688 if (ret < 0) {
2689 return -1;
2690 }
2691 s->qdev.type = buf[0];
2692 if (buf[1] & 0x80) {
2693 s->features |= 1 << SCSI_DISK_F_REMOVABLE;
2694 }
2695 return 0;
2696 }
2697
2698 static void scsi_block_realize(SCSIDevice *dev, Error **errp)
2699 {
2700 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
2701 AioContext *ctx;
2702 int sg_version;
2703 int rc;
2704
2705 if (!s->qdev.conf.blk) {
2706 error_setg(errp, "drive property not set");
2707 return;
2708 }
2709
2710 if (s->rotation_rate) {
2711 error_report_once("rotation_rate is specified for scsi-block but is "
2712 "not implemented. This option is deprecated and will "
2713 "be removed in a future version");
2714 }
2715
2716 ctx = blk_get_aio_context(s->qdev.conf.blk);
2717 aio_context_acquire(ctx);
2718
2719 /* check we are using a driver managing SG_IO (version 3 and after) */
2720 rc = blk_ioctl(s->qdev.conf.blk, SG_GET_VERSION_NUM, &sg_version);
2721 if (rc < 0) {
2722 error_setg_errno(errp, -rc, "cannot get SG_IO version number");
2723 if (rc != -EPERM) {
2724 error_append_hint(errp, "Is this a SCSI device?\n");
2725 }
2726 goto out;
2727 }
2728 if (sg_version < 30000) {
2729 error_setg(errp, "scsi generic interface too old");
2730 goto out;
2731 }
2732
2733 /* get device type from INQUIRY data */
2734 rc = get_device_type(s);
2735 if (rc < 0) {
2736 error_setg(errp, "INQUIRY failed");
2737 goto out;
2738 }
2739
2740 /* Make a guess for the block size, we'll fix it when the guest sends.
2741 * READ CAPACITY. If they don't, they likely would assume these sizes
2742 * anyway. (TODO: check in /sys).
2743 */
2744 if (s->qdev.type == TYPE_ROM || s->qdev.type == TYPE_WORM) {
2745 s->qdev.blocksize = 2048;
2746 } else {
2747 s->qdev.blocksize = 512;
2748 }
2749
2750 /* Makes the scsi-block device not removable by using HMP and QMP eject
2751 * command.
2752 */
2753 s->features |= (1 << SCSI_DISK_F_NO_REMOVABLE_DEVOPS);
2754
2755 scsi_realize(&s->qdev, errp);
2756 scsi_generic_read_device_inquiry(&s->qdev);
2757
2758 out:
2759 aio_context_release(ctx);
2760 }
2761
2762 typedef struct SCSIBlockReq {
2763 SCSIDiskReq req;
2764 sg_io_hdr_t io_header;
2765
2766 /* Selected bytes of the original CDB, copied into our own CDB. */
2767 uint8_t cmd, cdb1, group_number;
2768
2769 /* CDB passed to SG_IO. */
2770 uint8_t cdb[16];
2771 BlockCompletionFunc *cb;
2772 void *cb_opaque;
2773 } SCSIBlockReq;
2774
2775 static void scsi_block_sgio_complete(void *opaque, int ret)
2776 {
2777 SCSIBlockReq *req = (SCSIBlockReq *)opaque;
2778 SCSIDiskReq *r = &req->req;
2779 SCSIDevice *s = r->req.dev;
2780 sg_io_hdr_t *io_hdr = &req->io_header;
2781
2782 if (ret == 0) {
2783 if (io_hdr->host_status != SCSI_HOST_OK) {
2784 scsi_req_complete_failed(&r->req, io_hdr->host_status);
2785 scsi_req_unref(&r->req);
2786 return;
2787 }
2788
2789 if (io_hdr->driver_status & SG_ERR_DRIVER_TIMEOUT) {
2790 ret = BUSY;
2791 } else {
2792 ret = io_hdr->status;
2793 }
2794
2795 if (ret > 0) {
2796 aio_context_acquire(blk_get_aio_context(s->conf.blk));
2797 if (scsi_handle_rw_error(r, ret, true)) {
2798 aio_context_release(blk_get_aio_context(s->conf.blk));
2799 scsi_req_unref(&r->req);
2800 return;
2801 }
2802 aio_context_release(blk_get_aio_context(s->conf.blk));
2803
2804 /* Ignore error. */
2805 ret = 0;
2806 }
2807 }
2808
2809 req->cb(req->cb_opaque, ret);
2810 }
2811
2812 static BlockAIOCB *scsi_block_do_sgio(SCSIBlockReq *req,
2813 int64_t offset, QEMUIOVector *iov,
2814 int direction,
2815 BlockCompletionFunc *cb, void *opaque)
2816 {
2817 sg_io_hdr_t *io_header = &req->io_header;
2818 SCSIDiskReq *r = &req->req;
2819 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
2820 int nb_logical_blocks;
2821 uint64_t lba;
2822 BlockAIOCB *aiocb;
2823
2824 /* This is not supported yet. It can only happen if the guest does
2825 * reads and writes that are not aligned to one logical sectors
2826 * _and_ cover multiple MemoryRegions.
2827 */
2828 assert(offset % s->qdev.blocksize == 0);
2829 assert(iov->size % s->qdev.blocksize == 0);
2830
2831 io_header->interface_id = 'S';
2832
2833 /* The data transfer comes from the QEMUIOVector. */
2834 io_header->dxfer_direction = direction;
2835 io_header->dxfer_len = iov->size;
2836 io_header->dxferp = (void *)iov->iov;
2837 io_header->iovec_count = iov->niov;
2838 assert(io_header->iovec_count == iov->niov); /* no overflow! */
2839
2840 /* Build a new CDB with the LBA and length patched in, in case
2841 * DMA helpers split the transfer in multiple segments. Do not
2842 * build a CDB smaller than what the guest wanted, and only build
2843 * a larger one if strictly necessary.
2844 */
2845 io_header->cmdp = req->cdb;
2846 lba = offset / s->qdev.blocksize;
2847 nb_logical_blocks = io_header->dxfer_len / s->qdev.blocksize;
2848
2849 if ((req->cmd >> 5) == 0 && lba <= 0x1ffff) {
2850 /* 6-byte CDB */
2851 stl_be_p(&req->cdb[0], lba | (req->cmd << 24));
2852 req->cdb[4] = nb_logical_blocks;
2853 req->cdb[5] = 0;
2854 io_header->cmd_len = 6;
2855 } else if ((req->cmd >> 5) <= 1 && lba <= 0xffffffffULL) {
2856 /* 10-byte CDB */
2857 req->cdb[0] = (req->cmd & 0x1f) | 0x20;
2858 req->cdb[1] = req->cdb1;
2859 stl_be_p(&req->cdb[2], lba);
2860 req->cdb[6] = req->group_number;
2861 stw_be_p(&req->cdb[7], nb_logical_blocks);
2862 req->cdb[9] = 0;
2863 io_header->cmd_len = 10;
2864 } else if ((req->cmd >> 5) != 4 && lba <= 0xffffffffULL) {
2865 /* 12-byte CDB */
2866 req->cdb[0] = (req->cmd & 0x1f) | 0xA0;
2867 req->cdb[1] = req->cdb1;
2868 stl_be_p(&req->cdb[2], lba);
2869 stl_be_p(&req->cdb[6], nb_logical_blocks);
2870 req->cdb[10] = req->group_number;
2871 req->cdb[11] = 0;
2872 io_header->cmd_len = 12;
2873 } else {
2874 /* 16-byte CDB */
2875 req->cdb[0] = (req->cmd & 0x1f) | 0x80;
2876 req->cdb[1] = req->cdb1;
2877 stq_be_p(&req->cdb[2], lba);
2878 stl_be_p(&req->cdb[10], nb_logical_blocks);
2879 req->cdb[14] = req->group_number;
2880 req->cdb[15] = 0;
2881 io_header->cmd_len = 16;
2882 }
2883
2884 /* The rest is as in scsi-generic.c. */
2885 io_header->mx_sb_len = sizeof(r->req.sense);
2886 io_header->sbp = r->req.sense;
2887 io_header->timeout = s->qdev.io_timeout * 1000;
2888 io_header->usr_ptr = r;
2889 io_header->flags |= SG_FLAG_DIRECT_IO;
2890 req->cb = cb;
2891 req->cb_opaque = opaque;
2892 trace_scsi_disk_aio_sgio_command(r->req.tag, req->cdb[0], lba,
2893 nb_logical_blocks, io_header->timeout);
2894 aiocb = blk_aio_ioctl(s->qdev.conf.blk, SG_IO, io_header, scsi_block_sgio_complete, req);
2895 assert(aiocb != NULL);
2896 return aiocb;
2897 }
2898
2899 static bool scsi_block_no_fua(SCSICommand *cmd)
2900 {
2901 return false;
2902 }
2903
2904 static BlockAIOCB *scsi_block_dma_readv(int64_t offset,
2905 QEMUIOVector *iov,
2906 BlockCompletionFunc *cb, void *cb_opaque,
2907 void *opaque)
2908 {
2909 SCSIBlockReq *r = opaque;
2910 return scsi_block_do_sgio(r, offset, iov,
2911 SG_DXFER_FROM_DEV, cb, cb_opaque);
2912 }
2913
2914 static BlockAIOCB *scsi_block_dma_writev(int64_t offset,
2915 QEMUIOVector *iov,
2916 BlockCompletionFunc *cb, void *cb_opaque,
2917 void *opaque)
2918 {
2919 SCSIBlockReq *r = opaque;
2920 return scsi_block_do_sgio(r, offset, iov,
2921 SG_DXFER_TO_DEV, cb, cb_opaque);
2922 }
2923
2924 static bool scsi_block_is_passthrough(SCSIDiskState *s, uint8_t *buf)
2925 {
2926 switch (buf[0]) {
2927 case VERIFY_10:
2928 case VERIFY_12:
2929 case VERIFY_16:
2930 /* Check if BYTCHK == 0x01 (data-out buffer contains data
2931 * for the number of logical blocks specified in the length
2932 * field). For other modes, do not use scatter/gather operation.
2933 */
2934 if ((buf[1] & 6) == 2) {
2935 return false;
2936 }
2937 break;
2938
2939 case READ_6:
2940 case READ_10:
2941 case READ_12:
2942 case READ_16:
2943 case WRITE_6:
2944 case WRITE_10:
2945 case WRITE_12:
2946 case WRITE_16:
2947 case WRITE_VERIFY_10:
2948 case WRITE_VERIFY_12:
2949 case WRITE_VERIFY_16:
2950 /* MMC writing cannot be done via DMA helpers, because it sometimes
2951 * involves writing beyond the maximum LBA or to negative LBA (lead-in).
2952 * We might use scsi_block_dma_reqops as long as no writing commands are
2953 * seen, but performance usually isn't paramount on optical media. So,
2954 * just make scsi-block operate the same as scsi-generic for them.
2955 */
2956 if (s->qdev.type != TYPE_ROM) {
2957 return false;
2958 }
2959 break;
2960
2961 default:
2962 break;
2963 }
2964
2965 return true;
2966 }
2967
2968
2969 static int32_t scsi_block_dma_command(SCSIRequest *req, uint8_t *buf)
2970 {
2971 SCSIBlockReq *r = (SCSIBlockReq *)req;
2972 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
2973
2974 r->cmd = req->cmd.buf[0];
2975 switch (r->cmd >> 5) {
2976 case 0:
2977 /* 6-byte CDB. */
2978 r->cdb1 = r->group_number = 0;
2979 break;
2980 case 1:
2981 /* 10-byte CDB. */
2982 r->cdb1 = req->cmd.buf[1];
2983 r->group_number = req->cmd.buf[6];
2984 break;
2985 case 4:
2986 /* 12-byte CDB. */
2987 r->cdb1 = req->cmd.buf[1];
2988 r->group_number = req->cmd.buf[10];
2989 break;
2990 case 5:
2991 /* 16-byte CDB. */
2992 r->cdb1 = req->cmd.buf[1];
2993 r->group_number = req->cmd.buf[14];
2994 break;
2995 default:
2996 abort();
2997 }
2998
2999 /* Protection information is not supported. For SCSI versions 2 and
3000 * older (as determined by snooping the guest's INQUIRY commands),
3001 * there is no RD/WR/VRPROTECT, so skip this check in these versions.
3002 */
3003 if (s->qdev.scsi_version > 2 && (req->cmd.buf[1] & 0xe0)) {
3004 scsi_check_condition(&r->req, SENSE_CODE(INVALID_FIELD));
3005 return 0;
3006 }
3007
3008 return scsi_disk_dma_command(req, buf);
3009 }
3010
3011 static const SCSIReqOps scsi_block_dma_reqops = {
3012 .size = sizeof(SCSIBlockReq),
3013 .free_req = scsi_free_request,
3014 .send_command = scsi_block_dma_command,
3015 .read_data = scsi_read_data,
3016 .write_data = scsi_write_data,
3017 .get_buf = scsi_get_buf,
3018 .load_request = scsi_disk_load_request,
3019 .save_request = scsi_disk_save_request,
3020 };
3021
3022 static SCSIRequest *scsi_block_new_request(SCSIDevice *d, uint32_t tag,
3023 uint32_t lun, uint8_t *buf,
3024 void *hba_private)
3025 {
3026 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, d);
3027
3028 if (scsi_block_is_passthrough(s, buf)) {
3029 return scsi_req_alloc(&scsi_generic_req_ops, &s->qdev, tag, lun,
3030 hba_private);
3031 } else {
3032 return scsi_req_alloc(&scsi_block_dma_reqops, &s->qdev, tag, lun,
3033 hba_private);
3034 }
3035 }
3036
3037 static int scsi_block_parse_cdb(SCSIDevice *d, SCSICommand *cmd,
3038 uint8_t *buf, size_t buf_len,
3039 void *hba_private)
3040 {
3041 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, d);
3042
3043 if (scsi_block_is_passthrough(s, buf)) {
3044 return scsi_bus_parse_cdb(&s->qdev, cmd, buf, buf_len, hba_private);
3045 } else {
3046 return scsi_req_parse_cdb(&s->qdev, cmd, buf, buf_len);
3047 }
3048 }
3049
3050 static void scsi_block_update_sense(SCSIRequest *req)
3051 {
3052 SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
3053 SCSIBlockReq *br = DO_UPCAST(SCSIBlockReq, req, r);
3054 r->req.sense_len = MIN(br->io_header.sb_len_wr, sizeof(r->req.sense));
3055 }
3056 #endif
3057
3058 static
3059 BlockAIOCB *scsi_dma_readv(int64_t offset, QEMUIOVector *iov,
3060 BlockCompletionFunc *cb, void *cb_opaque,
3061 void *opaque)
3062 {
3063 SCSIDiskReq *r = opaque;
3064 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
3065 return blk_aio_preadv(s->qdev.conf.blk, offset, iov, 0, cb, cb_opaque);
3066 }
3067
3068 static
3069 BlockAIOCB *scsi_dma_writev(int64_t offset, QEMUIOVector *iov,
3070 BlockCompletionFunc *cb, void *cb_opaque,
3071 void *opaque)
3072 {
3073 SCSIDiskReq *r = opaque;
3074 SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
3075 return blk_aio_pwritev(s->qdev.conf.blk, offset, iov, 0, cb, cb_opaque);
3076 }
3077
3078 static void scsi_disk_base_class_initfn(ObjectClass *klass, void *data)
3079 {
3080 DeviceClass *dc = DEVICE_CLASS(klass);
3081 SCSIDiskClass *sdc = SCSI_DISK_BASE_CLASS(klass);
3082
3083 dc->fw_name = "disk";
3084 dc->reset = scsi_disk_reset;
3085 sdc->dma_readv = scsi_dma_readv;
3086 sdc->dma_writev = scsi_dma_writev;
3087 sdc->need_fua_emulation = scsi_is_cmd_fua;
3088 }
3089
3090 static const TypeInfo scsi_disk_base_info = {
3091 .name = TYPE_SCSI_DISK_BASE,
3092 .parent = TYPE_SCSI_DEVICE,
3093 .class_init = scsi_disk_base_class_initfn,
3094 .instance_size = sizeof(SCSIDiskState),
3095 .class_size = sizeof(SCSIDiskClass),
3096 .abstract = true,
3097 };
3098
3099 #define DEFINE_SCSI_DISK_PROPERTIES() \
3100 DEFINE_PROP_DRIVE_IOTHREAD("drive", SCSIDiskState, qdev.conf.blk), \
3101 DEFINE_BLOCK_PROPERTIES_BASE(SCSIDiskState, qdev.conf), \
3102 DEFINE_BLOCK_ERROR_PROPERTIES(SCSIDiskState, qdev.conf), \
3103 DEFINE_PROP_STRING("ver", SCSIDiskState, version), \
3104 DEFINE_PROP_STRING("serial", SCSIDiskState, serial), \
3105 DEFINE_PROP_STRING("vendor", SCSIDiskState, vendor), \
3106 DEFINE_PROP_STRING("product", SCSIDiskState, product), \
3107 DEFINE_PROP_STRING("device_id", SCSIDiskState, device_id)
3108
3109
3110 static Property scsi_hd_properties[] = {
3111 DEFINE_SCSI_DISK_PROPERTIES(),
3112 DEFINE_PROP_BIT("removable", SCSIDiskState, features,
3113 SCSI_DISK_F_REMOVABLE, false),
3114 DEFINE_PROP_BIT("dpofua", SCSIDiskState, features,
3115 SCSI_DISK_F_DPOFUA, false),
3116 DEFINE_PROP_UINT64("wwn", SCSIDiskState, qdev.wwn, 0),
3117 DEFINE_PROP_UINT64("port_wwn", SCSIDiskState, qdev.port_wwn, 0),
3118 DEFINE_PROP_UINT16("port_index", SCSIDiskState, port_index, 0),
3119 DEFINE_PROP_UINT64("max_unmap_size", SCSIDiskState, max_unmap_size,
3120 DEFAULT_MAX_UNMAP_SIZE),
3121 DEFINE_PROP_UINT64("max_io_size", SCSIDiskState, max_io_size,
3122 DEFAULT_MAX_IO_SIZE),
3123 DEFINE_PROP_UINT16("rotation_rate", SCSIDiskState, rotation_rate, 0),
3124 DEFINE_PROP_INT32("scsi_version", SCSIDiskState, qdev.default_scsi_version,
3125 5),
3126 DEFINE_PROP_BIT("quirk_mode_page_vendor_specific_apple", SCSIDiskState,
3127 quirks, SCSI_DISK_QUIRK_MODE_PAGE_VENDOR_SPECIFIC_APPLE,
3128 0),
3129 DEFINE_BLOCK_CHS_PROPERTIES(SCSIDiskState, qdev.conf),
3130 DEFINE_PROP_END_OF_LIST(),
3131 };
3132
3133 static const VMStateDescription vmstate_scsi_disk_state = {
3134 .name = "scsi-disk",
3135 .version_id = 1,
3136 .minimum_version_id = 1,
3137 .fields = (VMStateField[]) {
3138 VMSTATE_SCSI_DEVICE(qdev, SCSIDiskState),
3139 VMSTATE_BOOL(media_changed, SCSIDiskState),
3140 VMSTATE_BOOL(media_event, SCSIDiskState),
3141 VMSTATE_BOOL(eject_request, SCSIDiskState),
3142 VMSTATE_BOOL(tray_open, SCSIDiskState),
3143 VMSTATE_BOOL(tray_locked, SCSIDiskState),
3144 VMSTATE_END_OF_LIST()
3145 }
3146 };
3147
3148 static void scsi_hd_class_initfn(ObjectClass *klass, void *data)
3149 {
3150 DeviceClass *dc = DEVICE_CLASS(klass);
3151 SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);
3152
3153 sc->realize = scsi_hd_realize;
3154 sc->unrealize = scsi_unrealize;
3155 sc->alloc_req = scsi_new_request;
3156 sc->unit_attention_reported = scsi_disk_unit_attention_reported;
3157 dc->desc = "virtual SCSI disk";
3158 device_class_set_props(dc, scsi_hd_properties);
3159 dc->vmsd = &vmstate_scsi_disk_state;
3160 }
3161
3162 static const TypeInfo scsi_hd_info = {
3163 .name = "scsi-hd",
3164 .parent = TYPE_SCSI_DISK_BASE,
3165 .class_init = scsi_hd_class_initfn,
3166 };
3167
3168 static Property scsi_cd_properties[] = {
3169 DEFINE_SCSI_DISK_PROPERTIES(),
3170 DEFINE_PROP_UINT64("wwn", SCSIDiskState, qdev.wwn, 0),
3171 DEFINE_PROP_UINT64("port_wwn", SCSIDiskState, qdev.port_wwn, 0),
3172 DEFINE_PROP_UINT16("port_index", SCSIDiskState, port_index, 0),
3173 DEFINE_PROP_UINT64("max_io_size", SCSIDiskState, max_io_size,
3174 DEFAULT_MAX_IO_SIZE),
3175 DEFINE_PROP_INT32("scsi_version", SCSIDiskState, qdev.default_scsi_version,
3176 5),
3177 DEFINE_PROP_BIT("quirk_mode_page_apple_vendor", SCSIDiskState, quirks,
3178 SCSI_DISK_QUIRK_MODE_PAGE_APPLE_VENDOR, 0),
3179 DEFINE_PROP_BIT("quirk_mode_sense_rom_use_dbd", SCSIDiskState, quirks,
3180 SCSI_DISK_QUIRK_MODE_SENSE_ROM_USE_DBD, 0),
3181 DEFINE_PROP_BIT("quirk_mode_page_vendor_specific_apple", SCSIDiskState,
3182 quirks, SCSI_DISK_QUIRK_MODE_PAGE_VENDOR_SPECIFIC_APPLE,
3183 0),
3184 DEFINE_PROP_BIT("quirk_mode_page_truncated", SCSIDiskState, quirks,
3185 SCSI_DISK_QUIRK_MODE_PAGE_TRUNCATED, 0),
3186 DEFINE_PROP_END_OF_LIST(),
3187 };
3188
3189 static void scsi_cd_class_initfn(ObjectClass *klass, void *data)
3190 {
3191 DeviceClass *dc = DEVICE_CLASS(klass);
3192 SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);
3193
3194 sc->realize = scsi_cd_realize;
3195 sc->alloc_req = scsi_new_request;
3196 sc->unit_attention_reported = scsi_disk_unit_attention_reported;
3197 dc->desc = "virtual SCSI CD-ROM";
3198 device_class_set_props(dc, scsi_cd_properties);
3199 dc->vmsd = &vmstate_scsi_disk_state;
3200 }
3201
3202 static const TypeInfo scsi_cd_info = {
3203 .name = "scsi-cd",
3204 .parent = TYPE_SCSI_DISK_BASE,
3205 .class_init = scsi_cd_class_initfn,
3206 };
3207
3208 #ifdef __linux__
3209 static Property scsi_block_properties[] = {
3210 DEFINE_BLOCK_ERROR_PROPERTIES(SCSIDiskState, qdev.conf),
3211 DEFINE_PROP_DRIVE("drive", SCSIDiskState, qdev.conf.blk),
3212 DEFINE_PROP_BOOL("share-rw", SCSIDiskState, qdev.conf.share_rw, false),
3213 DEFINE_PROP_UINT16("rotation_rate", SCSIDiskState, rotation_rate, 0),
3214 DEFINE_PROP_UINT64("max_unmap_size", SCSIDiskState, max_unmap_size,
3215 DEFAULT_MAX_UNMAP_SIZE),
3216 DEFINE_PROP_UINT64("max_io_size", SCSIDiskState, max_io_size,
3217 DEFAULT_MAX_IO_SIZE),
3218 DEFINE_PROP_INT32("scsi_version", SCSIDiskState, qdev.default_scsi_version,
3219 -1),
3220 DEFINE_PROP_UINT32("io_timeout", SCSIDiskState, qdev.io_timeout,
3221 DEFAULT_IO_TIMEOUT),
3222 DEFINE_PROP_END_OF_LIST(),
3223 };
3224
3225 static void scsi_block_class_initfn(ObjectClass *klass, void *data)
3226 {
3227 DeviceClass *dc = DEVICE_CLASS(klass);
3228 SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);
3229 SCSIDiskClass *sdc = SCSI_DISK_BASE_CLASS(klass);
3230
3231 sc->realize = scsi_block_realize;
3232 sc->alloc_req = scsi_block_new_request;
3233 sc->parse_cdb = scsi_block_parse_cdb;
3234 sdc->dma_readv = scsi_block_dma_readv;
3235 sdc->dma_writev = scsi_block_dma_writev;
3236 sdc->update_sense = scsi_block_update_sense;
3237 sdc->need_fua_emulation = scsi_block_no_fua;
3238 dc->desc = "SCSI block device passthrough";
3239 device_class_set_props(dc, scsi_block_properties);
3240 dc->vmsd = &vmstate_scsi_disk_state;
3241 }
3242
3243 static const TypeInfo scsi_block_info = {
3244 .name = "scsi-block",
3245 .parent = TYPE_SCSI_DISK_BASE,
3246 .class_init = scsi_block_class_initfn,
3247 };
3248 #endif
3249
3250 static void scsi_disk_register_types(void)
3251 {
3252 type_register_static(&scsi_disk_base_info);
3253 type_register_static(&scsi_hd_info);
3254 type_register_static(&scsi_cd_info);
3255 #ifdef __linux__
3256 type_register_static(&scsi_block_info);
3257 #endif
3258 }
3259
3260 type_init(scsi_disk_register_types)
QEmu