scsi-bus.c 23.3 KB
Newer Older
1
#include "hw.h"
2
#include "qemu-error.h"
G
Gerd Hoffmann 已提交
3
#include "scsi.h"
4
#include "scsi-defs.h"
5
#include "qdev.h"
B
Blue Swirl 已提交
6
#include "blockdev.h"
7
#include "trace.h"
8

9
static char *scsibus_get_fw_dev_path(DeviceState *dev);
10
static int scsi_req_parse(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf);
11 12
static int scsi_build_sense(uint8_t *in_buf, int in_len,
                            uint8_t *buf, int len, bool fixed);
13

14 15 16
static struct BusInfo scsi_bus_info = {
    .name  = "SCSI",
    .size  = sizeof(SCSIBus),
17
    .get_fw_dev_path = scsibus_get_fw_dev_path,
18 19
    .props = (Property[]) {
        DEFINE_PROP_UINT32("scsi-id", SCSIDevice, id, -1),
20
        DEFINE_PROP_UINT32("lun", SCSIDevice, lun, 0),
21 22 23 24 25 26
        DEFINE_PROP_END_OF_LIST(),
    },
};
static int next_scsi_bus;

/* Create a scsi bus, and attach devices to it.  */
27
void scsi_bus_new(SCSIBus *bus, DeviceState *host, int tcq, int ndev,
P
Paolo Bonzini 已提交
28
                  const SCSIBusOps *ops)
29
{
30
    qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
31 32 33
    bus->busnr = next_scsi_bus++;
    bus->tcq = tcq;
    bus->ndev = ndev;
P
Paolo Bonzini 已提交
34
    bus->ops = ops;
G
Gerd Hoffmann 已提交
35
    bus->qbus.allow_hotplug = 1;
36 37 38 39 40 41 42
}

static int scsi_qdev_init(DeviceState *qdev, DeviceInfo *base)
{
    SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev);
    SCSIDeviceInfo *info = DO_UPCAST(SCSIDeviceInfo, qdev, base);
    SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus);
G
Gerd Hoffmann 已提交
43
    int rc = -1;
44 45 46 47 48 49 50 51

    if (dev->id == -1) {
        for (dev->id = 0; dev->id < bus->ndev; dev->id++) {
            if (bus->devs[dev->id] == NULL)
                break;
        }
    }
    if (dev->id >= bus->ndev) {
52
        error_report("bad scsi device id: %d", dev->id);
53 54 55 56
        goto err;
    }

    if (bus->devs[dev->id]) {
G
Gerd Hoffmann 已提交
57
        qdev_free(&bus->devs[dev->id]->qdev);
58 59 60 61
    }
    bus->devs[dev->id] = dev;

    dev->info = info;
62
    QTAILQ_INIT(&dev->requests);
G
Gerd Hoffmann 已提交
63 64 65 66
    rc = dev->info->init(dev);
    if (rc != 0) {
        bus->devs[dev->id] = NULL;
    }
67 68

err:
G
Gerd Hoffmann 已提交
69 70 71 72 73 74 75 76 77 78 79 80 81 82
    return rc;
}

static int scsi_qdev_exit(DeviceState *qdev)
{
    SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev);
    SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus);

    assert(bus->devs[dev->id] != NULL);
    if (bus->devs[dev->id]->info->destroy) {
        bus->devs[dev->id]->info->destroy(bus->devs[dev->id]);
    }
    bus->devs[dev->id] = NULL;
    return 0;
83 84 85 86 87 88
}

void scsi_qdev_register(SCSIDeviceInfo *info)
{
    info->qdev.bus_info = &scsi_bus_info;
    info->qdev.init     = scsi_qdev_init;
G
Gerd Hoffmann 已提交
89
    info->qdev.unplug   = qdev_simple_unplug_cb;
G
Gerd Hoffmann 已提交
90
    info->qdev.exit     = scsi_qdev_exit;
91 92 93 94
    qdev_register(&info->qdev);
}

/* handle legacy '-drive if=scsi,...' cmd line args */
95 96
SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, BlockDriverState *bdrv,
                                      int unit, bool removable)
97 98 99 100
{
    const char *driver;
    DeviceState *dev;

101
    driver = bdrv_is_sg(bdrv) ? "scsi-generic" : "scsi-disk";
102 103
    dev = qdev_create(&bus->qbus, driver);
    qdev_prop_set_uint32(dev, "scsi-id", unit);
104 105 106
    if (qdev_prop_exists(dev, "removable")) {
        qdev_prop_set_bit(dev, "removable", removable);
    }
107 108 109 110
    if (qdev_prop_set_drive(dev, "drive", bdrv) < 0) {
        qdev_free(dev);
        return NULL;
    }
111 112
    if (qdev_init(dev) < 0)
        return NULL;
113 114 115
    return DO_UPCAST(SCSIDevice, qdev, dev);
}

116
int scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
117
{
118
    Location loc;
119
    DriveInfo *dinfo;
120
    int res = 0, unit;
121

122
    loc_push_none(&loc);
123
    for (unit = 0; unit < bus->ndev; unit++) {
124 125 126 127
        dinfo = drive_get(IF_SCSI, bus->busnr, unit);
        if (dinfo == NULL) {
            continue;
        }
128
        qemu_opts_loc_restore(dinfo->opts);
129
        if (!scsi_bus_legacy_add_drive(bus, dinfo->bdrv, unit, false)) {
130 131 132
            res = -1;
            break;
        }
133
    }
134
    loc_pop(&loc);
135
    return res;
136
}
137

138 139 140 141 142 143 144 145 146 147 148 149 150 151
/* SCSIReqOps implementation for invalid commands.  */

static int32_t scsi_invalid_command(SCSIRequest *req, uint8_t *buf)
{
    scsi_req_build_sense(req, SENSE_CODE(INVALID_OPCODE));
    scsi_req_complete(req, CHECK_CONDITION);
    return 0;
}

struct SCSIReqOps reqops_invalid_opcode = {
    .size         = sizeof(SCSIRequest),
    .send_command = scsi_invalid_command
};

P
Paolo Bonzini 已提交
152
SCSIRequest *scsi_req_alloc(SCSIReqOps *reqops, SCSIDevice *d, uint32_t tag,
153
                            uint32_t lun, void *hba_private)
154 155 156
{
    SCSIRequest *req;

P
Paolo Bonzini 已提交
157
    req = qemu_mallocz(reqops->size);
158
    req->refcount = 1;
159 160 161 162
    req->bus = scsi_bus_from_device(d);
    req->dev = d;
    req->tag = tag;
    req->lun = lun;
163
    req->hba_private = hba_private;
G
Gerd Hoffmann 已提交
164
    req->status = -1;
165
    req->sense_len = 0;
P
Paolo Bonzini 已提交
166
    req->ops = reqops;
167
    trace_scsi_req_alloc(req->dev->id, req->lun, req->tag);
168 169 170
    return req;
}

171
SCSIRequest *scsi_req_new(SCSIDevice *d, uint32_t tag, uint32_t lun,
172
                          uint8_t *buf, void *hba_private)
P
Paolo Bonzini 已提交
173
{
174
    SCSIRequest *req;
175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190
    SCSICommand cmd;

    if (scsi_req_parse(&cmd, d, buf) != 0) {
        trace_scsi_req_parse_bad(d->id, lun, tag, buf[0]);
        req = scsi_req_alloc(&reqops_invalid_opcode, d, tag, lun, hba_private);
    } else {
        trace_scsi_req_parsed(d->id, lun, tag, buf[0],
                              cmd.mode, cmd.xfer);
        if (req->cmd.lba != -1) {
            trace_scsi_req_parsed_lba(d->id, lun, tag, buf[0],
                                      cmd.lba);
        }
        req = d->info->alloc_req(d, tag, lun, hba_private);
    }

    req->cmd = cmd;
191
    return req;
P
Paolo Bonzini 已提交
192 193
}

P
Paolo Bonzini 已提交
194 195
uint8_t *scsi_req_get_buf(SCSIRequest *req)
{
196
    return req->ops->get_buf(req);
P
Paolo Bonzini 已提交
197 198
}

199 200
int scsi_req_get_sense(SCSIRequest *req, uint8_t *buf, int len)
{
201 202
    assert(len >= 14);
    if (!req->sense_len) {
203 204
        return 0;
    }
205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222
    return scsi_build_sense(req->sense, req->sense_len, buf, len, true);
}

int scsi_device_get_sense(SCSIDevice *dev, uint8_t *buf, int len, bool fixed)
{
    return scsi_build_sense(dev->sense, dev->sense_len, buf, len, fixed);
}

void scsi_req_build_sense(SCSIRequest *req, SCSISense sense)
{
    trace_scsi_req_build_sense(req->dev->id, req->lun, req->tag,
                               sense.key, sense.asc, sense.ascq);
    memset(req->sense, 0, 18);
    req->sense[0] = 0xf0;
    req->sense[2] = sense.key;
    req->sense[12] = sense.asc;
    req->sense[13] = sense.ascq;
    req->sense_len = 18;
223 224
}

225
int32_t scsi_req_enqueue(SCSIRequest *req)
226
{
227 228
    int32_t rc;

229 230 231 232
    assert(!req->enqueued);
    scsi_req_ref(req);
    req->enqueued = true;
    QTAILQ_INSERT_TAIL(&req->dev->requests, req, next);
233 234

    scsi_req_ref(req);
235
    rc = req->ops->send_command(req, req->cmd.buf);
236 237
    scsi_req_unref(req);
    return rc;
238 239
}

240
static void scsi_req_dequeue(SCSIRequest *req)
241
{
242
    trace_scsi_req_dequeue(req->dev->id, req->lun, req->tag);
243 244 245
    if (req->enqueued) {
        QTAILQ_REMOVE(&req->dev->requests, req, next);
        req->enqueued = false;
P
Paolo Bonzini 已提交
246
        scsi_req_unref(req);
247 248 249
    }
}

P
Paolo Bonzini 已提交
250
static int scsi_req_length(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
251
{
P
Paolo Bonzini 已提交
252
    switch (buf[0] >> 5) {
253
    case 0:
P
Paolo Bonzini 已提交
254 255
        cmd->xfer = buf[4];
        cmd->len = 6;
256
        /* length 0 means 256 blocks */
P
Paolo Bonzini 已提交
257 258 259
        if (cmd->xfer == 0) {
            cmd->xfer = 256;
        }
260 261 262
        break;
    case 1:
    case 2:
P
Paolo Bonzini 已提交
263 264
        cmd->xfer = buf[8] | (buf[7] << 8);
        cmd->len = 10;
265 266
        break;
    case 4:
P
Paolo Bonzini 已提交
267 268
        cmd->xfer = buf[13] | (buf[12] << 8) | (buf[11] << 16) | (buf[10] << 24);
        cmd->len = 16;
269 270
        break;
    case 5:
P
Paolo Bonzini 已提交
271 272
        cmd->xfer = buf[9] | (buf[8] << 8) | (buf[7] << 16) | (buf[6] << 24);
        cmd->len = 12;
273 274 275 276 277
        break;
    default:
        return -1;
    }

P
Paolo Bonzini 已提交
278
    switch (buf[0]) {
279
    case TEST_UNIT_READY:
280
    case REWIND:
281 282 283 284
    case START_STOP:
    case SEEK_6:
    case WRITE_FILEMARKS:
    case SPACE:
285 286
    case RESERVE:
    case RELEASE:
287 288
    case ERASE:
    case ALLOW_MEDIUM_REMOVAL:
289
    case VERIFY_10:
290 291 292 293 294 295
    case SEEK_10:
    case SYNCHRONIZE_CACHE:
    case LOCK_UNLOCK_CACHE:
    case LOAD_UNLOAD:
    case SET_CD_SPEED:
    case SET_LIMITS:
296
    case WRITE_LONG_10:
297 298
    case MOVE_MEDIUM:
    case UPDATE_BLOCK:
P
Paolo Bonzini 已提交
299
        cmd->xfer = 0;
300 301 302
        break;
    case MODE_SENSE:
        break;
303
    case WRITE_SAME_10:
P
Paolo Bonzini 已提交
304
        cmd->xfer = 1;
305
        break;
306
    case READ_CAPACITY_10:
P
Paolo Bonzini 已提交
307
        cmd->xfer = 8;
308 309
        break;
    case READ_BLOCK_LIMITS:
P
Paolo Bonzini 已提交
310
        cmd->xfer = 6;
311 312
        break;
    case READ_POSITION:
P
Paolo Bonzini 已提交
313
        cmd->xfer = 20;
314 315
        break;
    case SEND_VOLUME_TAG:
P
Paolo Bonzini 已提交
316
        cmd->xfer *= 40;
317 318
        break;
    case MEDIUM_SCAN:
P
Paolo Bonzini 已提交
319
        cmd->xfer *= 8;
320 321
        break;
    case WRITE_10:
322
    case WRITE_VERIFY_10:
323 324 325
    case WRITE_6:
    case WRITE_12:
    case WRITE_VERIFY_12:
G
Gerd Hoffmann 已提交
326 327
    case WRITE_16:
    case WRITE_VERIFY_16:
P
Paolo Bonzini 已提交
328
        cmd->xfer *= dev->blocksize;
329 330 331 332 333 334
        break;
    case READ_10:
    case READ_6:
    case READ_REVERSE:
    case RECOVER_BUFFERED_DATA:
    case READ_12:
G
Gerd Hoffmann 已提交
335
    case READ_16:
P
Paolo Bonzini 已提交
336
        cmd->xfer *= dev->blocksize;
337 338
        break;
    case INQUIRY:
P
Paolo Bonzini 已提交
339
        cmd->xfer = buf[4] | (buf[3] << 8);
340
        break;
341 342
    case MAINTENANCE_OUT:
    case MAINTENANCE_IN:
P
Paolo Bonzini 已提交
343
        if (dev->type == TYPE_ROM) {
344
            /* GPCMD_REPORT_KEY and GPCMD_SEND_KEY from multi media commands */
P
Paolo Bonzini 已提交
345
            cmd->xfer = buf[9] | (buf[8] << 8);
346 347
        }
        break;
348 349 350 351
    }
    return 0;
}

P
Paolo Bonzini 已提交
352
static int scsi_req_stream_length(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
353
{
P
Paolo Bonzini 已提交
354
    switch (buf[0]) {
355 356 357 358 359
    /* stream commands */
    case READ_6:
    case READ_REVERSE:
    case RECOVER_BUFFERED_DATA:
    case WRITE_6:
P
Paolo Bonzini 已提交
360 361 362 363 364
        cmd->len = 6;
        cmd->xfer = buf[4] | (buf[3] << 8) | (buf[2] << 16);
        if (buf[1] & 0x01) { /* fixed */
            cmd->xfer *= dev->blocksize;
        }
365 366 367
        break;
    case REWIND:
    case START_STOP:
P
Paolo Bonzini 已提交
368 369
        cmd->len = 6;
        cmd->xfer = 0;
370 371 372
        break;
    /* generic commands */
    default:
P
Paolo Bonzini 已提交
373
        return scsi_req_length(cmd, dev, buf);
374 375 376 377
    }
    return 0;
}

P
Paolo Bonzini 已提交
378
static void scsi_cmd_xfer_mode(SCSICommand *cmd)
G
Gerd Hoffmann 已提交
379
{
P
Paolo Bonzini 已提交
380
    switch (cmd->buf[0]) {
G
Gerd Hoffmann 已提交
381 382
    case WRITE_6:
    case WRITE_10:
383
    case WRITE_VERIFY_10:
G
Gerd Hoffmann 已提交
384 385
    case WRITE_12:
    case WRITE_VERIFY_12:
G
Gerd Hoffmann 已提交
386 387
    case WRITE_16:
    case WRITE_VERIFY_16:
G
Gerd Hoffmann 已提交
388 389 390 391 392 393 394 395 396 397 398 399 400 401 402
    case COPY:
    case COPY_VERIFY:
    case COMPARE:
    case CHANGE_DEFINITION:
    case LOG_SELECT:
    case MODE_SELECT:
    case MODE_SELECT_10:
    case SEND_DIAGNOSTIC:
    case WRITE_BUFFER:
    case FORMAT_UNIT:
    case REASSIGN_BLOCKS:
    case SEARCH_EQUAL:
    case SEARCH_HIGH:
    case SEARCH_LOW:
    case UPDATE_BLOCK:
403 404
    case WRITE_LONG_10:
    case WRITE_SAME_10:
G
Gerd Hoffmann 已提交
405 406 407 408 409
    case SEARCH_HIGH_12:
    case SEARCH_EQUAL_12:
    case SEARCH_LOW_12:
    case MEDIUM_SCAN:
    case SEND_VOLUME_TAG:
410
    case PERSISTENT_RESERVE_OUT:
411
    case MAINTENANCE_OUT:
P
Paolo Bonzini 已提交
412
        cmd->mode = SCSI_XFER_TO_DEV;
G
Gerd Hoffmann 已提交
413 414
        break;
    default:
P
Paolo Bonzini 已提交
415 416
        if (cmd->xfer)
            cmd->mode = SCSI_XFER_FROM_DEV;
G
Gerd Hoffmann 已提交
417
        else {
P
Paolo Bonzini 已提交
418
            cmd->mode = SCSI_XFER_NONE;
G
Gerd Hoffmann 已提交
419 420 421 422 423
        }
        break;
    }
}

P
Paolo Bonzini 已提交
424
static uint64_t scsi_cmd_lba(SCSICommand *cmd)
425
{
P
Paolo Bonzini 已提交
426
    uint8_t *buf = cmd->buf;
427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455
    uint64_t lba;

    switch (buf[0] >> 5) {
    case 0:
        lba = (uint64_t) buf[3] | ((uint64_t) buf[2] << 8) |
              (((uint64_t) buf[1] & 0x1f) << 16);
        break;
    case 1:
    case 2:
        lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) |
              ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24);
        break;
    case 4:
        lba = (uint64_t) buf[9] | ((uint64_t) buf[8] << 8) |
              ((uint64_t) buf[7] << 16) | ((uint64_t) buf[6] << 24) |
              ((uint64_t) buf[5] << 32) | ((uint64_t) buf[4] << 40) |
              ((uint64_t) buf[3] << 48) | ((uint64_t) buf[2] << 56);
        break;
    case 5:
        lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) |
              ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24);
        break;
    default:
        lba = -1;

    }
    return lba;
}

456
int scsi_req_parse(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
457 458 459
{
    int rc;

460 461
    if (dev->type == TYPE_TAPE) {
        rc = scsi_req_stream_length(cmd, dev, buf);
462
    } else {
463
        rc = scsi_req_length(cmd, dev, buf);
464 465 466 467
    }
    if (rc != 0)
        return rc;

468 469 470
    memcpy(cmd->buf, buf, cmd->len);
    scsi_cmd_xfer_mode(cmd);
    cmd->lba = scsi_cmd_lba(cmd);
471 472
    return 0;
}
G
Gerd Hoffmann 已提交
473

474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535
/*
 * Predefined sense codes
 */

/* No sense data available */
const struct SCSISense sense_code_NO_SENSE = {
    .key = NO_SENSE , .asc = 0x00 , .ascq = 0x00
};

/* LUN not ready, Manual intervention required */
const struct SCSISense sense_code_LUN_NOT_READY = {
    .key = NOT_READY, .asc = 0x04, .ascq = 0x03
};

/* LUN not ready, Medium not present */
const struct SCSISense sense_code_NO_MEDIUM = {
    .key = NOT_READY, .asc = 0x3a, .ascq = 0x00
};

/* Hardware error, internal target failure */
const struct SCSISense sense_code_TARGET_FAILURE = {
    .key = HARDWARE_ERROR, .asc = 0x44, .ascq = 0x00
};

/* Illegal request, invalid command operation code */
const struct SCSISense sense_code_INVALID_OPCODE = {
    .key = ILLEGAL_REQUEST, .asc = 0x20, .ascq = 0x00
};

/* Illegal request, LBA out of range */
const struct SCSISense sense_code_LBA_OUT_OF_RANGE = {
    .key = ILLEGAL_REQUEST, .asc = 0x21, .ascq = 0x00
};

/* Illegal request, Invalid field in CDB */
const struct SCSISense sense_code_INVALID_FIELD = {
    .key = ILLEGAL_REQUEST, .asc = 0x24, .ascq = 0x00
};

/* Illegal request, LUN not supported */
const struct SCSISense sense_code_LUN_NOT_SUPPORTED = {
    .key = ILLEGAL_REQUEST, .asc = 0x25, .ascq = 0x00
};

/* Command aborted, I/O process terminated */
const struct SCSISense sense_code_IO_ERROR = {
    .key = ABORTED_COMMAND, .asc = 0x00, .ascq = 0x06
};

/* Command aborted, I_T Nexus loss occurred */
const struct SCSISense sense_code_I_T_NEXUS_LOSS = {
    .key = ABORTED_COMMAND, .asc = 0x29, .ascq = 0x07
};

/* Command aborted, Logical Unit failure */
const struct SCSISense sense_code_LUN_FAILURE = {
    .key = ABORTED_COMMAND, .asc = 0x3e, .ascq = 0x01
};

/*
 * scsi_build_sense
 *
536
 * Convert between fixed and descriptor sense buffers
537
 */
538 539
int scsi_build_sense(uint8_t *in_buf, int in_len,
                     uint8_t *buf, int len, bool fixed)
540
{
541 542
    bool fixed_in;
    SCSISense sense;
543 544 545 546
    if (!fixed && len < 8) {
        return 0;
    }

547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569
    if (in_len == 0) {
        sense.key = NO_SENSE;
        sense.asc = 0;
        sense.ascq = 0;
    } else {
        fixed_in = (in_buf[0] & 2) == 0;

        if (fixed == fixed_in) {
            memcpy(buf, in_buf, MIN(len, in_len));
            return MIN(len, in_len);
        }

        if (fixed_in) {
            sense.key = in_buf[2];
            sense.asc = in_buf[12];
            sense.ascq = in_buf[13];
        } else {
            sense.key = in_buf[1];
            sense.asc = in_buf[2];
            sense.ascq = in_buf[3];
        }
    }

570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588
    memset(buf, 0, len);
    if (fixed) {
        /* Return fixed format sense buffer */
        buf[0] = 0xf0;
        buf[2] = sense.key;
        buf[7] = 7;
        buf[12] = sense.asc;
        buf[13] = sense.ascq;
        return MIN(len, 18);
    } else {
        /* Return descriptor format sense buffer */
        buf[0] = 0x72;
        buf[1] = sense.key;
        buf[2] = sense.asc;
        buf[3] = sense.ascq;
        return 8;
    }
}

G
Gerd Hoffmann 已提交
589 590 591 592
static const char *scsi_command_name(uint8_t cmd)
{
    static const char *names[] = {
        [ TEST_UNIT_READY          ] = "TEST_UNIT_READY",
593
        [ REWIND                   ] = "REWIND",
G
Gerd Hoffmann 已提交
594 595 596 597 598 599 600 601 602 603 604 605
        [ REQUEST_SENSE            ] = "REQUEST_SENSE",
        [ FORMAT_UNIT              ] = "FORMAT_UNIT",
        [ READ_BLOCK_LIMITS        ] = "READ_BLOCK_LIMITS",
        [ REASSIGN_BLOCKS          ] = "REASSIGN_BLOCKS",
        [ READ_6                   ] = "READ_6",
        [ WRITE_6                  ] = "WRITE_6",
        [ SEEK_6                   ] = "SEEK_6",
        [ READ_REVERSE             ] = "READ_REVERSE",
        [ WRITE_FILEMARKS          ] = "WRITE_FILEMARKS",
        [ SPACE                    ] = "SPACE",
        [ INQUIRY                  ] = "INQUIRY",
        [ RECOVER_BUFFERED_DATA    ] = "RECOVER_BUFFERED_DATA",
606 607
        [ MAINTENANCE_IN           ] = "MAINTENANCE_IN",
        [ MAINTENANCE_OUT          ] = "MAINTENANCE_OUT",
G
Gerd Hoffmann 已提交
608 609 610 611 612 613 614 615 616 617
        [ MODE_SELECT              ] = "MODE_SELECT",
        [ RESERVE                  ] = "RESERVE",
        [ RELEASE                  ] = "RELEASE",
        [ COPY                     ] = "COPY",
        [ ERASE                    ] = "ERASE",
        [ MODE_SENSE               ] = "MODE_SENSE",
        [ START_STOP               ] = "START_STOP",
        [ RECEIVE_DIAGNOSTIC       ] = "RECEIVE_DIAGNOSTIC",
        [ SEND_DIAGNOSTIC          ] = "SEND_DIAGNOSTIC",
        [ ALLOW_MEDIUM_REMOVAL     ] = "ALLOW_MEDIUM_REMOVAL",
618
        [ READ_CAPACITY_10         ] = "READ_CAPACITY_10",
G
Gerd Hoffmann 已提交
619 620 621
        [ READ_10                  ] = "READ_10",
        [ WRITE_10                 ] = "WRITE_10",
        [ SEEK_10                  ] = "SEEK_10",
622 623
        [ WRITE_VERIFY_10          ] = "WRITE_VERIFY_10",
        [ VERIFY_10                ] = "VERIFY_10",
G
Gerd Hoffmann 已提交
624 625 626 627 628
        [ SEARCH_HIGH              ] = "SEARCH_HIGH",
        [ SEARCH_EQUAL             ] = "SEARCH_EQUAL",
        [ SEARCH_LOW               ] = "SEARCH_LOW",
        [ SET_LIMITS               ] = "SET_LIMITS",
        [ PRE_FETCH                ] = "PRE_FETCH",
629
        /* READ_POSITION and PRE_FETCH use the same operation code */
G
Gerd Hoffmann 已提交
630 631 632 633 634 635 636 637 638
        [ SYNCHRONIZE_CACHE        ] = "SYNCHRONIZE_CACHE",
        [ LOCK_UNLOCK_CACHE        ] = "LOCK_UNLOCK_CACHE",
        [ READ_DEFECT_DATA         ] = "READ_DEFECT_DATA",
        [ MEDIUM_SCAN              ] = "MEDIUM_SCAN",
        [ COMPARE                  ] = "COMPARE",
        [ COPY_VERIFY              ] = "COPY_VERIFY",
        [ WRITE_BUFFER             ] = "WRITE_BUFFER",
        [ READ_BUFFER              ] = "READ_BUFFER",
        [ UPDATE_BLOCK             ] = "UPDATE_BLOCK",
639 640
        [ READ_LONG_10             ] = "READ_LONG_10",
        [ WRITE_LONG_10            ] = "WRITE_LONG_10",
G
Gerd Hoffmann 已提交
641
        [ CHANGE_DEFINITION        ] = "CHANGE_DEFINITION",
642 643
        [ WRITE_SAME_10            ] = "WRITE_SAME_10",
        [ UNMAP                    ] = "UNMAP",
G
Gerd Hoffmann 已提交
644
        [ READ_TOC                 ] = "READ_TOC",
645 646
        [ REPORT_DENSITY_SUPPORT   ] = "REPORT_DENSITY_SUPPORT",
        [ GET_CONFIGURATION        ] = "GET_CONFIGURATION",
G
Gerd Hoffmann 已提交
647 648 649 650 651 652 653 654
        [ LOG_SELECT               ] = "LOG_SELECT",
        [ LOG_SENSE                ] = "LOG_SENSE",
        [ MODE_SELECT_10           ] = "MODE_SELECT_10",
        [ RESERVE_10               ] = "RESERVE_10",
        [ RELEASE_10               ] = "RELEASE_10",
        [ MODE_SENSE_10            ] = "MODE_SENSE_10",
        [ PERSISTENT_RESERVE_IN    ] = "PERSISTENT_RESERVE_IN",
        [ PERSISTENT_RESERVE_OUT   ] = "PERSISTENT_RESERVE_OUT",
655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674
        [ WRITE_FILEMARKS_16       ] = "WRITE_FILEMARKS_16",
        [ EXTENDED_COPY            ] = "EXTENDED_COPY",
        [ ATA_PASSTHROUGH          ] = "ATA_PASSTHROUGH",
        [ ACCESS_CONTROL_IN        ] = "ACCESS_CONTROL_IN",
        [ ACCESS_CONTROL_OUT       ] = "ACCESS_CONTROL_OUT",
        [ READ_16                  ] = "READ_16",
        [ COMPARE_AND_WRITE        ] = "COMPARE_AND_WRITE",
        [ WRITE_16                 ] = "WRITE_16",
        [ WRITE_VERIFY_16          ] = "WRITE_VERIFY_16",
        [ VERIFY_16                ] = "VERIFY_16",
        [ SYNCHRONIZE_CACHE_16     ] = "SYNCHRONIZE_CACHE_16",
        [ LOCATE_16                ] = "LOCATE_16",
        [ WRITE_SAME_16            ] = "WRITE_SAME_16",
        [ ERASE_16                 ] = "ERASE_16",
        [ SERVICE_ACTION_IN        ] = "SERVICE_ACTION_IN",
        [ WRITE_LONG_16            ] = "WRITE_LONG_16",
        [ REPORT_LUNS              ] = "REPORT_LUNS",
        [ BLANK                    ] = "BLANK",
        [ MAINTENANCE_IN           ] = "MAINTENANCE_IN",
        [ MAINTENANCE_OUT          ] = "MAINTENANCE_OUT",
G
Gerd Hoffmann 已提交
675
        [ MOVE_MEDIUM              ] = "MOVE_MEDIUM",
676
        [ LOAD_UNLOAD              ] = "LOAD_UNLOAD",
G
Gerd Hoffmann 已提交
677 678 679
        [ READ_12                  ] = "READ_12",
        [ WRITE_12                 ] = "WRITE_12",
        [ WRITE_VERIFY_12          ] = "WRITE_VERIFY_12",
680
        [ VERIFY_12                ] = "VERIFY_12",
G
Gerd Hoffmann 已提交
681 682 683 684 685
        [ SEARCH_HIGH_12           ] = "SEARCH_HIGH_12",
        [ SEARCH_EQUAL_12          ] = "SEARCH_EQUAL_12",
        [ SEARCH_LOW_12            ] = "SEARCH_LOW_12",
        [ READ_ELEMENT_STATUS      ] = "READ_ELEMENT_STATUS",
        [ SEND_VOLUME_TAG          ] = "SEND_VOLUME_TAG",
686
        [ READ_DEFECT_DATA_12      ] = "READ_DEFECT_DATA_12",
G
Gerd Hoffmann 已提交
687 688 689 690 691 692 693 694
        [ SET_CD_SPEED             ] = "SET_CD_SPEED",
    };

    if (cmd >= ARRAY_SIZE(names) || names[cmd] == NULL)
        return "*UNKNOWN*";
    return names[cmd];
}

P
Paolo Bonzini 已提交
695 696 697 698 699 700 701 702 703
SCSIRequest *scsi_req_ref(SCSIRequest *req)
{
    req->refcount++;
    return req;
}

void scsi_req_unref(SCSIRequest *req)
{
    if (--req->refcount == 0) {
704 705
        if (req->ops->free_req) {
            req->ops->free_req(req);
P
Paolo Bonzini 已提交
706 707 708 709 710
        }
        qemu_free(req);
    }
}

711 712 713 714 715 716
/* Tell the device that we finished processing this chunk of I/O.  It
   will start the next chunk or complete the command.  */
void scsi_req_continue(SCSIRequest *req)
{
    trace_scsi_req_continue(req->dev->id, req->lun, req->tag);
    if (req->cmd.mode == SCSI_XFER_TO_DEV) {
717
        req->ops->write_data(req);
718
    } else {
719
        req->ops->read_data(req);
720 721 722
    }
}

P
Paolo Bonzini 已提交
723 724
/* Called by the devices when data is ready for the HBA.  The HBA should
   start a DMA operation to read or fill the device's data buffer.
725
   Once it completes, calling scsi_req_continue will restart I/O.  */
P
Paolo Bonzini 已提交
726 727 728
void scsi_req_data(SCSIRequest *req, int len)
{
    trace_scsi_req_data(req->dev->id, req->lun, req->tag, len);
729
    req->bus->ops->transfer_data(req, len);
P
Paolo Bonzini 已提交
730 731
}

G
Gerd Hoffmann 已提交
732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759
void scsi_req_print(SCSIRequest *req)
{
    FILE *fp = stderr;
    int i;

    fprintf(fp, "[%s id=%d] %s",
            req->dev->qdev.parent_bus->name,
            req->dev->id,
            scsi_command_name(req->cmd.buf[0]));
    for (i = 1; i < req->cmd.len; i++) {
        fprintf(fp, " 0x%02x", req->cmd.buf[i]);
    }
    switch (req->cmd.mode) {
    case SCSI_XFER_NONE:
        fprintf(fp, " - none\n");
        break;
    case SCSI_XFER_FROM_DEV:
        fprintf(fp, " - from-dev len=%zd\n", req->cmd.xfer);
        break;
    case SCSI_XFER_TO_DEV:
        fprintf(fp, " - to-dev len=%zd\n", req->cmd.xfer);
        break;
    default:
        fprintf(fp, " - Oops\n");
        break;
    }
}

760
void scsi_req_complete(SCSIRequest *req, int status)
G
Gerd Hoffmann 已提交
761
{
762 763
    assert(req->status == -1);
    req->status = status;
764 765 766 767 768 769 770 771 772 773 774

    assert(req->sense_len < sizeof(req->sense));
    if (status == GOOD) {
        req->sense_len = 0;
    }

    if (req->sense_len) {
        memcpy(req->dev->sense, req->sense, req->sense_len);
    }
    req->dev->sense_len = req->sense_len;

P
Paolo Bonzini 已提交
775
    scsi_req_ref(req);
776
    scsi_req_dequeue(req);
777
    req->bus->ops->complete(req, req->status);
P
Paolo Bonzini 已提交
778
    scsi_req_unref(req);
G
Gerd Hoffmann 已提交
779
}
780

P
Paolo Bonzini 已提交
781 782
void scsi_req_cancel(SCSIRequest *req)
{
783 784
    if (req->ops->cancel_io) {
        req->ops->cancel_io(req);
P
Paolo Bonzini 已提交
785 786 787 788 789 790 791 792 793
    }
    scsi_req_ref(req);
    scsi_req_dequeue(req);
    if (req->bus->ops->cancel) {
        req->bus->ops->cancel(req);
    }
    scsi_req_unref(req);
}

P
Paolo Bonzini 已提交
794 795
void scsi_req_abort(SCSIRequest *req, int status)
{
796 797
    if (req->ops->cancel_io) {
        req->ops->cancel_io(req);
P
Paolo Bonzini 已提交
798
    }
799
    scsi_req_complete(req, status);
P
Paolo Bonzini 已提交
800 801
}

P
Paolo Bonzini 已提交
802 803 804 805 806 807
void scsi_device_purge_requests(SCSIDevice *sdev)
{
    SCSIRequest *req;

    while (!QTAILQ_EMPTY(&sdev->requests)) {
        req = QTAILQ_FIRST(&sdev->requests);
P
Paolo Bonzini 已提交
808
        scsi_req_cancel(req);
P
Paolo Bonzini 已提交
809 810 811
    }
}

812 813
static char *scsibus_get_fw_dev_path(DeviceState *dev)
{
Z
Zhi Yong Wu 已提交
814
    SCSIDevice *d = DO_UPCAST(SCSIDevice, qdev, dev);
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
    SCSIBus *bus = scsi_bus_from_device(d);
    char path[100];
    int i;

    for (i = 0; i < bus->ndev; i++) {
        if (bus->devs[i] == d) {
            break;
        }
    }

    assert(i != bus->ndev);

    snprintf(path, sizeof(path), "%s@%x", qdev_fw_name(dev), i);

    return strdup(path);
}