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