scsi-disk.c 66.0 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 "hw/block-common.h"
38
#include "dma.h"
39

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

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

47 48
typedef struct SCSIDiskState SCSIDiskState;

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

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

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

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

P
Paolo Bonzini 已提交
83
static void scsi_free_request(SCSIRequest *req)
P
pbrook 已提交
84
{
P
Paolo Bonzini 已提交
85 86
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);

87 88 89
    if (r->iov.iov_base) {
        qemu_vfree(r->iov.iov_base);
    }
P
pbrook 已提交
90 91
}

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

/* Cancel a pending data transfer.  */
102
static void scsi_cancel_io(SCSIRequest *req)
P
pbrook 已提交
103
{
104 105 106 107 108
    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);
109 110 111 112 113

        /* 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 已提交
114
    }
115
    r->req.aiocb = NULL;
P
pbrook 已提交
116 117
}

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

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

P
Paolo Bonzini 已提交
131 132 133 134 135 136 137
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);
138 139 140 141 142 143 144 145
    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 已提交
146 147 148 149 150 151 152 153 154 155 156 157 158 159
    }
}

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);
160 161 162 163 164 165
        } 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 已提交
166 167 168 169 170 171
        }
    }

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

172
static void scsi_aio_complete(void *opaque, int ret)
173 174 175 176 177 178
{
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);

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

179
    if (ret < 0) {
180 181 182 183 184 185 186 187
        if (scsi_handle_rw_error(r, -ret)) {
            goto done;
        }
    }

    scsi_req_complete(&r->req, GOOD);

done:
188 189 190
    if (!r->req.io_canceled) {
        scsi_req_unref(&r->req);
    }
191 192
}

193 194 195 196 197 198 199 200 201 202 203
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;

204 205 206
    case VERIFY_10:
    case VERIFY_12:
    case VERIFY_16:
207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
    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);
225
        r->req.aiocb = bdrv_aio_flush(s->qdev.conf.bs, scsi_aio_complete, r);
226 227 228 229 230 231 232 233 234
        return;
    }

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

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

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

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

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

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

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

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

    if (ret < 0) {
278
        if (scsi_handle_rw_error(r, -ret)) {
279
            goto done;
280 281 282
        }
    }

283 284 285 286 287 288
    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);
289 290 291 292 293

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

P
Paolo Bonzini 已提交
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313
/* 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 已提交
314 315 316 317 318 319 320
    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 已提交
321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
    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);
    }
}

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

P
pbrook 已提交
346 347
    DPRINTF("Read sector_count=%d\n", r->sector_count);
    if (r->sector_count == 0) {
348 349
        /* This also clears the sense buffer for REQUEST SENSE.  */
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
350
        return;
P
pbrook 已提交
351 352
    }

353 354 355
    /* No data transfer may already be in progress */
    assert(r->req.aiocb == NULL);

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

364 365
    if (s->tray_open) {
        scsi_read_complete(r, -ENOMEDIUM);
366
        return;
367
    }
368

P
Paolo Bonzini 已提交
369
    first = !r->started;
370
    r->started = true;
P
Paolo Bonzini 已提交
371 372 373
    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);
374
    } else {
P
Paolo Bonzini 已提交
375
        scsi_do_read(r, 0);
376
    }
P
pbrook 已提交
377 378
}

379 380 381 382 383 384 385
/*
 * 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.
 */
386
static int scsi_handle_rw_error(SCSIDiskReq *r, int error)
K
Kevin Wolf 已提交
387
{
388
    int is_read = (r->req.cmd.xfer == SCSI_XFER_FROM_DEV);
389
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
390
    BlockErrorAction action = bdrv_get_on_error(s->qdev.conf.bs, is_read);
391

392
    if (action == BLOCK_ERR_IGNORE) {
393
        bdrv_emit_qmp_error_event(s->qdev.conf.bs, BDRV_ACTION_IGNORE, is_read);
394
        return 0;
395
    }
396 397 398

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

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

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

P
Paolo Bonzini 已提交
430 431
    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
432
        bdrv_acct_done(s->qdev.conf.bs, &r->acct);
P
Paolo Bonzini 已提交
433
    }
434

435
    if (ret < 0) {
436
        if (scsi_handle_rw_error(r, -ret)) {
437
            goto done;
K
Kevin Wolf 已提交
438
        }
P
pbrook 已提交
439 440
    }

441
    n = r->qiov.size / 512;
442 443
    r->sector += n;
    r->sector_count -= n;
P
pbrook 已提交
444
    if (r->sector_count == 0) {
445 446
        scsi_write_do_fua(r);
        return;
P
pbrook 已提交
447
    } else {
P
Paolo Bonzini 已提交
448
        scsi_init_iovec(r, SCSI_DMA_BUF_SIZE);
449 450
        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 已提交
451
    }
452 453 454 455 456

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

459
static void scsi_write_data(SCSIRequest *req)
460
{
461
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
462
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
463 464
    uint32_t n;

465 466 467
    /* No data transfer may already be in progress */
    assert(r->req.aiocb == NULL);

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

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

487 488 489 490 491 492 493 494 495 496
    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;
    }

497 498 499 500 501 502 503
    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;
504 505
        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,
506
                                       scsi_write_complete, r);
507
    }
P
pbrook 已提交
508
}
P
pbrook 已提交
509

P
pbrook 已提交
510
/* Return a pointer to the data buffer.  */
511
static uint8_t *scsi_get_buf(SCSIRequest *req)
P
pbrook 已提交
512
{
513
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
P
pbrook 已提交
514

515
    return (uint8_t *)r->iov.iov_base;
P
pbrook 已提交
516 517
}

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

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

528
        outbuf[buflen++] = s->qdev.type & 0x1f;
529 530
        outbuf[buflen++] = page_code ; // this page
        outbuf[buflen++] = 0x00;
531 532
        outbuf[buflen++] = 0x00;
        start = buflen;
533 534 535

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

554 555 556 557 558 559
            if (!s->serial) {
                DPRINTF("Inquiry (EVPD[Serial number] not supported\n");
                return -1;
            }

            l = strlen(s->serial);
560
            if (l > 20) {
561
                l = 20;
562
            }
563 564 565

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

        case 0x83: /* Device identification page, mandatory */
        {
573 574 575
            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);
576

577
            if (id_len > max_len) {
578
                id_len = max_len;
579
            }
580 581 582 583 584 585 586
            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
587
            memcpy(outbuf+buflen, str, id_len);
588
            buflen += id_len;
589 590 591 592 593 594 595 596 597

            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;
            }
598 599
            break;
        }
600
        case 0xb0: /* block limits */
C
Christoph Hellwig 已提交
601
        {
602 603
            unsigned int unmap_sectors =
                    s->qdev.conf.discard_granularity / s->qdev.blocksize;
604 605 606 607
            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 已提交
608

H
Hannes Reinecke 已提交
609
            if (s->qdev.type == TYPE_ROM) {
H
Hannes Reinecke 已提交
610 611 612 613
                DPRINTF("Inquiry (EVPD[%02X] not supported for CDROM\n",
                        page_code);
                return -1;
            }
C
Christoph Hellwig 已提交
614
            /* required VPD size with unmap support */
615
            buflen = 0x40;
C
Christoph Hellwig 已提交
616 617 618 619 620 621 622 623 624 625 626
            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;
627 628 629 630 631 632 633 634 635 636

            /* 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 */
        {
637
            buflen = 8;
638
            outbuf[4] = 0;
639
            outbuf[5] = 0x60; /* write_same 10/16 supported */
640
            outbuf[6] = s->qdev.conf.discard_granularity ? 2 : 1;
641
            outbuf[7] = 0;
C
Christoph Hellwig 已提交
642 643
            break;
        }
644 645 646 647
        default:
            return -1;
        }
        /* done with EVPD */
648 649
        assert(buflen - start <= 255);
        outbuf[start - 1] = buflen - start;
650 651 652 653 654 655 656 657 658 659
        return buflen;
    }

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

    /* PAGE CODE == 0 */
    buflen = req->cmd.xfer;
660
    if (buflen > SCSI_MAX_INQUIRY_LEN) {
661
        buflen = SCSI_MAX_INQUIRY_LEN;
662
    }
663 664
    memset(outbuf, 0, buflen);

H
Hannes Reinecke 已提交
665
    outbuf[0] = s->qdev.type & 0x1f;
666
    outbuf[1] = (s->features & (1 << SCSI_DISK_F_REMOVABLE)) ? 0x80 : 0;
667 668 669 670

    strpadcpy((char *) &outbuf[16], 16, s->product, ' ');
    strpadcpy((char *) &outbuf[8], 8, s->vendor, ' ');

G
Gerd Hoffmann 已提交
671
    memset(&outbuf[32], 0, 4);
672
    memcpy(&outbuf[32], s->version, MIN(4, strlen(s->version)));
673 674 675 676 677 678
    /*
     * 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 已提交
679
    outbuf[2] = 5;
680
    outbuf[3] = 2; /* Format 2 */
681 682 683 684 685 686 687 688 689

    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;
    }

690
    /* Sync data transfer and TCQ.  */
691
    outbuf[7] = 0x10 | (req->bus->info->tcq ? 0x02 : 0);
692 693 694
    return buflen;
}

695 696 697 698 699 700
static inline bool media_is_dvd(SCSIDiskState *s)
{
    uint64_t nb_sectors;
    if (s->qdev.type != TYPE_ROM) {
        return false;
    }
701
    if (!bdrv_is_inserted(s->qdev.conf.bs)) {
702 703
        return false;
    }
704
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
705 706 707
    return nb_sectors > CD_MAX_SECTORS;
}

708 709 710 711 712 713
static inline bool media_is_cd(SCSIDiskState *s)
{
    uint64_t nb_sectors;
    if (s->qdev.type != TYPE_ROM) {
        return false;
    }
714
    if (!bdrv_is_inserted(s->qdev.conf.bs)) {
715 716
        return false;
    }
717
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
718 719 720
    return nb_sectors <= CD_MAX_SECTORS;
}

721 722 723 724 725 726 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
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;
}

754 755 756
static int scsi_read_dvd_structure(SCSIDiskState *s, SCSIDiskReq *r,
                                   uint8_t *outbuf)
{
757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777
    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) {
778
        if (s->tray_open || !bdrv_is_inserted(s->qdev.conf.bs)) {
779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799
            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;
        }
800
        bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
801 802 803 804 805 806 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

        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:
845 846 847
    return -1;
}

848
static int scsi_event_status_media(SCSIDiskState *s, uint8_t *outbuf)
849
{
850 851 852 853 854
    uint8_t event_code, media_status;

    media_status = 0;
    if (s->tray_open) {
        media_status = MS_TRAY_OPEN;
855
    } else if (bdrv_is_inserted(s->qdev.conf.bs)) {
856 857 858 859 860
        media_status = MS_MEDIA_PRESENT;
    }

    /* Event notification descriptor */
    event_code = MEC_NO_CHANGE;
861 862 863 864 865 866 867 868
    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;
        }
869 870 871 872 873 874 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
    }

    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;
905 906
}

907
static int scsi_get_configuration(SCSIDiskState *s, uint8_t *outbuf)
908
{
909 910
    int current;

911 912 913
    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }
914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938
    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;
939 940 941 942 943 944 945 946 947 948 949 950
}

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;
}

951
static int mode_sense_page(SCSIDiskState *s, int page, uint8_t **p_outbuf,
952
                           int page_control)
953
{
954 955 956 957
    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),
958 959
        [MODE_PAGE_R_W_ERROR]              = (1 << TYPE_DISK) | (1 << TYPE_ROM),
        [MODE_PAGE_AUDIO_CTL]              = (1 << TYPE_ROM),
960 961
        [MODE_PAGE_CAPABILITIES]           = (1 << TYPE_ROM),
    };
962
    uint8_t *p = *p_outbuf;
963

964 965 966 967 968 969
    if ((mode_sense_valid[page] & (1 << s->qdev.type)) == 0) {
        return -1;
    }

    p[0] = page;

970 971 972 973 974 975
    /*
     * 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.
     */
976
    switch (page) {
977
    case MODE_PAGE_HD_GEOMETRY:
978
        p[1] = 0x16;
979
        if (page_control == 1) { /* Changeable Values */
980
            break;
981
        }
982
        /* if a geometry hint is available, use it */
983 984 985 986
        p[2] = (s->qdev.conf.cyls >> 16) & 0xff;
        p[3] = (s->qdev.conf.cyls >> 8) & 0xff;
        p[4] = s->qdev.conf.cyls & 0xff;
        p[5] = s->qdev.conf.heads & 0xff;
987
        /* Write precomp start cylinder, disabled */
988 989 990
        p[6] = (s->qdev.conf.cyls >> 16) & 0xff;
        p[7] = (s->qdev.conf.cyls >> 8) & 0xff;
        p[8] = s->qdev.conf.cyls & 0xff;
991
        /* Reduced current start cylinder, disabled */
992 993 994
        p[9] = (s->qdev.conf.cyls >> 16) & 0xff;
        p[10] = (s->qdev.conf.cyls >> 8) & 0xff;
        p[11] = s->qdev.conf.cyls & 0xff;
995 996 997 998 999 1000 1001 1002 1003 1004
        /* 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;
1005
        break;
1006

1007
    case MODE_PAGE_FLEXIBLE_DISK_GEOMETRY:
1008
        p[1] = 0x1e;
1009
        if (page_control == 1) { /* Changeable Values */
1010
            break;
1011
        }
1012 1013 1014 1015
        /* Transfer rate [kbit/s], 5Mbit/s */
        p[2] = 5000 >> 8;
        p[3] = 5000 & 0xff;
        /* if a geometry hint is available, use it */
1016 1017
        p[4] = s->qdev.conf.heads & 0xff;
        p[5] = s->qdev.conf.secs & 0xff;
P
Paolo Bonzini 已提交
1018
        p[6] = s->qdev.blocksize >> 8;
1019 1020
        p[8] = (s->qdev.conf.cyls >> 8) & 0xff;
        p[9] = s->qdev.conf.cyls & 0xff;
1021
        /* Write precomp start cylinder, disabled */
1022 1023
        p[10] = (s->qdev.conf.cyls >> 8) & 0xff;
        p[11] = s->qdev.conf.cyls & 0xff;
1024
        /* Reduced current start cylinder, disabled */
1025 1026
        p[12] = (s->qdev.conf.cyls >> 8) & 0xff;
        p[13] = s->qdev.conf.cyls & 0xff;
1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041
        /* 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;
1042
        break;
1043

1044
    case MODE_PAGE_CACHING:
1045 1046
        p[0] = 8;
        p[1] = 0x12;
1047
        if (page_control == 1) { /* Changeable Values */
1048
            break;
1049
        }
1050
        if (bdrv_enable_write_cache(s->qdev.conf.bs)) {
1051 1052
            p[2] = 4; /* WCE */
        }
1053
        break;
1054

1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066
    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;

1067
    case MODE_PAGE_CAPABILITIES:
1068
        p[1] = 0x14;
1069
        if (page_control == 1) { /* Changeable Values */
1070
            break;
1071
        }
1072 1073 1074

        p[2] = 0x3b; /* CD-R & CD-RW read */
        p[3] = 0; /* Writing not supported */
1075 1076 1077 1078 1079
        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 */
1080
        p[6] = 0x2d | (s->tray_locked ? 2 : 0);
1081 1082 1083
        /* Locking supported, jumper present, eject, tray */
        p[7] = 0; /* no volume & mute control, no
                     changer */
1084
        p[8] = (50 * 176) >> 8; /* 50x read speed */
1085
        p[9] = (50 * 176) & 0xff;
1086 1087 1088
        p[10] = 2 >> 8; /* Two volume levels */
        p[11] = 2 & 0xff;
        p[12] = 2048 >> 8; /* 2M buffer */
1089
        p[13] = 2048 & 0xff;
1090
        p[14] = (16 * 176) >> 8; /* 16x read speed current */
1091
        p[15] = (16 * 176) & 0xff;
1092
        p[18] = (16 * 176) >> 8; /* 16x write speed */
1093
        p[19] = (16 * 176) & 0xff;
1094
        p[20] = (16 * 176) >> 8; /* 16x write speed current */
1095
        p[21] = (16 * 176) & 0xff;
1096
        break;
1097 1098

    default:
1099
        return -1;
1100
    }
1101 1102 1103

    *p_outbuf += p[1] + 2;
    return p[1] + 2;
1104 1105
}

1106
static int scsi_disk_emulate_mode_sense(SCSIDiskReq *r, uint8_t *outbuf)
1107
{
1108
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
1109
    uint64_t nb_sectors;
1110 1111
    bool dbd;
    int page, buflen, ret, page_control;
1112
    uint8_t *p;
1113
    uint8_t dev_specific_param;
1114

1115
    dbd = (r->req.cmd.buf[1] & 0x8) != 0;
1116 1117
    page = r->req.cmd.buf[2] & 0x3f;
    page_control = (r->req.cmd.buf[2] & 0xc0) >> 6;
1118
    DPRINTF("Mode Sense(%d) (page %d, xfer %zd, page_control %d)\n",
1119 1120
        (r->req.cmd.buf[0] == MODE_SENSE) ? 6 : 10, page, r->req.cmd.xfer, page_control);
    memset(outbuf, 0, r->req.cmd.xfer);
1121 1122
    p = outbuf;

1123
    if (s->qdev.type == TYPE_DISK) {
P
Paolo Bonzini 已提交
1124
        dev_specific_param = s->features & (1 << SCSI_DISK_F_DPOFUA) ? 0x10 : 0;
1125 1126 1127
        if (bdrv_is_read_only(s->qdev.conf.bs)) {
            dev_specific_param |= 0x80; /* Readonly.  */
        }
1128
    } else {
1129 1130
        /* MMC prescribes that CD/DVD drives have no block descriptors,
         * and defines no device-specific parameter.  */
P
Paolo Bonzini 已提交
1131
        dev_specific_param = 0x00;
1132
        dbd = true;
1133 1134
    }

1135
    if (r->req.cmd.buf[0] == MODE_SENSE) {
1136 1137 1138 1139 1140 1141 1142 1143 1144
        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;
1145 1146
    }

1147
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1148
    if (!dbd && nb_sectors) {
1149
        if (r->req.cmd.buf[0] == MODE_SENSE) {
1150 1151 1152 1153
            outbuf[3] = 8; /* Block descriptor length  */
        } else { /* MODE_SENSE_10 */
            outbuf[7] = 8; /* Block descriptor length  */
        }
P
Paolo Bonzini 已提交
1154
        nb_sectors /= (s->qdev.blocksize / 512);
1155
        if (nb_sectors > 0xffffff) {
1156
            nb_sectors = 0;
1157
        }
1158 1159 1160 1161 1162 1163
        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 已提交
1164
        p[6] = s->qdev.blocksize >> 8;
1165 1166 1167 1168
        p[7] = 0;
        p += 8;
    }

1169 1170 1171 1172
    if (page_control == 3) {
        /* Saved Values */
        scsi_check_condition(r, SENSE_CODE(SAVING_PARAMS_NOT_SUPPORTED));
        return -1;
1173 1174
    }

1175 1176 1177 1178 1179 1180 1181 1182 1183
    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;
        }
1184 1185 1186
    }

    buflen = p - outbuf;
1187 1188 1189 1190 1191
    /*
     * 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.
     */
1192
    if (r->req.cmd.buf[0] == MODE_SENSE) {
1193 1194 1195 1196 1197
        outbuf[0] = buflen - 1;
    } else { /* MODE_SENSE_10 */
        outbuf[0] = ((buflen - 2) >> 8) & 0xff;
        outbuf[1] = (buflen - 2) & 0xff;
    }
1198 1199 1200
    return buflen;
}

1201 1202 1203 1204 1205 1206 1207 1208 1209
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];
1210
    bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1211
    DPRINTF("Read TOC (track %d format %d msf %d)\n", start_track, format, msf >> 1);
P
Paolo Bonzini 已提交
1212
    nb_sectors /= s->qdev.blocksize / 512;
1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233
    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;
}

1234
static int scsi_disk_emulate_start_stop(SCSIDiskReq *r)
1235 1236 1237 1238 1239 1240 1241
{
    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) {
1242 1243
        if (!start && !s->tray_open && s->tray_locked) {
            scsi_check_condition(r,
1244
                                 bdrv_is_inserted(s->qdev.conf.bs)
1245 1246 1247
                                 ? SENSE_CODE(ILLEGAL_REQ_REMOVAL_PREVENTED)
                                 : SENSE_CODE(NOT_READY_REMOVAL_PREVENTED));
            return -1;
1248
        }
1249 1250 1251 1252 1253

        if (s->tray_open != !start) {
            bdrv_eject(s->qdev.conf.bs, !start);
            s->tray_open = !start;
        }
1254
    }
1255
    return 0;
1256 1257
}

1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276
static void scsi_disk_emulate_read_data(SCSIRequest *req)
{
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
    int buflen = r->iov.iov_len;

    if (buflen) {
        DPRINTF("Read buf_len=%zd\n", buflen);
        r->iov.iov_len = 0;
        r->started = true;
        scsi_req_data(&r->req, buflen);
        return;
    }

    /* This also clears the sense buffer for REQUEST SENSE.  */
    scsi_req_complete(&r->req, GOOD);
}

static void scsi_disk_emulate_write_data(SCSIRequest *req)
{
1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);

    if (r->iov.iov_len) {
        int buflen = r->iov.iov_len;
        DPRINTF("Write buf_len=%zd\n", buflen);
        r->iov.iov_len = 0;
        scsi_req_data(&r->req, buflen);
        return;
    }

    switch (req->cmd.buf[0]) {
    case MODE_SELECT:
    case MODE_SELECT_10:
        /* This also clears the sense buffer for REQUEST SENSE.  */
        scsi_req_complete(&r->req, GOOD);
        break;

    default:
        abort();
    }
1297 1298
}

1299
static int32_t scsi_disk_emulate_command(SCSIRequest *req, uint8_t *buf)
1300
{
1301
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
1302 1303
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
    uint64_t nb_sectors;
1304
    uint8_t *outbuf;
1305
    int buflen;
1306

1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330
    switch (req->cmd.buf[0]) {
    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;
    }

1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
    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);
1344
        r->iov.iov_base = qemu_blockalign(s->qdev.conf.bs, r->buflen);
1345 1346
    }

1347
    buflen = req->cmd.xfer;
1348
    outbuf = r->iov.iov_base;
1349 1350
    switch (req->cmd.buf[0]) {
    case TEST_UNIT_READY:
1351
        assert(!s->tray_open && bdrv_is_inserted(s->qdev.conf.bs));
H
Hannes Reinecke 已提交
1352
        break;
1353 1354
    case INQUIRY:
        buflen = scsi_disk_emulate_inquiry(req, outbuf);
1355
        if (buflen < 0) {
1356
            goto illegal_request;
1357
        }
H
Hannes Reinecke 已提交
1358
        break;
1359 1360
    case MODE_SENSE:
    case MODE_SENSE_10:
1361
        buflen = scsi_disk_emulate_mode_sense(r, outbuf);
1362
        if (buflen < 0) {
1363
            goto illegal_request;
1364
        }
1365
        break;
1366 1367
    case READ_TOC:
        buflen = scsi_disk_emulate_read_toc(req, outbuf);
1368
        if (buflen < 0) {
1369
            goto illegal_request;
1370
        }
1371
        break;
1372
    case RESERVE:
1373
        if (req->cmd.buf[1] & 1) {
1374
            goto illegal_request;
1375
        }
1376 1377
        break;
    case RESERVE_10:
1378
        if (req->cmd.buf[1] & 3) {
1379
            goto illegal_request;
1380
        }
1381 1382
        break;
    case RELEASE:
1383
        if (req->cmd.buf[1] & 1) {
1384
            goto illegal_request;
1385
        }
1386 1387
        break;
    case RELEASE_10:
1388
        if (req->cmd.buf[1] & 3) {
1389
            goto illegal_request;
1390
        }
1391
        break;
1392
    case START_STOP:
1393
        if (scsi_disk_emulate_start_stop(r) < 0) {
1394
            return 0;
1395
        }
H
Hannes Reinecke 已提交
1396
        break;
1397
    case ALLOW_MEDIUM_REMOVAL:
1398
        s->tray_locked = req->cmd.buf[4] & 1;
1399
        bdrv_lock_medium(s->qdev.conf.bs, req->cmd.buf[4] & 1);
H
Hannes Reinecke 已提交
1400
        break;
1401
    case READ_CAPACITY_10:
1402
        /* The normal LEN field for this command is zero.  */
H
Hannes Reinecke 已提交
1403
        memset(outbuf, 0, 8);
1404
        bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1405
        if (!nb_sectors) {
1406 1407
            scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
            return -1;
1408
        }
1409 1410 1411
        if ((req->cmd.buf[8] & 1) == 0 && req->cmd.lba) {
            goto illegal_request;
        }
P
Paolo Bonzini 已提交
1412
        nb_sectors /= s->qdev.blocksize / 512;
1413 1414 1415
        /* Returned value is the address of the last sector.  */
        nb_sectors--;
        /* Remember the new size for read/write sanity checking. */
P
Paolo Bonzini 已提交
1416
        s->qdev.max_lba = nb_sectors;
1417
        /* Clip to 2TB, instead of returning capacity modulo 2TB. */
1418
        if (nb_sectors > UINT32_MAX) {
1419
            nb_sectors = UINT32_MAX;
1420
        }
1421 1422 1423 1424 1425 1426
        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 已提交
1427
        outbuf[6] = s->qdev.blocksize >> 8;
1428 1429
        outbuf[7] = 0;
        buflen = 8;
H
Hannes Reinecke 已提交
1430
        break;
1431 1432 1433 1434 1435
    case REQUEST_SENSE:
        /* Just return "NO SENSE".  */
        buflen = scsi_build_sense(NULL, 0, outbuf, r->buflen,
                                  (req->cmd.buf[1] & 1) == 0);
        break;
1436 1437 1438 1439 1440 1441
    case MECHANISM_STATUS:
        buflen = scsi_emulate_mechanism_status(s, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
1442
    case GET_CONFIGURATION:
1443
        buflen = scsi_get_configuration(s, outbuf);
1444 1445 1446 1447 1448 1449 1450 1451 1452 1453
        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;
1454 1455 1456 1457 1458 1459
    case READ_DISC_INFORMATION:
        buflen = scsi_read_disc_information(s, r, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
1460 1461 1462 1463 1464
    case READ_DVD_STRUCTURE:
        buflen = scsi_read_dvd_structure(s, r, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
1465
        break;
1466
    case SERVICE_ACTION_IN_16:
1467
        /* Service Action In subcommands. */
1468
        if ((req->cmd.buf[1] & 31) == SAI_READ_CAPACITY_16) {
1469 1470
            DPRINTF("SAI READ CAPACITY(16)\n");
            memset(outbuf, 0, req->cmd.xfer);
1471
            bdrv_get_geometry(s->qdev.conf.bs, &nb_sectors);
1472
            if (!nb_sectors) {
1473 1474
                scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
                return -1;
1475
            }
1476 1477 1478
            if ((req->cmd.buf[14] & 1) == 0 && req->cmd.lba) {
                goto illegal_request;
            }
P
Paolo Bonzini 已提交
1479
            nb_sectors /= s->qdev.blocksize / 512;
1480 1481 1482
            /* Returned value is the address of the last sector.  */
            nb_sectors--;
            /* Remember the new size for read/write sanity checking. */
P
Paolo Bonzini 已提交
1483
            s->qdev.max_lba = nb_sectors;
1484 1485 1486 1487 1488 1489 1490 1491 1492 1493
            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 已提交
1494
            outbuf[10] = s->qdev.blocksize >> 8;
1495
            outbuf[11] = 0;
C
Christoph Hellwig 已提交
1496 1497
            outbuf[12] = 0;
            outbuf[13] = get_physical_block_exp(&s->qdev.conf);
1498 1499 1500 1501 1502 1503

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

1504 1505 1506 1507 1508 1509
            /* Protection, exponent and lowest lba field left blank. */
            buflen = req->cmd.xfer;
            break;
        }
        DPRINTF("Unsupported Service Action In\n");
        goto illegal_request;
1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561
    case SYNCHRONIZE_CACHE:
        /* The request is used as the AIO opaque value, so add a ref.  */
        scsi_req_ref(&r->req);
        bdrv_acct_start(s->qdev.conf.bs, &r->acct, 0, BDRV_ACCT_FLUSH);
        r->req.aiocb = bdrv_aio_flush(s->qdev.conf.bs, scsi_aio_complete, r);
        return 0;
    case SEEK_10:
        DPRINTF("Seek(10) (sector %" PRId64 ")\n", r->req.cmd.lba);
        if (r->req.cmd.lba > s->qdev.max_lba) {
            goto illegal_lba;
        }
        break;
    case MODE_SELECT:
        DPRINTF("Mode Select(6) (len %lu)\n", (long)r->req.cmd.xfer);
        /* We don't support mode parameter changes.
           Allow the mode parameter header + block descriptors only. */
        if (r->req.cmd.xfer > 12) {
            goto illegal_request;
        }
        break;
    case MODE_SELECT_10:
        DPRINTF("Mode Select(10) (len %lu)\n", (long)r->req.cmd.xfer);
        /* We don't support mode parameter changes.
           Allow the mode parameter header + block descriptors only. */
        if (r->req.cmd.xfer > 16) {
            goto illegal_request;
        }
        break;
    case WRITE_SAME_10:
        nb_sectors = lduw_be_p(&req->cmd.buf[7]);
        goto write_same;
    case WRITE_SAME_16:
        nb_sectors = ldl_be_p(&req->cmd.buf[10]) & 0xffffffffULL;
    write_same:
        if (r->req.cmd.lba > s->qdev.max_lba) {
            goto illegal_lba;
        }

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

        /* The request is used as the AIO opaque value, so add a ref.  */
        scsi_req_ref(&r->req);
        r->req.aiocb = bdrv_aio_discard(s->qdev.conf.bs,
                                        r->req.cmd.lba * (s->qdev.blocksize / 512),
                                        nb_sectors * (s->qdev.blocksize / 512),
                                        scsi_aio_complete, r);
        return 0;
1562
    default:
1563
        DPRINTF("Unknown SCSI command (%2.2x)\n", buf[0]);
1564
        scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
1565
        return 0;
1566
    }
1567
    assert(!r->req.aiocb);
1568 1569 1570 1571
    r->iov.iov_len = MIN(buflen, req->cmd.xfer);
    if (r->iov.iov_len == 0) {
        scsi_req_complete(&r->req, GOOD);
    }
1572 1573 1574 1575 1576 1577
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
        assert(r->iov.iov_len == req->cmd.xfer);
        return -r->iov.iov_len;
    } else {
        return r->iov.iov_len;
    }
1578 1579

illegal_request:
1580 1581 1582
    if (r->req.status == -1) {
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
    }
1583
    return 0;
1584 1585 1586 1587

illegal_lba:
    scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
    return 0;
1588 1589
}

P
pbrook 已提交
1590 1591 1592 1593 1594
/* 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.  */

1595
static int32_t scsi_disk_dma_command(SCSIRequest *req, uint8_t *buf)
P
pbrook 已提交
1596
{
1597 1598
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
P
Paolo Bonzini 已提交
1599
    int32_t len;
P
pbrook 已提交
1600 1601 1602
    uint8_t command;

    command = buf[0];
1603

1604 1605 1606
    if (s->tray_open || !bdrv_is_inserted(s->qdev.conf.bs)) {
        scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
        return 0;
1607 1608
    }

P
pbrook 已提交
1609
    switch (command) {
1610 1611
    case READ_6:
    case READ_10:
G
Gerd Hoffmann 已提交
1612 1613
    case READ_12:
    case READ_16:
1614
        len = r->req.cmd.xfer / s->qdev.blocksize;
1615
        DPRINTF("Read (sector %" PRId64 ", count %d)\n", r->req.cmd.lba, len);
P
Paolo Bonzini 已提交
1616
        if (r->req.cmd.lba > s->qdev.max_lba) {
1617
            goto illegal_lba;
1618
        }
P
Paolo Bonzini 已提交
1619 1620
        r->sector = r->req.cmd.lba * (s->qdev.blocksize / 512);
        r->sector_count = len * (s->qdev.blocksize / 512);
P
pbrook 已提交
1621
        break;
1622 1623 1624
    case VERIFY_10:
    case VERIFY_12:
    case VERIFY_16:
1625 1626
    case WRITE_6:
    case WRITE_10:
G
Gerd Hoffmann 已提交
1627 1628
    case WRITE_12:
    case WRITE_16:
1629
    case WRITE_VERIFY_10:
1630 1631
    case WRITE_VERIFY_12:
    case WRITE_VERIFY_16:
1632
        len = r->req.cmd.xfer / s->qdev.blocksize;
1633
        DPRINTF("Write %s(sector %" PRId64 ", count %d)\n",
1634 1635
                (command & 0xe) == 0xe ? "And Verify " : "",
                r->req.cmd.lba, len);
P
Paolo Bonzini 已提交
1636
        if (r->req.cmd.lba > s->qdev.max_lba) {
1637
            goto illegal_lba;
1638
        }
P
Paolo Bonzini 已提交
1639 1640
        r->sector = r->req.cmd.lba * (s->qdev.blocksize / 512);
        r->sector_count = len * (s->qdev.blocksize / 512);
P
pbrook 已提交
1641
        break;
1642
    default:
1643
        abort();
1644
    illegal_lba:
1645
        scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
1646
        return 0;
P
pbrook 已提交
1647
    }
1648
    if (r->sector_count == 0) {
1649
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
1650
    }
1651
    assert(r->iov.iov_len == 0);
1652
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
1653
        return -r->sector_count * 512;
P
pbrook 已提交
1654
    } else {
1655
        return r->sector_count * 512;
P
pbrook 已提交
1656 1657 1658
    }
}

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

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

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

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

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

1682
static void scsi_cd_change_media_cb(void *opaque, bool load)
1683
{
1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698
    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);
1699
    s->media_event = true;
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710
    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;
    }
1711 1712
}

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

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

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

1730 1731 1732 1733 1734 1735 1736 1737 1738
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);
    }
}

1739
static int scsi_initfn(SCSIDevice *dev)
P
pbrook 已提交
1740
{
1741
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
P
pbrook 已提交
1742

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

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

1754
    blkconf_serial(&s->qdev.conf, &s->serial);
1755 1756 1757
    if (blkconf_geometry(&dev->conf, NULL, 65535, 255, 255) < 0) {
        return -1;
    }
1758

1759
    if (!s->version) {
1760
        s->version = g_strdup(qemu_get_version());
1761
    }
1762 1763 1764
    if (!s->vendor) {
        s->vendor = g_strdup("QEMU");
    }
1765

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

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

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

1781 1782
static int scsi_hd_initfn(SCSIDevice *dev)
{
1783 1784 1785
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
    s->qdev.blocksize = s->qdev.conf.logical_block_size;
    s->qdev.type = TYPE_DISK;
1786 1787 1788
    if (!s->product) {
        s->product = g_strdup("QEMU HARDDISK");
    }
1789
    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 1799 1800
    if (!s->product) {
        s->product = g_strdup("QEMU CD-ROM");
    }
1801
    return scsi_initfn(&s->qdev);
1802 1803 1804 1805
}

static int scsi_disk_initfn(SCSIDevice *dev)
{
1806
    DriveInfo *dinfo;
1807 1808

    if (!dev->conf.bs) {
1809
        return scsi_initfn(dev);  /* ... and die there */
1810 1811
    }

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

1820
static const SCSIReqOps scsi_disk_emulate_reqops = {
P
Paolo Bonzini 已提交
1821
    .size         = sizeof(SCSIDiskReq),
1822
    .free_req     = scsi_free_request,
1823
    .send_command = scsi_disk_emulate_command,
1824 1825
    .read_data    = scsi_disk_emulate_read_data,
    .write_data   = scsi_disk_emulate_write_data,
1826 1827 1828 1829 1830 1831 1832
    .get_buf      = scsi_get_buf,
};

static const SCSIReqOps scsi_disk_dma_reqops = {
    .size         = sizeof(SCSIDiskReq),
    .free_req     = scsi_free_request,
    .send_command = scsi_disk_dma_command,
1833 1834 1835 1836
    .read_data    = scsi_read_data,
    .write_data   = scsi_write_data,
    .cancel_io    = scsi_cancel_io,
    .get_buf      = scsi_get_buf,
P
Paolo Bonzini 已提交
1837 1838
    .load_request = scsi_disk_load_request,
    .save_request = scsi_disk_save_request,
P
Paolo Bonzini 已提交
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 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879
static const SCSIReqOps *const scsi_disk_reqops_dispatch[256] = {
    [TEST_UNIT_READY]                 = &scsi_disk_emulate_reqops,
    [INQUIRY]                         = &scsi_disk_emulate_reqops,
    [MODE_SENSE]                      = &scsi_disk_emulate_reqops,
    [MODE_SENSE_10]                   = &scsi_disk_emulate_reqops,
    [START_STOP]                      = &scsi_disk_emulate_reqops,
    [ALLOW_MEDIUM_REMOVAL]            = &scsi_disk_emulate_reqops,
    [READ_CAPACITY_10]                = &scsi_disk_emulate_reqops,
    [READ_TOC]                        = &scsi_disk_emulate_reqops,
    [READ_DVD_STRUCTURE]              = &scsi_disk_emulate_reqops,
    [READ_DISC_INFORMATION]           = &scsi_disk_emulate_reqops,
    [GET_CONFIGURATION]               = &scsi_disk_emulate_reqops,
    [GET_EVENT_STATUS_NOTIFICATION]   = &scsi_disk_emulate_reqops,
    [MECHANISM_STATUS]                = &scsi_disk_emulate_reqops,
    [SERVICE_ACTION_IN_16]            = &scsi_disk_emulate_reqops,
    [REQUEST_SENSE]                   = &scsi_disk_emulate_reqops,
    [SYNCHRONIZE_CACHE]               = &scsi_disk_emulate_reqops,
    [SEEK_10]                         = &scsi_disk_emulate_reqops,
    [MODE_SELECT]                     = &scsi_disk_emulate_reqops,
    [MODE_SELECT_10]                  = &scsi_disk_emulate_reqops,
    [WRITE_SAME_10]                   = &scsi_disk_emulate_reqops,
    [WRITE_SAME_16]                   = &scsi_disk_emulate_reqops,

    [READ_6]                          = &scsi_disk_dma_reqops,
    [READ_10]                         = &scsi_disk_dma_reqops,
    [READ_12]                         = &scsi_disk_dma_reqops,
    [READ_16]                         = &scsi_disk_dma_reqops,
    [VERIFY_10]                       = &scsi_disk_dma_reqops,
    [VERIFY_12]                       = &scsi_disk_dma_reqops,
    [VERIFY_16]                       = &scsi_disk_dma_reqops,
    [WRITE_6]                         = &scsi_disk_dma_reqops,
    [WRITE_10]                        = &scsi_disk_dma_reqops,
    [WRITE_12]                        = &scsi_disk_dma_reqops,
    [WRITE_16]                        = &scsi_disk_dma_reqops,
    [WRITE_VERIFY_10]                 = &scsi_disk_dma_reqops,
    [WRITE_VERIFY_12]                 = &scsi_disk_dma_reqops,
    [WRITE_VERIFY_16]                 = &scsi_disk_dma_reqops,
};

P
Paolo Bonzini 已提交
1880 1881
static SCSIRequest *scsi_new_request(SCSIDevice *d, uint32_t tag, uint32_t lun,
                                     uint8_t *buf, void *hba_private)
P
Paolo Bonzini 已提交
1882 1883 1884
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, d);
    SCSIRequest *req;
1885 1886
    const SCSIReqOps *ops;
    uint8_t command;
P
Paolo Bonzini 已提交
1887

1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904
#ifdef DEBUG_SCSI
    DPRINTF("Command: lun=%d tag=0x%x data=0x%02x", lun, buf[0]);
    {
        int i;
        for (i = 1; i < r->req.cmd.len; i++) {
            printf(" 0x%02x", buf[i]);
        }
        printf("\n");
    }
#endif

    command = buf[0];
    ops = scsi_disk_reqops_dispatch[command];
    if (!ops) {
        ops = &scsi_disk_emulate_reqops;
    }
    req = scsi_req_alloc(ops, &s->qdev, tag, lun, hba_private);
P
Paolo Bonzini 已提交
1905 1906 1907
    return req;
}

1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938
#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];
1939 1940 1941
    if (buf[1] & 0x80) {
        s->features |= 1 << SCSI_DISK_F_REMOVABLE;
    }
1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992
    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:
1993 1994 1995
    case VERIFY_10:
    case VERIFY_12:
    case VERIFY_16:
1996 1997 1998 1999 2000 2001 2002
    case WRITE_6:
    case WRITE_10:
    case WRITE_12:
    case WRITE_16:
    case WRITE_VERIFY_10:
    case WRITE_VERIFY_12:
    case WRITE_VERIFY_16:
2003 2004 2005 2006 2007
        /* 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.
         */
2008
        if (bdrv_get_flags(s->qdev.conf.bs) & BDRV_O_NOCACHE) {
2009 2010 2011
            break;
        }

2012 2013 2014 2015 2016 2017
        /* 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).
         *
2018
         * We might use scsi_disk_dma_reqops as long as no writing commands are
2019 2020 2021
         * seen, but performance usually isn't paramount on optical media.  So,
         * just make scsi-block operate the same as scsi-generic for them.
         */
2022 2023 2024 2025
        if (s->qdev.type != TYPE_ROM) {
            return scsi_req_alloc(&scsi_disk_dma_reqops, &s->qdev, tag, lun,
                                  hba_private);
        }
2026 2027 2028 2029 2030 2031 2032
    }

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

2033 2034 2035 2036 2037 2038
#define DEFINE_SCSI_DISK_PROPERTIES()                                \
    DEFINE_BLOCK_PROPERTIES(SCSIDiskState, qdev.conf),               \
    DEFINE_PROP_STRING("ver", SCSIDiskState, version),               \
    DEFINE_PROP_STRING("serial", SCSIDiskState, serial),             \
    DEFINE_PROP_STRING("vendor", SCSIDiskState, vendor),             \
    DEFINE_PROP_STRING("product", SCSIDiskState, product)
2039

2040 2041
static Property scsi_hd_properties[] = {
    DEFINE_SCSI_DISK_PROPERTIES(),
2042 2043
    DEFINE_PROP_BIT("removable", SCSIDiskState, features,
                    SCSI_DISK_F_REMOVABLE, false),
P
Paolo Bonzini 已提交
2044 2045
    DEFINE_PROP_BIT("dpofua", SCSIDiskState, features,
                    SCSI_DISK_F_DPOFUA, false),
2046
    DEFINE_PROP_HEX64("wwn", SCSIDiskState, wwn, 0),
2047
    DEFINE_BLOCK_CHS_PROPERTIES(SCSIDiskState, qdev.conf),
2048 2049 2050
    DEFINE_PROP_END_OF_LIST(),
};

P
Paolo Bonzini 已提交
2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066
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()
    }
};

2067 2068
static void scsi_hd_class_initfn(ObjectClass *klass, void *data)
{
2069
    DeviceClass *dc = DEVICE_CLASS(klass);
2070 2071 2072 2073 2074 2075
    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;
2076 2077 2078 2079
    dc->fw_name = "disk";
    dc->desc = "virtual SCSI disk";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_hd_properties;
P
Paolo Bonzini 已提交
2080
    dc->vmsd  = &vmstate_scsi_disk_state;
2081 2082
}

2083 2084 2085 2086 2087 2088 2089 2090 2091
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(),
2092
    DEFINE_PROP_HEX64("wwn", SCSIDiskState, wwn, 0),
2093
    DEFINE_PROP_END_OF_LIST(),
2094 2095 2096 2097
};

static void scsi_cd_class_initfn(ObjectClass *klass, void *data)
{
2098
    DeviceClass *dc = DEVICE_CLASS(klass);
2099 2100 2101 2102 2103 2104
    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;
2105 2106 2107 2108
    dc->fw_name = "disk";
    dc->desc = "virtual SCSI CD-ROM";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_cd_properties;
P
Paolo Bonzini 已提交
2109
    dc->vmsd  = &vmstate_scsi_disk_state;
2110 2111
}

2112 2113 2114 2115 2116
static TypeInfo scsi_cd_info = {
    .name          = "scsi-cd",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_cd_class_initfn,
2117 2118
};

2119
#ifdef __linux__
2120
static Property scsi_block_properties[] = {
2121
    DEFINE_PROP_DRIVE("drive", SCSIDiskState, qdev.conf.bs),
2122 2123 2124
    DEFINE_PROP_END_OF_LIST(),
};

2125 2126
static void scsi_block_class_initfn(ObjectClass *klass, void *data)
{
2127
    DeviceClass *dc = DEVICE_CLASS(klass);
2128 2129 2130 2131 2132
    SCSIDeviceClass *sc = SCSI_DEVICE_CLASS(klass);

    sc->init         = scsi_block_initfn;
    sc->destroy      = scsi_destroy;
    sc->alloc_req    = scsi_block_new_request;
2133 2134 2135 2136
    dc->fw_name = "disk";
    dc->desc = "SCSI block device passthrough";
    dc->reset = scsi_disk_reset;
    dc->props = scsi_block_properties;
P
Paolo Bonzini 已提交
2137
    dc->vmsd  = &vmstate_scsi_disk_state;
2138 2139
}

2140 2141 2142 2143 2144
static TypeInfo scsi_block_info = {
    .name          = "scsi-block",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_block_class_initfn,
2145
};
2146
#endif
2147

2148 2149
static Property scsi_disk_properties[] = {
    DEFINE_SCSI_DISK_PROPERTIES(),
2150 2151
    DEFINE_PROP_BIT("removable", SCSIDiskState, features,
                    SCSI_DISK_F_REMOVABLE, false),
P
Paolo Bonzini 已提交
2152 2153
    DEFINE_PROP_BIT("dpofua", SCSIDiskState, features,
                    SCSI_DISK_F_DPOFUA, false),
2154
    DEFINE_PROP_HEX64("wwn", SCSIDiskState, wwn, 0),
2155 2156 2157
    DEFINE_PROP_END_OF_LIST(),
};

2158 2159
static void scsi_disk_class_initfn(ObjectClass *klass, void *data)
{
2160
    DeviceClass *dc = DEVICE_CLASS(klass);
2161 2162 2163 2164 2165 2166
    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;
2167 2168 2169 2170
    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 已提交
2171
    dc->vmsd  = &vmstate_scsi_disk_state;
2172 2173
}

2174 2175 2176 2177 2178
static TypeInfo scsi_disk_info = {
    .name          = "scsi-disk",
    .parent        = TYPE_SCSI_DEVICE,
    .instance_size = sizeof(SCSIDiskState),
    .class_init    = scsi_disk_class_initfn,
2179 2180
};

A
Andreas Färber 已提交
2181
static void scsi_disk_register_types(void)
2182
{
2183 2184
    type_register_static(&scsi_hd_info);
    type_register_static(&scsi_cd_info);
2185
#ifdef __linux__
2186
    type_register_static(&scsi_block_info);
2187
#endif
2188
    type_register_static(&scsi_disk_info);
T
ths 已提交
2189
}
A
Andreas Färber 已提交
2190 2191

type_init(scsi_disk_register_types)