]> git.proxmox.com Git - qemu.git/blame - hw/scsi-bus.c
scsi: move handling of REPORT LUNS and invalid LUNs to common code
[qemu.git] / hw / scsi-bus.c
CommitLineData
d52affa7 1#include "hw.h"
2f792016 2#include "qemu-error.h"
43b443b6 3#include "scsi.h"
2ec749cb 4#include "scsi-defs.h"
d52affa7 5#include "qdev.h"
2446333c 6#include "blockdev.h"
5138efec 7#include "trace.h"
d52affa7 8
db07c0f8 9static char *scsibus_get_fw_dev_path(DeviceState *dev);
afa46c46 10static int scsi_req_parse(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf);
b45ef674
PB
11static int scsi_build_sense(uint8_t *in_buf, int in_len,
12 uint8_t *buf, int len, bool fixed);
db07c0f8 13
d52affa7
GH
14static struct BusInfo scsi_bus_info = {
15 .name = "SCSI",
16 .size = sizeof(SCSIBus),
db07c0f8 17 .get_fw_dev_path = scsibus_get_fw_dev_path,
d52affa7
GH
18 .props = (Property[]) {
19 DEFINE_PROP_UINT32("scsi-id", SCSIDevice, id, -1),
87dcd1b2 20 DEFINE_PROP_UINT32("lun", SCSIDevice, lun, 0),
d52affa7
GH
21 DEFINE_PROP_END_OF_LIST(),
22 },
23};
24static int next_scsi_bus;
25
26/* Create a scsi bus, and attach devices to it. */
ca9c39fa 27void scsi_bus_new(SCSIBus *bus, DeviceState *host, int tcq, int ndev,
cfdc1bb0 28 const SCSIBusOps *ops)
d52affa7 29{
ca9c39fa 30 qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
d52affa7
GH
31 bus->busnr = next_scsi_bus++;
32 bus->tcq = tcq;
33 bus->ndev = ndev;
cfdc1bb0 34 bus->ops = ops;
cb23117b 35 bus->qbus.allow_hotplug = 1;
d52affa7
GH
36}
37
38static int scsi_qdev_init(DeviceState *qdev, DeviceInfo *base)
39{
40 SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev);
41 SCSIDeviceInfo *info = DO_UPCAST(SCSIDeviceInfo, qdev, base);
42 SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus);
01985dcf 43 int rc = -1;
d52affa7
GH
44
45 if (dev->id == -1) {
46 for (dev->id = 0; dev->id < bus->ndev; dev->id++) {
47 if (bus->devs[dev->id] == NULL)
48 break;
49 }
50 }
51 if (dev->id >= bus->ndev) {
1ecda02b 52 error_report("bad scsi device id: %d", dev->id);
d52affa7
GH
53 goto err;
54 }
55
56 if (bus->devs[dev->id]) {
01985dcf 57 qdev_free(&bus->devs[dev->id]->qdev);
d52affa7
GH
58 }
59 bus->devs[dev->id] = dev;
60
61 dev->info = info;
9af99d98 62 QTAILQ_INIT(&dev->requests);
01985dcf
GH
63 rc = dev->info->init(dev);
64 if (rc != 0) {
65 bus->devs[dev->id] = NULL;
66 }
d52affa7
GH
67
68err:
01985dcf
GH
69 return rc;
70}
71
72static int scsi_qdev_exit(DeviceState *qdev)
73{
74 SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev);
75 SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus);
76
77 assert(bus->devs[dev->id] != NULL);
78 if (bus->devs[dev->id]->info->destroy) {
79 bus->devs[dev->id]->info->destroy(bus->devs[dev->id]);
80 }
81 bus->devs[dev->id] = NULL;
82 return 0;
d52affa7
GH
83}
84
85void scsi_qdev_register(SCSIDeviceInfo *info)
86{
87 info->qdev.bus_info = &scsi_bus_info;
88 info->qdev.init = scsi_qdev_init;
cb23117b 89 info->qdev.unplug = qdev_simple_unplug_cb;
01985dcf 90 info->qdev.exit = scsi_qdev_exit;
d52affa7
GH
91 qdev_register(&info->qdev);
92}
93
94/* handle legacy '-drive if=scsi,...' cmd line args */
2d1fd261
SH
95SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, BlockDriverState *bdrv,
96 int unit, bool removable)
d52affa7
GH
97{
98 const char *driver;
99 DeviceState *dev;
100
f8b6cc00 101 driver = bdrv_is_sg(bdrv) ? "scsi-generic" : "scsi-disk";
d52affa7
GH
102 dev = qdev_create(&bus->qbus, driver);
103 qdev_prop_set_uint32(dev, "scsi-id", unit);
2d1fd261
SH
104 if (qdev_prop_exists(dev, "removable")) {
105 qdev_prop_set_bit(dev, "removable", removable);
106 }
18846dee
MA
107 if (qdev_prop_set_drive(dev, "drive", bdrv) < 0) {
108 qdev_free(dev);
109 return NULL;
110 }
33e66b86
MA
111 if (qdev_init(dev) < 0)
112 return NULL;
d52affa7
GH
113 return DO_UPCAST(SCSIDevice, qdev, dev);
114}
115
fa66b909 116int scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
d52affa7 117{
42e766a2 118 Location loc;
d52affa7 119 DriveInfo *dinfo;
fa66b909 120 int res = 0, unit;
d52affa7 121
42e766a2 122 loc_push_none(&loc);
622b520f 123 for (unit = 0; unit < bus->ndev; unit++) {
d52affa7
GH
124 dinfo = drive_get(IF_SCSI, bus->busnr, unit);
125 if (dinfo == NULL) {
126 continue;
127 }
42e766a2 128 qemu_opts_loc_restore(dinfo->opts);
2d1fd261 129 if (!scsi_bus_legacy_add_drive(bus, dinfo->bdrv, unit, false)) {
fa66b909
MA
130 res = -1;
131 break;
132 }
d52affa7 133 }
42e766a2 134 loc_pop(&loc);
fa66b909 135 return res;
d52affa7 136}
89b08ae1 137
afa46c46
PB
138/* SCSIReqOps implementation for invalid commands. */
139
140static int32_t scsi_invalid_command(SCSIRequest *req, uint8_t *buf)
141{
142 scsi_req_build_sense(req, SENSE_CODE(INVALID_OPCODE));
143 scsi_req_complete(req, CHECK_CONDITION);
144 return 0;
145}
146
147struct SCSIReqOps reqops_invalid_opcode = {
148 .size = sizeof(SCSIRequest),
149 .send_command = scsi_invalid_command
150};
151
fdaef069
PB
152/* SCSIReqOps implementation for REPORT LUNS and for commands sent to
153 an invalid LUN. */
154
155typedef struct SCSITargetReq SCSITargetReq;
156
157struct SCSITargetReq {
158 SCSIRequest req;
159 int len;
160 uint8_t buf[64];
161};
162
163static void store_lun(uint8_t *outbuf, int lun)
164{
165 if (lun < 256) {
166 outbuf[1] = lun;
167 return;
168 }
169 outbuf[1] = (lun & 255);
170 outbuf[0] = (lun >> 8) | 0x40;
171}
172
173static bool scsi_target_emulate_report_luns(SCSITargetReq *r)
174{
175 int len;
176 if (r->req.cmd.xfer < 16) {
177 return false;
178 }
179 if (r->req.cmd.buf[2] > 2) {
180 return false;
181 }
182 len = MIN(sizeof r->buf, r->req.cmd.xfer);
183 memset(r->buf, 0, len);
184 if (r->req.dev->lun != 0) {
185 r->buf[3] = 16;
186 r->len = 24;
187 store_lun(&r->buf[16], r->req.dev->lun);
188 } else {
189 r->buf[3] = 8;
190 r->len = 16;
191 }
192 return true;
193}
194
195static bool scsi_target_emulate_inquiry(SCSITargetReq *r)
196{
197 assert(r->req.dev->lun != r->req.lun);
198 if (r->req.cmd.buf[1] & 0x2) {
199 /* Command support data - optional, not implemented */
200 return false;
201 }
202
203 if (r->req.cmd.buf[1] & 0x1) {
204 /* Vital product data */
205 uint8_t page_code = r->req.cmd.buf[2];
206 if (r->req.cmd.xfer < 4) {
207 return false;
208 }
209
210 r->buf[r->len++] = page_code ; /* this page */
211 r->buf[r->len++] = 0x00;
212
213 switch (page_code) {
214 case 0x00: /* Supported page codes, mandatory */
215 {
216 int pages;
217 pages = r->len++;
218 r->buf[r->len++] = 0x00; /* list of supported pages (this page) */
219 r->buf[pages] = r->len - pages - 1; /* number of pages */
220 break;
221 }
222 default:
223 return false;
224 }
225 /* done with EVPD */
226 assert(r->len < sizeof(r->buf));
227 r->len = MIN(r->req.cmd.xfer, r->len);
228 return true;
229 }
230
231 /* Standard INQUIRY data */
232 if (r->req.cmd.buf[2] != 0) {
233 return false;
234 }
235
236 /* PAGE CODE == 0 */
237 if (r->req.cmd.xfer < 5) {
238 return -1;
239 }
240
241 r->len = MIN(r->req.cmd.xfer, 36);
242 memset(r->buf, 0, r->len);
243 if (r->req.lun != 0) {
244 r->buf[0] = TYPE_NO_LUN;
245 } else {
246 r->buf[0] = TYPE_NOT_PRESENT | TYPE_INACTIVE;
247 r->buf[2] = 5; /* Version */
248 r->buf[3] = 2 | 0x10; /* HiSup, response data format */
249 r->buf[4] = r->len - 5; /* Additional Length = (Len - 1) - 4 */
250 r->buf[7] = 0x10 | (r->req.bus->tcq ? 0x02 : 0); /* Sync, TCQ. */
251 memcpy(&r->buf[8], "QEMU ", 8);
252 memcpy(&r->buf[16], "QEMU TARGET ", 16);
253 strncpy((char *) &r->buf[32], QEMU_VERSION, 4);
254 }
255 return true;
256}
257
258static int32_t scsi_target_send_command(SCSIRequest *req, uint8_t *buf)
259{
260 SCSITargetReq *r = DO_UPCAST(SCSITargetReq, req, req);
261
262 switch (buf[0]) {
263 case REPORT_LUNS:
264 if (!scsi_target_emulate_report_luns(r)) {
265 goto illegal_request;
266 }
267 break;
268 case INQUIRY:
269 if (!scsi_target_emulate_inquiry(r)) {
270 goto illegal_request;
271 }
272 break;
273 default:
274 scsi_req_build_sense(req, SENSE_CODE(LUN_NOT_SUPPORTED));
275 scsi_req_complete(req, CHECK_CONDITION);
276 return 0;
277 illegal_request:
278 scsi_req_build_sense(req, SENSE_CODE(INVALID_FIELD));
279 scsi_req_complete(req, CHECK_CONDITION);
280 return 0;
281 }
282
283 if (!r->len) {
284 scsi_req_complete(req, GOOD);
285 }
286 return r->len;
287}
288
289static void scsi_target_read_data(SCSIRequest *req)
290{
291 SCSITargetReq *r = DO_UPCAST(SCSITargetReq, req, req);
292 uint32_t n;
293
294 n = r->len;
295 if (n > 0) {
296 r->len = 0;
297 scsi_req_data(&r->req, n);
298 } else {
299 scsi_req_complete(&r->req, GOOD);
300 }
301}
302
303static uint8_t *scsi_target_get_buf(SCSIRequest *req)
304{
305 SCSITargetReq *r = DO_UPCAST(SCSITargetReq, req, req);
306
307 return r->buf;
308}
309
310struct SCSIReqOps reqops_target_command = {
311 .size = sizeof(SCSITargetReq),
312 .send_command = scsi_target_send_command,
313 .read_data = scsi_target_read_data,
314 .get_buf = scsi_target_get_buf,
315};
316
317
8dbd4574 318SCSIRequest *scsi_req_alloc(SCSIReqOps *reqops, SCSIDevice *d, uint32_t tag,
c5bf71a9 319 uint32_t lun, void *hba_private)
89b08ae1
GH
320{
321 SCSIRequest *req;
322
8dbd4574 323 req = qemu_mallocz(reqops->size);
5c6c0e51 324 req->refcount = 1;
89b08ae1
GH
325 req->bus = scsi_bus_from_device(d);
326 req->dev = d;
327 req->tag = tag;
328 req->lun = lun;
c5bf71a9 329 req->hba_private = hba_private;
ed3a34a3 330 req->status = -1;
b45ef674 331 req->sense_len = 0;
8dbd4574 332 req->ops = reqops;
5138efec 333 trace_scsi_req_alloc(req->dev->id, req->lun, req->tag);
89b08ae1
GH
334 return req;
335}
336
c5bf71a9 337SCSIRequest *scsi_req_new(SCSIDevice *d, uint32_t tag, uint32_t lun,
c39ce112 338 uint8_t *buf, void *hba_private)
43a2b339 339{
c39ce112 340 SCSIRequest *req;
afa46c46
PB
341 SCSICommand cmd;
342
343 if (scsi_req_parse(&cmd, d, buf) != 0) {
344 trace_scsi_req_parse_bad(d->id, lun, tag, buf[0]);
345 req = scsi_req_alloc(&reqops_invalid_opcode, d, tag, lun, hba_private);
346 } else {
347 trace_scsi_req_parsed(d->id, lun, tag, buf[0],
348 cmd.mode, cmd.xfer);
349 if (req->cmd.lba != -1) {
350 trace_scsi_req_parsed_lba(d->id, lun, tag, buf[0],
351 cmd.lba);
352 }
fdaef069
PB
353
354 if ((lun != d->lun && buf[0] != REQUEST_SENSE) ||
355 buf[0] == REPORT_LUNS) {
356 req = scsi_req_alloc(&reqops_target_command, d, tag, lun,
357 hba_private);
358 } else {
359 req = d->info->alloc_req(d, tag, lun, hba_private);
360 }
afa46c46
PB
361 }
362
363 req->cmd = cmd;
c39ce112 364 return req;
43a2b339
PB
365}
366
0c34459b
PB
367uint8_t *scsi_req_get_buf(SCSIRequest *req)
368{
12010e7b 369 return req->ops->get_buf(req);
0c34459b
PB
370}
371
74382217
HR
372int scsi_req_get_sense(SCSIRequest *req, uint8_t *buf, int len)
373{
b45ef674
PB
374 assert(len >= 14);
375 if (!req->sense_len) {
74382217
HR
376 return 0;
377 }
b45ef674
PB
378 return scsi_build_sense(req->sense, req->sense_len, buf, len, true);
379}
380
381int scsi_device_get_sense(SCSIDevice *dev, uint8_t *buf, int len, bool fixed)
382{
383 return scsi_build_sense(dev->sense, dev->sense_len, buf, len, fixed);
384}
385
386void scsi_req_build_sense(SCSIRequest *req, SCSISense sense)
387{
388 trace_scsi_req_build_sense(req->dev->id, req->lun, req->tag,
389 sense.key, sense.asc, sense.ascq);
390 memset(req->sense, 0, 18);
391 req->sense[0] = 0xf0;
392 req->sense[2] = sense.key;
393 req->sense[12] = sense.asc;
394 req->sense[13] = sense.ascq;
395 req->sense_len = 18;
74382217
HR
396}
397
c39ce112 398int32_t scsi_req_enqueue(SCSIRequest *req)
89b08ae1 399{
fc4f0754
PB
400 int32_t rc;
401
5c6c0e51
HR
402 assert(!req->enqueued);
403 scsi_req_ref(req);
404 req->enqueued = true;
405 QTAILQ_INSERT_TAIL(&req->dev->requests, req, next);
fc4f0754
PB
406
407 scsi_req_ref(req);
c39ce112 408 rc = req->ops->send_command(req, req->cmd.buf);
fc4f0754
PB
409 scsi_req_unref(req);
410 return rc;
89b08ae1
GH
411}
412
a1f0cce2 413static void scsi_req_dequeue(SCSIRequest *req)
e8637c90 414{
5138efec 415 trace_scsi_req_dequeue(req->dev->id, req->lun, req->tag);
e8637c90
JK
416 if (req->enqueued) {
417 QTAILQ_REMOVE(&req->dev->requests, req, next);
418 req->enqueued = false;
ad2d30f7 419 scsi_req_unref(req);
e8637c90
JK
420 }
421}
422
2599aece 423static int scsi_req_length(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
2ec749cb 424{
2599aece 425 switch (buf[0] >> 5) {
2ec749cb 426 case 0:
2599aece
PB
427 cmd->xfer = buf[4];
428 cmd->len = 6;
2ec749cb 429 /* length 0 means 256 blocks */
2599aece
PB
430 if (cmd->xfer == 0) {
431 cmd->xfer = 256;
432 }
2ec749cb
GH
433 break;
434 case 1:
435 case 2:
2599aece
PB
436 cmd->xfer = buf[8] | (buf[7] << 8);
437 cmd->len = 10;
2ec749cb
GH
438 break;
439 case 4:
2599aece
PB
440 cmd->xfer = buf[13] | (buf[12] << 8) | (buf[11] << 16) | (buf[10] << 24);
441 cmd->len = 16;
2ec749cb
GH
442 break;
443 case 5:
2599aece
PB
444 cmd->xfer = buf[9] | (buf[8] << 8) | (buf[7] << 16) | (buf[6] << 24);
445 cmd->len = 12;
2ec749cb
GH
446 break;
447 default:
448 return -1;
449 }
450
2599aece 451 switch (buf[0]) {
2ec749cb 452 case TEST_UNIT_READY:
5e30a07d 453 case REWIND:
2ec749cb
GH
454 case START_STOP:
455 case SEEK_6:
456 case WRITE_FILEMARKS:
457 case SPACE:
a5e3d9ef
BK
458 case RESERVE:
459 case RELEASE:
2ec749cb
GH
460 case ERASE:
461 case ALLOW_MEDIUM_REMOVAL:
5e30a07d 462 case VERIFY_10:
2ec749cb
GH
463 case SEEK_10:
464 case SYNCHRONIZE_CACHE:
465 case LOCK_UNLOCK_CACHE:
466 case LOAD_UNLOAD:
467 case SET_CD_SPEED:
468 case SET_LIMITS:
5e30a07d 469 case WRITE_LONG_10:
2ec749cb
GH
470 case MOVE_MEDIUM:
471 case UPDATE_BLOCK:
2599aece 472 cmd->xfer = 0;
2ec749cb
GH
473 break;
474 case MODE_SENSE:
475 break;
5e30a07d 476 case WRITE_SAME_10:
2599aece 477 cmd->xfer = 1;
2ec749cb 478 break;
5e30a07d 479 case READ_CAPACITY_10:
2599aece 480 cmd->xfer = 8;
2ec749cb
GH
481 break;
482 case READ_BLOCK_LIMITS:
2599aece 483 cmd->xfer = 6;
2ec749cb
GH
484 break;
485 case READ_POSITION:
2599aece 486 cmd->xfer = 20;
2ec749cb
GH
487 break;
488 case SEND_VOLUME_TAG:
2599aece 489 cmd->xfer *= 40;
2ec749cb
GH
490 break;
491 case MEDIUM_SCAN:
2599aece 492 cmd->xfer *= 8;
2ec749cb
GH
493 break;
494 case WRITE_10:
5e30a07d 495 case WRITE_VERIFY_10:
2ec749cb
GH
496 case WRITE_6:
497 case WRITE_12:
498 case WRITE_VERIFY_12:
bd536cf3
GH
499 case WRITE_16:
500 case WRITE_VERIFY_16:
2599aece 501 cmd->xfer *= dev->blocksize;
2ec749cb
GH
502 break;
503 case READ_10:
504 case READ_6:
505 case READ_REVERSE:
506 case RECOVER_BUFFERED_DATA:
507 case READ_12:
bd536cf3 508 case READ_16:
2599aece 509 cmd->xfer *= dev->blocksize;
2ec749cb
GH
510 break;
511 case INQUIRY:
2599aece 512 cmd->xfer = buf[4] | (buf[3] << 8);
2ec749cb 513 break;
c7126d5b
NB
514 case MAINTENANCE_OUT:
515 case MAINTENANCE_IN:
2599aece 516 if (dev->type == TYPE_ROM) {
c7126d5b 517 /* GPCMD_REPORT_KEY and GPCMD_SEND_KEY from multi media commands */
2599aece 518 cmd->xfer = buf[9] | (buf[8] << 8);
c7126d5b
NB
519 }
520 break;
2ec749cb
GH
521 }
522 return 0;
523}
524
2599aece 525static int scsi_req_stream_length(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
2ec749cb 526{
2599aece 527 switch (buf[0]) {
2ec749cb
GH
528 /* stream commands */
529 case READ_6:
530 case READ_REVERSE:
531 case RECOVER_BUFFERED_DATA:
532 case WRITE_6:
2599aece
PB
533 cmd->len = 6;
534 cmd->xfer = buf[4] | (buf[3] << 8) | (buf[2] << 16);
535 if (buf[1] & 0x01) { /* fixed */
536 cmd->xfer *= dev->blocksize;
537 }
2ec749cb
GH
538 break;
539 case REWIND:
540 case START_STOP:
2599aece
PB
541 cmd->len = 6;
542 cmd->xfer = 0;
2ec749cb
GH
543 break;
544 /* generic commands */
545 default:
2599aece 546 return scsi_req_length(cmd, dev, buf);
2ec749cb
GH
547 }
548 return 0;
549}
550
2599aece 551static void scsi_cmd_xfer_mode(SCSICommand *cmd)
97a06435 552{
2599aece 553 switch (cmd->buf[0]) {
97a06435
GH
554 case WRITE_6:
555 case WRITE_10:
5e30a07d 556 case WRITE_VERIFY_10:
97a06435
GH
557 case WRITE_12:
558 case WRITE_VERIFY_12:
bd536cf3
GH
559 case WRITE_16:
560 case WRITE_VERIFY_16:
97a06435
GH
561 case COPY:
562 case COPY_VERIFY:
563 case COMPARE:
564 case CHANGE_DEFINITION:
565 case LOG_SELECT:
566 case MODE_SELECT:
567 case MODE_SELECT_10:
568 case SEND_DIAGNOSTIC:
569 case WRITE_BUFFER:
570 case FORMAT_UNIT:
571 case REASSIGN_BLOCKS:
97a06435
GH
572 case SEARCH_EQUAL:
573 case SEARCH_HIGH:
574 case SEARCH_LOW:
575 case UPDATE_BLOCK:
5e30a07d
HR
576 case WRITE_LONG_10:
577 case WRITE_SAME_10:
97a06435
GH
578 case SEARCH_HIGH_12:
579 case SEARCH_EQUAL_12:
580 case SEARCH_LOW_12:
97a06435
GH
581 case MEDIUM_SCAN:
582 case SEND_VOLUME_TAG:
01bedeba 583 case PERSISTENT_RESERVE_OUT:
c7126d5b 584 case MAINTENANCE_OUT:
2599aece 585 cmd->mode = SCSI_XFER_TO_DEV;
97a06435
GH
586 break;
587 default:
2599aece
PB
588 if (cmd->xfer)
589 cmd->mode = SCSI_XFER_FROM_DEV;
97a06435 590 else {
2599aece 591 cmd->mode = SCSI_XFER_NONE;
97a06435
GH
592 }
593 break;
594 }
595}
596
2599aece 597static uint64_t scsi_cmd_lba(SCSICommand *cmd)
2ec749cb 598{
2599aece 599 uint8_t *buf = cmd->buf;
2ec749cb
GH
600 uint64_t lba;
601
602 switch (buf[0] >> 5) {
603 case 0:
604 lba = (uint64_t) buf[3] | ((uint64_t) buf[2] << 8) |
605 (((uint64_t) buf[1] & 0x1f) << 16);
606 break;
607 case 1:
608 case 2:
609 lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) |
610 ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24);
611 break;
612 case 4:
613 lba = (uint64_t) buf[9] | ((uint64_t) buf[8] << 8) |
614 ((uint64_t) buf[7] << 16) | ((uint64_t) buf[6] << 24) |
615 ((uint64_t) buf[5] << 32) | ((uint64_t) buf[4] << 40) |
616 ((uint64_t) buf[3] << 48) | ((uint64_t) buf[2] << 56);
617 break;
618 case 5:
619 lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) |
620 ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24);
621 break;
622 default:
623 lba = -1;
624
625 }
626 return lba;
627}
628
afa46c46 629int scsi_req_parse(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
2ec749cb
GH
630{
631 int rc;
632
afa46c46
PB
633 if (dev->type == TYPE_TAPE) {
634 rc = scsi_req_stream_length(cmd, dev, buf);
2ec749cb 635 } else {
afa46c46 636 rc = scsi_req_length(cmd, dev, buf);
2ec749cb
GH
637 }
638 if (rc != 0)
639 return rc;
640
afa46c46
PB
641 memcpy(cmd->buf, buf, cmd->len);
642 scsi_cmd_xfer_mode(cmd);
643 cmd->lba = scsi_cmd_lba(cmd);
2ec749cb
GH
644 return 0;
645}
ed3a34a3 646
a1f0cce2
HR
647/*
648 * Predefined sense codes
649 */
650
651/* No sense data available */
652const struct SCSISense sense_code_NO_SENSE = {
653 .key = NO_SENSE , .asc = 0x00 , .ascq = 0x00
654};
655
656/* LUN not ready, Manual intervention required */
657const struct SCSISense sense_code_LUN_NOT_READY = {
658 .key = NOT_READY, .asc = 0x04, .ascq = 0x03
659};
660
661/* LUN not ready, Medium not present */
662const struct SCSISense sense_code_NO_MEDIUM = {
663 .key = NOT_READY, .asc = 0x3a, .ascq = 0x00
664};
665
666/* Hardware error, internal target failure */
667const struct SCSISense sense_code_TARGET_FAILURE = {
668 .key = HARDWARE_ERROR, .asc = 0x44, .ascq = 0x00
669};
670
671/* Illegal request, invalid command operation code */
672const struct SCSISense sense_code_INVALID_OPCODE = {
673 .key = ILLEGAL_REQUEST, .asc = 0x20, .ascq = 0x00
674};
675
676/* Illegal request, LBA out of range */
677const struct SCSISense sense_code_LBA_OUT_OF_RANGE = {
678 .key = ILLEGAL_REQUEST, .asc = 0x21, .ascq = 0x00
679};
680
681/* Illegal request, Invalid field in CDB */
682const struct SCSISense sense_code_INVALID_FIELD = {
683 .key = ILLEGAL_REQUEST, .asc = 0x24, .ascq = 0x00
684};
685
686/* Illegal request, LUN not supported */
687const struct SCSISense sense_code_LUN_NOT_SUPPORTED = {
688 .key = ILLEGAL_REQUEST, .asc = 0x25, .ascq = 0x00
689};
690
691/* Command aborted, I/O process terminated */
692const struct SCSISense sense_code_IO_ERROR = {
693 .key = ABORTED_COMMAND, .asc = 0x00, .ascq = 0x06
694};
695
696/* Command aborted, I_T Nexus loss occurred */
697const struct SCSISense sense_code_I_T_NEXUS_LOSS = {
698 .key = ABORTED_COMMAND, .asc = 0x29, .ascq = 0x07
699};
700
701/* Command aborted, Logical Unit failure */
702const struct SCSISense sense_code_LUN_FAILURE = {
703 .key = ABORTED_COMMAND, .asc = 0x3e, .ascq = 0x01
704};
705
706/*
707 * scsi_build_sense
708 *
b45ef674 709 * Convert between fixed and descriptor sense buffers
a1f0cce2 710 */
b45ef674
PB
711int scsi_build_sense(uint8_t *in_buf, int in_len,
712 uint8_t *buf, int len, bool fixed)
a1f0cce2 713{
b45ef674
PB
714 bool fixed_in;
715 SCSISense sense;
a1f0cce2
HR
716 if (!fixed && len < 8) {
717 return 0;
718 }
719
b45ef674
PB
720 if (in_len == 0) {
721 sense.key = NO_SENSE;
722 sense.asc = 0;
723 sense.ascq = 0;
724 } else {
725 fixed_in = (in_buf[0] & 2) == 0;
726
727 if (fixed == fixed_in) {
728 memcpy(buf, in_buf, MIN(len, in_len));
729 return MIN(len, in_len);
730 }
731
732 if (fixed_in) {
733 sense.key = in_buf[2];
734 sense.asc = in_buf[12];
735 sense.ascq = in_buf[13];
736 } else {
737 sense.key = in_buf[1];
738 sense.asc = in_buf[2];
739 sense.ascq = in_buf[3];
740 }
741 }
742
a1f0cce2
HR
743 memset(buf, 0, len);
744 if (fixed) {
745 /* Return fixed format sense buffer */
746 buf[0] = 0xf0;
747 buf[2] = sense.key;
748 buf[7] = 7;
749 buf[12] = sense.asc;
750 buf[13] = sense.ascq;
751 return MIN(len, 18);
752 } else {
753 /* Return descriptor format sense buffer */
754 buf[0] = 0x72;
755 buf[1] = sense.key;
756 buf[2] = sense.asc;
757 buf[3] = sense.ascq;
758 return 8;
759 }
760}
761
ec766865
GH
762static const char *scsi_command_name(uint8_t cmd)
763{
764 static const char *names[] = {
765 [ TEST_UNIT_READY ] = "TEST_UNIT_READY",
5e30a07d 766 [ REWIND ] = "REWIND",
ec766865
GH
767 [ REQUEST_SENSE ] = "REQUEST_SENSE",
768 [ FORMAT_UNIT ] = "FORMAT_UNIT",
769 [ READ_BLOCK_LIMITS ] = "READ_BLOCK_LIMITS",
770 [ REASSIGN_BLOCKS ] = "REASSIGN_BLOCKS",
771 [ READ_6 ] = "READ_6",
772 [ WRITE_6 ] = "WRITE_6",
773 [ SEEK_6 ] = "SEEK_6",
774 [ READ_REVERSE ] = "READ_REVERSE",
775 [ WRITE_FILEMARKS ] = "WRITE_FILEMARKS",
776 [ SPACE ] = "SPACE",
777 [ INQUIRY ] = "INQUIRY",
778 [ RECOVER_BUFFERED_DATA ] = "RECOVER_BUFFERED_DATA",
c7126d5b
NB
779 [ MAINTENANCE_IN ] = "MAINTENANCE_IN",
780 [ MAINTENANCE_OUT ] = "MAINTENANCE_OUT",
ec766865
GH
781 [ MODE_SELECT ] = "MODE_SELECT",
782 [ RESERVE ] = "RESERVE",
783 [ RELEASE ] = "RELEASE",
784 [ COPY ] = "COPY",
785 [ ERASE ] = "ERASE",
786 [ MODE_SENSE ] = "MODE_SENSE",
787 [ START_STOP ] = "START_STOP",
788 [ RECEIVE_DIAGNOSTIC ] = "RECEIVE_DIAGNOSTIC",
789 [ SEND_DIAGNOSTIC ] = "SEND_DIAGNOSTIC",
790 [ ALLOW_MEDIUM_REMOVAL ] = "ALLOW_MEDIUM_REMOVAL",
5e30a07d 791 [ READ_CAPACITY_10 ] = "READ_CAPACITY_10",
ec766865
GH
792 [ READ_10 ] = "READ_10",
793 [ WRITE_10 ] = "WRITE_10",
794 [ SEEK_10 ] = "SEEK_10",
5e30a07d
HR
795 [ WRITE_VERIFY_10 ] = "WRITE_VERIFY_10",
796 [ VERIFY_10 ] = "VERIFY_10",
ec766865
GH
797 [ SEARCH_HIGH ] = "SEARCH_HIGH",
798 [ SEARCH_EQUAL ] = "SEARCH_EQUAL",
799 [ SEARCH_LOW ] = "SEARCH_LOW",
800 [ SET_LIMITS ] = "SET_LIMITS",
801 [ PRE_FETCH ] = "PRE_FETCH",
545557d4 802 /* READ_POSITION and PRE_FETCH use the same operation code */
ec766865
GH
803 [ SYNCHRONIZE_CACHE ] = "SYNCHRONIZE_CACHE",
804 [ LOCK_UNLOCK_CACHE ] = "LOCK_UNLOCK_CACHE",
805 [ READ_DEFECT_DATA ] = "READ_DEFECT_DATA",
806 [ MEDIUM_SCAN ] = "MEDIUM_SCAN",
807 [ COMPARE ] = "COMPARE",
808 [ COPY_VERIFY ] = "COPY_VERIFY",
809 [ WRITE_BUFFER ] = "WRITE_BUFFER",
810 [ READ_BUFFER ] = "READ_BUFFER",
811 [ UPDATE_BLOCK ] = "UPDATE_BLOCK",
5e30a07d
HR
812 [ READ_LONG_10 ] = "READ_LONG_10",
813 [ WRITE_LONG_10 ] = "WRITE_LONG_10",
ec766865 814 [ CHANGE_DEFINITION ] = "CHANGE_DEFINITION",
5e30a07d
HR
815 [ WRITE_SAME_10 ] = "WRITE_SAME_10",
816 [ UNMAP ] = "UNMAP",
ec766865 817 [ READ_TOC ] = "READ_TOC",
5e30a07d
HR
818 [ REPORT_DENSITY_SUPPORT ] = "REPORT_DENSITY_SUPPORT",
819 [ GET_CONFIGURATION ] = "GET_CONFIGURATION",
ec766865
GH
820 [ LOG_SELECT ] = "LOG_SELECT",
821 [ LOG_SENSE ] = "LOG_SENSE",
822 [ MODE_SELECT_10 ] = "MODE_SELECT_10",
823 [ RESERVE_10 ] = "RESERVE_10",
824 [ RELEASE_10 ] = "RELEASE_10",
825 [ MODE_SENSE_10 ] = "MODE_SENSE_10",
826 [ PERSISTENT_RESERVE_IN ] = "PERSISTENT_RESERVE_IN",
827 [ PERSISTENT_RESERVE_OUT ] = "PERSISTENT_RESERVE_OUT",
5e30a07d
HR
828 [ WRITE_FILEMARKS_16 ] = "WRITE_FILEMARKS_16",
829 [ EXTENDED_COPY ] = "EXTENDED_COPY",
830 [ ATA_PASSTHROUGH ] = "ATA_PASSTHROUGH",
831 [ ACCESS_CONTROL_IN ] = "ACCESS_CONTROL_IN",
832 [ ACCESS_CONTROL_OUT ] = "ACCESS_CONTROL_OUT",
833 [ READ_16 ] = "READ_16",
834 [ COMPARE_AND_WRITE ] = "COMPARE_AND_WRITE",
835 [ WRITE_16 ] = "WRITE_16",
836 [ WRITE_VERIFY_16 ] = "WRITE_VERIFY_16",
837 [ VERIFY_16 ] = "VERIFY_16",
838 [ SYNCHRONIZE_CACHE_16 ] = "SYNCHRONIZE_CACHE_16",
839 [ LOCATE_16 ] = "LOCATE_16",
840 [ WRITE_SAME_16 ] = "WRITE_SAME_16",
841 [ ERASE_16 ] = "ERASE_16",
842 [ SERVICE_ACTION_IN ] = "SERVICE_ACTION_IN",
843 [ WRITE_LONG_16 ] = "WRITE_LONG_16",
844 [ REPORT_LUNS ] = "REPORT_LUNS",
845 [ BLANK ] = "BLANK",
846 [ MAINTENANCE_IN ] = "MAINTENANCE_IN",
847 [ MAINTENANCE_OUT ] = "MAINTENANCE_OUT",
ec766865 848 [ MOVE_MEDIUM ] = "MOVE_MEDIUM",
5e30a07d 849 [ LOAD_UNLOAD ] = "LOAD_UNLOAD",
ec766865
GH
850 [ READ_12 ] = "READ_12",
851 [ WRITE_12 ] = "WRITE_12",
852 [ WRITE_VERIFY_12 ] = "WRITE_VERIFY_12",
5e30a07d 853 [ VERIFY_12 ] = "VERIFY_12",
ec766865
GH
854 [ SEARCH_HIGH_12 ] = "SEARCH_HIGH_12",
855 [ SEARCH_EQUAL_12 ] = "SEARCH_EQUAL_12",
856 [ SEARCH_LOW_12 ] = "SEARCH_LOW_12",
857 [ READ_ELEMENT_STATUS ] = "READ_ELEMENT_STATUS",
858 [ SEND_VOLUME_TAG ] = "SEND_VOLUME_TAG",
5e30a07d 859 [ READ_DEFECT_DATA_12 ] = "READ_DEFECT_DATA_12",
ec766865 860 [ SET_CD_SPEED ] = "SET_CD_SPEED",
ec766865
GH
861 };
862
863 if (cmd >= ARRAY_SIZE(names) || names[cmd] == NULL)
864 return "*UNKNOWN*";
865 return names[cmd];
866}
867
ad2d30f7
PB
868SCSIRequest *scsi_req_ref(SCSIRequest *req)
869{
870 req->refcount++;
871 return req;
872}
873
874void scsi_req_unref(SCSIRequest *req)
875{
876 if (--req->refcount == 0) {
12010e7b
PB
877 if (req->ops->free_req) {
878 req->ops->free_req(req);
ad2d30f7
PB
879 }
880 qemu_free(req);
881 }
882}
883
ad3376cc
PB
884/* Tell the device that we finished processing this chunk of I/O. It
885 will start the next chunk or complete the command. */
886void scsi_req_continue(SCSIRequest *req)
887{
888 trace_scsi_req_continue(req->dev->id, req->lun, req->tag);
889 if (req->cmd.mode == SCSI_XFER_TO_DEV) {
12010e7b 890 req->ops->write_data(req);
ad3376cc 891 } else {
12010e7b 892 req->ops->read_data(req);
ad3376cc
PB
893 }
894}
895
ab9adc88
PB
896/* Called by the devices when data is ready for the HBA. The HBA should
897 start a DMA operation to read or fill the device's data buffer.
ad3376cc 898 Once it completes, calling scsi_req_continue will restart I/O. */
ab9adc88
PB
899void scsi_req_data(SCSIRequest *req, int len)
900{
901 trace_scsi_req_data(req->dev->id, req->lun, req->tag, len);
c6df7102 902 req->bus->ops->transfer_data(req, len);
ab9adc88
PB
903}
904
ec766865
GH
905void scsi_req_print(SCSIRequest *req)
906{
907 FILE *fp = stderr;
908 int i;
909
910 fprintf(fp, "[%s id=%d] %s",
911 req->dev->qdev.parent_bus->name,
912 req->dev->id,
913 scsi_command_name(req->cmd.buf[0]));
914 for (i = 1; i < req->cmd.len; i++) {
915 fprintf(fp, " 0x%02x", req->cmd.buf[i]);
916 }
917 switch (req->cmd.mode) {
918 case SCSI_XFER_NONE:
919 fprintf(fp, " - none\n");
920 break;
921 case SCSI_XFER_FROM_DEV:
922 fprintf(fp, " - from-dev len=%zd\n", req->cmd.xfer);
923 break;
924 case SCSI_XFER_TO_DEV:
925 fprintf(fp, " - to-dev len=%zd\n", req->cmd.xfer);
926 break;
927 default:
928 fprintf(fp, " - Oops\n");
929 break;
930 }
931}
932
682a9b21 933void scsi_req_complete(SCSIRequest *req, int status)
ed3a34a3 934{
682a9b21
PB
935 assert(req->status == -1);
936 req->status = status;
b45ef674
PB
937
938 assert(req->sense_len < sizeof(req->sense));
939 if (status == GOOD) {
940 req->sense_len = 0;
941 }
942
943 if (req->sense_len) {
944 memcpy(req->dev->sense, req->sense, req->sense_len);
945 }
946 req->dev->sense_len = req->sense_len;
947
ad2d30f7 948 scsi_req_ref(req);
e8637c90 949 scsi_req_dequeue(req);
c6df7102 950 req->bus->ops->complete(req, req->status);
ad2d30f7 951 scsi_req_unref(req);
ed3a34a3 952}
db07c0f8 953
94d3f98a
PB
954void scsi_req_cancel(SCSIRequest *req)
955{
12010e7b
PB
956 if (req->ops->cancel_io) {
957 req->ops->cancel_io(req);
94d3f98a
PB
958 }
959 scsi_req_ref(req);
960 scsi_req_dequeue(req);
961 if (req->bus->ops->cancel) {
962 req->bus->ops->cancel(req);
963 }
964 scsi_req_unref(req);
965}
966
19d110ab
PB
967void scsi_req_abort(SCSIRequest *req, int status)
968{
12010e7b
PB
969 if (req->ops->cancel_io) {
970 req->ops->cancel_io(req);
19d110ab 971 }
682a9b21 972 scsi_req_complete(req, status);
19d110ab
PB
973}
974
c557e889
PB
975void scsi_device_purge_requests(SCSIDevice *sdev)
976{
977 SCSIRequest *req;
978
979 while (!QTAILQ_EMPTY(&sdev->requests)) {
980 req = QTAILQ_FIRST(&sdev->requests);
94d3f98a 981 scsi_req_cancel(req);
c557e889
PB
982 }
983}
984
db07c0f8
GN
985static char *scsibus_get_fw_dev_path(DeviceState *dev)
986{
645a8ad6 987 SCSIDevice *d = DO_UPCAST(SCSIDevice, qdev, dev);
db07c0f8
GN
988 SCSIBus *bus = scsi_bus_from_device(d);
989 char path[100];
990 int i;
991
992 for (i = 0; i < bus->ndev; i++) {
993 if (bus->devs[i] == d) {
994 break;
995 }
996 }
997
998 assert(i != bus->ndev);
999
1000 snprintf(path, sizeof(path), "%s@%x", qdev_fw_name(dev), i);
1001
1002 return strdup(path);
1003}