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