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