]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/ide/ide-tape.c
5204bef4a21cb4fcc0d3940a3f011e246c10882d
[linux-2.6-omap-h63xx.git] / drivers / ide / ide-tape.c
1 /*
2  * IDE ATAPI streaming tape driver.
3  *
4  * Copyright (C) 1995-1999  Gadi Oxman <gadio@netvision.net.il>
5  * Copyright (C) 2003-2005  Bartlomiej Zolnierkiewicz
6  *
7  * This driver was constructed as a student project in the software laboratory
8  * of the faculty of electrical engineering in the Technion - Israel's
9  * Institute Of Technology, with the guide of Avner Lottem and Dr. Ilana David.
10  *
11  * It is hereby placed under the terms of the GNU general public license.
12  * (See linux/COPYING).
13  *
14  * For a historical changelog see
15  * Documentation/ide/ChangeLog.ide-tape.1995-2002
16  */
17
18 #define DRV_NAME "ide-tape"
19
20 #define IDETAPE_VERSION "1.20"
21
22 #include <linux/module.h>
23 #include <linux/types.h>
24 #include <linux/string.h>
25 #include <linux/kernel.h>
26 #include <linux/delay.h>
27 #include <linux/timer.h>
28 #include <linux/mm.h>
29 #include <linux/interrupt.h>
30 #include <linux/jiffies.h>
31 #include <linux/major.h>
32 #include <linux/errno.h>
33 #include <linux/genhd.h>
34 #include <linux/slab.h>
35 #include <linux/pci.h>
36 #include <linux/ide.h>
37 #include <linux/smp_lock.h>
38 #include <linux/completion.h>
39 #include <linux/bitops.h>
40 #include <linux/mutex.h>
41 #include <scsi/scsi.h>
42
43 #include <asm/byteorder.h>
44 #include <linux/irq.h>
45 #include <linux/uaccess.h>
46 #include <linux/io.h>
47 #include <asm/unaligned.h>
48 #include <linux/mtio.h>
49
50 enum {
51         /* output errors only */
52         DBG_ERR =               (1 << 0),
53         /* output all sense key/asc */
54         DBG_SENSE =             (1 << 1),
55         /* info regarding all chrdev-related procedures */
56         DBG_CHRDEV =            (1 << 2),
57         /* all remaining procedures */
58         DBG_PROCS =             (1 << 3),
59 };
60
61 /* define to see debug info */
62 #define IDETAPE_DEBUG_LOG               0
63
64 #if IDETAPE_DEBUG_LOG
65 #define debug_log(lvl, fmt, args...)                    \
66 {                                                       \
67         if (tape->debug_mask & lvl)                     \
68         printk(KERN_INFO "ide-tape: " fmt, ## args);    \
69 }
70 #else
71 #define debug_log(lvl, fmt, args...) do {} while (0)
72 #endif
73
74 /**************************** Tunable parameters *****************************/
75 /*
76  * After each failed packet command we issue a request sense command and retry
77  * the packet command IDETAPE_MAX_PC_RETRIES times.
78  *
79  * Setting IDETAPE_MAX_PC_RETRIES to 0 will disable retries.
80  */
81 #define IDETAPE_MAX_PC_RETRIES          3
82
83 /*
84  * Some drives (for example, Seagate STT3401A Travan) require a very long
85  * timeout, because they don't return an interrupt or clear their busy bit
86  * until after the command completes (even retension commands).
87  */
88 #define IDETAPE_WAIT_CMD                (900*HZ)
89
90 /*
91  * The following parameter is used to select the point in the internal tape fifo
92  * in which we will start to refill the buffer. Decreasing the following
93  * parameter will improve the system's latency and interactive response, while
94  * using a high value might improve system throughput.
95  */
96 #define IDETAPE_FIFO_THRESHOLD          2
97
98 /*
99  * DSC polling parameters.
100  *
101  * Polling for DSC (a single bit in the status register) is a very important
102  * function in ide-tape. There are two cases in which we poll for DSC:
103  *
104  * 1. Before a read/write packet command, to ensure that we can transfer data
105  * from/to the tape's data buffers, without causing an actual media access.
106  * In case the tape is not ready yet, we take out our request from the device
107  * request queue, so that ide.c could service requests from the other device
108  * on the same interface in the meantime.
109  *
110  * 2. After the successful initialization of a "media access packet command",
111  * which is a command that can take a long time to complete (the interval can
112  * range from several seconds to even an hour). Again, we postpone our request
113  * in the middle to free the bus for the other device. The polling frequency
114  * here should be lower than the read/write frequency since those media access
115  * commands are slow. We start from a "fast" frequency - IDETAPE_DSC_MA_FAST
116  * (1 second), and if we don't receive DSC after IDETAPE_DSC_MA_THRESHOLD
117  * (5 min), we switch it to a lower frequency - IDETAPE_DSC_MA_SLOW (1 min).
118  *
119  * We also set a timeout for the timer, in case something goes wrong. The
120  * timeout should be longer then the maximum execution time of a tape operation.
121  */
122
123 /* DSC timings. */
124 #define IDETAPE_DSC_RW_MIN              5*HZ/100        /* 50 msec */
125 #define IDETAPE_DSC_RW_MAX              40*HZ/100       /* 400 msec */
126 #define IDETAPE_DSC_RW_TIMEOUT          2*60*HZ         /* 2 minutes */
127 #define IDETAPE_DSC_MA_FAST             2*HZ            /* 2 seconds */
128 #define IDETAPE_DSC_MA_THRESHOLD        5*60*HZ         /* 5 minutes */
129 #define IDETAPE_DSC_MA_SLOW             30*HZ           /* 30 seconds */
130 #define IDETAPE_DSC_MA_TIMEOUT          2*60*60*HZ      /* 2 hours */
131
132 /*************************** End of tunable parameters ***********************/
133
134 /* tape directions */
135 enum {
136         IDETAPE_DIR_NONE  = (1 << 0),
137         IDETAPE_DIR_READ  = (1 << 1),
138         IDETAPE_DIR_WRITE = (1 << 2),
139 };
140
141 struct idetape_bh {
142         u32 b_size;
143         atomic_t b_count;
144         struct idetape_bh *b_reqnext;
145         char *b_data;
146 };
147
148 /* Tape door status */
149 #define DOOR_UNLOCKED                   0
150 #define DOOR_LOCKED                     1
151 #define DOOR_EXPLICITLY_LOCKED          2
152
153 /* Some defines for the SPACE command */
154 #define IDETAPE_SPACE_OVER_FILEMARK     1
155 #define IDETAPE_SPACE_TO_EOD            3
156
157 /* Some defines for the LOAD UNLOAD command */
158 #define IDETAPE_LU_LOAD_MASK            1
159 #define IDETAPE_LU_RETENSION_MASK       2
160 #define IDETAPE_LU_EOT_MASK             4
161
162 /* Error codes returned in rq->errors to the higher part of the driver. */
163 #define IDETAPE_ERROR_GENERAL           101
164 #define IDETAPE_ERROR_FILEMARK          102
165 #define IDETAPE_ERROR_EOD               103
166
167 /* Structures related to the SELECT SENSE / MODE SENSE packet commands. */
168 #define IDETAPE_BLOCK_DESCRIPTOR        0
169 #define IDETAPE_CAPABILITIES_PAGE       0x2a
170
171 /*
172  * Most of our global data which we need to save even as we leave the driver due
173  * to an interrupt or a timer event is stored in the struct defined below.
174  */
175 typedef struct ide_tape_obj {
176         ide_drive_t     *drive;
177         ide_driver_t    *driver;
178         struct gendisk  *disk;
179         struct kref     kref;
180
181         /*
182          *      pc points to the current processed packet command.
183          *
184          *      failed_pc points to the last failed packet command, or contains
185          *      NULL if we do not need to retry any packet command. This is
186          *      required since an additional packet command is needed before the
187          *      retry, to get detailed information on what went wrong.
188          */
189         /* Current packet command */
190         struct ide_atapi_pc *pc;
191         /* Last failed packet command */
192         struct ide_atapi_pc *failed_pc;
193         /* used by REQ_IDETAPE_{READ,WRITE} requests */
194         struct ide_atapi_pc queued_pc;
195
196         struct ide_atapi_pc request_sense_pc;
197         struct request request_sense_rq;
198
199         /*
200          * DSC polling variables.
201          *
202          * While polling for DSC we use postponed_rq to postpone the current
203          * request so that ide.c will be able to service pending requests on the
204          * other device. Note that at most we will have only one DSC (usually
205          * data transfer) request in the device request queue.
206          */
207         struct request *postponed_rq;
208         /* The time in which we started polling for DSC */
209         unsigned long dsc_polling_start;
210         /* Timer used to poll for dsc */
211         struct timer_list dsc_timer;
212         /* Read/Write dsc polling frequency */
213         unsigned long best_dsc_rw_freq;
214         unsigned long dsc_poll_freq;
215         unsigned long dsc_timeout;
216
217         /* Read position information */
218         u8 partition;
219         /* Current block */
220         unsigned int first_frame;
221
222         /* Last error information */
223         u8 sense_key, asc, ascq;
224
225         /* Character device operation */
226         unsigned int minor;
227         /* device name */
228         char name[4];
229         /* Current character device data transfer direction */
230         u8 chrdev_dir;
231
232         /* tape block size, usually 512 or 1024 bytes */
233         unsigned short blk_size;
234         int user_bs_factor;
235
236         /* Copy of the tape's Capabilities and Mechanical Page */
237         u8 caps[20];
238
239         /*
240          * Active data transfer request parameters.
241          *
242          * At most, there is only one ide-tape originated data transfer request
243          * in the device request queue. This allows ide.c to easily service
244          * requests from the other device when we postpone our active request.
245          */
246
247         /* Data buffer size chosen based on the tape's recommendation */
248         int buffer_size;
249         /* merge buffer */
250         struct idetape_bh *merge_bh;
251         /* size of the merge buffer */
252         int merge_bh_size;
253         /* pointer to current buffer head within the merge buffer */
254         struct idetape_bh *bh;
255         char *b_data;
256         int b_count;
257
258         int pages_per_buffer;
259         /* Wasted space in each stage */
260         int excess_bh_size;
261
262         /* protects the ide-tape queue */
263         spinlock_t lock;
264
265         /* Measures average tape speed */
266         unsigned long avg_time;
267         int avg_size;
268         int avg_speed;
269
270         /* the door is currently locked */
271         int door_locked;
272         /* the tape hardware is write protected */
273         char drv_write_prot;
274         /* the tape is write protected (hardware or opened as read-only) */
275         char write_prot;
276
277         u32 debug_mask;
278 } idetape_tape_t;
279
280 static DEFINE_MUTEX(idetape_ref_mutex);
281
282 static struct class *idetape_sysfs_class;
283
284 #define to_ide_tape(obj) container_of(obj, struct ide_tape_obj, kref)
285
286 #define ide_tape_g(disk) \
287         container_of((disk)->private_data, struct ide_tape_obj, driver)
288
289 static void ide_tape_release(struct kref *);
290
291 static struct ide_tape_obj *ide_tape_get(struct gendisk *disk)
292 {
293         struct ide_tape_obj *tape = NULL;
294
295         mutex_lock(&idetape_ref_mutex);
296         tape = ide_tape_g(disk);
297         if (tape) {
298                 if (ide_device_get(tape->drive))
299                         tape = NULL;
300                 else
301                         kref_get(&tape->kref);
302         }
303         mutex_unlock(&idetape_ref_mutex);
304         return tape;
305 }
306
307 static void ide_tape_put(struct ide_tape_obj *tape)
308 {
309         ide_drive_t *drive = tape->drive;
310
311         mutex_lock(&idetape_ref_mutex);
312         kref_put(&tape->kref, ide_tape_release);
313         ide_device_put(drive);
314         mutex_unlock(&idetape_ref_mutex);
315 }
316
317 /*
318  * The variables below are used for the character device interface. Additional
319  * state variables are defined in our ide_drive_t structure.
320  */
321 static struct ide_tape_obj *idetape_devs[MAX_HWIFS * MAX_DRIVES];
322
323 #define ide_tape_f(file) ((file)->private_data)
324
325 static struct ide_tape_obj *ide_tape_chrdev_get(unsigned int i)
326 {
327         struct ide_tape_obj *tape = NULL;
328
329         mutex_lock(&idetape_ref_mutex);
330         tape = idetape_devs[i];
331         if (tape)
332                 kref_get(&tape->kref);
333         mutex_unlock(&idetape_ref_mutex);
334         return tape;
335 }
336
337 static void idetape_input_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
338                                   unsigned int bcount)
339 {
340         struct idetape_bh *bh = pc->bh;
341         int count;
342
343         while (bcount) {
344                 if (bh == NULL) {
345                         printk(KERN_ERR "ide-tape: bh == NULL in "
346                                 "idetape_input_buffers\n");
347                         ide_pad_transfer(drive, 0, bcount);
348                         return;
349                 }
350                 count = min(
351                         (unsigned int)(bh->b_size - atomic_read(&bh->b_count)),
352                         bcount);
353                 drive->hwif->tp_ops->input_data(drive, NULL, bh->b_data +
354                                         atomic_read(&bh->b_count), count);
355                 bcount -= count;
356                 atomic_add(count, &bh->b_count);
357                 if (atomic_read(&bh->b_count) == bh->b_size) {
358                         bh = bh->b_reqnext;
359                         if (bh)
360                                 atomic_set(&bh->b_count, 0);
361                 }
362         }
363         pc->bh = bh;
364 }
365
366 static void idetape_output_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
367                                    unsigned int bcount)
368 {
369         struct idetape_bh *bh = pc->bh;
370         int count;
371
372         while (bcount) {
373                 if (bh == NULL) {
374                         printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
375                                         __func__);
376                         return;
377                 }
378                 count = min((unsigned int)pc->b_count, (unsigned int)bcount);
379                 drive->hwif->tp_ops->output_data(drive, NULL, pc->b_data, count);
380                 bcount -= count;
381                 pc->b_data += count;
382                 pc->b_count -= count;
383                 if (!pc->b_count) {
384                         bh = bh->b_reqnext;
385                         pc->bh = bh;
386                         if (bh) {
387                                 pc->b_data = bh->b_data;
388                                 pc->b_count = atomic_read(&bh->b_count);
389                         }
390                 }
391         }
392 }
393
394 static void idetape_update_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc)
395 {
396         struct idetape_bh *bh = pc->bh;
397         int count;
398         unsigned int bcount = pc->xferred;
399
400         if (pc->flags & PC_FLAG_WRITING)
401                 return;
402         while (bcount) {
403                 if (bh == NULL) {
404                         printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
405                                         __func__);
406                         return;
407                 }
408                 count = min((unsigned int)bh->b_size, (unsigned int)bcount);
409                 atomic_set(&bh->b_count, count);
410                 if (atomic_read(&bh->b_count) == bh->b_size)
411                         bh = bh->b_reqnext;
412                 bcount -= count;
413         }
414         pc->bh = bh;
415 }
416
417 /*
418  * called on each failed packet command retry to analyze the request sense. We
419  * currently do not utilize this information.
420  */
421 static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
422 {
423         idetape_tape_t *tape = drive->driver_data;
424         struct ide_atapi_pc *pc = tape->failed_pc;
425
426         tape->sense_key = sense[2] & 0xF;
427         tape->asc       = sense[12];
428         tape->ascq      = sense[13];
429
430         debug_log(DBG_ERR, "pc = %x, sense key = %x, asc = %x, ascq = %x\n",
431                  pc->c[0], tape->sense_key, tape->asc, tape->ascq);
432
433         /* Correct pc->xferred by asking the tape.       */
434         if (pc->flags & PC_FLAG_DMA_ERROR) {
435                 pc->xferred = pc->req_xfer -
436                         tape->blk_size *
437                         get_unaligned_be32(&sense[3]);
438                 idetape_update_buffers(drive, pc);
439         }
440
441         /*
442          * If error was the result of a zero-length read or write command,
443          * with sense key=5, asc=0x22, ascq=0, let it slide.  Some drives
444          * (i.e. Seagate STT3401A Travan) don't support 0-length read/writes.
445          */
446         if ((pc->c[0] == READ_6 || pc->c[0] == WRITE_6)
447             /* length == 0 */
448             && pc->c[4] == 0 && pc->c[3] == 0 && pc->c[2] == 0) {
449                 if (tape->sense_key == 5) {
450                         /* don't report an error, everything's ok */
451                         pc->error = 0;
452                         /* don't retry read/write */
453                         pc->flags |= PC_FLAG_ABORT;
454                 }
455         }
456         if (pc->c[0] == READ_6 && (sense[2] & 0x80)) {
457                 pc->error = IDETAPE_ERROR_FILEMARK;
458                 pc->flags |= PC_FLAG_ABORT;
459         }
460         if (pc->c[0] == WRITE_6) {
461                 if ((sense[2] & 0x40) || (tape->sense_key == 0xd
462                      && tape->asc == 0x0 && tape->ascq == 0x2)) {
463                         pc->error = IDETAPE_ERROR_EOD;
464                         pc->flags |= PC_FLAG_ABORT;
465                 }
466         }
467         if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
468                 if (tape->sense_key == 8) {
469                         pc->error = IDETAPE_ERROR_EOD;
470                         pc->flags |= PC_FLAG_ABORT;
471                 }
472                 if (!(pc->flags & PC_FLAG_ABORT) &&
473                     pc->xferred)
474                         pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
475         }
476 }
477
478 /* Free data buffers completely. */
479 static void ide_tape_kfree_buffer(idetape_tape_t *tape)
480 {
481         struct idetape_bh *prev_bh, *bh = tape->merge_bh;
482
483         while (bh) {
484                 u32 size = bh->b_size;
485
486                 while (size) {
487                         unsigned int order = fls(size >> PAGE_SHIFT)-1;
488
489                         if (bh->b_data)
490                                 free_pages((unsigned long)bh->b_data, order);
491
492                         size &= (order-1);
493                         bh->b_data += (1 << order) * PAGE_SIZE;
494                 }
495                 prev_bh = bh;
496                 bh = bh->b_reqnext;
497                 kfree(prev_bh);
498         }
499 }
500
501 static int idetape_end_request(ide_drive_t *drive, int uptodate, int nr_sects)
502 {
503         struct request *rq = HWGROUP(drive)->rq;
504         idetape_tape_t *tape = drive->driver_data;
505         unsigned long flags;
506         int error;
507
508         debug_log(DBG_PROCS, "Enter %s\n", __func__);
509
510         switch (uptodate) {
511         case 0: error = IDETAPE_ERROR_GENERAL; break;
512         case 1: error = 0; break;
513         default: error = uptodate;
514         }
515         rq->errors = error;
516         if (error)
517                 tape->failed_pc = NULL;
518
519         if (!blk_special_request(rq)) {
520                 ide_end_request(drive, uptodate, nr_sects);
521                 return 0;
522         }
523
524         spin_lock_irqsave(&tape->lock, flags);
525
526         ide_end_drive_cmd(drive, 0, 0);
527
528         spin_unlock_irqrestore(&tape->lock, flags);
529         return 0;
530 }
531
532 static void ide_tape_callback(ide_drive_t *drive)
533 {
534         idetape_tape_t *tape = drive->driver_data;
535         struct ide_atapi_pc *pc = tape->pc;
536         int uptodate = pc->error ? 0 : 1;
537
538         debug_log(DBG_PROCS, "Enter %s\n", __func__);
539
540         if (tape->failed_pc == pc)
541                 tape->failed_pc = NULL;
542
543         if (pc->c[0] == REQUEST_SENSE) {
544                 if (uptodate)
545                         idetape_analyze_error(drive, pc->buf);
546                 else
547                         printk(KERN_ERR "ide-tape: Error in REQUEST SENSE "
548                                         "itself - Aborting request!\n");
549         } else if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
550                 struct request *rq = drive->hwif->hwgroup->rq;
551                 int blocks = pc->xferred / tape->blk_size;
552
553                 tape->avg_size += blocks * tape->blk_size;
554
555                 if (time_after_eq(jiffies, tape->avg_time + HZ)) {
556                         tape->avg_speed = tape->avg_size * HZ /
557                                 (jiffies - tape->avg_time) / 1024;
558                         tape->avg_size = 0;
559                         tape->avg_time = jiffies;
560                 }
561
562                 tape->first_frame += blocks;
563                 rq->current_nr_sectors -= blocks;
564
565                 if (pc->error)
566                         uptodate = pc->error;
567         } else if (pc->c[0] == READ_POSITION && uptodate) {
568                 u8 *readpos = tape->pc->buf;
569
570                 debug_log(DBG_SENSE, "BOP - %s\n",
571                                 (readpos[0] & 0x80) ? "Yes" : "No");
572                 debug_log(DBG_SENSE, "EOP - %s\n",
573                                 (readpos[0] & 0x40) ? "Yes" : "No");
574
575                 if (readpos[0] & 0x4) {
576                         printk(KERN_INFO "ide-tape: Block location is unknown"
577                                          "to the tape\n");
578                         clear_bit(IDE_AFLAG_ADDRESS_VALID, &drive->atapi_flags);
579                         uptodate = 0;
580                 } else {
581                         debug_log(DBG_SENSE, "Block Location - %u\n",
582                                         be32_to_cpup((__be32 *)&readpos[4]));
583
584                         tape->partition = readpos[1];
585                         tape->first_frame = be32_to_cpup((__be32 *)&readpos[4]);
586                         set_bit(IDE_AFLAG_ADDRESS_VALID, &drive->atapi_flags);
587                 }
588         }
589
590         idetape_end_request(drive, uptodate, 0);
591 }
592
593 static void idetape_create_request_sense_cmd(struct ide_atapi_pc *pc)
594 {
595         ide_init_pc(pc);
596         pc->c[0] = REQUEST_SENSE;
597         pc->c[4] = 20;
598         pc->req_xfer = 20;
599 }
600
601 /*
602  *      idetape_retry_pc is called when an error was detected during the
603  *      last packet command. We queue a request sense packet command in
604  *      the head of the request list.
605  */
606 static void idetape_retry_pc(ide_drive_t *drive)
607 {
608         struct ide_tape_obj *tape = drive->driver_data;
609         struct request *rq = &tape->request_sense_rq;
610         struct ide_atapi_pc *pc = &tape->request_sense_pc;
611
612         (void)ide_read_error(drive);
613         idetape_create_request_sense_cmd(pc);
614         set_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags);
615         ide_queue_pc_head(drive, tape->disk, pc, rq);
616 }
617
618 /*
619  * Postpone the current request so that ide.c will be able to service requests
620  * from another device on the same hwgroup while we are polling for DSC.
621  */
622 static void idetape_postpone_request(ide_drive_t *drive)
623 {
624         idetape_tape_t *tape = drive->driver_data;
625
626         debug_log(DBG_PROCS, "Enter %s\n", __func__);
627
628         tape->postponed_rq = HWGROUP(drive)->rq;
629         ide_stall_queue(drive, tape->dsc_poll_freq);
630 }
631
632 static void ide_tape_handle_dsc(ide_drive_t *drive)
633 {
634         idetape_tape_t *tape = drive->driver_data;
635
636         /* Media access command */
637         tape->dsc_polling_start = jiffies;
638         tape->dsc_poll_freq = IDETAPE_DSC_MA_FAST;
639         tape->dsc_timeout = jiffies + IDETAPE_DSC_MA_TIMEOUT;
640         /* Allow ide.c to handle other requests */
641         idetape_postpone_request(drive);
642 }
643
644 static int ide_tape_io_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
645                                 unsigned int bcount, int write)
646 {
647         if (write)
648                 idetape_output_buffers(drive, pc, bcount);
649         else
650                 idetape_input_buffers(drive, pc, bcount);
651
652         return bcount;
653 }
654
655 /*
656  * This is the usual interrupt handler which will be called during a packet
657  * command. We will transfer some of the data (as requested by the drive) and
658  * will re-point interrupt handler to us. When data transfer is finished, we
659  * will act according to the algorithm described before
660  * idetape_issue_pc.
661  */
662 static ide_startstop_t idetape_pc_intr(ide_drive_t *drive)
663 {
664         idetape_tape_t *tape = drive->driver_data;
665
666         return ide_pc_intr(drive, tape->pc, idetape_pc_intr, IDETAPE_WAIT_CMD,
667                            NULL, idetape_update_buffers, idetape_retry_pc,
668                            ide_tape_handle_dsc, ide_tape_io_buffers);
669 }
670
671 /*
672  * Packet Command Interface
673  *
674  * The current Packet Command is available in tape->pc, and will not change
675  * until we finish handling it. Each packet command is associated with a
676  * callback function that will be called when the command is finished.
677  *
678  * The handling will be done in three stages:
679  *
680  * 1. idetape_issue_pc will send the packet command to the drive, and will set
681  * the interrupt handler to idetape_pc_intr.
682  *
683  * 2. On each interrupt, idetape_pc_intr will be called. This step will be
684  * repeated until the device signals us that no more interrupts will be issued.
685  *
686  * 3. ATAPI Tape media access commands have immediate status with a delayed
687  * process. In case of a successful initiation of a media access packet command,
688  * the DSC bit will be set when the actual execution of the command is finished.
689  * Since the tape drive will not issue an interrupt, we have to poll for this
690  * event. In this case, we define the request as "low priority request" by
691  * setting rq_status to IDETAPE_RQ_POSTPONED, set a timer to poll for DSC and
692  * exit the driver.
693  *
694  * ide.c will then give higher priority to requests which originate from the
695  * other device, until will change rq_status to RQ_ACTIVE.
696  *
697  * 4. When the packet command is finished, it will be checked for errors.
698  *
699  * 5. In case an error was found, we queue a request sense packet command in
700  * front of the request queue and retry the operation up to
701  * IDETAPE_MAX_PC_RETRIES times.
702  *
703  * 6. In case no error was found, or we decided to give up and not to retry
704  * again, the callback function will be called and then we will handle the next
705  * request.
706  */
707 static ide_startstop_t idetape_transfer_pc(ide_drive_t *drive)
708 {
709         idetape_tape_t *tape = drive->driver_data;
710
711         return ide_transfer_pc(drive, tape->pc, idetape_pc_intr,
712                                IDETAPE_WAIT_CMD, NULL);
713 }
714
715 static ide_startstop_t idetape_issue_pc(ide_drive_t *drive,
716                 struct ide_atapi_pc *pc)
717 {
718         idetape_tape_t *tape = drive->driver_data;
719
720         if (tape->pc->c[0] == REQUEST_SENSE &&
721             pc->c[0] == REQUEST_SENSE) {
722                 printk(KERN_ERR "ide-tape: possible ide-tape.c bug - "
723                         "Two request sense in serial were issued\n");
724         }
725
726         if (tape->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
727                 tape->failed_pc = pc;
728         /* Set the current packet command */
729         tape->pc = pc;
730
731         if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
732                 (pc->flags & PC_FLAG_ABORT)) {
733                 /*
734                  * We will "abort" retrying a packet command in case legitimate
735                  * error code was received (crossing a filemark, or end of the
736                  * media, for example).
737                  */
738                 if (!(pc->flags & PC_FLAG_ABORT)) {
739                         if (!(pc->c[0] == TEST_UNIT_READY &&
740                               tape->sense_key == 2 && tape->asc == 4 &&
741                              (tape->ascq == 1 || tape->ascq == 8))) {
742                                 printk(KERN_ERR "ide-tape: %s: I/O error, "
743                                                 "pc = %2x, key = %2x, "
744                                                 "asc = %2x, ascq = %2x\n",
745                                                 tape->name, pc->c[0],
746                                                 tape->sense_key, tape->asc,
747                                                 tape->ascq);
748                         }
749                         /* Giving up */
750                         pc->error = IDETAPE_ERROR_GENERAL;
751                 }
752                 tape->failed_pc = NULL;
753                 drive->pc_callback(drive);
754                 return ide_stopped;
755         }
756         debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
757
758         pc->retries++;
759
760         return ide_issue_pc(drive, pc, idetape_transfer_pc,
761                             IDETAPE_WAIT_CMD, NULL);
762 }
763
764 /* A mode sense command is used to "sense" tape parameters. */
765 static void idetape_create_mode_sense_cmd(struct ide_atapi_pc *pc, u8 page_code)
766 {
767         ide_init_pc(pc);
768         pc->c[0] = MODE_SENSE;
769         if (page_code != IDETAPE_BLOCK_DESCRIPTOR)
770                 /* DBD = 1 - Don't return block descriptors */
771                 pc->c[1] = 8;
772         pc->c[2] = page_code;
773         /*
774          * Changed pc->c[3] to 0 (255 will at best return unused info).
775          *
776          * For SCSI this byte is defined as subpage instead of high byte
777          * of length and some IDE drives seem to interpret it this way
778          * and return an error when 255 is used.
779          */
780         pc->c[3] = 0;
781         /* We will just discard data in that case */
782         pc->c[4] = 255;
783         if (page_code == IDETAPE_BLOCK_DESCRIPTOR)
784                 pc->req_xfer = 12;
785         else if (page_code == IDETAPE_CAPABILITIES_PAGE)
786                 pc->req_xfer = 24;
787         else
788                 pc->req_xfer = 50;
789 }
790
791 static ide_startstop_t idetape_media_access_finished(ide_drive_t *drive)
792 {
793         ide_hwif_t *hwif = drive->hwif;
794         idetape_tape_t *tape = drive->driver_data;
795         struct ide_atapi_pc *pc = tape->pc;
796         u8 stat;
797
798         stat = hwif->tp_ops->read_status(hwif);
799
800         if (stat & ATA_DSC) {
801                 if (stat & ATA_ERR) {
802                         /* Error detected */
803                         if (pc->c[0] != TEST_UNIT_READY)
804                                 printk(KERN_ERR "ide-tape: %s: I/O error, ",
805                                                 tape->name);
806                         /* Retry operation */
807                         idetape_retry_pc(drive);
808                         return ide_stopped;
809                 }
810                 pc->error = 0;
811         } else {
812                 pc->error = IDETAPE_ERROR_GENERAL;
813                 tape->failed_pc = NULL;
814         }
815         drive->pc_callback(drive);
816         return ide_stopped;
817 }
818
819 static void ide_tape_create_rw_cmd(idetape_tape_t *tape,
820                                    struct ide_atapi_pc *pc, struct request *rq,
821                                    u8 opcode)
822 {
823         struct idetape_bh *bh = (struct idetape_bh *)rq->special;
824         unsigned int length = rq->current_nr_sectors;
825
826         ide_init_pc(pc);
827         put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
828         pc->c[1] = 1;
829         pc->bh = bh;
830         pc->buf = NULL;
831         pc->buf_size = length * tape->blk_size;
832         pc->req_xfer = pc->buf_size;
833         if (pc->req_xfer == tape->buffer_size)
834                 pc->flags |= PC_FLAG_DMA_OK;
835
836         if (opcode == READ_6) {
837                 pc->c[0] = READ_6;
838                 atomic_set(&bh->b_count, 0);
839         } else if (opcode == WRITE_6) {
840                 pc->c[0] = WRITE_6;
841                 pc->flags |= PC_FLAG_WRITING;
842                 pc->b_data = bh->b_data;
843                 pc->b_count = atomic_read(&bh->b_count);
844         }
845
846         memcpy(rq->cmd, pc->c, 12);
847 }
848
849 static ide_startstop_t idetape_do_request(ide_drive_t *drive,
850                                           struct request *rq, sector_t block)
851 {
852         ide_hwif_t *hwif = drive->hwif;
853         idetape_tape_t *tape = drive->driver_data;
854         struct ide_atapi_pc *pc = NULL;
855         struct request *postponed_rq = tape->postponed_rq;
856         u8 stat;
857
858         debug_log(DBG_SENSE, "sector: %llu, nr_sectors: %lu,"
859                         " current_nr_sectors: %u\n",
860                         (unsigned long long)rq->sector, rq->nr_sectors,
861                         rq->current_nr_sectors);
862
863         if (!blk_special_request(rq)) {
864                 /* We do not support buffer cache originated requests. */
865                 printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
866                         "request queue (%d)\n", drive->name, rq->cmd_type);
867                 ide_end_request(drive, 0, 0);
868                 return ide_stopped;
869         }
870
871         /* Retry a failed packet command */
872         if (tape->failed_pc && tape->pc->c[0] == REQUEST_SENSE) {
873                 pc = tape->failed_pc;
874                 goto out;
875         }
876
877         if (postponed_rq != NULL)
878                 if (rq != postponed_rq) {
879                         printk(KERN_ERR "ide-tape: ide-tape.c bug - "
880                                         "Two DSC requests were queued\n");
881                         idetape_end_request(drive, 0, 0);
882                         return ide_stopped;
883                 }
884
885         tape->postponed_rq = NULL;
886
887         /*
888          * If the tape is still busy, postpone our request and service
889          * the other device meanwhile.
890          */
891         stat = hwif->tp_ops->read_status(hwif);
892
893         if (!drive->dsc_overlap && !(rq->cmd[13] & REQ_IDETAPE_PC2))
894                 set_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags);
895
896         if (drive->post_reset == 1) {
897                 set_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags);
898                 drive->post_reset = 0;
899         }
900
901         if (!test_and_clear_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags) &&
902             (stat & ATA_DSC) == 0) {
903                 if (postponed_rq == NULL) {
904                         tape->dsc_polling_start = jiffies;
905                         tape->dsc_poll_freq = tape->best_dsc_rw_freq;
906                         tape->dsc_timeout = jiffies + IDETAPE_DSC_RW_TIMEOUT;
907                 } else if (time_after(jiffies, tape->dsc_timeout)) {
908                         printk(KERN_ERR "ide-tape: %s: DSC timeout\n",
909                                 tape->name);
910                         if (rq->cmd[13] & REQ_IDETAPE_PC2) {
911                                 idetape_media_access_finished(drive);
912                                 return ide_stopped;
913                         } else {
914                                 return ide_do_reset(drive);
915                         }
916                 } else if (time_after(jiffies,
917                                         tape->dsc_polling_start +
918                                         IDETAPE_DSC_MA_THRESHOLD))
919                         tape->dsc_poll_freq = IDETAPE_DSC_MA_SLOW;
920                 idetape_postpone_request(drive);
921                 return ide_stopped;
922         }
923         if (rq->cmd[13] & REQ_IDETAPE_READ) {
924                 pc = &tape->queued_pc;
925                 ide_tape_create_rw_cmd(tape, pc, rq, READ_6);
926                 goto out;
927         }
928         if (rq->cmd[13] & REQ_IDETAPE_WRITE) {
929                 pc = &tape->queued_pc;
930                 ide_tape_create_rw_cmd(tape, pc, rq, WRITE_6);
931                 goto out;
932         }
933         if (rq->cmd[13] & REQ_IDETAPE_PC1) {
934                 pc = (struct ide_atapi_pc *) rq->buffer;
935                 rq->cmd[13] &= ~(REQ_IDETAPE_PC1);
936                 rq->cmd[13] |= REQ_IDETAPE_PC2;
937                 goto out;
938         }
939         if (rq->cmd[13] & REQ_IDETAPE_PC2) {
940                 idetape_media_access_finished(drive);
941                 return ide_stopped;
942         }
943         BUG();
944
945 out:
946         return idetape_issue_pc(drive, pc);
947 }
948
949 /*
950  * The function below uses __get_free_pages to allocate a data buffer of size
951  * tape->buffer_size (or a bit more). We attempt to combine sequential pages as
952  * much as possible.
953  *
954  * It returns a pointer to the newly allocated buffer, or NULL in case of
955  * failure.
956  */
957 static struct idetape_bh *ide_tape_kmalloc_buffer(idetape_tape_t *tape,
958                                                   int full, int clear)
959 {
960         struct idetape_bh *prev_bh, *bh, *merge_bh;
961         int pages = tape->pages_per_buffer;
962         unsigned int order, b_allocd;
963         char *b_data = NULL;
964
965         merge_bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
966         bh = merge_bh;
967         if (bh == NULL)
968                 goto abort;
969
970         order = fls(pages) - 1;
971         bh->b_data = (char *) __get_free_pages(GFP_KERNEL, order);
972         if (!bh->b_data)
973                 goto abort;
974         b_allocd = (1 << order) * PAGE_SIZE;
975         pages &= (order-1);
976
977         if (clear)
978                 memset(bh->b_data, 0, b_allocd);
979         bh->b_reqnext = NULL;
980         bh->b_size = b_allocd;
981         atomic_set(&bh->b_count, full ? bh->b_size : 0);
982
983         while (pages) {
984                 order = fls(pages) - 1;
985                 b_data = (char *) __get_free_pages(GFP_KERNEL, order);
986                 if (!b_data)
987                         goto abort;
988                 b_allocd = (1 << order) * PAGE_SIZE;
989
990                 if (clear)
991                         memset(b_data, 0, b_allocd);
992
993                 /* newly allocated page frames below buffer header or ...*/
994                 if (bh->b_data == b_data + b_allocd) {
995                         bh->b_size += b_allocd;
996                         bh->b_data -= b_allocd;
997                         if (full)
998                                 atomic_add(b_allocd, &bh->b_count);
999                         continue;
1000                 }
1001                 /* they are above the header */
1002                 if (b_data == bh->b_data + bh->b_size) {
1003                         bh->b_size += b_allocd;
1004                         if (full)
1005                                 atomic_add(b_allocd, &bh->b_count);
1006                         continue;
1007                 }
1008                 prev_bh = bh;
1009                 bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
1010                 if (!bh) {
1011                         free_pages((unsigned long) b_data, order);
1012                         goto abort;
1013                 }
1014                 bh->b_reqnext = NULL;
1015                 bh->b_data = b_data;
1016                 bh->b_size = b_allocd;
1017                 atomic_set(&bh->b_count, full ? bh->b_size : 0);
1018                 prev_bh->b_reqnext = bh;
1019
1020                 pages &= (order-1);
1021         }
1022
1023         bh->b_size -= tape->excess_bh_size;
1024         if (full)
1025                 atomic_sub(tape->excess_bh_size, &bh->b_count);
1026         return merge_bh;
1027 abort:
1028         ide_tape_kfree_buffer(tape);
1029         return NULL;
1030 }
1031
1032 static int idetape_copy_stage_from_user(idetape_tape_t *tape,
1033                                         const char __user *buf, int n)
1034 {
1035         struct idetape_bh *bh = tape->bh;
1036         int count;
1037         int ret = 0;
1038
1039         while (n) {
1040                 if (bh == NULL) {
1041                         printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
1042                                         __func__);
1043                         return 1;
1044                 }
1045                 count = min((unsigned int)
1046                                 (bh->b_size - atomic_read(&bh->b_count)),
1047                                 (unsigned int)n);
1048                 if (copy_from_user(bh->b_data + atomic_read(&bh->b_count), buf,
1049                                 count))
1050                         ret = 1;
1051                 n -= count;
1052                 atomic_add(count, &bh->b_count);
1053                 buf += count;
1054                 if (atomic_read(&bh->b_count) == bh->b_size) {
1055                         bh = bh->b_reqnext;
1056                         if (bh)
1057                                 atomic_set(&bh->b_count, 0);
1058                 }
1059         }
1060         tape->bh = bh;
1061         return ret;
1062 }
1063
1064 static int idetape_copy_stage_to_user(idetape_tape_t *tape, char __user *buf,
1065                                       int n)
1066 {
1067         struct idetape_bh *bh = tape->bh;
1068         int count;
1069         int ret = 0;
1070
1071         while (n) {
1072                 if (bh == NULL) {
1073                         printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
1074                                         __func__);
1075                         return 1;
1076                 }
1077                 count = min(tape->b_count, n);
1078                 if  (copy_to_user(buf, tape->b_data, count))
1079                         ret = 1;
1080                 n -= count;
1081                 tape->b_data += count;
1082                 tape->b_count -= count;
1083                 buf += count;
1084                 if (!tape->b_count) {
1085                         bh = bh->b_reqnext;
1086                         tape->bh = bh;
1087                         if (bh) {
1088                                 tape->b_data = bh->b_data;
1089                                 tape->b_count = atomic_read(&bh->b_count);
1090                         }
1091                 }
1092         }
1093         return ret;
1094 }
1095
1096 static void idetape_init_merge_buffer(idetape_tape_t *tape)
1097 {
1098         struct idetape_bh *bh = tape->merge_bh;
1099         tape->bh = tape->merge_bh;
1100
1101         if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
1102                 atomic_set(&bh->b_count, 0);
1103         else {
1104                 tape->b_data = bh->b_data;
1105                 tape->b_count = atomic_read(&bh->b_count);
1106         }
1107 }
1108
1109 /*
1110  * Write a filemark if write_filemark=1. Flush the device buffers without
1111  * writing a filemark otherwise.
1112  */
1113 static void idetape_create_write_filemark_cmd(ide_drive_t *drive,
1114                 struct ide_atapi_pc *pc, int write_filemark)
1115 {
1116         ide_init_pc(pc);
1117         pc->c[0] = WRITE_FILEMARKS;
1118         pc->c[4] = write_filemark;
1119         pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1120 }
1121
1122 static void idetape_create_test_unit_ready_cmd(struct ide_atapi_pc *pc)
1123 {
1124         ide_init_pc(pc);
1125         pc->c[0] = TEST_UNIT_READY;
1126 }
1127
1128 static int idetape_wait_ready(ide_drive_t *drive, unsigned long timeout)
1129 {
1130         idetape_tape_t *tape = drive->driver_data;
1131         struct gendisk *disk = tape->disk;
1132         struct ide_atapi_pc pc;
1133         int load_attempted = 0;
1134
1135         /* Wait for the tape to become ready */
1136         set_bit(IDE_AFLAG_MEDIUM_PRESENT, &drive->atapi_flags);
1137         timeout += jiffies;
1138         while (time_before(jiffies, timeout)) {
1139                 idetape_create_test_unit_ready_cmd(&pc);
1140                 if (!ide_queue_pc_tail(drive, disk, &pc))
1141                         return 0;
1142                 if ((tape->sense_key == 2 && tape->asc == 4 && tape->ascq == 2)
1143                     || (tape->asc == 0x3A)) {
1144                         /* no media */
1145                         if (load_attempted)
1146                                 return -ENOMEDIUM;
1147                         ide_do_start_stop(drive, disk, IDETAPE_LU_LOAD_MASK);
1148                         load_attempted = 1;
1149                 /* not about to be ready */
1150                 } else if (!(tape->sense_key == 2 && tape->asc == 4 &&
1151                              (tape->ascq == 1 || tape->ascq == 8)))
1152                         return -EIO;
1153                 msleep(100);
1154         }
1155         return -EIO;
1156 }
1157
1158 static int idetape_flush_tape_buffers(ide_drive_t *drive)
1159 {
1160         struct ide_tape_obj *tape = drive->driver_data;
1161         struct ide_atapi_pc pc;
1162         int rc;
1163
1164         idetape_create_write_filemark_cmd(drive, &pc, 0);
1165         rc = ide_queue_pc_tail(drive, tape->disk, &pc);
1166         if (rc)
1167                 return rc;
1168         idetape_wait_ready(drive, 60 * 5 * HZ);
1169         return 0;
1170 }
1171
1172 static void idetape_create_read_position_cmd(struct ide_atapi_pc *pc)
1173 {
1174         ide_init_pc(pc);
1175         pc->c[0] = READ_POSITION;
1176         pc->req_xfer = 20;
1177 }
1178
1179 static int idetape_read_position(ide_drive_t *drive)
1180 {
1181         idetape_tape_t *tape = drive->driver_data;
1182         struct ide_atapi_pc pc;
1183         int position;
1184
1185         debug_log(DBG_PROCS, "Enter %s\n", __func__);
1186
1187         idetape_create_read_position_cmd(&pc);
1188         if (ide_queue_pc_tail(drive, tape->disk, &pc))
1189                 return -1;
1190         position = tape->first_frame;
1191         return position;
1192 }
1193
1194 static void idetape_create_locate_cmd(ide_drive_t *drive,
1195                 struct ide_atapi_pc *pc,
1196                 unsigned int block, u8 partition, int skip)
1197 {
1198         ide_init_pc(pc);
1199         pc->c[0] = POSITION_TO_ELEMENT;
1200         pc->c[1] = 2;
1201         put_unaligned(cpu_to_be32(block), (unsigned int *) &pc->c[3]);
1202         pc->c[8] = partition;
1203         pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1204 }
1205
1206 static void __ide_tape_discard_merge_buffer(ide_drive_t *drive)
1207 {
1208         idetape_tape_t *tape = drive->driver_data;
1209
1210         if (tape->chrdev_dir != IDETAPE_DIR_READ)
1211                 return;
1212
1213         clear_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags);
1214         tape->merge_bh_size = 0;
1215         if (tape->merge_bh != NULL) {
1216                 ide_tape_kfree_buffer(tape);
1217                 tape->merge_bh = NULL;
1218         }
1219
1220         tape->chrdev_dir = IDETAPE_DIR_NONE;
1221 }
1222
1223 /*
1224  * Position the tape to the requested block using the LOCATE packet command.
1225  * A READ POSITION command is then issued to check where we are positioned. Like
1226  * all higher level operations, we queue the commands at the tail of the request
1227  * queue and wait for their completion.
1228  */
1229 static int idetape_position_tape(ide_drive_t *drive, unsigned int block,
1230                 u8 partition, int skip)
1231 {
1232         idetape_tape_t *tape = drive->driver_data;
1233         struct gendisk *disk = tape->disk;
1234         int retval;
1235         struct ide_atapi_pc pc;
1236
1237         if (tape->chrdev_dir == IDETAPE_DIR_READ)
1238                 __ide_tape_discard_merge_buffer(drive);
1239         idetape_wait_ready(drive, 60 * 5 * HZ);
1240         idetape_create_locate_cmd(drive, &pc, block, partition, skip);
1241         retval = ide_queue_pc_tail(drive, disk, &pc);
1242         if (retval)
1243                 return (retval);
1244
1245         idetape_create_read_position_cmd(&pc);
1246         return ide_queue_pc_tail(drive, disk, &pc);
1247 }
1248
1249 static void ide_tape_discard_merge_buffer(ide_drive_t *drive,
1250                                           int restore_position)
1251 {
1252         idetape_tape_t *tape = drive->driver_data;
1253         int seek, position;
1254
1255         __ide_tape_discard_merge_buffer(drive);
1256         if (restore_position) {
1257                 position = idetape_read_position(drive);
1258                 seek = position > 0 ? position : 0;
1259                 if (idetape_position_tape(drive, seek, 0, 0)) {
1260                         printk(KERN_INFO "ide-tape: %s: position_tape failed in"
1261                                          " %s\n", tape->name, __func__);
1262                         return;
1263                 }
1264         }
1265 }
1266
1267 /*
1268  * Generate a read/write request for the block device interface and wait for it
1269  * to be serviced.
1270  */
1271 static int idetape_queue_rw_tail(ide_drive_t *drive, int cmd, int blocks,
1272                                  struct idetape_bh *bh)
1273 {
1274         idetape_tape_t *tape = drive->driver_data;
1275         struct request *rq;
1276         int ret, errors;
1277
1278         debug_log(DBG_SENSE, "%s: cmd=%d\n", __func__, cmd);
1279
1280         rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
1281         rq->cmd_type = REQ_TYPE_SPECIAL;
1282         rq->cmd[13] = cmd;
1283         rq->rq_disk = tape->disk;
1284         rq->special = (void *)bh;
1285         rq->sector = tape->first_frame;
1286         rq->nr_sectors = blocks;
1287         rq->current_nr_sectors = blocks;
1288         blk_execute_rq(drive->queue, tape->disk, rq, 0);
1289
1290         errors = rq->errors;
1291         ret = tape->blk_size * (blocks - rq->current_nr_sectors);
1292         blk_put_request(rq);
1293
1294         if ((cmd & (REQ_IDETAPE_READ | REQ_IDETAPE_WRITE)) == 0)
1295                 return 0;
1296
1297         if (tape->merge_bh)
1298                 idetape_init_merge_buffer(tape);
1299         if (errors == IDETAPE_ERROR_GENERAL)
1300                 return -EIO;
1301         return ret;
1302 }
1303
1304 static void idetape_create_inquiry_cmd(struct ide_atapi_pc *pc)
1305 {
1306         ide_init_pc(pc);
1307         pc->c[0] = INQUIRY;
1308         pc->c[4] = 254;
1309         pc->req_xfer = 254;
1310 }
1311
1312 static void idetape_create_rewind_cmd(ide_drive_t *drive,
1313                 struct ide_atapi_pc *pc)
1314 {
1315         ide_init_pc(pc);
1316         pc->c[0] = REZERO_UNIT;
1317         pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1318 }
1319
1320 static void idetape_create_erase_cmd(struct ide_atapi_pc *pc)
1321 {
1322         ide_init_pc(pc);
1323         pc->c[0] = ERASE;
1324         pc->c[1] = 1;
1325         pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1326 }
1327
1328 static void idetape_create_space_cmd(struct ide_atapi_pc *pc, int count, u8 cmd)
1329 {
1330         ide_init_pc(pc);
1331         pc->c[0] = SPACE;
1332         put_unaligned(cpu_to_be32(count), (unsigned int *) &pc->c[1]);
1333         pc->c[1] = cmd;
1334         pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1335 }
1336
1337 /* Queue up a character device originated write request. */
1338 static int idetape_add_chrdev_write_request(ide_drive_t *drive, int blocks)
1339 {
1340         idetape_tape_t *tape = drive->driver_data;
1341
1342         debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
1343
1344         return idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE,
1345                                      blocks, tape->merge_bh);
1346 }
1347
1348 static void ide_tape_flush_merge_buffer(ide_drive_t *drive)
1349 {
1350         idetape_tape_t *tape = drive->driver_data;
1351         int blocks, min;
1352         struct idetape_bh *bh;
1353
1354         if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
1355                 printk(KERN_ERR "ide-tape: bug: Trying to empty merge buffer"
1356                                 " but we are not writing.\n");
1357                 return;
1358         }
1359         if (tape->merge_bh_size > tape->buffer_size) {
1360                 printk(KERN_ERR "ide-tape: bug: merge_buffer too big\n");
1361                 tape->merge_bh_size = tape->buffer_size;
1362         }
1363         if (tape->merge_bh_size) {
1364                 blocks = tape->merge_bh_size / tape->blk_size;
1365                 if (tape->merge_bh_size % tape->blk_size) {
1366                         unsigned int i;
1367
1368                         blocks++;
1369                         i = tape->blk_size - tape->merge_bh_size %
1370                                 tape->blk_size;
1371                         bh = tape->bh->b_reqnext;
1372                         while (bh) {
1373                                 atomic_set(&bh->b_count, 0);
1374                                 bh = bh->b_reqnext;
1375                         }
1376                         bh = tape->bh;
1377                         while (i) {
1378                                 if (bh == NULL) {
1379                                         printk(KERN_INFO "ide-tape: bug,"
1380                                                          " bh NULL\n");
1381                                         break;
1382                                 }
1383                                 min = min(i, (unsigned int)(bh->b_size -
1384                                                 atomic_read(&bh->b_count)));
1385                                 memset(bh->b_data + atomic_read(&bh->b_count),
1386                                                 0, min);
1387                                 atomic_add(min, &bh->b_count);
1388                                 i -= min;
1389                                 bh = bh->b_reqnext;
1390                         }
1391                 }
1392                 (void) idetape_add_chrdev_write_request(drive, blocks);
1393                 tape->merge_bh_size = 0;
1394         }
1395         if (tape->merge_bh != NULL) {
1396                 ide_tape_kfree_buffer(tape);
1397                 tape->merge_bh = NULL;
1398         }
1399         tape->chrdev_dir = IDETAPE_DIR_NONE;
1400 }
1401
1402 static int idetape_init_read(ide_drive_t *drive)
1403 {
1404         idetape_tape_t *tape = drive->driver_data;
1405         int bytes_read;
1406
1407         /* Initialize read operation */
1408         if (tape->chrdev_dir != IDETAPE_DIR_READ) {
1409                 if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
1410                         ide_tape_flush_merge_buffer(drive);
1411                         idetape_flush_tape_buffers(drive);
1412                 }
1413                 if (tape->merge_bh || tape->merge_bh_size) {
1414                         printk(KERN_ERR "ide-tape: merge_bh_size should be"
1415                                          " 0 now\n");
1416                         tape->merge_bh_size = 0;
1417                 }
1418                 tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
1419                 if (!tape->merge_bh)
1420                         return -ENOMEM;
1421                 tape->chrdev_dir = IDETAPE_DIR_READ;
1422
1423                 /*
1424                  * Issue a read 0 command to ensure that DSC handshake is
1425                  * switched from completion mode to buffer available mode.
1426                  * No point in issuing this if DSC overlap isn't supported, some
1427                  * drives (Seagate STT3401A) will return an error.
1428                  */
1429                 if (drive->dsc_overlap) {
1430                         bytes_read = idetape_queue_rw_tail(drive,
1431                                                         REQ_IDETAPE_READ, 0,
1432                                                         tape->merge_bh);
1433                         if (bytes_read < 0) {
1434                                 ide_tape_kfree_buffer(tape);
1435                                 tape->merge_bh = NULL;
1436                                 tape->chrdev_dir = IDETAPE_DIR_NONE;
1437                                 return bytes_read;
1438                         }
1439                 }
1440         }
1441
1442         return 0;
1443 }
1444
1445 /* called from idetape_chrdev_read() to service a chrdev read request. */
1446 static int idetape_add_chrdev_read_request(ide_drive_t *drive, int blocks)
1447 {
1448         idetape_tape_t *tape = drive->driver_data;
1449
1450         debug_log(DBG_PROCS, "Enter %s, %d blocks\n", __func__, blocks);
1451
1452         /* If we are at a filemark, return a read length of 0 */
1453         if (test_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags))
1454                 return 0;
1455
1456         idetape_init_read(drive);
1457
1458         return idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, blocks,
1459                                      tape->merge_bh);
1460 }
1461
1462 static void idetape_pad_zeros(ide_drive_t *drive, int bcount)
1463 {
1464         idetape_tape_t *tape = drive->driver_data;
1465         struct idetape_bh *bh;
1466         int blocks;
1467
1468         while (bcount) {
1469                 unsigned int count;
1470
1471                 bh = tape->merge_bh;
1472                 count = min(tape->buffer_size, bcount);
1473                 bcount -= count;
1474                 blocks = count / tape->blk_size;
1475                 while (count) {
1476                         atomic_set(&bh->b_count,
1477                                    min(count, (unsigned int)bh->b_size));
1478                         memset(bh->b_data, 0, atomic_read(&bh->b_count));
1479                         count -= atomic_read(&bh->b_count);
1480                         bh = bh->b_reqnext;
1481                 }
1482                 idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks,
1483                                       tape->merge_bh);
1484         }
1485 }
1486
1487 /*
1488  * Rewinds the tape to the Beginning Of the current Partition (BOP). We
1489  * currently support only one partition.
1490  */
1491 static int idetape_rewind_tape(ide_drive_t *drive)
1492 {
1493         struct ide_tape_obj *tape = drive->driver_data;
1494         struct gendisk *disk = tape->disk;
1495         int retval;
1496         struct ide_atapi_pc pc;
1497
1498         debug_log(DBG_SENSE, "Enter %s\n", __func__);
1499
1500         idetape_create_rewind_cmd(drive, &pc);
1501         retval = ide_queue_pc_tail(drive, disk, &pc);
1502         if (retval)
1503                 return retval;
1504
1505         idetape_create_read_position_cmd(&pc);
1506         retval = ide_queue_pc_tail(drive, disk, &pc);
1507         if (retval)
1508                 return retval;
1509         return 0;
1510 }
1511
1512 /* mtio.h compatible commands should be issued to the chrdev interface. */
1513 static int idetape_blkdev_ioctl(ide_drive_t *drive, unsigned int cmd,
1514                                 unsigned long arg)
1515 {
1516         idetape_tape_t *tape = drive->driver_data;
1517         void __user *argp = (void __user *)arg;
1518
1519         struct idetape_config {
1520                 int dsc_rw_frequency;
1521                 int dsc_media_access_frequency;
1522                 int nr_stages;
1523         } config;
1524
1525         debug_log(DBG_PROCS, "Enter %s\n", __func__);
1526
1527         switch (cmd) {
1528         case 0x0340:
1529                 if (copy_from_user(&config, argp, sizeof(config)))
1530                         return -EFAULT;
1531                 tape->best_dsc_rw_freq = config.dsc_rw_frequency;
1532                 break;
1533         case 0x0350:
1534                 config.dsc_rw_frequency = (int) tape->best_dsc_rw_freq;
1535                 config.nr_stages = 1;
1536                 if (copy_to_user(argp, &config, sizeof(config)))
1537                         return -EFAULT;
1538                 break;
1539         default:
1540                 return -EIO;
1541         }
1542         return 0;
1543 }
1544
1545 static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op,
1546                                         int mt_count)
1547 {
1548         idetape_tape_t *tape = drive->driver_data;
1549         struct gendisk *disk = tape->disk;
1550         struct ide_atapi_pc pc;
1551         int retval, count = 0;
1552         int sprev = !!(tape->caps[4] & 0x20);
1553
1554         if (mt_count == 0)
1555                 return 0;
1556         if (MTBSF == mt_op || MTBSFM == mt_op) {
1557                 if (!sprev)
1558                         return -EIO;
1559                 mt_count = -mt_count;
1560         }
1561
1562         if (tape->chrdev_dir == IDETAPE_DIR_READ) {
1563                 tape->merge_bh_size = 0;
1564                 if (test_and_clear_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags))
1565                         ++count;
1566                 ide_tape_discard_merge_buffer(drive, 0);
1567         }
1568
1569         switch (mt_op) {
1570         case MTFSF:
1571         case MTBSF:
1572                 idetape_create_space_cmd(&pc, mt_count - count,
1573                                          IDETAPE_SPACE_OVER_FILEMARK);
1574                 return ide_queue_pc_tail(drive, disk, &pc);
1575         case MTFSFM:
1576         case MTBSFM:
1577                 if (!sprev)
1578                         return -EIO;
1579                 retval = idetape_space_over_filemarks(drive, MTFSF,
1580                                                       mt_count - count);
1581                 if (retval)
1582                         return retval;
1583                 count = (MTBSFM == mt_op ? 1 : -1);
1584                 return idetape_space_over_filemarks(drive, MTFSF, count);
1585         default:
1586                 printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",
1587                                 mt_op);
1588                 return -EIO;
1589         }
1590 }
1591
1592 /*
1593  * Our character device read / write functions.
1594  *
1595  * The tape is optimized to maximize throughput when it is transferring an
1596  * integral number of the "continuous transfer limit", which is a parameter of
1597  * the specific tape (26kB on my particular tape, 32kB for Onstream).
1598  *
1599  * As of version 1.3 of the driver, the character device provides an abstract
1600  * continuous view of the media - any mix of block sizes (even 1 byte) on the
1601  * same backup/restore procedure is supported. The driver will internally
1602  * convert the requests to the recommended transfer unit, so that an unmatch
1603  * between the user's block size to the recommended size will only result in a
1604  * (slightly) increased driver overhead, but will no longer hit performance.
1605  * This is not applicable to Onstream.
1606  */
1607 static ssize_t idetape_chrdev_read(struct file *file, char __user *buf,
1608                                    size_t count, loff_t *ppos)
1609 {
1610         struct ide_tape_obj *tape = ide_tape_f(file);
1611         ide_drive_t *drive = tape->drive;
1612         ssize_t bytes_read, temp, actually_read = 0, rc;
1613         ssize_t ret = 0;
1614         u16 ctl = *(u16 *)&tape->caps[12];
1615
1616         debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
1617
1618         if (tape->chrdev_dir != IDETAPE_DIR_READ) {
1619                 if (test_bit(IDE_AFLAG_DETECT_BS, &drive->atapi_flags))
1620                         if (count > tape->blk_size &&
1621                             (count % tape->blk_size) == 0)
1622                                 tape->user_bs_factor = count / tape->blk_size;
1623         }
1624         rc = idetape_init_read(drive);
1625         if (rc < 0)
1626                 return rc;
1627         if (count == 0)
1628                 return (0);
1629         if (tape->merge_bh_size) {
1630                 actually_read = min((unsigned int)(tape->merge_bh_size),
1631                                     (unsigned int)count);
1632                 if (idetape_copy_stage_to_user(tape, buf, actually_read))
1633                         ret = -EFAULT;
1634                 buf += actually_read;
1635                 tape->merge_bh_size -= actually_read;
1636                 count -= actually_read;
1637         }
1638         while (count >= tape->buffer_size) {
1639                 bytes_read = idetape_add_chrdev_read_request(drive, ctl);
1640                 if (bytes_read <= 0)
1641                         goto finish;
1642                 if (idetape_copy_stage_to_user(tape, buf, bytes_read))
1643                         ret = -EFAULT;
1644                 buf += bytes_read;
1645                 count -= bytes_read;
1646                 actually_read += bytes_read;
1647         }
1648         if (count) {
1649                 bytes_read = idetape_add_chrdev_read_request(drive, ctl);
1650                 if (bytes_read <= 0)
1651                         goto finish;
1652                 temp = min((unsigned long)count, (unsigned long)bytes_read);
1653                 if (idetape_copy_stage_to_user(tape, buf, temp))
1654                         ret = -EFAULT;
1655                 actually_read += temp;
1656                 tape->merge_bh_size = bytes_read-temp;
1657         }
1658 finish:
1659         if (!actually_read && test_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags)) {
1660                 debug_log(DBG_SENSE, "%s: spacing over filemark\n", tape->name);
1661
1662                 idetape_space_over_filemarks(drive, MTFSF, 1);
1663                 return 0;
1664         }
1665
1666         return ret ? ret : actually_read;
1667 }
1668
1669 static ssize_t idetape_chrdev_write(struct file *file, const char __user *buf,
1670                                      size_t count, loff_t *ppos)
1671 {
1672         struct ide_tape_obj *tape = ide_tape_f(file);
1673         ide_drive_t *drive = tape->drive;
1674         ssize_t actually_written = 0;
1675         ssize_t ret = 0;
1676         u16 ctl = *(u16 *)&tape->caps[12];
1677
1678         /* The drive is write protected. */
1679         if (tape->write_prot)
1680                 return -EACCES;
1681
1682         debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
1683
1684         /* Initialize write operation */
1685         if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
1686                 if (tape->chrdev_dir == IDETAPE_DIR_READ)
1687                         ide_tape_discard_merge_buffer(drive, 1);
1688                 if (tape->merge_bh || tape->merge_bh_size) {
1689                         printk(KERN_ERR "ide-tape: merge_bh_size "
1690                                 "should be 0 now\n");
1691                         tape->merge_bh_size = 0;
1692                 }
1693                 tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
1694                 if (!tape->merge_bh)
1695                         return -ENOMEM;
1696                 tape->chrdev_dir = IDETAPE_DIR_WRITE;
1697                 idetape_init_merge_buffer(tape);
1698
1699                 /*
1700                  * Issue a write 0 command to ensure that DSC handshake is
1701                  * switched from completion mode to buffer available mode. No
1702                  * point in issuing this if DSC overlap isn't supported, some
1703                  * drives (Seagate STT3401A) will return an error.
1704                  */
1705                 if (drive->dsc_overlap) {
1706                         ssize_t retval = idetape_queue_rw_tail(drive,
1707                                                         REQ_IDETAPE_WRITE, 0,
1708                                                         tape->merge_bh);
1709                         if (retval < 0) {
1710                                 ide_tape_kfree_buffer(tape);
1711                                 tape->merge_bh = NULL;
1712                                 tape->chrdev_dir = IDETAPE_DIR_NONE;
1713                                 return retval;
1714                         }
1715                 }
1716         }
1717         if (count == 0)
1718                 return (0);
1719         if (tape->merge_bh_size) {
1720                 if (tape->merge_bh_size >= tape->buffer_size) {
1721                         printk(KERN_ERR "ide-tape: bug: merge buf too big\n");
1722                         tape->merge_bh_size = 0;
1723                 }
1724                 actually_written = min((unsigned int)
1725                                 (tape->buffer_size - tape->merge_bh_size),
1726                                 (unsigned int)count);
1727                 if (idetape_copy_stage_from_user(tape, buf, actually_written))
1728                                 ret = -EFAULT;
1729                 buf += actually_written;
1730                 tape->merge_bh_size += actually_written;
1731                 count -= actually_written;
1732
1733                 if (tape->merge_bh_size == tape->buffer_size) {
1734                         ssize_t retval;
1735                         tape->merge_bh_size = 0;
1736                         retval = idetape_add_chrdev_write_request(drive, ctl);
1737                         if (retval <= 0)
1738                                 return (retval);
1739                 }
1740         }
1741         while (count >= tape->buffer_size) {
1742                 ssize_t retval;
1743                 if (idetape_copy_stage_from_user(tape, buf, tape->buffer_size))
1744                         ret = -EFAULT;
1745                 buf += tape->buffer_size;
1746                 count -= tape->buffer_size;
1747                 retval = idetape_add_chrdev_write_request(drive, ctl);
1748                 actually_written += tape->buffer_size;
1749                 if (retval <= 0)
1750                         return (retval);
1751         }
1752         if (count) {
1753                 actually_written += count;
1754                 if (idetape_copy_stage_from_user(tape, buf, count))
1755                         ret = -EFAULT;
1756                 tape->merge_bh_size += count;
1757         }
1758         return ret ? ret : actually_written;
1759 }
1760
1761 static int idetape_write_filemark(ide_drive_t *drive)
1762 {
1763         struct ide_tape_obj *tape = drive->driver_data;
1764         struct ide_atapi_pc pc;
1765
1766         /* Write a filemark */
1767         idetape_create_write_filemark_cmd(drive, &pc, 1);
1768         if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
1769                 printk(KERN_ERR "ide-tape: Couldn't write a filemark\n");
1770                 return -EIO;
1771         }
1772         return 0;
1773 }
1774
1775 /*
1776  * Called from idetape_chrdev_ioctl when the general mtio MTIOCTOP ioctl is
1777  * requested.
1778  *
1779  * Note: MTBSF and MTBSFM are not supported when the tape doesn't support
1780  * spacing over filemarks in the reverse direction. In this case, MTFSFM is also
1781  * usually not supported.
1782  *
1783  * The following commands are currently not supported:
1784  *
1785  * MTFSS, MTBSS, MTWSM, MTSETDENSITY, MTSETDRVBUFFER, MT_ST_BOOLEANS,
1786  * MT_ST_WRITE_THRESHOLD.
1787  */
1788 static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
1789 {
1790         idetape_tape_t *tape = drive->driver_data;
1791         struct gendisk *disk = tape->disk;
1792         struct ide_atapi_pc pc;
1793         int i, retval;
1794
1795         debug_log(DBG_ERR, "Handling MTIOCTOP ioctl: mt_op=%d, mt_count=%d\n",
1796                         mt_op, mt_count);
1797
1798         switch (mt_op) {
1799         case MTFSF:
1800         case MTFSFM:
1801         case MTBSF:
1802         case MTBSFM:
1803                 if (!mt_count)
1804                         return 0;
1805                 return idetape_space_over_filemarks(drive, mt_op, mt_count);
1806         default:
1807                 break;
1808         }
1809
1810         switch (mt_op) {
1811         case MTWEOF:
1812                 if (tape->write_prot)
1813                         return -EACCES;
1814                 ide_tape_discard_merge_buffer(drive, 1);
1815                 for (i = 0; i < mt_count; i++) {
1816                         retval = idetape_write_filemark(drive);
1817                         if (retval)
1818                                 return retval;
1819                 }
1820                 return 0;
1821         case MTREW:
1822                 ide_tape_discard_merge_buffer(drive, 0);
1823                 if (idetape_rewind_tape(drive))
1824                         return -EIO;
1825                 return 0;
1826         case MTLOAD:
1827                 ide_tape_discard_merge_buffer(drive, 0);
1828                 return ide_do_start_stop(drive, disk, IDETAPE_LU_LOAD_MASK);
1829         case MTUNLOAD:
1830         case MTOFFL:
1831                 /*
1832                  * If door is locked, attempt to unlock before
1833                  * attempting to eject.
1834                  */
1835                 if (tape->door_locked) {
1836                         if (!ide_set_media_lock(drive, disk, 0))
1837                                 tape->door_locked = DOOR_UNLOCKED;
1838                 }
1839                 ide_tape_discard_merge_buffer(drive, 0);
1840                 retval = ide_do_start_stop(drive, disk, !IDETAPE_LU_LOAD_MASK);
1841                 if (!retval)
1842                         clear_bit(IDE_AFLAG_MEDIUM_PRESENT, &drive->atapi_flags);
1843                 return retval;
1844         case MTNOP:
1845                 ide_tape_discard_merge_buffer(drive, 0);
1846                 return idetape_flush_tape_buffers(drive);
1847         case MTRETEN:
1848                 ide_tape_discard_merge_buffer(drive, 0);
1849                 return ide_do_start_stop(drive, disk,
1850                         IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK);
1851         case MTEOM:
1852                 idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD);
1853                 return ide_queue_pc_tail(drive, disk, &pc);
1854         case MTERASE:
1855                 (void)idetape_rewind_tape(drive);
1856                 idetape_create_erase_cmd(&pc);
1857                 return ide_queue_pc_tail(drive, disk, &pc);
1858         case MTSETBLK:
1859                 if (mt_count) {
1860                         if (mt_count < tape->blk_size ||
1861                             mt_count % tape->blk_size)
1862                                 return -EIO;
1863                         tape->user_bs_factor = mt_count / tape->blk_size;
1864                         clear_bit(IDE_AFLAG_DETECT_BS, &drive->atapi_flags);
1865                 } else
1866                         set_bit(IDE_AFLAG_DETECT_BS, &drive->atapi_flags);
1867                 return 0;
1868         case MTSEEK:
1869                 ide_tape_discard_merge_buffer(drive, 0);
1870                 return idetape_position_tape(drive,
1871                         mt_count * tape->user_bs_factor, tape->partition, 0);
1872         case MTSETPART:
1873                 ide_tape_discard_merge_buffer(drive, 0);
1874                 return idetape_position_tape(drive, 0, mt_count, 0);
1875         case MTFSR:
1876         case MTBSR:
1877         case MTLOCK:
1878                 retval = ide_set_media_lock(drive, disk, 1);
1879                 if (retval)
1880                         return retval;
1881                 tape->door_locked = DOOR_EXPLICITLY_LOCKED;
1882                 return 0;
1883         case MTUNLOCK:
1884                 retval = ide_set_media_lock(drive, disk, 0);
1885                 if (retval)
1886                         return retval;
1887                 tape->door_locked = DOOR_UNLOCKED;
1888                 return 0;
1889         default:
1890                 printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",
1891                                 mt_op);
1892                 return -EIO;
1893         }
1894 }
1895
1896 /*
1897  * Our character device ioctls. General mtio.h magnetic io commands are
1898  * supported here, and not in the corresponding block interface. Our own
1899  * ide-tape ioctls are supported on both interfaces.
1900  */
1901 static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
1902                                 unsigned int cmd, unsigned long arg)
1903 {
1904         struct ide_tape_obj *tape = ide_tape_f(file);
1905         ide_drive_t *drive = tape->drive;
1906         struct mtop mtop;
1907         struct mtget mtget;
1908         struct mtpos mtpos;
1909         int block_offset = 0, position = tape->first_frame;
1910         void __user *argp = (void __user *)arg;
1911
1912         debug_log(DBG_CHRDEV, "Enter %s, cmd=%u\n", __func__, cmd);
1913
1914         if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
1915                 ide_tape_flush_merge_buffer(drive);
1916                 idetape_flush_tape_buffers(drive);
1917         }
1918         if (cmd == MTIOCGET || cmd == MTIOCPOS) {
1919                 block_offset = tape->merge_bh_size /
1920                         (tape->blk_size * tape->user_bs_factor);
1921                 position = idetape_read_position(drive);
1922                 if (position < 0)
1923                         return -EIO;
1924         }
1925         switch (cmd) {
1926         case MTIOCTOP:
1927                 if (copy_from_user(&mtop, argp, sizeof(struct mtop)))
1928                         return -EFAULT;
1929                 return idetape_mtioctop(drive, mtop.mt_op, mtop.mt_count);
1930         case MTIOCGET:
1931                 memset(&mtget, 0, sizeof(struct mtget));
1932                 mtget.mt_type = MT_ISSCSI2;
1933                 mtget.mt_blkno = position / tape->user_bs_factor - block_offset;
1934                 mtget.mt_dsreg =
1935                         ((tape->blk_size * tape->user_bs_factor)
1936                          << MT_ST_BLKSIZE_SHIFT) & MT_ST_BLKSIZE_MASK;
1937
1938                 if (tape->drv_write_prot)
1939                         mtget.mt_gstat |= GMT_WR_PROT(0xffffffff);
1940
1941                 if (copy_to_user(argp, &mtget, sizeof(struct mtget)))
1942                         return -EFAULT;
1943                 return 0;
1944         case MTIOCPOS:
1945                 mtpos.mt_blkno = position / tape->user_bs_factor - block_offset;
1946                 if (copy_to_user(argp, &mtpos, sizeof(struct mtpos)))
1947                         return -EFAULT;
1948                 return 0;
1949         default:
1950                 if (tape->chrdev_dir == IDETAPE_DIR_READ)
1951                         ide_tape_discard_merge_buffer(drive, 1);
1952                 return idetape_blkdev_ioctl(drive, cmd, arg);
1953         }
1954 }
1955
1956 /*
1957  * Do a mode sense page 0 with block descriptor and if it succeeds set the tape
1958  * block size with the reported value.
1959  */
1960 static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive)
1961 {
1962         idetape_tape_t *tape = drive->driver_data;
1963         struct ide_atapi_pc pc;
1964
1965         idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR);
1966         if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
1967                 printk(KERN_ERR "ide-tape: Can't get block descriptor\n");
1968                 if (tape->blk_size == 0) {
1969                         printk(KERN_WARNING "ide-tape: Cannot deal with zero "
1970                                             "block size, assuming 32k\n");
1971                         tape->blk_size = 32768;
1972                 }
1973                 return;
1974         }
1975         tape->blk_size = (pc.buf[4 + 5] << 16) +
1976                                 (pc.buf[4 + 6] << 8)  +
1977                                  pc.buf[4 + 7];
1978         tape->drv_write_prot = (pc.buf[2] & 0x80) >> 7;
1979 }
1980
1981 static int idetape_chrdev_open(struct inode *inode, struct file *filp)
1982 {
1983         unsigned int minor = iminor(inode), i = minor & ~0xc0;
1984         ide_drive_t *drive;
1985         idetape_tape_t *tape;
1986         int retval;
1987
1988         if (i >= MAX_HWIFS * MAX_DRIVES)
1989                 return -ENXIO;
1990
1991         lock_kernel();
1992         tape = ide_tape_chrdev_get(i);
1993         if (!tape) {
1994                 unlock_kernel();
1995                 return -ENXIO;
1996         }
1997
1998         debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
1999
2000         /*
2001          * We really want to do nonseekable_open(inode, filp); here, but some
2002          * versions of tar incorrectly call lseek on tapes and bail out if that
2003          * fails.  So we disallow pread() and pwrite(), but permit lseeks.
2004          */
2005         filp->f_mode &= ~(FMODE_PREAD | FMODE_PWRITE);
2006
2007         drive = tape->drive;
2008
2009         filp->private_data = tape;
2010
2011         if (test_and_set_bit(IDE_AFLAG_BUSY, &drive->atapi_flags)) {
2012                 retval = -EBUSY;
2013                 goto out_put_tape;
2014         }
2015
2016         retval = idetape_wait_ready(drive, 60 * HZ);
2017         if (retval) {
2018                 clear_bit(IDE_AFLAG_BUSY, &drive->atapi_flags);
2019                 printk(KERN_ERR "ide-tape: %s: drive not ready\n", tape->name);
2020                 goto out_put_tape;
2021         }
2022
2023         idetape_read_position(drive);
2024         if (!test_bit(IDE_AFLAG_ADDRESS_VALID, &drive->atapi_flags))
2025                 (void)idetape_rewind_tape(drive);
2026
2027         /* Read block size and write protect status from drive. */
2028         ide_tape_get_bsize_from_bdesc(drive);
2029
2030         /* Set write protect flag if device is opened as read-only. */
2031         if ((filp->f_flags & O_ACCMODE) == O_RDONLY)
2032                 tape->write_prot = 1;
2033         else
2034                 tape->write_prot = tape->drv_write_prot;
2035
2036         /* Make sure drive isn't write protected if user wants to write. */
2037         if (tape->write_prot) {
2038                 if ((filp->f_flags & O_ACCMODE) == O_WRONLY ||
2039                     (filp->f_flags & O_ACCMODE) == O_RDWR) {
2040                         clear_bit(IDE_AFLAG_BUSY, &drive->atapi_flags);
2041                         retval = -EROFS;
2042                         goto out_put_tape;
2043                 }
2044         }
2045
2046         /* Lock the tape drive door so user can't eject. */
2047         if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
2048                 if (!ide_set_media_lock(drive, tape->disk, 1)) {
2049                         if (tape->door_locked != DOOR_EXPLICITLY_LOCKED)
2050                                 tape->door_locked = DOOR_LOCKED;
2051                 }
2052         }
2053         unlock_kernel();
2054         return 0;
2055
2056 out_put_tape:
2057         ide_tape_put(tape);
2058         unlock_kernel();
2059         return retval;
2060 }
2061
2062 static void idetape_write_release(ide_drive_t *drive, unsigned int minor)
2063 {
2064         idetape_tape_t *tape = drive->driver_data;
2065
2066         ide_tape_flush_merge_buffer(drive);
2067         tape->merge_bh = ide_tape_kmalloc_buffer(tape, 1, 0);
2068         if (tape->merge_bh != NULL) {
2069                 idetape_pad_zeros(drive, tape->blk_size *
2070                                 (tape->user_bs_factor - 1));
2071                 ide_tape_kfree_buffer(tape);
2072                 tape->merge_bh = NULL;
2073         }
2074         idetape_write_filemark(drive);
2075         idetape_flush_tape_buffers(drive);
2076         idetape_flush_tape_buffers(drive);
2077 }
2078
2079 static int idetape_chrdev_release(struct inode *inode, struct file *filp)
2080 {
2081         struct ide_tape_obj *tape = ide_tape_f(filp);
2082         ide_drive_t *drive = tape->drive;
2083         unsigned int minor = iminor(inode);
2084
2085         lock_kernel();
2086         tape = drive->driver_data;
2087
2088         debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
2089
2090         if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
2091                 idetape_write_release(drive, minor);
2092         if (tape->chrdev_dir == IDETAPE_DIR_READ) {
2093                 if (minor < 128)
2094                         ide_tape_discard_merge_buffer(drive, 1);
2095         }
2096
2097         if (minor < 128 && test_bit(IDE_AFLAG_MEDIUM_PRESENT, &drive->atapi_flags))
2098                 (void) idetape_rewind_tape(drive);
2099         if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
2100                 if (tape->door_locked == DOOR_LOCKED) {
2101                         if (!ide_set_media_lock(drive, tape->disk, 0))
2102                                 tape->door_locked = DOOR_UNLOCKED;
2103                 }
2104         }
2105         clear_bit(IDE_AFLAG_BUSY, &drive->atapi_flags);
2106         ide_tape_put(tape);
2107         unlock_kernel();
2108         return 0;
2109 }
2110
2111 static void idetape_get_inquiry_results(ide_drive_t *drive)
2112 {
2113         idetape_tape_t *tape = drive->driver_data;
2114         struct ide_atapi_pc pc;
2115         char fw_rev[4], vendor_id[8], product_id[16];
2116
2117         idetape_create_inquiry_cmd(&pc);
2118         if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
2119                 printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
2120                                 tape->name);
2121                 return;
2122         }
2123         memcpy(vendor_id, &pc.buf[8], 8);
2124         memcpy(product_id, &pc.buf[16], 16);
2125         memcpy(fw_rev, &pc.buf[32], 4);
2126
2127         ide_fixstring(vendor_id, 8, 0);
2128         ide_fixstring(product_id, 16, 0);
2129         ide_fixstring(fw_rev, 4, 0);
2130
2131         printk(KERN_INFO "ide-tape: %s <-> %s: %.8s %.16s rev %.4s\n",
2132                         drive->name, tape->name, vendor_id, product_id, fw_rev);
2133 }
2134
2135 /*
2136  * Ask the tape about its various parameters. In particular, we will adjust our
2137  * data transfer buffer size to the recommended value as returned by the tape.
2138  */
2139 static void idetape_get_mode_sense_results(ide_drive_t *drive)
2140 {
2141         idetape_tape_t *tape = drive->driver_data;
2142         struct ide_atapi_pc pc;
2143         u8 *caps;
2144         u8 speed, max_speed;
2145
2146         idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
2147         if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
2148                 printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
2149                                 " some default values\n");
2150                 tape->blk_size = 512;
2151                 put_unaligned(52,   (u16 *)&tape->caps[12]);
2152                 put_unaligned(540,  (u16 *)&tape->caps[14]);
2153                 put_unaligned(6*52, (u16 *)&tape->caps[16]);
2154                 return;
2155         }
2156         caps = pc.buf + 4 + pc.buf[3];
2157
2158         /* convert to host order and save for later use */
2159         speed = be16_to_cpup((__be16 *)&caps[14]);
2160         max_speed = be16_to_cpup((__be16 *)&caps[8]);
2161
2162         *(u16 *)&caps[8] = max_speed;
2163         *(u16 *)&caps[12] = be16_to_cpup((__be16 *)&caps[12]);
2164         *(u16 *)&caps[14] = speed;
2165         *(u16 *)&caps[16] = be16_to_cpup((__be16 *)&caps[16]);
2166
2167         if (!speed) {
2168                 printk(KERN_INFO "ide-tape: %s: invalid tape speed "
2169                                 "(assuming 650KB/sec)\n", drive->name);
2170                 *(u16 *)&caps[14] = 650;
2171         }
2172         if (!max_speed) {
2173                 printk(KERN_INFO "ide-tape: %s: invalid max_speed "
2174                                 "(assuming 650KB/sec)\n", drive->name);
2175                 *(u16 *)&caps[8] = 650;
2176         }
2177
2178         memcpy(&tape->caps, caps, 20);
2179
2180         /* device lacks locking support according to capabilities page */
2181         if ((caps[6] & 1) == 0)
2182                 drive->atapi_flags |= IDE_AFLAG_NO_DOORLOCK;
2183
2184         if (caps[7] & 0x02)
2185                 tape->blk_size = 512;
2186         else if (caps[7] & 0x04)
2187                 tape->blk_size = 1024;
2188 }
2189
2190 #ifdef CONFIG_IDE_PROC_FS
2191 #define ide_tape_devset_get(name, field) \
2192 static int get_##name(ide_drive_t *drive) \
2193 { \
2194         idetape_tape_t *tape = drive->driver_data; \
2195         return tape->field; \
2196 }
2197
2198 #define ide_tape_devset_set(name, field) \
2199 static int set_##name(ide_drive_t *drive, int arg) \
2200 { \
2201         idetape_tape_t *tape = drive->driver_data; \
2202         tape->field = arg; \
2203         return 0; \
2204 }
2205
2206 #define ide_tape_devset_rw(_name, _min, _max, _field, _mulf, _divf) \
2207 ide_tape_devset_get(_name, _field) \
2208 ide_tape_devset_set(_name, _field) \
2209 __IDE_DEVSET(_name, S_RW, _min, _max, get_##_name, set_##_name, _mulf, _divf)
2210
2211 #define ide_tape_devset_r(_name, _min, _max, _field, _mulf, _divf) \
2212 ide_tape_devset_get(_name, _field) \
2213 __IDE_DEVSET(_name, S_READ, _min, _max, get_##_name, NULL, _mulf, _divf)
2214
2215 static int mulf_tdsc(ide_drive_t *drive)        { return 1000; }
2216 static int divf_tdsc(ide_drive_t *drive)        { return   HZ; }
2217 static int divf_buffer(ide_drive_t *drive)      { return    2; }
2218 static int divf_buffer_size(ide_drive_t *drive) { return 1024; }
2219
2220 ide_devset_rw(dsc_overlap,      0,      1, dsc_overlap);
2221
2222 ide_tape_devset_rw(debug_mask,  0, 0xffff, debug_mask,  NULL, NULL);
2223 ide_tape_devset_rw(tdsc, IDETAPE_DSC_RW_MIN, IDETAPE_DSC_RW_MAX,
2224                    best_dsc_rw_freq, mulf_tdsc, divf_tdsc);
2225
2226 ide_tape_devset_r(avg_speed,    0, 0xffff, avg_speed,   NULL, NULL);
2227 ide_tape_devset_r(speed,        0, 0xffff, caps[14],    NULL, NULL);
2228 ide_tape_devset_r(buffer,       0, 0xffff, caps[16],    NULL, divf_buffer);
2229 ide_tape_devset_r(buffer_size,  0, 0xffff, buffer_size, NULL, divf_buffer_size);
2230
2231 static const struct ide_devset *idetape_settings[] = {
2232         &ide_devset_avg_speed,
2233         &ide_devset_buffer,
2234         &ide_devset_buffer_size,
2235         &ide_devset_debug_mask,
2236         &ide_devset_dsc_overlap,
2237         &ide_devset_speed,
2238         &ide_devset_tdsc,
2239         NULL
2240 };
2241 #endif
2242
2243 /*
2244  * The function below is called to:
2245  *
2246  * 1. Initialize our various state variables.
2247  * 2. Ask the tape for its capabilities.
2248  * 3. Allocate a buffer which will be used for data transfer. The buffer size
2249  * is chosen based on the recommendation which we received in step 2.
2250  *
2251  * Note that at this point ide.c already assigned us an irq, so that we can
2252  * queue requests here and wait for their completion.
2253  */
2254 static void idetape_setup(ide_drive_t *drive, idetape_tape_t *tape, int minor)
2255 {
2256         unsigned long t;
2257         int speed;
2258         int buffer_size;
2259         u8 gcw[2];
2260         u16 *ctl = (u16 *)&tape->caps[12];
2261
2262         drive->pc_callback = ide_tape_callback;
2263
2264         spin_lock_init(&tape->lock);
2265         drive->dsc_overlap = 1;
2266         if (drive->hwif->host_flags & IDE_HFLAG_NO_DSC) {
2267                 printk(KERN_INFO "ide-tape: %s: disabling DSC overlap\n",
2268                                  tape->name);
2269                 drive->dsc_overlap = 0;
2270         }
2271         /* Seagate Travan drives do not support DSC overlap. */
2272         if (strstr((char *)&drive->id[ATA_ID_PROD], "Seagate STT3401"))
2273                 drive->dsc_overlap = 0;
2274         tape->minor = minor;
2275         tape->name[0] = 'h';
2276         tape->name[1] = 't';
2277         tape->name[2] = '0' + minor;
2278         tape->chrdev_dir = IDETAPE_DIR_NONE;
2279
2280         *((u16 *)&gcw) = drive->id[ATA_ID_CONFIG];
2281
2282         /* Command packet DRQ type */
2283         if (((gcw[0] & 0x60) >> 5) == 1)
2284                 set_bit(IDE_AFLAG_DRQ_INTERRUPT, &drive->atapi_flags);
2285
2286         idetape_get_inquiry_results(drive);
2287         idetape_get_mode_sense_results(drive);
2288         ide_tape_get_bsize_from_bdesc(drive);
2289         tape->user_bs_factor = 1;
2290         tape->buffer_size = *ctl * tape->blk_size;
2291         while (tape->buffer_size > 0xffff) {
2292                 printk(KERN_NOTICE "ide-tape: decreasing stage size\n");
2293                 *ctl /= 2;
2294                 tape->buffer_size = *ctl * tape->blk_size;
2295         }
2296         buffer_size = tape->buffer_size;
2297         tape->pages_per_buffer = buffer_size / PAGE_SIZE;
2298         if (buffer_size % PAGE_SIZE) {
2299                 tape->pages_per_buffer++;
2300                 tape->excess_bh_size = PAGE_SIZE - buffer_size % PAGE_SIZE;
2301         }
2302
2303         /* select the "best" DSC read/write polling freq */
2304         speed = max(*(u16 *)&tape->caps[14], *(u16 *)&tape->caps[8]);
2305
2306         t = (IDETAPE_FIFO_THRESHOLD * tape->buffer_size * HZ) / (speed * 1000);
2307
2308         /*
2309          * Ensure that the number we got makes sense; limit it within
2310          * IDETAPE_DSC_RW_MIN and IDETAPE_DSC_RW_MAX.
2311          */
2312         tape->best_dsc_rw_freq = clamp_t(unsigned long, t, IDETAPE_DSC_RW_MIN,
2313                                          IDETAPE_DSC_RW_MAX);
2314         printk(KERN_INFO "ide-tape: %s <-> %s: %dKBps, %d*%dkB buffer, "
2315                 "%lums tDSC%s\n",
2316                 drive->name, tape->name, *(u16 *)&tape->caps[14],
2317                 (*(u16 *)&tape->caps[16] * 512) / tape->buffer_size,
2318                 tape->buffer_size / 1024,
2319                 tape->best_dsc_rw_freq * 1000 / HZ,
2320                 drive->using_dma ? ", DMA":"");
2321
2322         ide_proc_register_driver(drive, tape->driver);
2323 }
2324
2325 static void ide_tape_remove(ide_drive_t *drive)
2326 {
2327         idetape_tape_t *tape = drive->driver_data;
2328
2329         ide_proc_unregister_driver(drive, tape->driver);
2330
2331         ide_unregister_region(tape->disk);
2332
2333         ide_tape_put(tape);
2334 }
2335
2336 static void ide_tape_release(struct kref *kref)
2337 {
2338         struct ide_tape_obj *tape = to_ide_tape(kref);
2339         ide_drive_t *drive = tape->drive;
2340         struct gendisk *g = tape->disk;
2341
2342         BUG_ON(tape->merge_bh_size);
2343
2344         drive->dsc_overlap = 0;
2345         drive->driver_data = NULL;
2346         device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor));
2347         device_destroy(idetape_sysfs_class,
2348                         MKDEV(IDETAPE_MAJOR, tape->minor + 128));
2349         idetape_devs[tape->minor] = NULL;
2350         g->private_data = NULL;
2351         put_disk(g);
2352         kfree(tape);
2353 }
2354
2355 #ifdef CONFIG_IDE_PROC_FS
2356 static int proc_idetape_read_name
2357         (char *page, char **start, off_t off, int count, int *eof, void *data)
2358 {
2359         ide_drive_t     *drive = (ide_drive_t *) data;
2360         idetape_tape_t  *tape = drive->driver_data;
2361         char            *out = page;
2362         int             len;
2363
2364         len = sprintf(out, "%s\n", tape->name);
2365         PROC_IDE_READ_RETURN(page, start, off, count, eof, len);
2366 }
2367
2368 static ide_proc_entry_t idetape_proc[] = {
2369         { "capacity",   S_IFREG|S_IRUGO,        proc_ide_read_capacity, NULL },
2370         { "name",       S_IFREG|S_IRUGO,        proc_idetape_read_name, NULL },
2371         { NULL, 0, NULL, NULL }
2372 };
2373 #endif
2374
2375 static int ide_tape_probe(ide_drive_t *);
2376
2377 static ide_driver_t idetape_driver = {
2378         .gen_driver = {
2379                 .owner          = THIS_MODULE,
2380                 .name           = "ide-tape",
2381                 .bus            = &ide_bus_type,
2382         },
2383         .probe                  = ide_tape_probe,
2384         .remove                 = ide_tape_remove,
2385         .version                = IDETAPE_VERSION,
2386         .media                  = ide_tape,
2387         .do_request             = idetape_do_request,
2388         .end_request            = idetape_end_request,
2389         .error                  = __ide_error,
2390 #ifdef CONFIG_IDE_PROC_FS
2391         .proc                   = idetape_proc,
2392         .settings               = idetape_settings,
2393 #endif
2394 };
2395
2396 /* Our character device supporting functions, passed to register_chrdev. */
2397 static const struct file_operations idetape_fops = {
2398         .owner          = THIS_MODULE,
2399         .read           = idetape_chrdev_read,
2400         .write          = idetape_chrdev_write,
2401         .ioctl          = idetape_chrdev_ioctl,
2402         .open           = idetape_chrdev_open,
2403         .release        = idetape_chrdev_release,
2404 };
2405
2406 static int idetape_open(struct inode *inode, struct file *filp)
2407 {
2408         struct gendisk *disk = inode->i_bdev->bd_disk;
2409         struct ide_tape_obj *tape;
2410
2411         tape = ide_tape_get(disk);
2412         if (!tape)
2413                 return -ENXIO;
2414
2415         return 0;
2416 }
2417
2418 static int idetape_release(struct inode *inode, struct file *filp)
2419 {
2420         struct gendisk *disk = inode->i_bdev->bd_disk;
2421         struct ide_tape_obj *tape = ide_tape_g(disk);
2422
2423         ide_tape_put(tape);
2424
2425         return 0;
2426 }
2427
2428 static int idetape_ioctl(struct inode *inode, struct file *file,
2429                         unsigned int cmd, unsigned long arg)
2430 {
2431         struct block_device *bdev = inode->i_bdev;
2432         struct ide_tape_obj *tape = ide_tape_g(bdev->bd_disk);
2433         ide_drive_t *drive = tape->drive;
2434         int err = generic_ide_ioctl(drive, file, bdev, cmd, arg);
2435         if (err == -EINVAL)
2436                 err = idetape_blkdev_ioctl(drive, cmd, arg);
2437         return err;
2438 }
2439
2440 static struct block_device_operations idetape_block_ops = {
2441         .owner          = THIS_MODULE,
2442         .open           = idetape_open,
2443         .release        = idetape_release,
2444         .ioctl          = idetape_ioctl,
2445 };
2446
2447 static int ide_tape_probe(ide_drive_t *drive)
2448 {
2449         idetape_tape_t *tape;
2450         struct gendisk *g;
2451         int minor;
2452
2453         if (!strstr("ide-tape", drive->driver_req))
2454                 goto failed;
2455
2456         if (drive->media != ide_tape)
2457                 goto failed;
2458
2459         if (drive->id_read == 1 && !ide_check_atapi_device(drive, DRV_NAME)) {
2460                 printk(KERN_ERR "ide-tape: %s: not supported by this version of"
2461                                 " the driver\n", drive->name);
2462                 goto failed;
2463         }
2464         tape = kzalloc(sizeof(idetape_tape_t), GFP_KERNEL);
2465         if (tape == NULL) {
2466                 printk(KERN_ERR "ide-tape: %s: Can't allocate a tape struct\n",
2467                                 drive->name);
2468                 goto failed;
2469         }
2470
2471         g = alloc_disk(1 << PARTN_BITS);
2472         if (!g)
2473                 goto out_free_tape;
2474
2475         ide_init_disk(g, drive);
2476
2477         kref_init(&tape->kref);
2478
2479         tape->drive = drive;
2480         tape->driver = &idetape_driver;
2481         tape->disk = g;
2482
2483         g->private_data = &tape->driver;
2484
2485         drive->driver_data = tape;
2486
2487         mutex_lock(&idetape_ref_mutex);
2488         for (minor = 0; idetape_devs[minor]; minor++)
2489                 ;
2490         idetape_devs[minor] = tape;
2491         mutex_unlock(&idetape_ref_mutex);
2492
2493         idetape_setup(drive, tape, minor);
2494
2495         device_create_drvdata(idetape_sysfs_class, &drive->gendev,
2496                               MKDEV(IDETAPE_MAJOR, minor), NULL,
2497                               "%s", tape->name);
2498         device_create_drvdata(idetape_sysfs_class, &drive->gendev,
2499                               MKDEV(IDETAPE_MAJOR, minor + 128), NULL,
2500                               "n%s", tape->name);
2501
2502         g->fops = &idetape_block_ops;
2503         ide_register_region(g);
2504
2505         return 0;
2506
2507 out_free_tape:
2508         kfree(tape);
2509 failed:
2510         return -ENODEV;
2511 }
2512
2513 static void __exit idetape_exit(void)
2514 {
2515         driver_unregister(&idetape_driver.gen_driver);
2516         class_destroy(idetape_sysfs_class);
2517         unregister_chrdev(IDETAPE_MAJOR, "ht");
2518 }
2519
2520 static int __init idetape_init(void)
2521 {
2522         int error = 1;
2523         idetape_sysfs_class = class_create(THIS_MODULE, "ide_tape");
2524         if (IS_ERR(idetape_sysfs_class)) {
2525                 idetape_sysfs_class = NULL;
2526                 printk(KERN_ERR "Unable to create sysfs class for ide tapes\n");
2527                 error = -EBUSY;
2528                 goto out;
2529         }
2530
2531         if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
2532                 printk(KERN_ERR "ide-tape: Failed to register chrdev"
2533                                 " interface\n");
2534                 error = -EBUSY;
2535                 goto out_free_class;
2536         }
2537
2538         error = driver_register(&idetape_driver.gen_driver);
2539         if (error)
2540                 goto out_free_driver;
2541
2542         return 0;
2543
2544 out_free_driver:
2545         driver_unregister(&idetape_driver.gen_driver);
2546 out_free_class:
2547         class_destroy(idetape_sysfs_class);
2548 out:
2549         return error;
2550 }
2551
2552 MODULE_ALIAS("ide:*m-tape*");
2553 module_init(idetape_init);
2554 module_exit(idetape_exit);
2555 MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
2556 MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
2557 MODULE_LICENSE("GPL");