root / hw / scsi-bus.c @ af93485c
History | View | Annotate | Download (15 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 | d52affa7 | Gerd Hoffmann | |
8 | d52affa7 | Gerd Hoffmann | static struct BusInfo scsi_bus_info = { |
9 | d52affa7 | Gerd Hoffmann | .name = "SCSI",
|
10 | d52affa7 | Gerd Hoffmann | .size = sizeof(SCSIBus),
|
11 | d52affa7 | Gerd Hoffmann | .props = (Property[]) { |
12 | d52affa7 | Gerd Hoffmann | DEFINE_PROP_UINT32("scsi-id", SCSIDevice, id, -1), |
13 | d52affa7 | Gerd Hoffmann | DEFINE_PROP_END_OF_LIST(), |
14 | d52affa7 | Gerd Hoffmann | }, |
15 | d52affa7 | Gerd Hoffmann | }; |
16 | d52affa7 | Gerd Hoffmann | static int next_scsi_bus; |
17 | d52affa7 | Gerd Hoffmann | |
18 | d52affa7 | Gerd Hoffmann | /* Create a scsi bus, and attach devices to it. */
|
19 | ca9c39fa | Gerd Hoffmann | void scsi_bus_new(SCSIBus *bus, DeviceState *host, int tcq, int ndev, |
20 | ca9c39fa | Gerd Hoffmann | scsi_completionfn complete) |
21 | d52affa7 | Gerd Hoffmann | { |
22 | ca9c39fa | Gerd Hoffmann | qbus_create_inplace(&bus->qbus, &scsi_bus_info, host, NULL);
|
23 | d52affa7 | Gerd Hoffmann | bus->busnr = next_scsi_bus++; |
24 | d52affa7 | Gerd Hoffmann | bus->tcq = tcq; |
25 | d52affa7 | Gerd Hoffmann | bus->ndev = ndev; |
26 | d52affa7 | Gerd Hoffmann | bus->complete = complete; |
27 | cb23117b | Gerd Hoffmann | bus->qbus.allow_hotplug = 1;
|
28 | d52affa7 | Gerd Hoffmann | } |
29 | d52affa7 | Gerd Hoffmann | |
30 | d52affa7 | Gerd Hoffmann | static int scsi_qdev_init(DeviceState *qdev, DeviceInfo *base) |
31 | d52affa7 | Gerd Hoffmann | { |
32 | d52affa7 | Gerd Hoffmann | SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev); |
33 | d52affa7 | Gerd Hoffmann | SCSIDeviceInfo *info = DO_UPCAST(SCSIDeviceInfo, qdev, base); |
34 | d52affa7 | Gerd Hoffmann | SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus); |
35 | 01985dcf | Gerd Hoffmann | int rc = -1; |
36 | d52affa7 | Gerd Hoffmann | |
37 | d52affa7 | Gerd Hoffmann | if (dev->id == -1) { |
38 | d52affa7 | Gerd Hoffmann | for (dev->id = 0; dev->id < bus->ndev; dev->id++) { |
39 | d52affa7 | Gerd Hoffmann | if (bus->devs[dev->id] == NULL) |
40 | d52affa7 | Gerd Hoffmann | break;
|
41 | d52affa7 | Gerd Hoffmann | } |
42 | d52affa7 | Gerd Hoffmann | } |
43 | d52affa7 | Gerd Hoffmann | if (dev->id >= bus->ndev) {
|
44 | 1ecda02b | Markus Armbruster | error_report("bad scsi device id: %d", dev->id);
|
45 | d52affa7 | Gerd Hoffmann | goto err;
|
46 | d52affa7 | Gerd Hoffmann | } |
47 | d52affa7 | Gerd Hoffmann | |
48 | d52affa7 | Gerd Hoffmann | if (bus->devs[dev->id]) {
|
49 | 01985dcf | Gerd Hoffmann | qdev_free(&bus->devs[dev->id]->qdev); |
50 | d52affa7 | Gerd Hoffmann | } |
51 | d52affa7 | Gerd Hoffmann | bus->devs[dev->id] = dev; |
52 | d52affa7 | Gerd Hoffmann | |
53 | d52affa7 | Gerd Hoffmann | dev->info = info; |
54 | 9af99d98 | Gerd Hoffmann | QTAILQ_INIT(&dev->requests); |
55 | 01985dcf | Gerd Hoffmann | rc = dev->info->init(dev); |
56 | 01985dcf | Gerd Hoffmann | if (rc != 0) { |
57 | 01985dcf | Gerd Hoffmann | bus->devs[dev->id] = NULL;
|
58 | 01985dcf | Gerd Hoffmann | } |
59 | d52affa7 | Gerd Hoffmann | |
60 | d52affa7 | Gerd Hoffmann | err:
|
61 | 01985dcf | Gerd Hoffmann | return rc;
|
62 | 01985dcf | Gerd Hoffmann | } |
63 | 01985dcf | Gerd Hoffmann | |
64 | 01985dcf | Gerd Hoffmann | static int scsi_qdev_exit(DeviceState *qdev) |
65 | 01985dcf | Gerd Hoffmann | { |
66 | 01985dcf | Gerd Hoffmann | SCSIDevice *dev = DO_UPCAST(SCSIDevice, qdev, qdev); |
67 | 01985dcf | Gerd Hoffmann | SCSIBus *bus = DO_UPCAST(SCSIBus, qbus, dev->qdev.parent_bus); |
68 | 01985dcf | Gerd Hoffmann | |
69 | 01985dcf | Gerd Hoffmann | assert(bus->devs[dev->id] != NULL);
|
70 | 01985dcf | Gerd Hoffmann | if (bus->devs[dev->id]->info->destroy) {
|
71 | 01985dcf | Gerd Hoffmann | bus->devs[dev->id]->info->destroy(bus->devs[dev->id]); |
72 | 01985dcf | Gerd Hoffmann | } |
73 | 01985dcf | Gerd Hoffmann | bus->devs[dev->id] = NULL;
|
74 | 01985dcf | Gerd Hoffmann | return 0; |
75 | d52affa7 | Gerd Hoffmann | } |
76 | d52affa7 | Gerd Hoffmann | |
77 | d52affa7 | Gerd Hoffmann | void scsi_qdev_register(SCSIDeviceInfo *info)
|
78 | d52affa7 | Gerd Hoffmann | { |
79 | d52affa7 | Gerd Hoffmann | info->qdev.bus_info = &scsi_bus_info; |
80 | d52affa7 | Gerd Hoffmann | info->qdev.init = scsi_qdev_init; |
81 | cb23117b | Gerd Hoffmann | info->qdev.unplug = qdev_simple_unplug_cb; |
82 | 01985dcf | Gerd Hoffmann | info->qdev.exit = scsi_qdev_exit; |
83 | d52affa7 | Gerd Hoffmann | qdev_register(&info->qdev); |
84 | d52affa7 | Gerd Hoffmann | } |
85 | d52affa7 | Gerd Hoffmann | |
86 | d52affa7 | Gerd Hoffmann | /* handle legacy '-drive if=scsi,...' cmd line args */
|
87 | f8b6cc00 | Markus Armbruster | SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, BlockDriverState *bdrv, int unit)
|
88 | d52affa7 | Gerd Hoffmann | { |
89 | d52affa7 | Gerd Hoffmann | const char *driver; |
90 | d52affa7 | Gerd Hoffmann | DeviceState *dev; |
91 | d52affa7 | Gerd Hoffmann | |
92 | f8b6cc00 | Markus Armbruster | driver = bdrv_is_sg(bdrv) ? "scsi-generic" : "scsi-disk"; |
93 | d52affa7 | Gerd Hoffmann | dev = qdev_create(&bus->qbus, driver); |
94 | d52affa7 | Gerd Hoffmann | qdev_prop_set_uint32(dev, "scsi-id", unit);
|
95 | 18846dee | Markus Armbruster | if (qdev_prop_set_drive(dev, "drive", bdrv) < 0) { |
96 | 18846dee | Markus Armbruster | qdev_free(dev); |
97 | 18846dee | Markus Armbruster | return NULL; |
98 | 18846dee | Markus Armbruster | } |
99 | 33e66b86 | Markus Armbruster | if (qdev_init(dev) < 0) |
100 | 33e66b86 | Markus Armbruster | return NULL; |
101 | d52affa7 | Gerd Hoffmann | return DO_UPCAST(SCSIDevice, qdev, dev);
|
102 | d52affa7 | Gerd Hoffmann | } |
103 | d52affa7 | Gerd Hoffmann | |
104 | fa66b909 | Markus Armbruster | int scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
|
105 | d52affa7 | Gerd Hoffmann | { |
106 | 42e766a2 | Markus Armbruster | Location loc; |
107 | d52affa7 | Gerd Hoffmann | DriveInfo *dinfo; |
108 | fa66b909 | Markus Armbruster | int res = 0, unit; |
109 | d52affa7 | Gerd Hoffmann | |
110 | 42e766a2 | Markus Armbruster | loc_push_none(&loc); |
111 | d52affa7 | Gerd Hoffmann | for (unit = 0; unit < MAX_SCSI_DEVS; unit++) { |
112 | d52affa7 | Gerd Hoffmann | dinfo = drive_get(IF_SCSI, bus->busnr, unit); |
113 | d52affa7 | Gerd Hoffmann | if (dinfo == NULL) { |
114 | d52affa7 | Gerd Hoffmann | continue;
|
115 | d52affa7 | Gerd Hoffmann | } |
116 | 42e766a2 | Markus Armbruster | qemu_opts_loc_restore(dinfo->opts); |
117 | f8b6cc00 | Markus Armbruster | if (!scsi_bus_legacy_add_drive(bus, dinfo->bdrv, unit)) {
|
118 | fa66b909 | Markus Armbruster | res = -1;
|
119 | fa66b909 | Markus Armbruster | break;
|
120 | fa66b909 | Markus Armbruster | } |
121 | d52affa7 | Gerd Hoffmann | } |
122 | 42e766a2 | Markus Armbruster | loc_pop(&loc); |
123 | fa66b909 | Markus Armbruster | return res;
|
124 | d52affa7 | Gerd Hoffmann | } |
125 | 89b08ae1 | Gerd Hoffmann | |
126 | 37659e51 | Gerd Hoffmann | void scsi_dev_clear_sense(SCSIDevice *dev)
|
127 | 37659e51 | Gerd Hoffmann | { |
128 | 37659e51 | Gerd Hoffmann | memset(&dev->sense, 0, sizeof(dev->sense)); |
129 | 37659e51 | Gerd Hoffmann | } |
130 | 37659e51 | Gerd Hoffmann | |
131 | 37659e51 | Gerd Hoffmann | void scsi_dev_set_sense(SCSIDevice *dev, uint8_t key)
|
132 | 37659e51 | Gerd Hoffmann | { |
133 | 37659e51 | Gerd Hoffmann | dev->sense.key = key; |
134 | 37659e51 | Gerd Hoffmann | } |
135 | 37659e51 | Gerd Hoffmann | |
136 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *scsi_req_alloc(size_t size, SCSIDevice *d, uint32_t tag, uint32_t lun) |
137 | 89b08ae1 | Gerd Hoffmann | { |
138 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *req; |
139 | 89b08ae1 | Gerd Hoffmann | |
140 | 89b08ae1 | Gerd Hoffmann | req = qemu_mallocz(size); |
141 | 89b08ae1 | Gerd Hoffmann | req->bus = scsi_bus_from_device(d); |
142 | 89b08ae1 | Gerd Hoffmann | req->dev = d; |
143 | 89b08ae1 | Gerd Hoffmann | req->tag = tag; |
144 | 89b08ae1 | Gerd Hoffmann | req->lun = lun; |
145 | ed3a34a3 | Gerd Hoffmann | req->status = -1;
|
146 | e8637c90 | Jan Kiszka | req->enqueued = true;
|
147 | 89b08ae1 | Gerd Hoffmann | QTAILQ_INSERT_TAIL(&d->requests, req, next); |
148 | 89b08ae1 | Gerd Hoffmann | return req;
|
149 | 89b08ae1 | Gerd Hoffmann | } |
150 | 89b08ae1 | Gerd Hoffmann | |
151 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *scsi_req_find(SCSIDevice *d, uint32_t tag) |
152 | 89b08ae1 | Gerd Hoffmann | { |
153 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *req; |
154 | 89b08ae1 | Gerd Hoffmann | |
155 | 89b08ae1 | Gerd Hoffmann | QTAILQ_FOREACH(req, &d->requests, next) { |
156 | 89b08ae1 | Gerd Hoffmann | if (req->tag == tag) {
|
157 | 89b08ae1 | Gerd Hoffmann | return req;
|
158 | 89b08ae1 | Gerd Hoffmann | } |
159 | 89b08ae1 | Gerd Hoffmann | } |
160 | 89b08ae1 | Gerd Hoffmann | return NULL; |
161 | 89b08ae1 | Gerd Hoffmann | } |
162 | 89b08ae1 | Gerd Hoffmann | |
163 | e8637c90 | Jan Kiszka | static void scsi_req_dequeue(SCSIRequest *req) |
164 | e8637c90 | Jan Kiszka | { |
165 | e8637c90 | Jan Kiszka | if (req->enqueued) {
|
166 | e8637c90 | Jan Kiszka | QTAILQ_REMOVE(&req->dev->requests, req, next); |
167 | e8637c90 | Jan Kiszka | req->enqueued = false;
|
168 | e8637c90 | Jan Kiszka | } |
169 | e8637c90 | Jan Kiszka | } |
170 | e8637c90 | Jan Kiszka | |
171 | 89b08ae1 | Gerd Hoffmann | void scsi_req_free(SCSIRequest *req)
|
172 | 89b08ae1 | Gerd Hoffmann | { |
173 | e8637c90 | Jan Kiszka | scsi_req_dequeue(req); |
174 | 89b08ae1 | Gerd Hoffmann | qemu_free(req); |
175 | 89b08ae1 | Gerd Hoffmann | } |
176 | 2ec749cb | Gerd Hoffmann | |
177 | 2ec749cb | Gerd Hoffmann | static int scsi_req_length(SCSIRequest *req, uint8_t *cmd) |
178 | 2ec749cb | Gerd Hoffmann | { |
179 | 2ec749cb | Gerd Hoffmann | switch (cmd[0] >> 5) { |
180 | 2ec749cb | Gerd Hoffmann | case 0: |
181 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[4];
|
182 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 6;
|
183 | 2ec749cb | Gerd Hoffmann | /* length 0 means 256 blocks */
|
184 | 2ec749cb | Gerd Hoffmann | if (req->cmd.xfer == 0) |
185 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 256;
|
186 | 2ec749cb | Gerd Hoffmann | break;
|
187 | 2ec749cb | Gerd Hoffmann | case 1: |
188 | 2ec749cb | Gerd Hoffmann | case 2: |
189 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[8] | (cmd[7] << 8); |
190 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 10;
|
191 | 2ec749cb | Gerd Hoffmann | break;
|
192 | 2ec749cb | Gerd Hoffmann | case 4: |
193 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[13] | (cmd[12] << 8) | (cmd[11] << 16) | (cmd[10] << 24); |
194 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 16;
|
195 | 2ec749cb | Gerd Hoffmann | break;
|
196 | 2ec749cb | Gerd Hoffmann | case 5: |
197 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[9] | (cmd[8] << 8) | (cmd[7] << 16) | (cmd[6] << 24); |
198 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 12;
|
199 | 2ec749cb | Gerd Hoffmann | break;
|
200 | 2ec749cb | Gerd Hoffmann | default:
|
201 | 2ec749cb | Gerd Hoffmann | return -1; |
202 | 2ec749cb | Gerd Hoffmann | } |
203 | 2ec749cb | Gerd Hoffmann | |
204 | 2ec749cb | Gerd Hoffmann | switch(cmd[0]) { |
205 | 2ec749cb | Gerd Hoffmann | case TEST_UNIT_READY:
|
206 | 2ec749cb | Gerd Hoffmann | case REZERO_UNIT:
|
207 | 2ec749cb | Gerd Hoffmann | case START_STOP:
|
208 | 2ec749cb | Gerd Hoffmann | case SEEK_6:
|
209 | 2ec749cb | Gerd Hoffmann | case WRITE_FILEMARKS:
|
210 | 2ec749cb | Gerd Hoffmann | case SPACE:
|
211 | a5e3d9ef | Bernhard Kohl | case RESERVE:
|
212 | a5e3d9ef | Bernhard Kohl | case RELEASE:
|
213 | 2ec749cb | Gerd Hoffmann | case ERASE:
|
214 | 2ec749cb | Gerd Hoffmann | case ALLOW_MEDIUM_REMOVAL:
|
215 | 2ec749cb | Gerd Hoffmann | case VERIFY:
|
216 | 2ec749cb | Gerd Hoffmann | case SEEK_10:
|
217 | 2ec749cb | Gerd Hoffmann | case SYNCHRONIZE_CACHE:
|
218 | 2ec749cb | Gerd Hoffmann | case LOCK_UNLOCK_CACHE:
|
219 | 2ec749cb | Gerd Hoffmann | case LOAD_UNLOAD:
|
220 | 2ec749cb | Gerd Hoffmann | case SET_CD_SPEED:
|
221 | 2ec749cb | Gerd Hoffmann | case SET_LIMITS:
|
222 | 2ec749cb | Gerd Hoffmann | case WRITE_LONG:
|
223 | 2ec749cb | Gerd Hoffmann | case MOVE_MEDIUM:
|
224 | 2ec749cb | Gerd Hoffmann | case UPDATE_BLOCK:
|
225 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 0;
|
226 | 2ec749cb | Gerd Hoffmann | break;
|
227 | 2ec749cb | Gerd Hoffmann | case MODE_SENSE:
|
228 | 2ec749cb | Gerd Hoffmann | break;
|
229 | 2ec749cb | Gerd Hoffmann | case WRITE_SAME:
|
230 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 1;
|
231 | 2ec749cb | Gerd Hoffmann | break;
|
232 | 2ec749cb | Gerd Hoffmann | case READ_CAPACITY:
|
233 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 8;
|
234 | 2ec749cb | Gerd Hoffmann | break;
|
235 | 2ec749cb | Gerd Hoffmann | case READ_BLOCK_LIMITS:
|
236 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 6;
|
237 | 2ec749cb | Gerd Hoffmann | break;
|
238 | 2ec749cb | Gerd Hoffmann | case READ_POSITION:
|
239 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 20;
|
240 | 2ec749cb | Gerd Hoffmann | break;
|
241 | 2ec749cb | Gerd Hoffmann | case SEND_VOLUME_TAG:
|
242 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= 40;
|
243 | 2ec749cb | Gerd Hoffmann | break;
|
244 | 2ec749cb | Gerd Hoffmann | case MEDIUM_SCAN:
|
245 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= 8;
|
246 | 2ec749cb | Gerd Hoffmann | break;
|
247 | 2ec749cb | Gerd Hoffmann | case WRITE_10:
|
248 | 2ec749cb | Gerd Hoffmann | case WRITE_VERIFY:
|
249 | 2ec749cb | Gerd Hoffmann | case WRITE_6:
|
250 | 2ec749cb | Gerd Hoffmann | case WRITE_12:
|
251 | 2ec749cb | Gerd Hoffmann | case WRITE_VERIFY_12:
|
252 | bd536cf3 | Gerd Hoffmann | case WRITE_16:
|
253 | bd536cf3 | Gerd Hoffmann | case WRITE_VERIFY_16:
|
254 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= req->dev->blocksize; |
255 | 2ec749cb | Gerd Hoffmann | break;
|
256 | 2ec749cb | Gerd Hoffmann | case READ_10:
|
257 | 2ec749cb | Gerd Hoffmann | case READ_6:
|
258 | 2ec749cb | Gerd Hoffmann | case READ_REVERSE:
|
259 | 2ec749cb | Gerd Hoffmann | case RECOVER_BUFFERED_DATA:
|
260 | 2ec749cb | Gerd Hoffmann | case READ_12:
|
261 | bd536cf3 | Gerd Hoffmann | case READ_16:
|
262 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= req->dev->blocksize; |
263 | 2ec749cb | Gerd Hoffmann | break;
|
264 | 2ec749cb | Gerd Hoffmann | case INQUIRY:
|
265 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[4] | (cmd[3] << 8); |
266 | 2ec749cb | Gerd Hoffmann | break;
|
267 | c7126d5b | Nicholas Bellinger | case MAINTENANCE_OUT:
|
268 | c7126d5b | Nicholas Bellinger | case MAINTENANCE_IN:
|
269 | c7126d5b | Nicholas Bellinger | if (req->dev->type == TYPE_ROM) {
|
270 | c7126d5b | Nicholas Bellinger | /* GPCMD_REPORT_KEY and GPCMD_SEND_KEY from multi media commands */
|
271 | c7126d5b | Nicholas Bellinger | req->cmd.xfer = cmd[9] | (cmd[8] << 8); |
272 | c7126d5b | Nicholas Bellinger | } |
273 | c7126d5b | Nicholas Bellinger | break;
|
274 | 2ec749cb | Gerd Hoffmann | } |
275 | 2ec749cb | Gerd Hoffmann | return 0; |
276 | 2ec749cb | Gerd Hoffmann | } |
277 | 2ec749cb | Gerd Hoffmann | |
278 | 2ec749cb | Gerd Hoffmann | static int scsi_req_stream_length(SCSIRequest *req, uint8_t *cmd) |
279 | 2ec749cb | Gerd Hoffmann | { |
280 | 2ec749cb | Gerd Hoffmann | switch(cmd[0]) { |
281 | 2ec749cb | Gerd Hoffmann | /* stream commands */
|
282 | 2ec749cb | Gerd Hoffmann | case READ_6:
|
283 | 2ec749cb | Gerd Hoffmann | case READ_REVERSE:
|
284 | 2ec749cb | Gerd Hoffmann | case RECOVER_BUFFERED_DATA:
|
285 | 2ec749cb | Gerd Hoffmann | case WRITE_6:
|
286 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 6;
|
287 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[4] | (cmd[3] << 8) | (cmd[2] << 16); |
288 | 2ec749cb | Gerd Hoffmann | if (cmd[1] & 0x01) /* fixed */ |
289 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= req->dev->blocksize; |
290 | 2ec749cb | Gerd Hoffmann | break;
|
291 | 2ec749cb | Gerd Hoffmann | case REWIND:
|
292 | 2ec749cb | Gerd Hoffmann | case START_STOP:
|
293 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 6;
|
294 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 0;
|
295 | 2ec749cb | Gerd Hoffmann | break;
|
296 | 2ec749cb | Gerd Hoffmann | /* generic commands */
|
297 | 2ec749cb | Gerd Hoffmann | default:
|
298 | 2ec749cb | Gerd Hoffmann | return scsi_req_length(req, cmd);
|
299 | 2ec749cb | Gerd Hoffmann | } |
300 | 2ec749cb | Gerd Hoffmann | return 0; |
301 | 2ec749cb | Gerd Hoffmann | } |
302 | 2ec749cb | Gerd Hoffmann | |
303 | 97a06435 | Gerd Hoffmann | static void scsi_req_xfer_mode(SCSIRequest *req) |
304 | 97a06435 | Gerd Hoffmann | { |
305 | 97a06435 | Gerd Hoffmann | switch (req->cmd.buf[0]) { |
306 | 97a06435 | Gerd Hoffmann | case WRITE_6:
|
307 | 97a06435 | Gerd Hoffmann | case WRITE_10:
|
308 | 97a06435 | Gerd Hoffmann | case WRITE_VERIFY:
|
309 | 97a06435 | Gerd Hoffmann | case WRITE_12:
|
310 | 97a06435 | Gerd Hoffmann | case WRITE_VERIFY_12:
|
311 | bd536cf3 | Gerd Hoffmann | case WRITE_16:
|
312 | bd536cf3 | Gerd Hoffmann | case WRITE_VERIFY_16:
|
313 | 97a06435 | Gerd Hoffmann | case COPY:
|
314 | 97a06435 | Gerd Hoffmann | case COPY_VERIFY:
|
315 | 97a06435 | Gerd Hoffmann | case COMPARE:
|
316 | 97a06435 | Gerd Hoffmann | case CHANGE_DEFINITION:
|
317 | 97a06435 | Gerd Hoffmann | case LOG_SELECT:
|
318 | 97a06435 | Gerd Hoffmann | case MODE_SELECT:
|
319 | 97a06435 | Gerd Hoffmann | case MODE_SELECT_10:
|
320 | 97a06435 | Gerd Hoffmann | case SEND_DIAGNOSTIC:
|
321 | 97a06435 | Gerd Hoffmann | case WRITE_BUFFER:
|
322 | 97a06435 | Gerd Hoffmann | case FORMAT_UNIT:
|
323 | 97a06435 | Gerd Hoffmann | case REASSIGN_BLOCKS:
|
324 | 97a06435 | Gerd Hoffmann | case SEARCH_EQUAL:
|
325 | 97a06435 | Gerd Hoffmann | case SEARCH_HIGH:
|
326 | 97a06435 | Gerd Hoffmann | case SEARCH_LOW:
|
327 | 97a06435 | Gerd Hoffmann | case UPDATE_BLOCK:
|
328 | 97a06435 | Gerd Hoffmann | case WRITE_LONG:
|
329 | 97a06435 | Gerd Hoffmann | case WRITE_SAME:
|
330 | 97a06435 | Gerd Hoffmann | case SEARCH_HIGH_12:
|
331 | 97a06435 | Gerd Hoffmann | case SEARCH_EQUAL_12:
|
332 | 97a06435 | Gerd Hoffmann | case SEARCH_LOW_12:
|
333 | 97a06435 | Gerd Hoffmann | case SET_WINDOW:
|
334 | 97a06435 | Gerd Hoffmann | case MEDIUM_SCAN:
|
335 | 97a06435 | Gerd Hoffmann | case SEND_VOLUME_TAG:
|
336 | 97a06435 | Gerd Hoffmann | case WRITE_LONG_2:
|
337 | 01bedeba | Nicholas Bellinger | case PERSISTENT_RESERVE_OUT:
|
338 | c7126d5b | Nicholas Bellinger | case MAINTENANCE_OUT:
|
339 | 97a06435 | Gerd Hoffmann | req->cmd.mode = SCSI_XFER_TO_DEV; |
340 | 97a06435 | Gerd Hoffmann | break;
|
341 | 97a06435 | Gerd Hoffmann | default:
|
342 | 97a06435 | Gerd Hoffmann | if (req->cmd.xfer)
|
343 | 97a06435 | Gerd Hoffmann | req->cmd.mode = SCSI_XFER_FROM_DEV; |
344 | 97a06435 | Gerd Hoffmann | else {
|
345 | 97a06435 | Gerd Hoffmann | req->cmd.mode = SCSI_XFER_NONE; |
346 | 97a06435 | Gerd Hoffmann | } |
347 | 97a06435 | Gerd Hoffmann | break;
|
348 | 97a06435 | Gerd Hoffmann | } |
349 | 97a06435 | Gerd Hoffmann | } |
350 | 97a06435 | Gerd Hoffmann | |
351 | 2ec749cb | Gerd Hoffmann | static uint64_t scsi_req_lba(SCSIRequest *req)
|
352 | 2ec749cb | Gerd Hoffmann | { |
353 | 2ec749cb | Gerd Hoffmann | uint8_t *buf = req->cmd.buf; |
354 | 2ec749cb | Gerd Hoffmann | uint64_t lba; |
355 | 2ec749cb | Gerd Hoffmann | |
356 | 2ec749cb | Gerd Hoffmann | switch (buf[0] >> 5) { |
357 | 2ec749cb | Gerd Hoffmann | case 0: |
358 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[3] | ((uint64_t) buf[2] << 8) | |
359 | 2ec749cb | Gerd Hoffmann | (((uint64_t) buf[1] & 0x1f) << 16); |
360 | 2ec749cb | Gerd Hoffmann | break;
|
361 | 2ec749cb | Gerd Hoffmann | case 1: |
362 | 2ec749cb | Gerd Hoffmann | case 2: |
363 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) | |
364 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24); |
365 | 2ec749cb | Gerd Hoffmann | break;
|
366 | 2ec749cb | Gerd Hoffmann | case 4: |
367 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[9] | ((uint64_t) buf[8] << 8) | |
368 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[7] << 16) | ((uint64_t) buf[6] << 24) | |
369 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[5] << 32) | ((uint64_t) buf[4] << 40) | |
370 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[3] << 48) | ((uint64_t) buf[2] << 56); |
371 | 2ec749cb | Gerd Hoffmann | break;
|
372 | 2ec749cb | Gerd Hoffmann | case 5: |
373 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) | |
374 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24); |
375 | 2ec749cb | Gerd Hoffmann | break;
|
376 | 2ec749cb | Gerd Hoffmann | default:
|
377 | 2ec749cb | Gerd Hoffmann | lba = -1;
|
378 | 2ec749cb | Gerd Hoffmann | |
379 | 2ec749cb | Gerd Hoffmann | } |
380 | 2ec749cb | Gerd Hoffmann | return lba;
|
381 | 2ec749cb | Gerd Hoffmann | } |
382 | 2ec749cb | Gerd Hoffmann | |
383 | 2ec749cb | Gerd Hoffmann | int scsi_req_parse(SCSIRequest *req, uint8_t *buf)
|
384 | 2ec749cb | Gerd Hoffmann | { |
385 | 2ec749cb | Gerd Hoffmann | int rc;
|
386 | 2ec749cb | Gerd Hoffmann | |
387 | 2ec749cb | Gerd Hoffmann | if (req->dev->type == TYPE_TAPE) {
|
388 | 2ec749cb | Gerd Hoffmann | rc = scsi_req_stream_length(req, buf); |
389 | 2ec749cb | Gerd Hoffmann | } else {
|
390 | 2ec749cb | Gerd Hoffmann | rc = scsi_req_length(req, buf); |
391 | 2ec749cb | Gerd Hoffmann | } |
392 | 2ec749cb | Gerd Hoffmann | if (rc != 0) |
393 | 2ec749cb | Gerd Hoffmann | return rc;
|
394 | 2ec749cb | Gerd Hoffmann | |
395 | 2ec749cb | Gerd Hoffmann | memcpy(req->cmd.buf, buf, req->cmd.len); |
396 | 97a06435 | Gerd Hoffmann | scsi_req_xfer_mode(req); |
397 | 2ec749cb | Gerd Hoffmann | req->cmd.lba = scsi_req_lba(req); |
398 | 2ec749cb | Gerd Hoffmann | return 0; |
399 | 2ec749cb | Gerd Hoffmann | } |
400 | ed3a34a3 | Gerd Hoffmann | |
401 | ec766865 | Gerd Hoffmann | static const char *scsi_command_name(uint8_t cmd) |
402 | ec766865 | Gerd Hoffmann | { |
403 | ec766865 | Gerd Hoffmann | static const char *names[] = { |
404 | ec766865 | Gerd Hoffmann | [ TEST_UNIT_READY ] = "TEST_UNIT_READY",
|
405 | ec766865 | Gerd Hoffmann | [ REZERO_UNIT ] = "REZERO_UNIT",
|
406 | 545557d4 | Blue Swirl | /* REWIND and REZERO_UNIT use the same operation code */
|
407 | ec766865 | Gerd Hoffmann | [ REQUEST_SENSE ] = "REQUEST_SENSE",
|
408 | ec766865 | Gerd Hoffmann | [ FORMAT_UNIT ] = "FORMAT_UNIT",
|
409 | ec766865 | Gerd Hoffmann | [ READ_BLOCK_LIMITS ] = "READ_BLOCK_LIMITS",
|
410 | ec766865 | Gerd Hoffmann | [ REASSIGN_BLOCKS ] = "REASSIGN_BLOCKS",
|
411 | ec766865 | Gerd Hoffmann | [ READ_6 ] = "READ_6",
|
412 | ec766865 | Gerd Hoffmann | [ WRITE_6 ] = "WRITE_6",
|
413 | ec766865 | Gerd Hoffmann | [ SEEK_6 ] = "SEEK_6",
|
414 | ec766865 | Gerd Hoffmann | [ READ_REVERSE ] = "READ_REVERSE",
|
415 | ec766865 | Gerd Hoffmann | [ WRITE_FILEMARKS ] = "WRITE_FILEMARKS",
|
416 | ec766865 | Gerd Hoffmann | [ SPACE ] = "SPACE",
|
417 | ec766865 | Gerd Hoffmann | [ INQUIRY ] = "INQUIRY",
|
418 | ec766865 | Gerd Hoffmann | [ RECOVER_BUFFERED_DATA ] = "RECOVER_BUFFERED_DATA",
|
419 | c7126d5b | Nicholas Bellinger | [ MAINTENANCE_IN ] = "MAINTENANCE_IN",
|
420 | c7126d5b | Nicholas Bellinger | [ MAINTENANCE_OUT ] = "MAINTENANCE_OUT",
|
421 | ec766865 | Gerd Hoffmann | [ MODE_SELECT ] = "MODE_SELECT",
|
422 | ec766865 | Gerd Hoffmann | [ RESERVE ] = "RESERVE",
|
423 | ec766865 | Gerd Hoffmann | [ RELEASE ] = "RELEASE",
|
424 | ec766865 | Gerd Hoffmann | [ COPY ] = "COPY",
|
425 | ec766865 | Gerd Hoffmann | [ ERASE ] = "ERASE",
|
426 | ec766865 | Gerd Hoffmann | [ MODE_SENSE ] = "MODE_SENSE",
|
427 | ec766865 | Gerd Hoffmann | [ START_STOP ] = "START_STOP",
|
428 | ec766865 | Gerd Hoffmann | [ RECEIVE_DIAGNOSTIC ] = "RECEIVE_DIAGNOSTIC",
|
429 | ec766865 | Gerd Hoffmann | [ SEND_DIAGNOSTIC ] = "SEND_DIAGNOSTIC",
|
430 | ec766865 | Gerd Hoffmann | [ ALLOW_MEDIUM_REMOVAL ] = "ALLOW_MEDIUM_REMOVAL",
|
431 | ec766865 | Gerd Hoffmann | |
432 | ec766865 | Gerd Hoffmann | [ SET_WINDOW ] = "SET_WINDOW",
|
433 | ec766865 | Gerd Hoffmann | [ READ_CAPACITY ] = "READ_CAPACITY",
|
434 | ec766865 | Gerd Hoffmann | [ READ_10 ] = "READ_10",
|
435 | ec766865 | Gerd Hoffmann | [ WRITE_10 ] = "WRITE_10",
|
436 | ec766865 | Gerd Hoffmann | [ SEEK_10 ] = "SEEK_10",
|
437 | ec766865 | Gerd Hoffmann | [ WRITE_VERIFY ] = "WRITE_VERIFY",
|
438 | ec766865 | Gerd Hoffmann | [ VERIFY ] = "VERIFY",
|
439 | ec766865 | Gerd Hoffmann | [ SEARCH_HIGH ] = "SEARCH_HIGH",
|
440 | ec766865 | Gerd Hoffmann | [ SEARCH_EQUAL ] = "SEARCH_EQUAL",
|
441 | ec766865 | Gerd Hoffmann | [ SEARCH_LOW ] = "SEARCH_LOW",
|
442 | ec766865 | Gerd Hoffmann | [ SET_LIMITS ] = "SET_LIMITS",
|
443 | ec766865 | Gerd Hoffmann | [ PRE_FETCH ] = "PRE_FETCH",
|
444 | 545557d4 | Blue Swirl | /* READ_POSITION and PRE_FETCH use the same operation code */
|
445 | ec766865 | Gerd Hoffmann | [ SYNCHRONIZE_CACHE ] = "SYNCHRONIZE_CACHE",
|
446 | ec766865 | Gerd Hoffmann | [ LOCK_UNLOCK_CACHE ] = "LOCK_UNLOCK_CACHE",
|
447 | ec766865 | Gerd Hoffmann | [ READ_DEFECT_DATA ] = "READ_DEFECT_DATA",
|
448 | ec766865 | Gerd Hoffmann | [ MEDIUM_SCAN ] = "MEDIUM_SCAN",
|
449 | ec766865 | Gerd Hoffmann | [ COMPARE ] = "COMPARE",
|
450 | ec766865 | Gerd Hoffmann | [ COPY_VERIFY ] = "COPY_VERIFY",
|
451 | ec766865 | Gerd Hoffmann | [ WRITE_BUFFER ] = "WRITE_BUFFER",
|
452 | ec766865 | Gerd Hoffmann | [ READ_BUFFER ] = "READ_BUFFER",
|
453 | ec766865 | Gerd Hoffmann | [ UPDATE_BLOCK ] = "UPDATE_BLOCK",
|
454 | ec766865 | Gerd Hoffmann | [ READ_LONG ] = "READ_LONG",
|
455 | ec766865 | Gerd Hoffmann | [ WRITE_LONG ] = "WRITE_LONG",
|
456 | ec766865 | Gerd Hoffmann | [ CHANGE_DEFINITION ] = "CHANGE_DEFINITION",
|
457 | ec766865 | Gerd Hoffmann | [ WRITE_SAME ] = "WRITE_SAME",
|
458 | ec766865 | Gerd Hoffmann | [ READ_TOC ] = "READ_TOC",
|
459 | ec766865 | Gerd Hoffmann | [ LOG_SELECT ] = "LOG_SELECT",
|
460 | ec766865 | Gerd Hoffmann | [ LOG_SENSE ] = "LOG_SENSE",
|
461 | ec766865 | Gerd Hoffmann | [ MODE_SELECT_10 ] = "MODE_SELECT_10",
|
462 | ec766865 | Gerd Hoffmann | [ RESERVE_10 ] = "RESERVE_10",
|
463 | ec766865 | Gerd Hoffmann | [ RELEASE_10 ] = "RELEASE_10",
|
464 | ec766865 | Gerd Hoffmann | [ MODE_SENSE_10 ] = "MODE_SENSE_10",
|
465 | ec766865 | Gerd Hoffmann | [ PERSISTENT_RESERVE_IN ] = "PERSISTENT_RESERVE_IN",
|
466 | ec766865 | Gerd Hoffmann | [ PERSISTENT_RESERVE_OUT ] = "PERSISTENT_RESERVE_OUT",
|
467 | ec766865 | Gerd Hoffmann | [ MOVE_MEDIUM ] = "MOVE_MEDIUM",
|
468 | ec766865 | Gerd Hoffmann | [ READ_12 ] = "READ_12",
|
469 | ec766865 | Gerd Hoffmann | [ WRITE_12 ] = "WRITE_12",
|
470 | ec766865 | Gerd Hoffmann | [ WRITE_VERIFY_12 ] = "WRITE_VERIFY_12",
|
471 | ec766865 | Gerd Hoffmann | [ SEARCH_HIGH_12 ] = "SEARCH_HIGH_12",
|
472 | ec766865 | Gerd Hoffmann | [ SEARCH_EQUAL_12 ] = "SEARCH_EQUAL_12",
|
473 | ec766865 | Gerd Hoffmann | [ SEARCH_LOW_12 ] = "SEARCH_LOW_12",
|
474 | ec766865 | Gerd Hoffmann | [ READ_ELEMENT_STATUS ] = "READ_ELEMENT_STATUS",
|
475 | ec766865 | Gerd Hoffmann | [ SEND_VOLUME_TAG ] = "SEND_VOLUME_TAG",
|
476 | ec766865 | Gerd Hoffmann | [ WRITE_LONG_2 ] = "WRITE_LONG_2",
|
477 | ec766865 | Gerd Hoffmann | |
478 | ec766865 | Gerd Hoffmann | [ REPORT_DENSITY_SUPPORT ] = "REPORT_DENSITY_SUPPORT",
|
479 | 38215553 | Gerd Hoffmann | [ GET_CONFIGURATION ] = "GET_CONFIGURATION",
|
480 | bd536cf3 | Gerd Hoffmann | [ READ_16 ] = "READ_16",
|
481 | bd536cf3 | Gerd Hoffmann | [ WRITE_16 ] = "WRITE_16",
|
482 | bd536cf3 | Gerd Hoffmann | [ WRITE_VERIFY_16 ] = "WRITE_VERIFY_16",
|
483 | 5dd90e2a | Gerd Hoffmann | [ SERVICE_ACTION_IN ] = "SERVICE_ACTION_IN",
|
484 | 39ec9a50 | Gerd Hoffmann | [ REPORT_LUNS ] = "REPORT_LUNS",
|
485 | ec766865 | Gerd Hoffmann | [ LOAD_UNLOAD ] = "LOAD_UNLOAD",
|
486 | ec766865 | Gerd Hoffmann | [ SET_CD_SPEED ] = "SET_CD_SPEED",
|
487 | ec766865 | Gerd Hoffmann | [ BLANK ] = "BLANK",
|
488 | ec766865 | Gerd Hoffmann | }; |
489 | ec766865 | Gerd Hoffmann | |
490 | ec766865 | Gerd Hoffmann | if (cmd >= ARRAY_SIZE(names) || names[cmd] == NULL) |
491 | ec766865 | Gerd Hoffmann | return "*UNKNOWN*"; |
492 | ec766865 | Gerd Hoffmann | return names[cmd];
|
493 | ec766865 | Gerd Hoffmann | } |
494 | ec766865 | Gerd Hoffmann | |
495 | ec766865 | Gerd Hoffmann | void scsi_req_print(SCSIRequest *req)
|
496 | ec766865 | Gerd Hoffmann | { |
497 | ec766865 | Gerd Hoffmann | FILE *fp = stderr; |
498 | ec766865 | Gerd Hoffmann | int i;
|
499 | ec766865 | Gerd Hoffmann | |
500 | ec766865 | Gerd Hoffmann | fprintf(fp, "[%s id=%d] %s",
|
501 | ec766865 | Gerd Hoffmann | req->dev->qdev.parent_bus->name, |
502 | ec766865 | Gerd Hoffmann | req->dev->id, |
503 | ec766865 | Gerd Hoffmann | scsi_command_name(req->cmd.buf[0]));
|
504 | ec766865 | Gerd Hoffmann | for (i = 1; i < req->cmd.len; i++) { |
505 | ec766865 | Gerd Hoffmann | fprintf(fp, " 0x%02x", req->cmd.buf[i]);
|
506 | ec766865 | Gerd Hoffmann | } |
507 | ec766865 | Gerd Hoffmann | switch (req->cmd.mode) {
|
508 | ec766865 | Gerd Hoffmann | case SCSI_XFER_NONE:
|
509 | ec766865 | Gerd Hoffmann | fprintf(fp, " - none\n");
|
510 | ec766865 | Gerd Hoffmann | break;
|
511 | ec766865 | Gerd Hoffmann | case SCSI_XFER_FROM_DEV:
|
512 | ec766865 | Gerd Hoffmann | fprintf(fp, " - from-dev len=%zd\n", req->cmd.xfer);
|
513 | ec766865 | Gerd Hoffmann | break;
|
514 | ec766865 | Gerd Hoffmann | case SCSI_XFER_TO_DEV:
|
515 | ec766865 | Gerd Hoffmann | fprintf(fp, " - to-dev len=%zd\n", req->cmd.xfer);
|
516 | ec766865 | Gerd Hoffmann | break;
|
517 | ec766865 | Gerd Hoffmann | default:
|
518 | ec766865 | Gerd Hoffmann | fprintf(fp, " - Oops\n");
|
519 | ec766865 | Gerd Hoffmann | break;
|
520 | ec766865 | Gerd Hoffmann | } |
521 | ec766865 | Gerd Hoffmann | } |
522 | ec766865 | Gerd Hoffmann | |
523 | ed3a34a3 | Gerd Hoffmann | void scsi_req_complete(SCSIRequest *req)
|
524 | ed3a34a3 | Gerd Hoffmann | { |
525 | ed3a34a3 | Gerd Hoffmann | assert(req->status != -1);
|
526 | e8637c90 | Jan Kiszka | scsi_req_dequeue(req); |
527 | ed3a34a3 | Gerd Hoffmann | req->bus->complete(req->bus, SCSI_REASON_DONE, |
528 | ed3a34a3 | Gerd Hoffmann | req->tag, |
529 | ed3a34a3 | Gerd Hoffmann | req->status); |
530 | ed3a34a3 | Gerd Hoffmann | } |