[mirror_qemu.git] / hw / scsi-bus.c

#include "hw.h"
#include "sysemu.h"
#include "scsi.h"
#include "scsi-defs.h"
#include "block.h"
#include "qdev.h"

static struct BusInfo scsi_bus_info = {
    .name  = "SCSI",
    .size  = sizeof(SCSIBus),
    .props = (Property[]) {
        DEFINE_PROP_UINT32("scsi-id", SCSIDevice, id, -1),
        DEFINE_PROP_END_OF_LIST(),
    },
};
static int next_scsi_bus;

/* Create a scsi bus, and attach devices to it.  */
void scsi_bus_new(SCSIBus *bus, DeviceState *host, int tcq, int ndev,
                  scsi_completionfn complete)
{
    qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
    bus->busnr = next_scsi_bus++;
    bus->tcq = tcq;
    bus->ndev = ndev;
    bus->complete = complete;
    bus->qbus.allow_hotplug = 1;
}

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);
    int rc = -1;

    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) {
        qemu_error("bad scsi device id: %d\n", dev->id);
        goto err;
    }

    if (bus->devs[dev->id]) {
        qdev_free(&bus->devs[dev->id]->qdev);
    }
    bus->devs[dev->id] = dev;

    dev->info = info;
    QTAILQ_INIT(&dev->requests);
    rc = dev->info->init(dev);
    if (rc != 0) {
        bus->devs[dev->id] = NULL;
    }

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

void scsi_qdev_register(SCSIDeviceInfo *info)
{
    info->qdev.bus_info = &scsi_bus_info;
    info->qdev.init     = scsi_qdev_init;
    info->qdev.unplug   = qdev_simple_unplug_cb;
    info->qdev.exit     = scsi_qdev_exit;
    qdev_register(&info->qdev);
}

/* handle legacy '-drive if=scsi,...' cmd line args */
/* FIXME callers should check for failure, but don't */
SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, DriveInfo *dinfo, int unit)
{
    const char *driver;
    DeviceState *dev;

    driver = bdrv_is_sg(dinfo->bdrv) ? "scsi-generic" : "scsi-disk";
    dev = qdev_create(&bus->qbus, driver);
    qdev_prop_set_uint32(dev, "scsi-id", unit);
    qdev_prop_set_drive(dev, "drive", dinfo);
    if (qdev_init(dev) < 0)
        return NULL;
    return DO_UPCAST(SCSIDevice, qdev, dev);
}

void scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
{
    DriveInfo *dinfo;
    int unit;

    for (unit = 0; unit < MAX_SCSI_DEVS; unit++) {
        dinfo = drive_get(IF_SCSI, bus->busnr, unit);
        if (dinfo == NULL) {
            continue;
        }
        scsi_bus_legacy_add_drive(bus, dinfo, unit);
    }
}

SCSIRequest *scsi_req_alloc(size_t size, SCSIDevice *d, uint32_t tag, uint32_t lun)
{
    SCSIRequest *req;

    req = qemu_mallocz(size);
    req->bus = scsi_bus_from_device(d);
    req->dev = d;
    req->tag = tag;
    req->lun = lun;
    QTAILQ_INSERT_TAIL(&d->requests, req, next);
    return req;
}

SCSIRequest *scsi_req_find(SCSIDevice *d, uint32_t tag)
{
    SCSIRequest *req;

    QTAILQ_FOREACH(req, &d->requests, next) {
        if (req->tag == tag) {
            return req;
        }
    }
    return NULL;
}

void scsi_req_free(SCSIRequest *req)
{
    QTAILQ_REMOVE(&req->dev->requests, req, next);
    qemu_free(req);
}

static int scsi_req_length(SCSIRequest *req, uint8_t *cmd)
{
    switch (cmd[0] >> 5) {
    case 0:
        req->cmd.xfer = cmd[4];
        req->cmd.len = 6;
        /* length 0 means 256 blocks */
        if (req->cmd.xfer == 0)
            req->cmd.xfer = 256;
        break;
    case 1:
    case 2:
        req->cmd.xfer = cmd[8] | (cmd[7] << 8);
        req->cmd.len = 10;
        break;
    case 4:
        req->cmd.xfer = cmd[13] | (cmd[12] << 8) | (cmd[11] << 16) | (cmd[10] << 24);
        req->cmd.len = 16;
        break;
    case 5:
        req->cmd.xfer = cmd[9] | (cmd[8] << 8) | (cmd[7] << 16) | (cmd[6] << 24);
        req->cmd.len = 12;
        break;
    default:
        return -1;
    }

    switch(cmd[0]) {
    case TEST_UNIT_READY:
    case REZERO_UNIT:
    case START_STOP:
    case SEEK_6:
    case WRITE_FILEMARKS:
    case SPACE:
    case ERASE:
    case ALLOW_MEDIUM_REMOVAL:
    case VERIFY:
    case SEEK_10:
    case SYNCHRONIZE_CACHE:
    case LOCK_UNLOCK_CACHE:
    case LOAD_UNLOAD:
    case SET_CD_SPEED:
    case SET_LIMITS:
    case WRITE_LONG:
    case MOVE_MEDIUM:
    case UPDATE_BLOCK:
        req->cmd.xfer = 0;
        break;
    case MODE_SENSE:
        break;
    case WRITE_SAME:
        req->cmd.xfer = 1;
        break;
    case READ_CAPACITY:
        req->cmd.xfer = 8;
        break;
    case READ_BLOCK_LIMITS:
        req->cmd.xfer = 6;
        break;
    case READ_POSITION:
        req->cmd.xfer = 20;
        break;
    case SEND_VOLUME_TAG:
        req->cmd.xfer *= 40;
        break;
    case MEDIUM_SCAN:
        req->cmd.xfer *= 8;
        break;
    case WRITE_10:
    case WRITE_VERIFY:
    case WRITE_6:
    case WRITE_12:
    case WRITE_VERIFY_12:
        req->cmd.xfer *= req->dev->blocksize;
        break;
    case READ_10:
    case READ_6:
    case READ_REVERSE:
    case RECOVER_BUFFERED_DATA:
    case READ_12:
        req->cmd.xfer *= req->dev->blocksize;
        break;
    case INQUIRY:
        req->cmd.xfer = cmd[4] | (cmd[3] << 8);
        break;
    }
    return 0;
}

static int scsi_req_stream_length(SCSIRequest *req, uint8_t *cmd)
{
    switch(cmd[0]) {
    /* stream commands */
    case READ_6:
    case READ_REVERSE:
    case RECOVER_BUFFERED_DATA:
    case WRITE_6:
        req->cmd.len = 6;
        req->cmd.xfer = cmd[4] | (cmd[3] << 8) | (cmd[2] << 16);
        if (cmd[1] & 0x01) /* fixed */
            req->cmd.xfer *= req->dev->blocksize;
        break;
    case REWIND:
    case START_STOP:
        req->cmd.len = 6;
        req->cmd.xfer = 0;
        break;
    /* generic commands */
    default:
        return scsi_req_length(req, cmd);
    }
    return 0;
}

static uint64_t scsi_req_lba(SCSIRequest *req)
{
    uint8_t *buf = req->cmd.buf;
    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;
}

int scsi_req_parse(SCSIRequest *req, uint8_t *buf)
{
    int rc;

    if (req->dev->type == TYPE_TAPE) {
        rc = scsi_req_stream_length(req, buf);
    } else {
        rc = scsi_req_length(req, buf);
    }
    if (rc != 0)
        return rc;

    memcpy(req->cmd.buf, buf, req->cmd.len);
    req->cmd.lba = scsi_req_lba(req);
    return 0;
}
Commit	Line	Data
d52affa7 GH	1	#include "hw.h"
d52affa7 GH	2	#include "sysemu.h"
43b443b6	3	#include "scsi.h"
2ec749cb	4	#include "scsi-defs.h"
d52affa7 GH	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. */
ca9c39fa GH	19	void scsi_bus_new(SCSIBus bus, DeviceState host, int tcq, int ndev,
ca9c39fa GH	20	scsi_completionfn complete)
d52affa7	21	{
ca9c39fa	22	qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
d52affa7 GH	23	bus->busnr = next_scsi_bus++;
	24	bus->tcq = tcq;
	25	bus->ndev = ndev;
	26	bus->complete = complete;
cb23117b	27	bus->qbus.allow_hotplug = 1;
d52affa7 GH	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);
01985dcf	35	int rc = -1;
d52affa7 GH	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]) {
01985dcf	49	qdev_free(&bus->devs[dev->id]->qdev);
d52affa7 GH	50	}
	51	bus->devs[dev->id] = dev;
	52
	53	dev->info = info;
9af99d98	54	QTAILQ_INIT(&dev->requests);
01985dcf GH	55	rc = dev->info->init(dev);
	56	if (rc != 0) {
	57	bus->devs[dev->id] = NULL;
	58	}
d52affa7 GH	59
d52affa7 GH	60	err:
01985dcf GH	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;
d52affa7 GH	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;
cb23117b	81	info->qdev.unplug = qdev_simple_unplug_cb;
01985dcf	82	info->qdev.exit = scsi_qdev_exit;
d52affa7 GH	83	qdev_register(&info->qdev);
	84	}
	85
	86	/* handle legacy '-drive if=scsi,...' cmd line args */
33e66b86	87	/* FIXME callers should check for failure, but don't */
d52affa7 GH	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);
33e66b86 MA	97	if (qdev_init(dev) < 0)
33e66b86 MA	98	return NULL;
d52affa7 GH	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	}
89b08ae1 GH	115
	116	SCSIRequest scsi_req_alloc(size_t size, SCSIDevice d, uint32_t tag, uint32_t lun)
	117	{
	118	SCSIRequest *req;
	119
	120	req = qemu_mallocz(size);
	121	req->bus = scsi_bus_from_device(d);
	122	req->dev = d;
	123	req->tag = tag;
	124	req->lun = lun;
	125	QTAILQ_INSERT_TAIL(&d->requests, req, next);
	126	return req;
	127	}
	128
	129	SCSIRequest scsi_req_find(SCSIDevice d, uint32_t tag)
	130	{
	131	SCSIRequest *req;
	132
	133	QTAILQ_FOREACH(req, &d->requests, next) {
	134	if (req->tag == tag) {
	135	return req;
	136	}
	137	}
	138	return NULL;
	139	}
	140
	141	void scsi_req_free(SCSIRequest *req)
	142	{
	143	QTAILQ_REMOVE(&req->dev->requests, req, next);
	144	qemu_free(req);
	145	}
2ec749cb GH	146
	147	static int scsi_req_length(SCSIRequest req, uint8_t cmd)
	148	{
	149	switch (cmd[0] >> 5) {
	150	case 0:
	151	req->cmd.xfer = cmd[4];
	152	req->cmd.len = 6;
	153	/* length 0 means 256 blocks */
	154	if (req->cmd.xfer == 0)
	155	req->cmd.xfer = 256;
	156	break;
	157	case 1:
	158	case 2:
	159	req->cmd.xfer = cmd[8] \| (cmd[7] << 8);
	160	req->cmd.len = 10;
	161	break;
	162	case 4:
	163	req->cmd.xfer = cmd[13] \| (cmd[12] << 8) \| (cmd[11] << 16) \| (cmd[10] << 24);
	164	req->cmd.len = 16;
	165	break;
	166	case 5:
	167	req->cmd.xfer = cmd[9] \| (cmd[8] << 8) \| (cmd[7] << 16) \| (cmd[6] << 24);
	168	req->cmd.len = 12;
	169	break;
	170	default:
	171	return -1;
	172	}
	173
	174	switch(cmd[0]) {
	175	case TEST_UNIT_READY:
	176	case REZERO_UNIT:
	177	case START_STOP:
	178	case SEEK_6:
	179	case WRITE_FILEMARKS:
	180	case SPACE:
	181	case ERASE:
	182	case ALLOW_MEDIUM_REMOVAL:
	183	case VERIFY:
	184	case SEEK_10:
	185	case SYNCHRONIZE_CACHE:
	186	case LOCK_UNLOCK_CACHE:
	187	case LOAD_UNLOAD:
	188	case SET_CD_SPEED:
	189	case SET_LIMITS:
	190	case WRITE_LONG:
	191	case MOVE_MEDIUM:
	192	case UPDATE_BLOCK:
	193	req->cmd.xfer = 0;
	194	break;
	195	case MODE_SENSE:
	196	break;
	197	case WRITE_SAME:
	198	req->cmd.xfer = 1;
	199	break;
	200	case READ_CAPACITY:
	201	req->cmd.xfer = 8;
	202	break;
	203	case READ_BLOCK_LIMITS:
	204	req->cmd.xfer = 6;
	205	break;
	206	case READ_POSITION:
	207	req->cmd.xfer = 20;
	208	break;
	209	case SEND_VOLUME_TAG:
210	req->cmd.xfer *= 40;
211	break;
212	case MEDIUM_SCAN:
213	req->cmd.xfer *= 8;
214	break;
215	case WRITE_10:
216	case WRITE_VERIFY:
217	case WRITE_6:
218	case WRITE_12:
219	case WRITE_VERIFY_12:
220	req->cmd.xfer *= req->dev->blocksize;
221	break;
222	case READ_10:
223	case READ_6:
224	case READ_REVERSE:
225	case RECOVER_BUFFERED_DATA:
226	case READ_12:
227	req->cmd.xfer *= req->dev->blocksize;
228	break;
229	case INQUIRY:
230	req->cmd.xfer = cmd[4] \| (cmd[3] << 8);
231	break;
232	}
233	return 0;
234	}
235
236	static int scsi_req_stream_length(SCSIRequest req, uint8_t cmd)
237	{
238	switch(cmd[0]) {
239	/* stream commands */
240	case READ_6:
241	case READ_REVERSE:
242	case RECOVER_BUFFERED_DATA:
243	case WRITE_6:
244	req->cmd.len = 6;
245	req->cmd.xfer = cmd[4] \| (cmd[3] << 8) \| (cmd[2] << 16);
246	if (cmd[1] & 0x01) /* fixed */
247	req->cmd.xfer *= req->dev->blocksize;
248	break;
249	case REWIND:
250	case START_STOP:
251	req->cmd.len = 6;
252	req->cmd.xfer = 0;
253	break;
254	/* generic commands */
255	default:
256	return scsi_req_length(req, cmd);
257	}
258	return 0;
259	}
260
261	static uint64_t scsi_req_lba(SCSIRequest *req)
262	{
263	uint8_t *buf = req->cmd.buf;
264	uint64_t lba;
265
266	switch (buf[0] >> 5) {
267	case 0:
268	lba = (uint64_t) buf[3] \| ((uint64_t) buf[2] << 8) \|
269	(((uint64_t) buf[1] & 0x1f) << 16);
270	break;
271	case 1:
272	case 2:
273	lba = (uint64_t) buf[5] \| ((uint64_t) buf[4] << 8) \|
274	((uint64_t) buf[3] << 16) \| ((uint64_t) buf[2] << 24);
275	break;
276	case 4:
277	lba = (uint64_t) buf[9] \| ((uint64_t) buf[8] << 8) \|
278	((uint64_t) buf[7] << 16) \| ((uint64_t) buf[6] << 24) \|
279	((uint64_t) buf[5] << 32) \| ((uint64_t) buf[4] << 40) \|
280	((uint64_t) buf[3] << 48) \| ((uint64_t) buf[2] << 56);
281	break;
282	case 5:
283	lba = (uint64_t) buf[5] \| ((uint64_t) buf[4] << 8) \|
284	((uint64_t) buf[3] << 16) \| ((uint64_t) buf[2] << 24);
285	break;
286	default:
287	lba = -1;
288
289	}
290	return lba;
291	}
292
293	int scsi_req_parse(SCSIRequest req, uint8_t buf)
294	{
295	int rc;
296
297	if (req->dev->type == TYPE_TAPE) {
298	rc = scsi_req_stream_length(req, buf);
299	} else {
300	rc = scsi_req_length(req, buf);
301	}
302	if (rc != 0)
303	return rc;
304
305	memcpy(req->cmd.buf, buf, req->cmd.len);
306	req->cmd.lba = scsi_req_lba(req);
307	return 0;
308	}