root / hw / scsi-bus.c @ 39ec9a50
History | View | Annotate | Download (13.9 kB)
1 | d52affa7 | Gerd Hoffmann | #include "hw.h" |
---|---|---|---|
2 | d52affa7 | Gerd Hoffmann | #include "sysemu.h" |
3 | 43b443b6 | Gerd Hoffmann | #include "scsi.h" |
4 | 2ec749cb | Gerd Hoffmann | #include "scsi-defs.h" |
5 | d52affa7 | Gerd Hoffmann | #include "block.h" |
6 | d52affa7 | Gerd Hoffmann | #include "qdev.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 | d52affa7 | Gerd Hoffmann | qemu_error("bad scsi device id: %d\n", 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 | 33e66b86 | Markus Armbruster | /* FIXME callers should check for failure, but don't */
|
88 | d52affa7 | Gerd Hoffmann | SCSIDevice *scsi_bus_legacy_add_drive(SCSIBus *bus, DriveInfo *dinfo, int unit)
|
89 | d52affa7 | Gerd Hoffmann | { |
90 | d52affa7 | Gerd Hoffmann | const char *driver; |
91 | d52affa7 | Gerd Hoffmann | DeviceState *dev; |
92 | d52affa7 | Gerd Hoffmann | |
93 | d52affa7 | Gerd Hoffmann | driver = bdrv_is_sg(dinfo->bdrv) ? "scsi-generic" : "scsi-disk"; |
94 | d52affa7 | Gerd Hoffmann | dev = qdev_create(&bus->qbus, driver); |
95 | d52affa7 | Gerd Hoffmann | qdev_prop_set_uint32(dev, "scsi-id", unit);
|
96 | d52affa7 | Gerd Hoffmann | qdev_prop_set_drive(dev, "drive", dinfo);
|
97 | 33e66b86 | Markus Armbruster | if (qdev_init(dev) < 0) |
98 | 33e66b86 | Markus Armbruster | return NULL; |
99 | d52affa7 | Gerd Hoffmann | return DO_UPCAST(SCSIDevice, qdev, dev);
|
100 | d52affa7 | Gerd Hoffmann | } |
101 | d52affa7 | Gerd Hoffmann | |
102 | d52affa7 | Gerd Hoffmann | void scsi_bus_legacy_handle_cmdline(SCSIBus *bus)
|
103 | d52affa7 | Gerd Hoffmann | { |
104 | d52affa7 | Gerd Hoffmann | DriveInfo *dinfo; |
105 | d52affa7 | Gerd Hoffmann | int unit;
|
106 | d52affa7 | Gerd Hoffmann | |
107 | d52affa7 | Gerd Hoffmann | for (unit = 0; unit < MAX_SCSI_DEVS; unit++) { |
108 | d52affa7 | Gerd Hoffmann | dinfo = drive_get(IF_SCSI, bus->busnr, unit); |
109 | d52affa7 | Gerd Hoffmann | if (dinfo == NULL) { |
110 | d52affa7 | Gerd Hoffmann | continue;
|
111 | d52affa7 | Gerd Hoffmann | } |
112 | d52affa7 | Gerd Hoffmann | scsi_bus_legacy_add_drive(bus, dinfo, unit); |
113 | d52affa7 | Gerd Hoffmann | } |
114 | d52affa7 | Gerd Hoffmann | } |
115 | 89b08ae1 | Gerd Hoffmann | |
116 | 37659e51 | Gerd Hoffmann | void scsi_dev_clear_sense(SCSIDevice *dev)
|
117 | 37659e51 | Gerd Hoffmann | { |
118 | 37659e51 | Gerd Hoffmann | memset(&dev->sense, 0, sizeof(dev->sense)); |
119 | 37659e51 | Gerd Hoffmann | } |
120 | 37659e51 | Gerd Hoffmann | |
121 | 37659e51 | Gerd Hoffmann | void scsi_dev_set_sense(SCSIDevice *dev, uint8_t key)
|
122 | 37659e51 | Gerd Hoffmann | { |
123 | 37659e51 | Gerd Hoffmann | dev->sense.key = key; |
124 | 37659e51 | Gerd Hoffmann | } |
125 | 37659e51 | Gerd Hoffmann | |
126 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *scsi_req_alloc(size_t size, SCSIDevice *d, uint32_t tag, uint32_t lun) |
127 | 89b08ae1 | Gerd Hoffmann | { |
128 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *req; |
129 | 89b08ae1 | Gerd Hoffmann | |
130 | 89b08ae1 | Gerd Hoffmann | req = qemu_mallocz(size); |
131 | 89b08ae1 | Gerd Hoffmann | req->bus = scsi_bus_from_device(d); |
132 | 89b08ae1 | Gerd Hoffmann | req->dev = d; |
133 | 89b08ae1 | Gerd Hoffmann | req->tag = tag; |
134 | 89b08ae1 | Gerd Hoffmann | req->lun = lun; |
135 | ed3a34a3 | Gerd Hoffmann | req->status = -1;
|
136 | 89b08ae1 | Gerd Hoffmann | QTAILQ_INSERT_TAIL(&d->requests, req, next); |
137 | 89b08ae1 | Gerd Hoffmann | return req;
|
138 | 89b08ae1 | Gerd Hoffmann | } |
139 | 89b08ae1 | Gerd Hoffmann | |
140 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *scsi_req_find(SCSIDevice *d, uint32_t tag) |
141 | 89b08ae1 | Gerd Hoffmann | { |
142 | 89b08ae1 | Gerd Hoffmann | SCSIRequest *req; |
143 | 89b08ae1 | Gerd Hoffmann | |
144 | 89b08ae1 | Gerd Hoffmann | QTAILQ_FOREACH(req, &d->requests, next) { |
145 | 89b08ae1 | Gerd Hoffmann | if (req->tag == tag) {
|
146 | 89b08ae1 | Gerd Hoffmann | return req;
|
147 | 89b08ae1 | Gerd Hoffmann | } |
148 | 89b08ae1 | Gerd Hoffmann | } |
149 | 89b08ae1 | Gerd Hoffmann | return NULL; |
150 | 89b08ae1 | Gerd Hoffmann | } |
151 | 89b08ae1 | Gerd Hoffmann | |
152 | 89b08ae1 | Gerd Hoffmann | void scsi_req_free(SCSIRequest *req)
|
153 | 89b08ae1 | Gerd Hoffmann | { |
154 | 89b08ae1 | Gerd Hoffmann | QTAILQ_REMOVE(&req->dev->requests, req, next); |
155 | 89b08ae1 | Gerd Hoffmann | qemu_free(req); |
156 | 89b08ae1 | Gerd Hoffmann | } |
157 | 2ec749cb | Gerd Hoffmann | |
158 | 2ec749cb | Gerd Hoffmann | static int scsi_req_length(SCSIRequest *req, uint8_t *cmd) |
159 | 2ec749cb | Gerd Hoffmann | { |
160 | 2ec749cb | Gerd Hoffmann | switch (cmd[0] >> 5) { |
161 | 2ec749cb | Gerd Hoffmann | case 0: |
162 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[4];
|
163 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 6;
|
164 | 2ec749cb | Gerd Hoffmann | /* length 0 means 256 blocks */
|
165 | 2ec749cb | Gerd Hoffmann | if (req->cmd.xfer == 0) |
166 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 256;
|
167 | 2ec749cb | Gerd Hoffmann | break;
|
168 | 2ec749cb | Gerd Hoffmann | case 1: |
169 | 2ec749cb | Gerd Hoffmann | case 2: |
170 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[8] | (cmd[7] << 8); |
171 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 10;
|
172 | 2ec749cb | Gerd Hoffmann | break;
|
173 | 2ec749cb | Gerd Hoffmann | case 4: |
174 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[13] | (cmd[12] << 8) | (cmd[11] << 16) | (cmd[10] << 24); |
175 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 16;
|
176 | 2ec749cb | Gerd Hoffmann | break;
|
177 | 2ec749cb | Gerd Hoffmann | case 5: |
178 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[9] | (cmd[8] << 8) | (cmd[7] << 16) | (cmd[6] << 24); |
179 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 12;
|
180 | 2ec749cb | Gerd Hoffmann | break;
|
181 | 2ec749cb | Gerd Hoffmann | default:
|
182 | 2ec749cb | Gerd Hoffmann | return -1; |
183 | 2ec749cb | Gerd Hoffmann | } |
184 | 2ec749cb | Gerd Hoffmann | |
185 | 2ec749cb | Gerd Hoffmann | switch(cmd[0]) { |
186 | 2ec749cb | Gerd Hoffmann | case TEST_UNIT_READY:
|
187 | 2ec749cb | Gerd Hoffmann | case REZERO_UNIT:
|
188 | 2ec749cb | Gerd Hoffmann | case START_STOP:
|
189 | 2ec749cb | Gerd Hoffmann | case SEEK_6:
|
190 | 2ec749cb | Gerd Hoffmann | case WRITE_FILEMARKS:
|
191 | 2ec749cb | Gerd Hoffmann | case SPACE:
|
192 | 2ec749cb | Gerd Hoffmann | case ERASE:
|
193 | 2ec749cb | Gerd Hoffmann | case ALLOW_MEDIUM_REMOVAL:
|
194 | 2ec749cb | Gerd Hoffmann | case VERIFY:
|
195 | 2ec749cb | Gerd Hoffmann | case SEEK_10:
|
196 | 2ec749cb | Gerd Hoffmann | case SYNCHRONIZE_CACHE:
|
197 | 2ec749cb | Gerd Hoffmann | case LOCK_UNLOCK_CACHE:
|
198 | 2ec749cb | Gerd Hoffmann | case LOAD_UNLOAD:
|
199 | 2ec749cb | Gerd Hoffmann | case SET_CD_SPEED:
|
200 | 2ec749cb | Gerd Hoffmann | case SET_LIMITS:
|
201 | 2ec749cb | Gerd Hoffmann | case WRITE_LONG:
|
202 | 2ec749cb | Gerd Hoffmann | case MOVE_MEDIUM:
|
203 | 2ec749cb | Gerd Hoffmann | case UPDATE_BLOCK:
|
204 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 0;
|
205 | 2ec749cb | Gerd Hoffmann | break;
|
206 | 2ec749cb | Gerd Hoffmann | case MODE_SENSE:
|
207 | 2ec749cb | Gerd Hoffmann | break;
|
208 | 2ec749cb | Gerd Hoffmann | case WRITE_SAME:
|
209 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 1;
|
210 | 2ec749cb | Gerd Hoffmann | break;
|
211 | 2ec749cb | Gerd Hoffmann | case READ_CAPACITY:
|
212 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 8;
|
213 | 2ec749cb | Gerd Hoffmann | break;
|
214 | 2ec749cb | Gerd Hoffmann | case READ_BLOCK_LIMITS:
|
215 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 6;
|
216 | 2ec749cb | Gerd Hoffmann | break;
|
217 | 2ec749cb | Gerd Hoffmann | case READ_POSITION:
|
218 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 20;
|
219 | 2ec749cb | Gerd Hoffmann | break;
|
220 | 2ec749cb | Gerd Hoffmann | case SEND_VOLUME_TAG:
|
221 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= 40;
|
222 | 2ec749cb | Gerd Hoffmann | break;
|
223 | 2ec749cb | Gerd Hoffmann | case MEDIUM_SCAN:
|
224 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= 8;
|
225 | 2ec749cb | Gerd Hoffmann | break;
|
226 | 2ec749cb | Gerd Hoffmann | case WRITE_10:
|
227 | 2ec749cb | Gerd Hoffmann | case WRITE_VERIFY:
|
228 | 2ec749cb | Gerd Hoffmann | case WRITE_6:
|
229 | 2ec749cb | Gerd Hoffmann | case WRITE_12:
|
230 | 2ec749cb | Gerd Hoffmann | case WRITE_VERIFY_12:
|
231 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= req->dev->blocksize; |
232 | 2ec749cb | Gerd Hoffmann | break;
|
233 | 2ec749cb | Gerd Hoffmann | case READ_10:
|
234 | 2ec749cb | Gerd Hoffmann | case READ_6:
|
235 | 2ec749cb | Gerd Hoffmann | case READ_REVERSE:
|
236 | 2ec749cb | Gerd Hoffmann | case RECOVER_BUFFERED_DATA:
|
237 | 2ec749cb | Gerd Hoffmann | case READ_12:
|
238 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= req->dev->blocksize; |
239 | 2ec749cb | Gerd Hoffmann | break;
|
240 | 2ec749cb | Gerd Hoffmann | case INQUIRY:
|
241 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[4] | (cmd[3] << 8); |
242 | 2ec749cb | Gerd Hoffmann | break;
|
243 | 2ec749cb | Gerd Hoffmann | } |
244 | 2ec749cb | Gerd Hoffmann | return 0; |
245 | 2ec749cb | Gerd Hoffmann | } |
246 | 2ec749cb | Gerd Hoffmann | |
247 | 2ec749cb | Gerd Hoffmann | static int scsi_req_stream_length(SCSIRequest *req, uint8_t *cmd) |
248 | 2ec749cb | Gerd Hoffmann | { |
249 | 2ec749cb | Gerd Hoffmann | switch(cmd[0]) { |
250 | 2ec749cb | Gerd Hoffmann | /* stream commands */
|
251 | 2ec749cb | Gerd Hoffmann | case READ_6:
|
252 | 2ec749cb | Gerd Hoffmann | case READ_REVERSE:
|
253 | 2ec749cb | Gerd Hoffmann | case RECOVER_BUFFERED_DATA:
|
254 | 2ec749cb | Gerd Hoffmann | case WRITE_6:
|
255 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 6;
|
256 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = cmd[4] | (cmd[3] << 8) | (cmd[2] << 16); |
257 | 2ec749cb | Gerd Hoffmann | if (cmd[1] & 0x01) /* fixed */ |
258 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer *= req->dev->blocksize; |
259 | 2ec749cb | Gerd Hoffmann | break;
|
260 | 2ec749cb | Gerd Hoffmann | case REWIND:
|
261 | 2ec749cb | Gerd Hoffmann | case START_STOP:
|
262 | 2ec749cb | Gerd Hoffmann | req->cmd.len = 6;
|
263 | 2ec749cb | Gerd Hoffmann | req->cmd.xfer = 0;
|
264 | 2ec749cb | Gerd Hoffmann | break;
|
265 | 2ec749cb | Gerd Hoffmann | /* generic commands */
|
266 | 2ec749cb | Gerd Hoffmann | default:
|
267 | 2ec749cb | Gerd Hoffmann | return scsi_req_length(req, cmd);
|
268 | 2ec749cb | Gerd Hoffmann | } |
269 | 2ec749cb | Gerd Hoffmann | return 0; |
270 | 2ec749cb | Gerd Hoffmann | } |
271 | 2ec749cb | Gerd Hoffmann | |
272 | 97a06435 | Gerd Hoffmann | static void scsi_req_xfer_mode(SCSIRequest *req) |
273 | 97a06435 | Gerd Hoffmann | { |
274 | 97a06435 | Gerd Hoffmann | switch (req->cmd.buf[0]) { |
275 | 97a06435 | Gerd Hoffmann | case WRITE_6:
|
276 | 97a06435 | Gerd Hoffmann | case WRITE_10:
|
277 | 97a06435 | Gerd Hoffmann | case WRITE_VERIFY:
|
278 | 97a06435 | Gerd Hoffmann | case WRITE_12:
|
279 | 97a06435 | Gerd Hoffmann | case WRITE_VERIFY_12:
|
280 | 97a06435 | Gerd Hoffmann | case COPY:
|
281 | 97a06435 | Gerd Hoffmann | case COPY_VERIFY:
|
282 | 97a06435 | Gerd Hoffmann | case COMPARE:
|
283 | 97a06435 | Gerd Hoffmann | case CHANGE_DEFINITION:
|
284 | 97a06435 | Gerd Hoffmann | case LOG_SELECT:
|
285 | 97a06435 | Gerd Hoffmann | case MODE_SELECT:
|
286 | 97a06435 | Gerd Hoffmann | case MODE_SELECT_10:
|
287 | 97a06435 | Gerd Hoffmann | case SEND_DIAGNOSTIC:
|
288 | 97a06435 | Gerd Hoffmann | case WRITE_BUFFER:
|
289 | 97a06435 | Gerd Hoffmann | case FORMAT_UNIT:
|
290 | 97a06435 | Gerd Hoffmann | case REASSIGN_BLOCKS:
|
291 | 97a06435 | Gerd Hoffmann | case RESERVE:
|
292 | 97a06435 | Gerd Hoffmann | case SEARCH_EQUAL:
|
293 | 97a06435 | Gerd Hoffmann | case SEARCH_HIGH:
|
294 | 97a06435 | Gerd Hoffmann | case SEARCH_LOW:
|
295 | 97a06435 | Gerd Hoffmann | case UPDATE_BLOCK:
|
296 | 97a06435 | Gerd Hoffmann | case WRITE_LONG:
|
297 | 97a06435 | Gerd Hoffmann | case WRITE_SAME:
|
298 | 97a06435 | Gerd Hoffmann | case SEARCH_HIGH_12:
|
299 | 97a06435 | Gerd Hoffmann | case SEARCH_EQUAL_12:
|
300 | 97a06435 | Gerd Hoffmann | case SEARCH_LOW_12:
|
301 | 97a06435 | Gerd Hoffmann | case SET_WINDOW:
|
302 | 97a06435 | Gerd Hoffmann | case MEDIUM_SCAN:
|
303 | 97a06435 | Gerd Hoffmann | case SEND_VOLUME_TAG:
|
304 | 97a06435 | Gerd Hoffmann | case WRITE_LONG_2:
|
305 | 97a06435 | Gerd Hoffmann | req->cmd.mode = SCSI_XFER_TO_DEV; |
306 | 97a06435 | Gerd Hoffmann | break;
|
307 | 97a06435 | Gerd Hoffmann | default:
|
308 | 97a06435 | Gerd Hoffmann | if (req->cmd.xfer)
|
309 | 97a06435 | Gerd Hoffmann | req->cmd.mode = SCSI_XFER_FROM_DEV; |
310 | 97a06435 | Gerd Hoffmann | else {
|
311 | 97a06435 | Gerd Hoffmann | req->cmd.mode = SCSI_XFER_NONE; |
312 | 97a06435 | Gerd Hoffmann | } |
313 | 97a06435 | Gerd Hoffmann | break;
|
314 | 97a06435 | Gerd Hoffmann | } |
315 | 97a06435 | Gerd Hoffmann | } |
316 | 97a06435 | Gerd Hoffmann | |
317 | 2ec749cb | Gerd Hoffmann | static uint64_t scsi_req_lba(SCSIRequest *req)
|
318 | 2ec749cb | Gerd Hoffmann | { |
319 | 2ec749cb | Gerd Hoffmann | uint8_t *buf = req->cmd.buf; |
320 | 2ec749cb | Gerd Hoffmann | uint64_t lba; |
321 | 2ec749cb | Gerd Hoffmann | |
322 | 2ec749cb | Gerd Hoffmann | switch (buf[0] >> 5) { |
323 | 2ec749cb | Gerd Hoffmann | case 0: |
324 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[3] | ((uint64_t) buf[2] << 8) | |
325 | 2ec749cb | Gerd Hoffmann | (((uint64_t) buf[1] & 0x1f) << 16); |
326 | 2ec749cb | Gerd Hoffmann | break;
|
327 | 2ec749cb | Gerd Hoffmann | case 1: |
328 | 2ec749cb | Gerd Hoffmann | case 2: |
329 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) | |
330 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24); |
331 | 2ec749cb | Gerd Hoffmann | break;
|
332 | 2ec749cb | Gerd Hoffmann | case 4: |
333 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[9] | ((uint64_t) buf[8] << 8) | |
334 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[7] << 16) | ((uint64_t) buf[6] << 24) | |
335 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[5] << 32) | ((uint64_t) buf[4] << 40) | |
336 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[3] << 48) | ((uint64_t) buf[2] << 56); |
337 | 2ec749cb | Gerd Hoffmann | break;
|
338 | 2ec749cb | Gerd Hoffmann | case 5: |
339 | 2ec749cb | Gerd Hoffmann | lba = (uint64_t) buf[5] | ((uint64_t) buf[4] << 8) | |
340 | 2ec749cb | Gerd Hoffmann | ((uint64_t) buf[3] << 16) | ((uint64_t) buf[2] << 24); |
341 | 2ec749cb | Gerd Hoffmann | break;
|
342 | 2ec749cb | Gerd Hoffmann | default:
|
343 | 2ec749cb | Gerd Hoffmann | lba = -1;
|
344 | 2ec749cb | Gerd Hoffmann | |
345 | 2ec749cb | Gerd Hoffmann | } |
346 | 2ec749cb | Gerd Hoffmann | return lba;
|
347 | 2ec749cb | Gerd Hoffmann | } |
348 | 2ec749cb | Gerd Hoffmann | |
349 | 2ec749cb | Gerd Hoffmann | int scsi_req_parse(SCSIRequest *req, uint8_t *buf)
|
350 | 2ec749cb | Gerd Hoffmann | { |
351 | 2ec749cb | Gerd Hoffmann | int rc;
|
352 | 2ec749cb | Gerd Hoffmann | |
353 | 2ec749cb | Gerd Hoffmann | if (req->dev->type == TYPE_TAPE) {
|
354 | 2ec749cb | Gerd Hoffmann | rc = scsi_req_stream_length(req, buf); |
355 | 2ec749cb | Gerd Hoffmann | } else {
|
356 | 2ec749cb | Gerd Hoffmann | rc = scsi_req_length(req, buf); |
357 | 2ec749cb | Gerd Hoffmann | } |
358 | 2ec749cb | Gerd Hoffmann | if (rc != 0) |
359 | 2ec749cb | Gerd Hoffmann | return rc;
|
360 | 2ec749cb | Gerd Hoffmann | |
361 | 2ec749cb | Gerd Hoffmann | memcpy(req->cmd.buf, buf, req->cmd.len); |
362 | 97a06435 | Gerd Hoffmann | scsi_req_xfer_mode(req); |
363 | 2ec749cb | Gerd Hoffmann | req->cmd.lba = scsi_req_lba(req); |
364 | 2ec749cb | Gerd Hoffmann | return 0; |
365 | 2ec749cb | Gerd Hoffmann | } |
366 | ed3a34a3 | Gerd Hoffmann | |
367 | ec766865 | Gerd Hoffmann | static const char *scsi_command_name(uint8_t cmd) |
368 | ec766865 | Gerd Hoffmann | { |
369 | ec766865 | Gerd Hoffmann | static const char *names[] = { |
370 | ec766865 | Gerd Hoffmann | [ TEST_UNIT_READY ] = "TEST_UNIT_READY",
|
371 | ec766865 | Gerd Hoffmann | [ REZERO_UNIT ] = "REZERO_UNIT",
|
372 | ec766865 | Gerd Hoffmann | [ REQUEST_SENSE ] = "REQUEST_SENSE",
|
373 | ec766865 | Gerd Hoffmann | [ FORMAT_UNIT ] = "FORMAT_UNIT",
|
374 | ec766865 | Gerd Hoffmann | [ READ_BLOCK_LIMITS ] = "READ_BLOCK_LIMITS",
|
375 | ec766865 | Gerd Hoffmann | [ REASSIGN_BLOCKS ] = "REASSIGN_BLOCKS",
|
376 | ec766865 | Gerd Hoffmann | [ READ_6 ] = "READ_6",
|
377 | ec766865 | Gerd Hoffmann | [ WRITE_6 ] = "WRITE_6",
|
378 | ec766865 | Gerd Hoffmann | [ SEEK_6 ] = "SEEK_6",
|
379 | ec766865 | Gerd Hoffmann | [ READ_REVERSE ] = "READ_REVERSE",
|
380 | ec766865 | Gerd Hoffmann | [ WRITE_FILEMARKS ] = "WRITE_FILEMARKS",
|
381 | ec766865 | Gerd Hoffmann | [ SPACE ] = "SPACE",
|
382 | ec766865 | Gerd Hoffmann | [ INQUIRY ] = "INQUIRY",
|
383 | ec766865 | Gerd Hoffmann | [ RECOVER_BUFFERED_DATA ] = "RECOVER_BUFFERED_DATA",
|
384 | ec766865 | Gerd Hoffmann | [ MODE_SELECT ] = "MODE_SELECT",
|
385 | ec766865 | Gerd Hoffmann | [ RESERVE ] = "RESERVE",
|
386 | ec766865 | Gerd Hoffmann | [ RELEASE ] = "RELEASE",
|
387 | ec766865 | Gerd Hoffmann | [ COPY ] = "COPY",
|
388 | ec766865 | Gerd Hoffmann | [ ERASE ] = "ERASE",
|
389 | ec766865 | Gerd Hoffmann | [ MODE_SENSE ] = "MODE_SENSE",
|
390 | ec766865 | Gerd Hoffmann | [ START_STOP ] = "START_STOP",
|
391 | ec766865 | Gerd Hoffmann | [ RECEIVE_DIAGNOSTIC ] = "RECEIVE_DIAGNOSTIC",
|
392 | ec766865 | Gerd Hoffmann | [ SEND_DIAGNOSTIC ] = "SEND_DIAGNOSTIC",
|
393 | ec766865 | Gerd Hoffmann | [ ALLOW_MEDIUM_REMOVAL ] = "ALLOW_MEDIUM_REMOVAL",
|
394 | ec766865 | Gerd Hoffmann | |
395 | ec766865 | Gerd Hoffmann | [ SET_WINDOW ] = "SET_WINDOW",
|
396 | ec766865 | Gerd Hoffmann | [ READ_CAPACITY ] = "READ_CAPACITY",
|
397 | ec766865 | Gerd Hoffmann | [ READ_10 ] = "READ_10",
|
398 | ec766865 | Gerd Hoffmann | [ WRITE_10 ] = "WRITE_10",
|
399 | ec766865 | Gerd Hoffmann | [ SEEK_10 ] = "SEEK_10",
|
400 | ec766865 | Gerd Hoffmann | [ WRITE_VERIFY ] = "WRITE_VERIFY",
|
401 | ec766865 | Gerd Hoffmann | [ VERIFY ] = "VERIFY",
|
402 | ec766865 | Gerd Hoffmann | [ SEARCH_HIGH ] = "SEARCH_HIGH",
|
403 | ec766865 | Gerd Hoffmann | [ SEARCH_EQUAL ] = "SEARCH_EQUAL",
|
404 | ec766865 | Gerd Hoffmann | [ SEARCH_LOW ] = "SEARCH_LOW",
|
405 | ec766865 | Gerd Hoffmann | [ SET_LIMITS ] = "SET_LIMITS",
|
406 | ec766865 | Gerd Hoffmann | [ PRE_FETCH ] = "PRE_FETCH",
|
407 | ec766865 | Gerd Hoffmann | [ READ_POSITION ] = "READ_POSITION",
|
408 | ec766865 | Gerd Hoffmann | [ SYNCHRONIZE_CACHE ] = "SYNCHRONIZE_CACHE",
|
409 | ec766865 | Gerd Hoffmann | [ LOCK_UNLOCK_CACHE ] = "LOCK_UNLOCK_CACHE",
|
410 | ec766865 | Gerd Hoffmann | [ READ_DEFECT_DATA ] = "READ_DEFECT_DATA",
|
411 | ec766865 | Gerd Hoffmann | [ MEDIUM_SCAN ] = "MEDIUM_SCAN",
|
412 | ec766865 | Gerd Hoffmann | [ COMPARE ] = "COMPARE",
|
413 | ec766865 | Gerd Hoffmann | [ COPY_VERIFY ] = "COPY_VERIFY",
|
414 | ec766865 | Gerd Hoffmann | [ WRITE_BUFFER ] = "WRITE_BUFFER",
|
415 | ec766865 | Gerd Hoffmann | [ READ_BUFFER ] = "READ_BUFFER",
|
416 | ec766865 | Gerd Hoffmann | [ UPDATE_BLOCK ] = "UPDATE_BLOCK",
|
417 | ec766865 | Gerd Hoffmann | [ READ_LONG ] = "READ_LONG",
|
418 | ec766865 | Gerd Hoffmann | [ WRITE_LONG ] = "WRITE_LONG",
|
419 | ec766865 | Gerd Hoffmann | [ CHANGE_DEFINITION ] = "CHANGE_DEFINITION",
|
420 | ec766865 | Gerd Hoffmann | [ WRITE_SAME ] = "WRITE_SAME",
|
421 | ec766865 | Gerd Hoffmann | [ READ_TOC ] = "READ_TOC",
|
422 | ec766865 | Gerd Hoffmann | [ LOG_SELECT ] = "LOG_SELECT",
|
423 | ec766865 | Gerd Hoffmann | [ LOG_SENSE ] = "LOG_SENSE",
|
424 | ec766865 | Gerd Hoffmann | [ MODE_SELECT_10 ] = "MODE_SELECT_10",
|
425 | ec766865 | Gerd Hoffmann | [ RESERVE_10 ] = "RESERVE_10",
|
426 | ec766865 | Gerd Hoffmann | [ RELEASE_10 ] = "RELEASE_10",
|
427 | ec766865 | Gerd Hoffmann | [ MODE_SENSE_10 ] = "MODE_SENSE_10",
|
428 | ec766865 | Gerd Hoffmann | [ PERSISTENT_RESERVE_IN ] = "PERSISTENT_RESERVE_IN",
|
429 | ec766865 | Gerd Hoffmann | [ PERSISTENT_RESERVE_OUT ] = "PERSISTENT_RESERVE_OUT",
|
430 | ec766865 | Gerd Hoffmann | [ MOVE_MEDIUM ] = "MOVE_MEDIUM",
|
431 | ec766865 | Gerd Hoffmann | [ READ_12 ] = "READ_12",
|
432 | ec766865 | Gerd Hoffmann | [ WRITE_12 ] = "WRITE_12",
|
433 | ec766865 | Gerd Hoffmann | [ WRITE_VERIFY_12 ] = "WRITE_VERIFY_12",
|
434 | ec766865 | Gerd Hoffmann | [ SEARCH_HIGH_12 ] = "SEARCH_HIGH_12",
|
435 | ec766865 | Gerd Hoffmann | [ SEARCH_EQUAL_12 ] = "SEARCH_EQUAL_12",
|
436 | ec766865 | Gerd Hoffmann | [ SEARCH_LOW_12 ] = "SEARCH_LOW_12",
|
437 | ec766865 | Gerd Hoffmann | [ READ_ELEMENT_STATUS ] = "READ_ELEMENT_STATUS",
|
438 | ec766865 | Gerd Hoffmann | [ SEND_VOLUME_TAG ] = "SEND_VOLUME_TAG",
|
439 | ec766865 | Gerd Hoffmann | [ WRITE_LONG_2 ] = "WRITE_LONG_2",
|
440 | ec766865 | Gerd Hoffmann | |
441 | ec766865 | Gerd Hoffmann | [ REWIND ] = "REWIND",
|
442 | ec766865 | Gerd Hoffmann | [ REPORT_DENSITY_SUPPORT ] = "REPORT_DENSITY_SUPPORT",
|
443 | 38215553 | Gerd Hoffmann | [ GET_CONFIGURATION ] = "GET_CONFIGURATION",
|
444 | 5dd90e2a | Gerd Hoffmann | [ SERVICE_ACTION_IN ] = "SERVICE_ACTION_IN",
|
445 | 39ec9a50 | Gerd Hoffmann | [ REPORT_LUNS ] = "REPORT_LUNS",
|
446 | ec766865 | Gerd Hoffmann | [ LOAD_UNLOAD ] = "LOAD_UNLOAD",
|
447 | ec766865 | Gerd Hoffmann | [ SET_CD_SPEED ] = "SET_CD_SPEED",
|
448 | ec766865 | Gerd Hoffmann | [ BLANK ] = "BLANK",
|
449 | ec766865 | Gerd Hoffmann | }; |
450 | ec766865 | Gerd Hoffmann | |
451 | ec766865 | Gerd Hoffmann | if (cmd >= ARRAY_SIZE(names) || names[cmd] == NULL) |
452 | ec766865 | Gerd Hoffmann | return "*UNKNOWN*"; |
453 | ec766865 | Gerd Hoffmann | return names[cmd];
|
454 | ec766865 | Gerd Hoffmann | } |
455 | ec766865 | Gerd Hoffmann | |
456 | ec766865 | Gerd Hoffmann | void scsi_req_print(SCSIRequest *req)
|
457 | ec766865 | Gerd Hoffmann | { |
458 | ec766865 | Gerd Hoffmann | FILE *fp = stderr; |
459 | ec766865 | Gerd Hoffmann | int i;
|
460 | ec766865 | Gerd Hoffmann | |
461 | ec766865 | Gerd Hoffmann | fprintf(fp, "[%s id=%d] %s",
|
462 | ec766865 | Gerd Hoffmann | req->dev->qdev.parent_bus->name, |
463 | ec766865 | Gerd Hoffmann | req->dev->id, |
464 | ec766865 | Gerd Hoffmann | scsi_command_name(req->cmd.buf[0]));
|
465 | ec766865 | Gerd Hoffmann | for (i = 1; i < req->cmd.len; i++) { |
466 | ec766865 | Gerd Hoffmann | fprintf(fp, " 0x%02x", req->cmd.buf[i]);
|
467 | ec766865 | Gerd Hoffmann | } |
468 | ec766865 | Gerd Hoffmann | switch (req->cmd.mode) {
|
469 | ec766865 | Gerd Hoffmann | case SCSI_XFER_NONE:
|
470 | ec766865 | Gerd Hoffmann | fprintf(fp, " - none\n");
|
471 | ec766865 | Gerd Hoffmann | break;
|
472 | ec766865 | Gerd Hoffmann | case SCSI_XFER_FROM_DEV:
|
473 | ec766865 | Gerd Hoffmann | fprintf(fp, " - from-dev len=%zd\n", req->cmd.xfer);
|
474 | ec766865 | Gerd Hoffmann | break;
|
475 | ec766865 | Gerd Hoffmann | case SCSI_XFER_TO_DEV:
|
476 | ec766865 | Gerd Hoffmann | fprintf(fp, " - to-dev len=%zd\n", req->cmd.xfer);
|
477 | ec766865 | Gerd Hoffmann | break;
|
478 | ec766865 | Gerd Hoffmann | default:
|
479 | ec766865 | Gerd Hoffmann | fprintf(fp, " - Oops\n");
|
480 | ec766865 | Gerd Hoffmann | break;
|
481 | ec766865 | Gerd Hoffmann | } |
482 | ec766865 | Gerd Hoffmann | } |
483 | ec766865 | Gerd Hoffmann | |
484 | ed3a34a3 | Gerd Hoffmann | void scsi_req_complete(SCSIRequest *req)
|
485 | ed3a34a3 | Gerd Hoffmann | { |
486 | ed3a34a3 | Gerd Hoffmann | assert(req->status != -1);
|
487 | ed3a34a3 | Gerd Hoffmann | req->bus->complete(req->bus, SCSI_REASON_DONE, |
488 | ed3a34a3 | Gerd Hoffmann | req->tag, |
489 | ed3a34a3 | Gerd Hoffmann | req->status); |
490 | ed3a34a3 | Gerd Hoffmann | } |