scsi-disk.c 44.2 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

31 32
#define BADF(fmt, ...) \
do { fprintf(stderr, "scsi-disk: " fmt , ## __VA_ARGS__); } while (0)
P
pbrook 已提交
33

P
pbrook 已提交
34
#include "qemu-common.h"
35
#include "qemu-error.h"
G
Gerd Hoffmann 已提交
36
#include "scsi.h"
G
Gerd Hoffmann 已提交
37
#include "scsi-defs.h"
38
#include "sysemu.h"
B
Blue Swirl 已提交
39
#include "blockdev.h"
40
#include "block_int.h"
41

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

K
Kevin Wolf 已提交
45 46 47 48
#define SCSI_REQ_STATUS_RETRY           0x01
#define SCSI_REQ_STATUS_RETRY_TYPE_MASK 0x06
#define SCSI_REQ_STATUS_RETRY_READ      0x00
#define SCSI_REQ_STATUS_RETRY_WRITE     0x02
49
#define SCSI_REQ_STATUS_RETRY_FLUSH     0x04
50

51 52
typedef struct SCSIDiskState SCSIDiskState;

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

65
struct SCSIDiskState
P
pbrook 已提交
66
{
67
    SCSIDevice qdev;
68
    BlockDriverState *bs;
P
pbrook 已提交
69 70 71
    /* The qemu block layer uses a fixed 512 byte sector size.
       This is the number of 512 byte blocks in a single scsi sector.  */
    int cluster_size;
72
    uint32_t removable;
73
    uint64_t max_lba;
74
    bool media_changed;
75
    QEMUBH *bh;
G
Gerd Hoffmann 已提交
76
    char *version;
77
    char *serial;
78
    bool tray_open;
79
    bool tray_locked;
P
pbrook 已提交
80 81
};

K
Kevin Wolf 已提交
82
static int scsi_handle_rw_error(SCSIDiskReq *r, int error, int type);
83
static int scsi_disk_emulate_command(SCSIDiskReq *r);
K
Kevin Wolf 已提交
84

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

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

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

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

115 116
static uint32_t scsi_init_iovec(SCSIDiskReq *r)
{
117 118 119 120 121 122 123
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);

    if (!r->iov.iov_base) {
        r->buflen = SCSI_DMA_BUF_SIZE;
        r->iov.iov_base = qemu_blockalign(s->bs, r->buflen);
    }
    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
pbrook 已提交
128 129
static void scsi_read_complete(void * opaque, int ret)
{
130
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
131
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
K
Kevin Wolf 已提交
132
    int n;
P
pbrook 已提交
133

P
Paolo Bonzini 已提交
134 135 136 137
    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
        bdrv_acct_done(s->bs, &r->acct);
    }
138

P
pbrook 已提交
139
    if (ret) {
K
Kevin Wolf 已提交
140 141 142
        if (scsi_handle_rw_error(r, -ret, SCSI_REQ_STATUS_RETRY_READ)) {
            return;
        }
P
pbrook 已提交
143
    }
K
Kevin Wolf 已提交
144

145
    DPRINTF("Data ready tag=0x%x len=%zd\n", r->req.tag, r->qiov.size);
P
pbrook 已提交
146

147
    n = r->qiov.size / 512;
K
Kevin Wolf 已提交
148 149
    r->sector += n;
    r->sector_count -= n;
150
    scsi_req_data(&r->req, r->qiov.size);
P
pbrook 已提交
151 152
}

153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170
static void scsi_flush_complete(void * opaque, int ret)
{
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);

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

    if (ret < 0) {
        if (scsi_handle_rw_error(r, -ret, SCSI_REQ_STATUS_RETRY_FLUSH)) {
            return;
        }
    }

    scsi_req_complete(&r->req, GOOD);
}
K
Kevin Wolf 已提交
171

172 173
/* Read more data from scsi device into buffer.  */
static void scsi_read_data(SCSIRequest *req)
P
pbrook 已提交
174
{
175
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
K
Kevin Wolf 已提交
176
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
P
pbrook 已提交
177 178
    uint32_t n;

P
pbrook 已提交
179
    if (r->sector_count == (uint32_t)-1) {
180
        DPRINTF("Read buf_len=%zd\n", r->iov.iov_len);
P
pbrook 已提交
181
        r->sector_count = 0;
P
Paolo Bonzini 已提交
182
        scsi_req_data(&r->req, r->iov.iov_len);
P
pbrook 已提交
183
        return;
P
pbrook 已提交
184
    }
P
pbrook 已提交
185 186
    DPRINTF("Read sector_count=%d\n", r->sector_count);
    if (r->sector_count == 0) {
187 188
        /* This also clears the sense buffer for REQUEST SENSE.  */
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
189
        return;
P
pbrook 已提交
190 191
    }

192 193 194
    /* No data transfer may already be in progress */
    assert(r->req.aiocb == NULL);

195 196 197 198 199 200
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
        DPRINTF("Data transfer direction invalid\n");
        scsi_read_complete(r, -EINVAL);
        return;
    }

201 202 203
    if (s->tray_open) {
        scsi_read_complete(r, -ENOMEDIUM);
    }
204
    n = scsi_init_iovec(r);
205
    bdrv_acct_start(s->bs, &r->acct, n * BDRV_SECTOR_SIZE, BDRV_ACCT_READ);
206
    r->req.aiocb = bdrv_aio_readv(s->bs, r->sector, &r->qiov, n,
207
                              scsi_read_complete, r);
208 209 210
    if (r->req.aiocb == NULL) {
        scsi_read_complete(r, -EIO);
    }
P
pbrook 已提交
211 212
}

K
Kevin Wolf 已提交
213 214 215
static int scsi_handle_rw_error(SCSIDiskReq *r, int error, int type)
{
    int is_read = (type == SCSI_REQ_STATUS_RETRY_READ);
216
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
K
Kevin Wolf 已提交
217
    BlockErrorAction action = bdrv_get_on_error(s->bs, is_read);
218

219
    if (action == BLOCK_ERR_IGNORE) {
K
Kevin Wolf 已提交
220
        bdrv_mon_event(s->bs, BDRV_ACTION_IGNORE, is_read);
221
        return 0;
222
    }
223 224 225

    if ((error == ENOSPC && action == BLOCK_ERR_STOP_ENOSPC)
            || action == BLOCK_ERR_STOP_ANY) {
K
Kevin Wolf 已提交
226 227 228 229 230

        type &= SCSI_REQ_STATUS_RETRY_TYPE_MASK;
        r->status |= SCSI_REQ_STATUS_RETRY | type;

        bdrv_mon_event(s->bs, BDRV_ACTION_STOP, is_read);
231
        vm_stop(RUN_STATE_IO_ERROR);
L
Luiz Capitulino 已提交
232
        bdrv_iostatus_set_err(s->bs, error);
233
    } else {
234
        switch (error) {
235 236 237
        case ENOMEDIUM:
            scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
            break;
238
        case ENOMEM:
239
            scsi_check_condition(r, SENSE_CODE(TARGET_FAILURE));
240 241
            break;
        case EINVAL:
242
            scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
243 244
            break;
        default:
245
            scsi_check_condition(r, SENSE_CODE(IO_ERROR));
246
            break;
247
        }
K
Kevin Wolf 已提交
248
        bdrv_mon_event(s->bs, BDRV_ACTION_REPORT, is_read);
249 250 251 252
    }
    return 1;
}

P
pbrook 已提交
253 254
static void scsi_write_complete(void * opaque, int ret)
{
255
    SCSIDiskReq *r = (SCSIDiskReq *)opaque;
256
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
257 258
    uint32_t n;

P
Paolo Bonzini 已提交
259 260 261 262
    if (r->req.aiocb != NULL) {
        r->req.aiocb = NULL;
        bdrv_acct_done(s->bs, &r->acct);
    }
263

P
pbrook 已提交
264
    if (ret) {
K
Kevin Wolf 已提交
265
        if (scsi_handle_rw_error(r, -ret, SCSI_REQ_STATUS_RETRY_WRITE)) {
266
            return;
K
Kevin Wolf 已提交
267
        }
P
pbrook 已提交
268 269
    }

270
    n = r->qiov.size / 512;
271 272
    r->sector += n;
    r->sector_count -= n;
P
pbrook 已提交
273
    if (r->sector_count == 0) {
274
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
275
    } else {
276 277 278
        scsi_init_iovec(r);
        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 已提交
279 280 281
    }
}

282
static void scsi_write_data(SCSIRequest *req)
283
{
284
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
285
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
286 287
    uint32_t n;

288 289 290
    /* No data transfer may already be in progress */
    assert(r->req.aiocb == NULL);

291 292 293
    if (r->req.cmd.mode != SCSI_XFER_TO_DEV) {
        DPRINTF("Data transfer direction invalid\n");
        scsi_write_complete(r, -EINVAL);
294
        return;
295 296
    }

297
    n = r->qiov.size / 512;
298
    if (n) {
299 300 301
        if (s->tray_open) {
            scsi_write_complete(r, -ENOMEDIUM);
        }
302
        bdrv_acct_start(s->bs, &r->acct, n * BDRV_SECTOR_SIZE, BDRV_ACCT_WRITE);
303
        r->req.aiocb = bdrv_aio_writev(s->bs, r->sector, &r->qiov, n,
304
                                       scsi_write_complete, r);
305
        if (r->req.aiocb == NULL) {
306
            scsi_write_complete(r, -ENOMEM);
307
        }
308
    } else {
309
        /* Called for the first time.  Ask the driver to send us more data.  */
310 311
        scsi_write_complete(r, 0);
    }
P
pbrook 已提交
312
}
P
pbrook 已提交
313

314
static void scsi_dma_restart_bh(void *opaque)
315
{
316
    SCSIDiskState *s = opaque;
317 318
    SCSIRequest *req;
    SCSIDiskReq *r;
319 320 321

    qemu_bh_delete(s->bh);
    s->bh = NULL;
322

323 324
    QTAILQ_FOREACH(req, &s->qdev.requests, next) {
        r = DO_UPCAST(SCSIDiskReq, req, req);
325
        if (r->status & SCSI_REQ_STATUS_RETRY) {
K
Kevin Wolf 已提交
326
            int status = r->status;
327 328
            int ret;

K
Kevin Wolf 已提交
329 330 331 332 333
            r->status &=
                ~(SCSI_REQ_STATUS_RETRY | SCSI_REQ_STATUS_RETRY_TYPE_MASK);

            switch (status & SCSI_REQ_STATUS_RETRY_TYPE_MASK) {
            case SCSI_REQ_STATUS_RETRY_READ:
334
                scsi_read_data(&r->req);
K
Kevin Wolf 已提交
335 336
                break;
            case SCSI_REQ_STATUS_RETRY_WRITE:
337
                scsi_write_data(&r->req);
K
Kevin Wolf 已提交
338
                break;
339
            case SCSI_REQ_STATUS_RETRY_FLUSH:
340
                ret = scsi_disk_emulate_command(r);
341
                if (ret == 0) {
342
                    scsi_req_complete(&r->req, GOOD);
343
                }
K
Kevin Wolf 已提交
344
            }
345 346 347 348
        }
    }
}

349
static void scsi_dma_restart_cb(void *opaque, int running, RunState state)
350
{
351
    SCSIDiskState *s = opaque;
352

353
    if (!running) {
354
        return;
355
    }
356 357 358 359 360 361
    if (!s->bh) {
        s->bh = qemu_bh_new(scsi_dma_restart_bh, s);
        qemu_bh_schedule(s->bh);
    }
}

P
pbrook 已提交
362
/* Return a pointer to the data buffer.  */
363
static uint8_t *scsi_get_buf(SCSIRequest *req)
P
pbrook 已提交
364
{
365
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
P
pbrook 已提交
366

367
    return (uint8_t *)r->iov.iov_base;
P
pbrook 已提交
368 369
}

370 371
static int scsi_disk_emulate_inquiry(SCSIRequest *req, uint8_t *outbuf)
{
G
Gerd Hoffmann 已提交
372
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389
    int buflen = 0;

    if (req->cmd.buf[1] & 0x2) {
        /* Command support data - optional, not implemented */
        BADF("optional INQUIRY command support request not implemented\n");
        return -1;
    }

    if (req->cmd.buf[1] & 0x1) {
        /* Vital product data */
        uint8_t page_code = req->cmd.buf[2];
        if (req->cmd.xfer < 4) {
            BADF("Error: Inquiry (EVPD[%02X]) buffer size %zd is "
                 "less than 4\n", page_code, req->cmd.xfer);
            return -1;
        }

H
Hannes Reinecke 已提交
390
        if (s->qdev.type == TYPE_ROM) {
391 392 393 394 395 396 397 398 399
            outbuf[buflen++] = 5;
        } else {
            outbuf[buflen++] = 0;
        }
        outbuf[buflen++] = page_code ; // this page
        outbuf[buflen++] = 0x00;

        switch (page_code) {
        case 0x00: /* Supported page codes, mandatory */
H
Hannes Reinecke 已提交
400 401
        {
            int pages;
402 403
            DPRINTF("Inquiry EVPD[Supported pages] "
                    "buffer size %zd\n", req->cmd.xfer);
H
Hannes Reinecke 已提交
404
            pages = buflen++;
405
            outbuf[buflen++] = 0x00; // list of supported pages (this page)
406
            if (s->serial) {
407
                outbuf[buflen++] = 0x80; // unit serial number
408
            }
409
            outbuf[buflen++] = 0x83; // device identification
H
Hannes Reinecke 已提交
410
            if (s->qdev.type == TYPE_DISK) {
411 412
                outbuf[buflen++] = 0xb0; // block limits
                outbuf[buflen++] = 0xb2; // thin provisioning
H
Hannes Reinecke 已提交
413 414
            }
            outbuf[pages] = buflen - pages - 1; // number of pages
415
            break;
H
Hannes Reinecke 已提交
416
        }
417 418
        case 0x80: /* Device serial number, optional */
        {
419
            int l;
420

421 422 423 424 425 426
            if (!s->serial) {
                DPRINTF("Inquiry (EVPD[Serial number] not supported\n");
                return -1;
            }

            l = strlen(s->serial);
427
            if (l > req->cmd.xfer) {
428
                l = req->cmd.xfer;
429 430
            }
            if (l > 20) {
431
                l = 20;
432
            }
433 434 435 436

            DPRINTF("Inquiry EVPD[Serial number] "
                    "buffer size %zd\n", req->cmd.xfer);
            outbuf[buflen++] = l;
437
            memcpy(outbuf+buflen, s->serial, l);
438 439 440 441 442 443 444
            buflen += l;
            break;
        }

        case 0x83: /* Device identification page, mandatory */
        {
            int max_len = 255 - 8;
445
            int id_len = strlen(bdrv_get_device_name(s->bs));
446

447
            if (id_len > max_len) {
448
                id_len = max_len;
449
            }
450 451 452
            DPRINTF("Inquiry EVPD[Device identification] "
                    "buffer size %zd\n", req->cmd.xfer);

H
Hannes Reinecke 已提交
453
            outbuf[buflen++] = 4 + id_len;
454 455 456 457 458
            outbuf[buflen++] = 0x2; // ASCII
            outbuf[buflen++] = 0;   // not officially assigned
            outbuf[buflen++] = 0;   // reserved
            outbuf[buflen++] = id_len; // length of data following

459
            memcpy(outbuf+buflen, bdrv_get_device_name(s->bs), id_len);
460 461 462
            buflen += id_len;
            break;
        }
463
        case 0xb0: /* block limits */
C
Christoph Hellwig 已提交
464
        {
465 466
            unsigned int unmap_sectors =
                    s->qdev.conf.discard_granularity / s->qdev.blocksize;
467 468 469 470
            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 已提交
471

H
Hannes Reinecke 已提交
472
            if (s->qdev.type == TYPE_ROM) {
H
Hannes Reinecke 已提交
473 474 475 476
                DPRINTF("Inquiry (EVPD[%02X] not supported for CDROM\n",
                        page_code);
                return -1;
            }
C
Christoph Hellwig 已提交
477 478 479 480 481 482 483 484 485 486 487 488 489 490
            /* required VPD size with unmap support */
            outbuf[3] = buflen = 0x3c;

            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;
491 492 493 494 495 496 497 498 499 500 501 502 503 504 505

            /* 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 */
        {
            outbuf[3] = buflen = 8;
            outbuf[4] = 0;
            outbuf[5] = 0x40; /* write same with unmap supported */
            outbuf[6] = 0;
            outbuf[7] = 0;
C
Christoph Hellwig 已提交
506 507
            break;
        }
508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531
        default:
            BADF("Error: unsupported Inquiry (EVPD[%02X]) "
                 "buffer size %zd\n", page_code, req->cmd.xfer);
            return -1;
        }
        /* done with EVPD */
        return buflen;
    }

    /* Standard INQUIRY data */
    if (req->cmd.buf[2] != 0) {
        BADF("Error: Inquiry (STANDARD) page or code "
             "is non-zero [%02X]\n", req->cmd.buf[2]);
        return -1;
    }

    /* PAGE CODE == 0 */
    if (req->cmd.xfer < 5) {
        BADF("Error: Inquiry (STANDARD) buffer size %zd "
             "is less than 5\n", req->cmd.xfer);
        return -1;
    }

    buflen = req->cmd.xfer;
532
    if (buflen > SCSI_MAX_INQUIRY_LEN) {
533
        buflen = SCSI_MAX_INQUIRY_LEN;
534
    }
535 536
    memset(outbuf, 0, buflen);

H
Hannes Reinecke 已提交
537 538
    outbuf[0] = s->qdev.type & 0x1f;
    if (s->qdev.type == TYPE_ROM) {
539
        outbuf[1] = 0x80;
L
Laszlo Ast 已提交
540
        memcpy(&outbuf[16], "QEMU CD-ROM     ", 16);
541
    } else {
542
        outbuf[1] = s->removable ? 0x80 : 0;
L
Laszlo Ast 已提交
543
        memcpy(&outbuf[16], "QEMU HARDDISK   ", 16);
544
    }
L
Laszlo Ast 已提交
545
    memcpy(&outbuf[8], "QEMU    ", 8);
G
Gerd Hoffmann 已提交
546
    memset(&outbuf[32], 0, 4);
547
    memcpy(&outbuf[32], s->version, MIN(4, strlen(s->version)));
548 549 550 551 552 553
    /*
     * 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 已提交
554
    outbuf[2] = 5;
555
    outbuf[3] = 2; /* Format 2 */
556 557 558 559 560 561 562 563 564

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

565 566 567 568 569
    /* Sync data transfer and TCQ.  */
    outbuf[7] = 0x10 | (req->bus->tcq ? 0x02 : 0);
    return buflen;
}

570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606
static int scsi_read_dvd_structure(SCSIDiskState *s, SCSIDiskReq *r,
                                   uint8_t *outbuf)
{
    scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
    return -1;
}

static int scsi_get_event_status_notification(SCSIDiskState *s,
                                              SCSIDiskReq *r, uint8_t *outbuf)
{
    scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
    return -1;
}

static int scsi_get_configuration(SCSIDiskState *s, SCSIDiskReq *r,
                                  uint8_t *outbuf)
{
    if (s->qdev.type != TYPE_ROM) {
        return -1;
    }
    memset(outbuf, 0, 8);
    /* ??? This should probably return much more information.  For now
       just return the basic header indicating the CD-ROM profile.  */
    outbuf[7] = 8; /* CD-ROM */
    return 8;
}

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

607
static int mode_sense_page(SCSIDiskState *s, int page, uint8_t **p_outbuf,
608
                           int page_control)
609
{
610 611 612 613 614 615 616
    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),
        [MODE_PAGE_CAPABILITIES]           = (1 << TYPE_ROM),
    };

617
    BlockDriverState *bdrv = s->bs;
618
    int cylinders, heads, secs;
619
    uint8_t *p = *p_outbuf;
620

621 622 623 624 625 626
    if ((mode_sense_valid[page] & (1 << s->qdev.type)) == 0) {
        return -1;
    }

    p[0] = page;

627 628 629 630 631 632
    /*
     * 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.
     */
633
    switch (page) {
634
    case MODE_PAGE_HD_GEOMETRY:
635
        p[1] = 0x16;
636
        if (page_control == 1) { /* Changeable Values */
637
            break;
638
        }
639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662
        /* if a geometry hint is available, use it */
        bdrv_get_geometry_hint(bdrv, &cylinders, &heads, &secs);
        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;
663
        break;
664

665
    case MODE_PAGE_FLEXIBLE_DISK_GEOMETRY:
666
        p[1] = 0x1e;
667
        if (page_control == 1) { /* Changeable Values */
668
            break;
669
        }
670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700
        /* Transfer rate [kbit/s], 5Mbit/s */
        p[2] = 5000 >> 8;
        p[3] = 5000 & 0xff;
        /* if a geometry hint is available, use it */
        bdrv_get_geometry_hint(bdrv, &cylinders, &heads, &secs);
        p[4] = heads & 0xff;
        p[5] = secs & 0xff;
        p[6] = s->cluster_size * 2;
        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;
701
        break;
702

703
    case MODE_PAGE_CACHING:
704 705
        p[0] = 8;
        p[1] = 0x12;
706
        if (page_control == 1) { /* Changeable Values */
707
            break;
708
        }
709
        if (bdrv_enable_write_cache(s->bs)) {
710 711
            p[2] = 4; /* WCE */
        }
712
        break;
713

714
    case MODE_PAGE_CAPABILITIES:
715
        p[1] = 0x14;
716
        if (page_control == 1) { /* Changeable Values */
717
            break;
718
        }
719 720 721 722 723 724 725
        p[2] = 3; // CD-R & CD-RW read
        p[3] = 0; // Writing not supported
        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 */
726
        p[6] = 0x2d | (s->tray_locked ? 2 : 0);
727 728 729 730 731 732 733 734 735 736 737 738 739 740 741
        /* Locking supported, jumper present, eject, tray */
        p[7] = 0; /* no volume & mute control, no
                     changer */
        p[8] = (50 * 176) >> 8; // 50x read speed
        p[9] = (50 * 176) & 0xff;
        p[10] = 0 >> 8; // No volume
        p[11] = 0 & 0xff;
        p[12] = 2048 >> 8; // 2M buffer
        p[13] = 2048 & 0xff;
        p[14] = (16 * 176) >> 8; // 16x read speed current
        p[15] = (16 * 176) & 0xff;
        p[18] = (16 * 176) >> 8; // 16x write speed
        p[19] = (16 * 176) & 0xff;
        p[20] = (16 * 176) >> 8; // 16x write speed current
        p[21] = (16 * 176) & 0xff;
742
        break;
743 744

    default:
745
        return -1;
746
    }
747 748 749

    *p_outbuf += p[1] + 2;
    return p[1] + 2;
750 751
}

752
static int scsi_disk_emulate_mode_sense(SCSIDiskReq *r, uint8_t *outbuf)
753
{
754
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, r->req.dev);
755
    uint64_t nb_sectors;
756
    int page, dbd, buflen, ret, page_control;
757
    uint8_t *p;
758
    uint8_t dev_specific_param;
759

760 761 762
    dbd = r->req.cmd.buf[1]  & 0x8;
    page = r->req.cmd.buf[2] & 0x3f;
    page_control = (r->req.cmd.buf[2] & 0xc0) >> 6;
763
    DPRINTF("Mode Sense(%d) (page %d, xfer %zd, page_control %d)\n",
764 765
        (r->req.cmd.buf[0] == MODE_SENSE) ? 6 : 10, page, r->req.cmd.xfer, page_control);
    memset(outbuf, 0, r->req.cmd.xfer);
766 767
    p = outbuf;

768
    if (bdrv_is_read_only(s->bs)) {
769 770 771 772 773
        dev_specific_param = 0x80; /* Readonly.  */
    } else {
        dev_specific_param = 0x00;
    }

774
    if (r->req.cmd.buf[0] == MODE_SENSE) {
775 776 777 778 779 780 781 782 783
        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;
784 785
    }

786
    bdrv_get_geometry(s->bs, &nb_sectors);
787
    if (!dbd && nb_sectors) {
788
        if (r->req.cmd.buf[0] == MODE_SENSE) {
789 790 791 792
            outbuf[3] = 8; /* Block descriptor length  */
        } else { /* MODE_SENSE_10 */
            outbuf[7] = 8; /* Block descriptor length  */
        }
793
        nb_sectors /= s->cluster_size;
794
        if (nb_sectors > 0xffffff) {
795
            nb_sectors = 0;
796
        }
797 798 799 800 801 802 803 804 805 806 807
        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[6] = s->cluster_size * 2;
        p[7] = 0;
        p += 8;
    }

808 809 810 811
    if (page_control == 3) {
        /* Saved Values */
        scsi_check_condition(r, SENSE_CODE(SAVING_PARAMS_NOT_SUPPORTED));
        return -1;
812 813
    }

814 815 816 817 818 819 820 821 822
    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;
        }
823 824 825
    }

    buflen = p - outbuf;
826 827 828 829 830
    /*
     * 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.
     */
831
    if (r->req.cmd.buf[0] == MODE_SENSE) {
832 833 834 835 836
        outbuf[0] = buflen - 1;
    } else { /* MODE_SENSE_10 */
        outbuf[0] = ((buflen - 2) >> 8) & 0xff;
        outbuf[1] = (buflen - 2) & 0xff;
    }
837
    if (buflen > r->req.cmd.xfer) {
838
        buflen = r->req.cmd.xfer;
839
    }
840 841 842
    return buflen;
}

843 844 845 846 847 848 849 850 851
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];
852
    bdrv_get_geometry(s->bs, &nb_sectors);
853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872
    DPRINTF("Read TOC (track %d format %d msf %d)\n", start_track, format, msf >> 1);
    nb_sectors /= s->cluster_size;
    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;
    }
873
    if (toclen > req->cmd.xfer) {
874
        toclen = req->cmd.xfer;
875
    }
876 877 878
    return toclen;
}

879
static int scsi_disk_emulate_start_stop(SCSIDiskReq *r)
880 881 882 883 884 885 886
{
    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) {
887 888 889 890 891 892
        if (!start && !s->tray_open && s->tray_locked) {
            scsi_check_condition(r,
                                 bdrv_is_inserted(s->bs)
                                 ? SENSE_CODE(ILLEGAL_REQ_REMOVAL_PREVENTED)
                                 : SENSE_CODE(NOT_READY_REMOVAL_PREVENTED));
            return -1;
893
        }
894
        bdrv_eject(s->bs, !start);
895
        s->tray_open = !start;
896
    }
897
    return 0;
898 899
}

900
static int scsi_disk_emulate_command(SCSIDiskReq *r)
901
{
902
    SCSIRequest *req = &r->req;
903 904
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
    uint64_t nb_sectors;
905
    uint8_t *outbuf;
906 907
    int buflen = 0;

908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924
    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);
        r->iov.iov_base = qemu_blockalign(s->bs, r->buflen);
    }

    outbuf = r->iov.iov_base;
925 926
    switch (req->cmd.buf[0]) {
    case TEST_UNIT_READY:
927
        if (s->tray_open || !bdrv_is_inserted(s->bs)) {
928
            goto not_ready;
929
        }
H
Hannes Reinecke 已提交
930
        break;
931 932
    case INQUIRY:
        buflen = scsi_disk_emulate_inquiry(req, outbuf);
933
        if (buflen < 0) {
934
            goto illegal_request;
935
        }
H
Hannes Reinecke 已提交
936
        break;
937 938
    case MODE_SENSE:
    case MODE_SENSE_10:
939
        buflen = scsi_disk_emulate_mode_sense(r, outbuf);
940
        if (buflen < 0) {
941
            goto illegal_request;
942
        }
943
        break;
944 945
    case READ_TOC:
        buflen = scsi_disk_emulate_read_toc(req, outbuf);
946
        if (buflen < 0) {
947
            goto illegal_request;
948
        }
949
        break;
950
    case RESERVE:
951
        if (req->cmd.buf[1] & 1) {
952
            goto illegal_request;
953
        }
954 955
        break;
    case RESERVE_10:
956
        if (req->cmd.buf[1] & 3) {
957
            goto illegal_request;
958
        }
959 960
        break;
    case RELEASE:
961
        if (req->cmd.buf[1] & 1) {
962
            goto illegal_request;
963
        }
964 965
        break;
    case RELEASE_10:
966
        if (req->cmd.buf[1] & 3) {
967
            goto illegal_request;
968
        }
969
        break;
970
    case START_STOP:
971 972 973
        if (scsi_disk_emulate_start_stop(r) < 0) {
            return -1;
        }
H
Hannes Reinecke 已提交
974
        break;
975
    case ALLOW_MEDIUM_REMOVAL:
976
        s->tray_locked = req->cmd.buf[4] & 1;
977
        bdrv_lock_medium(s->bs, req->cmd.buf[4] & 1);
H
Hannes Reinecke 已提交
978
        break;
979
    case READ_CAPACITY_10:
980
        /* The normal LEN field for this command is zero.  */
H
Hannes Reinecke 已提交
981 982
        memset(outbuf, 0, 8);
        bdrv_get_geometry(s->bs, &nb_sectors);
983
        if (!nb_sectors) {
984
            goto not_ready;
985
        }
986 987 988 989 990 991
        nb_sectors /= s->cluster_size;
        /* Returned value is the address of the last sector.  */
        nb_sectors--;
        /* Remember the new size for read/write sanity checking. */
        s->max_lba = nb_sectors;
        /* Clip to 2TB, instead of returning capacity modulo 2TB. */
992
        if (nb_sectors > UINT32_MAX) {
993
            nb_sectors = UINT32_MAX;
994
        }
995 996 997 998 999 1000 1001 1002 1003
        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;
        outbuf[6] = s->cluster_size * 2;
        outbuf[7] = 0;
        buflen = 8;
H
Hannes Reinecke 已提交
1004
        break;
1005 1006 1007 1008 1009 1010
    case MECHANISM_STATUS:
        buflen = scsi_emulate_mechanism_status(s, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
        break;
1011
    case GET_CONFIGURATION:
1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
        buflen = scsi_get_configuration(s, r, outbuf);
        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;
    case READ_DVD_STRUCTURE:
        buflen = scsi_read_dvd_structure(s, r, outbuf);
        if (buflen < 0) {
            goto illegal_request;
        }
1028
        break;
1029
    case SERVICE_ACTION_IN_16:
1030
        /* Service Action In subcommands. */
1031
        if ((req->cmd.buf[1] & 31) == SAI_READ_CAPACITY_16) {
1032 1033
            DPRINTF("SAI READ CAPACITY(16)\n");
            memset(outbuf, 0, req->cmd.xfer);
1034
            bdrv_get_geometry(s->bs, &nb_sectors);
1035
            if (!nb_sectors) {
1036
                goto not_ready;
1037
            }
1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054
            nb_sectors /= s->cluster_size;
            /* Returned value is the address of the last sector.  */
            nb_sectors--;
            /* Remember the new size for read/write sanity checking. */
            s->max_lba = nb_sectors;
            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;
            outbuf[10] = s->cluster_size * 2;
            outbuf[11] = 0;
C
Christoph Hellwig 已提交
1055 1056
            outbuf[12] = 0;
            outbuf[13] = get_physical_block_exp(&s->qdev.conf);
1057 1058 1059 1060 1061 1062

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

1063 1064 1065 1066 1067 1068
            /* Protection, exponent and lowest lba field left blank. */
            buflen = req->cmd.xfer;
            break;
        }
        DPRINTF("Unsupported Service Action In\n");
        goto illegal_request;
1069
    case VERIFY_10:
1070
        break;
1071
    default:
1072
        scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
1073
        return -1;
1074 1075 1076 1077
    }
    return buflen;

not_ready:
1078
    if (s->tray_open || !bdrv_is_inserted(s->bs)) {
1079
        scsi_check_condition(r, SENSE_CODE(NO_MEDIUM));
1080
    } else {
1081
        scsi_check_condition(r, SENSE_CODE(LUN_NOT_READY));
1082
    }
1083
    return -1;
1084 1085

illegal_request:
1086 1087 1088
    if (r->req.status == -1) {
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
    }
1089
    return -1;
1090 1091
}

P
pbrook 已提交
1092 1093 1094 1095 1096
/* 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.  */

1097
static int32_t scsi_send_command(SCSIRequest *req, uint8_t *buf)
P
pbrook 已提交
1098
{
1099 1100
    SCSIDiskReq *r = DO_UPCAST(SCSIDiskReq, req, req);
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, req->dev);
P
Paolo Bonzini 已提交
1101
    int32_t len;
P
pbrook 已提交
1102
    uint8_t command;
1103
    int rc;
P
pbrook 已提交
1104 1105

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

P
pbrook 已提交
1108 1109 1110
#ifdef DEBUG_SCSI
    {
        int i;
1111
        for (i = 1; i < r->req.cmd.len; i++) {
P
pbrook 已提交
1112 1113 1114 1115 1116
            printf(" 0x%02x", buf[i]);
        }
        printf("\n");
    }
#endif
1117

P
pbrook 已提交
1118
    switch (command) {
1119
    case TEST_UNIT_READY:
1120
    case INQUIRY:
1121 1122
    case MODE_SENSE:
    case MODE_SENSE_10:
1123 1124 1125 1126
    case RESERVE:
    case RESERVE_10:
    case RELEASE:
    case RELEASE_10:
1127
    case START_STOP:
1128
    case ALLOW_MEDIUM_REMOVAL:
1129
    case READ_CAPACITY_10:
1130
    case READ_TOC:
1131
    case READ_DVD_STRUCTURE:
1132
    case GET_CONFIGURATION:
1133 1134
    case GET_EVENT_STATUS_NOTIFICATION:
    case MECHANISM_STATUS:
1135
    case SERVICE_ACTION_IN_16:
1136
    case VERIFY_10:
1137
        rc = scsi_disk_emulate_command(r);
1138
        if (rc < 0) {
1139
            return 0;
1140
        }
1141 1142

        r->iov.iov_len = rc;
1143
        break;
1144 1145 1146 1147 1148 1149 1150
    case SYNCHRONIZE_CACHE:
        bdrv_acct_start(s->bs, &r->acct, 0, BDRV_ACCT_FLUSH);
        r->req.aiocb = bdrv_aio_flush(s->bs, scsi_flush_complete, r);
        if (r->req.aiocb == NULL) {
            scsi_flush_complete(r, -EIO);
        }
        return 0;
1151 1152
    case READ_6:
    case READ_10:
G
Gerd Hoffmann 已提交
1153 1154
    case READ_12:
    case READ_16:
1155
        len = r->req.cmd.xfer / s->qdev.blocksize;
1156
        DPRINTF("Read (sector %" PRId64 ", count %d)\n", r->req.cmd.lba, len);
1157
        if (r->req.cmd.lba > s->max_lba) {
1158
            goto illegal_lba;
1159
        }
1160
        r->sector = r->req.cmd.lba * s->cluster_size;
P
pbrook 已提交
1161
        r->sector_count = len * s->cluster_size;
P
pbrook 已提交
1162
        break;
1163 1164
    case WRITE_6:
    case WRITE_10:
G
Gerd Hoffmann 已提交
1165 1166
    case WRITE_12:
    case WRITE_16:
1167
    case WRITE_VERIFY_10:
1168 1169
    case WRITE_VERIFY_12:
    case WRITE_VERIFY_16:
1170
        len = r->req.cmd.xfer / s->qdev.blocksize;
1171
        DPRINTF("Write %s(sector %" PRId64 ", count %d)\n",
1172 1173
                (command & 0xe) == 0xe ? "And Verify " : "",
                r->req.cmd.lba, len);
1174
        if (r->req.cmd.lba > s->max_lba) {
1175
            goto illegal_lba;
1176
        }
1177
        r->sector = r->req.cmd.lba * s->cluster_size;
P
pbrook 已提交
1178
        r->sector_count = len * s->cluster_size;
P
pbrook 已提交
1179
        break;
1180
    case MODE_SELECT:
1181
        DPRINTF("Mode Select(6) (len %lu)\n", (long)r->req.cmd.xfer);
1182 1183
        /* We don't support mode parameter changes.
           Allow the mode parameter header + block descriptors only. */
1184
        if (r->req.cmd.xfer > 12) {
1185 1186 1187 1188
            goto fail;
        }
        break;
    case MODE_SELECT_10:
1189
        DPRINTF("Mode Select(10) (len %lu)\n", (long)r->req.cmd.xfer);
1190 1191
        /* We don't support mode parameter changes.
           Allow the mode parameter header + block descriptors only. */
1192
        if (r->req.cmd.xfer > 16) {
1193 1194 1195 1196 1197
            goto fail;
        }
        break;
    case SEEK_6:
    case SEEK_10:
1198 1199 1200
        DPRINTF("Seek(%d) (sector %" PRId64 ")\n", command == SEEK_6 ? 6 : 10,
                r->req.cmd.lba);
        if (r->req.cmd.lba > s->max_lba) {
1201 1202
            goto illegal_lba;
        }
1203 1204
        break;
    case WRITE_SAME_16:
1205
        len = r->req.cmd.xfer / s->qdev.blocksize;
1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227

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

        if (r->req.cmd.lba > s->max_lba) {
            goto illegal_lba;
        }

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

        rc = bdrv_discard(s->bs, r->req.cmd.lba * s->cluster_size,
                          len * s->cluster_size);
        if (rc < 0) {
            /* XXX: better error code ?*/
            goto fail;
        }

1228
        break;
1229 1230
    case REQUEST_SENSE:
        abort();
P
pbrook 已提交
1231
    default:
1232
        DPRINTF("Unknown SCSI command (%2.2x)\n", buf[0]);
1233
        scsi_check_condition(r, SENSE_CODE(INVALID_OPCODE));
1234
        return 0;
P
pbrook 已提交
1235
    fail:
1236
        scsi_check_condition(r, SENSE_CODE(INVALID_FIELD));
1237
        return 0;
1238
    illegal_lba:
1239
        scsi_check_condition(r, SENSE_CODE(LBA_OUT_OF_RANGE));
1240
        return 0;
P
pbrook 已提交
1241
    }
1242
    if (r->sector_count == 0 && r->iov.iov_len == 0) {
1243
        scsi_req_complete(&r->req, GOOD);
P
pbrook 已提交
1244
    }
1245
    len = r->sector_count * 512 + r->iov.iov_len;
1246 1247
    if (r->req.cmd.mode == SCSI_XFER_TO_DEV) {
        return -len;
P
pbrook 已提交
1248
    } else {
1249
        if (!r->sector_count) {
P
pbrook 已提交
1250
            r->sector_count = -1;
1251
        }
1252
        return len;
P
pbrook 已提交
1253 1254 1255
    }
}

J
Jan Kiszka 已提交
1256 1257 1258 1259 1260
static void scsi_disk_reset(DeviceState *dev)
{
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev.qdev, dev);
    uint64_t nb_sectors;

1261
    scsi_device_purge_requests(&s->qdev, SENSE_CODE(RESET));
J
Jan Kiszka 已提交
1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274

    bdrv_get_geometry(s->bs, &nb_sectors);
    nb_sectors /= s->cluster_size;
    if (nb_sectors) {
        nb_sectors--;
    }
    s->max_lba = nb_sectors;
}

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

1275
    scsi_device_purge_requests(&s->qdev, SENSE_CODE(NO_SENSE));
1276
    blockdev_mark_auto_del(s->qdev.conf.bs);
G
Gerd Hoffmann 已提交
1277 1278
}

1279
static void scsi_cd_change_media_cb(void *opaque, bool load)
1280
{
1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295
    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);
1296 1297
}

1298 1299 1300 1301 1302
static bool scsi_cd_is_tray_open(void *opaque)
{
    return ((SCSIDiskState *)opaque)->tray_open;
}

1303 1304 1305 1306 1307 1308
static bool scsi_cd_is_medium_locked(void *opaque)
{
    return ((SCSIDiskState *)opaque)->tray_locked;
}

static const BlockDevOps scsi_cd_block_ops = {
1309
    .change_media_cb = scsi_cd_change_media_cb,
1310
    .is_tray_open = scsi_cd_is_tray_open,
1311 1312 1313
    .is_medium_locked = scsi_cd_is_medium_locked,
};

1314 1315 1316 1317 1318 1319 1320 1321 1322
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);
    }
}

H
Hannes Reinecke 已提交
1323
static int scsi_initfn(SCSIDevice *dev, uint8_t scsi_type)
P
pbrook 已提交
1324
{
1325
    SCSIDiskState *s = DO_UPCAST(SCSIDiskState, qdev, dev);
1326
    DriveInfo *dinfo;
P
pbrook 已提交
1327

1328
    if (!s->qdev.conf.bs) {
1329
        error_report("scsi-disk: drive property not set");
1330 1331
        return -1;
    }
1332
    s->bs = s->qdev.conf.bs;
1333

H
Hannes Reinecke 已提交
1334
    if (scsi_type == TYPE_DISK && !bdrv_is_inserted(s->bs)) {
1335 1336 1337 1338
        error_report("Device needs media, but drive is empty");
        return -1;
    }

1339
    if (!s->serial) {
1340 1341
        /* try to fall back to value set with legacy -drive serial=... */
        dinfo = drive_get_by_blockdev(s->bs);
1342
        if (*dinfo->serial) {
1343
            s->serial = g_strdup(dinfo->serial);
1344
        }
1345 1346
    }

1347
    if (!s->version) {
1348
        s->version = g_strdup(QEMU_VERSION);
1349 1350
    }

1351
    if (bdrv_is_sg(s->bs)) {
1352
        error_report("scsi-disk: unwanted /dev/sg*");
1353 1354 1355
        return -1;
    }

H
Hannes Reinecke 已提交
1356
    if (scsi_type == TYPE_ROM) {
1357
        bdrv_set_dev_ops(s->bs, &scsi_cd_block_ops, s);
1358
        s->qdev.blocksize = 2048;
H
Hannes Reinecke 已提交
1359
    } else if (scsi_type == TYPE_DISK) {
1360
        s->qdev.blocksize = s->qdev.conf.logical_block_size;
H
Hannes Reinecke 已提交
1361 1362 1363
    } else {
        error_report("scsi-disk: Unhandled SCSI type %02x", scsi_type);
        return -1;
P
pbrook 已提交
1364
    }
1365
    s->cluster_size = s->qdev.blocksize / 512;
1366
    bdrv_set_buffer_alignment(s->bs, s->qdev.blocksize);
1367

H
Hannes Reinecke 已提交
1368
    s->qdev.type = scsi_type;
1369
    qemu_add_vm_change_state_handler(scsi_dma_restart_cb, s);
L
Luiz Capitulino 已提交
1370
    bdrv_iostatus_enable(s->bs);
1371
    add_boot_device_path(s->qdev.conf.bootindex, &dev->qdev, ",0");
1372 1373 1374
    return 0;
}

1375 1376
static int scsi_hd_initfn(SCSIDevice *dev)
{
H
Hannes Reinecke 已提交
1377
    return scsi_initfn(dev, TYPE_DISK);
1378 1379 1380 1381
}

static int scsi_cd_initfn(SCSIDevice *dev)
{
H
Hannes Reinecke 已提交
1382
    return scsi_initfn(dev, TYPE_ROM);
1383 1384 1385 1386
}

static int scsi_disk_initfn(SCSIDevice *dev)
{
1387
    DriveInfo *dinfo;
H
Hannes Reinecke 已提交
1388
    uint8_t scsi_type;
1389 1390

    if (!dev->conf.bs) {
H
Hannes Reinecke 已提交
1391
        scsi_type = TYPE_DISK;  /* will die in scsi_initfn() */
1392
    } else {
1393
        dinfo = drive_get_by_blockdev(dev->conf.bs);
H
Hannes Reinecke 已提交
1394
        scsi_type = dinfo->media_cd ? TYPE_ROM : TYPE_DISK;
1395 1396
    }

H
Hannes Reinecke 已提交
1397
    return scsi_initfn(dev, scsi_type);
1398 1399
}

P
Paolo Bonzini 已提交
1400 1401
static SCSIReqOps scsi_disk_reqops = {
    .size         = sizeof(SCSIDiskReq),
1402 1403 1404 1405 1406 1407
    .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 已提交
1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419
};

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

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

1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433
#define DEFINE_SCSI_DISK_PROPERTIES()                           \
    DEFINE_BLOCK_PROPERTIES(SCSIDiskState, qdev.conf),          \
    DEFINE_PROP_STRING("ver",  SCSIDiskState, version),         \
    DEFINE_PROP_STRING("serial",  SCSIDiskState, serial)

static SCSIDeviceInfo scsi_disk_info[] = {
    {
        .qdev.name    = "scsi-hd",
        .qdev.fw_name = "disk",
        .qdev.desc    = "virtual SCSI disk",
        .qdev.size    = sizeof(SCSIDiskState),
        .qdev.reset   = scsi_disk_reset,
        .init         = scsi_hd_initfn,
        .destroy      = scsi_destroy,
1434
        .alloc_req    = scsi_new_request,
1435
        .unit_attention_reported = scsi_disk_unit_attention_reported,
1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
        .qdev.props   = (Property[]) {
            DEFINE_SCSI_DISK_PROPERTIES(),
            DEFINE_PROP_BIT("removable", SCSIDiskState, removable, 0, false),
            DEFINE_PROP_END_OF_LIST(),
        }
    },{
        .qdev.name    = "scsi-cd",
        .qdev.fw_name = "disk",
        .qdev.desc    = "virtual SCSI CD-ROM",
        .qdev.size    = sizeof(SCSIDiskState),
        .qdev.reset   = scsi_disk_reset,
        .init         = scsi_cd_initfn,
        .destroy      = scsi_destroy,
1449
        .alloc_req    = scsi_new_request,
1450
        .unit_attention_reported = scsi_disk_unit_attention_reported,
1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462
        .qdev.props   = (Property[]) {
            DEFINE_SCSI_DISK_PROPERTIES(),
            DEFINE_PROP_END_OF_LIST(),
        },
    },{
        .qdev.name    = "scsi-disk", /* legacy -device scsi-disk */
        .qdev.fw_name = "disk",
        .qdev.desc    = "virtual SCSI disk or CD-ROM (legacy)",
        .qdev.size    = sizeof(SCSIDiskState),
        .qdev.reset   = scsi_disk_reset,
        .init         = scsi_disk_initfn,
        .destroy      = scsi_destroy,
1463
        .alloc_req    = scsi_new_request,
1464
        .unit_attention_reported = scsi_disk_unit_attention_reported,
1465 1466 1467 1468 1469 1470
        .qdev.props   = (Property[]) {
            DEFINE_SCSI_DISK_PROPERTIES(),
            DEFINE_PROP_BIT("removable", SCSIDiskState, removable, 0, false),
            DEFINE_PROP_END_OF_LIST(),
        }
    }
1471 1472 1473 1474
};

static void scsi_disk_register_devices(void)
{
1475 1476 1477 1478 1479
    int i;

    for (i = 0; i < ARRAY_SIZE(scsi_disk_info); i++) {
        scsi_qdev_register(&scsi_disk_info[i]);
    }
T
ths 已提交
1480
}
1481
device_init(scsi_disk_register_devices)