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