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