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