Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/drivers/scsi/ide-scsi.c Version 0.9 Jul 4, 1999 | |
3 | * | |
4 | * Copyright (C) 1996 - 1999 Gadi Oxman <gadio@netvision.net.il> | |
5 | */ | |
6 | ||
7 | /* | |
8 | * Emulation of a SCSI host adapter for IDE ATAPI devices. | |
9 | * | |
10 | * With this driver, one can use the Linux SCSI drivers instead of the | |
11 | * native IDE ATAPI drivers. | |
12 | * | |
13 | * Ver 0.1 Dec 3 96 Initial version. | |
14 | * Ver 0.2 Jan 26 97 Fixed bug in cleanup_module() and added emulation | |
15 | * of MODE_SENSE_6/MODE_SELECT_6 for cdroms. Thanks | |
16 | * to Janos Farkas for pointing this out. | |
17 | * Avoid using bitfields in structures for m68k. | |
18 | * Added Scatter/Gather and DMA support. | |
19 | * Ver 0.4 Dec 7 97 Add support for ATAPI PD/CD drives. | |
20 | * Use variable timeout for each command. | |
21 | * Ver 0.5 Jan 2 98 Fix previous PD/CD support. | |
22 | * Allow disabling of SCSI-6 to SCSI-10 transformation. | |
23 | * Ver 0.6 Jan 27 98 Allow disabling of SCSI command translation layer | |
24 | * for access through /dev/sg. | |
25 | * Fix MODE_SENSE_6/MODE_SELECT_6/INQUIRY translation. | |
26 | * Ver 0.7 Dec 04 98 Ignore commands where lun != 0 to avoid multiple | |
27 | * detection of devices with CONFIG_SCSI_MULTI_LUN | |
28 | * Ver 0.8 Feb 05 99 Optical media need translation too. Reverse 0.7. | |
29 | * Ver 0.9 Jul 04 99 Fix a bug in SG_SET_TRANSFORM. | |
30 | * Ver 0.91 Jun 10 02 Fix "off by one" error in transforms | |
31 | * Ver 0.92 Dec 31 02 Implement new SCSI mid level API | |
32 | */ | |
33 | ||
34 | #define IDESCSI_VERSION "0.92" | |
35 | ||
36 | #include <linux/module.h> | |
37 | #include <linux/config.h> | |
38 | #include <linux/types.h> | |
39 | #include <linux/string.h> | |
40 | #include <linux/kernel.h> | |
41 | #include <linux/mm.h> | |
42 | #include <linux/ioport.h> | |
43 | #include <linux/blkdev.h> | |
44 | #include <linux/errno.h> | |
45 | #include <linux/hdreg.h> | |
46 | #include <linux/slab.h> | |
47 | #include <linux/ide.h> | |
48 | #include <linux/scatterlist.h> | |
df0ae249 | 49 | #include <linux/delay.h> |
1da177e4 LT |
50 | |
51 | #include <asm/io.h> | |
52 | #include <asm/bitops.h> | |
53 | #include <asm/uaccess.h> | |
54 | ||
55 | #include <scsi/scsi.h> | |
56 | #include <scsi/scsi_cmnd.h> | |
57 | #include <scsi/scsi_device.h> | |
58 | #include <scsi/scsi_host.h> | |
59 | #include <scsi/scsi_tcq.h> | |
60 | #include <scsi/sg.h> | |
61 | ||
62 | #define IDESCSI_DEBUG_LOG 0 | |
63 | ||
64 | typedef struct idescsi_pc_s { | |
65 | u8 c[12]; /* Actual packet bytes */ | |
66 | int request_transfer; /* Bytes to transfer */ | |
67 | int actually_transferred; /* Bytes actually transferred */ | |
68 | int buffer_size; /* Size of our data buffer */ | |
69 | struct request *rq; /* The corresponding request */ | |
70 | u8 *buffer; /* Data buffer */ | |
71 | u8 *current_position; /* Pointer into the above buffer */ | |
72 | struct scatterlist *sg; /* Scatter gather table */ | |
73 | int b_count; /* Bytes transferred from current entry */ | |
74 | struct scsi_cmnd *scsi_cmd; /* SCSI command */ | |
75 | void (*done)(struct scsi_cmnd *); /* Scsi completion routine */ | |
76 | unsigned long flags; /* Status/Action flags */ | |
77 | unsigned long timeout; /* Command timeout */ | |
78 | } idescsi_pc_t; | |
79 | ||
80 | /* | |
81 | * Packet command status bits. | |
82 | */ | |
83 | #define PC_DMA_IN_PROGRESS 0 /* 1 while DMA in progress */ | |
84 | #define PC_WRITING 1 /* Data direction */ | |
85 | #define PC_TRANSFORM 2 /* transform SCSI commands */ | |
86 | #define PC_TIMEDOUT 3 /* command timed out */ | |
87 | #define PC_DMA_OK 4 /* Use DMA */ | |
88 | ||
89 | /* | |
90 | * SCSI command transformation layer | |
91 | */ | |
92 | #define IDESCSI_TRANSFORM 0 /* Enable/Disable transformation */ | |
93 | #define IDESCSI_SG_TRANSFORM 1 /* /dev/sg transformation */ | |
94 | ||
95 | /* | |
96 | * Log flags | |
97 | */ | |
98 | #define IDESCSI_LOG_CMD 0 /* Log SCSI commands */ | |
99 | ||
100 | typedef struct ide_scsi_obj { | |
101 | ide_drive_t *drive; | |
102 | ide_driver_t *driver; | |
103 | struct gendisk *disk; | |
104 | struct Scsi_Host *host; | |
105 | ||
106 | idescsi_pc_t *pc; /* Current packet command */ | |
107 | unsigned long flags; /* Status/Action flags */ | |
108 | unsigned long transform; /* SCSI cmd translation layer */ | |
109 | unsigned long log; /* log flags */ | |
110 | } idescsi_scsi_t; | |
111 | ||
112 | static DECLARE_MUTEX(idescsi_ref_sem); | |
113 | ||
114 | #define ide_scsi_g(disk) \ | |
115 | container_of((disk)->private_data, struct ide_scsi_obj, driver) | |
116 | ||
117 | static struct ide_scsi_obj *ide_scsi_get(struct gendisk *disk) | |
118 | { | |
119 | struct ide_scsi_obj *scsi = NULL; | |
120 | ||
121 | down(&idescsi_ref_sem); | |
122 | scsi = ide_scsi_g(disk); | |
123 | if (scsi) | |
124 | scsi_host_get(scsi->host); | |
125 | up(&idescsi_ref_sem); | |
126 | return scsi; | |
127 | } | |
128 | ||
129 | static void ide_scsi_put(struct ide_scsi_obj *scsi) | |
130 | { | |
131 | down(&idescsi_ref_sem); | |
132 | scsi_host_put(scsi->host); | |
133 | up(&idescsi_ref_sem); | |
134 | } | |
135 | ||
136 | static inline idescsi_scsi_t *scsihost_to_idescsi(struct Scsi_Host *host) | |
137 | { | |
138 | return (idescsi_scsi_t*) (&host[1]); | |
139 | } | |
140 | ||
141 | static inline idescsi_scsi_t *drive_to_idescsi(ide_drive_t *ide_drive) | |
142 | { | |
143 | return scsihost_to_idescsi(ide_drive->driver_data); | |
144 | } | |
145 | ||
146 | /* | |
147 | * Per ATAPI device status bits. | |
148 | */ | |
149 | #define IDESCSI_DRQ_INTERRUPT 0 /* DRQ interrupt device */ | |
150 | ||
151 | /* | |
152 | * ide-scsi requests. | |
153 | */ | |
154 | #define IDESCSI_PC_RQ 90 | |
155 | ||
156 | static void idescsi_discard_data (ide_drive_t *drive, unsigned int bcount) | |
157 | { | |
158 | while (bcount--) | |
159 | (void) HWIF(drive)->INB(IDE_DATA_REG); | |
160 | } | |
161 | ||
162 | static void idescsi_output_zeros (ide_drive_t *drive, unsigned int bcount) | |
163 | { | |
164 | while (bcount--) | |
165 | HWIF(drive)->OUTB(0, IDE_DATA_REG); | |
166 | } | |
167 | ||
168 | /* | |
169 | * PIO data transfer routines using the scatter gather table. | |
170 | */ | |
171 | static void idescsi_input_buffers (ide_drive_t *drive, idescsi_pc_t *pc, unsigned int bcount) | |
172 | { | |
173 | int count; | |
174 | char *buf; | |
175 | ||
176 | while (bcount) { | |
177 | if (pc->sg - (struct scatterlist *) pc->scsi_cmd->request_buffer > pc->scsi_cmd->use_sg) { | |
178 | printk (KERN_ERR "ide-scsi: scatter gather table too small, discarding data\n"); | |
179 | idescsi_discard_data (drive, bcount); | |
180 | return; | |
181 | } | |
182 | count = min(pc->sg->length - pc->b_count, bcount); | |
a717f773 AM |
183 | if (PageHighMem(pc->sg->page)) { |
184 | unsigned long flags; | |
185 | ||
186 | local_irq_save(flags); | |
187 | buf = kmap_atomic(pc->sg->page, KM_IRQ0) + | |
188 | pc->sg->offset; | |
189 | drive->hwif->atapi_input_bytes(drive, | |
190 | buf + pc->b_count, count); | |
191 | kunmap_atomic(buf - pc->sg->offset, KM_IRQ0); | |
192 | local_irq_restore(flags); | |
193 | } else { | |
194 | buf = page_address(pc->sg->page) + pc->sg->offset; | |
195 | drive->hwif->atapi_input_bytes(drive, | |
196 | buf + pc->b_count, count); | |
197 | } | |
198 | bcount -= count; pc->b_count += count; | |
1da177e4 LT |
199 | if (pc->b_count == pc->sg->length) { |
200 | pc->sg++; | |
201 | pc->b_count = 0; | |
202 | } | |
203 | } | |
204 | } | |
205 | ||
206 | static void idescsi_output_buffers (ide_drive_t *drive, idescsi_pc_t *pc, unsigned int bcount) | |
207 | { | |
208 | int count; | |
209 | char *buf; | |
210 | ||
211 | while (bcount) { | |
212 | if (pc->sg - (struct scatterlist *) pc->scsi_cmd->request_buffer > pc->scsi_cmd->use_sg) { | |
213 | printk (KERN_ERR "ide-scsi: scatter gather table too small, padding with zeros\n"); | |
214 | idescsi_output_zeros (drive, bcount); | |
215 | return; | |
216 | } | |
217 | count = min(pc->sg->length - pc->b_count, bcount); | |
a717f773 AM |
218 | if (PageHighMem(pc->sg->page)) { |
219 | unsigned long flags; | |
220 | ||
221 | local_irq_save(flags); | |
222 | buf = kmap_atomic(pc->sg->page, KM_IRQ0) + | |
223 | pc->sg->offset; | |
224 | drive->hwif->atapi_output_bytes(drive, | |
225 | buf + pc->b_count, count); | |
226 | kunmap_atomic(buf - pc->sg->offset, KM_IRQ0); | |
227 | local_irq_restore(flags); | |
228 | } else { | |
229 | buf = page_address(pc->sg->page) + pc->sg->offset; | |
230 | drive->hwif->atapi_output_bytes(drive, | |
231 | buf + pc->b_count, count); | |
232 | } | |
233 | bcount -= count; pc->b_count += count; | |
1da177e4 LT |
234 | if (pc->b_count == pc->sg->length) { |
235 | pc->sg++; | |
236 | pc->b_count = 0; | |
237 | } | |
238 | } | |
239 | } | |
240 | ||
241 | /* | |
242 | * Most of the SCSI commands are supported directly by ATAPI devices. | |
243 | * idescsi_transform_pc handles the few exceptions. | |
244 | */ | |
245 | static inline void idescsi_transform_pc1 (ide_drive_t *drive, idescsi_pc_t *pc) | |
246 | { | |
247 | u8 *c = pc->c, *scsi_buf = pc->buffer, *sc = pc->scsi_cmd->cmnd; | |
248 | char *atapi_buf; | |
249 | ||
250 | if (!test_bit(PC_TRANSFORM, &pc->flags)) | |
251 | return; | |
252 | if (drive->media == ide_cdrom || drive->media == ide_optical) { | |
253 | if (c[0] == READ_6 || c[0] == WRITE_6) { | |
254 | c[8] = c[4]; c[5] = c[3]; c[4] = c[2]; | |
255 | c[3] = c[1] & 0x1f; c[2] = 0; c[1] &= 0xe0; | |
256 | c[0] += (READ_10 - READ_6); | |
257 | } | |
258 | if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) { | |
259 | unsigned short new_len; | |
260 | if (!scsi_buf) | |
261 | return; | |
262 | if ((atapi_buf = kmalloc(pc->buffer_size + 4, GFP_ATOMIC)) == NULL) | |
263 | return; | |
264 | memset(atapi_buf, 0, pc->buffer_size + 4); | |
265 | memset (c, 0, 12); | |
266 | c[0] = sc[0] | 0x40; | |
267 | c[1] = sc[1]; | |
268 | c[2] = sc[2]; | |
269 | new_len = sc[4] + 4; | |
270 | c[8] = new_len; | |
271 | c[7] = new_len >> 8; | |
272 | c[9] = sc[5]; | |
273 | if (c[0] == MODE_SELECT_10) { | |
274 | atapi_buf[1] = scsi_buf[0]; /* Mode data length */ | |
275 | atapi_buf[2] = scsi_buf[1]; /* Medium type */ | |
276 | atapi_buf[3] = scsi_buf[2]; /* Device specific parameter */ | |
277 | atapi_buf[7] = scsi_buf[3]; /* Block descriptor length */ | |
278 | memcpy(atapi_buf + 8, scsi_buf + 4, pc->buffer_size - 4); | |
279 | } | |
280 | pc->buffer = atapi_buf; | |
281 | pc->request_transfer += 4; | |
282 | pc->buffer_size += 4; | |
283 | } | |
284 | } | |
285 | } | |
286 | ||
287 | static inline void idescsi_transform_pc2 (ide_drive_t *drive, idescsi_pc_t *pc) | |
288 | { | |
289 | u8 *atapi_buf = pc->buffer; | |
290 | u8 *sc = pc->scsi_cmd->cmnd; | |
291 | u8 *scsi_buf = pc->scsi_cmd->request_buffer; | |
292 | ||
293 | if (!test_bit(PC_TRANSFORM, &pc->flags)) | |
294 | return; | |
295 | if (drive->media == ide_cdrom || drive->media == ide_optical) { | |
296 | if (pc->c[0] == MODE_SENSE_10 && sc[0] == MODE_SENSE) { | |
297 | scsi_buf[0] = atapi_buf[1]; /* Mode data length */ | |
298 | scsi_buf[1] = atapi_buf[2]; /* Medium type */ | |
299 | scsi_buf[2] = atapi_buf[3]; /* Device specific parameter */ | |
300 | scsi_buf[3] = atapi_buf[7]; /* Block descriptor length */ | |
301 | memcpy(scsi_buf + 4, atapi_buf + 8, pc->request_transfer - 8); | |
302 | } | |
303 | if (pc->c[0] == INQUIRY) { | |
304 | scsi_buf[2] |= 2; /* ansi_revision */ | |
305 | scsi_buf[3] = (scsi_buf[3] & 0xf0) | 2; /* response data format */ | |
306 | } | |
307 | } | |
308 | if (atapi_buf && atapi_buf != scsi_buf) | |
309 | kfree(atapi_buf); | |
310 | } | |
311 | ||
312 | static void hexdump(u8 *x, int len) | |
313 | { | |
314 | int i; | |
315 | ||
316 | printk("[ "); | |
317 | for (i = 0; i < len; i++) | |
318 | printk("%x ", x[i]); | |
319 | printk("]\n"); | |
320 | } | |
321 | ||
322 | static int idescsi_check_condition(ide_drive_t *drive, struct request *failed_command) | |
323 | { | |
324 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
325 | idescsi_pc_t *pc; | |
326 | struct request *rq; | |
327 | u8 *buf; | |
328 | ||
329 | /* stuff a sense request in front of our current request */ | |
330 | pc = kmalloc (sizeof (idescsi_pc_t), GFP_ATOMIC); | |
331 | rq = kmalloc (sizeof (struct request), GFP_ATOMIC); | |
332 | buf = kmalloc(SCSI_SENSE_BUFFERSIZE, GFP_ATOMIC); | |
333 | if (pc == NULL || rq == NULL || buf == NULL) { | |
c9475cb0 JJ |
334 | kfree(buf); |
335 | kfree(rq); | |
336 | kfree(pc); | |
1da177e4 LT |
337 | return -ENOMEM; |
338 | } | |
339 | memset (pc, 0, sizeof (idescsi_pc_t)); | |
340 | memset (buf, 0, SCSI_SENSE_BUFFERSIZE); | |
341 | ide_init_drive_cmd(rq); | |
342 | rq->special = (char *) pc; | |
343 | pc->rq = rq; | |
344 | pc->buffer = buf; | |
345 | pc->c[0] = REQUEST_SENSE; | |
346 | pc->c[4] = pc->request_transfer = pc->buffer_size = SCSI_SENSE_BUFFERSIZE; | |
347 | rq->flags = REQ_SENSE; | |
348 | pc->timeout = jiffies + WAIT_READY; | |
349 | /* NOTE! Save the failed packet command in "rq->buffer" */ | |
350 | rq->buffer = (void *) failed_command->special; | |
351 | pc->scsi_cmd = ((idescsi_pc_t *) failed_command->special)->scsi_cmd; | |
352 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) { | |
353 | printk ("ide-scsi: %s: queue cmd = ", drive->name); | |
354 | hexdump(pc->c, 6); | |
355 | } | |
356 | rq->rq_disk = scsi->disk; | |
357 | return ide_do_drive_cmd(drive, rq, ide_preempt); | |
358 | } | |
359 | ||
360 | static int idescsi_end_request(ide_drive_t *, int, int); | |
361 | ||
362 | static ide_startstop_t | |
363 | idescsi_atapi_error(ide_drive_t *drive, struct request *rq, u8 stat, u8 err) | |
364 | { | |
365 | if (HWIF(drive)->INB(IDE_STATUS_REG) & (BUSY_STAT|DRQ_STAT)) | |
366 | /* force an abort */ | |
367 | HWIF(drive)->OUTB(WIN_IDLEIMMEDIATE,IDE_COMMAND_REG); | |
368 | ||
369 | rq->errors++; | |
370 | ||
371 | idescsi_end_request(drive, 0, 0); | |
372 | ||
373 | return ide_stopped; | |
374 | } | |
375 | ||
376 | static ide_startstop_t | |
377 | idescsi_atapi_abort(ide_drive_t *drive, struct request *rq) | |
378 | { | |
379 | #if IDESCSI_DEBUG_LOG | |
380 | printk(KERN_WARNING "idescsi_atapi_abort called for %lu\n", | |
381 | ((idescsi_pc_t *) rq->special)->scsi_cmd->serial_number); | |
382 | #endif | |
383 | rq->errors |= ERROR_MAX; | |
384 | ||
385 | idescsi_end_request(drive, 0, 0); | |
386 | ||
387 | return ide_stopped; | |
388 | } | |
389 | ||
390 | static int idescsi_end_request (ide_drive_t *drive, int uptodate, int nrsecs) | |
391 | { | |
392 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
393 | struct request *rq = HWGROUP(drive)->rq; | |
394 | idescsi_pc_t *pc = (idescsi_pc_t *) rq->special; | |
395 | int log = test_bit(IDESCSI_LOG_CMD, &scsi->log); | |
396 | struct Scsi_Host *host; | |
397 | u8 *scsi_buf; | |
32565347 | 398 | int errors = rq->errors; |
1da177e4 LT |
399 | unsigned long flags; |
400 | ||
401 | if (!(rq->flags & (REQ_SPECIAL|REQ_SENSE))) { | |
402 | ide_end_request(drive, uptodate, nrsecs); | |
403 | return 0; | |
404 | } | |
405 | ide_end_drive_cmd (drive, 0, 0); | |
406 | if (rq->flags & REQ_SENSE) { | |
407 | idescsi_pc_t *opc = (idescsi_pc_t *) rq->buffer; | |
408 | if (log) { | |
409 | printk ("ide-scsi: %s: wrap up check %lu, rst = ", drive->name, opc->scsi_cmd->serial_number); | |
410 | hexdump(pc->buffer,16); | |
411 | } | |
412 | memcpy((void *) opc->scsi_cmd->sense_buffer, pc->buffer, SCSI_SENSE_BUFFERSIZE); | |
413 | kfree(pc->buffer); | |
414 | kfree(pc); | |
415 | kfree(rq); | |
416 | pc = opc; | |
417 | rq = pc->rq; | |
418 | pc->scsi_cmd->result = (CHECK_CONDITION << 1) | | |
419 | ((test_bit(PC_TIMEDOUT, &pc->flags)?DID_TIME_OUT:DID_OK) << 16); | |
420 | } else if (test_bit(PC_TIMEDOUT, &pc->flags)) { | |
421 | if (log) | |
422 | printk (KERN_WARNING "ide-scsi: %s: timed out for %lu\n", | |
423 | drive->name, pc->scsi_cmd->serial_number); | |
424 | pc->scsi_cmd->result = DID_TIME_OUT << 16; | |
32565347 | 425 | } else if (errors >= ERROR_MAX) { |
1da177e4 LT |
426 | pc->scsi_cmd->result = DID_ERROR << 16; |
427 | if (log) | |
428 | printk ("ide-scsi: %s: I/O error for %lu\n", drive->name, pc->scsi_cmd->serial_number); | |
32565347 | 429 | } else if (errors) { |
1da177e4 LT |
430 | if (log) |
431 | printk ("ide-scsi: %s: check condition for %lu\n", drive->name, pc->scsi_cmd->serial_number); | |
432 | if (!idescsi_check_condition(drive, rq)) | |
433 | /* we started a request sense, so we'll be back, exit for now */ | |
434 | return 0; | |
435 | pc->scsi_cmd->result = (CHECK_CONDITION << 1) | (DID_OK << 16); | |
436 | } else { | |
437 | pc->scsi_cmd->result = DID_OK << 16; | |
438 | idescsi_transform_pc2 (drive, pc); | |
439 | if (log) { | |
440 | printk ("ide-scsi: %s: suc %lu", drive->name, pc->scsi_cmd->serial_number); | |
441 | if (!test_bit(PC_WRITING, &pc->flags) && pc->actually_transferred && pc->actually_transferred <= 1024 && pc->buffer) { | |
442 | printk(", rst = "); | |
443 | scsi_buf = pc->scsi_cmd->request_buffer; | |
444 | hexdump(scsi_buf, min_t(unsigned, 16, pc->scsi_cmd->request_bufflen)); | |
445 | } else printk("\n"); | |
446 | } | |
447 | } | |
448 | host = pc->scsi_cmd->device->host; | |
449 | spin_lock_irqsave(host->host_lock, flags); | |
450 | pc->done(pc->scsi_cmd); | |
451 | spin_unlock_irqrestore(host->host_lock, flags); | |
452 | kfree(pc); | |
453 | kfree(rq); | |
454 | scsi->pc = NULL; | |
455 | return 0; | |
456 | } | |
457 | ||
458 | static inline unsigned long get_timeout(idescsi_pc_t *pc) | |
459 | { | |
460 | return max_t(unsigned long, WAIT_CMD, pc->timeout - jiffies); | |
461 | } | |
462 | ||
463 | static int idescsi_expiry(ide_drive_t *drive) | |
464 | { | |
465 | idescsi_scsi_t *scsi = drive->driver_data; | |
466 | idescsi_pc_t *pc = scsi->pc; | |
467 | ||
468 | #if IDESCSI_DEBUG_LOG | |
469 | printk(KERN_WARNING "idescsi_expiry called for %lu at %lu\n", pc->scsi_cmd->serial_number, jiffies); | |
470 | #endif | |
471 | set_bit(PC_TIMEDOUT, &pc->flags); | |
472 | ||
473 | return 0; /* we do not want the ide subsystem to retry */ | |
474 | } | |
475 | ||
476 | /* | |
477 | * Our interrupt handler. | |
478 | */ | |
479 | static ide_startstop_t idescsi_pc_intr (ide_drive_t *drive) | |
480 | { | |
481 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
482 | idescsi_pc_t *pc=scsi->pc; | |
483 | struct request *rq = pc->rq; | |
484 | atapi_bcount_t bcount; | |
485 | atapi_status_t status; | |
486 | atapi_ireason_t ireason; | |
487 | atapi_feature_t feature; | |
488 | ||
489 | unsigned int temp; | |
490 | ||
491 | #if IDESCSI_DEBUG_LOG | |
492 | printk (KERN_INFO "ide-scsi: Reached idescsi_pc_intr interrupt handler\n"); | |
493 | #endif /* IDESCSI_DEBUG_LOG */ | |
494 | ||
495 | if (test_bit(PC_TIMEDOUT, &pc->flags)){ | |
496 | #if IDESCSI_DEBUG_LOG | |
497 | printk(KERN_WARNING "idescsi_pc_intr: got timed out packet %lu at %lu\n", | |
498 | pc->scsi_cmd->serial_number, jiffies); | |
499 | #endif | |
500 | /* end this request now - scsi should retry it*/ | |
501 | idescsi_end_request (drive, 1, 0); | |
502 | return ide_stopped; | |
503 | } | |
504 | if (test_and_clear_bit (PC_DMA_IN_PROGRESS, &pc->flags)) { | |
505 | #if IDESCSI_DEBUG_LOG | |
506 | printk ("ide-scsi: %s: DMA complete\n", drive->name); | |
507 | #endif /* IDESCSI_DEBUG_LOG */ | |
508 | pc->actually_transferred=pc->request_transfer; | |
509 | (void) HWIF(drive)->ide_dma_end(drive); | |
510 | } | |
511 | ||
512 | feature.all = 0; | |
513 | /* Clear the interrupt */ | |
514 | status.all = HWIF(drive)->INB(IDE_STATUS_REG); | |
515 | ||
516 | if (!status.b.drq) { | |
517 | /* No more interrupts */ | |
518 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) | |
519 | printk (KERN_INFO "Packet command completed, %d bytes transferred\n", pc->actually_transferred); | |
520 | local_irq_enable(); | |
521 | if (status.b.check) | |
522 | rq->errors++; | |
523 | idescsi_end_request (drive, 1, 0); | |
524 | return ide_stopped; | |
525 | } | |
526 | bcount.b.low = HWIF(drive)->INB(IDE_BCOUNTL_REG); | |
527 | bcount.b.high = HWIF(drive)->INB(IDE_BCOUNTH_REG); | |
528 | ireason.all = HWIF(drive)->INB(IDE_IREASON_REG); | |
529 | ||
530 | if (ireason.b.cod) { | |
531 | printk(KERN_ERR "ide-scsi: CoD != 0 in idescsi_pc_intr\n"); | |
532 | return ide_do_reset (drive); | |
533 | } | |
534 | if (ireason.b.io) { | |
535 | temp = pc->actually_transferred + bcount.all; | |
536 | if (temp > pc->request_transfer) { | |
537 | if (temp > pc->buffer_size) { | |
538 | printk(KERN_ERR "ide-scsi: The scsi wants to " | |
539 | "send us more data than expected " | |
540 | "- discarding data\n"); | |
541 | temp = pc->buffer_size - pc->actually_transferred; | |
542 | if (temp) { | |
543 | clear_bit(PC_WRITING, &pc->flags); | |
544 | if (pc->sg) | |
545 | idescsi_input_buffers(drive, pc, temp); | |
546 | else | |
547 | drive->hwif->atapi_input_bytes(drive, pc->current_position, temp); | |
548 | printk(KERN_ERR "ide-scsi: transferred %d of %d bytes\n", temp, bcount.all); | |
549 | } | |
550 | pc->actually_transferred += temp; | |
551 | pc->current_position += temp; | |
552 | idescsi_discard_data(drive, bcount.all - temp); | |
553 | ide_set_handler(drive, &idescsi_pc_intr, get_timeout(pc), idescsi_expiry); | |
554 | return ide_started; | |
555 | } | |
556 | #if IDESCSI_DEBUG_LOG | |
557 | printk (KERN_NOTICE "ide-scsi: The scsi wants to send us more data than expected - allowing transfer\n"); | |
558 | #endif /* IDESCSI_DEBUG_LOG */ | |
559 | } | |
560 | } | |
561 | if (ireason.b.io) { | |
562 | clear_bit(PC_WRITING, &pc->flags); | |
563 | if (pc->sg) | |
564 | idescsi_input_buffers(drive, pc, bcount.all); | |
565 | else | |
566 | HWIF(drive)->atapi_input_bytes(drive, pc->current_position, bcount.all); | |
567 | } else { | |
568 | set_bit(PC_WRITING, &pc->flags); | |
569 | if (pc->sg) | |
570 | idescsi_output_buffers (drive, pc, bcount.all); | |
571 | else | |
572 | HWIF(drive)->atapi_output_bytes(drive, pc->current_position, bcount.all); | |
573 | } | |
574 | /* Update the current position */ | |
575 | pc->actually_transferred += bcount.all; | |
576 | pc->current_position += bcount.all; | |
577 | ||
578 | /* And set the interrupt handler again */ | |
579 | ide_set_handler(drive, &idescsi_pc_intr, get_timeout(pc), idescsi_expiry); | |
580 | return ide_started; | |
581 | } | |
582 | ||
583 | static ide_startstop_t idescsi_transfer_pc(ide_drive_t *drive) | |
584 | { | |
585 | ide_hwif_t *hwif = drive->hwif; | |
586 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
587 | idescsi_pc_t *pc = scsi->pc; | |
588 | atapi_ireason_t ireason; | |
589 | ide_startstop_t startstop; | |
590 | ||
591 | if (ide_wait_stat(&startstop,drive,DRQ_STAT,BUSY_STAT,WAIT_READY)) { | |
592 | printk(KERN_ERR "ide-scsi: Strange, packet command " | |
593 | "initiated yet DRQ isn't asserted\n"); | |
594 | return startstop; | |
595 | } | |
596 | ireason.all = HWIF(drive)->INB(IDE_IREASON_REG); | |
597 | if (!ireason.b.cod || ireason.b.io) { | |
598 | printk(KERN_ERR "ide-scsi: (IO,CoD) != (0,1) while " | |
599 | "issuing a packet command\n"); | |
600 | return ide_do_reset (drive); | |
601 | } | |
602 | if (HWGROUP(drive)->handler != NULL) | |
603 | BUG(); | |
604 | /* Set the interrupt routine */ | |
605 | ide_set_handler(drive, &idescsi_pc_intr, get_timeout(pc), idescsi_expiry); | |
606 | /* Send the actual packet */ | |
607 | drive->hwif->atapi_output_bytes(drive, scsi->pc->c, 12); | |
608 | if (test_bit (PC_DMA_OK, &pc->flags)) { | |
609 | set_bit (PC_DMA_IN_PROGRESS, &pc->flags); | |
610 | hwif->dma_start(drive); | |
611 | } | |
612 | return ide_started; | |
613 | } | |
614 | ||
615 | static inline int idescsi_set_direction(idescsi_pc_t *pc) | |
616 | { | |
617 | switch (pc->c[0]) { | |
618 | case READ_6: case READ_10: case READ_12: | |
619 | clear_bit(PC_WRITING, &pc->flags); | |
620 | return 0; | |
621 | case WRITE_6: case WRITE_10: case WRITE_12: | |
622 | set_bit(PC_WRITING, &pc->flags); | |
623 | return 0; | |
624 | default: | |
625 | return 1; | |
626 | } | |
627 | } | |
628 | ||
629 | static int idescsi_map_sg(ide_drive_t *drive, idescsi_pc_t *pc) | |
630 | { | |
631 | ide_hwif_t *hwif = drive->hwif; | |
632 | struct scatterlist *sg, *scsi_sg; | |
633 | int segments; | |
634 | ||
635 | if (!pc->request_transfer || pc->request_transfer % 1024) | |
636 | return 1; | |
637 | ||
638 | if (idescsi_set_direction(pc)) | |
639 | return 1; | |
640 | ||
641 | sg = hwif->sg_table; | |
642 | scsi_sg = pc->scsi_cmd->request_buffer; | |
643 | segments = pc->scsi_cmd->use_sg; | |
644 | ||
645 | if (segments > hwif->sg_max_nents) | |
646 | return 1; | |
647 | ||
648 | if (!segments) { | |
649 | hwif->sg_nents = 1; | |
650 | sg_init_one(sg, pc->scsi_cmd->request_buffer, pc->request_transfer); | |
651 | } else { | |
652 | hwif->sg_nents = segments; | |
653 | memcpy(sg, scsi_sg, sizeof(*sg) * segments); | |
654 | } | |
655 | ||
656 | return 0; | |
657 | } | |
658 | ||
659 | /* | |
660 | * Issue a packet command | |
661 | */ | |
662 | static ide_startstop_t idescsi_issue_pc (ide_drive_t *drive, idescsi_pc_t *pc) | |
663 | { | |
664 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
665 | ide_hwif_t *hwif = drive->hwif; | |
666 | atapi_feature_t feature; | |
667 | atapi_bcount_t bcount; | |
668 | ||
669 | scsi->pc=pc; /* Set the current packet command */ | |
670 | pc->actually_transferred=0; /* We haven't transferred any data yet */ | |
671 | pc->current_position=pc->buffer; | |
672 | bcount.all = min(pc->request_transfer, 63 * 1024); /* Request to transfer the entire buffer at once */ | |
673 | ||
674 | feature.all = 0; | |
675 | if (drive->using_dma && !idescsi_map_sg(drive, pc)) { | |
676 | hwif->sg_mapped = 1; | |
677 | feature.b.dma = !hwif->dma_setup(drive); | |
678 | hwif->sg_mapped = 0; | |
679 | } | |
680 | ||
681 | SELECT_DRIVE(drive); | |
682 | if (IDE_CONTROL_REG) | |
683 | HWIF(drive)->OUTB(drive->ctl, IDE_CONTROL_REG); | |
684 | ||
685 | HWIF(drive)->OUTB(feature.all, IDE_FEATURE_REG); | |
686 | HWIF(drive)->OUTB(bcount.b.high, IDE_BCOUNTH_REG); | |
687 | HWIF(drive)->OUTB(bcount.b.low, IDE_BCOUNTL_REG); | |
688 | ||
689 | if (feature.b.dma) | |
690 | set_bit(PC_DMA_OK, &pc->flags); | |
691 | ||
692 | if (test_bit(IDESCSI_DRQ_INTERRUPT, &scsi->flags)) { | |
693 | if (HWGROUP(drive)->handler != NULL) | |
694 | BUG(); | |
695 | ide_set_handler(drive, &idescsi_transfer_pc, | |
696 | get_timeout(pc), idescsi_expiry); | |
697 | /* Issue the packet command */ | |
698 | HWIF(drive)->OUTB(WIN_PACKETCMD, IDE_COMMAND_REG); | |
699 | return ide_started; | |
700 | } else { | |
701 | /* Issue the packet command */ | |
702 | HWIF(drive)->OUTB(WIN_PACKETCMD, IDE_COMMAND_REG); | |
703 | return idescsi_transfer_pc(drive); | |
704 | } | |
705 | } | |
706 | ||
707 | /* | |
708 | * idescsi_do_request is our request handling function. | |
709 | */ | |
710 | static ide_startstop_t idescsi_do_request (ide_drive_t *drive, struct request *rq, sector_t block) | |
711 | { | |
712 | #if IDESCSI_DEBUG_LOG | |
713 | printk (KERN_INFO "rq_status: %d, dev: %s, cmd: %x, errors: %d\n",rq->rq_status, rq->rq_disk->disk_name,rq->cmd[0],rq->errors); | |
714 | printk (KERN_INFO "sector: %ld, nr_sectors: %ld, current_nr_sectors: %d\n",rq->sector,rq->nr_sectors,rq->current_nr_sectors); | |
715 | #endif /* IDESCSI_DEBUG_LOG */ | |
716 | ||
717 | if (rq->flags & (REQ_SPECIAL|REQ_SENSE)) { | |
718 | return idescsi_issue_pc (drive, (idescsi_pc_t *) rq->special); | |
719 | } | |
720 | blk_dump_rq_flags(rq, "ide-scsi: unsup command"); | |
721 | idescsi_end_request (drive, 0, 0); | |
722 | return ide_stopped; | |
723 | } | |
724 | ||
725 | static void idescsi_add_settings(ide_drive_t *drive) | |
726 | { | |
727 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
728 | ||
729 | /* | |
730 | * drive setting name read/write ioctl ioctl data type min max mul_factor div_factor data pointer set function | |
731 | */ | |
732 | ide_add_setting(drive, "bios_cyl", SETTING_RW, -1, -1, TYPE_INT, 0, 1023, 1, 1, &drive->bios_cyl, NULL); | |
733 | ide_add_setting(drive, "bios_head", SETTING_RW, -1, -1, TYPE_BYTE, 0, 255, 1, 1, &drive->bios_head, NULL); | |
734 | ide_add_setting(drive, "bios_sect", SETTING_RW, -1, -1, TYPE_BYTE, 0, 63, 1, 1, &drive->bios_sect, NULL); | |
735 | ide_add_setting(drive, "transform", SETTING_RW, -1, -1, TYPE_INT, 0, 3, 1, 1, &scsi->transform, NULL); | |
736 | ide_add_setting(drive, "log", SETTING_RW, -1, -1, TYPE_INT, 0, 1, 1, 1, &scsi->log, NULL); | |
737 | } | |
738 | ||
739 | /* | |
740 | * Driver initialization. | |
741 | */ | |
742 | static void idescsi_setup (ide_drive_t *drive, idescsi_scsi_t *scsi) | |
743 | { | |
1da177e4 LT |
744 | if (drive->id && (drive->id->config & 0x0060) == 0x20) |
745 | set_bit (IDESCSI_DRQ_INTERRUPT, &scsi->flags); | |
746 | set_bit(IDESCSI_TRANSFORM, &scsi->transform); | |
747 | clear_bit(IDESCSI_SG_TRANSFORM, &scsi->transform); | |
748 | #if IDESCSI_DEBUG_LOG | |
749 | set_bit(IDESCSI_LOG_CMD, &scsi->log); | |
750 | #endif /* IDESCSI_DEBUG_LOG */ | |
751 | idescsi_add_settings(drive); | |
1da177e4 LT |
752 | } |
753 | ||
8604affd | 754 | static int ide_scsi_remove(struct device *dev) |
1da177e4 | 755 | { |
8604affd | 756 | ide_drive_t *drive = to_ide_device(dev); |
1da177e4 LT |
757 | struct Scsi_Host *scsihost = drive->driver_data; |
758 | struct ide_scsi_obj *scsi = scsihost_to_idescsi(scsihost); | |
759 | struct gendisk *g = scsi->disk; | |
760 | ||
8604affd | 761 | ide_unregister_subdriver(drive, scsi->driver); |
1da177e4 LT |
762 | |
763 | ide_unregister_region(g); | |
764 | ||
765 | drive->driver_data = NULL; | |
766 | g->private_data = NULL; | |
767 | put_disk(g); | |
768 | ||
769 | scsi_remove_host(scsihost); | |
770 | ide_scsi_put(scsi); | |
771 | ||
772 | return 0; | |
773 | } | |
774 | ||
8604affd | 775 | static int ide_scsi_probe(struct device *); |
1da177e4 LT |
776 | |
777 | #ifdef CONFIG_PROC_FS | |
778 | static ide_proc_entry_t idescsi_proc[] = { | |
779 | { "capacity", S_IFREG|S_IRUGO, proc_ide_read_capacity, NULL }, | |
780 | { NULL, 0, NULL, NULL } | |
781 | }; | |
782 | #else | |
783 | # define idescsi_proc NULL | |
784 | #endif | |
785 | ||
1da177e4 LT |
786 | static ide_driver_t idescsi_driver = { |
787 | .owner = THIS_MODULE, | |
8604affd BZ |
788 | .gen_driver = { |
789 | .name = "ide-scsi", | |
790 | .bus = &ide_bus_type, | |
791 | .probe = ide_scsi_probe, | |
792 | .remove = ide_scsi_remove, | |
793 | }, | |
1da177e4 LT |
794 | .version = IDESCSI_VERSION, |
795 | .media = ide_scsi, | |
1da177e4 LT |
796 | .supports_dsc_overlap = 0, |
797 | .proc = idescsi_proc, | |
1da177e4 LT |
798 | .do_request = idescsi_do_request, |
799 | .end_request = idescsi_end_request, | |
800 | .error = idescsi_atapi_error, | |
801 | .abort = idescsi_atapi_abort, | |
1da177e4 LT |
802 | }; |
803 | ||
804 | static int idescsi_ide_open(struct inode *inode, struct file *filp) | |
805 | { | |
806 | struct gendisk *disk = inode->i_bdev->bd_disk; | |
807 | struct ide_scsi_obj *scsi; | |
808 | ide_drive_t *drive; | |
809 | ||
810 | if (!(scsi = ide_scsi_get(disk))) | |
811 | return -ENXIO; | |
812 | ||
813 | drive = scsi->drive; | |
814 | ||
815 | drive->usage++; | |
816 | ||
817 | return 0; | |
818 | } | |
819 | ||
820 | static int idescsi_ide_release(struct inode *inode, struct file *filp) | |
821 | { | |
822 | struct gendisk *disk = inode->i_bdev->bd_disk; | |
823 | struct ide_scsi_obj *scsi = ide_scsi_g(disk); | |
824 | ide_drive_t *drive = scsi->drive; | |
825 | ||
826 | drive->usage--; | |
827 | ||
828 | ide_scsi_put(scsi); | |
829 | ||
830 | return 0; | |
831 | } | |
832 | ||
833 | static int idescsi_ide_ioctl(struct inode *inode, struct file *file, | |
834 | unsigned int cmd, unsigned long arg) | |
835 | { | |
836 | struct block_device *bdev = inode->i_bdev; | |
837 | struct ide_scsi_obj *scsi = ide_scsi_g(bdev->bd_disk); | |
838 | return generic_ide_ioctl(scsi->drive, file, bdev, cmd, arg); | |
839 | } | |
840 | ||
841 | static struct block_device_operations idescsi_ops = { | |
842 | .owner = THIS_MODULE, | |
843 | .open = idescsi_ide_open, | |
844 | .release = idescsi_ide_release, | |
845 | .ioctl = idescsi_ide_ioctl, | |
846 | }; | |
847 | ||
1da177e4 LT |
848 | static int idescsi_slave_configure(struct scsi_device * sdp) |
849 | { | |
850 | /* Configure detected device */ | |
851 | scsi_adjust_queue_depth(sdp, MSG_SIMPLE_TAG, sdp->host->cmd_per_lun); | |
852 | return 0; | |
853 | } | |
854 | ||
855 | static const char *idescsi_info (struct Scsi_Host *host) | |
856 | { | |
857 | return "SCSI host adapter emulation for IDE ATAPI devices"; | |
858 | } | |
859 | ||
860 | static int idescsi_ioctl (struct scsi_device *dev, int cmd, void __user *arg) | |
861 | { | |
862 | idescsi_scsi_t *scsi = scsihost_to_idescsi(dev->host); | |
863 | ||
864 | if (cmd == SG_SET_TRANSFORM) { | |
865 | if (arg) | |
866 | set_bit(IDESCSI_SG_TRANSFORM, &scsi->transform); | |
867 | else | |
868 | clear_bit(IDESCSI_SG_TRANSFORM, &scsi->transform); | |
869 | return 0; | |
870 | } else if (cmd == SG_GET_TRANSFORM) | |
871 | return put_user(test_bit(IDESCSI_SG_TRANSFORM, &scsi->transform), (int __user *) arg); | |
872 | return -EINVAL; | |
873 | } | |
874 | ||
875 | static inline int should_transform(ide_drive_t *drive, struct scsi_cmnd *cmd) | |
876 | { | |
877 | idescsi_scsi_t *scsi = drive_to_idescsi(drive); | |
878 | ||
879 | /* this was a layering violation and we can't support it | |
880 | anymore, sorry. */ | |
881 | #if 0 | |
882 | struct gendisk *disk = cmd->request->rq_disk; | |
883 | ||
884 | if (disk) { | |
f64a181d | 885 | struct struct scsi_device_Template **p = disk->private_data; |
1da177e4 LT |
886 | if (strcmp((*p)->scsi_driverfs_driver.name, "sg") == 0) |
887 | return test_bit(IDESCSI_SG_TRANSFORM, &scsi->transform); | |
888 | } | |
889 | #endif | |
890 | return test_bit(IDESCSI_TRANSFORM, &scsi->transform); | |
891 | } | |
892 | ||
893 | static int idescsi_queue (struct scsi_cmnd *cmd, | |
894 | void (*done)(struct scsi_cmnd *)) | |
895 | { | |
896 | struct Scsi_Host *host = cmd->device->host; | |
897 | idescsi_scsi_t *scsi = scsihost_to_idescsi(host); | |
898 | ide_drive_t *drive = scsi->drive; | |
899 | struct request *rq = NULL; | |
900 | idescsi_pc_t *pc = NULL; | |
901 | ||
902 | if (!drive) { | |
017560fc | 903 | scmd_printk (KERN_ERR, cmd, "drive not present\n"); |
1da177e4 LT |
904 | goto abort; |
905 | } | |
906 | scsi = drive_to_idescsi(drive); | |
907 | pc = kmalloc (sizeof (idescsi_pc_t), GFP_ATOMIC); | |
908 | rq = kmalloc (sizeof (struct request), GFP_ATOMIC); | |
909 | if (rq == NULL || pc == NULL) { | |
910 | printk (KERN_ERR "ide-scsi: %s: out of memory\n", drive->name); | |
911 | goto abort; | |
912 | } | |
913 | ||
914 | memset (pc->c, 0, 12); | |
915 | pc->flags = 0; | |
916 | pc->rq = rq; | |
917 | memcpy (pc->c, cmd->cmnd, cmd->cmd_len); | |
918 | if (cmd->use_sg) { | |
919 | pc->buffer = NULL; | |
920 | pc->sg = cmd->request_buffer; | |
921 | } else { | |
922 | pc->buffer = cmd->request_buffer; | |
923 | pc->sg = NULL; | |
924 | } | |
925 | pc->b_count = 0; | |
926 | pc->request_transfer = pc->buffer_size = cmd->request_bufflen; | |
927 | pc->scsi_cmd = cmd; | |
928 | pc->done = done; | |
929 | pc->timeout = jiffies + cmd->timeout_per_command; | |
930 | ||
931 | if (should_transform(drive, cmd)) | |
932 | set_bit(PC_TRANSFORM, &pc->flags); | |
933 | idescsi_transform_pc1 (drive, pc); | |
934 | ||
935 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) { | |
936 | printk ("ide-scsi: %s: que %lu, cmd = ", drive->name, cmd->serial_number); | |
937 | hexdump(cmd->cmnd, cmd->cmd_len); | |
938 | if (memcmp(pc->c, cmd->cmnd, cmd->cmd_len)) { | |
939 | printk ("ide-scsi: %s: que %lu, tsl = ", drive->name, cmd->serial_number); | |
940 | hexdump(pc->c, 12); | |
941 | } | |
942 | } | |
943 | ||
944 | ide_init_drive_cmd (rq); | |
945 | rq->special = (char *) pc; | |
946 | rq->flags = REQ_SPECIAL; | |
947 | spin_unlock_irq(host->host_lock); | |
948 | rq->rq_disk = scsi->disk; | |
949 | (void) ide_do_drive_cmd (drive, rq, ide_end); | |
950 | spin_lock_irq(host->host_lock); | |
951 | return 0; | |
952 | abort: | |
c9475cb0 JJ |
953 | kfree (pc); |
954 | kfree (rq); | |
1da177e4 LT |
955 | cmd->result = DID_ERROR << 16; |
956 | done(cmd); | |
957 | return 0; | |
958 | } | |
959 | ||
960 | static int idescsi_eh_abort (struct scsi_cmnd *cmd) | |
961 | { | |
962 | idescsi_scsi_t *scsi = scsihost_to_idescsi(cmd->device->host); | |
963 | ide_drive_t *drive = scsi->drive; | |
964 | int busy; | |
965 | int ret = FAILED; | |
966 | ||
967 | /* In idescsi_eh_abort we try to gently pry our command from the ide subsystem */ | |
968 | ||
969 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) | |
970 | printk (KERN_WARNING "ide-scsi: abort called for %lu\n", cmd->serial_number); | |
971 | ||
972 | if (!drive) { | |
973 | printk (KERN_WARNING "ide-scsi: Drive not set in idescsi_eh_abort\n"); | |
974 | WARN_ON(1); | |
975 | goto no_drive; | |
976 | } | |
977 | ||
978 | /* First give it some more time, how much is "right" is hard to say :-( */ | |
979 | ||
980 | busy = ide_wait_not_busy(HWIF(drive), 100); /* FIXME - uses mdelay which causes latency? */ | |
981 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) | |
982 | printk (KERN_WARNING "ide-scsi: drive did%s become ready\n", busy?" not":""); | |
983 | ||
984 | spin_lock_irq(&ide_lock); | |
985 | ||
986 | /* If there is no pc running we're done (our interrupt took care of it) */ | |
987 | if (!scsi->pc) { | |
988 | ret = SUCCESS; | |
989 | goto ide_unlock; | |
990 | } | |
991 | ||
992 | /* It's somewhere in flight. Does ide subsystem agree? */ | |
993 | if (scsi->pc->scsi_cmd->serial_number == cmd->serial_number && !busy && | |
994 | elv_queue_empty(drive->queue) && HWGROUP(drive)->rq != scsi->pc->rq) { | |
995 | /* | |
996 | * FIXME - not sure this condition can ever occur | |
997 | */ | |
998 | printk (KERN_ERR "ide-scsi: cmd aborted!\n"); | |
999 | ||
1000 | if (scsi->pc->rq->flags & REQ_SENSE) | |
1001 | kfree(scsi->pc->buffer); | |
1002 | kfree(scsi->pc->rq); | |
1003 | kfree(scsi->pc); | |
1004 | scsi->pc = NULL; | |
1005 | ||
1006 | ret = SUCCESS; | |
1007 | } | |
1008 | ||
1009 | ide_unlock: | |
1010 | spin_unlock_irq(&ide_lock); | |
1011 | no_drive: | |
1012 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) | |
1013 | printk (KERN_WARNING "ide-scsi: abort returns %s\n", ret == SUCCESS?"success":"failed"); | |
1014 | ||
1015 | return ret; | |
1016 | } | |
1017 | ||
1018 | static int idescsi_eh_reset (struct scsi_cmnd *cmd) | |
1019 | { | |
1020 | struct request *req; | |
1021 | idescsi_scsi_t *scsi = scsihost_to_idescsi(cmd->device->host); | |
1022 | ide_drive_t *drive = scsi->drive; | |
1023 | int ready = 0; | |
1024 | int ret = SUCCESS; | |
1025 | ||
1026 | /* In idescsi_eh_reset we forcefully remove the command from the ide subsystem and reset the device. */ | |
1027 | ||
1028 | if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) | |
1029 | printk (KERN_WARNING "ide-scsi: reset called for %lu\n", cmd->serial_number); | |
1030 | ||
1031 | if (!drive) { | |
1032 | printk (KERN_WARNING "ide-scsi: Drive not set in idescsi_eh_reset\n"); | |
1033 | WARN_ON(1); | |
1034 | return FAILED; | |
1035 | } | |
1036 | ||
df0ae249 JG |
1037 | spin_lock_irq(cmd->device->host->host_lock); |
1038 | spin_lock(&ide_lock); | |
1da177e4 LT |
1039 | |
1040 | if (!scsi->pc || (req = scsi->pc->rq) != HWGROUP(drive)->rq || !HWGROUP(drive)->handler) { | |
1041 | printk (KERN_WARNING "ide-scsi: No active request in idescsi_eh_reset\n"); | |
1042 | spin_unlock(&ide_lock); | |
df0ae249 | 1043 | spin_unlock_irq(cmd->device->host->host_lock); |
1da177e4 LT |
1044 | return FAILED; |
1045 | } | |
1046 | ||
1047 | /* kill current request */ | |
1048 | blkdev_dequeue_request(req); | |
1049 | end_that_request_last(req); | |
1050 | if (req->flags & REQ_SENSE) | |
1051 | kfree(scsi->pc->buffer); | |
1052 | kfree(scsi->pc); | |
1053 | scsi->pc = NULL; | |
1054 | kfree(req); | |
1055 | ||
1056 | /* now nuke the drive queue */ | |
1057 | while ((req = elv_next_request(drive->queue))) { | |
1058 | blkdev_dequeue_request(req); | |
1059 | end_that_request_last(req); | |
1060 | } | |
1061 | ||
1062 | HWGROUP(drive)->rq = NULL; | |
1063 | HWGROUP(drive)->handler = NULL; | |
1064 | HWGROUP(drive)->busy = 1; /* will set this to zero when ide reset finished */ | |
df0ae249 | 1065 | spin_unlock(&ide_lock); |
1da177e4 LT |
1066 | |
1067 | ide_do_reset(drive); | |
1068 | ||
1069 | /* ide_do_reset starts a polling handler which restarts itself every 50ms until the reset finishes */ | |
1070 | ||
1071 | do { | |
1da177e4 | 1072 | spin_unlock_irq(cmd->device->host->host_lock); |
df0ae249 | 1073 | msleep(50); |
1da177e4 LT |
1074 | spin_lock_irq(cmd->device->host->host_lock); |
1075 | } while ( HWGROUP(drive)->handler ); | |
1076 | ||
1077 | ready = drive_is_ready(drive); | |
1078 | HWGROUP(drive)->busy--; | |
1079 | if (!ready) { | |
1080 | printk (KERN_ERR "ide-scsi: reset failed!\n"); | |
1081 | ret = FAILED; | |
1082 | } | |
1083 | ||
df0ae249 | 1084 | spin_unlock_irq(cmd->device->host->host_lock); |
1da177e4 LT |
1085 | return ret; |
1086 | } | |
1087 | ||
1088 | static int idescsi_bios(struct scsi_device *sdev, struct block_device *bdev, | |
1089 | sector_t capacity, int *parm) | |
1090 | { | |
1091 | idescsi_scsi_t *idescsi = scsihost_to_idescsi(sdev->host); | |
1092 | ide_drive_t *drive = idescsi->drive; | |
1093 | ||
1094 | if (drive->bios_cyl && drive->bios_head && drive->bios_sect) { | |
1095 | parm[0] = drive->bios_head; | |
1096 | parm[1] = drive->bios_sect; | |
1097 | parm[2] = drive->bios_cyl; | |
1098 | } | |
1099 | return 0; | |
1100 | } | |
1101 | ||
1102 | static struct scsi_host_template idescsi_template = { | |
1103 | .module = THIS_MODULE, | |
1104 | .name = "idescsi", | |
1105 | .info = idescsi_info, | |
1106 | .slave_configure = idescsi_slave_configure, | |
1107 | .ioctl = idescsi_ioctl, | |
1108 | .queuecommand = idescsi_queue, | |
1109 | .eh_abort_handler = idescsi_eh_abort, | |
1110 | .eh_host_reset_handler = idescsi_eh_reset, | |
1111 | .bios_param = idescsi_bios, | |
1112 | .can_queue = 40, | |
1113 | .this_id = -1, | |
1114 | .sg_tablesize = 256, | |
1115 | .cmd_per_lun = 5, | |
1116 | .max_sectors = 128, | |
1117 | .use_clustering = DISABLE_CLUSTERING, | |
1118 | .emulated = 1, | |
1119 | .proc_name = "ide-scsi", | |
1120 | }; | |
1121 | ||
8604affd | 1122 | static int ide_scsi_probe(struct device *dev) |
1da177e4 | 1123 | { |
8604affd | 1124 | ide_drive_t *drive = to_ide_device(dev); |
1da177e4 LT |
1125 | idescsi_scsi_t *idescsi; |
1126 | struct Scsi_Host *host; | |
1127 | struct gendisk *g; | |
1128 | static int warned; | |
1129 | int err = -ENOMEM; | |
1130 | ||
1131 | if (!warned && drive->media == ide_cdrom) { | |
1132 | printk(KERN_WARNING "ide-scsi is deprecated for cd burning! Use ide-cd and give dev=/dev/hdX as device\n"); | |
1133 | warned = 1; | |
1134 | } | |
1135 | ||
1136 | if (!strstr("ide-scsi", drive->driver_req) || | |
1137 | !drive->present || | |
1138 | drive->media == ide_disk || | |
1139 | !(host = scsi_host_alloc(&idescsi_template,sizeof(idescsi_scsi_t)))) | |
8604affd | 1140 | return -ENODEV; |
1da177e4 LT |
1141 | |
1142 | g = alloc_disk(1 << PARTN_BITS); | |
1143 | if (!g) | |
1144 | goto out_host_put; | |
1145 | ||
1146 | ide_init_disk(g, drive); | |
1147 | ||
1148 | host->max_id = 1; | |
1149 | ||
1150 | #if IDESCSI_DEBUG_LOG | |
1151 | if (drive->id->last_lun) | |
1152 | printk(KERN_NOTICE "%s: id->last_lun=%u\n", drive->name, drive->id->last_lun); | |
1153 | #endif | |
1154 | if ((drive->id->last_lun & 0x7) != 7) | |
1155 | host->max_lun = (drive->id->last_lun & 0x7) + 1; | |
1156 | else | |
1157 | host->max_lun = 1; | |
1158 | ||
1159 | drive->driver_data = host; | |
1160 | idescsi = scsihost_to_idescsi(host); | |
1161 | idescsi->drive = drive; | |
1162 | idescsi->driver = &idescsi_driver; | |
1163 | idescsi->host = host; | |
1164 | idescsi->disk = g; | |
1165 | g->private_data = &idescsi->driver; | |
8604affd BZ |
1166 | ide_register_subdriver(drive, &idescsi_driver); |
1167 | err = 0; | |
1168 | idescsi_setup(drive, idescsi); | |
1169 | g->fops = &idescsi_ops; | |
1170 | ide_register_region(g); | |
1171 | err = scsi_add_host(host, &drive->gendev); | |
1da177e4 | 1172 | if (!err) { |
8604affd BZ |
1173 | scsi_scan_host(host); |
1174 | return 0; | |
1da177e4 | 1175 | } |
8604affd BZ |
1176 | /* fall through on error */ |
1177 | ide_unregister_region(g); | |
1178 | ide_unregister_subdriver(drive, &idescsi_driver); | |
1da177e4 LT |
1179 | |
1180 | put_disk(g); | |
1181 | out_host_put: | |
1182 | scsi_host_put(host); | |
1183 | return err; | |
1184 | } | |
1185 | ||
1186 | static int __init init_idescsi_module(void) | |
1187 | { | |
8604affd | 1188 | return driver_register(&idescsi_driver.gen_driver); |
1da177e4 LT |
1189 | } |
1190 | ||
1191 | static void __exit exit_idescsi_module(void) | |
1192 | { | |
8604affd | 1193 | driver_unregister(&idescsi_driver.gen_driver); |
1da177e4 LT |
1194 | } |
1195 | ||
1196 | module_init(init_idescsi_module); | |
1197 | module_exit(exit_idescsi_module); | |
1198 | MODULE_LICENSE("GPL"); |