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