scsi-disk.c 62.4 KB
Newer Older
P
pbrook 已提交
1 2 3 4 5 6 7
/*
 * SCSI Device emulation
 *
 * Copyright (c) 2006 CodeSourcery.
 * Based on code by Fabrice Bellard
 *
 * Written by Paul Brook
8 9 10 11 12 13
 * Modifications:
 *  2009-Dec-12 Artyom Tarasenko : implemented stamdard inquiry for the case
 *                                 when the allocation length of CDB is smaller
 *                                 than 36.
 *  2009-Oct-13 Artyom Tarasenko : implemented the block descriptor in the
 *                                 MODE SENSE response.
P
pbrook 已提交
14
 *
M
Matthew Fernandez 已提交
15
 * This code is licensed under the LGPL.
P
pbrook 已提交
16 17
 *
 * Note that this file only handles the SCSI architecture model and device
18 19
 * commands.  Emulation of interface/link layer protocols is handled by
 * the host adapter emulator.
P
pbrook 已提交
20 21 22 23 24
 */

//#define DEBUG_SCSI

#ifdef DEBUG_SCSI
25 26
#define DPRINTF(fmt, ...) \
do { printf("scsi-disk: " fmt , ## __VA_ARGS__); } while (0)
P
pbrook 已提交
27
#else
28
#define DPRINTF(fmt, ...) do {} while(0)
P
pbrook 已提交
29 30
#endif

P
pbrook 已提交
31
#include "qemu-common.h"
32
#include "qemu-error.h"
G
Gerd Hoffmann 已提交
33
#include "scsi.h"
G
Gerd Hoffmann 已提交
34
#include "scsi-defs.h"
35
#include "sysemu.h"
B
Blue Swirl 已提交
36
#include "blockdev.h"
37
#include "dma.h"
38

39 40 41 42
#ifdef __linux
#include <scsi/sg.h>
#endif

43
#define SCSI_DMA_BUF_SIZE    131072
44
#define SCSI_MAX_INQUIRY_LEN 256
P
pbrook 已提交
45

46 47
typedef struct SCSIDiskState SCSIDiskState;

48 49
typedef struct SCSIDiskReq {
    SCSIRequest req;
P
pbrook 已提交
50
    /* Both sector and sector_count are in terms of qemu 512 byte blocks.  */
51 52
    uint64_t sector;
    uint32_t sector_count;
53
    uint32_t buflen;
54
    bool started;
55 56
    struct iovec iov;
    QEMUIOVector qiov;
57
    BlockAcctCookie acct;
58
} SCSIDiskReq;
P
pbrook 已提交
59

60
#define SCSI_DISK_F_REMOVABLE   0
P
Paolo Bonzini 已提交
61
#define SCSI_DISK_F_DPOFUA      1
62

63
struct SCSIDiskState
P
pbrook 已提交
64
{
65
    SCSIDevice qdev;
66
    uint32_t features;
67
    bool media_changed;
68
    bool media_event;
69
    bool eject_request;
70
    uint64_t wwn;
71
    QEMUBH *bh;
G
Gerd Hoffmann 已提交
72
    char *version;
73
    char *serial;
74
    bool tray_open;
75
    bool tray_locked;
P
pbrook 已提交
76 77
};

78
static int scsi_handle_rw_error(SCSIDiskReq *r, int error);
K
Kevin Wolf 已提交
79

P
Paolo Bonzini 已提交
80
static void scsi_free_request(SCSIRequest *req)
P
pbrook 已提交
81
{
P
Paolo Bonzini 已提交
82 83
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);

84 85 86
    if (r->iov.iov_base) {
        qemu_vfree(r->iov.iov_base);
    }
P
pbrook 已提交
87 88
}

89 90
/* Helper function for command completion with sense.  */
static void scsi_check_condition(SCSIDiskReq *r, SCSISense sense)
G
Gerd Hoffmann 已提交
91
{
B
Blue Swirl 已提交
92 93
    DPRINTF("Command complete tag=0x%x sense=%d/%d/%d\n",
            r->req.tag, sense.key, sense.asc, sense.ascq);
94 95
    scsi_req_build_sense(&r->req, sense);
    scsi_req_complete(&r->req, CHECK_CONDITION);
P
pbrook 已提交
96 97 98
}

/* Cancel a pending data transfer.  */
99
static void scsi_cancel_io(SCSIRequest *req)
P
pbrook 已提交
100
{
101 102 103 104 105
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);

    DPRINTF("Cancel tag=0x%x\n", req->tag);
    if (r->req.aiocb) {
        bdrv_aio_cancel(r->req.aiocb);
106 107 108 109 110

        /* This reference was left in by scsi_*_data.  We take ownership of
         * it the moment scsi_req_cancel is called, independent of whether
         * bdrv_aio_cancel completes the request or not.  */
        scsi_req_unref(&r->req);
P
pbrook 已提交
111
    }
112
    r->req.aiocb = NULL;
P
pbrook 已提交
113 114
}

P
Paolo Bonzini 已提交
115
static uint32_t scsi_init_iovec(SCSIDiskReq *r, size_t size)
116
{
117 118 119
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);

    if (!r->iov.iov_base) {
P
Paolo Bonzini 已提交
120
        r->buflen = size;
121
        r->iov.iov_base = qemu_blockalign(s->qdev.conf.bs, r->buflen);
122 123
    }
    r->iov.iov_len = MIN(r->sector_count * 512, r->buflen);
124 125 126 127
    qemu_iovec_init_external(&r->qiov, &r->iov, 1);
    return r->qiov.size / 512;
}

P
Paolo Bonzini 已提交
128 129 130 131 132 133 134
static void scsi_disk_save_request(QEMUFile *f, SCSIRequest *req)
{
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);

    qemu_put_be64s(f, &r->sector);
    qemu_put_be32s(f, &r->sector_count);
    qemu_put_be32s(f, &r->buflen);
135 136 137 138 139 140 141 142
    if (r->buflen) {
        if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
            qemu_put_buffer(f, r->iov.iov_base, r->iov.iov_len);
        } else if (!req->retry) {
            uint32_t len = r->iov.iov_len;
            qemu_put_be32s(f, &len);
            qemu_put_buffer(f, r->iov.iov_base, r->iov.iov_len);
        }
P
Paolo Bonzini 已提交
143 144 145 146 147 148 149 150 151 152 153 154 155 156
    }
}

static void scsi_disk_load_request(QEMUFile *f, SCSIRequest *req)
{
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);

    qemu_get_be64s(f, &r->sector);
    qemu_get_be32s(f, &r->sector_count);
    qemu_get_be32s(f, &r->buflen);
    if (r->buflen) {
        scsi_init_iovec(r, r->buflen);
        if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
            qemu_get_buffer(f, r->iov.iov_base, r->iov.iov_len);
157 158 159 160 161 162
        } else if (!r->req.retry) {
            uint32_t len;
            qemu_get_be32s(f, &len);
            r->iov.iov_len = len;
            assert(r->iov.iov_len <= r->buflen);
            qemu_get_buffer(f, r->iov.iov_base, r->iov.iov_len);
P
Paolo Bonzini 已提交
163 164 165 166 167 168
        }
    }

    qemu_iovec_init_external(&r->qiov, &r->iov, 1);
}

169
static void scsi_flush_complete(void * opaque, int ret)
170 171 172 173 174 175
{
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);

    bdrv_acct_done(s->qdev.conf.bs, &r->acct);

176
    if (ret < 0) {
177 178 179 180 181 182 183 184
        if (scsi_handle_rw_error(r, -ret)) {
            goto done;
        }
    }

    scsi_req_complete(&r->req, GOOD);

done:
185 186 187
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
188 189
}

190 191 192 193 194 195 196 197 198 199 200
static bool scsi_is_cmd_fua(SCSICommand *cmd)
{
    switch (cmd->buf[0]) {
    case READ_10:
    case READ_12:
    case READ_16:
    case WRITE_10:
    case WRITE_12:
    case WRITE_16:
        return (cmd->buf[1] & 8) != 0;

201 202 203
    case VERIFY_10:
    case VERIFY_12:
    case VERIFY_16:
204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231
    case WRITE_VERIFY_10:
    case WRITE_VERIFY_12:
    case WRITE_VERIFY_16:
        return true;

    case READ_6:
    case WRITE_6:
    default:
        return false;
    }
}

static void scsi_write_do_fua(SCSIDiskReq *r)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);

    if (scsi_is_cmd_fua(&r->req.cmd)) {
        bdrv_acct_start(s->qdev.conf.bs, &r->acct, 0, BDRV_ACCT_FLUSH);
        r->req.aiocb = bdrv_aio_flush(s->qdev.conf.bs, scsi_flush_complete, r);
        return;
    }

    scsi_req_complete(&r->req, GOOD);
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
}

232
static void scsi_dma_complete(void *opaque, int ret)
P
pbrook 已提交
233
{
234
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
235
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
P
pbrook 已提交
236

237 238 239 240
    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
        bdrv_acct_done(s->qdev.conf.bs, &r->acct);
    }
241

242
    if (ret < 0) {
243
        if (scsi_handle_rw_error(r, -ret)) {
244
            goto done;
K
Kevin Wolf 已提交
245
        }
P
pbrook 已提交
246
    }
K
Kevin Wolf 已提交
247

248 249
    r->sector += r->sector_count;
    r->sector_count = 0;
250 251 252 253 254 255
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
        scsi_write_do_fua(r);
        return;
    } else {
        scsi_req_complete(&r->req, GOOD);
    }
256 257 258 259 260

done:
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
P
pbrook 已提交
261 262
}

263
static void scsi_read_complete(void * opaque, int ret)
264 265 266
{
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
267
    int n;
268

269 270 271 272
    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
        bdrv_acct_done(s->qdev.conf.bs, &r->acct);
    }
273 274

    if (ret < 0) {
275
        if (scsi_handle_rw_error(r, -ret)) {
276
            goto done;
277 278 279
        }
    }

280 281 282 283 284 285
    DPRINTF("Data ready tag=0x%x len=%zd\n", r->req.tag, r->qiov.size);

    n = r->qiov.size / 512;
    r->sector += n;
    r->sector_count -= n;
    scsi_req_data(&r->req, r->qiov.size);
286 287 288 289 290

done:
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
291
}
K
Kevin Wolf 已提交
292

P
Paolo Bonzini 已提交
293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310
/* Actually issue a read to the block device.  */
static void scsi_do_read(void *opaque, int ret)
{
    SCSIDiskReq *r = opaque;
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
    uint32_t n;

    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
        bdrv_acct_done(s->qdev.conf.bs, &r->acct);
    }

    if (ret < 0) {
        if (scsi_handle_rw_error(r, -ret)) {
            goto done;
        }
    }

P
Paolo Bonzini 已提交
311 312 313 314 315 316 317
    if (r->req.io_canceled) {
        return;
    }

    /* The request is used as the AIO opaque value, so add a ref.  */
    scsi_req_ref(&r->req);

P
Paolo Bonzini 已提交
318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335
    if (r->req.sg) {
        dma_acct_start(s->qdev.conf.bs, &r->acct, r->req.sg, BDRV_ACCT_READ);
        r->req.resid -= r->req.sg->size;
        r->req.aiocb = dma_bdrv_read(s->qdev.conf.bs, r->req.sg, r->sector,
                                     scsi_dma_complete, r);
    } else {
        n = scsi_init_iovec(r, SCSI_DMA_BUF_SIZE);
        bdrv_acct_start(s->qdev.conf.bs, &r->acct, n * BDRV_SECTOR_SIZE, BDRV_ACCT_READ);
        r->req.aiocb = bdrv_aio_readv(s->qdev.conf.bs, r->sector, &r->qiov, n,
                                      scsi_read_complete, r);
    }

done:
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
}

336 337
/* Read more data from scsi device into buffer.  */
static void scsi_read_data(SCSIRequest *req)
P
pbrook 已提交
338
{
339
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
K
Kevin Wolf 已提交
340
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
P
Paolo Bonzini 已提交
341
    bool first;
P
pbrook 已提交
342

P
pbrook 已提交
343
    if (r->sector_count == (uint32_t)-1) {
344
        DPRINTF("Read buf_len=%zd\n", r->iov.iov_len);
P
pbrook 已提交
345
        r->sector_count = 0;
346
        r->started = true;
P
Paolo Bonzini 已提交
347
        scsi_req_data(&r->req, r->iov.iov_len);
P
pbrook 已提交
348
        return;
P
pbrook 已提交
349
    }
P
pbrook 已提交
350 351
    DPRINTF("Read sector_count=%d\n", r->sector_count);
    if (r->sector_count == 0) {
352 353
        /* This also clears the sense buffer for REQUEST SENSE.  */
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
354
        return;
P
pbrook 已提交
355 356
    }

357 358 359
    /* No data transfer may already be in progress */
    assert(r->req.aiocb == NULL);

360 361
    /* The request is used as the AIO opaque value, so add a ref.  */
    scsi_req_ref(&r->req);
362 363 364 365 366 367
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
        DPRINTF("Data transfer direction invalid\n");
        scsi_read_complete(r, -EINVAL);
        return;
    }

368 369
    if (s->tray_open) {
        scsi_read_complete(r, -ENOMEDIUM);
370
        return;
371
    }
372

P
Paolo Bonzini 已提交
373
    first = !r->started;
374
    r->started = true;
P
Paolo Bonzini 已提交
375 376 377
    if (first && scsi_is_cmd_fua(&r->req.cmd)) {
        bdrv_acct_start(s->qdev.conf.bs, &r->acct, 0, BDRV_ACCT_FLUSH);
        r->req.aiocb = bdrv_aio_flush(s->qdev.conf.bs, scsi_do_read, r);
378
    } else {
P
Paolo Bonzini 已提交
379
        scsi_do_read(r, 0);
380
    }
P
pbrook 已提交
381 382
}

383 384 385 386 387 388 389
/*
 * scsi_handle_rw_error has two return values.  0 means that the error
 * must be ignored, 1 means that the error has been processed and the
 * caller should not do anything else for this request.  Note that
 * scsi_handle_rw_error always manages its reference counts, independent
 * of the return value.
 */
390
static int scsi_handle_rw_error(SCSIDiskReq *r, int error)
K
Kevin Wolf 已提交
391
{
392
    int is_read = (r->req.cmd.xfer == SCSI_XFER_FROM_DEV);
393
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
394
    BlockErrorAction action = bdrv_get_on_error(s->qdev.conf.bs, is_read);
395

396
    if (action == BLOCK_ERR_IGNORE) {
397
        bdrv_emit_qmp_error_event(s->qdev.conf.bs, BDRV_ACTION_IGNORE, is_read);
398
        return 0;
399
    }
400 401 402

    if ((error == ENOSPC && action == BLOCK_ERR_STOP_ENOSPC)
            || action == BLOCK_ERR_STOP_ANY) {
K
Kevin Wolf 已提交
403

404
        bdrv_emit_qmp_error_event(s->qdev.conf.bs, BDRV_ACTION_STOP, is_read);
405
        vm_stop(RUN_STATE_IO_ERROR);
406
        bdrv_iostatus_set_err(s->qdev.conf.bs, error);
407
        scsi_req_retry(&r->req);
408
    } else {
409
        switch (error) {
410 411 412
        case ENOMEDIUM:
            scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
            break;
413
        case ENOMEM:
414
            scsi_check_condition(r, SENSE_CODE(TARGET_FAILURE));
415 416
            break;
        case EINVAL:
417
            scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
418 419
            break;
        default:
420
            scsi_check_condition(r, SENSE_CODE(IO_ERROR));
421
            break;
422
        }
423
        bdrv_emit_qmp_error_event(s->qdev.conf.bs, BDRV_ACTION_REPORT, is_read);
424 425 426 427
    }
    return 1;
}

P
pbrook 已提交
428 429
static void scsi_write_complete(void * opaque, int ret)
{
430
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
431
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
432 433
    uint32_t n;

P
Paolo Bonzini 已提交
434 435
    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
436
        bdrv_acct_done(s->qdev.conf.bs, &r->acct);
P
Paolo Bonzini 已提交
437
    }
438

439
    if (ret < 0) {
440
        if (scsi_handle_rw_error(r, -ret)) {
441
            goto done;
K
Kevin Wolf 已提交
442
        }
P
pbrook 已提交
443 444
    }

445
    n = r->qiov.size / 512;
446 447
    r->sector += n;
    r->sector_count -= n;
P
pbrook 已提交
448
    if (r->sector_count == 0) {
449 450
        scsi_write_do_fua(r);
        return;
P
pbrook 已提交
451
    } else {
P
Paolo Bonzini 已提交
452
        scsi_init_iovec(r, SCSI_DMA_BUF_SIZE);
453 454
        DPRINTF("Write complete tag=0x%x more=%d\n", r->req.tag, r->qiov.size);
        scsi_req_data(&r->req, r->qiov.size);
P
pbrook 已提交
455
    }
456 457 458 459 460

done:
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
P
pbrook 已提交
461 462
}

463
static void scsi_write_data(SCSIRequest *req)
464
{
465
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
466
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
467 468
    uint32_t n;

469 470 471
    /* No data transfer may already be in progress */
    assert(r->req.aiocb == NULL);

472 473
    /* The request is used as the AIO opaque value, so add a ref.  */
    scsi_req_ref(&r->req);
474 475 476
    if (r->req.cmd.mode != SCSI_XFER_TO_DEV) {
        DPRINTF("Data transfer direction invalid\n");
        scsi_write_complete(r, -EINVAL);
477
        return;
478 479
    }

480 481
    if (!r->req.sg && !r->qiov.size) {
        /* Called for the first time.  Ask the driver to send us more data.  */
482
        r->started = true;
483 484 485 486 487 488 489 490
        scsi_write_complete(r, 0);
        return;
    }
    if (s->tray_open) {
        scsi_write_complete(r, -ENOMEDIUM);
        return;
    }

491 492 493 494 495 496 497 498 499 500
    if (r->req.cmd.buf[0] == VERIFY_10 || r->req.cmd.buf[0] == VERIFY_12 ||
        r->req.cmd.buf[0] == VERIFY_16) {
        if (r->req.sg) {
            scsi_dma_complete(r, 0);
        } else {
            scsi_write_complete(r, 0);
        }
        return;
    }

501 502 503 504 505 506 507
    if (r->req.sg) {
        dma_acct_start(s->qdev.conf.bs, &r->acct, r->req.sg, BDRV_ACCT_WRITE);
        r->req.resid -= r->req.sg->size;
        r->req.aiocb = dma_bdrv_write(s->qdev.conf.bs, r->req.sg, r->sector,
                                      scsi_dma_complete, r);
    } else {
        n = r->qiov.size / 512;
508 509
        bdrv_acct_start(s->qdev.conf.bs, &r->acct, n * BDRV_SECTOR_SIZE, BDRV_ACCT_WRITE);
        r->req.aiocb = bdrv_aio_writev(s->qdev.conf.bs, r->sector, &r->qiov, n,
510
                                       scsi_write_complete, r);
511
    }
P
pbrook 已提交
512
}
P
pbrook 已提交
513

P
pbrook 已提交
514
/* Return a pointer to the data buffer.  */
515
static uint8_t *scsi_get_buf(SCSIRequest *req)
P
pbrook 已提交
516
{
517
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
P
pbrook 已提交
518

519
    return (uint8_t *)r->iov.iov_base;
P
pbrook 已提交
520 521
}

522 523
static int scsi_disk_emulate_inquiry(SCSIRequest *req, uint8_t *outbuf)
{
G
Gerd Hoffmann 已提交
524
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
525
    int buflen = 0;
526
    int start;
527 528 529 530 531

    if (req->cmd.buf[1] & 0x1) {
        /* Vital product data */
        uint8_t page_code = req->cmd.buf[2];

532
        outbuf[buflen++] = s->qdev.type & 0x1f;
533 534
        outbuf[buflen++] = page_code ; // this page
        outbuf[buflen++] = 0x00;
535 536
        outbuf[buflen++] = 0x00;
        start = buflen;
537 538 539

        switch (page_code) {
        case 0x00: /* Supported page codes, mandatory */
H
Hannes Reinecke 已提交
540
        {
541 542 543
            DPRINTF("Inquiry EVPD[Supported pages] "
                    "buffer size %zd\n", req->cmd.xfer);
            outbuf[buflen++] = 0x00; // list of supported pages (this page)
544
            if (s->serial) {
545
                outbuf[buflen++] = 0x80; // unit serial number
546
            }
547
            outbuf[buflen++] = 0x83; // device identification
H
Hannes Reinecke 已提交
548
            if (s->qdev.type == TYPE_DISK) {
549 550
                outbuf[buflen++] = 0xb0; // block limits
                outbuf[buflen++] = 0xb2; // thin provisioning
H
Hannes Reinecke 已提交
551
            }
552
            break;
H
Hannes Reinecke 已提交
553
        }
554 555
        case 0x80: /* Device serial number, optional */
        {
556
            int l;
557

558 559 560 561 562 563
            if (!s->serial) {
                DPRINTF("Inquiry (EVPD[Serial number] not supported\n");
                return -1;
            }

            l = strlen(s->serial);
564
            if (l > 20) {
565
                l = 20;
566
            }
567 568 569

            DPRINTF("Inquiry EVPD[Serial number] "
                    "buffer size %zd\n", req->cmd.xfer);
570
            memcpy(outbuf+buflen, s->serial, l);
571 572 573 574 575 576
            buflen += l;
            break;
        }

        case 0x83: /* Device identification page, mandatory */
        {
577 578 579
            const char *str = s->serial ?: bdrv_get_device_name(s->qdev.conf.bs);
            int max_len = s->serial ? 20 : 255 - 8;
            int id_len = strlen(str);
580

581
            if (id_len > max_len) {
582
                id_len = max_len;
583
            }
584 585 586 587 588 589 590
            DPRINTF("Inquiry EVPD[Device identification] "
                    "buffer size %zd\n", req->cmd.xfer);

            outbuf[buflen++] = 0x2; // ASCII
            outbuf[buflen++] = 0;   // not officially assigned
            outbuf[buflen++] = 0;   // reserved
            outbuf[buflen++] = id_len; // length of data following
591
            memcpy(outbuf+buflen, str, id_len);
592
            buflen += id_len;
593 594 595 596 597 598 599 600 601

            if (s->wwn) {
                outbuf[buflen++] = 0x1; // Binary
                outbuf[buflen++] = 0x3; // NAA
                outbuf[buflen++] = 0;   // reserved
                outbuf[buflen++] = 8;
                stq_be_p(&outbuf[buflen], s->wwn);
                buflen += 8;
            }
602 603
            break;
        }
604
        case 0xb0: /* block limits */
C
Christoph Hellwig 已提交
605
        {
606 607
            unsigned int unmap_sectors =
                    s->qdev.conf.discard_granularity / s->qdev.blocksize;
608 609 610 611
            unsigned int min_io_size =
                    s->qdev.conf.min_io_size / s->qdev.blocksize;
            unsigned int opt_io_size =
                    s->qdev.conf.opt_io_size / s->qdev.blocksize;
C
Christoph Hellwig 已提交
612

H
Hannes Reinecke 已提交
613
            if (s->qdev.type == TYPE_ROM) {
H
Hannes Reinecke 已提交
614 615 616 617
                DPRINTF("Inquiry (EVPD[%02X] not supported for CDROM\n",
                        page_code);
                return -1;
            }
C
Christoph Hellwig 已提交
618
            /* required VPD size with unmap support */
619
            buflen = 0x40;
C
Christoph Hellwig 已提交
620 621 622 623 624 625 626 627 628 629 630
            memset(outbuf + 4, 0, buflen - 4);

            /* optimal transfer length granularity */
            outbuf[6] = (min_io_size >> 8) & 0xff;
            outbuf[7] = min_io_size & 0xff;

            /* optimal transfer length */
            outbuf[12] = (opt_io_size >> 24) & 0xff;
            outbuf[13] = (opt_io_size >> 16) & 0xff;
            outbuf[14] = (opt_io_size >> 8) & 0xff;
            outbuf[15] = opt_io_size & 0xff;
631 632 633 634 635 636 637 638 639 640

            /* optimal unmap granularity */
            outbuf[28] = (unmap_sectors >> 24) & 0xff;
            outbuf[29] = (unmap_sectors >> 16) & 0xff;
            outbuf[30] = (unmap_sectors >> 8) & 0xff;
            outbuf[31] = unmap_sectors & 0xff;
            break;
        }
        case 0xb2: /* thin provisioning */
        {
641
            buflen = 8;
642
            outbuf[4] = 0;
643
            outbuf[5] = 0x60; /* write_same 10/16 supported */
644
            outbuf[6] = s->qdev.conf.discard_granularity ? 2 : 1;
645
            outbuf[7] = 0;
C
Christoph Hellwig 已提交
646 647
            break;
        }
648 649 650 651
        default:
            return -1;
        }
        /* done with EVPD */
652 653
        assert(buflen - start <= 255);
        outbuf[start - 1] = buflen - start;
654 655 656 657 658 659 660 661 662 663
        return buflen;
    }

    /* Standard INQUIRY data */
    if (req->cmd.buf[2] != 0) {
        return -1;
    }

    /* PAGE CODE == 0 */
    buflen = req->cmd.xfer;
664
    if (buflen > SCSI_MAX_INQUIRY_LEN) {
665
        buflen = SCSI_MAX_INQUIRY_LEN;
666
    }
667 668
    memset(outbuf, 0, buflen);

H
Hannes Reinecke 已提交
669
    outbuf[0] = s->qdev.type & 0x1f;
670
    outbuf[1] = (s->features & (1 << SCSI_DISK_F_REMOVABLE)) ? 0x80 : 0;
H
Hannes Reinecke 已提交
671
    if (s->qdev.type == TYPE_ROM) {
L
Laszlo Ast 已提交
672
        memcpy(&outbuf[16], "QEMU CD-ROM     ", 16);
673
    } else {
L
Laszlo Ast 已提交
674
        memcpy(&outbuf[16], "QEMU HARDDISK   ", 16);
675
    }
L
Laszlo Ast 已提交
676
    memcpy(&outbuf[8], "QEMU    ", 8);
G
Gerd Hoffmann 已提交
677
    memset(&outbuf[32], 0, 4);
678
    memcpy(&outbuf[32], s->version, MIN(4, strlen(s->version)));
679 680 681 682 683 684
    /*
     * We claim conformance to SPC-3, which is required for guests
     * to ask for modern features like READ CAPACITY(16) or the
     * block characteristics VPD page by default.  Not all of SPC-3
     * is actually implemented, but we're good enough.
     */
C
Christoph Hellwig 已提交
685
    outbuf[2] = 5;
686
    outbuf[3] = 2; /* Format 2 */
687 688 689 690 691 692 693 694 695

    if (buflen > 36) {
        outbuf[4] = buflen - 5; /* Additional Length = (Len - 1) - 4 */
    } else {
        /* If the allocation length of CDB is too small,
               the additional length is not adjusted */
        outbuf[4] = 36 - 5;
    }

696
    /* Sync data transfer and TCQ.  */
697
    outbuf[7] = 0x10 | (req->bus->info->tcq ? 0x02 : 0);
698 699 700
    return buflen;
}

701 702 703 704 705 706
static inline bool media_is_dvd(SCSIDiskState *s)
{
    uint64_t nb_sectors;
    if (s->qdev.type != TYPE_ROM) {
        return false;
    }
707
    if (!bdrv_is_inserted(s->qdev.conf.bs)) {
708 709
        return false;
    }
710
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
711 712 713
    return nb_sectors > CD_MAX_SECTORS;
}

714 715 716 717 718 719
static inline bool media_is_cd(SCSIDiskState *s)
{
    uint64_t nb_sectors;
    if (s->qdev.type != TYPE_ROM) {
        return false;
    }
720
    if (!bdrv_is_inserted(s->qdev.conf.bs)) {
721 722
        return false;
    }
723
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
724 725 726
    return nb_sectors <= CD_MAX_SECTORS;
}

727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759
static int scsi_read_disc_information(SCSIDiskState *s, SCSIDiskReq *r,
                                      uint8_t *outbuf)
{
    uint8_t type = r->req.cmd.buf[1] & 7;

    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }

    /* Types 1/2 are only defined for Blu-Ray.  */
    if (type != 0) {
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
        return -1;
    }

    memset(outbuf, 0, 34);
    outbuf[1] = 32;
    outbuf[2] = 0xe; /* last session complete, disc finalized */
    outbuf[3] = 1;   /* first track on disc */
    outbuf[4] = 1;   /* # of sessions */
    outbuf[5] = 1;   /* first track of last session */
    outbuf[6] = 1;   /* last track of last session */
    outbuf[7] = 0x20; /* unrestricted use */
    outbuf[8] = 0x00; /* CD-ROM or DVD-ROM */
    /* 9-10-11: most significant byte corresponding bytes 4-5-6 */
    /* 12-23: not meaningful for CD-ROM or DVD-ROM */
    /* 24-31: disc bar code */
    /* 32: disc application code */
    /* 33: number of OPC tables */

    return 34;
}

760 761 762
static int scsi_read_dvd_structure(SCSIDiskState *s, SCSIDiskReq *r,
                                   uint8_t *outbuf)
{
763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783
    static const int rds_caps_size[5] = {
        [0] = 2048 + 4,
        [1] = 4 + 4,
        [3] = 188 + 4,
        [4] = 2048 + 4,
    };

    uint8_t media = r->req.cmd.buf[1];
    uint8_t layer = r->req.cmd.buf[6];
    uint8_t format = r->req.cmd.buf[7];
    int size = -1;

    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }
    if (media != 0) {
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
        return -1;
    }

    if (format != 0xff) {
784
        if (s->tray_open || !bdrv_is_inserted(s->qdev.conf.bs)) {
785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805
            scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
            return -1;
        }
        if (media_is_cd(s)) {
            scsi_check_condition(r, SENSE_CODE(INCOMPATIBLE_FORMAT));
            return -1;
        }
        if (format >= ARRAY_SIZE(rds_caps_size)) {
            return -1;
        }
        size = rds_caps_size[format];
        memset(outbuf, 0, size);
    }

    switch (format) {
    case 0x00: {
        /* Physical format information */
        uint64_t nb_sectors;
        if (layer != 0) {
            goto fail;
        }
806
        bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850

        outbuf[4] = 1;   /* DVD-ROM, part version 1 */
        outbuf[5] = 0xf; /* 120mm disc, minimum rate unspecified */
        outbuf[6] = 1;   /* one layer, read-only (per MMC-2 spec) */
        outbuf[7] = 0;   /* default densities */

        stl_be_p(&outbuf[12], (nb_sectors >> 2) - 1); /* end sector */
        stl_be_p(&outbuf[16], (nb_sectors >> 2) - 1); /* l0 end sector */
        break;
    }

    case 0x01: /* DVD copyright information, all zeros */
        break;

    case 0x03: /* BCA information - invalid field for no BCA info */
        return -1;

    case 0x04: /* DVD disc manufacturing information, all zeros */
        break;

    case 0xff: { /* List capabilities */
        int i;
        size = 4;
        for (i = 0; i < ARRAY_SIZE(rds_caps_size); i++) {
            if (!rds_caps_size[i]) {
                continue;
            }
            outbuf[size] = i;
            outbuf[size + 1] = 0x40; /* Not writable, readable */
            stw_be_p(&outbuf[size + 2], rds_caps_size[i]);
            size += 4;
        }
        break;
     }

    default:
        return -1;
    }

    /* Size of buffer, not including 2 byte size field */
    stw_be_p(outbuf, size - 2);
    return size;

fail:
851 852 853
    return -1;
}

854
static int scsi_event_status_media(SCSIDiskState *s, uint8_t *outbuf)
855
{
856 857 858 859 860
    uint8_t event_code, media_status;

    media_status = 0;
    if (s->tray_open) {
        media_status = MS_TRAY_OPEN;
861
    } else if (bdrv_is_inserted(s->qdev.conf.bs)) {
862 863 864 865 866
        media_status = MS_MEDIA_PRESENT;
    }

    /* Event notification descriptor */
    event_code = MEC_NO_CHANGE;
867 868 869 870 871 872 873 874
    if (media_status != MS_TRAY_OPEN) {
        if (s->media_event) {
            event_code = MEC_NEW_MEDIA;
            s->media_event = false;
        } else if (s->eject_request) {
            event_code = MEC_EJECT_REQUESTED;
            s->eject_request = false;
        }
875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910
    }

    outbuf[0] = event_code;
    outbuf[1] = media_status;

    /* These fields are reserved, just clear them. */
    outbuf[2] = 0;
    outbuf[3] = 0;
    return 4;
}

static int scsi_get_event_status_notification(SCSIDiskState *s, SCSIDiskReq *r,
                                              uint8_t *outbuf)
{
    int size;
    uint8_t *buf = r->req.cmd.buf;
    uint8_t notification_class_request = buf[4];
    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }
    if ((buf[1] & 1) == 0) {
        /* asynchronous */
        return -1;
    }

    size = 4;
    outbuf[0] = outbuf[1] = 0;
    outbuf[3] = 1 << GESN_MEDIA; /* supported events */
    if (notification_class_request & (1 << GESN_MEDIA)) {
        outbuf[2] = GESN_MEDIA;
        size += scsi_event_status_media(s, &outbuf[size]);
    } else {
        outbuf[2] = 0x80;
    }
    stw_be_p(outbuf, size - 4);
    return size;
911 912
}

913
static int scsi_get_configuration(SCSIDiskState *s, uint8_t *outbuf)
914
{
915 916
    int current;

917 918 919
    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }
920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944
    current = media_is_dvd(s) ? MMC_PROFILE_DVD_ROM : MMC_PROFILE_CD_ROM;
    memset(outbuf, 0, 40);
    stl_be_p(&outbuf[0], 36); /* Bytes after the data length field */
    stw_be_p(&outbuf[6], current);
    /* outbuf[8] - outbuf[19]: Feature 0 - Profile list */
    outbuf[10] = 0x03; /* persistent, current */
    outbuf[11] = 8; /* two profiles */
    stw_be_p(&outbuf[12], MMC_PROFILE_DVD_ROM);
    outbuf[14] = (current == MMC_PROFILE_DVD_ROM);
    stw_be_p(&outbuf[16], MMC_PROFILE_CD_ROM);
    outbuf[18] = (current == MMC_PROFILE_CD_ROM);
    /* outbuf[20] - outbuf[31]: Feature 1 - Core feature */
    stw_be_p(&outbuf[20], 1);
    outbuf[22] = 0x08 | 0x03; /* version 2, persistent, current */
    outbuf[23] = 8;
    stl_be_p(&outbuf[24], 1); /* SCSI */
    outbuf[28] = 1; /* DBE = 1, mandatory */
    /* outbuf[32] - outbuf[39]: Feature 3 - Removable media feature */
    stw_be_p(&outbuf[32], 3);
    outbuf[34] = 0x08 | 0x03; /* version 2, persistent, current */
    outbuf[35] = 4;
    outbuf[36] = 0x39; /* tray, load=1, eject=1, unlocked at powerup, lock=1 */
    /* TODO: Random readable, CD read, DVD read, drive serial number,
       power management */
    return 40;
945 946 947 948 949 950 951 952 953 954 955 956
}

static int scsi_emulate_mechanism_status(SCSIDiskState *s, uint8_t *outbuf)
{
    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }
    memset(outbuf, 0, 8);
    outbuf[5] = 1; /* CD-ROM */
    return 8;
}

957
static int mode_sense_page(SCSIDiskState *s, int page, uint8_t **p_outbuf,
958
                           int page_control)
959
{
960 961 962 963
    static const int mode_sense_valid[0x3f] = {
        [MODE_PAGE_HD_GEOMETRY]            = (1 << TYPE_DISK),
        [MODE_PAGE_FLEXIBLE_DISK_GEOMETRY] = (1 << TYPE_DISK),
        [MODE_PAGE_CACHING]                = (1 << TYPE_DISK) | (1 << TYPE_ROM),
964 965
        [MODE_PAGE_R_W_ERROR]              = (1 << TYPE_DISK) | (1 << TYPE_ROM),
        [MODE_PAGE_AUDIO_CTL]              = (1 << TYPE_ROM),
966 967 968
        [MODE_PAGE_CAPABILITIES]           = (1 << TYPE_ROM),
    };

969
    BlockDriverState *bdrv = s->qdev.conf.bs;
970
    int cylinders, heads, secs;
971
    uint8_t *p = *p_outbuf;
972

973 974 975 976 977 978
    if ((mode_sense_valid[page] & (1 << s->qdev.type)) == 0) {
        return -1;
    }

    p[0] = page;

979 980 981 982 983 984
    /*
     * If Changeable Values are requested, a mask denoting those mode parameters
     * that are changeable shall be returned. As we currently don't support
     * parameter changes via MODE_SELECT all bits are returned set to zero.
     * The buffer was already menset to zero by the caller of this function.
     */
985
    switch (page) {
986
    case MODE_PAGE_HD_GEOMETRY:
987
        p[1] = 0x16;
988
        if (page_control == 1) { /* Changeable Values */
989
            break;
990
        }
991
        /* if a geometry hint is available, use it */
P
Paolo Bonzini 已提交
992
        bdrv_guess_geometry(bdrv, &cylinders, &heads, &secs);
993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
        p[2] = (cylinders >> 16) & 0xff;
        p[3] = (cylinders >> 8) & 0xff;
        p[4] = cylinders & 0xff;
        p[5] = heads & 0xff;
        /* Write precomp start cylinder, disabled */
        p[6] = (cylinders >> 16) & 0xff;
        p[7] = (cylinders >> 8) & 0xff;
        p[8] = cylinders & 0xff;
        /* Reduced current start cylinder, disabled */
        p[9] = (cylinders >> 16) & 0xff;
        p[10] = (cylinders >> 8) & 0xff;
        p[11] = cylinders & 0xff;
        /* Device step rate [ns], 200ns */
        p[12] = 0;
        p[13] = 200;
        /* Landing zone cylinder */
        p[14] = 0xff;
        p[15] =  0xff;
        p[16] = 0xff;
        /* Medium rotation rate [rpm], 5400 rpm */
        p[20] = (5400 >> 8) & 0xff;
        p[21] = 5400 & 0xff;
1015
        break;
1016

1017
    case MODE_PAGE_FLEXIBLE_DISK_GEOMETRY:
1018
        p[1] = 0x1e;
1019
        if (page_control == 1) { /* Changeable Values */
1020
            break;
1021
        }
1022 1023 1024 1025
        /* Transfer rate [kbit/s], 5Mbit/s */
        p[2] = 5000 >> 8;
        p[3] = 5000 & 0xff;
        /* if a geometry hint is available, use it */
P
Paolo Bonzini 已提交
1026
        bdrv_guess_geometry(bdrv, &cylinders, &heads, &secs);
1027 1028
        p[4] = heads & 0xff;
        p[5] = secs & 0xff;
P
Paolo Bonzini 已提交
1029
        p[6] = s->qdev.blocksize >> 8;
1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052
        p[8] = (cylinders >> 8) & 0xff;
        p[9] = cylinders & 0xff;
        /* Write precomp start cylinder, disabled */
        p[10] = (cylinders >> 8) & 0xff;
        p[11] = cylinders & 0xff;
        /* Reduced current start cylinder, disabled */
        p[12] = (cylinders >> 8) & 0xff;
        p[13] = cylinders & 0xff;
        /* Device step rate [100us], 100us */
        p[14] = 0;
        p[15] = 1;
        /* Device step pulse width [us], 1us */
        p[16] = 1;
        /* Device head settle delay [100us], 100us */
        p[17] = 0;
        p[18] = 1;
        /* Motor on delay [0.1s], 0.1s */
        p[19] = 1;
        /* Motor off delay [0.1s], 0.1s */
        p[20] = 1;
        /* Medium rotation rate [rpm], 5400 rpm */
        p[28] = (5400 >> 8) & 0xff;
        p[29] = 5400 & 0xff;
1053
        break;
1054

1055
    case MODE_PAGE_CACHING:
1056 1057
        p[0] = 8;
        p[1] = 0x12;
1058
        if (page_control == 1) { /* Changeable Values */
1059
            break;
1060
        }
1061
        if (bdrv_enable_write_cache(s->qdev.conf.bs)) {
1062 1063
            p[2] = 4; /* WCE */
        }
1064
        break;
1065

1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077
    case MODE_PAGE_R_W_ERROR:
        p[1] = 10;
        p[2] = 0x80; /* Automatic Write Reallocation Enabled */
        if (s->qdev.type == TYPE_ROM) {
            p[3] = 0x20; /* Read Retry Count */
        }
        break;

    case MODE_PAGE_AUDIO_CTL:
        p[1] = 14;
        break;

1078
    case MODE_PAGE_CAPABILITIES:
1079
        p[1] = 0x14;
1080
        if (page_control == 1) { /* Changeable Values */
1081
            break;
1082
        }
1083 1084 1085

        p[2] = 0x3b; /* CD-R & CD-RW read */
        p[3] = 0; /* Writing not supported */
1086 1087 1088 1089 1090
        p[4] = 0x7f; /* Audio, composite, digital out,
                        mode 2 form 1&2, multi session */
        p[5] = 0xff; /* CD DA, DA accurate, RW supported,
                        RW corrected, C2 errors, ISRC,
                        UPC, Bar code */
1091
        p[6] = 0x2d | (s->tray_locked ? 2 : 0);
1092 1093 1094
        /* Locking supported, jumper present, eject, tray */
        p[7] = 0; /* no volume & mute control, no
                     changer */
1095
        p[8] = (50 * 176) >> 8; /* 50x read speed */
1096
        p[9] = (50 * 176) & 0xff;
1097 1098 1099
        p[10] = 2 >> 8; /* Two volume levels */
        p[11] = 2 & 0xff;
        p[12] = 2048 >> 8; /* 2M buffer */
1100
        p[13] = 2048 & 0xff;
1101
        p[14] = (16 * 176) >> 8; /* 16x read speed current */
1102
        p[15] = (16 * 176) & 0xff;
1103
        p[18] = (16 * 176) >> 8; /* 16x write speed */
1104
        p[19] = (16 * 176) & 0xff;
1105
        p[20] = (16 * 176) >> 8; /* 16x write speed current */
1106
        p[21] = (16 * 176) & 0xff;
1107
        break;
1108 1109

    default:
1110
        return -1;
1111
    }
1112 1113 1114

    *p_outbuf += p[1] + 2;
    return p[1] + 2;
1115 1116
}

1117
static int scsi_disk_emulate_mode_sense(SCSIDiskReq *r, uint8_t *outbuf)
1118
{
1119
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1120
    uint64_t nb_sectors;
1121 1122
    bool dbd;
    int page, buflen, ret, page_control;
1123
    uint8_t *p;
1124
    uint8_t dev_specific_param;
1125

1126
    dbd = (r->req.cmd.buf[1] & 0x8) != 0;
1127 1128
    page = r->req.cmd.buf[2] & 0x3f;
    page_control = (r->req.cmd.buf[2] & 0xc0) >> 6;
1129
    DPRINTF("Mode Sense(%d) (page %d, xfer %zd, page_control %d)\n",
1130 1131
        (r->req.cmd.buf[0] == MODE_SENSE) ? 6 : 10, page, r->req.cmd.xfer, page_control);
    memset(outbuf, 0, r->req.cmd.xfer);
1132 1133
    p = outbuf;

1134
    if (s->qdev.type == TYPE_DISK) {
P
Paolo Bonzini 已提交
1135
        dev_specific_param = s->features & (1 << SCSI_DISK_F_DPOFUA) ? 0x10 : 0;
1136 1137 1138
        if (bdrv_is_read_only(s->qdev.conf.bs)) {
            dev_specific_param |= 0x80; /* Readonly.  */
        }
1139
    } else {
1140 1141
        /* MMC prescribes that CD/DVD drives have no block descriptors,
         * and defines no device-specific parameter.  */
P
Paolo Bonzini 已提交
1142
        dev_specific_param = 0x00;
1143
        dbd = true;
1144 1145
    }

1146
    if (r->req.cmd.buf[0] == MODE_SENSE) {
1147 1148 1149 1150 1151 1152 1153 1154 1155
        p[1] = 0; /* Default media type.  */
        p[2] = dev_specific_param;
        p[3] = 0; /* Block descriptor length.  */
        p += 4;
    } else { /* MODE_SENSE_10 */
        p[2] = 0; /* Default media type.  */
        p[3] = dev_specific_param;
        p[6] = p[7] = 0; /* Block descriptor length.  */
        p += 8;
1156 1157
    }

1158
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1159
    if (!dbd && nb_sectors) {
1160
        if (r->req.cmd.buf[0] == MODE_SENSE) {
1161 1162 1163 1164
            outbuf[3] = 8; /* Block descriptor length  */
        } else { /* MODE_SENSE_10 */
            outbuf[7] = 8; /* Block descriptor length  */
        }
P
Paolo Bonzini 已提交
1165
        nb_sectors /= (s->qdev.blocksize / 512);
1166
        if (nb_sectors > 0xffffff) {
1167
            nb_sectors = 0;
1168
        }
1169 1170 1171 1172 1173 1174
        p[0] = 0; /* media density code */
        p[1] = (nb_sectors >> 16) & 0xff;
        p[2] = (nb_sectors >> 8) & 0xff;
        p[3] = nb_sectors & 0xff;
        p[4] = 0; /* reserved */
        p[5] = 0; /* bytes 5-7 are the sector size in bytes */
P
Paolo Bonzini 已提交
1175
        p[6] = s->qdev.blocksize >> 8;
1176 1177 1178 1179
        p[7] = 0;
        p += 8;
    }

1180 1181 1182 1183
    if (page_control == 3) {
        /* Saved Values */
        scsi_check_condition(r, SENSE_CODE(SAVING_PARAMS_NOT_SUPPORTED));
        return -1;
1184 1185
    }

1186 1187 1188 1189 1190 1191 1192 1193 1194
    if (page == 0x3f) {
        for (page = 0; page <= 0x3e; page++) {
            mode_sense_page(s, page, &p, page_control);
        }
    } else {
        ret = mode_sense_page(s, page, &p, page_control);
        if (ret == -1) {
            return -1;
        }
1195 1196 1197
    }

    buflen = p - outbuf;
1198 1199 1200 1201 1202
    /*
     * The mode data length field specifies the length in bytes of the
     * following data that is available to be transferred. The mode data
     * length does not include itself.
     */
1203
    if (r->req.cmd.buf[0] == MODE_SENSE) {
1204 1205 1206 1207 1208
        outbuf[0] = buflen - 1;
    } else { /* MODE_SENSE_10 */
        outbuf[0] = ((buflen - 2) >> 8) & 0xff;
        outbuf[1] = (buflen - 2) & 0xff;
    }
1209 1210 1211
    return buflen;
}

1212 1213 1214 1215 1216 1217 1218 1219 1220
static int scsi_disk_emulate_read_toc(SCSIRequest *req, uint8_t *outbuf)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
    int start_track, format, msf, toclen;
    uint64_t nb_sectors;

    msf = req->cmd.buf[1] & 2;
    format = req->cmd.buf[2] & 0xf;
    start_track = req->cmd.buf[6];
1221
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1222
    DPRINTF("Read TOC (track %d format %d msf %d)\n", start_track, format, msf >> 1);
P
Paolo Bonzini 已提交
1223
    nb_sectors /= s->qdev.blocksize / 512;
1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244
    switch (format) {
    case 0:
        toclen = cdrom_read_toc(nb_sectors, outbuf, msf, start_track);
        break;
    case 1:
        /* multi session : only a single session defined */
        toclen = 12;
        memset(outbuf, 0, 12);
        outbuf[1] = 0x0a;
        outbuf[2] = 0x01;
        outbuf[3] = 0x01;
        break;
    case 2:
        toclen = cdrom_read_toc_raw(nb_sectors, outbuf, msf, start_track);
        break;
    default:
        return -1;
    }
    return toclen;
}

1245
static int scsi_disk_emulate_start_stop(SCSIDiskReq *r)
1246 1247 1248 1249 1250 1251 1252
{
    SCSIRequest *req = &r->req;
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
    bool start = req->cmd.buf[4] & 1;
    bool loej = req->cmd.buf[4] & 2; /* load on start, eject on !start */

    if (s->qdev.type == TYPE_ROM && loej) {
1253 1254
        if (!start && !s->tray_open && s->tray_locked) {
            scsi_check_condition(r,
1255
                                 bdrv_is_inserted(s->qdev.conf.bs)
1256 1257 1258
                                 ? SENSE_CODE(ILLEGAL_REQ_REMOVAL_PREVENTED)
                                 : SENSE_CODE(NOT_READY_REMOVAL_PREVENTED));
            return -1;
1259
        }
1260 1261 1262 1263 1264

        if (s->tray_open != !start) {
            bdrv_eject(s->qdev.conf.bs, !start);
            s->tray_open = !start;
        }
1265
    }
1266
    return 0;
1267 1268
}

1269
static int scsi_disk_emulate_command(SCSIDiskReq *r)
1270
{
1271
    SCSIRequest *req = &r->req;
1272 1273
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
    uint64_t nb_sectors;
1274
    uint8_t *outbuf;
1275 1276
    int buflen = 0;

1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289
    if (!r->iov.iov_base) {
        /*
         * FIXME: we shouldn't return anything bigger than 4k, but the code
         * requires the buffer to be as big as req->cmd.xfer in several
         * places.  So, do not allow CDBs with a very large ALLOCATION
         * LENGTH.  The real fix would be to modify scsi_read_data and
         * dma_buf_read, so that they return data beyond the buflen
         * as all zeros.
         */
        if (req->cmd.xfer > 65536) {
            goto illegal_request;
        }
        r->buflen = MAX(4096, req->cmd.xfer);
1290
        r->iov.iov_base = qemu_blockalign(s->qdev.conf.bs, r->buflen);
1291 1292 1293
    }

    outbuf = r->iov.iov_base;
1294 1295
    switch (req->cmd.buf[0]) {
    case TEST_UNIT_READY:
1296
        assert(!s->tray_open && bdrv_is_inserted(s->qdev.conf.bs));
H
Hannes Reinecke 已提交
1297
        break;
1298 1299
    case INQUIRY:
        buflen = scsi_disk_emulate_inquiry(req, outbuf);
1300
        if (buflen < 0) {
1301
            goto illegal_request;
1302
        }
H
Hannes Reinecke 已提交
1303
        break;
1304 1305
    case MODE_SENSE:
    case MODE_SENSE_10:
1306
        buflen = scsi_disk_emulate_mode_sense(r, outbuf);
1307
        if (buflen < 0) {
1308
            goto illegal_request;
1309
        }
1310
        break;
1311 1312
    case READ_TOC:
        buflen = scsi_disk_emulate_read_toc(req, outbuf);
1313
        if (buflen < 0) {
1314
            goto illegal_request;
1315
        }
1316
        break;
1317
    case RESERVE:
1318
        if (req->cmd.buf[1] & 1) {
1319
            goto illegal_request;
1320
        }
1321 1322
        break;
    case RESERVE_10:
1323
        if (req->cmd.buf[1] & 3) {
1324
            goto illegal_request;
1325
        }
1326 1327
        break;
    case RELEASE:
1328
        if (req->cmd.buf[1] & 1) {
1329
            goto illegal_request;
1330
        }
1331 1332
        break;
    case RELEASE_10:
1333
        if (req->cmd.buf[1] & 3) {
1334
            goto illegal_request;
1335
        }
1336
        break;
1337
    case START_STOP:
1338 1339 1340
        if (scsi_disk_emulate_start_stop(r) < 0) {
            return -1;
        }
H
Hannes Reinecke 已提交
1341
        break;
1342
    case ALLOW_MEDIUM_REMOVAL:
1343
        s->tray_locked = req->cmd.buf[4] & 1;
1344
        bdrv_lock_medium(s->qdev.conf.bs, req->cmd.buf[4] & 1);
H
Hannes Reinecke 已提交
1345
        break;
1346
    case READ_CAPACITY_10:
1347
        /* The normal LEN field for this command is zero.  */
H
Hannes Reinecke 已提交
1348
        memset(outbuf, 0, 8);
1349
        bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1350
        if (!nb_sectors) {
1351 1352
            scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
            return -1;
1353
        }
1354 1355 1356
        if ((req->cmd.buf[8] & 1) == 0 && req->cmd.lba) {
            goto illegal_request;
        }
P
Paolo Bonzini 已提交
1357
        nb_sectors /= s->qdev.blocksize / 512;
1358 1359 1360
        /* Returned value is the address of the last sector.  */
        nb_sectors--;
        /* Remember the new size for read/write sanity checking. */
P
Paolo Bonzini 已提交
1361
        s->qdev.max_lba = nb_sectors;
1362
        /* Clip to 2TB, instead of returning capacity modulo 2TB. */
1363
        if (nb_sectors > UINT32_MAX) {
1364
            nb_sectors = UINT32_MAX;
1365
        }
1366 1367 1368 1369 1370 1371
        outbuf[0] = (nb_sectors >> 24) & 0xff;
        outbuf[1] = (nb_sectors >> 16) & 0xff;
        outbuf[2] = (nb_sectors >> 8) & 0xff;
        outbuf[3] = nb_sectors & 0xff;
        outbuf[4] = 0;
        outbuf[5] = 0;
P
Paolo Bonzini 已提交
1372
        outbuf[6] = s->qdev.blocksize >> 8;
1373 1374
        outbuf[7] = 0;
        buflen = 8;
H
Hannes Reinecke 已提交
1375
        break;
1376 1377 1378 1379 1380
    case REQUEST_SENSE:
        /* Just return "NO SENSE".  */
        buflen = scsi_build_sense(NULL, 0, outbuf, r->buflen,
                                  (req->cmd.buf[1] & 1) == 0);
        break;
1381 1382 1383 1384 1385 1386
    case MECHANISM_STATUS:
        buflen = scsi_emulate_mechanism_status(s, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
1387
    case GET_CONFIGURATION:
1388
        buflen = scsi_get_configuration(s, outbuf);
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
    case GET_EVENT_STATUS_NOTIFICATION:
        buflen = scsi_get_event_status_notification(s, r, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
1399 1400 1401 1402 1403 1404
    case READ_DISC_INFORMATION:
        buflen = scsi_read_disc_information(s, r, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
1405 1406 1407 1408 1409
    case READ_DVD_STRUCTURE:
        buflen = scsi_read_dvd_structure(s, r, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
1410
        break;
1411
    case SERVICE_ACTION_IN_16:
1412
        /* Service Action In subcommands. */
1413
        if ((req->cmd.buf[1] & 31) == SAI_READ_CAPACITY_16) {
1414 1415
            DPRINTF("SAI READ CAPACITY(16)\n");
            memset(outbuf, 0, req->cmd.xfer);
1416
            bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1417
            if (!nb_sectors) {
1418 1419
                scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
                return -1;
1420
            }
1421 1422 1423
            if ((req->cmd.buf[14] & 1) == 0 && req->cmd.lba) {
                goto illegal_request;
            }
P
Paolo Bonzini 已提交
1424
            nb_sectors /= s->qdev.blocksize / 512;
1425 1426 1427
            /* Returned value is the address of the last sector.  */
            nb_sectors--;
            /* Remember the new size for read/write sanity checking. */
P
Paolo Bonzini 已提交
1428
            s->qdev.max_lba = nb_sectors;
1429 1430 1431 1432 1433 1434 1435 1436 1437 1438
            outbuf[0] = (nb_sectors >> 56) & 0xff;
            outbuf[1] = (nb_sectors >> 48) & 0xff;
            outbuf[2] = (nb_sectors >> 40) & 0xff;
            outbuf[3] = (nb_sectors >> 32) & 0xff;
            outbuf[4] = (nb_sectors >> 24) & 0xff;
            outbuf[5] = (nb_sectors >> 16) & 0xff;
            outbuf[6] = (nb_sectors >> 8) & 0xff;
            outbuf[7] = nb_sectors & 0xff;
            outbuf[8] = 0;
            outbuf[9] = 0;
P
Paolo Bonzini 已提交
1439
            outbuf[10] = s->qdev.blocksize >> 8;
1440
            outbuf[11] = 0;
C
Christoph Hellwig 已提交
1441 1442
            outbuf[12] = 0;
            outbuf[13] = get_physical_block_exp(&s->qdev.conf);
1443 1444 1445 1446 1447 1448

            /* set TPE bit if the format supports discard */
            if (s->qdev.conf.discard_granularity) {
                outbuf[14] = 0x80;
            }

1449 1450 1451 1452 1453 1454
            /* Protection, exponent and lowest lba field left blank. */
            buflen = req->cmd.xfer;
            break;
        }
        DPRINTF("Unsupported Service Action In\n");
        goto illegal_request;
1455
    default:
1456
        scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
1457
        return -1;
1458
    }
1459
    buflen = MIN(buflen, req->cmd.xfer);
1460 1461 1462
    return buflen;

illegal_request:
1463 1464 1465
    if (r->req.status == -1) {
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
    }
1466
    return -1;
1467 1468
}

P
pbrook 已提交
1469 1470 1471 1472 1473
/* Execute a scsi command.  Returns the length of the data expected by the
   command.  This will be Positive for data transfers from the device
   (eg. disk reads), negative for transfers to the device (eg. disk writes),
   and zero if the command does not transfer any data.  */

1474
static int32_t scsi_send_command(SCSIRequest *req, uint8_t *buf)
P
pbrook 已提交
1475
{
1476 1477
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
P
Paolo Bonzini 已提交
1478
    int32_t len;
P
pbrook 已提交
1479
    uint8_t command;
1480
    int rc;
P
pbrook 已提交
1481 1482

    command = buf[0];
1483
    DPRINTF("Command: lun=%d tag=0x%x data=0x%02x", req->lun, req->tag, buf[0]);
1484

P
pbrook 已提交
1485 1486 1487
#ifdef DEBUG_SCSI
    {
        int i;
1488
        for (i = 1; i < r->req.cmd.len; i++) {
P
pbrook 已提交
1489 1490 1491 1492 1493
            printf(" 0x%02x", buf[i]);
        }
        printf("\n");
    }
#endif
1494

1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518
    switch (command) {
    case INQUIRY:
    case MODE_SENSE:
    case MODE_SENSE_10:
    case RESERVE:
    case RESERVE_10:
    case RELEASE:
    case RELEASE_10:
    case START_STOP:
    case ALLOW_MEDIUM_REMOVAL:
    case GET_CONFIGURATION:
    case GET_EVENT_STATUS_NOTIFICATION:
    case MECHANISM_STATUS:
    case REQUEST_SENSE:
        break;

    default:
        if (s->tray_open || !bdrv_is_inserted(s->qdev.conf.bs)) {
            scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
            return 0;
        }
        break;
    }

P
pbrook 已提交
1519
    switch (command) {
1520
    case TEST_UNIT_READY:
1521
    case INQUIRY:
1522 1523
    case MODE_SENSE:
    case MODE_SENSE_10:
1524 1525 1526 1527
    case RESERVE:
    case RESERVE_10:
    case RELEASE:
    case RELEASE_10:
1528
    case START_STOP:
1529
    case ALLOW_MEDIUM_REMOVAL:
1530
    case READ_CAPACITY_10:
1531
    case READ_TOC:
1532
    case READ_DISC_INFORMATION:
1533
    case READ_DVD_STRUCTURE:
1534
    case GET_CONFIGURATION:
1535 1536
    case GET_EVENT_STATUS_NOTIFICATION:
    case MECHANISM_STATUS:
1537
    case SERVICE_ACTION_IN_16:
1538
    case REQUEST_SENSE:
1539
        rc = scsi_disk_emulate_command(r);
1540
        if (rc < 0) {
1541
            return 0;
1542
        }
1543 1544

        r->iov.iov_len = rc;
1545
        break;
1546
    case SYNCHRONIZE_CACHE:
1547 1548
        /* The request is used as the AIO opaque value, so add a ref.  */
        scsi_req_ref(&r->req);
1549 1550
        bdrv_acct_start(s->qdev.conf.bs, &r->acct, 0, BDRV_ACCT_FLUSH);
        r->req.aiocb = bdrv_aio_flush(s->qdev.conf.bs, scsi_flush_complete, r);
1551
        return 0;
1552 1553
    case READ_6:
    case READ_10:
G
Gerd Hoffmann 已提交
1554 1555
    case READ_12:
    case READ_16:
1556
        len = r->req.cmd.xfer / s->qdev.blocksize;
1557
        DPRINTF("Read (sector %" PRId64 ", count %d)\n", r->req.cmd.lba, len);
P
Paolo Bonzini 已提交
1558
        if (r->req.cmd.lba > s->qdev.max_lba) {
1559
            goto illegal_lba;
1560
        }
P
Paolo Bonzini 已提交
1561 1562
        r->sector = r->req.cmd.lba * (s->qdev.blocksize / 512);
        r->sector_count = len * (s->qdev.blocksize / 512);
P
pbrook 已提交
1563
        break;
1564 1565 1566
    case VERIFY_10:
    case VERIFY_12:
    case VERIFY_16:
1567 1568
    case WRITE_6:
    case WRITE_10:
G
Gerd Hoffmann 已提交
1569 1570
    case WRITE_12:
    case WRITE_16:
1571
    case WRITE_VERIFY_10:
1572 1573
    case WRITE_VERIFY_12:
    case WRITE_VERIFY_16:
1574
        len = r->req.cmd.xfer / s->qdev.blocksize;
1575
        DPRINTF("Write %s(sector %" PRId64 ", count %d)\n",
1576 1577
                (command & 0xe) == 0xe ? "And Verify " : "",
                r->req.cmd.lba, len);
P
Paolo Bonzini 已提交
1578
        if (r->req.cmd.lba > s->qdev.max_lba) {
1579
            goto illegal_lba;
1580
        }
P
Paolo Bonzini 已提交
1581 1582
        r->sector = r->req.cmd.lba * (s->qdev.blocksize / 512);
        r->sector_count = len * (s->qdev.blocksize / 512);
P
pbrook 已提交
1583
        break;
1584
    case MODE_SELECT:
1585
        DPRINTF("Mode Select(6) (len %lu)\n", (long)r->req.cmd.xfer);
1586 1587
        /* We don't support mode parameter changes.
           Allow the mode parameter header + block descriptors only. */
1588
        if (r->req.cmd.xfer > 12) {
1589 1590 1591 1592
            goto fail;
        }
        break;
    case MODE_SELECT_10:
1593
        DPRINTF("Mode Select(10) (len %lu)\n", (long)r->req.cmd.xfer);
1594 1595
        /* We don't support mode parameter changes.
           Allow the mode parameter header + block descriptors only. */
1596
        if (r->req.cmd.xfer > 16) {
1597 1598 1599 1600
            goto fail;
        }
        break;
    case SEEK_10:
P
Paolo Bonzini 已提交
1601
        DPRINTF("Seek(10) (sector %" PRId64 ")\n", r->req.cmd.lba);
P
Paolo Bonzini 已提交
1602
        if (r->req.cmd.lba > s->qdev.max_lba) {
1603 1604
            goto illegal_lba;
        }
1605
        break;
1606
    case WRITE_SAME_10:
1607 1608
        len = lduw_be_p(&buf[7]);
        goto write_same;
1609
    case WRITE_SAME_16:
1610 1611
        len = ldl_be_p(&buf[10]) & 0xffffffffULL;
    write_same:
1612

1613
        DPRINTF("WRITE SAME() (sector %" PRId64 ", count %d)\n",
1614 1615
                r->req.cmd.lba, len);

P
Paolo Bonzini 已提交
1616
        if (r->req.cmd.lba > s->qdev.max_lba) {
1617 1618 1619 1620 1621 1622 1623 1624 1625 1626
            goto illegal_lba;
        }

        /*
         * We only support WRITE SAME with the unmap bit set for now.
         */
        if (!(buf[1] & 0x8)) {
            goto fail;
        }

P
Paolo Bonzini 已提交
1627 1628 1629
        rc = bdrv_discard(s->qdev.conf.bs,
                          r->req.cmd.lba * (s->qdev.blocksize / 512),
                          len * (s->qdev.blocksize / 512));
1630 1631 1632 1633 1634
        if (rc < 0) {
            /* XXX: better error code ?*/
            goto fail;
        }

1635
        break;
P
pbrook 已提交
1636
    default:
1637
        DPRINTF("Unknown SCSI command (%2.2x)\n", buf[0]);
1638
        scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
1639
        return 0;
P
pbrook 已提交
1640
    fail:
1641
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
1642
        return 0;
1643
    illegal_lba:
1644
        scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
1645
        return 0;
P
pbrook 已提交
1646
    }
1647
    if (r->sector_count == 0 && r->iov.iov_len == 0) {
1648
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
1649
    }
1650
    len = r->sector_count * 512 + r->iov.iov_len;
1651 1652
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
        return -len;
P
pbrook 已提交
1653
    } else {
1654
        if (!r->sector_count) {
P
pbrook 已提交
1655
            r->sector_count = -1;
1656
        }
1657
        return len;
P
pbrook 已提交
1658 1659 1660
    }
}

J
Jan Kiszka 已提交
1661 1662 1663 1664 1665
static void scsi_disk_reset(DeviceState *dev)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev.qdev, dev);
    uint64_t nb_sectors;

1666
    scsi_device_purge_requests(&s->qdev, SENSE_CODE(RESET));
J
Jan Kiszka 已提交
1667

1668
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
P
Paolo Bonzini 已提交
1669
    nb_sectors /= s->qdev.blocksize / 512;
J
Jan Kiszka 已提交
1670 1671 1672
    if (nb_sectors) {
        nb_sectors--;
    }
P
Paolo Bonzini 已提交
1673
    s->qdev.max_lba = nb_sectors;
J
Jan Kiszka 已提交
1674 1675 1676 1677 1678 1679
}

static void scsi_destroy(SCSIDevice *dev)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);

1680
    scsi_device_purge_requests(&s->qdev, SENSE_CODE(NO_SENSE));
1681
    blockdev_mark_auto_del(s->qdev.conf.bs);
G
Gerd Hoffmann 已提交
1682 1683
}

1684
static void scsi_cd_change_media_cb(void *opaque, bool load)
1685
{
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700
    SCSIDiskState *s = opaque;

    /*
     * When a CD gets changed, we have to report an ejected state and
     * then a loaded state to guests so that they detect tray
     * open/close and media change events.  Guests that do not use
     * GET_EVENT_STATUS_NOTIFICATION to detect such tray open/close
     * states rely on this behavior.
     *
     * media_changed governs the state machine used for unit attention
     * report.  media_event is used by GET EVENT STATUS NOTIFICATION.
     */
    s->media_changed = load;
    s->tray_open = !load;
    s->qdev.unit_attention = SENSE_CODE(UNIT_ATTENTION_NO_MEDIUM);
1701
    s->media_event = true;
1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712
    s->eject_request = false;
}

static void scsi_cd_eject_request_cb(void *opaque, bool force)
{
    SCSIDiskState *s = opaque;

    s->eject_request = true;
    if (force) {
        s->tray_locked = false;
    }
1713 1714
}

1715 1716 1717 1718 1719
static bool scsi_cd_is_tray_open(void *opaque)
{
    return ((SCSIDiskState *)opaque)->tray_open;
}

1720 1721 1722 1723 1724 1725
static bool scsi_cd_is_medium_locked(void *opaque)
{
    return ((SCSIDiskState *)opaque)->tray_locked;
}

static const BlockDevOps scsi_cd_block_ops = {
1726
    .change_media_cb = scsi_cd_change_media_cb,
1727
    .eject_request_cb = scsi_cd_eject_request_cb,
1728
    .is_tray_open = scsi_cd_is_tray_open,
1729 1730 1731
    .is_medium_locked = scsi_cd_is_medium_locked,
};

1732 1733 1734 1735 1736 1737 1738 1739 1740
static void scsi_disk_unit_attention_reported(SCSIDevice *dev)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
    if (s->media_changed) {
        s->media_changed = false;
        s->qdev.unit_attention = SENSE_CODE(MEDIUM_CHANGED);
    }
}

1741
static int scsi_initfn(SCSIDevice *dev)
P
pbrook 已提交
1742
{
1743
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
1744
    DriveInfo *dinfo;
P
pbrook 已提交
1745

1746
    if (!s->qdev.conf.bs) {
1747
        error_report("drive property not set");
1748 1749 1750
        return -1;
    }

1751 1752
    if (!(s->features & (1 << SCSI_DISK_F_REMOVABLE)) &&
        !bdrv_is_inserted(s->qdev.conf.bs)) {
1753 1754 1755 1756
        error_report("Device needs media, but drive is empty");
        return -1;
    }

1757
    if (!s->serial) {
1758
        /* try to fall back to value set with legacy -drive serial=... */
1759
        dinfo = drive_get_by_blockdev(s->qdev.conf.bs);
1760
        if (*dinfo->serial) {
1761
            s->serial = g_strdup(dinfo->serial);
1762
        }
1763 1764
    }

1765
    if (!s->version) {
1766
        s->version = g_strdup(qemu_get_version());
1767 1768
    }

1769
    if (bdrv_is_sg(s->qdev.conf.bs)) {
1770
        error_report("unwanted /dev/sg*");
1771 1772 1773
        return -1;
    }

1774
    if (s->features & (1 << SCSI_DISK_F_REMOVABLE)) {
1775
        bdrv_set_dev_ops(s->qdev.conf.bs, &scsi_cd_block_ops, s);
P
pbrook 已提交
1776
    }
1777
    bdrv_set_buffer_alignment(s->qdev.conf.bs, s->qdev.blocksize);
1778

1779
    bdrv_iostatus_enable(s->qdev.conf.bs);
P
Paolo Bonzini 已提交
1780
    add_boot_device_path(s->qdev.conf.bootindex, &dev->qdev, NULL);
1781 1782 1783
    return 0;
}

1784 1785
static int scsi_hd_initfn(SCSIDevice *dev)
{
1786 1787 1788 1789
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
    s->qdev.blocksize = s->qdev.conf.logical_block_size;
    s->qdev.type = TYPE_DISK;
    return scsi_initfn(&s->qdev);
1790 1791 1792 1793
}

static int scsi_cd_initfn(SCSIDevice *dev)
{
1794 1795 1796
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
    s->qdev.blocksize = 2048;
    s->qdev.type = TYPE_ROM;
1797
    s->features |= 1 << SCSI_DISK_F_REMOVABLE;
1798
    return scsi_initfn(&s->qdev);
1799 1800 1801 1802
}

static int scsi_disk_initfn(SCSIDevice *dev)
{
1803
    DriveInfo *dinfo;
1804 1805

    if (!dev->conf.bs) {
1806
        return scsi_initfn(dev);  /* ... and die there */
1807 1808
    }

1809 1810 1811 1812 1813 1814
    dinfo = drive_get_by_blockdev(dev->conf.bs);
    if (dinfo->media_cd) {
        return scsi_cd_initfn(dev);
    } else {
        return scsi_hd_initfn(dev);
    }
1815 1816
}

P
Paolo Bonzini 已提交
1817
static const SCSIReqOps scsi_disk_reqops = {
P
Paolo Bonzini 已提交
1818
    .size         = sizeof(SCSIDiskReq),
1819 1820 1821 1822 1823 1824
    .free_req     = scsi_free_request,
    .send_command = scsi_send_command,
    .read_data    = scsi_read_data,
    .write_data   = scsi_write_data,
    .cancel_io    = scsi_cancel_io,
    .get_buf      = scsi_get_buf,
P
Paolo Bonzini 已提交
1825 1826
    .load_request = scsi_disk_load_request,
    .save_request = scsi_disk_save_request,
P
Paolo Bonzini 已提交
1827 1828
};

P
Paolo Bonzini 已提交
1829 1830
static SCSIRequest *scsi_new_request(SCSIDevice *d, uint32_t tag, uint32_t lun,
                                     uint8_t *buf, void *hba_private)
P
Paolo Bonzini 已提交
1831 1832 1833 1834 1835 1836 1837 1838
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, d);
    SCSIRequest *req;

    req = scsi_req_alloc(&scsi_disk_reqops, &s->qdev, tag, lun, hba_private);
    return req;
}

1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869
#ifdef __linux__
static int get_device_type(SCSIDiskState *s)
{
    BlockDriverState *bdrv = s->qdev.conf.bs;
    uint8_t cmd[16];
    uint8_t buf[36];
    uint8_t sensebuf[8];
    sg_io_hdr_t io_header;
    int ret;

    memset(cmd, 0, sizeof(cmd));
    memset(buf, 0, sizeof(buf));
    cmd[0] = INQUIRY;
    cmd[4] = sizeof(buf);

    memset(&io_header, 0, sizeof(io_header));
    io_header.interface_id = 'S';
    io_header.dxfer_direction = SG_DXFER_FROM_DEV;
    io_header.dxfer_len = sizeof(buf);
    io_header.dxferp = buf;
    io_header.cmdp = cmd;
    io_header.cmd_len = sizeof(cmd);
    io_header.mx_sb_len = sizeof(sensebuf);
    io_header.sbp = sensebuf;
    io_header.timeout = 6000; /* XXX */

    ret = bdrv_ioctl(bdrv, SG_IO, &io_header);
    if (ret < 0 || io_header.driver_status || io_header.host_status) {
        return -1;
    }
    s->qdev.type = buf[0];
1870 1871 1872
    if (buf[1] & 0x80) {
        s->features |= 1 << SCSI_DISK_F_REMOVABLE;
    }
1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923
    return 0;
}

static int scsi_block_initfn(SCSIDevice *dev)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
    int sg_version;
    int rc;

    if (!s->qdev.conf.bs) {
        error_report("scsi-block: drive property not set");
        return -1;
    }

    /* check we are using a driver managing SG_IO (version 3 and after) */
    if (bdrv_ioctl(s->qdev.conf.bs, SG_GET_VERSION_NUM, &sg_version) < 0 ||
        sg_version < 30000) {
        error_report("scsi-block: scsi generic interface too old");
        return -1;
    }

    /* get device type from INQUIRY data */
    rc = get_device_type(s);
    if (rc < 0) {
        error_report("scsi-block: INQUIRY failed");
        return -1;
    }

    /* Make a guess for the block size, we'll fix it when the guest sends.
     * READ CAPACITY.  If they don't, they likely would assume these sizes
     * anyway. (TODO: check in /sys).
     */
    if (s->qdev.type == TYPE_ROM || s->qdev.type == TYPE_WORM) {
        s->qdev.blocksize = 2048;
    } else {
        s->qdev.blocksize = 512;
    }
    return scsi_initfn(&s->qdev);
}

static SCSIRequest *scsi_block_new_request(SCSIDevice *d, uint32_t tag,
                                           uint32_t lun, uint8_t *buf,
                                           void *hba_private)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, d);

    switch (buf[0]) {
    case READ_6:
    case READ_10:
    case READ_12:
    case READ_16:
1924 1925 1926
    case VERIFY_10:
    case VERIFY_12:
    case VERIFY_16:
1927 1928 1929 1930 1931 1932 1933
    case WRITE_6:
    case WRITE_10:
    case WRITE_12:
    case WRITE_16:
    case WRITE_VERIFY_10:
    case WRITE_VERIFY_12:
    case WRITE_VERIFY_16:
1934 1935 1936 1937 1938
        /* If we are not using O_DIRECT, we might read stale data from the
	 * host cache if writes were made using other commands than these
	 * ones (such as WRITE SAME or EXTENDED COPY, etc.).  So, without
	 * O_DIRECT everything must go through SG_IO.
         */
1939
        if (bdrv_get_flags(s->qdev.conf.bs) & BDRV_O_NOCACHE) {
1940 1941 1942
            break;
        }

1943 1944 1945 1946 1947 1948 1949 1950 1951 1952
        /* MMC writing cannot be done via pread/pwrite, because it sometimes
         * involves writing beyond the maximum LBA or to negative LBA (lead-in).
         * And once you do these writes, reading from the block device is
         * unreliable, too.  It is even possible that reads deliver random data
         * from the host page cache (this is probably a Linux bug).
         *
         * We might use scsi_disk_reqops as long as no writing commands are
         * seen, but performance usually isn't paramount on optical media.  So,
         * just make scsi-block operate the same as scsi-generic for them.
         */
1953 1954 1955 1956 1957
        if (s->qdev.type == TYPE_ROM) {
            break;
	}
        return scsi_req_alloc(&scsi_disk_reqops, &s->qdev, tag, lun,
                              hba_private);
1958 1959 1960 1961 1962 1963 1964
    }

    return scsi_req_alloc(&scsi_generic_req_ops, &s->qdev, tag, lun,
                          hba_private);
}
#endif

1965 1966 1967 1968 1969
#define DEFINE_SCSI_DISK_PROPERTIES()                           \
    DEFINE_BLOCK_PROPERTIES(SCSIDiskState, qdev.conf),          \
    DEFINE_PROP_STRING("ver",  SCSIDiskState, version),         \
    DEFINE_PROP_STRING("serial",  SCSIDiskState, serial)

1970 1971
static Property scsi_hd_properties[] = {
    DEFINE_SCSI_DISK_PROPERTIES(),
1972 1973
    DEFINE_PROP_BIT("removable", SCSIDiskState, features,
                    SCSI_DISK_F_REMOVABLE, false),
P
Paolo Bonzini 已提交
1974 1975
    DEFINE_PROP_BIT("dpofua", SCSIDiskState, features,
                    SCSI_DISK_F_DPOFUA, false),
1976
    DEFINE_PROP_HEX64("wwn", SCSIDiskState, wwn, 0),
1977 1978 1979
    DEFINE_PROP_END_OF_LIST(),
};

P
Paolo Bonzini 已提交
1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995
static const VMStateDescription vmstate_scsi_disk_state = {
    .name = "scsi-disk",
    .version_id = 1,
    .minimum_version_id = 1,
    .minimum_version_id_old = 1,
    .fields = (VMStateField[]) {
        VMSTATE_SCSI_DEVICE(qdev, SCSIDiskState),
        VMSTATE_BOOL(media_changed, SCSIDiskState),
        VMSTATE_BOOL(media_event, SCSIDiskState),
        VMSTATE_BOOL(eject_request, SCSIDiskState),
        VMSTATE_BOOL(tray_open, SCSIDiskState),
        VMSTATE_BOOL(tray_locked, SCSIDiskState),
        VMSTATE_END_OF_LIST()
    }
};

1996 1997
static void scsi_hd_class_initfn(ObjectClass *klass, void *data)
{
1998
    DeviceClass *dc = DEVICE_CLASS(klass);
1999 2000 2001 2002 2003 2004
    SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);

    sc->init         = scsi_hd_initfn;
    sc->destroy      = scsi_destroy;
    sc->alloc_req    = scsi_new_request;
    sc->unit_attention_reported = scsi_disk_unit_attention_reported;
2005 2006 2007 2008
    dc->fw_name = "disk";
    dc->desc = "virtual SCSI disk";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_hd_properties;
P
Paolo Bonzini 已提交
2009
    dc->vmsd  = &vmstate_scsi_disk_state;
2010 2011
}

2012 2013 2014 2015 2016 2017 2018 2019 2020
static TypeInfo scsi_hd_info = {
    .name          = "scsi-hd",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_hd_class_initfn,
};

static Property scsi_cd_properties[] = {
    DEFINE_SCSI_DISK_PROPERTIES(),
2021
    DEFINE_PROP_HEX64("wwn", SCSIDiskState, wwn, 0),
2022
    DEFINE_PROP_END_OF_LIST(),
2023 2024 2025 2026
};

static void scsi_cd_class_initfn(ObjectClass *klass, void *data)
{
2027
    DeviceClass *dc = DEVICE_CLASS(klass);
2028 2029 2030 2031 2032 2033
    SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);

    sc->init         = scsi_cd_initfn;
    sc->destroy      = scsi_destroy;
    sc->alloc_req    = scsi_new_request;
    sc->unit_attention_reported = scsi_disk_unit_attention_reported;
2034 2035 2036 2037
    dc->fw_name = "disk";
    dc->desc = "virtual SCSI CD-ROM";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_cd_properties;
P
Paolo Bonzini 已提交
2038
    dc->vmsd  = &vmstate_scsi_disk_state;
2039 2040
}

2041 2042 2043 2044 2045
static TypeInfo scsi_cd_info = {
    .name          = "scsi-cd",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_cd_class_initfn,
2046 2047
};

2048
#ifdef __linux__
2049 2050 2051 2052 2053
static Property scsi_block_properties[] = {
    DEFINE_SCSI_DISK_PROPERTIES(),
    DEFINE_PROP_END_OF_LIST(),
};

2054 2055
static void scsi_block_class_initfn(ObjectClass *klass, void *data)
{
2056
    DeviceClass *dc = DEVICE_CLASS(klass);
2057 2058 2059 2060 2061
    SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);

    sc->init         = scsi_block_initfn;
    sc->destroy      = scsi_destroy;
    sc->alloc_req    = scsi_block_new_request;
2062 2063 2064 2065
    dc->fw_name = "disk";
    dc->desc = "SCSI block device passthrough";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_block_properties;
P
Paolo Bonzini 已提交
2066
    dc->vmsd  = &vmstate_scsi_disk_state;
2067 2068
}

2069 2070 2071 2072 2073
static TypeInfo scsi_block_info = {
    .name          = "scsi-block",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_block_class_initfn,
2074
};
2075
#endif
2076

2077 2078
static Property scsi_disk_properties[] = {
    DEFINE_SCSI_DISK_PROPERTIES(),
2079 2080
    DEFINE_PROP_BIT("removable", SCSIDiskState, features,
                    SCSI_DISK_F_REMOVABLE, false),
P
Paolo Bonzini 已提交
2081 2082
    DEFINE_PROP_BIT("dpofua", SCSIDiskState, features,
                    SCSI_DISK_F_DPOFUA, false),
2083
    DEFINE_PROP_HEX64("wwn", SCSIDiskState, wwn, 0),
2084 2085 2086
    DEFINE_PROP_END_OF_LIST(),
};

2087 2088
static void scsi_disk_class_initfn(ObjectClass *klass, void *data)
{
2089
    DeviceClass *dc = DEVICE_CLASS(klass);
2090 2091 2092 2093 2094 2095
    SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);

    sc->init         = scsi_disk_initfn;
    sc->destroy      = scsi_destroy;
    sc->alloc_req    = scsi_new_request;
    sc->unit_attention_reported = scsi_disk_unit_attention_reported;
2096 2097 2098 2099
    dc->fw_name = "disk";
    dc->desc = "virtual SCSI disk or CD-ROM (legacy)";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_disk_properties;
P
Paolo Bonzini 已提交
2100
    dc->vmsd  = &vmstate_scsi_disk_state;
2101 2102
}

2103 2104 2105 2106 2107
static TypeInfo scsi_disk_info = {
    .name          = "scsi-disk",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_disk_class_initfn,
2108 2109
};

A
Andreas Färber 已提交
2110
static void scsi_disk_register_types(void)
2111
{
2112 2113
    type_register_static(&scsi_hd_info);
    type_register_static(&scsi_cd_info);
2114
#ifdef __linux__
2115
    type_register_static(&scsi_block_info);
2116
#endif
2117
    type_register_static(&scsi_disk_info);
T
ths 已提交
2118
}
A
Andreas Färber 已提交
2119 2120

type_init(scsi_disk_register_types)