root / hw / scsi-bus.c @ 0cdd3d14
History | View | Annotate | Download (45.9 kB)
1 | d52affa7 | Gerd Hoffmann | #include "hw.h" |
---|---|---|---|
2 | 2f792016 | Markus Armbruster | #include "qemu-error.h" |
3 | 43b443b6 | Gerd Hoffmann | #include "scsi.h" |
4 | 2ec749cb | Gerd Hoffmann | #include "scsi-defs.h" |
5 | d52affa7 | Gerd Hoffmann | #include "qdev.h" |
6 | 2446333c | Blue Swirl | #include "blockdev.h" |
7 | 5138efec | Paolo Bonzini | #include "trace.h" |
8 | 3d5aba97 | Paolo Bonzini | #include "dma.h" |
9 | d52affa7 | Gerd Hoffmann | |
10 | baa1bd89 | Paolo Bonzini | static char *scsibus_get_dev_path(DeviceState *dev); |
11 | db07c0f8 | Gleb Natapov | static char *scsibus_get_fw_dev_path(DeviceState *dev); |
12 | afa46c46 | Paolo Bonzini | static int scsi_req_parse(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf); |
13 | 71544d30 | Paolo Bonzini | static void scsi_req_dequeue(SCSIRequest *req); |
14 | db07c0f8 | Gleb Natapov | |
15 | d52affa7 | Gerd Hoffmann | static struct BusInfo scsi_bus_info = { |
16 | d52affa7 | Gerd Hoffmann | .name = "SCSI",
|
17 | d52affa7 | Gerd Hoffmann | .size = sizeof(SCSIBus),
|
18 | baa1bd89 | Paolo Bonzini | .get_dev_path = scsibus_get_dev_path, |
19 | db07c0f8 | Gleb Natapov | .get_fw_dev_path = scsibus_get_fw_dev_path, |
20 | d52affa7 | Gerd Hoffmann | .props = (Property[]) { |
21 | 0d3545e7 | Paolo Bonzini | DEFINE_PROP_UINT32("channel", SCSIDevice, channel, 0), |
22 | d52affa7 | Gerd Hoffmann | DEFINE_PROP_UINT32("scsi-id", SCSIDevice, id, -1), |
23 | 7e0380b9 | Paolo Bonzini | DEFINE_PROP_UINT32("lun", SCSIDevice, lun, -1), |
24 | d52affa7 | Gerd Hoffmann | DEFINE_PROP_END_OF_LIST(), |
25 | d52affa7 | Gerd Hoffmann | }, |
26 | d52affa7 | Gerd Hoffmann | }; |
27 | d52affa7 | Gerd Hoffmann | static int next_scsi_bus; |
28 | d52affa7 | Gerd Hoffmann | |
29 | b9eea3e6 | Anthony Liguori | static int scsi_device_init(SCSIDevice *s) |
30 | b9eea3e6 | Anthony Liguori | { |
31 | b9eea3e6 | Anthony Liguori | SCSIDeviceClass *sc = SCSI_DEVICE_GET_CLASS(s); |
32 | b9eea3e6 | Anthony Liguori | if (sc->init) {
|
33 | b9eea3e6 | Anthony Liguori | return sc->init(s);
|
34 | b9eea3e6 | Anthony Liguori | } |
35 | b9eea3e6 | Anthony Liguori | return 0; |
36 | b9eea3e6 | Anthony Liguori | } |
37 | b9eea3e6 | Anthony Liguori | |
38 | b9eea3e6 | Anthony Liguori | static void scsi_device_destroy(SCSIDevice *s) |
39 | b9eea3e6 | Anthony Liguori | { |
40 | b9eea3e6 | Anthony Liguori | SCSIDeviceClass *sc = SCSI_DEVICE_GET_CLASS(s); |
41 | b9eea3e6 | Anthony Liguori | if (sc->destroy) {
|
42 | b9eea3e6 | Anthony Liguori | sc->destroy(s); |
43 | b9eea3e6 | Anthony Liguori | } |
44 | b9eea3e6 | Anthony Liguori | } |
45 | b9eea3e6 | Anthony Liguori | |
46 | b9eea3e6 | Anthony Liguori | static SCSIRequest *scsi_device_alloc_req(SCSIDevice *s, uint32_t tag, uint32_t lun,
|
47 | b9eea3e6 | Anthony Liguori | uint8_t *buf, void *hba_private)
|
48 | b9eea3e6 | Anthony Liguori | { |
49 | b9eea3e6 | Anthony Liguori | SCSIDeviceClass *sc = SCSI_DEVICE_GET_CLASS(s); |
50 | b9eea3e6 | Anthony Liguori | if (sc->alloc_req) {
|
51 | b9eea3e6 | Anthony Liguori | return sc->alloc_req(s, tag, lun, buf, hba_private);
|
52 | b9eea3e6 | Anthony Liguori | } |
53 | b9eea3e6 | Anthony Liguori | |
54 | b9eea3e6 | Anthony Liguori | return NULL; |
55 | b9eea3e6 | Anthony Liguori | } |
56 | b9eea3e6 | Anthony Liguori | |
57 | b9eea3e6 | Anthony Liguori | static void scsi_device_unit_attention_reported(SCSIDevice *s) |
58 | b9eea3e6 | Anthony Liguori | { |
59 | b9eea3e6 | Anthony Liguori | SCSIDeviceClass *sc = SCSI_DEVICE_GET_CLASS(s); |
60 | b9eea3e6 | Anthony Liguori | if (sc->unit_attention_reported) {
|
61 | b9eea3e6 | Anthony Liguori | sc->unit_attention_reported(s); |
62 | b9eea3e6 | Anthony Liguori | } |
63 | b9eea3e6 | Anthony Liguori | } |
64 | b9eea3e6 | Anthony Liguori | |
65 | d52affa7 | Gerd Hoffmann | /* Create a scsi bus, and attach devices to it. */
|
66 | afd4030c | Paolo Bonzini | void scsi_bus_new(SCSIBus *bus, DeviceState *host, const SCSIBusInfo *info) |
67 | d52affa7 | Gerd Hoffmann | { |
68 | ca9c39fa | Gerd Hoffmann | qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
|
69 | d52affa7 | Gerd Hoffmann | bus->busnr = next_scsi_bus++; |
70 | afd4030c | Paolo Bonzini | bus->info = info; |
71 | cb23117b | Gerd Hoffmann | bus->qbus.allow_hotplug = 1;
|
72 | d52affa7 | Gerd Hoffmann | } |
73 | d52affa7 | Gerd Hoffmann | |
74 | 71544d30 | Paolo Bonzini | static void scsi_dma_restart_bh(void *opaque) |
75 | 71544d30 | Paolo Bonzini | { |
76 | 71544d30 | Paolo Bonzini | SCSIDevice *s = opaque; |
77 | 71544d30 | Paolo Bonzini | SCSIRequest *req, *next; |
78 | 71544d30 | Paolo Bonzini | |
79 | 71544d30 | Paolo Bonzini | qemu_bh_delete(s->bh); |
80 | 71544d30 | Paolo Bonzini | s->bh = NULL;
|
81 | 71544d30 | Paolo Bonzini | |
82 | 71544d30 | Paolo Bonzini | QTAILQ_FOREACH_SAFE(req, &s->requests, next, next) { |
83 | 71544d30 | Paolo Bonzini | scsi_req_ref(req); |
84 | 71544d30 | Paolo Bonzini | if (req->retry) {
|
85 | 71544d30 | Paolo Bonzini | req->retry = false;
|
86 | 71544d30 | Paolo Bonzini | switch (req->cmd.mode) {
|
87 | 71544d30 | Paolo Bonzini | case SCSI_XFER_FROM_DEV:
|
88 | 71544d30 | Paolo Bonzini | case SCSI_XFER_TO_DEV:
|
89 | 71544d30 | Paolo Bonzini | scsi_req_continue(req); |
90 | 71544d30 | Paolo Bonzini | break;
|
91 | 71544d30 | Paolo Bonzini | case SCSI_XFER_NONE:
|
92 | 5d0d2467 | Paolo Bonzini | assert(!req->sg); |
93 | 71544d30 | Paolo Bonzini | scsi_req_dequeue(req); |
94 | 71544d30 | Paolo Bonzini | scsi_req_enqueue(req); |
95 | 71544d30 | Paolo Bonzini | break;
|
96 | 71544d30 | Paolo Bonzini | } |
97 | 71544d30 | Paolo Bonzini | } |
98 | 71544d30 | Paolo Bonzini | scsi_req_unref(req); |
99 | 71544d30 | Paolo Bonzini | } |
100 | 71544d30 | Paolo Bonzini | } |
101 | 71544d30 | Paolo Bonzini | |
102 | 71544d30 | Paolo Bonzini | void scsi_req_retry(SCSIRequest *req)
|
103 | 71544d30 | Paolo Bonzini | { |
104 | 71544d30 | Paolo Bonzini | /* No need to save a reference, because scsi_dma_restart_bh just
|
105 | 71544d30 | Paolo Bonzini | * looks at the request list. */
|
106 | 71544d30 | Paolo Bonzini | req->retry = true;
|
107 | 71544d30 | Paolo Bonzini | } |
108 | 71544d30 | Paolo Bonzini | |
109 | 71544d30 | Paolo Bonzini | static void scsi_dma_restart_cb(void *opaque, int running, RunState state) |
110 | 71544d30 | Paolo Bonzini | { |
111 | 71544d30 | Paolo Bonzini | SCSIDevice *s = opaque; |
112 | 71544d30 | Paolo Bonzini | |
113 | 71544d30 | Paolo Bonzini | if (!running) {
|
114 | 71544d30 | Paolo Bonzini | return;
|
115 | 71544d30 | Paolo Bonzini | } |
116 | 71544d30 | Paolo Bonzini | if (!s->bh) {
|
117 | 71544d30 | Paolo Bonzini | s->bh = qemu_bh_new(scsi_dma_restart_bh, s); |
118 | 71544d30 | Paolo Bonzini | qemu_bh_schedule(s->bh); |
119 | 71544d30 | Paolo Bonzini | } |
120 | 71544d30 | Paolo Bonzini | } |
121 | 71544d30 | Paolo Bonzini | |
122 | d307af79 | Anthony Liguori | static int scsi_qdev_init(DeviceState *qdev) |
123 | d52affa7 | Gerd Hoffmann | { |
124 | b9eea3e6 | Anthony Liguori | SCSIDevice *dev = SCSI_DEVICE(qdev); |
125 | d52affa7 | Gerd Hoffmann | SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus); |
126 | 7e0380b9 | Paolo Bonzini | SCSIDevice *d; |
127 | 01985dcf | Gerd Hoffmann | int rc = -1; |
128 | d52affa7 | Gerd Hoffmann | |
129 | 0d3545e7 | Paolo Bonzini | if (dev->channel > bus->info->max_channel) {
|
130 | 0d3545e7 | Paolo Bonzini | error_report("bad scsi channel id: %d", dev->channel);
|
131 | 0d3545e7 | Paolo Bonzini | goto err;
|
132 | 0d3545e7 | Paolo Bonzini | } |
133 | 7e0380b9 | Paolo Bonzini | if (dev->id != -1 && dev->id > bus->info->max_target) { |
134 | 1ecda02b | Markus Armbruster | error_report("bad scsi device id: %d", dev->id);
|
135 | d52affa7 | Gerd Hoffmann | goto err;
|
136 | d52affa7 | Gerd Hoffmann | } |
137 | d3d250bd | Paolo Bonzini | if (dev->lun != -1 && dev->lun > bus->info->max_lun) { |
138 | d3d250bd | Paolo Bonzini | error_report("bad scsi device lun: %d", dev->lun);
|
139 | d3d250bd | Paolo Bonzini | goto err;
|
140 | d3d250bd | Paolo Bonzini | } |
141 | d52affa7 | Gerd Hoffmann | |
142 | 7e0380b9 | Paolo Bonzini | if (dev->id == -1) { |
143 | 7e0380b9 | Paolo Bonzini | int id = -1; |
144 | 7e0380b9 | Paolo Bonzini | if (dev->lun == -1) { |
145 | 7e0380b9 | Paolo Bonzini | dev->lun = 0;
|
146 | 7e0380b9 | Paolo Bonzini | } |
147 | 7e0380b9 | Paolo Bonzini | do {
|
148 | 0d3545e7 | Paolo Bonzini | d = scsi_device_find(bus, dev->channel, ++id, dev->lun); |
149 | d3d250bd | Paolo Bonzini | } while (d && d->lun == dev->lun && id < bus->info->max_target);
|
150 | d3d250bd | Paolo Bonzini | if (d && d->lun == dev->lun) {
|
151 | 7e0380b9 | Paolo Bonzini | error_report("no free target");
|
152 | 7e0380b9 | Paolo Bonzini | goto err;
|
153 | 7e0380b9 | Paolo Bonzini | } |
154 | 7e0380b9 | Paolo Bonzini | dev->id = id; |
155 | 7e0380b9 | Paolo Bonzini | } else if (dev->lun == -1) { |
156 | 7e0380b9 | Paolo Bonzini | int lun = -1; |
157 | 7e0380b9 | Paolo Bonzini | do {
|
158 | 0d3545e7 | Paolo Bonzini | d = scsi_device_find(bus, dev->channel, dev->id, ++lun); |
159 | 7e0380b9 | Paolo Bonzini | } while (d && d->lun == lun && lun < bus->info->max_lun);
|
160 | d3d250bd | Paolo Bonzini | if (d && d->lun == lun) {
|
161 | 7e0380b9 | Paolo Bonzini | error_report("no free lun");
|
162 | 7e0380b9 | Paolo Bonzini | goto err;
|
163 | 7e0380b9 | Paolo Bonzini | } |
164 | 7e0380b9 | Paolo Bonzini | dev->lun = lun; |
165 | 7e0380b9 | Paolo Bonzini | } else {
|
166 | 0d3545e7 | Paolo Bonzini | d = scsi_device_find(bus, dev->channel, dev->id, dev->lun); |
167 | d3d250bd | Paolo Bonzini | assert(d); |
168 | d3d250bd | Paolo Bonzini | if (d->lun == dev->lun && dev != d) {
|
169 | 7e0380b9 | Paolo Bonzini | qdev_free(&d->qdev); |
170 | 7e0380b9 | Paolo Bonzini | } |
171 | d52affa7 | Gerd Hoffmann | } |
172 | d52affa7 | Gerd Hoffmann | |
173 | 9af99d98 | Gerd Hoffmann | QTAILQ_INIT(&dev->requests); |
174 | b9eea3e6 | Anthony Liguori | rc = scsi_device_init(dev); |
175 | 71544d30 | Paolo Bonzini | if (rc == 0) { |
176 | 71544d30 | Paolo Bonzini | dev->vmsentry = qemu_add_vm_change_state_handler(scsi_dma_restart_cb, |
177 | 71544d30 | Paolo Bonzini | dev); |
178 | 71544d30 | Paolo Bonzini | } |
179 | d52affa7 | Gerd Hoffmann | |
180 | d52affa7 | Gerd Hoffmann | err:
|
181 | 01985dcf | Gerd Hoffmann | return rc;
|
182 | 01985dcf | Gerd Hoffmann | } |
183 | 01985dcf | Gerd Hoffmann | |
184 | 01985dcf | Gerd Hoffmann | static int scsi_qdev_exit(DeviceState *qdev) |
185 | 01985dcf | Gerd Hoffmann | { |
186 | b9eea3e6 | Anthony Liguori | SCSIDevice *dev = SCSI_DEVICE(qdev); |
187 | 01985dcf | Gerd Hoffmann | |
188 | 71544d30 | Paolo Bonzini | if (dev->vmsentry) {
|
189 | 71544d30 | Paolo Bonzini | qemu_del_vm_change_state_handler(dev->vmsentry); |
190 | 71544d30 | Paolo Bonzini | } |
191 | b9eea3e6 | Anthony Liguori | scsi_device_destroy(dev); |
192 | 01985dcf | Gerd Hoffmann | return 0; |
193 | d52affa7 | Gerd Hoffmann | } |
194 | d52affa7 | Gerd Hoffmann | |
195 | d52affa7 | Gerd Hoffmann | /* handle legacy '-drive if=scsi,...' cmd line args */
|
196 | 2d1fd261 | Stefan Hajnoczi | SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, BlockDriverState *bdrv, |
197 | ce4e7e46 | Paolo Bonzini | int unit, bool removable, int bootindex) |
198 | d52affa7 | Gerd Hoffmann | { |
199 | d52affa7 | Gerd Hoffmann | const char *driver; |
200 | d52affa7 | Gerd Hoffmann | DeviceState *dev; |
201 | d52affa7 | Gerd Hoffmann | |
202 | f8b6cc00 | Markus Armbruster | driver = bdrv_is_sg(bdrv) ? "scsi-generic" : "scsi-disk"; |
203 | d52affa7 | Gerd Hoffmann | dev = qdev_create(&bus->qbus, driver); |
204 | d52affa7 | Gerd Hoffmann | qdev_prop_set_uint32(dev, "scsi-id", unit);
|
205 | ce4e7e46 | Paolo Bonzini | if (bootindex >= 0) { |
206 | ce4e7e46 | Paolo Bonzini | qdev_prop_set_int32(dev, "bootindex", bootindex);
|
207 | ce4e7e46 | Paolo Bonzini | } |
208 | 2d1fd261 | Stefan Hajnoczi | if (qdev_prop_exists(dev, "removable")) { |
209 | 2d1fd261 | Stefan Hajnoczi | qdev_prop_set_bit(dev, "removable", removable);
|
210 | 2d1fd261 | Stefan Hajnoczi | } |
211 | 18846dee | Markus Armbruster | if (qdev_prop_set_drive(dev, "drive", bdrv) < 0) { |
212 | 18846dee | Markus Armbruster | qdev_free(dev); |
213 | 18846dee | Markus Armbruster | return NULL; |
214 | 18846dee | Markus Armbruster | } |
215 | 33e66b86 | Markus Armbruster | if (qdev_init(dev) < 0) |
216 | 33e66b86 | Markus Armbruster | return NULL; |
217 | b9eea3e6 | Anthony Liguori | return SCSI_DEVICE(dev);
|
218 | d52affa7 | Gerd Hoffmann | } |
219 | d52affa7 | Gerd Hoffmann | |
220 | fa66b909 | Markus Armbruster | int scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
|
221 | d52affa7 | Gerd Hoffmann | { |
222 | 42e766a2 | Markus Armbruster | Location loc; |
223 | d52affa7 | Gerd Hoffmann | DriveInfo *dinfo; |
224 | fa66b909 | Markus Armbruster | int res = 0, unit; |
225 | d52affa7 | Gerd Hoffmann | |
226 | 42e766a2 | Markus Armbruster | loc_push_none(&loc); |
227 | d3d250bd | Paolo Bonzini | for (unit = 0; unit <= bus->info->max_target; unit++) { |
228 | d52affa7 | Gerd Hoffmann | dinfo = drive_get(IF_SCSI, bus->busnr, unit); |
229 | d52affa7 | Gerd Hoffmann | if (dinfo == NULL) { |
230 | d52affa7 | Gerd Hoffmann | continue;
|
231 | d52affa7 | Gerd Hoffmann | } |
232 | 42e766a2 | Markus Armbruster | qemu_opts_loc_restore(dinfo->opts); |
233 | ce4e7e46 | Paolo Bonzini | if (!scsi_bus_legacy_add_drive(bus, dinfo->bdrv, unit, false, -1)) { |
234 | fa66b909 | Markus Armbruster | res = -1;
|
235 | fa66b909 | Markus Armbruster | break;
|
236 | fa66b909 | Markus Armbruster | } |
237 | d52affa7 | Gerd Hoffmann | } |
238 | 42e766a2 | Markus Armbruster | loc_pop(&loc); |
239 | fa66b909 | Markus Armbruster | return res;
|
240 | d52affa7 | Gerd Hoffmann | } |
241 | 89b08ae1 | Gerd Hoffmann | |
242 | 12a08998 | Paolo Bonzini | static int32_t scsi_invalid_field(SCSIRequest *req, uint8_t *buf)
|
243 | 12a08998 | Paolo Bonzini | { |
244 | 12a08998 | Paolo Bonzini | scsi_req_build_sense(req, SENSE_CODE(INVALID_FIELD)); |
245 | 12a08998 | Paolo Bonzini | scsi_req_complete(req, CHECK_CONDITION); |
246 | 12a08998 | Paolo Bonzini | return 0; |
247 | 12a08998 | Paolo Bonzini | } |
248 | 12a08998 | Paolo Bonzini | |
249 | 12a08998 | Paolo Bonzini | static const struct SCSIReqOps reqops_invalid_field = { |
250 | 12a08998 | Paolo Bonzini | .size = sizeof(SCSIRequest),
|
251 | 12a08998 | Paolo Bonzini | .send_command = scsi_invalid_field |
252 | 12a08998 | Paolo Bonzini | }; |
253 | 12a08998 | Paolo Bonzini | |
254 | afa46c46 | Paolo Bonzini | /* SCSIReqOps implementation for invalid commands. */
|
255 | afa46c46 | Paolo Bonzini | |
256 | afa46c46 | Paolo Bonzini | static int32_t scsi_invalid_command(SCSIRequest *req, uint8_t *buf)
|
257 | afa46c46 | Paolo Bonzini | { |
258 | afa46c46 | Paolo Bonzini | scsi_req_build_sense(req, SENSE_CODE(INVALID_OPCODE)); |
259 | afa46c46 | Paolo Bonzini | scsi_req_complete(req, CHECK_CONDITION); |
260 | afa46c46 | Paolo Bonzini | return 0; |
261 | afa46c46 | Paolo Bonzini | } |
262 | afa46c46 | Paolo Bonzini | |
263 | adcf2754 | Paolo Bonzini | static const struct SCSIReqOps reqops_invalid_opcode = { |
264 | afa46c46 | Paolo Bonzini | .size = sizeof(SCSIRequest),
|
265 | afa46c46 | Paolo Bonzini | .send_command = scsi_invalid_command |
266 | afa46c46 | Paolo Bonzini | }; |
267 | afa46c46 | Paolo Bonzini | |
268 | 6dc06f08 | Paolo Bonzini | /* SCSIReqOps implementation for unit attention conditions. */
|
269 | 6dc06f08 | Paolo Bonzini | |
270 | 6dc06f08 | Paolo Bonzini | static int32_t scsi_unit_attention(SCSIRequest *req, uint8_t *buf)
|
271 | 6dc06f08 | Paolo Bonzini | { |
272 | 6dc06f08 | Paolo Bonzini | if (req->dev && req->dev->unit_attention.key == UNIT_ATTENTION) {
|
273 | 6dc06f08 | Paolo Bonzini | scsi_req_build_sense(req, req->dev->unit_attention); |
274 | 6dc06f08 | Paolo Bonzini | } else if (req->bus->unit_attention.key == UNIT_ATTENTION) { |
275 | 6dc06f08 | Paolo Bonzini | scsi_req_build_sense(req, req->bus->unit_attention); |
276 | 6dc06f08 | Paolo Bonzini | } |
277 | 6dc06f08 | Paolo Bonzini | scsi_req_complete(req, CHECK_CONDITION); |
278 | 6dc06f08 | Paolo Bonzini | return 0; |
279 | 6dc06f08 | Paolo Bonzini | } |
280 | 6dc06f08 | Paolo Bonzini | |
281 | adcf2754 | Paolo Bonzini | static const struct SCSIReqOps reqops_unit_attention = { |
282 | 6dc06f08 | Paolo Bonzini | .size = sizeof(SCSIRequest),
|
283 | 6dc06f08 | Paolo Bonzini | .send_command = scsi_unit_attention |
284 | 6dc06f08 | Paolo Bonzini | }; |
285 | 6dc06f08 | Paolo Bonzini | |
286 | fdaef069 | Paolo Bonzini | /* SCSIReqOps implementation for REPORT LUNS and for commands sent to
|
287 | fdaef069 | Paolo Bonzini | an invalid LUN. */
|
288 | fdaef069 | Paolo Bonzini | |
289 | fdaef069 | Paolo Bonzini | typedef struct SCSITargetReq SCSITargetReq; |
290 | fdaef069 | Paolo Bonzini | |
291 | fdaef069 | Paolo Bonzini | struct SCSITargetReq {
|
292 | fdaef069 | Paolo Bonzini | SCSIRequest req; |
293 | fdaef069 | Paolo Bonzini | int len;
|
294 | ba74307c | Paolo Bonzini | uint8_t buf[2056];
|
295 | fdaef069 | Paolo Bonzini | }; |
296 | fdaef069 | Paolo Bonzini | |
297 | fdaef069 | Paolo Bonzini | static void store_lun(uint8_t *outbuf, int lun) |
298 | fdaef069 | Paolo Bonzini | { |
299 | fdaef069 | Paolo Bonzini | if (lun < 256) { |
300 | fdaef069 | Paolo Bonzini | outbuf[1] = lun;
|
301 | fdaef069 | Paolo Bonzini | return;
|
302 | fdaef069 | Paolo Bonzini | } |
303 | fdaef069 | Paolo Bonzini | outbuf[1] = (lun & 255); |
304 | fdaef069 | Paolo Bonzini | outbuf[0] = (lun >> 8) | 0x40; |
305 | fdaef069 | Paolo Bonzini | } |
306 | fdaef069 | Paolo Bonzini | |
307 | fdaef069 | Paolo Bonzini | static bool scsi_target_emulate_report_luns(SCSITargetReq *r) |
308 | fdaef069 | Paolo Bonzini | { |
309 | ba74307c | Paolo Bonzini | DeviceState *qdev; |
310 | ba74307c | Paolo Bonzini | int i, len, n;
|
311 | 0d3545e7 | Paolo Bonzini | int channel, id;
|
312 | ba74307c | Paolo Bonzini | bool found_lun0;
|
313 | ba74307c | Paolo Bonzini | |
314 | fdaef069 | Paolo Bonzini | if (r->req.cmd.xfer < 16) { |
315 | fdaef069 | Paolo Bonzini | return false; |
316 | fdaef069 | Paolo Bonzini | } |
317 | fdaef069 | Paolo Bonzini | if (r->req.cmd.buf[2] > 2) { |
318 | fdaef069 | Paolo Bonzini | return false; |
319 | fdaef069 | Paolo Bonzini | } |
320 | 0d3545e7 | Paolo Bonzini | channel = r->req.dev->channel; |
321 | ba74307c | Paolo Bonzini | id = r->req.dev->id; |
322 | ba74307c | Paolo Bonzini | found_lun0 = false;
|
323 | ba74307c | Paolo Bonzini | n = 0;
|
324 | ba74307c | Paolo Bonzini | QTAILQ_FOREACH(qdev, &r->req.bus->qbus.children, sibling) { |
325 | b9eea3e6 | Anthony Liguori | SCSIDevice *dev = SCSI_DEVICE(qdev); |
326 | ba74307c | Paolo Bonzini | |
327 | 0d3545e7 | Paolo Bonzini | if (dev->channel == channel && dev->id == id) {
|
328 | ba74307c | Paolo Bonzini | if (dev->lun == 0) { |
329 | ba74307c | Paolo Bonzini | found_lun0 = true;
|
330 | ba74307c | Paolo Bonzini | } |
331 | ba74307c | Paolo Bonzini | n += 8;
|
332 | ba74307c | Paolo Bonzini | } |
333 | ba74307c | Paolo Bonzini | } |
334 | ba74307c | Paolo Bonzini | if (!found_lun0) {
|
335 | ba74307c | Paolo Bonzini | n += 8;
|
336 | ba74307c | Paolo Bonzini | } |
337 | ba74307c | Paolo Bonzini | len = MIN(n + 8, r->req.cmd.xfer & ~7); |
338 | ba74307c | Paolo Bonzini | if (len > sizeof(r->buf)) { |
339 | ba74307c | Paolo Bonzini | /* TODO: > 256 LUNs? */
|
340 | ba74307c | Paolo Bonzini | return false; |
341 | ba74307c | Paolo Bonzini | } |
342 | ba74307c | Paolo Bonzini | |
343 | fdaef069 | Paolo Bonzini | memset(r->buf, 0, len);
|
344 | ba74307c | Paolo Bonzini | stl_be_p(&r->buf, n); |
345 | ba74307c | Paolo Bonzini | i = found_lun0 ? 8 : 16; |
346 | ba74307c | Paolo Bonzini | QTAILQ_FOREACH(qdev, &r->req.bus->qbus.children, sibling) { |
347 | b9eea3e6 | Anthony Liguori | SCSIDevice *dev = SCSI_DEVICE(qdev); |
348 | ba74307c | Paolo Bonzini | |
349 | 0d3545e7 | Paolo Bonzini | if (dev->channel == channel && dev->id == id) {
|
350 | ba74307c | Paolo Bonzini | store_lun(&r->buf[i], dev->lun); |
351 | ba74307c | Paolo Bonzini | i += 8;
|
352 | ba74307c | Paolo Bonzini | } |
353 | fdaef069 | Paolo Bonzini | } |
354 | ba74307c | Paolo Bonzini | assert(i == n + 8);
|
355 | ba74307c | Paolo Bonzini | r->len = len; |
356 | fdaef069 | Paolo Bonzini | return true; |
357 | fdaef069 | Paolo Bonzini | } |
358 | fdaef069 | Paolo Bonzini | |
359 | fdaef069 | Paolo Bonzini | static bool scsi_target_emulate_inquiry(SCSITargetReq *r) |
360 | fdaef069 | Paolo Bonzini | { |
361 | fdaef069 | Paolo Bonzini | assert(r->req.dev->lun != r->req.lun); |
362 | fdaef069 | Paolo Bonzini | if (r->req.cmd.buf[1] & 0x2) { |
363 | fdaef069 | Paolo Bonzini | /* Command support data - optional, not implemented */
|
364 | fdaef069 | Paolo Bonzini | return false; |
365 | fdaef069 | Paolo Bonzini | } |
366 | fdaef069 | Paolo Bonzini | |
367 | fdaef069 | Paolo Bonzini | if (r->req.cmd.buf[1] & 0x1) { |
368 | fdaef069 | Paolo Bonzini | /* Vital product data */
|
369 | fdaef069 | Paolo Bonzini | uint8_t page_code = r->req.cmd.buf[2];
|
370 | fdaef069 | Paolo Bonzini | r->buf[r->len++] = page_code ; /* this page */
|
371 | fdaef069 | Paolo Bonzini | r->buf[r->len++] = 0x00;
|
372 | fdaef069 | Paolo Bonzini | |
373 | fdaef069 | Paolo Bonzini | switch (page_code) {
|
374 | fdaef069 | Paolo Bonzini | case 0x00: /* Supported page codes, mandatory */ |
375 | fdaef069 | Paolo Bonzini | { |
376 | fdaef069 | Paolo Bonzini | int pages;
|
377 | fdaef069 | Paolo Bonzini | pages = r->len++; |
378 | fdaef069 | Paolo Bonzini | r->buf[r->len++] = 0x00; /* list of supported pages (this page) */ |
379 | fdaef069 | Paolo Bonzini | r->buf[pages] = r->len - pages - 1; /* number of pages */ |
380 | fdaef069 | Paolo Bonzini | break;
|
381 | fdaef069 | Paolo Bonzini | } |
382 | fdaef069 | Paolo Bonzini | default:
|
383 | fdaef069 | Paolo Bonzini | return false; |
384 | fdaef069 | Paolo Bonzini | } |
385 | fdaef069 | Paolo Bonzini | /* done with EVPD */
|
386 | fdaef069 | Paolo Bonzini | assert(r->len < sizeof(r->buf));
|
387 | fdaef069 | Paolo Bonzini | r->len = MIN(r->req.cmd.xfer, r->len); |
388 | fdaef069 | Paolo Bonzini | return true; |
389 | fdaef069 | Paolo Bonzini | } |
390 | fdaef069 | Paolo Bonzini | |
391 | fdaef069 | Paolo Bonzini | /* Standard INQUIRY data */
|
392 | fdaef069 | Paolo Bonzini | if (r->req.cmd.buf[2] != 0) { |
393 | fdaef069 | Paolo Bonzini | return false; |
394 | fdaef069 | Paolo Bonzini | } |
395 | fdaef069 | Paolo Bonzini | |
396 | fdaef069 | Paolo Bonzini | /* PAGE CODE == 0 */
|
397 | fdaef069 | Paolo Bonzini | r->len = MIN(r->req.cmd.xfer, 36);
|
398 | fdaef069 | Paolo Bonzini | memset(r->buf, 0, r->len);
|
399 | fdaef069 | Paolo Bonzini | if (r->req.lun != 0) { |
400 | fdaef069 | Paolo Bonzini | r->buf[0] = TYPE_NO_LUN;
|
401 | fdaef069 | Paolo Bonzini | } else {
|
402 | fdaef069 | Paolo Bonzini | r->buf[0] = TYPE_NOT_PRESENT | TYPE_INACTIVE;
|
403 | fdaef069 | Paolo Bonzini | r->buf[2] = 5; /* Version */ |
404 | fdaef069 | Paolo Bonzini | r->buf[3] = 2 | 0x10; /* HiSup, response data format */ |
405 | fdaef069 | Paolo Bonzini | r->buf[4] = r->len - 5; /* Additional Length = (Len - 1) - 4 */ |
406 | afd4030c | Paolo Bonzini | r->buf[7] = 0x10 | (r->req.bus->info->tcq ? 0x02 : 0); /* Sync, TCQ. */ |
407 | fdaef069 | Paolo Bonzini | memcpy(&r->buf[8], "QEMU ", 8); |
408 | fdaef069 | Paolo Bonzini | memcpy(&r->buf[16], "QEMU TARGET ", 16); |
409 | fdaef069 | Paolo Bonzini | strncpy((char *) &r->buf[32], QEMU_VERSION, 4); |
410 | fdaef069 | Paolo Bonzini | } |
411 | fdaef069 | Paolo Bonzini | return true; |
412 | fdaef069 | Paolo Bonzini | } |
413 | fdaef069 | Paolo Bonzini | |
414 | fdaef069 | Paolo Bonzini | static int32_t scsi_target_send_command(SCSIRequest *req, uint8_t *buf)
|
415 | fdaef069 | Paolo Bonzini | { |
416 | fdaef069 | Paolo Bonzini | SCSITargetReq *r = DO_UPCAST(SCSITargetReq, req, req); |
417 | fdaef069 | Paolo Bonzini | |
418 | fdaef069 | Paolo Bonzini | switch (buf[0]) { |
419 | fdaef069 | Paolo Bonzini | case REPORT_LUNS:
|
420 | fdaef069 | Paolo Bonzini | if (!scsi_target_emulate_report_luns(r)) {
|
421 | fdaef069 | Paolo Bonzini | goto illegal_request;
|
422 | fdaef069 | Paolo Bonzini | } |
423 | fdaef069 | Paolo Bonzini | break;
|
424 | fdaef069 | Paolo Bonzini | case INQUIRY:
|
425 | fdaef069 | Paolo Bonzini | if (!scsi_target_emulate_inquiry(r)) {
|
426 | fdaef069 | Paolo Bonzini | goto illegal_request;
|
427 | fdaef069 | Paolo Bonzini | } |
428 | fdaef069 | Paolo Bonzini | break;
|
429 | 739df215 | Paolo Bonzini | case REQUEST_SENSE:
|
430 | 8b2a04ee | Paolo Bonzini | r->len = scsi_device_get_sense(r->req.dev, r->buf, |
431 | 8b2a04ee | Paolo Bonzini | MIN(req->cmd.xfer, sizeof r->buf),
|
432 | 739df215 | Paolo Bonzini | (req->cmd.buf[1] & 1) == 0); |
433 | 3653d8c4 | Paolo Bonzini | if (r->req.dev->sense_is_ua) {
|
434 | b9eea3e6 | Anthony Liguori | scsi_device_unit_attention_reported(req->dev); |
435 | 3653d8c4 | Paolo Bonzini | r->req.dev->sense_len = 0;
|
436 | 3653d8c4 | Paolo Bonzini | r->req.dev->sense_is_ua = false;
|
437 | 3653d8c4 | Paolo Bonzini | } |
438 | 739df215 | Paolo Bonzini | break;
|
439 | fdaef069 | Paolo Bonzini | default:
|
440 | fdaef069 | Paolo Bonzini | scsi_req_build_sense(req, SENSE_CODE(LUN_NOT_SUPPORTED)); |
441 | fdaef069 | Paolo Bonzini | scsi_req_complete(req, CHECK_CONDITION); |
442 | fdaef069 | Paolo Bonzini | return 0; |
443 | fdaef069 | Paolo Bonzini | illegal_request:
|
444 | fdaef069 | Paolo Bonzini | scsi_req_build_sense(req, SENSE_CODE(INVALID_FIELD)); |
445 | fdaef069 | Paolo Bonzini | scsi_req_complete(req, CHECK_CONDITION); |
446 | fdaef069 | Paolo Bonzini | return 0; |
447 | fdaef069 | Paolo Bonzini | } |
448 | fdaef069 | Paolo Bonzini | |
449 | fdaef069 | Paolo Bonzini | if (!r->len) {
|
450 | fdaef069 | Paolo Bonzini | scsi_req_complete(req, GOOD); |
451 | fdaef069 | Paolo Bonzini | } |
452 | fdaef069 | Paolo Bonzini | return r->len;
|
453 | fdaef069 | Paolo Bonzini | } |
454 | fdaef069 | Paolo Bonzini | |
455 | fdaef069 | Paolo Bonzini | static void scsi_target_read_data(SCSIRequest *req) |
456 | fdaef069 | Paolo Bonzini | { |
457 | fdaef069 | Paolo Bonzini | SCSITargetReq *r = DO_UPCAST(SCSITargetReq, req, req); |
458 | fdaef069 | Paolo Bonzini | uint32_t n; |
459 | fdaef069 | Paolo Bonzini | |
460 | fdaef069 | Paolo Bonzini | n = r->len; |
461 | fdaef069 | Paolo Bonzini | if (n > 0) { |
462 | fdaef069 | Paolo Bonzini | r->len = 0;
|
463 | fdaef069 | Paolo Bonzini | scsi_req_data(&r->req, n); |
464 | fdaef069 | Paolo Bonzini | } else {
|
465 | fdaef069 | Paolo Bonzini | scsi_req_complete(&r->req, GOOD); |
466 | fdaef069 | Paolo Bonzini | } |
467 | fdaef069 | Paolo Bonzini | } |
468 | fdaef069 | Paolo Bonzini | |
469 | fdaef069 | Paolo Bonzini | static uint8_t *scsi_target_get_buf(SCSIRequest *req)
|
470 | fdaef069 | Paolo Bonzini | { |
471 | fdaef069 | Paolo Bonzini | SCSITargetReq *r = DO_UPCAST(SCSITargetReq, req, req); |
472 | fdaef069 | Paolo Bonzini | |
473 | fdaef069 | Paolo Bonzini | return r->buf;
|
474 | fdaef069 | Paolo Bonzini | } |
475 | fdaef069 | Paolo Bonzini | |
476 | adcf2754 | Paolo Bonzini | static const struct SCSIReqOps reqops_target_command = { |
477 | fdaef069 | Paolo Bonzini | .size = sizeof(SCSITargetReq),
|
478 | fdaef069 | Paolo Bonzini | .send_command = scsi_target_send_command, |
479 | fdaef069 | Paolo Bonzini | .read_data = scsi_target_read_data, |
480 | fdaef069 | Paolo Bonzini | .get_buf = scsi_target_get_buf, |
481 | fdaef069 | Paolo Bonzini | }; |
482 | fdaef069 | Paolo Bonzini | |
483 | fdaef069 | Paolo Bonzini | |
484 | adcf2754 | Paolo Bonzini | SCSIRequest *scsi_req_alloc(const SCSIReqOps *reqops, SCSIDevice *d,
|
485 | adcf2754 | Paolo Bonzini | uint32_t tag, uint32_t lun, void *hba_private)
|
486 | 89b08ae1 | Gerd Hoffmann | { |
487 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *req; |
488 | 89b08ae1 | Gerd Hoffmann | |
489 | 7267c094 | Anthony Liguori | req = g_malloc0(reqops->size); |
490 | 5c6c0e51 | Hannes Reinecke | req->refcount = 1;
|
491 | 89b08ae1 | Gerd Hoffmann | req->bus = scsi_bus_from_device(d); |
492 | 89b08ae1 | Gerd Hoffmann | req->dev = d; |
493 | 89b08ae1 | Gerd Hoffmann | req->tag = tag; |
494 | 89b08ae1 | Gerd Hoffmann | req->lun = lun; |
495 | c5bf71a9 | Hannes Reinecke | req->hba_private = hba_private; |
496 | ed3a34a3 | Gerd Hoffmann | req->status = -1;
|
497 | b45ef674 | Paolo Bonzini | req->sense_len = 0;
|
498 | 8dbd4574 | Paolo Bonzini | req->ops = reqops; |
499 | 5138efec | Paolo Bonzini | trace_scsi_req_alloc(req->dev->id, req->lun, req->tag); |
500 | 89b08ae1 | Gerd Hoffmann | return req;
|
501 | 89b08ae1 | Gerd Hoffmann | } |
502 | 89b08ae1 | Gerd Hoffmann | |
503 | c5bf71a9 | Hannes Reinecke | SCSIRequest *scsi_req_new(SCSIDevice *d, uint32_t tag, uint32_t lun, |
504 | c39ce112 | Paolo Bonzini | uint8_t *buf, void *hba_private)
|
505 | 43a2b339 | Paolo Bonzini | { |
506 | 6dc06f08 | Paolo Bonzini | SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, d->qdev.parent_bus); |
507 | c39ce112 | Paolo Bonzini | SCSIRequest *req; |
508 | afa46c46 | Paolo Bonzini | SCSICommand cmd; |
509 | afa46c46 | Paolo Bonzini | |
510 | afa46c46 | Paolo Bonzini | if (scsi_req_parse(&cmd, d, buf) != 0) { |
511 | afa46c46 | Paolo Bonzini | trace_scsi_req_parse_bad(d->id, lun, tag, buf[0]);
|
512 | afa46c46 | Paolo Bonzini | req = scsi_req_alloc(&reqops_invalid_opcode, d, tag, lun, hba_private); |
513 | afa46c46 | Paolo Bonzini | } else {
|
514 | afa46c46 | Paolo Bonzini | trace_scsi_req_parsed(d->id, lun, tag, buf[0],
|
515 | afa46c46 | Paolo Bonzini | cmd.mode, cmd.xfer); |
516 | 3b6ffe50 | Peter Maydell | if (cmd.lba != -1) { |
517 | afa46c46 | Paolo Bonzini | trace_scsi_req_parsed_lba(d->id, lun, tag, buf[0],
|
518 | afa46c46 | Paolo Bonzini | cmd.lba); |
519 | afa46c46 | Paolo Bonzini | } |
520 | fdaef069 | Paolo Bonzini | |
521 | 12a08998 | Paolo Bonzini | if (cmd.xfer > INT32_MAX) {
|
522 | 12a08998 | Paolo Bonzini | req = scsi_req_alloc(&reqops_invalid_field, d, tag, lun, hba_private); |
523 | 12a08998 | Paolo Bonzini | } else if ((d->unit_attention.key == UNIT_ATTENTION || |
524 | 12a08998 | Paolo Bonzini | bus->unit_attention.key == UNIT_ATTENTION) && |
525 | 12a08998 | Paolo Bonzini | (buf[0] != INQUIRY &&
|
526 | 12a08998 | Paolo Bonzini | buf[0] != REPORT_LUNS &&
|
527 | 12a08998 | Paolo Bonzini | buf[0] != GET_CONFIGURATION &&
|
528 | 12a08998 | Paolo Bonzini | buf[0] != GET_EVENT_STATUS_NOTIFICATION &&
|
529 | 12a08998 | Paolo Bonzini | |
530 | 12a08998 | Paolo Bonzini | /*
|
531 | 12a08998 | Paolo Bonzini | * If we already have a pending unit attention condition,
|
532 | 12a08998 | Paolo Bonzini | * report this one before triggering another one.
|
533 | 12a08998 | Paolo Bonzini | */
|
534 | 12a08998 | Paolo Bonzini | !(buf[0] == REQUEST_SENSE && d->sense_is_ua))) {
|
535 | 6dc06f08 | Paolo Bonzini | req = scsi_req_alloc(&reqops_unit_attention, d, tag, lun, |
536 | 6dc06f08 | Paolo Bonzini | hba_private); |
537 | 6dc06f08 | Paolo Bonzini | } else if (lun != d->lun || |
538 | e5f38ff6 | Paolo Bonzini | buf[0] == REPORT_LUNS ||
|
539 | e5f38ff6 | Paolo Bonzini | (buf[0] == REQUEST_SENSE && d->sense_len)) {
|
540 | fdaef069 | Paolo Bonzini | req = scsi_req_alloc(&reqops_target_command, d, tag, lun, |
541 | fdaef069 | Paolo Bonzini | hba_private); |
542 | fdaef069 | Paolo Bonzini | } else {
|
543 | b9eea3e6 | Anthony Liguori | req = scsi_device_alloc_req(d, tag, lun, buf, hba_private); |
544 | fdaef069 | Paolo Bonzini | } |
545 | afa46c46 | Paolo Bonzini | } |
546 | afa46c46 | Paolo Bonzini | |
547 | afa46c46 | Paolo Bonzini | req->cmd = cmd; |
548 | 01e95455 | Paolo Bonzini | req->resid = req->cmd.xfer; |
549 | 01e95455 | Paolo Bonzini | |
550 | 98254542 | Paolo Bonzini | switch (buf[0]) { |
551 | 98254542 | Paolo Bonzini | case INQUIRY:
|
552 | 98254542 | Paolo Bonzini | trace_scsi_inquiry(d->id, lun, tag, cmd.buf[1], cmd.buf[2]); |
553 | 98254542 | Paolo Bonzini | break;
|
554 | 98254542 | Paolo Bonzini | case TEST_UNIT_READY:
|
555 | 98254542 | Paolo Bonzini | trace_scsi_test_unit_ready(d->id, lun, tag); |
556 | 98254542 | Paolo Bonzini | break;
|
557 | 98254542 | Paolo Bonzini | case REPORT_LUNS:
|
558 | 98254542 | Paolo Bonzini | trace_scsi_report_luns(d->id, lun, tag); |
559 | 98254542 | Paolo Bonzini | break;
|
560 | 98254542 | Paolo Bonzini | case REQUEST_SENSE:
|
561 | 98254542 | Paolo Bonzini | trace_scsi_request_sense(d->id, lun, tag); |
562 | 98254542 | Paolo Bonzini | break;
|
563 | 98254542 | Paolo Bonzini | default:
|
564 | 98254542 | Paolo Bonzini | break;
|
565 | 98254542 | Paolo Bonzini | } |
566 | 98254542 | Paolo Bonzini | |
567 | c39ce112 | Paolo Bonzini | return req;
|
568 | 43a2b339 | Paolo Bonzini | } |
569 | 43a2b339 | Paolo Bonzini | |
570 | 0c34459b | Paolo Bonzini | uint8_t *scsi_req_get_buf(SCSIRequest *req) |
571 | 0c34459b | Paolo Bonzini | { |
572 | 12010e7b | Paolo Bonzini | return req->ops->get_buf(req);
|
573 | 0c34459b | Paolo Bonzini | } |
574 | 0c34459b | Paolo Bonzini | |
575 | 6dc06f08 | Paolo Bonzini | static void scsi_clear_unit_attention(SCSIRequest *req) |
576 | 6dc06f08 | Paolo Bonzini | { |
577 | 6dc06f08 | Paolo Bonzini | SCSISense *ua; |
578 | 6dc06f08 | Paolo Bonzini | if (req->dev->unit_attention.key != UNIT_ATTENTION &&
|
579 | 6dc06f08 | Paolo Bonzini | req->bus->unit_attention.key != UNIT_ATTENTION) { |
580 | 6dc06f08 | Paolo Bonzini | return;
|
581 | 6dc06f08 | Paolo Bonzini | } |
582 | 6dc06f08 | Paolo Bonzini | |
583 | 6dc06f08 | Paolo Bonzini | /*
|
584 | 6dc06f08 | Paolo Bonzini | * If an INQUIRY command enters the enabled command state,
|
585 | 6dc06f08 | Paolo Bonzini | * the device server shall [not] clear any unit attention condition;
|
586 | 6dc06f08 | Paolo Bonzini | * See also MMC-6, paragraphs 6.5 and 6.6.2.
|
587 | 6dc06f08 | Paolo Bonzini | */
|
588 | 6dc06f08 | Paolo Bonzini | if (req->cmd.buf[0] == INQUIRY || |
589 | 6dc06f08 | Paolo Bonzini | req->cmd.buf[0] == GET_CONFIGURATION ||
|
590 | 6dc06f08 | Paolo Bonzini | req->cmd.buf[0] == GET_EVENT_STATUS_NOTIFICATION) {
|
591 | 6dc06f08 | Paolo Bonzini | return;
|
592 | 6dc06f08 | Paolo Bonzini | } |
593 | 6dc06f08 | Paolo Bonzini | |
594 | 6dc06f08 | Paolo Bonzini | if (req->dev->unit_attention.key == UNIT_ATTENTION) {
|
595 | 6dc06f08 | Paolo Bonzini | ua = &req->dev->unit_attention; |
596 | 6dc06f08 | Paolo Bonzini | } else {
|
597 | 6dc06f08 | Paolo Bonzini | ua = &req->bus->unit_attention; |
598 | 6dc06f08 | Paolo Bonzini | } |
599 | 6dc06f08 | Paolo Bonzini | |
600 | 6dc06f08 | Paolo Bonzini | /*
|
601 | 6dc06f08 | Paolo Bonzini | * If a REPORT LUNS command enters the enabled command state, [...]
|
602 | 6dc06f08 | Paolo Bonzini | * the device server shall clear any pending unit attention condition
|
603 | 6dc06f08 | Paolo Bonzini | * with an additional sense code of REPORTED LUNS DATA HAS CHANGED.
|
604 | 6dc06f08 | Paolo Bonzini | */
|
605 | 6dc06f08 | Paolo Bonzini | if (req->cmd.buf[0] == REPORT_LUNS && |
606 | 6dc06f08 | Paolo Bonzini | !(ua->asc == SENSE_CODE(REPORTED_LUNS_CHANGED).asc && |
607 | 6dc06f08 | Paolo Bonzini | ua->ascq == SENSE_CODE(REPORTED_LUNS_CHANGED).ascq)) { |
608 | 6dc06f08 | Paolo Bonzini | return;
|
609 | 6dc06f08 | Paolo Bonzini | } |
610 | 6dc06f08 | Paolo Bonzini | |
611 | 6dc06f08 | Paolo Bonzini | *ua = SENSE_CODE(NO_SENSE); |
612 | 6dc06f08 | Paolo Bonzini | } |
613 | 6dc06f08 | Paolo Bonzini | |
614 | 74382217 | Hannes Reinecke | int scsi_req_get_sense(SCSIRequest *req, uint8_t *buf, int len) |
615 | 74382217 | Hannes Reinecke | { |
616 | 6dc06f08 | Paolo Bonzini | int ret;
|
617 | 6dc06f08 | Paolo Bonzini | |
618 | b45ef674 | Paolo Bonzini | assert(len >= 14);
|
619 | b45ef674 | Paolo Bonzini | if (!req->sense_len) {
|
620 | 74382217 | Hannes Reinecke | return 0; |
621 | 74382217 | Hannes Reinecke | } |
622 | 6dc06f08 | Paolo Bonzini | |
623 | 6dc06f08 | Paolo Bonzini | ret = scsi_build_sense(req->sense, req->sense_len, buf, len, true);
|
624 | 6dc06f08 | Paolo Bonzini | |
625 | 6dc06f08 | Paolo Bonzini | /*
|
626 | 6dc06f08 | Paolo Bonzini | * FIXME: clearing unit attention conditions upon autosense should be done
|
627 | 6dc06f08 | Paolo Bonzini | * only if the UA_INTLCK_CTRL field in the Control mode page is set to 00b
|
628 | 6dc06f08 | Paolo Bonzini | * (SAM-5, 5.14).
|
629 | 6dc06f08 | Paolo Bonzini | *
|
630 | 6dc06f08 | Paolo Bonzini | * We assume UA_INTLCK_CTRL to be 00b for HBAs that support autosense, and
|
631 | 6dc06f08 | Paolo Bonzini | * 10b for HBAs that do not support it (do not call scsi_req_get_sense).
|
632 | 3653d8c4 | Paolo Bonzini | * Here we handle unit attention clearing for UA_INTLCK_CTRL == 00b.
|
633 | 6dc06f08 | Paolo Bonzini | */
|
634 | 3653d8c4 | Paolo Bonzini | if (req->dev->sense_is_ua) {
|
635 | b9eea3e6 | Anthony Liguori | scsi_device_unit_attention_reported(req->dev); |
636 | 3653d8c4 | Paolo Bonzini | req->dev->sense_len = 0;
|
637 | 3653d8c4 | Paolo Bonzini | req->dev->sense_is_ua = false;
|
638 | 3653d8c4 | Paolo Bonzini | } |
639 | 6dc06f08 | Paolo Bonzini | return ret;
|
640 | b45ef674 | Paolo Bonzini | } |
641 | b45ef674 | Paolo Bonzini | |
642 | b45ef674 | Paolo Bonzini | int scsi_device_get_sense(SCSIDevice *dev, uint8_t *buf, int len, bool fixed) |
643 | b45ef674 | Paolo Bonzini | { |
644 | b45ef674 | Paolo Bonzini | return scsi_build_sense(dev->sense, dev->sense_len, buf, len, fixed);
|
645 | b45ef674 | Paolo Bonzini | } |
646 | b45ef674 | Paolo Bonzini | |
647 | b45ef674 | Paolo Bonzini | void scsi_req_build_sense(SCSIRequest *req, SCSISense sense)
|
648 | b45ef674 | Paolo Bonzini | { |
649 | b45ef674 | Paolo Bonzini | trace_scsi_req_build_sense(req->dev->id, req->lun, req->tag, |
650 | b45ef674 | Paolo Bonzini | sense.key, sense.asc, sense.ascq); |
651 | b45ef674 | Paolo Bonzini | memset(req->sense, 0, 18); |
652 | 77e4743c | Paolo Bonzini | req->sense[0] = 0x70; |
653 | b45ef674 | Paolo Bonzini | req->sense[2] = sense.key;
|
654 | eae31cb9 | Paolo Bonzini | req->sense[7] = 10; |
655 | b45ef674 | Paolo Bonzini | req->sense[12] = sense.asc;
|
656 | b45ef674 | Paolo Bonzini | req->sense[13] = sense.ascq;
|
657 | b45ef674 | Paolo Bonzini | req->sense_len = 18;
|
658 | 74382217 | Hannes Reinecke | } |
659 | 74382217 | Hannes Reinecke | |
660 | 63f740dd | Paolo Bonzini | static void scsi_req_enqueue_internal(SCSIRequest *req) |
661 | 89b08ae1 | Gerd Hoffmann | { |
662 | 5c6c0e51 | Hannes Reinecke | assert(!req->enqueued); |
663 | 5c6c0e51 | Hannes Reinecke | scsi_req_ref(req); |
664 | 3d5aba97 | Paolo Bonzini | if (req->bus->info->get_sg_list) {
|
665 | 3d5aba97 | Paolo Bonzini | req->sg = req->bus->info->get_sg_list(req); |
666 | 3d5aba97 | Paolo Bonzini | } else {
|
667 | 3d5aba97 | Paolo Bonzini | req->sg = NULL;
|
668 | 3d5aba97 | Paolo Bonzini | } |
669 | 5c6c0e51 | Hannes Reinecke | req->enqueued = true;
|
670 | 5c6c0e51 | Hannes Reinecke | QTAILQ_INSERT_TAIL(&req->dev->requests, req, next); |
671 | 63f740dd | Paolo Bonzini | } |
672 | fc4f0754 | Paolo Bonzini | |
673 | 63f740dd | Paolo Bonzini | int32_t scsi_req_enqueue(SCSIRequest *req) |
674 | 63f740dd | Paolo Bonzini | { |
675 | 63f740dd | Paolo Bonzini | int32_t rc; |
676 | 63f740dd | Paolo Bonzini | |
677 | 63f740dd | Paolo Bonzini | assert(!req->retry); |
678 | 63f740dd | Paolo Bonzini | scsi_req_enqueue_internal(req); |
679 | fc4f0754 | Paolo Bonzini | scsi_req_ref(req); |
680 | c39ce112 | Paolo Bonzini | rc = req->ops->send_command(req, req->cmd.buf); |
681 | fc4f0754 | Paolo Bonzini | scsi_req_unref(req); |
682 | fc4f0754 | Paolo Bonzini | return rc;
|
683 | 89b08ae1 | Gerd Hoffmann | } |
684 | 89b08ae1 | Gerd Hoffmann | |
685 | a1f0cce2 | Hannes Reinecke | static void scsi_req_dequeue(SCSIRequest *req) |
686 | e8637c90 | Jan Kiszka | { |
687 | 5138efec | Paolo Bonzini | trace_scsi_req_dequeue(req->dev->id, req->lun, req->tag); |
688 | 71544d30 | Paolo Bonzini | req->retry = false;
|
689 | e8637c90 | Jan Kiszka | if (req->enqueued) {
|
690 | e8637c90 | Jan Kiszka | QTAILQ_REMOVE(&req->dev->requests, req, next); |
691 | e8637c90 | Jan Kiszka | req->enqueued = false;
|
692 | ad2d30f7 | Paolo Bonzini | scsi_req_unref(req); |
693 | e8637c90 | Jan Kiszka | } |
694 | e8637c90 | Jan Kiszka | } |
695 | e8637c90 | Jan Kiszka | |
696 | 06b86357 | Paolo Bonzini | static int scsi_get_performance_length(int num_desc, int type, int data_type) |
697 | 06b86357 | Paolo Bonzini | { |
698 | 06b86357 | Paolo Bonzini | /* MMC-6, paragraph 6.7. */
|
699 | 06b86357 | Paolo Bonzini | switch (type) {
|
700 | 06b86357 | Paolo Bonzini | case 0: |
701 | 06b86357 | Paolo Bonzini | if ((data_type & 3) == 0) { |
702 | 06b86357 | Paolo Bonzini | /* Each descriptor is as in Table 295 - Nominal performance. */
|
703 | 06b86357 | Paolo Bonzini | return 16 * num_desc + 8; |
704 | 06b86357 | Paolo Bonzini | } else {
|
705 | 06b86357 | Paolo Bonzini | /* Each descriptor is as in Table 296 - Exceptions. */
|
706 | 06b86357 | Paolo Bonzini | return 6 * num_desc + 8; |
707 | 06b86357 | Paolo Bonzini | } |
708 | 06b86357 | Paolo Bonzini | case 1: |
709 | 06b86357 | Paolo Bonzini | case 4: |
710 | 06b86357 | Paolo Bonzini | case 5: |
711 | 06b86357 | Paolo Bonzini | return 8 * num_desc + 8; |
712 | 06b86357 | Paolo Bonzini | case 2: |
713 | 06b86357 | Paolo Bonzini | return 2048 * num_desc + 8; |
714 | 06b86357 | Paolo Bonzini | case 3: |
715 | 06b86357 | Paolo Bonzini | return 16 * num_desc + 8; |
716 | 06b86357 | Paolo Bonzini | default:
|
717 | 06b86357 | Paolo Bonzini | return 8; |
718 | 06b86357 | Paolo Bonzini | } |
719 | 06b86357 | Paolo Bonzini | } |
720 | 06b86357 | Paolo Bonzini | |
721 | 2599aece | Paolo Bonzini | static int scsi_req_length(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf) |
722 | 2ec749cb | Gerd Hoffmann | { |
723 | 2599aece | Paolo Bonzini | switch (buf[0] >> 5) { |
724 | 2ec749cb | Gerd Hoffmann | case 0: |
725 | 2599aece | Paolo Bonzini | cmd->xfer = buf[4];
|
726 | 2599aece | Paolo Bonzini | cmd->len = 6;
|
727 | 2ec749cb | Gerd Hoffmann | break;
|
728 | 2ec749cb | Gerd Hoffmann | case 1: |
729 | 2ec749cb | Gerd Hoffmann | case 2: |
730 | bd5da232 | Paolo Bonzini | cmd->xfer = lduw_be_p(&buf[7]);
|
731 | 2599aece | Paolo Bonzini | cmd->len = 10;
|
732 | 2ec749cb | Gerd Hoffmann | break;
|
733 | 2ec749cb | Gerd Hoffmann | case 4: |
734 | 06b86357 | Paolo Bonzini | cmd->xfer = ldl_be_p(&buf[10]) & 0xffffffffULL; |
735 | 2599aece | Paolo Bonzini | cmd->len = 16;
|
736 | 2ec749cb | Gerd Hoffmann | break;
|
737 | 2ec749cb | Gerd Hoffmann | case 5: |
738 | 06b86357 | Paolo Bonzini | cmd->xfer = ldl_be_p(&buf[6]) & 0xffffffffULL; |
739 | 2599aece | Paolo Bonzini | cmd->len = 12;
|
740 | 2ec749cb | Gerd Hoffmann | break;
|
741 | 2ec749cb | Gerd Hoffmann | default:
|
742 | 2ec749cb | Gerd Hoffmann | return -1; |
743 | 2ec749cb | Gerd Hoffmann | } |
744 | 2ec749cb | Gerd Hoffmann | |
745 | 2599aece | Paolo Bonzini | switch (buf[0]) { |
746 | 2ec749cb | Gerd Hoffmann | case TEST_UNIT_READY:
|
747 | 5e30a07d | Hannes Reinecke | case REWIND:
|
748 | 2ec749cb | Gerd Hoffmann | case START_STOP:
|
749 | 00a01ad4 | Paolo Bonzini | case SET_CAPACITY:
|
750 | 2ec749cb | Gerd Hoffmann | case WRITE_FILEMARKS:
|
751 | 06b86357 | Paolo Bonzini | case WRITE_FILEMARKS_16:
|
752 | 2ec749cb | Gerd Hoffmann | case SPACE:
|
753 | a5e3d9ef | Bernhard Kohl | case RESERVE:
|
754 | a5e3d9ef | Bernhard Kohl | case RELEASE:
|
755 | 2ec749cb | Gerd Hoffmann | case ERASE:
|
756 | 2ec749cb | Gerd Hoffmann | case ALLOW_MEDIUM_REMOVAL:
|
757 | 5e30a07d | Hannes Reinecke | case VERIFY_10:
|
758 | 2ec749cb | Gerd Hoffmann | case SEEK_10:
|
759 | 2ec749cb | Gerd Hoffmann | case SYNCHRONIZE_CACHE:
|
760 | 06b86357 | Paolo Bonzini | case SYNCHRONIZE_CACHE_16:
|
761 | 06b86357 | Paolo Bonzini | case LOCATE_16:
|
762 | 2ec749cb | Gerd Hoffmann | case LOCK_UNLOCK_CACHE:
|
763 | 2ec749cb | Gerd Hoffmann | case LOAD_UNLOAD:
|
764 | 2ec749cb | Gerd Hoffmann | case SET_CD_SPEED:
|
765 | 2ec749cb | Gerd Hoffmann | case SET_LIMITS:
|
766 | 5e30a07d | Hannes Reinecke | case WRITE_LONG_10:
|
767 | 2ec749cb | Gerd Hoffmann | case MOVE_MEDIUM:
|
768 | 2ec749cb | Gerd Hoffmann | case UPDATE_BLOCK:
|
769 | 06b86357 | Paolo Bonzini | case RESERVE_TRACK:
|
770 | 06b86357 | Paolo Bonzini | case SET_READ_AHEAD:
|
771 | 06b86357 | Paolo Bonzini | case PRE_FETCH:
|
772 | 06b86357 | Paolo Bonzini | case PRE_FETCH_16:
|
773 | 06b86357 | Paolo Bonzini | case ALLOW_OVERWRITE:
|
774 | 2599aece | Paolo Bonzini | cmd->xfer = 0;
|
775 | 2ec749cb | Gerd Hoffmann | break;
|
776 | 2ec749cb | Gerd Hoffmann | case MODE_SENSE:
|
777 | 2ec749cb | Gerd Hoffmann | break;
|
778 | 5e30a07d | Hannes Reinecke | case WRITE_SAME_10:
|
779 | a5ee9085 | Paolo Bonzini | case WRITE_SAME_16:
|
780 | a5ee9085 | Paolo Bonzini | cmd->xfer = dev->blocksize; |
781 | 2ec749cb | Gerd Hoffmann | break;
|
782 | 5e30a07d | Hannes Reinecke | case READ_CAPACITY_10:
|
783 | 2599aece | Paolo Bonzini | cmd->xfer = 8;
|
784 | 2ec749cb | Gerd Hoffmann | break;
|
785 | 2ec749cb | Gerd Hoffmann | case READ_BLOCK_LIMITS:
|
786 | 2599aece | Paolo Bonzini | cmd->xfer = 6;
|
787 | 2ec749cb | Gerd Hoffmann | break;
|
788 | 2ec749cb | Gerd Hoffmann | case SEND_VOLUME_TAG:
|
789 | 06b86357 | Paolo Bonzini | /* GPCMD_SET_STREAMING from multimedia commands. */
|
790 | 06b86357 | Paolo Bonzini | if (dev->type == TYPE_ROM) {
|
791 | 06b86357 | Paolo Bonzini | cmd->xfer = buf[10] | (buf[9] << 8); |
792 | 06b86357 | Paolo Bonzini | } else {
|
793 | 06b86357 | Paolo Bonzini | cmd->xfer = buf[9] | (buf[8] << 8); |
794 | 06b86357 | Paolo Bonzini | } |
795 | 2ec749cb | Gerd Hoffmann | break;
|
796 | f62d0594 | Paolo Bonzini | case WRITE_6:
|
797 | f62d0594 | Paolo Bonzini | /* length 0 means 256 blocks */
|
798 | f62d0594 | Paolo Bonzini | if (cmd->xfer == 0) { |
799 | f62d0594 | Paolo Bonzini | cmd->xfer = 256;
|
800 | f62d0594 | Paolo Bonzini | } |
801 | 2ec749cb | Gerd Hoffmann | case WRITE_10:
|
802 | 5e30a07d | Hannes Reinecke | case WRITE_VERIFY_10:
|
803 | 2ec749cb | Gerd Hoffmann | case WRITE_12:
|
804 | 2ec749cb | Gerd Hoffmann | case WRITE_VERIFY_12:
|
805 | bd536cf3 | Gerd Hoffmann | case WRITE_16:
|
806 | bd536cf3 | Gerd Hoffmann | case WRITE_VERIFY_16:
|
807 | 2599aece | Paolo Bonzini | cmd->xfer *= dev->blocksize; |
808 | 2ec749cb | Gerd Hoffmann | break;
|
809 | 2ec749cb | Gerd Hoffmann | case READ_6:
|
810 | 2ec749cb | Gerd Hoffmann | case READ_REVERSE:
|
811 | f62d0594 | Paolo Bonzini | /* length 0 means 256 blocks */
|
812 | f62d0594 | Paolo Bonzini | if (cmd->xfer == 0) { |
813 | f62d0594 | Paolo Bonzini | cmd->xfer = 256;
|
814 | f62d0594 | Paolo Bonzini | } |
815 | f62d0594 | Paolo Bonzini | case READ_10:
|
816 | 2ec749cb | Gerd Hoffmann | case RECOVER_BUFFERED_DATA:
|
817 | 2ec749cb | Gerd Hoffmann | case READ_12:
|
818 | bd536cf3 | Gerd Hoffmann | case READ_16:
|
819 | 2599aece | Paolo Bonzini | cmd->xfer *= dev->blocksize; |
820 | 2ec749cb | Gerd Hoffmann | break;
|
821 | 06b86357 | Paolo Bonzini | case FORMAT_UNIT:
|
822 | 06b86357 | Paolo Bonzini | /* MMC mandates the parameter list to be 12-bytes long. Parameters
|
823 | 06b86357 | Paolo Bonzini | * for block devices are restricted to the header right now. */
|
824 | 06b86357 | Paolo Bonzini | if (dev->type == TYPE_ROM && (buf[1] & 16)) { |
825 | 06b86357 | Paolo Bonzini | cmd->xfer = 12;
|
826 | 06b86357 | Paolo Bonzini | } else {
|
827 | 06b86357 | Paolo Bonzini | cmd->xfer = (buf[1] & 16) == 0 ? 0 : (buf[1] & 32 ? 8 : 4); |
828 | 06b86357 | Paolo Bonzini | } |
829 | 06b86357 | Paolo Bonzini | break;
|
830 | 2ec749cb | Gerd Hoffmann | case INQUIRY:
|
831 | 06b86357 | Paolo Bonzini | case RECEIVE_DIAGNOSTIC:
|
832 | 06b86357 | Paolo Bonzini | case SEND_DIAGNOSTIC:
|
833 | 2599aece | Paolo Bonzini | cmd->xfer = buf[4] | (buf[3] << 8); |
834 | 2ec749cb | Gerd Hoffmann | break;
|
835 | 06b86357 | Paolo Bonzini | case READ_CD:
|
836 | 06b86357 | Paolo Bonzini | case READ_BUFFER:
|
837 | 06b86357 | Paolo Bonzini | case WRITE_BUFFER:
|
838 | 06b86357 | Paolo Bonzini | case SEND_CUE_SHEET:
|
839 | 06b86357 | Paolo Bonzini | cmd->xfer = buf[8] | (buf[7] << 8) | (buf[6] << 16); |
840 | 06b86357 | Paolo Bonzini | break;
|
841 | 06b86357 | Paolo Bonzini | case PERSISTENT_RESERVE_OUT:
|
842 | 06b86357 | Paolo Bonzini | cmd->xfer = ldl_be_p(&buf[5]) & 0xffffffffULL; |
843 | 06b86357 | Paolo Bonzini | break;
|
844 | 06b86357 | Paolo Bonzini | case ERASE_12:
|
845 | 06b86357 | Paolo Bonzini | if (dev->type == TYPE_ROM) {
|
846 | 06b86357 | Paolo Bonzini | /* MMC command GET PERFORMANCE. */
|
847 | 06b86357 | Paolo Bonzini | cmd->xfer = scsi_get_performance_length(buf[9] | (buf[8] << 8), |
848 | 06b86357 | Paolo Bonzini | buf[10], buf[1] & 0x1f); |
849 | 06b86357 | Paolo Bonzini | } |
850 | 06b86357 | Paolo Bonzini | break;
|
851 | 06b86357 | Paolo Bonzini | case MECHANISM_STATUS:
|
852 | 06b86357 | Paolo Bonzini | case READ_DVD_STRUCTURE:
|
853 | 06b86357 | Paolo Bonzini | case SEND_DVD_STRUCTURE:
|
854 | c7126d5b | Nicholas Bellinger | case MAINTENANCE_OUT:
|
855 | c7126d5b | Nicholas Bellinger | case MAINTENANCE_IN:
|
856 | 2599aece | Paolo Bonzini | if (dev->type == TYPE_ROM) {
|
857 | c7126d5b | Nicholas Bellinger | /* GPCMD_REPORT_KEY and GPCMD_SEND_KEY from multi media commands */
|
858 | 2599aece | Paolo Bonzini | cmd->xfer = buf[9] | (buf[8] << 8); |
859 | c7126d5b | Nicholas Bellinger | } |
860 | c7126d5b | Nicholas Bellinger | break;
|
861 | 2ec749cb | Gerd Hoffmann | } |
862 | 2ec749cb | Gerd Hoffmann | return 0; |
863 | 2ec749cb | Gerd Hoffmann | } |
864 | 2ec749cb | Gerd Hoffmann | |
865 | 2599aece | Paolo Bonzini | static int scsi_req_stream_length(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf) |
866 | 2ec749cb | Gerd Hoffmann | { |
867 | 2599aece | Paolo Bonzini | switch (buf[0]) { |
868 | 2ec749cb | Gerd Hoffmann | /* stream commands */
|
869 | 06b86357 | Paolo Bonzini | case ERASE_12:
|
870 | 06b86357 | Paolo Bonzini | case ERASE_16:
|
871 | 06b86357 | Paolo Bonzini | cmd->xfer = 0;
|
872 | 06b86357 | Paolo Bonzini | break;
|
873 | 2ec749cb | Gerd Hoffmann | case READ_6:
|
874 | 2ec749cb | Gerd Hoffmann | case READ_REVERSE:
|
875 | 2ec749cb | Gerd Hoffmann | case RECOVER_BUFFERED_DATA:
|
876 | 2ec749cb | Gerd Hoffmann | case WRITE_6:
|
877 | 2599aece | Paolo Bonzini | cmd->len = 6;
|
878 | 2599aece | Paolo Bonzini | cmd->xfer = buf[4] | (buf[3] << 8) | (buf[2] << 16); |
879 | 2599aece | Paolo Bonzini | if (buf[1] & 0x01) { /* fixed */ |
880 | 2599aece | Paolo Bonzini | cmd->xfer *= dev->blocksize; |
881 | 2599aece | Paolo Bonzini | } |
882 | 2ec749cb | Gerd Hoffmann | break;
|
883 | 065c2599 | Paolo Bonzini | case READ_16:
|
884 | 065c2599 | Paolo Bonzini | case READ_REVERSE_16:
|
885 | 065c2599 | Paolo Bonzini | case VERIFY_16:
|
886 | 065c2599 | Paolo Bonzini | case WRITE_16:
|
887 | 065c2599 | Paolo Bonzini | cmd->len = 16;
|
888 | 065c2599 | Paolo Bonzini | cmd->xfer = buf[14] | (buf[13] << 8) | (buf[12] << 16); |
889 | 065c2599 | Paolo Bonzini | if (buf[1] & 0x01) { /* fixed */ |
890 | 065c2599 | Paolo Bonzini | cmd->xfer *= dev->blocksize; |
891 | 065c2599 | Paolo Bonzini | } |
892 | 065c2599 | Paolo Bonzini | break;
|
893 | 2ec749cb | Gerd Hoffmann | case REWIND:
|
894 | 2ec749cb | Gerd Hoffmann | case START_STOP:
|
895 | 2599aece | Paolo Bonzini | cmd->len = 6;
|
896 | 2599aece | Paolo Bonzini | cmd->xfer = 0;
|
897 | 2ec749cb | Gerd Hoffmann | break;
|
898 | 06b86357 | Paolo Bonzini | case SPACE_16:
|
899 | 06b86357 | Paolo Bonzini | cmd->xfer = buf[13] | (buf[12] << 8); |
900 | 06b86357 | Paolo Bonzini | break;
|
901 | 06b86357 | Paolo Bonzini | case READ_POSITION:
|
902 | 06b86357 | Paolo Bonzini | cmd->xfer = buf[8] | (buf[7] << 8); |
903 | 06b86357 | Paolo Bonzini | break;
|
904 | 06b86357 | Paolo Bonzini | case FORMAT_UNIT:
|
905 | 06b86357 | Paolo Bonzini | cmd->xfer = buf[4] | (buf[3] << 8); |
906 | 06b86357 | Paolo Bonzini | break;
|
907 | 2ec749cb | Gerd Hoffmann | /* generic commands */
|
908 | 2ec749cb | Gerd Hoffmann | default:
|
909 | 2599aece | Paolo Bonzini | return scsi_req_length(cmd, dev, buf);
|
910 | 2ec749cb | Gerd Hoffmann | } |
911 | 2ec749cb | Gerd Hoffmann | return 0; |
912 | 2ec749cb | Gerd Hoffmann | } |
913 | 2ec749cb | Gerd Hoffmann | |
914 | 2599aece | Paolo Bonzini | static void scsi_cmd_xfer_mode(SCSICommand *cmd) |
915 | 97a06435 | Gerd Hoffmann | { |
916 | a5ee9085 | Paolo Bonzini | if (!cmd->xfer) {
|
917 | a5ee9085 | Paolo Bonzini | cmd->mode = SCSI_XFER_NONE; |
918 | a5ee9085 | Paolo Bonzini | return;
|
919 | a5ee9085 | Paolo Bonzini | } |
920 | 2599aece | Paolo Bonzini | switch (cmd->buf[0]) { |
921 | 97a06435 | Gerd Hoffmann | case WRITE_6:
|
922 | 97a06435 | Gerd Hoffmann | case WRITE_10:
|
923 | 5e30a07d | Hannes Reinecke | case WRITE_VERIFY_10:
|
924 | 97a06435 | Gerd Hoffmann | case WRITE_12:
|
925 | 97a06435 | Gerd Hoffmann | case WRITE_VERIFY_12:
|
926 | bd536cf3 | Gerd Hoffmann | case WRITE_16:
|
927 | bd536cf3 | Gerd Hoffmann | case WRITE_VERIFY_16:
|
928 | 97a06435 | Gerd Hoffmann | case COPY:
|
929 | 97a06435 | Gerd Hoffmann | case COPY_VERIFY:
|
930 | 97a06435 | Gerd Hoffmann | case COMPARE:
|
931 | 97a06435 | Gerd Hoffmann | case CHANGE_DEFINITION:
|
932 | 97a06435 | Gerd Hoffmann | case LOG_SELECT:
|
933 | 97a06435 | Gerd Hoffmann | case MODE_SELECT:
|
934 | 97a06435 | Gerd Hoffmann | case MODE_SELECT_10:
|
935 | 97a06435 | Gerd Hoffmann | case SEND_DIAGNOSTIC:
|
936 | 97a06435 | Gerd Hoffmann | case WRITE_BUFFER:
|
937 | 97a06435 | Gerd Hoffmann | case FORMAT_UNIT:
|
938 | 97a06435 | Gerd Hoffmann | case REASSIGN_BLOCKS:
|
939 | 97a06435 | Gerd Hoffmann | case SEARCH_EQUAL:
|
940 | 97a06435 | Gerd Hoffmann | case SEARCH_HIGH:
|
941 | 97a06435 | Gerd Hoffmann | case SEARCH_LOW:
|
942 | 97a06435 | Gerd Hoffmann | case UPDATE_BLOCK:
|
943 | 5e30a07d | Hannes Reinecke | case WRITE_LONG_10:
|
944 | 5e30a07d | Hannes Reinecke | case WRITE_SAME_10:
|
945 | a5ee9085 | Paolo Bonzini | case WRITE_SAME_16:
|
946 | 381b634c | Ronnie Sahlberg | case UNMAP:
|
947 | 97a06435 | Gerd Hoffmann | case SEARCH_HIGH_12:
|
948 | 97a06435 | Gerd Hoffmann | case SEARCH_EQUAL_12:
|
949 | 97a06435 | Gerd Hoffmann | case SEARCH_LOW_12:
|
950 | 97a06435 | Gerd Hoffmann | case MEDIUM_SCAN:
|
951 | 97a06435 | Gerd Hoffmann | case SEND_VOLUME_TAG:
|
952 | 06b86357 | Paolo Bonzini | case SEND_CUE_SHEET:
|
953 | 06b86357 | Paolo Bonzini | case SEND_DVD_STRUCTURE:
|
954 | 01bedeba | Nicholas Bellinger | case PERSISTENT_RESERVE_OUT:
|
955 | c7126d5b | Nicholas Bellinger | case MAINTENANCE_OUT:
|
956 | 381b634c | Ronnie Sahlberg | case ATA_PASSTHROUGH:
|
957 | 2599aece | Paolo Bonzini | cmd->mode = SCSI_XFER_TO_DEV; |
958 | 97a06435 | Gerd Hoffmann | break;
|
959 | 97a06435 | Gerd Hoffmann | default:
|
960 | a5ee9085 | Paolo Bonzini | cmd->mode = SCSI_XFER_FROM_DEV; |
961 | 97a06435 | Gerd Hoffmann | break;
|
962 | 97a06435 | Gerd Hoffmann | } |
963 | 97a06435 | Gerd Hoffmann | } |
964 | 97a06435 | Gerd Hoffmann | |
965 | 2599aece | Paolo Bonzini | static uint64_t scsi_cmd_lba(SCSICommand *cmd)
|
966 | 2ec749cb | Gerd Hoffmann | { |
967 | 2599aece | Paolo Bonzini | uint8_t *buf = cmd->buf; |
968 | 2ec749cb | Gerd Hoffmann | uint64_t lba; |
969 | 2ec749cb | Gerd Hoffmann | |
970 | 2ec749cb | Gerd Hoffmann | switch (buf[0] >> 5) { |
971 | 2ec749cb | Gerd Hoffmann | case 0: |
972 | bd5da232 | Paolo Bonzini | lba = ldl_be_p(&buf[0]) & 0x1fffff; |
973 | 2ec749cb | Gerd Hoffmann | break;
|
974 | 2ec749cb | Gerd Hoffmann | case 1: |
975 | 2ec749cb | Gerd Hoffmann | case 2: |
976 | bd5da232 | Paolo Bonzini | case 5: |
977 | 06b86357 | Paolo Bonzini | lba = ldl_be_p(&buf[2]) & 0xffffffffULL; |
978 | 2ec749cb | Gerd Hoffmann | break;
|
979 | 2ec749cb | Gerd Hoffmann | case 4: |
980 | bd5da232 | Paolo Bonzini | lba = ldq_be_p(&buf[2]);
|
981 | 2ec749cb | Gerd Hoffmann | break;
|
982 | 2ec749cb | Gerd Hoffmann | default:
|
983 | 2ec749cb | Gerd Hoffmann | lba = -1;
|
984 | 2ec749cb | Gerd Hoffmann | |
985 | 2ec749cb | Gerd Hoffmann | } |
986 | 2ec749cb | Gerd Hoffmann | return lba;
|
987 | 2ec749cb | Gerd Hoffmann | } |
988 | 2ec749cb | Gerd Hoffmann | |
989 | afa46c46 | Paolo Bonzini | int scsi_req_parse(SCSICommand *cmd, SCSIDevice *dev, uint8_t *buf)
|
990 | 2ec749cb | Gerd Hoffmann | { |
991 | 2ec749cb | Gerd Hoffmann | int rc;
|
992 | 2ec749cb | Gerd Hoffmann | |
993 | afa46c46 | Paolo Bonzini | if (dev->type == TYPE_TAPE) {
|
994 | afa46c46 | Paolo Bonzini | rc = scsi_req_stream_length(cmd, dev, buf); |
995 | 2ec749cb | Gerd Hoffmann | } else {
|
996 | afa46c46 | Paolo Bonzini | rc = scsi_req_length(cmd, dev, buf); |
997 | 2ec749cb | Gerd Hoffmann | } |
998 | 2ec749cb | Gerd Hoffmann | if (rc != 0) |
999 | 2ec749cb | Gerd Hoffmann | return rc;
|
1000 | 2ec749cb | Gerd Hoffmann | |
1001 | afa46c46 | Paolo Bonzini | memcpy(cmd->buf, buf, cmd->len); |
1002 | afa46c46 | Paolo Bonzini | scsi_cmd_xfer_mode(cmd); |
1003 | afa46c46 | Paolo Bonzini | cmd->lba = scsi_cmd_lba(cmd); |
1004 | 2ec749cb | Gerd Hoffmann | return 0; |
1005 | 2ec749cb | Gerd Hoffmann | } |
1006 | ed3a34a3 | Gerd Hoffmann | |
1007 | a1f0cce2 | Hannes Reinecke | /*
|
1008 | a1f0cce2 | Hannes Reinecke | * Predefined sense codes
|
1009 | a1f0cce2 | Hannes Reinecke | */
|
1010 | a1f0cce2 | Hannes Reinecke | |
1011 | a1f0cce2 | Hannes Reinecke | /* No sense data available */
|
1012 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_NO_SENSE = { |
1013 | a1f0cce2 | Hannes Reinecke | .key = NO_SENSE , .asc = 0x00 , .ascq = 0x00 |
1014 | a1f0cce2 | Hannes Reinecke | }; |
1015 | a1f0cce2 | Hannes Reinecke | |
1016 | a1f0cce2 | Hannes Reinecke | /* LUN not ready, Manual intervention required */
|
1017 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_LUN_NOT_READY = { |
1018 | a1f0cce2 | Hannes Reinecke | .key = NOT_READY, .asc = 0x04, .ascq = 0x03 |
1019 | a1f0cce2 | Hannes Reinecke | }; |
1020 | a1f0cce2 | Hannes Reinecke | |
1021 | a1f0cce2 | Hannes Reinecke | /* LUN not ready, Medium not present */
|
1022 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_NO_MEDIUM = { |
1023 | a1f0cce2 | Hannes Reinecke | .key = NOT_READY, .asc = 0x3a, .ascq = 0x00 |
1024 | a1f0cce2 | Hannes Reinecke | }; |
1025 | a1f0cce2 | Hannes Reinecke | |
1026 | 68bb01f3 | Markus Armbruster | /* LUN not ready, medium removal prevented */
|
1027 | 68bb01f3 | Markus Armbruster | const struct SCSISense sense_code_NOT_READY_REMOVAL_PREVENTED = { |
1028 | 68bb01f3 | Markus Armbruster | .key = NOT_READY, .asc = 0x53, .ascq = 0x00 |
1029 | 68bb01f3 | Markus Armbruster | }; |
1030 | 68bb01f3 | Markus Armbruster | |
1031 | a1f0cce2 | Hannes Reinecke | /* Hardware error, internal target failure */
|
1032 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_TARGET_FAILURE = { |
1033 | a1f0cce2 | Hannes Reinecke | .key = HARDWARE_ERROR, .asc = 0x44, .ascq = 0x00 |
1034 | a1f0cce2 | Hannes Reinecke | }; |
1035 | a1f0cce2 | Hannes Reinecke | |
1036 | a1f0cce2 | Hannes Reinecke | /* Illegal request, invalid command operation code */
|
1037 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_INVALID_OPCODE = { |
1038 | a1f0cce2 | Hannes Reinecke | .key = ILLEGAL_REQUEST, .asc = 0x20, .ascq = 0x00 |
1039 | a1f0cce2 | Hannes Reinecke | }; |
1040 | a1f0cce2 | Hannes Reinecke | |
1041 | a1f0cce2 | Hannes Reinecke | /* Illegal request, LBA out of range */
|
1042 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_LBA_OUT_OF_RANGE = { |
1043 | a1f0cce2 | Hannes Reinecke | .key = ILLEGAL_REQUEST, .asc = 0x21, .ascq = 0x00 |
1044 | a1f0cce2 | Hannes Reinecke | }; |
1045 | a1f0cce2 | Hannes Reinecke | |
1046 | a1f0cce2 | Hannes Reinecke | /* Illegal request, Invalid field in CDB */
|
1047 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_INVALID_FIELD = { |
1048 | a1f0cce2 | Hannes Reinecke | .key = ILLEGAL_REQUEST, .asc = 0x24, .ascq = 0x00 |
1049 | a1f0cce2 | Hannes Reinecke | }; |
1050 | a1f0cce2 | Hannes Reinecke | |
1051 | a1f0cce2 | Hannes Reinecke | /* Illegal request, LUN not supported */
|
1052 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_LUN_NOT_SUPPORTED = { |
1053 | a1f0cce2 | Hannes Reinecke | .key = ILLEGAL_REQUEST, .asc = 0x25, .ascq = 0x00 |
1054 | a1f0cce2 | Hannes Reinecke | }; |
1055 | a1f0cce2 | Hannes Reinecke | |
1056 | a872a304 | Paolo Bonzini | /* Illegal request, Saving parameters not supported */
|
1057 | a872a304 | Paolo Bonzini | const struct SCSISense sense_code_SAVING_PARAMS_NOT_SUPPORTED = { |
1058 | a872a304 | Paolo Bonzini | .key = ILLEGAL_REQUEST, .asc = 0x39, .ascq = 0x00 |
1059 | a872a304 | Paolo Bonzini | }; |
1060 | a872a304 | Paolo Bonzini | |
1061 | a872a304 | Paolo Bonzini | /* Illegal request, Incompatible medium installed */
|
1062 | 67cc61e4 | Paolo Bonzini | const struct SCSISense sense_code_INCOMPATIBLE_FORMAT = { |
1063 | a872a304 | Paolo Bonzini | .key = ILLEGAL_REQUEST, .asc = 0x30, .ascq = 0x00 |
1064 | a872a304 | Paolo Bonzini | }; |
1065 | a872a304 | Paolo Bonzini | |
1066 | 68bb01f3 | Markus Armbruster | /* Illegal request, medium removal prevented */
|
1067 | 68bb01f3 | Markus Armbruster | const struct SCSISense sense_code_ILLEGAL_REQ_REMOVAL_PREVENTED = { |
1068 | 68bb01f3 | Markus Armbruster | .key = ILLEGAL_REQUEST, .asc = 0x53, .ascq = 0x00 |
1069 | 68bb01f3 | Markus Armbruster | }; |
1070 | 68bb01f3 | Markus Armbruster | |
1071 | a1f0cce2 | Hannes Reinecke | /* Command aborted, I/O process terminated */
|
1072 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_IO_ERROR = { |
1073 | a1f0cce2 | Hannes Reinecke | .key = ABORTED_COMMAND, .asc = 0x00, .ascq = 0x06 |
1074 | a1f0cce2 | Hannes Reinecke | }; |
1075 | a1f0cce2 | Hannes Reinecke | |
1076 | a1f0cce2 | Hannes Reinecke | /* Command aborted, I_T Nexus loss occurred */
|
1077 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_I_T_NEXUS_LOSS = { |
1078 | a1f0cce2 | Hannes Reinecke | .key = ABORTED_COMMAND, .asc = 0x29, .ascq = 0x07 |
1079 | a1f0cce2 | Hannes Reinecke | }; |
1080 | a1f0cce2 | Hannes Reinecke | |
1081 | a1f0cce2 | Hannes Reinecke | /* Command aborted, Logical Unit failure */
|
1082 | a1f0cce2 | Hannes Reinecke | const struct SCSISense sense_code_LUN_FAILURE = { |
1083 | a1f0cce2 | Hannes Reinecke | .key = ABORTED_COMMAND, .asc = 0x3e, .ascq = 0x01 |
1084 | a1f0cce2 | Hannes Reinecke | }; |
1085 | a1f0cce2 | Hannes Reinecke | |
1086 | a872a304 | Paolo Bonzini | /* Unit attention, Power on, reset or bus device reset occurred */
|
1087 | a872a304 | Paolo Bonzini | const struct SCSISense sense_code_RESET = { |
1088 | a872a304 | Paolo Bonzini | .key = UNIT_ATTENTION, .asc = 0x29, .ascq = 0x00 |
1089 | a872a304 | Paolo Bonzini | }; |
1090 | a872a304 | Paolo Bonzini | |
1091 | 8a9c16f6 | Paolo Bonzini | /* Unit attention, No medium */
|
1092 | 8a9c16f6 | Paolo Bonzini | const struct SCSISense sense_code_UNIT_ATTENTION_NO_MEDIUM = { |
1093 | 8a9c16f6 | Paolo Bonzini | .key = UNIT_ATTENTION, .asc = 0x3a, .ascq = 0x00 |
1094 | 8a9c16f6 | Paolo Bonzini | }; |
1095 | 8a9c16f6 | Paolo Bonzini | |
1096 | a872a304 | Paolo Bonzini | /* Unit attention, Medium may have changed */
|
1097 | a872a304 | Paolo Bonzini | const struct SCSISense sense_code_MEDIUM_CHANGED = { |
1098 | a872a304 | Paolo Bonzini | .key = UNIT_ATTENTION, .asc = 0x28, .ascq = 0x00 |
1099 | a872a304 | Paolo Bonzini | }; |
1100 | a872a304 | Paolo Bonzini | |
1101 | a872a304 | Paolo Bonzini | /* Unit attention, Reported LUNs data has changed */
|
1102 | a872a304 | Paolo Bonzini | const struct SCSISense sense_code_REPORTED_LUNS_CHANGED = { |
1103 | a872a304 | Paolo Bonzini | .key = UNIT_ATTENTION, .asc = 0x3f, .ascq = 0x0e |
1104 | a872a304 | Paolo Bonzini | }; |
1105 | a872a304 | Paolo Bonzini | |
1106 | a872a304 | Paolo Bonzini | /* Unit attention, Device internal reset */
|
1107 | a872a304 | Paolo Bonzini | const struct SCSISense sense_code_DEVICE_INTERNAL_RESET = { |
1108 | a872a304 | Paolo Bonzini | .key = UNIT_ATTENTION, .asc = 0x29, .ascq = 0x04 |
1109 | a872a304 | Paolo Bonzini | }; |
1110 | a872a304 | Paolo Bonzini | |
1111 | a1f0cce2 | Hannes Reinecke | /*
|
1112 | a1f0cce2 | Hannes Reinecke | * scsi_build_sense
|
1113 | a1f0cce2 | Hannes Reinecke | *
|
1114 | b45ef674 | Paolo Bonzini | * Convert between fixed and descriptor sense buffers
|
1115 | a1f0cce2 | Hannes Reinecke | */
|
1116 | b45ef674 | Paolo Bonzini | int scsi_build_sense(uint8_t *in_buf, int in_len, |
1117 | b45ef674 | Paolo Bonzini | uint8_t *buf, int len, bool fixed) |
1118 | a1f0cce2 | Hannes Reinecke | { |
1119 | b45ef674 | Paolo Bonzini | bool fixed_in;
|
1120 | b45ef674 | Paolo Bonzini | SCSISense sense; |
1121 | a1f0cce2 | Hannes Reinecke | if (!fixed && len < 8) { |
1122 | a1f0cce2 | Hannes Reinecke | return 0; |
1123 | a1f0cce2 | Hannes Reinecke | } |
1124 | a1f0cce2 | Hannes Reinecke | |
1125 | b45ef674 | Paolo Bonzini | if (in_len == 0) { |
1126 | b45ef674 | Paolo Bonzini | sense.key = NO_SENSE; |
1127 | b45ef674 | Paolo Bonzini | sense.asc = 0;
|
1128 | b45ef674 | Paolo Bonzini | sense.ascq = 0;
|
1129 | b45ef674 | Paolo Bonzini | } else {
|
1130 | b45ef674 | Paolo Bonzini | fixed_in = (in_buf[0] & 2) == 0; |
1131 | b45ef674 | Paolo Bonzini | |
1132 | b45ef674 | Paolo Bonzini | if (fixed == fixed_in) {
|
1133 | b45ef674 | Paolo Bonzini | memcpy(buf, in_buf, MIN(len, in_len)); |
1134 | b45ef674 | Paolo Bonzini | return MIN(len, in_len);
|
1135 | b45ef674 | Paolo Bonzini | } |
1136 | b45ef674 | Paolo Bonzini | |
1137 | b45ef674 | Paolo Bonzini | if (fixed_in) {
|
1138 | b45ef674 | Paolo Bonzini | sense.key = in_buf[2];
|
1139 | b45ef674 | Paolo Bonzini | sense.asc = in_buf[12];
|
1140 | b45ef674 | Paolo Bonzini | sense.ascq = in_buf[13];
|
1141 | b45ef674 | Paolo Bonzini | } else {
|
1142 | b45ef674 | Paolo Bonzini | sense.key = in_buf[1];
|
1143 | b45ef674 | Paolo Bonzini | sense.asc = in_buf[2];
|
1144 | b45ef674 | Paolo Bonzini | sense.ascq = in_buf[3];
|
1145 | b45ef674 | Paolo Bonzini | } |
1146 | b45ef674 | Paolo Bonzini | } |
1147 | b45ef674 | Paolo Bonzini | |
1148 | a1f0cce2 | Hannes Reinecke | memset(buf, 0, len);
|
1149 | a1f0cce2 | Hannes Reinecke | if (fixed) {
|
1150 | a1f0cce2 | Hannes Reinecke | /* Return fixed format sense buffer */
|
1151 | 77e4743c | Paolo Bonzini | buf[0] = 0x70; |
1152 | a1f0cce2 | Hannes Reinecke | buf[2] = sense.key;
|
1153 | eae31cb9 | Paolo Bonzini | buf[7] = 10; |
1154 | a1f0cce2 | Hannes Reinecke | buf[12] = sense.asc;
|
1155 | a1f0cce2 | Hannes Reinecke | buf[13] = sense.ascq;
|
1156 | a1f0cce2 | Hannes Reinecke | return MIN(len, 18); |
1157 | a1f0cce2 | Hannes Reinecke | } else {
|
1158 | a1f0cce2 | Hannes Reinecke | /* Return descriptor format sense buffer */
|
1159 | a1f0cce2 | Hannes Reinecke | buf[0] = 0x72; |
1160 | a1f0cce2 | Hannes Reinecke | buf[1] = sense.key;
|
1161 | a1f0cce2 | Hannes Reinecke | buf[2] = sense.asc;
|
1162 | a1f0cce2 | Hannes Reinecke | buf[3] = sense.ascq;
|
1163 | a1f0cce2 | Hannes Reinecke | return 8; |
1164 | a1f0cce2 | Hannes Reinecke | } |
1165 | a1f0cce2 | Hannes Reinecke | } |
1166 | a1f0cce2 | Hannes Reinecke | |
1167 | ec766865 | Gerd Hoffmann | static const char *scsi_command_name(uint8_t cmd) |
1168 | ec766865 | Gerd Hoffmann | { |
1169 | ec766865 | Gerd Hoffmann | static const char *names[] = { |
1170 | ec766865 | Gerd Hoffmann | [ TEST_UNIT_READY ] = "TEST_UNIT_READY",
|
1171 | 5e30a07d | Hannes Reinecke | [ REWIND ] = "REWIND",
|
1172 | ec766865 | Gerd Hoffmann | [ REQUEST_SENSE ] = "REQUEST_SENSE",
|
1173 | ec766865 | Gerd Hoffmann | [ FORMAT_UNIT ] = "FORMAT_UNIT",
|
1174 | ec766865 | Gerd Hoffmann | [ READ_BLOCK_LIMITS ] = "READ_BLOCK_LIMITS",
|
1175 | ec766865 | Gerd Hoffmann | [ REASSIGN_BLOCKS ] = "REASSIGN_BLOCKS",
|
1176 | ec766865 | Gerd Hoffmann | [ READ_6 ] = "READ_6",
|
1177 | ec766865 | Gerd Hoffmann | [ WRITE_6 ] = "WRITE_6",
|
1178 | 00a01ad4 | Paolo Bonzini | [ SET_CAPACITY ] = "SET_CAPACITY",
|
1179 | ec766865 | Gerd Hoffmann | [ READ_REVERSE ] = "READ_REVERSE",
|
1180 | ec766865 | Gerd Hoffmann | [ WRITE_FILEMARKS ] = "WRITE_FILEMARKS",
|
1181 | ec766865 | Gerd Hoffmann | [ SPACE ] = "SPACE",
|
1182 | ec766865 | Gerd Hoffmann | [ INQUIRY ] = "INQUIRY",
|
1183 | ec766865 | Gerd Hoffmann | [ RECOVER_BUFFERED_DATA ] = "RECOVER_BUFFERED_DATA",
|
1184 | c7126d5b | Nicholas Bellinger | [ MAINTENANCE_IN ] = "MAINTENANCE_IN",
|
1185 | c7126d5b | Nicholas Bellinger | [ MAINTENANCE_OUT ] = "MAINTENANCE_OUT",
|
1186 | ec766865 | Gerd Hoffmann | [ MODE_SELECT ] = "MODE_SELECT",
|
1187 | ec766865 | Gerd Hoffmann | [ RESERVE ] = "RESERVE",
|
1188 | ec766865 | Gerd Hoffmann | [ RELEASE ] = "RELEASE",
|
1189 | ec766865 | Gerd Hoffmann | [ COPY ] = "COPY",
|
1190 | ec766865 | Gerd Hoffmann | [ ERASE ] = "ERASE",
|
1191 | ec766865 | Gerd Hoffmann | [ MODE_SENSE ] = "MODE_SENSE",
|
1192 | ec766865 | Gerd Hoffmann | [ START_STOP ] = "START_STOP",
|
1193 | ec766865 | Gerd Hoffmann | [ RECEIVE_DIAGNOSTIC ] = "RECEIVE_DIAGNOSTIC",
|
1194 | ec766865 | Gerd Hoffmann | [ SEND_DIAGNOSTIC ] = "SEND_DIAGNOSTIC",
|
1195 | ec766865 | Gerd Hoffmann | [ ALLOW_MEDIUM_REMOVAL ] = "ALLOW_MEDIUM_REMOVAL",
|
1196 | 5e30a07d | Hannes Reinecke | [ READ_CAPACITY_10 ] = "READ_CAPACITY_10",
|
1197 | ec766865 | Gerd Hoffmann | [ READ_10 ] = "READ_10",
|
1198 | ec766865 | Gerd Hoffmann | [ WRITE_10 ] = "WRITE_10",
|
1199 | ec766865 | Gerd Hoffmann | [ SEEK_10 ] = "SEEK_10",
|
1200 | 5e30a07d | Hannes Reinecke | [ WRITE_VERIFY_10 ] = "WRITE_VERIFY_10",
|
1201 | 5e30a07d | Hannes Reinecke | [ VERIFY_10 ] = "VERIFY_10",
|
1202 | ec766865 | Gerd Hoffmann | [ SEARCH_HIGH ] = "SEARCH_HIGH",
|
1203 | ec766865 | Gerd Hoffmann | [ SEARCH_EQUAL ] = "SEARCH_EQUAL",
|
1204 | ec766865 | Gerd Hoffmann | [ SEARCH_LOW ] = "SEARCH_LOW",
|
1205 | ec766865 | Gerd Hoffmann | [ SET_LIMITS ] = "SET_LIMITS",
|
1206 | 00a01ad4 | Paolo Bonzini | [ PRE_FETCH ] = "PRE_FETCH/READ_POSITION",
|
1207 | 545557d4 | Blue Swirl | /* READ_POSITION and PRE_FETCH use the same operation code */
|
1208 | ec766865 | Gerd Hoffmann | [ SYNCHRONIZE_CACHE ] = "SYNCHRONIZE_CACHE",
|
1209 | ec766865 | Gerd Hoffmann | [ LOCK_UNLOCK_CACHE ] = "LOCK_UNLOCK_CACHE",
|
1210 | ec766865 | Gerd Hoffmann | [ READ_DEFECT_DATA ] = "READ_DEFECT_DATA",
|
1211 | ec766865 | Gerd Hoffmann | [ MEDIUM_SCAN ] = "MEDIUM_SCAN",
|
1212 | ec766865 | Gerd Hoffmann | [ COMPARE ] = "COMPARE",
|
1213 | ec766865 | Gerd Hoffmann | [ COPY_VERIFY ] = "COPY_VERIFY",
|
1214 | ec766865 | Gerd Hoffmann | [ WRITE_BUFFER ] = "WRITE_BUFFER",
|
1215 | ec766865 | Gerd Hoffmann | [ READ_BUFFER ] = "READ_BUFFER",
|
1216 | ec766865 | Gerd Hoffmann | [ UPDATE_BLOCK ] = "UPDATE_BLOCK",
|
1217 | 5e30a07d | Hannes Reinecke | [ READ_LONG_10 ] = "READ_LONG_10",
|
1218 | 5e30a07d | Hannes Reinecke | [ WRITE_LONG_10 ] = "WRITE_LONG_10",
|
1219 | ec766865 | Gerd Hoffmann | [ CHANGE_DEFINITION ] = "CHANGE_DEFINITION",
|
1220 | 5e30a07d | Hannes Reinecke | [ WRITE_SAME_10 ] = "WRITE_SAME_10",
|
1221 | 5e30a07d | Hannes Reinecke | [ UNMAP ] = "UNMAP",
|
1222 | ec766865 | Gerd Hoffmann | [ READ_TOC ] = "READ_TOC",
|
1223 | 5e30a07d | Hannes Reinecke | [ REPORT_DENSITY_SUPPORT ] = "REPORT_DENSITY_SUPPORT",
|
1224 | 3e46d87d | Paolo Bonzini | [ SANITIZE ] = "SANITIZE",
|
1225 | 5e30a07d | Hannes Reinecke | [ GET_CONFIGURATION ] = "GET_CONFIGURATION",
|
1226 | ec766865 | Gerd Hoffmann | [ LOG_SELECT ] = "LOG_SELECT",
|
1227 | ec766865 | Gerd Hoffmann | [ LOG_SENSE ] = "LOG_SENSE",
|
1228 | ec766865 | Gerd Hoffmann | [ MODE_SELECT_10 ] = "MODE_SELECT_10",
|
1229 | ec766865 | Gerd Hoffmann | [ RESERVE_10 ] = "RESERVE_10",
|
1230 | ec766865 | Gerd Hoffmann | [ RELEASE_10 ] = "RELEASE_10",
|
1231 | ec766865 | Gerd Hoffmann | [ MODE_SENSE_10 ] = "MODE_SENSE_10",
|
1232 | ec766865 | Gerd Hoffmann | [ PERSISTENT_RESERVE_IN ] = "PERSISTENT_RESERVE_IN",
|
1233 | ec766865 | Gerd Hoffmann | [ PERSISTENT_RESERVE_OUT ] = "PERSISTENT_RESERVE_OUT",
|
1234 | 5e30a07d | Hannes Reinecke | [ WRITE_FILEMARKS_16 ] = "WRITE_FILEMARKS_16",
|
1235 | 5e30a07d | Hannes Reinecke | [ EXTENDED_COPY ] = "EXTENDED_COPY",
|
1236 | 5e30a07d | Hannes Reinecke | [ ATA_PASSTHROUGH ] = "ATA_PASSTHROUGH",
|
1237 | 5e30a07d | Hannes Reinecke | [ ACCESS_CONTROL_IN ] = "ACCESS_CONTROL_IN",
|
1238 | 5e30a07d | Hannes Reinecke | [ ACCESS_CONTROL_OUT ] = "ACCESS_CONTROL_OUT",
|
1239 | 5e30a07d | Hannes Reinecke | [ READ_16 ] = "READ_16",
|
1240 | 5e30a07d | Hannes Reinecke | [ COMPARE_AND_WRITE ] = "COMPARE_AND_WRITE",
|
1241 | 5e30a07d | Hannes Reinecke | [ WRITE_16 ] = "WRITE_16",
|
1242 | 5e30a07d | Hannes Reinecke | [ WRITE_VERIFY_16 ] = "WRITE_VERIFY_16",
|
1243 | 5e30a07d | Hannes Reinecke | [ VERIFY_16 ] = "VERIFY_16",
|
1244 | 00a01ad4 | Paolo Bonzini | [ PRE_FETCH_16 ] = "PRE_FETCH_16",
|
1245 | 00a01ad4 | Paolo Bonzini | [ SYNCHRONIZE_CACHE_16 ] = "SPACE_16/SYNCHRONIZE_CACHE_16",
|
1246 | 00a01ad4 | Paolo Bonzini | /* SPACE_16 and SYNCHRONIZE_CACHE_16 use the same operation code */
|
1247 | 5e30a07d | Hannes Reinecke | [ LOCATE_16 ] = "LOCATE_16",
|
1248 | 00a01ad4 | Paolo Bonzini | [ WRITE_SAME_16 ] = "ERASE_16/WRITE_SAME_16",
|
1249 | 48bb9f53 | Blue Swirl | /* ERASE_16 and WRITE_SAME_16 use the same operation code */
|
1250 | f6515262 | Paolo Bonzini | [ SERVICE_ACTION_IN_16 ] = "SERVICE_ACTION_IN_16",
|
1251 | 5e30a07d | Hannes Reinecke | [ WRITE_LONG_16 ] = "WRITE_LONG_16",
|
1252 | 5e30a07d | Hannes Reinecke | [ REPORT_LUNS ] = "REPORT_LUNS",
|
1253 | 5e30a07d | Hannes Reinecke | [ BLANK ] = "BLANK",
|
1254 | ec766865 | Gerd Hoffmann | [ MOVE_MEDIUM ] = "MOVE_MEDIUM",
|
1255 | 5e30a07d | Hannes Reinecke | [ LOAD_UNLOAD ] = "LOAD_UNLOAD",
|
1256 | ec766865 | Gerd Hoffmann | [ READ_12 ] = "READ_12",
|
1257 | ec766865 | Gerd Hoffmann | [ WRITE_12 ] = "WRITE_12",
|
1258 | 00a01ad4 | Paolo Bonzini | [ ERASE_12 ] = "ERASE_12/GET_PERFORMANCE",
|
1259 | 00a01ad4 | Paolo Bonzini | /* ERASE_12 and GET_PERFORMANCE use the same operation code */
|
1260 | f6515262 | Paolo Bonzini | [ SERVICE_ACTION_IN_12 ] = "SERVICE_ACTION_IN_12",
|
1261 | ec766865 | Gerd Hoffmann | [ WRITE_VERIFY_12 ] = "WRITE_VERIFY_12",
|
1262 | 5e30a07d | Hannes Reinecke | [ VERIFY_12 ] = "VERIFY_12",
|
1263 | ec766865 | Gerd Hoffmann | [ SEARCH_HIGH_12 ] = "SEARCH_HIGH_12",
|
1264 | ec766865 | Gerd Hoffmann | [ SEARCH_EQUAL_12 ] = "SEARCH_EQUAL_12",
|
1265 | ec766865 | Gerd Hoffmann | [ SEARCH_LOW_12 ] = "SEARCH_LOW_12",
|
1266 | ec766865 | Gerd Hoffmann | [ READ_ELEMENT_STATUS ] = "READ_ELEMENT_STATUS",
|
1267 | 00a01ad4 | Paolo Bonzini | [ SEND_VOLUME_TAG ] = "SEND_VOLUME_TAG/SET_STREAMING",
|
1268 | 00a01ad4 | Paolo Bonzini | /* SEND_VOLUME_TAG and SET_STREAMING use the same operation code */
|
1269 | 00a01ad4 | Paolo Bonzini | [ READ_CD ] = "READ_CD",
|
1270 | 5e30a07d | Hannes Reinecke | [ READ_DEFECT_DATA_12 ] = "READ_DEFECT_DATA_12",
|
1271 | 00a01ad4 | Paolo Bonzini | [ READ_DVD_STRUCTURE ] = "READ_DVD_STRUCTURE",
|
1272 | 00a01ad4 | Paolo Bonzini | [ RESERVE_TRACK ] = "RESERVE_TRACK",
|
1273 | 00a01ad4 | Paolo Bonzini | [ SEND_CUE_SHEET ] = "SEND_CUE_SHEET",
|
1274 | 00a01ad4 | Paolo Bonzini | [ SEND_DVD_STRUCTURE ] = "SEND_DVD_STRUCTURE",
|
1275 | ec766865 | Gerd Hoffmann | [ SET_CD_SPEED ] = "SET_CD_SPEED",
|
1276 | 00a01ad4 | Paolo Bonzini | [ SET_READ_AHEAD ] = "SET_READ_AHEAD",
|
1277 | 00a01ad4 | Paolo Bonzini | [ ALLOW_OVERWRITE ] = "ALLOW_OVERWRITE",
|
1278 | 00a01ad4 | Paolo Bonzini | [ MECHANISM_STATUS ] = "MECHANISM_STATUS",
|
1279 | ec766865 | Gerd Hoffmann | }; |
1280 | ec766865 | Gerd Hoffmann | |
1281 | ec766865 | Gerd Hoffmann | if (cmd >= ARRAY_SIZE(names) || names[cmd] == NULL) |
1282 | ec766865 | Gerd Hoffmann | return "*UNKNOWN*"; |
1283 | ec766865 | Gerd Hoffmann | return names[cmd];
|
1284 | ec766865 | Gerd Hoffmann | } |
1285 | ec766865 | Gerd Hoffmann | |
1286 | ad2d30f7 | Paolo Bonzini | SCSIRequest *scsi_req_ref(SCSIRequest *req) |
1287 | ad2d30f7 | Paolo Bonzini | { |
1288 | ad2d30f7 | Paolo Bonzini | req->refcount++; |
1289 | ad2d30f7 | Paolo Bonzini | return req;
|
1290 | ad2d30f7 | Paolo Bonzini | } |
1291 | ad2d30f7 | Paolo Bonzini | |
1292 | ad2d30f7 | Paolo Bonzini | void scsi_req_unref(SCSIRequest *req)
|
1293 | ad2d30f7 | Paolo Bonzini | { |
1294 | 68bd348a | Stefan Weil | assert(req->refcount > 0);
|
1295 | ad2d30f7 | Paolo Bonzini | if (--req->refcount == 0) { |
1296 | 12010e7b | Paolo Bonzini | if (req->ops->free_req) {
|
1297 | 12010e7b | Paolo Bonzini | req->ops->free_req(req); |
1298 | ad2d30f7 | Paolo Bonzini | } |
1299 | 7267c094 | Anthony Liguori | g_free(req); |
1300 | ad2d30f7 | Paolo Bonzini | } |
1301 | ad2d30f7 | Paolo Bonzini | } |
1302 | ad2d30f7 | Paolo Bonzini | |
1303 | ad3376cc | Paolo Bonzini | /* Tell the device that we finished processing this chunk of I/O. It
|
1304 | ad3376cc | Paolo Bonzini | will start the next chunk or complete the command. */
|
1305 | ad3376cc | Paolo Bonzini | void scsi_req_continue(SCSIRequest *req)
|
1306 | ad3376cc | Paolo Bonzini | { |
1307 | ad3376cc | Paolo Bonzini | trace_scsi_req_continue(req->dev->id, req->lun, req->tag); |
1308 | ad3376cc | Paolo Bonzini | if (req->cmd.mode == SCSI_XFER_TO_DEV) {
|
1309 | 12010e7b | Paolo Bonzini | req->ops->write_data(req); |
1310 | ad3376cc | Paolo Bonzini | } else {
|
1311 | 12010e7b | Paolo Bonzini | req->ops->read_data(req); |
1312 | ad3376cc | Paolo Bonzini | } |
1313 | ad3376cc | Paolo Bonzini | } |
1314 | ad3376cc | Paolo Bonzini | |
1315 | ab9adc88 | Paolo Bonzini | /* Called by the devices when data is ready for the HBA. The HBA should
|
1316 | ab9adc88 | Paolo Bonzini | start a DMA operation to read or fill the device's data buffer.
|
1317 | ad3376cc | Paolo Bonzini | Once it completes, calling scsi_req_continue will restart I/O. */
|
1318 | ab9adc88 | Paolo Bonzini | void scsi_req_data(SCSIRequest *req, int len) |
1319 | ab9adc88 | Paolo Bonzini | { |
1320 | 3d5aba97 | Paolo Bonzini | uint8_t *buf; |
1321 | e88c591d | Paolo Bonzini | if (req->io_canceled) {
|
1322 | e88c591d | Paolo Bonzini | trace_scsi_req_data_canceled(req->dev->id, req->lun, req->tag, len); |
1323 | 01e95455 | Paolo Bonzini | return;
|
1324 | e88c591d | Paolo Bonzini | } |
1325 | 01e95455 | Paolo Bonzini | trace_scsi_req_data(req->dev->id, req->lun, req->tag, len); |
1326 | 01e95455 | Paolo Bonzini | assert(req->cmd.mode != SCSI_XFER_NONE); |
1327 | 3d5aba97 | Paolo Bonzini | if (!req->sg) {
|
1328 | 3d5aba97 | Paolo Bonzini | req->resid -= len; |
1329 | 3d5aba97 | Paolo Bonzini | req->bus->info->transfer_data(req, len); |
1330 | 3d5aba97 | Paolo Bonzini | return;
|
1331 | 3d5aba97 | Paolo Bonzini | } |
1332 | 3d5aba97 | Paolo Bonzini | |
1333 | 3d5aba97 | Paolo Bonzini | /* If the device calls scsi_req_data and the HBA specified a
|
1334 | 3d5aba97 | Paolo Bonzini | * scatter/gather list, the transfer has to happen in a single
|
1335 | 3d5aba97 | Paolo Bonzini | * step. */
|
1336 | 3d5aba97 | Paolo Bonzini | assert(!req->dma_started); |
1337 | 3d5aba97 | Paolo Bonzini | req->dma_started = true;
|
1338 | 3d5aba97 | Paolo Bonzini | |
1339 | 3d5aba97 | Paolo Bonzini | buf = scsi_req_get_buf(req); |
1340 | 3d5aba97 | Paolo Bonzini | if (req->cmd.mode == SCSI_XFER_FROM_DEV) {
|
1341 | 3d5aba97 | Paolo Bonzini | req->resid = dma_buf_read(buf, len, req->sg); |
1342 | 3d5aba97 | Paolo Bonzini | } else {
|
1343 | 3d5aba97 | Paolo Bonzini | req->resid = dma_buf_write(buf, len, req->sg); |
1344 | 3d5aba97 | Paolo Bonzini | } |
1345 | 3d5aba97 | Paolo Bonzini | scsi_req_continue(req); |
1346 | ab9adc88 | Paolo Bonzini | } |
1347 | ab9adc88 | Paolo Bonzini | |
1348 | ec766865 | Gerd Hoffmann | void scsi_req_print(SCSIRequest *req)
|
1349 | ec766865 | Gerd Hoffmann | { |
1350 | ec766865 | Gerd Hoffmann | FILE *fp = stderr; |
1351 | ec766865 | Gerd Hoffmann | int i;
|
1352 | ec766865 | Gerd Hoffmann | |
1353 | ec766865 | Gerd Hoffmann | fprintf(fp, "[%s id=%d] %s",
|
1354 | ec766865 | Gerd Hoffmann | req->dev->qdev.parent_bus->name, |
1355 | ec766865 | Gerd Hoffmann | req->dev->id, |
1356 | ec766865 | Gerd Hoffmann | scsi_command_name(req->cmd.buf[0]));
|
1357 | ec766865 | Gerd Hoffmann | for (i = 1; i < req->cmd.len; i++) { |
1358 | ec766865 | Gerd Hoffmann | fprintf(fp, " 0x%02x", req->cmd.buf[i]);
|
1359 | ec766865 | Gerd Hoffmann | } |
1360 | ec766865 | Gerd Hoffmann | switch (req->cmd.mode) {
|
1361 | ec766865 | Gerd Hoffmann | case SCSI_XFER_NONE:
|
1362 | ec766865 | Gerd Hoffmann | fprintf(fp, " - none\n");
|
1363 | ec766865 | Gerd Hoffmann | break;
|
1364 | ec766865 | Gerd Hoffmann | case SCSI_XFER_FROM_DEV:
|
1365 | ec766865 | Gerd Hoffmann | fprintf(fp, " - from-dev len=%zd\n", req->cmd.xfer);
|
1366 | ec766865 | Gerd Hoffmann | break;
|
1367 | ec766865 | Gerd Hoffmann | case SCSI_XFER_TO_DEV:
|
1368 | ec766865 | Gerd Hoffmann | fprintf(fp, " - to-dev len=%zd\n", req->cmd.xfer);
|
1369 | ec766865 | Gerd Hoffmann | break;
|
1370 | ec766865 | Gerd Hoffmann | default:
|
1371 | ec766865 | Gerd Hoffmann | fprintf(fp, " - Oops\n");
|
1372 | ec766865 | Gerd Hoffmann | break;
|
1373 | ec766865 | Gerd Hoffmann | } |
1374 | ec766865 | Gerd Hoffmann | } |
1375 | ec766865 | Gerd Hoffmann | |
1376 | 682a9b21 | Paolo Bonzini | void scsi_req_complete(SCSIRequest *req, int status) |
1377 | ed3a34a3 | Gerd Hoffmann | { |
1378 | 682a9b21 | Paolo Bonzini | assert(req->status == -1);
|
1379 | 682a9b21 | Paolo Bonzini | req->status = status; |
1380 | b45ef674 | Paolo Bonzini | |
1381 | b45ef674 | Paolo Bonzini | assert(req->sense_len < sizeof(req->sense));
|
1382 | b45ef674 | Paolo Bonzini | if (status == GOOD) {
|
1383 | b45ef674 | Paolo Bonzini | req->sense_len = 0;
|
1384 | b45ef674 | Paolo Bonzini | } |
1385 | b45ef674 | Paolo Bonzini | |
1386 | b45ef674 | Paolo Bonzini | if (req->sense_len) {
|
1387 | b45ef674 | Paolo Bonzini | memcpy(req->dev->sense, req->sense, req->sense_len); |
1388 | 3653d8c4 | Paolo Bonzini | req->dev->sense_len = req->sense_len; |
1389 | 3653d8c4 | Paolo Bonzini | req->dev->sense_is_ua = (req->ops == &reqops_unit_attention); |
1390 | 3653d8c4 | Paolo Bonzini | } else {
|
1391 | 3653d8c4 | Paolo Bonzini | req->dev->sense_len = 0;
|
1392 | 3653d8c4 | Paolo Bonzini | req->dev->sense_is_ua = false;
|
1393 | b45ef674 | Paolo Bonzini | } |
1394 | b45ef674 | Paolo Bonzini | |
1395 | 6dc06f08 | Paolo Bonzini | /*
|
1396 | 6dc06f08 | Paolo Bonzini | * Unit attention state is now stored in the device's sense buffer
|
1397 | 6dc06f08 | Paolo Bonzini | * if the HBA didn't do autosense. Clear the pending unit attention
|
1398 | 6dc06f08 | Paolo Bonzini | * flags.
|
1399 | 6dc06f08 | Paolo Bonzini | */
|
1400 | 6dc06f08 | Paolo Bonzini | scsi_clear_unit_attention(req); |
1401 | 6dc06f08 | Paolo Bonzini | |
1402 | ad2d30f7 | Paolo Bonzini | scsi_req_ref(req); |
1403 | e8637c90 | Jan Kiszka | scsi_req_dequeue(req); |
1404 | 01e95455 | Paolo Bonzini | req->bus->info->complete(req, req->status, req->resid); |
1405 | ad2d30f7 | Paolo Bonzini | scsi_req_unref(req); |
1406 | ed3a34a3 | Gerd Hoffmann | } |
1407 | db07c0f8 | Gleb Natapov | |
1408 | 94d3f98a | Paolo Bonzini | void scsi_req_cancel(SCSIRequest *req)
|
1409 | 94d3f98a | Paolo Bonzini | { |
1410 | e88c591d | Paolo Bonzini | if (!req->enqueued) {
|
1411 | e88c591d | Paolo Bonzini | return;
|
1412 | 94d3f98a | Paolo Bonzini | } |
1413 | 94d3f98a | Paolo Bonzini | scsi_req_ref(req); |
1414 | 94d3f98a | Paolo Bonzini | scsi_req_dequeue(req); |
1415 | e88c591d | Paolo Bonzini | req->io_canceled = true;
|
1416 | e88c591d | Paolo Bonzini | if (req->ops->cancel_io) {
|
1417 | e88c591d | Paolo Bonzini | req->ops->cancel_io(req); |
1418 | e88c591d | Paolo Bonzini | } |
1419 | afd4030c | Paolo Bonzini | if (req->bus->info->cancel) {
|
1420 | afd4030c | Paolo Bonzini | req->bus->info->cancel(req); |
1421 | 94d3f98a | Paolo Bonzini | } |
1422 | 94d3f98a | Paolo Bonzini | scsi_req_unref(req); |
1423 | 94d3f98a | Paolo Bonzini | } |
1424 | 94d3f98a | Paolo Bonzini | |
1425 | 19d110ab | Paolo Bonzini | void scsi_req_abort(SCSIRequest *req, int status) |
1426 | 19d110ab | Paolo Bonzini | { |
1427 | e88c591d | Paolo Bonzini | if (!req->enqueued) {
|
1428 | e88c591d | Paolo Bonzini | return;
|
1429 | e88c591d | Paolo Bonzini | } |
1430 | e88c591d | Paolo Bonzini | scsi_req_ref(req); |
1431 | e88c591d | Paolo Bonzini | scsi_req_dequeue(req); |
1432 | e88c591d | Paolo Bonzini | req->io_canceled = true;
|
1433 | 12010e7b | Paolo Bonzini | if (req->ops->cancel_io) {
|
1434 | 12010e7b | Paolo Bonzini | req->ops->cancel_io(req); |
1435 | 19d110ab | Paolo Bonzini | } |
1436 | 682a9b21 | Paolo Bonzini | scsi_req_complete(req, status); |
1437 | e88c591d | Paolo Bonzini | scsi_req_unref(req); |
1438 | 19d110ab | Paolo Bonzini | } |
1439 | 19d110ab | Paolo Bonzini | |
1440 | c7b48872 | Paolo Bonzini | void scsi_device_purge_requests(SCSIDevice *sdev, SCSISense sense)
|
1441 | c557e889 | Paolo Bonzini | { |
1442 | c557e889 | Paolo Bonzini | SCSIRequest *req; |
1443 | c557e889 | Paolo Bonzini | |
1444 | c557e889 | Paolo Bonzini | while (!QTAILQ_EMPTY(&sdev->requests)) {
|
1445 | c557e889 | Paolo Bonzini | req = QTAILQ_FIRST(&sdev->requests); |
1446 | 94d3f98a | Paolo Bonzini | scsi_req_cancel(req); |
1447 | c557e889 | Paolo Bonzini | } |
1448 | c7b48872 | Paolo Bonzini | sdev->unit_attention = sense; |
1449 | c557e889 | Paolo Bonzini | } |
1450 | c557e889 | Paolo Bonzini | |
1451 | baa1bd89 | Paolo Bonzini | static char *scsibus_get_dev_path(DeviceState *dev) |
1452 | baa1bd89 | Paolo Bonzini | { |
1453 | baa1bd89 | Paolo Bonzini | SCSIDevice *d = DO_UPCAST(SCSIDevice, qdev, dev); |
1454 | baa1bd89 | Paolo Bonzini | DeviceState *hba = dev->parent_bus->parent; |
1455 | baa1bd89 | Paolo Bonzini | char *id = NULL; |
1456 | b7c8c35f | Paolo Bonzini | char *path;
|
1457 | baa1bd89 | Paolo Bonzini | |
1458 | baa1bd89 | Paolo Bonzini | if (hba && hba->parent_bus && hba->parent_bus->info->get_dev_path) {
|
1459 | baa1bd89 | Paolo Bonzini | id = hba->parent_bus->info->get_dev_path(hba); |
1460 | baa1bd89 | Paolo Bonzini | } |
1461 | baa1bd89 | Paolo Bonzini | if (id) {
|
1462 | b7c8c35f | Paolo Bonzini | path = g_strdup_printf("%s/%d:%d:%d", id, d->channel, d->id, d->lun);
|
1463 | baa1bd89 | Paolo Bonzini | } else {
|
1464 | b7c8c35f | Paolo Bonzini | path = g_strdup_printf("%d:%d:%d", d->channel, d->id, d->lun);
|
1465 | baa1bd89 | Paolo Bonzini | } |
1466 | b7c8c35f | Paolo Bonzini | g_free(id); |
1467 | b7c8c35f | Paolo Bonzini | return path;
|
1468 | baa1bd89 | Paolo Bonzini | } |
1469 | baa1bd89 | Paolo Bonzini | |
1470 | db07c0f8 | Gleb Natapov | static char *scsibus_get_fw_dev_path(DeviceState *dev) |
1471 | db07c0f8 | Gleb Natapov | { |
1472 | b9eea3e6 | Anthony Liguori | SCSIDevice *d = SCSI_DEVICE(dev); |
1473 | db07c0f8 | Gleb Natapov | char path[100]; |
1474 | db07c0f8 | Gleb Natapov | |
1475 | 795928f6 | Paolo Bonzini | snprintf(path, sizeof(path), "channel@%x/%s@%x,%x", d->channel, |
1476 | 795928f6 | Paolo Bonzini | qdev_fw_name(dev), d->id, d->lun); |
1477 | db07c0f8 | Gleb Natapov | |
1478 | f48a7a6e | Paolo Bonzini | return strdup(path);
|
1479 | f48a7a6e | Paolo Bonzini | } |
1480 | f48a7a6e | Paolo Bonzini | |
1481 | 0d3545e7 | Paolo Bonzini | SCSIDevice *scsi_device_find(SCSIBus *bus, int channel, int id, int lun) |
1482 | f48a7a6e | Paolo Bonzini | { |
1483 | f48a7a6e | Paolo Bonzini | DeviceState *qdev; |
1484 | f48a7a6e | Paolo Bonzini | SCSIDevice *target_dev = NULL;
|
1485 | db07c0f8 | Gleb Natapov | |
1486 | f48a7a6e | Paolo Bonzini | QTAILQ_FOREACH_REVERSE(qdev, &bus->qbus.children, ChildrenHead, sibling) { |
1487 | b9eea3e6 | Anthony Liguori | SCSIDevice *dev = SCSI_DEVICE(qdev); |
1488 | db07c0f8 | Gleb Natapov | |
1489 | 0d3545e7 | Paolo Bonzini | if (dev->channel == channel && dev->id == id) {
|
1490 | f48a7a6e | Paolo Bonzini | if (dev->lun == lun) {
|
1491 | f48a7a6e | Paolo Bonzini | return dev;
|
1492 | f48a7a6e | Paolo Bonzini | } |
1493 | f48a7a6e | Paolo Bonzini | target_dev = dev; |
1494 | f48a7a6e | Paolo Bonzini | } |
1495 | f48a7a6e | Paolo Bonzini | } |
1496 | f48a7a6e | Paolo Bonzini | return target_dev;
|
1497 | db07c0f8 | Gleb Natapov | } |
1498 | b9eea3e6 | Anthony Liguori | |
1499 | 63f740dd | Paolo Bonzini | /* SCSI request list. For simplicity, pv points to the whole device */
|
1500 | 63f740dd | Paolo Bonzini | |
1501 | 63f740dd | Paolo Bonzini | static void put_scsi_requests(QEMUFile *f, void *pv, size_t size) |
1502 | 63f740dd | Paolo Bonzini | { |
1503 | 63f740dd | Paolo Bonzini | SCSIDevice *s = pv; |
1504 | 63f740dd | Paolo Bonzini | SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, s->qdev.parent_bus); |
1505 | 63f740dd | Paolo Bonzini | SCSIRequest *req; |
1506 | 63f740dd | Paolo Bonzini | |
1507 | 63f740dd | Paolo Bonzini | QTAILQ_FOREACH(req, &s->requests, next) { |
1508 | 63f740dd | Paolo Bonzini | assert(!req->io_canceled); |
1509 | 63f740dd | Paolo Bonzini | assert(req->status == -1);
|
1510 | 63f740dd | Paolo Bonzini | assert(req->retry); |
1511 | 63f740dd | Paolo Bonzini | assert(req->enqueued); |
1512 | 63f740dd | Paolo Bonzini | |
1513 | 63f740dd | Paolo Bonzini | qemu_put_sbyte(f, 1);
|
1514 | 63f740dd | Paolo Bonzini | qemu_put_buffer(f, req->cmd.buf, sizeof(req->cmd.buf));
|
1515 | 63f740dd | Paolo Bonzini | qemu_put_be32s(f, &req->tag); |
1516 | 63f740dd | Paolo Bonzini | qemu_put_be32s(f, &req->lun); |
1517 | 63f740dd | Paolo Bonzini | if (bus->info->save_request) {
|
1518 | 63f740dd | Paolo Bonzini | bus->info->save_request(f, req); |
1519 | 63f740dd | Paolo Bonzini | } |
1520 | 63f740dd | Paolo Bonzini | if (req->ops->save_request) {
|
1521 | 63f740dd | Paolo Bonzini | req->ops->save_request(f, req); |
1522 | 63f740dd | Paolo Bonzini | } |
1523 | 63f740dd | Paolo Bonzini | } |
1524 | 63f740dd | Paolo Bonzini | qemu_put_sbyte(f, 0);
|
1525 | 63f740dd | Paolo Bonzini | } |
1526 | 63f740dd | Paolo Bonzini | |
1527 | 63f740dd | Paolo Bonzini | static int get_scsi_requests(QEMUFile *f, void *pv, size_t size) |
1528 | 63f740dd | Paolo Bonzini | { |
1529 | 63f740dd | Paolo Bonzini | SCSIDevice *s = pv; |
1530 | 63f740dd | Paolo Bonzini | SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, s->qdev.parent_bus); |
1531 | 63f740dd | Paolo Bonzini | |
1532 | 63f740dd | Paolo Bonzini | while (qemu_get_sbyte(f)) {
|
1533 | 63f740dd | Paolo Bonzini | uint8_t buf[SCSI_CMD_BUF_SIZE]; |
1534 | 63f740dd | Paolo Bonzini | uint32_t tag; |
1535 | 63f740dd | Paolo Bonzini | uint32_t lun; |
1536 | 63f740dd | Paolo Bonzini | SCSIRequest *req; |
1537 | 63f740dd | Paolo Bonzini | |
1538 | 63f740dd | Paolo Bonzini | qemu_get_buffer(f, buf, sizeof(buf));
|
1539 | 63f740dd | Paolo Bonzini | qemu_get_be32s(f, &tag); |
1540 | 63f740dd | Paolo Bonzini | qemu_get_be32s(f, &lun); |
1541 | 63f740dd | Paolo Bonzini | req = scsi_req_new(s, tag, lun, buf, NULL);
|
1542 | 63f740dd | Paolo Bonzini | if (bus->info->load_request) {
|
1543 | 63f740dd | Paolo Bonzini | req->hba_private = bus->info->load_request(f, req); |
1544 | 63f740dd | Paolo Bonzini | } |
1545 | 63f740dd | Paolo Bonzini | if (req->ops->load_request) {
|
1546 | 63f740dd | Paolo Bonzini | req->ops->load_request(f, req); |
1547 | 63f740dd | Paolo Bonzini | } |
1548 | 63f740dd | Paolo Bonzini | |
1549 | 63f740dd | Paolo Bonzini | /* Just restart it later. */
|
1550 | 63f740dd | Paolo Bonzini | req->retry = true;
|
1551 | 63f740dd | Paolo Bonzini | scsi_req_enqueue_internal(req); |
1552 | 63f740dd | Paolo Bonzini | |
1553 | 63f740dd | Paolo Bonzini | /* At this point, the request will be kept alive by the reference
|
1554 | 63f740dd | Paolo Bonzini | * added by scsi_req_enqueue_internal, so we can release our reference.
|
1555 | 63f740dd | Paolo Bonzini | * The HBA of course will add its own reference in the load_request
|
1556 | 63f740dd | Paolo Bonzini | * callback if it needs to hold on the SCSIRequest.
|
1557 | 63f740dd | Paolo Bonzini | */
|
1558 | 63f740dd | Paolo Bonzini | scsi_req_unref(req); |
1559 | 63f740dd | Paolo Bonzini | } |
1560 | 63f740dd | Paolo Bonzini | |
1561 | 63f740dd | Paolo Bonzini | return 0; |
1562 | 63f740dd | Paolo Bonzini | } |
1563 | 63f740dd | Paolo Bonzini | |
1564 | 12badfc2 | Jim Meyering | static const VMStateInfo vmstate_info_scsi_requests = { |
1565 | 63f740dd | Paolo Bonzini | .name = "scsi-requests",
|
1566 | 63f740dd | Paolo Bonzini | .get = get_scsi_requests, |
1567 | 63f740dd | Paolo Bonzini | .put = put_scsi_requests, |
1568 | 63f740dd | Paolo Bonzini | }; |
1569 | 63f740dd | Paolo Bonzini | |
1570 | 63f740dd | Paolo Bonzini | const VMStateDescription vmstate_scsi_device = {
|
1571 | 63f740dd | Paolo Bonzini | .name = "SCSIDevice",
|
1572 | 63f740dd | Paolo Bonzini | .version_id = 1,
|
1573 | 63f740dd | Paolo Bonzini | .minimum_version_id = 1,
|
1574 | 63f740dd | Paolo Bonzini | .minimum_version_id_old = 1,
|
1575 | 63f740dd | Paolo Bonzini | .fields = (VMStateField[]) { |
1576 | 63f740dd | Paolo Bonzini | VMSTATE_UINT8(unit_attention.key, SCSIDevice), |
1577 | 63f740dd | Paolo Bonzini | VMSTATE_UINT8(unit_attention.asc, SCSIDevice), |
1578 | 63f740dd | Paolo Bonzini | VMSTATE_UINT8(unit_attention.ascq, SCSIDevice), |
1579 | 63f740dd | Paolo Bonzini | VMSTATE_BOOL(sense_is_ua, SCSIDevice), |
1580 | 63f740dd | Paolo Bonzini | VMSTATE_UINT8_ARRAY(sense, SCSIDevice, SCSI_SENSE_BUF_SIZE), |
1581 | 63f740dd | Paolo Bonzini | VMSTATE_UINT32(sense_len, SCSIDevice), |
1582 | 63f740dd | Paolo Bonzini | { |
1583 | 63f740dd | Paolo Bonzini | .name = "requests",
|
1584 | 63f740dd | Paolo Bonzini | .version_id = 0,
|
1585 | 63f740dd | Paolo Bonzini | .field_exists = NULL,
|
1586 | 63f740dd | Paolo Bonzini | .size = 0, /* ouch */ |
1587 | 63f740dd | Paolo Bonzini | .info = &vmstate_info_scsi_requests, |
1588 | 63f740dd | Paolo Bonzini | .flags = VMS_SINGLE, |
1589 | 63f740dd | Paolo Bonzini | .offset = 0,
|
1590 | 63f740dd | Paolo Bonzini | }, |
1591 | 63f740dd | Paolo Bonzini | VMSTATE_END_OF_LIST() |
1592 | 63f740dd | Paolo Bonzini | } |
1593 | 63f740dd | Paolo Bonzini | }; |
1594 | 63f740dd | Paolo Bonzini | |
1595 | 39bffca2 | Anthony Liguori | static void scsi_device_class_init(ObjectClass *klass, void *data) |
1596 | 39bffca2 | Anthony Liguori | { |
1597 | 39bffca2 | Anthony Liguori | DeviceClass *k = DEVICE_CLASS(klass); |
1598 | 39bffca2 | Anthony Liguori | k->bus_info = &scsi_bus_info; |
1599 | 39bffca2 | Anthony Liguori | k->init = scsi_qdev_init; |
1600 | 39bffca2 | Anthony Liguori | k->unplug = qdev_simple_unplug_cb; |
1601 | 39bffca2 | Anthony Liguori | k->exit = scsi_qdev_exit; |
1602 | 39bffca2 | Anthony Liguori | } |
1603 | 39bffca2 | Anthony Liguori | |
1604 | b9eea3e6 | Anthony Liguori | static TypeInfo scsi_device_type_info = {
|
1605 | b9eea3e6 | Anthony Liguori | .name = TYPE_SCSI_DEVICE, |
1606 | b9eea3e6 | Anthony Liguori | .parent = TYPE_DEVICE, |
1607 | b9eea3e6 | Anthony Liguori | .instance_size = sizeof(SCSIDevice),
|
1608 | b9eea3e6 | Anthony Liguori | .abstract = true,
|
1609 | b9eea3e6 | Anthony Liguori | .class_size = sizeof(SCSIDeviceClass),
|
1610 | 39bffca2 | Anthony Liguori | .class_init = scsi_device_class_init, |
1611 | b9eea3e6 | Anthony Liguori | }; |
1612 | b9eea3e6 | Anthony Liguori | |
1613 | 83f7d43a | Andreas Färber | static void scsi_register_types(void) |
1614 | b9eea3e6 | Anthony Liguori | { |
1615 | b9eea3e6 | Anthony Liguori | type_register_static(&scsi_device_type_info); |
1616 | b9eea3e6 | Anthony Liguori | } |
1617 | b9eea3e6 | Anthony Liguori | |
1618 | 83f7d43a | Andreas Färber | type_init(scsi_register_types) |