hw/scsi-bus.c

   1 #include "hw.h"
   2 #include "sysemu.h"
   3 #include "scsi.h"
   4 #include "scsi-defs.h"
   5 #include "block.h"
   6 #include "qdev.h"
   7
   8 static struct BusInfo scsi_bus_info = {
   9     .name  = "SCSI",
  10     .size  = sizeof(SCSIBus),
  11     .props = (Property[]) {
  12         DEFINE_PROP_UINT32("scsi-id", SCSIDevice, id, -1),
  13         DEFINE_PROP_END_OF_LIST(),
  14     },
  15 };
  16 static int next_scsi_bus;
  17
  18 /* Create a scsi bus, and attach devices to it.  */
  19 void scsi_bus_new(SCSIBus *bus, DeviceState *host, int tcq, int ndev,
  20                   scsi_completionfn complete)
  21 {
  22     qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
  23     bus->busnr = next_scsi_bus++;
  24     bus->tcq = tcq;
  25     bus->ndev = ndev;
  26     bus->complete = complete;
  27     bus->qbus.allow_hotplug = 1;
  28 }
  29
  30 static int scsi_qdev_init(DeviceState *qdev, DeviceInfo *base)
  31 {
  32     SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev);
  33     SCSIDeviceInfo *info = DO_UPCAST(SCSIDeviceInfo, qdev, base);
  34     SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus);
  35     int rc = -1;
  36
  37     if (dev->id == -1) {
  38         for (dev->id = 0; dev->id < bus->ndev; dev->id++) {
  39             if (bus->devs[dev->id] == NULL)
  40                 break;
  41         }
  42     }
  43     if (dev->id >= bus->ndev) {
  44         qemu_error("bad scsi device id: %d\n", dev->id);
  45         goto err;
  46     }
  47
  48     if (bus->devs[dev->id]) {
  49         qdev_free(&bus->devs[dev->id]->qdev);
  50     }
  51     bus->devs[dev->id] = dev;
  52
  53     dev->info = info;
  54     QTAILQ_INIT(&dev->requests);
  55     rc = dev->info->init(dev);
  56     if (rc != 0) {
  57         bus->devs[dev->id] = NULL;
  58     }
  59
  60 err:
  61     return rc;
  62 }
  63
  64 static int scsi_qdev_exit(DeviceState *qdev)
  65 {
  66     SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev);
  67     SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus);
  68
  69     assert(bus->devs[dev->id] != NULL);
  70     if (bus->devs[dev->id]->info->destroy) {
  71         bus->devs[dev->id]->info->destroy(bus->devs[dev->id]);
  72     }
  73     bus->devs[dev->id] = NULL;
  74     return 0;
  75 }
  76
  77 void scsi_qdev_register(SCSIDeviceInfo *info)
  78 {
  79     info->qdev.bus_info = &scsi_bus_info;
  80     info->qdev.init     = scsi_qdev_init;
  81     info->qdev.unplug   = qdev_simple_unplug_cb;
  82     info->qdev.exit     = scsi_qdev_exit;
  83     qdev_register(&info->qdev);
  84 }
  85
  86 /* handle legacy '-drive if=scsi,...' cmd line args */
  87 /* FIXME callers should check for failure, but don't */
  88 SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, DriveInfo *dinfo, int unit)
  89 {
  90     const char *driver;
  91     DeviceState *dev;
  92
  93     driver = bdrv_is_sg(dinfo->bdrv) ? "scsi-generic" : "scsi-disk";
  94     dev = qdev_create(&bus->qbus, driver);
  95     qdev_prop_set_uint32(dev, "scsi-id", unit);
  96     qdev_prop_set_drive(dev, "drive", dinfo);
  97     if (qdev_init(dev) < 0)
  98         return NULL;
  99     return DO_UPCAST(SCSIDevice, qdev, dev);
 100 }
 101
 102 void scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
 103 {
 104     DriveInfo *dinfo;
 105     int unit;
 106
 107     for (unit = 0; unit < MAX_SCSI_DEVS; unit++) {
 108         dinfo = drive_get(IF_SCSI, bus->busnr, unit);
 109         if (dinfo == NULL) {
 110             continue;
 111         }
 112         scsi_bus_legacy_add_drive(bus, dinfo, unit);
 113     }
 114 }
 115
 116 void scsi_dev_clear_sense(SCSIDevice *dev)
 117 {
 118     memset(&dev->sense, 0, sizeof(dev->sense));
 119 }
 120
 121 void scsi_dev_set_sense(SCSIDevice *dev, uint8_t key)
 122 {
 123     dev->sense.key = key;
 124 }
 125
 126 SCSIRequest *scsi_req_alloc(size_t size, SCSIDevice *d, uint32_t tag, uint32_t lun)
 127 {
 128     SCSIRequest *req;
 129
 130     req = qemu_mallocz(size);
 131     req->bus = scsi_bus_from_device(d);
 132     req->dev = d;
 133     req->tag = tag;
 134     req->lun = lun;
 135     QTAILQ_INSERT_TAIL(&d->requests, req, next);
 136     return req;
 137 }
 138
 139 SCSIRequest *scsi_req_find(SCSIDevice *d, uint32_t tag)
 140 {
 141     SCSIRequest *req;
 142
 143     QTAILQ_FOREACH(req, &d->requests, next) {
 144         if (req->tag == tag) {
 145             return req;
 146         }
 147     }
 148     return NULL;
 149 }
 150
 151 void scsi_req_free(SCSIRequest *req)
 152 {
 153     QTAILQ_REMOVE(&req->dev->requests, req, next);
 154     qemu_free(req);
 155 }
 156
 157 static int scsi_req_length(SCSIRequest *req, uint8_t *cmd)
 158 {
 159     switch (cmd[0] >> 5) {
 160     case 0:
 161         req->cmd.xfer = cmd[4];
 162         req->cmd.len = 6;
 163         /* length 0 means 256 blocks */
 164         if (req->cmd.xfer == 0)
 165             req->cmd.xfer = 256;
 166         break;
 167     case 1:
 168     case 2:
 169         req->cmd.xfer = cmd[8] | (cmd[7] << 8);
 170         req->cmd.len = 10;
 171         break;
 172     case 4:
 173         req->cmd.xfer = cmd[13] | (cmd[12] << 8) | (cmd[11] << 16) | (cmd[10] << 24);
 174         req->cmd.len = 16;
 175         break;
 176     case 5:
 177         req->cmd.xfer = cmd[9] | (cmd[8] << 8) | (cmd[7] << 16) | (cmd[6] << 24);
 178         req->cmd.len = 12;
 179         break;
 180     default:
 181         return -1;
 182     }
 183
 184     switch(cmd[0]) {
 185     case TEST_UNIT_READY:
 186     case REZERO_UNIT:
 187     case START_STOP:
 188     case SEEK_6:
 189     case WRITE_FILEMARKS:
 190     case SPACE:
 191     case ERASE:
 192     case ALLOW_MEDIUM_REMOVAL:
 193     case VERIFY:
 194     case SEEK_10:
 195     case SYNCHRONIZE_CACHE:
 196     case LOCK_UNLOCK_CACHE:
 197     case LOAD_UNLOAD:
 198     case SET_CD_SPEED:
 199     case SET_LIMITS:
 200     case WRITE_LONG:
 201     case MOVE_MEDIUM:
 202     case UPDATE_BLOCK:
 203         req->cmd.xfer = 0;
 204         break;
 205     case MODE_SENSE:
 206         break;
 207     case WRITE_SAME:
 208         req->cmd.xfer = 1;
 209         break;
 210     case READ_CAPACITY:
 211         req->cmd.xfer = 8;
 212         break;
 213     case READ_BLOCK_LIMITS:
 214         req->cmd.xfer = 6;
 215         break;
 216     case READ_POSITION:
 217         req->cmd.xfer = 20;
 218         break;
 219     case SEND_VOLUME_TAG:
 220         req->cmd.xfer *= 40;
 221         break;
 222     case MEDIUM_SCAN:
 223         req->cmd.xfer *= 8;
 224         break;
 225     case WRITE_10:
 226     case WRITE_VERIFY:
 227     case WRITE_6:
 228     case WRITE_12:
 229     case WRITE_VERIFY_12:
 230         req->cmd.xfer *= req->dev->blocksize;
 231         break;
 232     case READ_10:
 233     case READ_6:
 234     case READ_REVERSE:
 235     case RECOVER_BUFFERED_DATA:
 236     case READ_12:
 237         req->cmd.xfer *= req->dev->blocksize;
 238         break;
 239     case INQUIRY:
 240         req->cmd.xfer = cmd[4] | (cmd[3] << 8);
 241         break;
 242     }
 243     return 0;
 244 }
 245
 246 static int scsi_req_stream_length(SCSIRequest *req, uint8_t *cmd)
 247 {
 248     switch(cmd[0]) {
 249     /* stream commands */
 250     case READ_6:
 251     case READ_REVERSE:
 252     case RECOVER_BUFFERED_DATA:
 253     case WRITE_6:
 254         req->cmd.len = 6;
 255         req->cmd.xfer = cmd[4] | (cmd[3] << 8) | (cmd[2] << 16);
 256         if (cmd[1] & 0x01) /* fixed */
 257             req->cmd.xfer *= req->dev->blocksize;
 258         break;
 259     case REWIND:
 260     case START_STOP:
 261         req->cmd.len = 6;
 262         req->cmd.xfer = 0;
 263         break;
 264     /* generic commands */
 265     default:
 266         return scsi_req_length(req, cmd);
 267     }
 268     return 0;
 269 }
 270
 271 static void scsi_req_xfer_mode(SCSIRequest *req)
 272 {
 273     switch (req->cmd.buf[0]) {
 274     case WRITE_6:
 275     case WRITE_10:
 276     case WRITE_VERIFY:
 277     case WRITE_12:
 278     case WRITE_VERIFY_12:
 279     case COPY:
 280     case COPY_VERIFY:
 281     case COMPARE:
 282     case CHANGE_DEFINITION:
 283     case LOG_SELECT:
 284     case MODE_SELECT:
 285     case MODE_SELECT_10:
 286     case SEND_DIAGNOSTIC:
 287     case WRITE_BUFFER:
 288     case FORMAT_UNIT:
 289     case REASSIGN_BLOCKS:
 290     case RESERVE:
 291     case SEARCH_EQUAL:
 292     case SEARCH_HIGH:
 293     case SEARCH_LOW:
 294     case UPDATE_BLOCK:
 295     case WRITE_LONG:
 296     case WRITE_SAME:
 297     case SEARCH_HIGH_12:
 298     case SEARCH_EQUAL_12:
 299     case SEARCH_LOW_12:
 300     case SET_WINDOW:
 301     case MEDIUM_SCAN:
 302     case SEND_VOLUME_TAG:
 303     case WRITE_LONG_2:
 304         req->cmd.mode = SCSI_XFER_TO_DEV;
 305         break;
 306     default:
 307         if (req->cmd.xfer)
 308             req->cmd.mode = SCSI_XFER_FROM_DEV;
 309         else {
 310             req->cmd.mode = SCSI_XFER_NONE;
 311         }
 312         break;
 313     }
 314 }
 315
 316 static uint64_t scsi_req_lba(SCSIRequest *req)
 317 {
 318     uint8_t *buf = req->cmd.buf;
 319     uint64_t lba;
 320
 321     switch (buf[0] >> 5) {
 322     case 0:
 323         lba = (uint64_t) buf[3] | ((uint64_t) buf[2] << 8) |
 324               (((uint64_t) buf[1] & 0x1f) << 16);
 325         break;
 326     case 1:
 327     case 2:
 328         lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) |
 329               ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24);
 330         break;
 331     case 4:
 332         lba = (uint64_t) buf[9] | ((uint64_t) buf[8] << 8) |
 333               ((uint64_t) buf[7] << 16) | ((uint64_t) buf[6] << 24) |
 334               ((uint64_t) buf[5] << 32) | ((uint64_t) buf[4] << 40) |
 335               ((uint64_t) buf[3] << 48) | ((uint64_t) buf[2] << 56);
 336         break;
 337     case 5:
 338         lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) |
 339               ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24);
 340         break;
 341     default:
 342         lba = -1;
 343
 344     }
 345     return lba;
 346 }
 347
 348 int scsi_req_parse(SCSIRequest *req, uint8_t *buf)
 349 {
 350     int rc;
 351
 352     if (req->dev->type == TYPE_TAPE) {
 353         rc = scsi_req_stream_length(req, buf);
 354     } else {
 355         rc = scsi_req_length(req, buf);
 356     }
 357     if (rc != 0)
 358         return rc;
 359
 360     memcpy(req->cmd.buf, buf, req->cmd.len);
 361     scsi_req_xfer_mode(req);
 362     req->cmd.lba = scsi_req_lba(req);
 363     return 0;
 364 }