ide-tape.c revision a1efc85f0b4d48627ef0b2aeb766a39fb4a00561
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 IDETAPE_VERSION "1.19"
19
20#include <linux/module.h>
21#include <linux/types.h>
22#include <linux/string.h>
23#include <linux/kernel.h>
24#include <linux/delay.h>
25#include <linux/timer.h>
26#include <linux/mm.h>
27#include <linux/interrupt.h>
28#include <linux/jiffies.h>
29#include <linux/major.h>
30#include <linux/errno.h>
31#include <linux/genhd.h>
32#include <linux/slab.h>
33#include <linux/pci.h>
34#include <linux/ide.h>
35#include <linux/smp_lock.h>
36#include <linux/completion.h>
37#include <linux/bitops.h>
38#include <linux/mutex.h>
39#include <scsi/scsi.h>
40
41#include <asm/byteorder.h>
42#include <asm/irq.h>
43#include <asm/uaccess.h>
44#include <asm/io.h>
45#include <asm/unaligned.h>
46#include <linux/mtio.h>
47
48enum {
49	/* output errors only */
50	DBG_ERR =		(1 << 0),
51	/* output all sense key/asc */
52	DBG_SENSE =		(1 << 1),
53	/* info regarding all chrdev-related procedures */
54	DBG_CHRDEV =		(1 << 2),
55	/* all remaining procedures */
56	DBG_PROCS =		(1 << 3),
57	/* buffer alloc info (pc_stack & rq_stack) */
58	DBG_PCRQ_STACK =	(1 << 4),
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
77/*
78 *	Pipelined mode parameters.
79 *
80 *	We try to use the minimum number of stages which is enough to
81 *	keep the tape constantly streaming. To accomplish that, we implement
82 *	a feedback loop around the maximum number of stages:
83 *
84 *	We start from MIN maximum stages (we will not even use MIN stages
85 *      if we don't need them), increment it by RATE*(MAX-MIN)
86 *	whenever we sense that the pipeline is empty, until we reach
87 *	the optimum value or until we reach MAX.
88 *
89 *	Setting the following parameter to 0 is illegal: the pipelined mode
90 *	cannot be disabled (idetape_calculate_speeds() divides by
91 *	tape->max_stages.)
92 */
93#define IDETAPE_MIN_PIPELINE_STAGES	  1
94#define IDETAPE_MAX_PIPELINE_STAGES	400
95#define IDETAPE_INCREASE_STAGES_RATE	 20
96
97/*
98 *	After each failed packet command we issue a request sense command
99 *	and retry the packet command IDETAPE_MAX_PC_RETRIES times.
100 *
101 *	Setting IDETAPE_MAX_PC_RETRIES to 0 will disable retries.
102 */
103#define IDETAPE_MAX_PC_RETRIES		3
104
105/*
106 *	With each packet command, we allocate a buffer of
107 *	IDETAPE_PC_BUFFER_SIZE bytes. This is used for several packet
108 *	commands (Not for READ/WRITE commands).
109 */
110#define IDETAPE_PC_BUFFER_SIZE		256
111
112/*
113 *	In various places in the driver, we need to allocate storage
114 *	for packet commands and requests, which will remain valid while
115 *	we leave the driver to wait for an interrupt or a timeout event.
116 */
117#define IDETAPE_PC_STACK		(10 + IDETAPE_MAX_PC_RETRIES)
118
119/*
120 * Some drives (for example, Seagate STT3401A Travan) require a very long
121 * timeout, because they don't return an interrupt or clear their busy bit
122 * until after the command completes (even retension commands).
123 */
124#define IDETAPE_WAIT_CMD		(900*HZ)
125
126/*
127 *	The following parameter is used to select the point in the internal
128 *	tape fifo in which we will start to refill the buffer. Decreasing
129 *	the following parameter will improve the system's latency and
130 *	interactive response, while using a high value might improve system
131 *	throughput.
132 */
133#define IDETAPE_FIFO_THRESHOLD 		2
134
135/*
136 *	DSC polling parameters.
137 *
138 *	Polling for DSC (a single bit in the status register) is a very
139 *	important function in ide-tape. There are two cases in which we
140 *	poll for DSC:
141 *
142 *	1.	Before a read/write packet command, to ensure that we
143 *		can transfer data from/to the tape's data buffers, without
144 *		causing an actual media access. In case the tape is not
145 *		ready yet, we take out our request from the device
146 *		request queue, so that ide.c will service requests from
147 *		the other device on the same interface meanwhile.
148 *
149 *	2.	After the successful initialization of a "media access
150 *		packet command", which is a command which can take a long
151 *		time to complete (it can be several seconds or even an hour).
152 *
153 *		Again, we postpone our request in the middle to free the bus
154 *		for the other device. The polling frequency here should be
155 *		lower than the read/write frequency since those media access
156 *		commands are slow. We start from a "fast" frequency -
157 *		IDETAPE_DSC_MA_FAST (one second), and if we don't receive DSC
158 *		after IDETAPE_DSC_MA_THRESHOLD (5 minutes), we switch it to a
159 *		lower frequency - IDETAPE_DSC_MA_SLOW (1 minute).
160 *
161 *	We also set a timeout for the timer, in case something goes wrong.
162 *	The timeout should be longer then the maximum execution time of a
163 *	tape operation.
164 */
165
166/*
167 *	DSC timings.
168 */
169#define IDETAPE_DSC_RW_MIN		5*HZ/100	/* 50 msec */
170#define IDETAPE_DSC_RW_MAX		40*HZ/100	/* 400 msec */
171#define IDETAPE_DSC_RW_TIMEOUT		2*60*HZ		/* 2 minutes */
172#define IDETAPE_DSC_MA_FAST		2*HZ		/* 2 seconds */
173#define IDETAPE_DSC_MA_THRESHOLD	5*60*HZ		/* 5 minutes */
174#define IDETAPE_DSC_MA_SLOW		30*HZ		/* 30 seconds */
175#define IDETAPE_DSC_MA_TIMEOUT		2*60*60*HZ	/* 2 hours */
176
177/*************************** End of tunable parameters ***********************/
178
179/*
180 *	Read/Write error simulation
181 */
182#define SIMULATE_ERRORS			0
183
184/*
185 *	For general magnetic tape device compatibility.
186 */
187typedef enum {
188	idetape_direction_none,
189	idetape_direction_read,
190	idetape_direction_write
191} idetape_chrdev_direction_t;
192
193struct idetape_bh {
194	u32 b_size;
195	atomic_t b_count;
196	struct idetape_bh *b_reqnext;
197	char *b_data;
198};
199
200/*
201 *	Our view of a packet command.
202 */
203typedef struct idetape_packet_command_s {
204	u8 c[12];				/* Actual packet bytes */
205	int retries;				/* On each retry, we increment retries */
206	int error;				/* Error code */
207	int request_transfer;			/* Bytes to transfer */
208	int actually_transferred;		/* Bytes actually transferred */
209	int buffer_size;			/* Size of our data buffer */
210	struct idetape_bh *bh;
211	char *b_data;
212	int b_count;
213	u8 *buffer;				/* Data buffer */
214	u8 *current_position;			/* Pointer into the above buffer */
215	ide_startstop_t (*callback) (ide_drive_t *);	/* Called when this packet command is completed */
216	u8 pc_buffer[IDETAPE_PC_BUFFER_SIZE];	/* Temporary buffer */
217	unsigned long flags;			/* Status/Action bit flags: long for set_bit */
218} idetape_pc_t;
219
220/*
221 *	Packet command flag bits.
222 */
223/* Set when an error is considered normal - We won't retry */
224#define	PC_ABORT			0
225/* 1 When polling for DSC on a media access command */
226#define PC_WAIT_FOR_DSC			1
227/* 1 when we prefer to use DMA if possible */
228#define PC_DMA_RECOMMENDED		2
229/* 1 while DMA in progress */
230#define	PC_DMA_IN_PROGRESS		3
231/* 1 when encountered problem during DMA */
232#define	PC_DMA_ERROR			4
233/* Data direction */
234#define	PC_WRITING			5
235
236/*
237 *	A pipeline stage.
238 */
239typedef struct idetape_stage_s {
240	struct request rq;			/* The corresponding request */
241	struct idetape_bh *bh;			/* The data buffers */
242	struct idetape_stage_s *next;		/* Pointer to the next stage */
243} idetape_stage_t;
244
245/*
246 *	Most of our global data which we need to save even as we leave the
247 *	driver due to an interrupt or a timer event is stored in a variable
248 *	of type idetape_tape_t, defined below.
249 */
250typedef struct ide_tape_obj {
251	ide_drive_t	*drive;
252	ide_driver_t	*driver;
253	struct gendisk	*disk;
254	struct kref	kref;
255
256	/*
257	 *	Since a typical character device operation requires more
258	 *	than one packet command, we provide here enough memory
259	 *	for the maximum of interconnected packet commands.
260	 *	The packet commands are stored in the circular array pc_stack.
261	 *	pc_stack_index points to the last used entry, and warps around
262	 *	to the start when we get to the last array entry.
263	 *
264	 *	pc points to the current processed packet command.
265	 *
266	 *	failed_pc points to the last failed packet command, or contains
267	 *	NULL if we do not need to retry any packet command. This is
268	 *	required since an additional packet command is needed before the
269	 *	retry, to get detailed information on what went wrong.
270	 */
271	/* Current packet command */
272	idetape_pc_t *pc;
273	/* Last failed packet command */
274	idetape_pc_t *failed_pc;
275	/* Packet command stack */
276	idetape_pc_t pc_stack[IDETAPE_PC_STACK];
277	/* Next free packet command storage space */
278	int pc_stack_index;
279	struct request rq_stack[IDETAPE_PC_STACK];
280	/* We implement a circular array */
281	int rq_stack_index;
282
283	/*
284	 *	DSC polling variables.
285	 *
286	 *	While polling for DSC we use postponed_rq to postpone the
287	 *	current request so that ide.c will be able to service
288	 *	pending requests on the other device. Note that at most
289	 *	we will have only one DSC (usually data transfer) request
290	 *	in the device request queue. Additional requests can be
291	 *	queued in our internal pipeline, but they will be visible
292	 *	to ide.c only one at a time.
293	 */
294	struct request *postponed_rq;
295	/* The time in which we started polling for DSC */
296	unsigned long dsc_polling_start;
297	/* Timer used to poll for dsc */
298	struct timer_list dsc_timer;
299	/* Read/Write dsc polling frequency */
300	unsigned long best_dsc_rw_frequency;
301	/* The current polling frequency */
302	unsigned long dsc_polling_frequency;
303	/* Maximum waiting time */
304	unsigned long dsc_timeout;
305
306	/*
307	 *	Read position information
308	 */
309	u8 partition;
310	/* Current block */
311	unsigned int first_frame_position;
312	unsigned int last_frame_position;
313	unsigned int blocks_in_buffer;
314
315	/*
316	 *	Last error information
317	 */
318	u8 sense_key, asc, ascq;
319
320	/*
321	 *	Character device operation
322	 */
323	unsigned int minor;
324	/* device name */
325	char name[4];
326	/* Current character device data transfer direction */
327	idetape_chrdev_direction_t chrdev_direction;
328
329	/*
330	 *	Device information
331	 */
332	/* Usually 512 or 1024 bytes */
333	unsigned short tape_block_size;
334	int user_bs_factor;
335
336	/* Copy of the tape's Capabilities and Mechanical Page */
337	u8 caps[20];
338
339	/*
340	 *	Active data transfer request parameters.
341	 *
342	 *	At most, there is only one ide-tape originated data transfer
343	 *	request in the device request queue. This allows ide.c to
344	 *	easily service requests from the other device when we
345	 *	postpone our active request. In the pipelined operation
346	 *	mode, we use our internal pipeline structure to hold
347	 *	more data requests.
348	 *
349	 *	The data buffer size is chosen based on the tape's
350	 *	recommendation.
351	 */
352	/* Pointer to the request which is waiting in the device request queue */
353	struct request *active_data_request;
354	/* Data buffer size (chosen based on the tape's recommendation */
355	int stage_size;
356	idetape_stage_t *merge_stage;
357	int merge_stage_size;
358	struct idetape_bh *bh;
359	char *b_data;
360	int b_count;
361
362	/*
363	 *	Pipeline parameters.
364	 *
365	 *	To accomplish non-pipelined mode, we simply set the following
366	 *	variables to zero (or NULL, where appropriate).
367	 */
368	/* Number of currently used stages */
369	int nr_stages;
370	/* Number of pending stages */
371	int nr_pending_stages;
372	/* We will not allocate more than this number of stages */
373	int max_stages, min_pipeline, max_pipeline;
374	/* The first stage which will be removed from the pipeline */
375	idetape_stage_t *first_stage;
376	/* The currently active stage */
377	idetape_stage_t *active_stage;
378	/* Will be serviced after the currently active request */
379	idetape_stage_t *next_stage;
380	/* New requests will be added to the pipeline here */
381	idetape_stage_t *last_stage;
382	/* Optional free stage which we can use */
383	idetape_stage_t *cache_stage;
384	int pages_per_stage;
385	/* Wasted space in each stage */
386	int excess_bh_size;
387
388	/* Status/Action flags: long for set_bit */
389	unsigned long flags;
390	/* protects the ide-tape queue */
391	spinlock_t spinlock;
392
393	/*
394	 * Measures average tape speed
395	 */
396	unsigned long avg_time;
397	int avg_size;
398	int avg_speed;
399
400	char vendor_id[10];
401	char product_id[18];
402	char firmware_revision[6];
403	int firmware_revision_num;
404
405	/* the door is currently locked */
406	int door_locked;
407	/* the tape hardware is write protected */
408	char drv_write_prot;
409	/* the tape is write protected (hardware or opened as read-only) */
410	char write_prot;
411
412	/*
413	 * Limit the number of times a request can
414	 * be postponed, to avoid an infinite postpone
415	 * deadlock.
416	 */
417	/* request postpone count limit */
418	int postpone_cnt;
419
420	/*
421	 * Measures number of frames:
422	 *
423	 * 1. written/read to/from the driver pipeline (pipeline_head).
424	 * 2. written/read to/from the tape buffers (idetape_bh).
425	 * 3. written/read by the tape to/from the media (tape_head).
426	 */
427	int pipeline_head;
428	int buffer_head;
429	int tape_head;
430	int last_tape_head;
431
432	/*
433	 * Speed control at the tape buffers input/output
434	 */
435	unsigned long insert_time;
436	int insert_size;
437	int insert_speed;
438	int max_insert_speed;
439	int measure_insert_time;
440
441	/*
442	 * Measure tape still time, in milliseconds
443	 */
444	unsigned long tape_still_time_begin;
445	int tape_still_time;
446
447	/*
448	 * Speed regulation negative feedback loop
449	 */
450	int speed_control;
451	int pipeline_head_speed;
452	int controlled_pipeline_head_speed;
453	int uncontrolled_pipeline_head_speed;
454	int controlled_last_pipeline_head;
455	int uncontrolled_last_pipeline_head;
456	unsigned long uncontrolled_pipeline_head_time;
457	unsigned long controlled_pipeline_head_time;
458	int controlled_previous_pipeline_head;
459	int uncontrolled_previous_pipeline_head;
460	unsigned long controlled_previous_head_time;
461	unsigned long uncontrolled_previous_head_time;
462	int restart_speed_control_req;
463
464	u32 debug_mask;
465} idetape_tape_t;
466
467static DEFINE_MUTEX(idetape_ref_mutex);
468
469static struct class *idetape_sysfs_class;
470
471#define to_ide_tape(obj) container_of(obj, struct ide_tape_obj, kref)
472
473#define ide_tape_g(disk) \
474	container_of((disk)->private_data, struct ide_tape_obj, driver)
475
476static struct ide_tape_obj *ide_tape_get(struct gendisk *disk)
477{
478	struct ide_tape_obj *tape = NULL;
479
480	mutex_lock(&idetape_ref_mutex);
481	tape = ide_tape_g(disk);
482	if (tape)
483		kref_get(&tape->kref);
484	mutex_unlock(&idetape_ref_mutex);
485	return tape;
486}
487
488static void ide_tape_release(struct kref *);
489
490static void ide_tape_put(struct ide_tape_obj *tape)
491{
492	mutex_lock(&idetape_ref_mutex);
493	kref_put(&tape->kref, ide_tape_release);
494	mutex_unlock(&idetape_ref_mutex);
495}
496
497/*
498 *	Tape door status
499 */
500#define DOOR_UNLOCKED			0
501#define DOOR_LOCKED			1
502#define DOOR_EXPLICITLY_LOCKED		2
503
504/*
505 *	Tape flag bits values.
506 */
507#define IDETAPE_IGNORE_DSC		0
508#define IDETAPE_ADDRESS_VALID		1	/* 0 When the tape position is unknown */
509#define IDETAPE_BUSY			2	/* Device already opened */
510#define IDETAPE_PIPELINE_ERROR		3	/* Error detected in a pipeline stage */
511#define IDETAPE_DETECT_BS		4	/* Attempt to auto-detect the current user block size */
512#define IDETAPE_FILEMARK		5	/* Currently on a filemark */
513#define IDETAPE_DRQ_INTERRUPT		6	/* DRQ interrupt device */
514#define IDETAPE_READ_ERROR		7
515#define IDETAPE_PIPELINE_ACTIVE		8	/* pipeline active */
516/* 0 = no tape is loaded, so we don't rewind after ejecting */
517#define IDETAPE_MEDIUM_PRESENT		9
518
519/*
520 *	Some defines for the READ BUFFER command
521 */
522#define IDETAPE_RETRIEVE_FAULTY_BLOCK	6
523
524/*
525 *	Some defines for the SPACE command
526 */
527#define IDETAPE_SPACE_OVER_FILEMARK	1
528#define IDETAPE_SPACE_TO_EOD		3
529
530/*
531 *	Some defines for the LOAD UNLOAD command
532 */
533#define IDETAPE_LU_LOAD_MASK		1
534#define IDETAPE_LU_RETENSION_MASK	2
535#define IDETAPE_LU_EOT_MASK		4
536
537/*
538 *	Special requests for our block device strategy routine.
539 *
540 *	In order to service a character device command, we add special
541 *	requests to the tail of our block device request queue and wait
542 *	for their completion.
543 */
544
545enum {
546	REQ_IDETAPE_PC1		= (1 << 0), /* packet command (first stage) */
547	REQ_IDETAPE_PC2		= (1 << 1), /* packet command (second stage) */
548	REQ_IDETAPE_READ	= (1 << 2),
549	REQ_IDETAPE_WRITE	= (1 << 3),
550	REQ_IDETAPE_READ_BUFFER	= (1 << 4),
551};
552
553/*
554 *	Error codes which are returned in rq->errors to the higher part
555 *	of the driver.
556 */
557#define	IDETAPE_ERROR_GENERAL		101
558#define	IDETAPE_ERROR_FILEMARK		102
559#define	IDETAPE_ERROR_EOD		103
560
561/*
562 *	The following is used to format the general configuration word of
563 *	the ATAPI IDENTIFY DEVICE command.
564 */
565struct idetape_id_gcw {
566	unsigned packet_size		:2;	/* Packet Size */
567	unsigned reserved234		:3;	/* Reserved */
568	unsigned drq_type		:2;	/* Command packet DRQ type */
569	unsigned removable		:1;	/* Removable media */
570	unsigned device_type		:5;	/* Device type */
571	unsigned reserved13		:1;	/* Reserved */
572	unsigned protocol		:2;	/* Protocol type */
573};
574
575/* Structures related to the SELECT SENSE / MODE SENSE packet commands. */
576#define IDETAPE_BLOCK_DESCRIPTOR	0
577#define	IDETAPE_CAPABILITIES_PAGE	0x2a
578
579/*
580 *	The variables below are used for the character device interface.
581 *	Additional state variables are defined in our ide_drive_t structure.
582 */
583static struct ide_tape_obj * idetape_devs[MAX_HWIFS * MAX_DRIVES];
584
585#define ide_tape_f(file) ((file)->private_data)
586
587static struct ide_tape_obj *ide_tape_chrdev_get(unsigned int i)
588{
589	struct ide_tape_obj *tape = NULL;
590
591	mutex_lock(&idetape_ref_mutex);
592	tape = idetape_devs[i];
593	if (tape)
594		kref_get(&tape->kref);
595	mutex_unlock(&idetape_ref_mutex);
596	return tape;
597}
598
599/*
600 *      Function declarations
601 *
602 */
603static int idetape_chrdev_release (struct inode *inode, struct file *filp);
604static void idetape_write_release (ide_drive_t *drive, unsigned int minor);
605
606/*
607 * Too bad. The drive wants to send us data which we are not ready to accept.
608 * Just throw it away.
609 */
610static void idetape_discard_data (ide_drive_t *drive, unsigned int bcount)
611{
612	while (bcount--)
613		(void) HWIF(drive)->INB(IDE_DATA_REG);
614}
615
616static void idetape_input_buffers (ide_drive_t *drive, idetape_pc_t *pc, unsigned int bcount)
617{
618	struct idetape_bh *bh = pc->bh;
619	int count;
620
621	while (bcount) {
622		if (bh == NULL) {
623			printk(KERN_ERR "ide-tape: bh == NULL in "
624				"idetape_input_buffers\n");
625			idetape_discard_data(drive, bcount);
626			return;
627		}
628		count = min((unsigned int)(bh->b_size - atomic_read(&bh->b_count)), bcount);
629		HWIF(drive)->atapi_input_bytes(drive, bh->b_data + atomic_read(&bh->b_count), count);
630		bcount -= count;
631		atomic_add(count, &bh->b_count);
632		if (atomic_read(&bh->b_count) == bh->b_size) {
633			bh = bh->b_reqnext;
634			if (bh)
635				atomic_set(&bh->b_count, 0);
636		}
637	}
638	pc->bh = bh;
639}
640
641static void idetape_output_buffers (ide_drive_t *drive, idetape_pc_t *pc, unsigned int bcount)
642{
643	struct idetape_bh *bh = pc->bh;
644	int count;
645
646	while (bcount) {
647		if (bh == NULL) {
648			printk(KERN_ERR "ide-tape: bh == NULL in "
649				"idetape_output_buffers\n");
650			return;
651		}
652		count = min((unsigned int)pc->b_count, (unsigned int)bcount);
653		HWIF(drive)->atapi_output_bytes(drive, pc->b_data, count);
654		bcount -= count;
655		pc->b_data += count;
656		pc->b_count -= count;
657		if (!pc->b_count) {
658			pc->bh = bh = bh->b_reqnext;
659			if (bh) {
660				pc->b_data = bh->b_data;
661				pc->b_count = atomic_read(&bh->b_count);
662			}
663		}
664	}
665}
666
667static void idetape_update_buffers (idetape_pc_t *pc)
668{
669	struct idetape_bh *bh = pc->bh;
670	int count;
671	unsigned int bcount = pc->actually_transferred;
672
673	if (test_bit(PC_WRITING, &pc->flags))
674		return;
675	while (bcount) {
676		if (bh == NULL) {
677			printk(KERN_ERR "ide-tape: bh == NULL in "
678				"idetape_update_buffers\n");
679			return;
680		}
681		count = min((unsigned int)bh->b_size, (unsigned int)bcount);
682		atomic_set(&bh->b_count, count);
683		if (atomic_read(&bh->b_count) == bh->b_size)
684			bh = bh->b_reqnext;
685		bcount -= count;
686	}
687	pc->bh = bh;
688}
689
690/*
691 *	idetape_next_pc_storage returns a pointer to a place in which we can
692 *	safely store a packet command, even though we intend to leave the
693 *	driver. A storage space for a maximum of IDETAPE_PC_STACK packet
694 *	commands is allocated at initialization time.
695 */
696static idetape_pc_t *idetape_next_pc_storage (ide_drive_t *drive)
697{
698	idetape_tape_t *tape = drive->driver_data;
699
700	debug_log(DBG_PCRQ_STACK, "pc_stack_index=%d\n", tape->pc_stack_index);
701
702	if (tape->pc_stack_index == IDETAPE_PC_STACK)
703		tape->pc_stack_index=0;
704	return (&tape->pc_stack[tape->pc_stack_index++]);
705}
706
707/*
708 *	idetape_next_rq_storage is used along with idetape_next_pc_storage.
709 *	Since we queue packet commands in the request queue, we need to
710 *	allocate a request, along with the allocation of a packet command.
711 */
712
713/**************************************************************
714 *                                                            *
715 *  This should get fixed to use kmalloc(.., GFP_ATOMIC)      *
716 *  followed later on by kfree().   -ml                       *
717 *                                                            *
718 **************************************************************/
719
720static struct request *idetape_next_rq_storage (ide_drive_t *drive)
721{
722	idetape_tape_t *tape = drive->driver_data;
723
724	debug_log(DBG_PCRQ_STACK, "rq_stack_index=%d\n", tape->rq_stack_index);
725
726	if (tape->rq_stack_index == IDETAPE_PC_STACK)
727		tape->rq_stack_index=0;
728	return (&tape->rq_stack[tape->rq_stack_index++]);
729}
730
731/*
732 *	idetape_init_pc initializes a packet command.
733 */
734static void idetape_init_pc (idetape_pc_t *pc)
735{
736	memset(pc->c, 0, 12);
737	pc->retries = 0;
738	pc->flags = 0;
739	pc->request_transfer = 0;
740	pc->buffer = pc->pc_buffer;
741	pc->buffer_size = IDETAPE_PC_BUFFER_SIZE;
742	pc->bh = NULL;
743	pc->b_data = NULL;
744}
745
746/*
747 * called on each failed packet command retry to analyze the request sense. We
748 * currently do not utilize this information.
749 */
750static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
751{
752	idetape_tape_t *tape = drive->driver_data;
753	idetape_pc_t *pc = tape->failed_pc;
754
755	tape->sense_key = sense[2] & 0xF;
756	tape->asc       = sense[12];
757	tape->ascq      = sense[13];
758
759	debug_log(DBG_ERR, "pc = %x, sense key = %x, asc = %x, ascq = %x\n",
760		 pc->c[0], tape->sense_key, tape->asc, tape->ascq);
761
762	/* Correct pc->actually_transferred by asking the tape.	 */
763	if (test_bit(PC_DMA_ERROR, &pc->flags)) {
764		pc->actually_transferred = pc->request_transfer -
765			tape->tape_block_size *
766			be32_to_cpu(get_unaligned((u32 *)&sense[3]));
767		idetape_update_buffers(pc);
768	}
769
770	/*
771	 * If error was the result of a zero-length read or write command,
772	 * with sense key=5, asc=0x22, ascq=0, let it slide.  Some drives
773	 * (i.e. Seagate STT3401A Travan) don't support 0-length read/writes.
774	 */
775	if ((pc->c[0] == READ_6 || pc->c[0] == WRITE_6)
776	    /* length == 0 */
777	    && pc->c[4] == 0 && pc->c[3] == 0 && pc->c[2] == 0) {
778		if (tape->sense_key == 5) {
779			/* don't report an error, everything's ok */
780			pc->error = 0;
781			/* don't retry read/write */
782			set_bit(PC_ABORT, &pc->flags);
783		}
784	}
785	if (pc->c[0] == READ_6 && (sense[2] & 0x80)) {
786		pc->error = IDETAPE_ERROR_FILEMARK;
787		set_bit(PC_ABORT, &pc->flags);
788	}
789	if (pc->c[0] == WRITE_6) {
790		if ((sense[2] & 0x40) || (tape->sense_key == 0xd
791		     && tape->asc == 0x0 && tape->ascq == 0x2)) {
792			pc->error = IDETAPE_ERROR_EOD;
793			set_bit(PC_ABORT, &pc->flags);
794		}
795	}
796	if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
797		if (tape->sense_key == 8) {
798			pc->error = IDETAPE_ERROR_EOD;
799			set_bit(PC_ABORT, &pc->flags);
800		}
801		if (!test_bit(PC_ABORT, &pc->flags) &&
802		    pc->actually_transferred)
803			pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
804	}
805}
806
807static void idetape_activate_next_stage(ide_drive_t *drive)
808{
809	idetape_tape_t *tape = drive->driver_data;
810	idetape_stage_t *stage = tape->next_stage;
811	struct request *rq = &stage->rq;
812
813	debug_log(DBG_PROCS, "Enter %s\n", __func__);
814
815	if (stage == NULL) {
816		printk(KERN_ERR "ide-tape: bug: Trying to activate a non"
817				" existing stage\n");
818		return;
819	}
820
821	rq->rq_disk = tape->disk;
822	rq->buffer = NULL;
823	rq->special = (void *)stage->bh;
824	tape->active_data_request = rq;
825	tape->active_stage = stage;
826	tape->next_stage = stage->next;
827}
828
829/*
830 *	idetape_increase_max_pipeline_stages is a part of the feedback
831 *	loop which tries to find the optimum number of stages. In the
832 *	feedback loop, we are starting from a minimum maximum number of
833 *	stages, and if we sense that the pipeline is empty, we try to
834 *	increase it, until we reach the user compile time memory limit.
835 */
836static void idetape_increase_max_pipeline_stages (ide_drive_t *drive)
837{
838	idetape_tape_t *tape = drive->driver_data;
839	int increase = (tape->max_pipeline - tape->min_pipeline) / 10;
840
841	debug_log(DBG_PROCS, "Enter %s\n", __func__);
842
843	tape->max_stages += max(increase, 1);
844	tape->max_stages = max(tape->max_stages, tape->min_pipeline);
845	tape->max_stages = min(tape->max_stages, tape->max_pipeline);
846}
847
848/*
849 *	idetape_kfree_stage calls kfree to completely free a stage, along with
850 *	its related buffers.
851 */
852static void __idetape_kfree_stage (idetape_stage_t *stage)
853{
854	struct idetape_bh *prev_bh, *bh = stage->bh;
855	int size;
856
857	while (bh != NULL) {
858		if (bh->b_data != NULL) {
859			size = (int) bh->b_size;
860			while (size > 0) {
861				free_page((unsigned long) bh->b_data);
862				size -= PAGE_SIZE;
863				bh->b_data += PAGE_SIZE;
864			}
865		}
866		prev_bh = bh;
867		bh = bh->b_reqnext;
868		kfree(prev_bh);
869	}
870	kfree(stage);
871}
872
873static void idetape_kfree_stage (idetape_tape_t *tape, idetape_stage_t *stage)
874{
875	__idetape_kfree_stage(stage);
876}
877
878/*
879 *	idetape_remove_stage_head removes tape->first_stage from the pipeline.
880 *	The caller should avoid race conditions.
881 */
882static void idetape_remove_stage_head (ide_drive_t *drive)
883{
884	idetape_tape_t *tape = drive->driver_data;
885	idetape_stage_t *stage;
886
887	debug_log(DBG_PROCS, "Enter %s\n", __func__);
888
889	if (tape->first_stage == NULL) {
890		printk(KERN_ERR "ide-tape: bug: tape->first_stage is NULL\n");
891		return;
892	}
893	if (tape->active_stage == tape->first_stage) {
894		printk(KERN_ERR "ide-tape: bug: Trying to free our active "
895				"pipeline stage\n");
896		return;
897	}
898	stage = tape->first_stage;
899	tape->first_stage = stage->next;
900	idetape_kfree_stage(tape, stage);
901	tape->nr_stages--;
902	if (tape->first_stage == NULL) {
903		tape->last_stage = NULL;
904		if (tape->next_stage != NULL)
905			printk(KERN_ERR "ide-tape: bug: tape->next_stage != NULL\n");
906		if (tape->nr_stages)
907			printk(KERN_ERR "ide-tape: bug: nr_stages should be 0 now\n");
908	}
909}
910
911/*
912 * This will free all the pipeline stages starting from new_last_stage->next
913 * to the end of the list, and point tape->last_stage to new_last_stage.
914 */
915static void idetape_abort_pipeline(ide_drive_t *drive,
916				   idetape_stage_t *new_last_stage)
917{
918	idetape_tape_t *tape = drive->driver_data;
919	idetape_stage_t *stage = new_last_stage->next;
920	idetape_stage_t *nstage;
921
922	debug_log(DBG_PROCS, "%s: Enter %s\n", tape->name, __func__);
923
924	while (stage) {
925		nstage = stage->next;
926		idetape_kfree_stage(tape, stage);
927		--tape->nr_stages;
928		--tape->nr_pending_stages;
929		stage = nstage;
930	}
931	if (new_last_stage)
932		new_last_stage->next = NULL;
933	tape->last_stage = new_last_stage;
934	tape->next_stage = NULL;
935}
936
937/*
938 *	idetape_end_request is used to finish servicing a request, and to
939 *	insert a pending pipeline request into the main device queue.
940 */
941static int idetape_end_request(ide_drive_t *drive, int uptodate, int nr_sects)
942{
943	struct request *rq = HWGROUP(drive)->rq;
944	idetape_tape_t *tape = drive->driver_data;
945	unsigned long flags;
946	int error;
947	int remove_stage = 0;
948	idetape_stage_t *active_stage;
949
950	debug_log(DBG_PROCS, "Enter %s\n", __func__);
951
952	switch (uptodate) {
953		case 0:	error = IDETAPE_ERROR_GENERAL; break;
954		case 1: error = 0; break;
955		default: error = uptodate;
956	}
957	rq->errors = error;
958	if (error)
959		tape->failed_pc = NULL;
960
961	if (!blk_special_request(rq)) {
962		ide_end_request(drive, uptodate, nr_sects);
963		return 0;
964	}
965
966	spin_lock_irqsave(&tape->spinlock, flags);
967
968	/* The request was a pipelined data transfer request */
969	if (tape->active_data_request == rq) {
970		active_stage = tape->active_stage;
971		tape->active_stage = NULL;
972		tape->active_data_request = NULL;
973		tape->nr_pending_stages--;
974		if (rq->cmd[0] & REQ_IDETAPE_WRITE) {
975			remove_stage = 1;
976			if (error) {
977				set_bit(IDETAPE_PIPELINE_ERROR, &tape->flags);
978				if (error == IDETAPE_ERROR_EOD)
979					idetape_abort_pipeline(drive, active_stage);
980			}
981		} else if (rq->cmd[0] & REQ_IDETAPE_READ) {
982			if (error == IDETAPE_ERROR_EOD) {
983				set_bit(IDETAPE_PIPELINE_ERROR, &tape->flags);
984				idetape_abort_pipeline(drive, active_stage);
985			}
986		}
987		if (tape->next_stage != NULL) {
988			idetape_activate_next_stage(drive);
989
990			/*
991			 * Insert the next request into the request queue.
992			 */
993			(void) ide_do_drive_cmd(drive, tape->active_data_request, ide_end);
994		} else if (!error) {
995				idetape_increase_max_pipeline_stages(drive);
996		}
997	}
998	ide_end_drive_cmd(drive, 0, 0);
999//	blkdev_dequeue_request(rq);
1000//	drive->rq = NULL;
1001//	end_that_request_last(rq);
1002
1003	if (remove_stage)
1004		idetape_remove_stage_head(drive);
1005	if (tape->active_data_request == NULL)
1006		clear_bit(IDETAPE_PIPELINE_ACTIVE, &tape->flags);
1007	spin_unlock_irqrestore(&tape->spinlock, flags);
1008	return 0;
1009}
1010
1011static ide_startstop_t idetape_request_sense_callback (ide_drive_t *drive)
1012{
1013	idetape_tape_t *tape = drive->driver_data;
1014
1015	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1016
1017	if (!tape->pc->error) {
1018		idetape_analyze_error(drive, tape->pc->buffer);
1019		idetape_end_request(drive, 1, 0);
1020	} else {
1021		printk(KERN_ERR "ide-tape: Error in REQUEST SENSE itself - Aborting request!\n");
1022		idetape_end_request(drive, 0, 0);
1023	}
1024	return ide_stopped;
1025}
1026
1027static void idetape_create_request_sense_cmd (idetape_pc_t *pc)
1028{
1029	idetape_init_pc(pc);
1030	pc->c[0] = REQUEST_SENSE;
1031	pc->c[4] = 20;
1032	pc->request_transfer = 20;
1033	pc->callback = &idetape_request_sense_callback;
1034}
1035
1036static void idetape_init_rq(struct request *rq, u8 cmd)
1037{
1038	memset(rq, 0, sizeof(*rq));
1039	rq->cmd_type = REQ_TYPE_SPECIAL;
1040	rq->cmd[0] = cmd;
1041}
1042
1043/*
1044 *	idetape_queue_pc_head generates a new packet command request in front
1045 *	of the request queue, before the current request, so that it will be
1046 *	processed immediately, on the next pass through the driver.
1047 *
1048 *	idetape_queue_pc_head is called from the request handling part of
1049 *	the driver (the "bottom" part). Safe storage for the request should
1050 *	be allocated with idetape_next_pc_storage and idetape_next_rq_storage
1051 *	before calling idetape_queue_pc_head.
1052 *
1053 *	Memory for those requests is pre-allocated at initialization time, and
1054 *	is limited to IDETAPE_PC_STACK requests. We assume that we have enough
1055 *	space for the maximum possible number of inter-dependent packet commands.
1056 *
1057 *	The higher level of the driver - The ioctl handler and the character
1058 *	device handling functions should queue request to the lower level part
1059 *	and wait for their completion using idetape_queue_pc_tail or
1060 *	idetape_queue_rw_tail.
1061 */
1062static void idetape_queue_pc_head (ide_drive_t *drive, idetape_pc_t *pc,struct request *rq)
1063{
1064	struct ide_tape_obj *tape = drive->driver_data;
1065
1066	idetape_init_rq(rq, REQ_IDETAPE_PC1);
1067	rq->buffer = (char *) pc;
1068	rq->rq_disk = tape->disk;
1069	(void) ide_do_drive_cmd(drive, rq, ide_preempt);
1070}
1071
1072/*
1073 *	idetape_retry_pc is called when an error was detected during the
1074 *	last packet command. We queue a request sense packet command in
1075 *	the head of the request list.
1076 */
1077static ide_startstop_t idetape_retry_pc (ide_drive_t *drive)
1078{
1079	idetape_tape_t *tape = drive->driver_data;
1080	idetape_pc_t *pc;
1081	struct request *rq;
1082
1083	(void)ide_read_error(drive);
1084	pc = idetape_next_pc_storage(drive);
1085	rq = idetape_next_rq_storage(drive);
1086	idetape_create_request_sense_cmd(pc);
1087	set_bit(IDETAPE_IGNORE_DSC, &tape->flags);
1088	idetape_queue_pc_head(drive, pc, rq);
1089	return ide_stopped;
1090}
1091
1092/*
1093 *	idetape_postpone_request postpones the current request so that
1094 *	ide.c will be able to service requests from another device on
1095 *	the same hwgroup while we are polling for DSC.
1096 */
1097static void idetape_postpone_request (ide_drive_t *drive)
1098{
1099	idetape_tape_t *tape = drive->driver_data;
1100
1101	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1102
1103	tape->postponed_rq = HWGROUP(drive)->rq;
1104	ide_stall_queue(drive, tape->dsc_polling_frequency);
1105}
1106
1107typedef void idetape_io_buf(ide_drive_t *, idetape_pc_t *, unsigned int);
1108
1109/*
1110 * This is the usual interrupt handler which will be called during a packet
1111 * command. We will transfer some of the data (as requested by the drive) and
1112 * will re-point interrupt handler to us. When data transfer is finished, we
1113 * will act according to the algorithm described before
1114 * idetape_issue_packet_command.
1115 */
1116static ide_startstop_t idetape_pc_intr(ide_drive_t *drive)
1117{
1118	ide_hwif_t *hwif = drive->hwif;
1119	idetape_tape_t *tape = drive->driver_data;
1120	idetape_pc_t *pc = tape->pc;
1121	xfer_func_t *xferfunc;
1122	idetape_io_buf *iobuf;
1123	unsigned int temp;
1124#if SIMULATE_ERRORS
1125	static int error_sim_count = 0;
1126#endif
1127	u16 bcount;
1128	u8 stat, ireason;
1129
1130	debug_log(DBG_PROCS, "Enter %s - interrupt handler\n", __func__);
1131
1132	/* Clear the interrupt */
1133	stat = ide_read_status(drive);
1134
1135	if (test_bit(PC_DMA_IN_PROGRESS, &pc->flags)) {
1136		if (hwif->ide_dma_end(drive) || (stat & ERR_STAT)) {
1137			/*
1138			 * A DMA error is sometimes expected. For example,
1139			 * if the tape is crossing a filemark during a
1140			 * READ command, it will issue an irq and position
1141			 * itself before the filemark, so that only a partial
1142			 * data transfer will occur (which causes the DMA
1143			 * error). In that case, we will later ask the tape
1144			 * how much bytes of the original request were
1145			 * actually transferred (we can't receive that
1146			 * information from the DMA engine on most chipsets).
1147			 */
1148
1149			/*
1150			 * On the contrary, a DMA error is never expected;
1151			 * it usually indicates a hardware error or abort.
1152			 * If the tape crosses a filemark during a READ
1153			 * command, it will issue an irq and position itself
1154			 * after the filemark (not before). Only a partial
1155			 * data transfer will occur, but no DMA error.
1156			 * (AS, 19 Apr 2001)
1157			 */
1158			set_bit(PC_DMA_ERROR, &pc->flags);
1159		} else {
1160			pc->actually_transferred = pc->request_transfer;
1161			idetape_update_buffers(pc);
1162		}
1163		debug_log(DBG_PROCS, "DMA finished\n");
1164
1165	}
1166
1167	/* No more interrupts */
1168	if ((stat & DRQ_STAT) == 0) {
1169		debug_log(DBG_SENSE, "Packet command completed, %d bytes"
1170				" transferred\n", pc->actually_transferred);
1171
1172		clear_bit(PC_DMA_IN_PROGRESS, &pc->flags);
1173		local_irq_enable();
1174
1175#if SIMULATE_ERRORS
1176		if ((pc->c[0] == WRITE_6 || pc->c[0] == READ_6) &&
1177		    (++error_sim_count % 100) == 0) {
1178			printk(KERN_INFO "ide-tape: %s: simulating error\n",
1179				tape->name);
1180			stat |= ERR_STAT;
1181		}
1182#endif
1183		if ((stat & ERR_STAT) && pc->c[0] == REQUEST_SENSE)
1184			stat &= ~ERR_STAT;
1185		if ((stat & ERR_STAT) || test_bit(PC_DMA_ERROR, &pc->flags)) {
1186			/* Error detected */
1187			debug_log(DBG_ERR, "%s: I/O error\n", tape->name);
1188
1189			if (pc->c[0] == REQUEST_SENSE) {
1190				printk(KERN_ERR "ide-tape: I/O error in request"
1191						" sense command\n");
1192				return ide_do_reset(drive);
1193			}
1194			debug_log(DBG_ERR, "[cmd %x]: check condition\n",
1195					pc->c[0]);
1196
1197			/* Retry operation */
1198			return idetape_retry_pc(drive);
1199		}
1200		pc->error = 0;
1201		if (test_bit(PC_WAIT_FOR_DSC, &pc->flags) &&
1202		    (stat & SEEK_STAT) == 0) {
1203			/* Media access command */
1204			tape->dsc_polling_start = jiffies;
1205			tape->dsc_polling_frequency = IDETAPE_DSC_MA_FAST;
1206			tape->dsc_timeout = jiffies + IDETAPE_DSC_MA_TIMEOUT;
1207			/* Allow ide.c to handle other requests */
1208			idetape_postpone_request(drive);
1209			return ide_stopped;
1210		}
1211		if (tape->failed_pc == pc)
1212			tape->failed_pc = NULL;
1213		/* Command finished - Call the callback function */
1214		return pc->callback(drive);
1215	}
1216	if (test_and_clear_bit(PC_DMA_IN_PROGRESS, &pc->flags)) {
1217		printk(KERN_ERR "ide-tape: The tape wants to issue more "
1218				"interrupts in DMA mode\n");
1219		printk(KERN_ERR "ide-tape: DMA disabled, reverting to PIO\n");
1220		ide_dma_off(drive);
1221		return ide_do_reset(drive);
1222	}
1223	/* Get the number of bytes to transfer on this interrupt. */
1224	bcount = (hwif->INB(IDE_BCOUNTH_REG) << 8) |
1225		  hwif->INB(IDE_BCOUNTL_REG);
1226
1227	ireason = hwif->INB(IDE_IREASON_REG);
1228
1229	if (ireason & CD) {
1230		printk(KERN_ERR "ide-tape: CoD != 0 in %s\n", __func__);
1231		return ide_do_reset(drive);
1232	}
1233	if (((ireason & IO) == IO) == test_bit(PC_WRITING, &pc->flags)) {
1234		/* Hopefully, we will never get here */
1235		printk(KERN_ERR "ide-tape: We wanted to %s, ",
1236				(ireason & IO) ? "Write" : "Read");
1237		printk(KERN_ERR "ide-tape: but the tape wants us to %s !\n",
1238				(ireason & IO) ? "Read" : "Write");
1239		return ide_do_reset(drive);
1240	}
1241	if (!test_bit(PC_WRITING, &pc->flags)) {
1242		/* Reading - Check that we have enough space */
1243		temp = pc->actually_transferred + bcount;
1244		if (temp > pc->request_transfer) {
1245			if (temp > pc->buffer_size) {
1246				printk(KERN_ERR "ide-tape: The tape wants to "
1247					"send us more data than expected "
1248					"- discarding data\n");
1249				idetape_discard_data(drive, bcount);
1250				ide_set_handler(drive, &idetape_pc_intr,
1251						IDETAPE_WAIT_CMD, NULL);
1252				return ide_started;
1253			}
1254			debug_log(DBG_SENSE, "The tape wants to send us more "
1255				"data than expected - allowing transfer\n");
1256		}
1257		iobuf = &idetape_input_buffers;
1258		xferfunc = hwif->atapi_input_bytes;
1259	} else {
1260		iobuf = &idetape_output_buffers;
1261		xferfunc = hwif->atapi_output_bytes;
1262	}
1263
1264	if (pc->bh)
1265		iobuf(drive, pc, bcount);
1266	else
1267		xferfunc(drive, pc->current_position, bcount);
1268
1269	/* Update the current position */
1270	pc->actually_transferred += bcount;
1271	pc->current_position += bcount;
1272
1273	debug_log(DBG_SENSE, "[cmd %x] transferred %d bytes on that intr.\n",
1274			pc->c[0], bcount);
1275
1276	/* And set the interrupt handler again */
1277	ide_set_handler(drive, &idetape_pc_intr, IDETAPE_WAIT_CMD, NULL);
1278	return ide_started;
1279}
1280
1281/*
1282 *	Packet Command Interface
1283 *
1284 *	The current Packet Command is available in tape->pc, and will not
1285 *	change until we finish handling it. Each packet command is associated
1286 *	with a callback function that will be called when the command is
1287 *	finished.
1288 *
1289 *	The handling will be done in three stages:
1290 *
1291 *	1.	idetape_issue_packet_command will send the packet command to the
1292 *		drive, and will set the interrupt handler to idetape_pc_intr.
1293 *
1294 *	2.	On each interrupt, idetape_pc_intr will be called. This step
1295 *		will be repeated until the device signals us that no more
1296 *		interrupts will be issued.
1297 *
1298 *	3.	ATAPI Tape media access commands have immediate status with a
1299 *		delayed process. In case of a successful initiation of a
1300 *		media access packet command, the DSC bit will be set when the
1301 *		actual execution of the command is finished.
1302 *		Since the tape drive will not issue an interrupt, we have to
1303 *		poll for this event. In this case, we define the request as
1304 *		"low priority request" by setting rq_status to
1305 *		IDETAPE_RQ_POSTPONED, 	set a timer to poll for DSC and exit
1306 *		the driver.
1307 *
1308 *		ide.c will then give higher priority to requests which
1309 *		originate from the other device, until will change rq_status
1310 *		to RQ_ACTIVE.
1311 *
1312 *	4.	When the packet command is finished, it will be checked for errors.
1313 *
1314 *	5.	In case an error was found, we queue a request sense packet
1315 *		command in front of the request queue and retry the operation
1316 *		up to IDETAPE_MAX_PC_RETRIES times.
1317 *
1318 *	6.	In case no error was found, or we decided to give up and not
1319 *		to retry again, the callback function will be called and then
1320 *		we will handle the next request.
1321 *
1322 */
1323static ide_startstop_t idetape_transfer_pc(ide_drive_t *drive)
1324{
1325	ide_hwif_t *hwif = drive->hwif;
1326	idetape_tape_t *tape = drive->driver_data;
1327	idetape_pc_t *pc = tape->pc;
1328	int retries = 100;
1329	ide_startstop_t startstop;
1330	u8 ireason;
1331
1332	if (ide_wait_stat(&startstop,drive,DRQ_STAT,BUSY_STAT,WAIT_READY)) {
1333		printk(KERN_ERR "ide-tape: Strange, packet command initiated yet DRQ isn't asserted\n");
1334		return startstop;
1335	}
1336	ireason = hwif->INB(IDE_IREASON_REG);
1337	while (retries-- && ((ireason & CD) == 0 || (ireason & IO))) {
1338		printk(KERN_ERR "ide-tape: (IO,CoD != (0,1) while issuing "
1339				"a packet command, retrying\n");
1340		udelay(100);
1341		ireason = hwif->INB(IDE_IREASON_REG);
1342		if (retries == 0) {
1343			printk(KERN_ERR "ide-tape: (IO,CoD != (0,1) while "
1344					"issuing a packet command, ignoring\n");
1345			ireason |= CD;
1346			ireason &= ~IO;
1347		}
1348	}
1349	if ((ireason & CD) == 0 || (ireason & IO)) {
1350		printk(KERN_ERR "ide-tape: (IO,CoD) != (0,1) while issuing "
1351				"a packet command\n");
1352		return ide_do_reset(drive);
1353	}
1354	/* Set the interrupt routine */
1355	ide_set_handler(drive, &idetape_pc_intr, IDETAPE_WAIT_CMD, NULL);
1356#ifdef CONFIG_BLK_DEV_IDEDMA
1357	/* Begin DMA, if necessary */
1358	if (test_bit(PC_DMA_IN_PROGRESS, &pc->flags))
1359		hwif->dma_start(drive);
1360#endif
1361	/* Send the actual packet */
1362	HWIF(drive)->atapi_output_bytes(drive, pc->c, 12);
1363	return ide_started;
1364}
1365
1366static ide_startstop_t idetape_issue_packet_command (ide_drive_t *drive, idetape_pc_t *pc)
1367{
1368	ide_hwif_t *hwif = drive->hwif;
1369	idetape_tape_t *tape = drive->driver_data;
1370	int dma_ok = 0;
1371	u16 bcount;
1372
1373	if (tape->pc->c[0] == REQUEST_SENSE &&
1374	    pc->c[0] == REQUEST_SENSE) {
1375		printk(KERN_ERR "ide-tape: possible ide-tape.c bug - "
1376			"Two request sense in serial were issued\n");
1377	}
1378
1379	if (tape->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
1380		tape->failed_pc = pc;
1381	/* Set the current packet command */
1382	tape->pc = pc;
1383
1384	if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
1385	    test_bit(PC_ABORT, &pc->flags)) {
1386		/*
1387		 *	We will "abort" retrying a packet command in case
1388		 *	a legitimate error code was received (crossing a
1389		 *	filemark, or end of the media, for example).
1390		 */
1391		if (!test_bit(PC_ABORT, &pc->flags)) {
1392			if (!(pc->c[0] == TEST_UNIT_READY &&
1393			      tape->sense_key == 2 && tape->asc == 4 &&
1394			     (tape->ascq == 1 || tape->ascq == 8))) {
1395				printk(KERN_ERR "ide-tape: %s: I/O error, "
1396						"pc = %2x, key = %2x, "
1397						"asc = %2x, ascq = %2x\n",
1398						tape->name, pc->c[0],
1399						tape->sense_key, tape->asc,
1400						tape->ascq);
1401			}
1402			/* Giving up */
1403			pc->error = IDETAPE_ERROR_GENERAL;
1404		}
1405		tape->failed_pc = NULL;
1406		return pc->callback(drive);
1407	}
1408	debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
1409
1410	pc->retries++;
1411	/* We haven't transferred any data yet */
1412	pc->actually_transferred = 0;
1413	pc->current_position = pc->buffer;
1414	/* Request to transfer the entire buffer at once */
1415	bcount = pc->request_transfer;
1416
1417	if (test_and_clear_bit(PC_DMA_ERROR, &pc->flags)) {
1418		printk(KERN_WARNING "ide-tape: DMA disabled, "
1419				"reverting to PIO\n");
1420		ide_dma_off(drive);
1421	}
1422	if (test_bit(PC_DMA_RECOMMENDED, &pc->flags) && drive->using_dma)
1423		dma_ok = !hwif->dma_setup(drive);
1424
1425	ide_pktcmd_tf_load(drive, IDE_TFLAG_NO_SELECT_MASK |
1426			   IDE_TFLAG_OUT_DEVICE, bcount, dma_ok);
1427
1428	if (dma_ok)			/* Will begin DMA later */
1429		set_bit(PC_DMA_IN_PROGRESS, &pc->flags);
1430	if (test_bit(IDETAPE_DRQ_INTERRUPT, &tape->flags)) {
1431		ide_execute_command(drive, WIN_PACKETCMD, &idetape_transfer_pc,
1432				    IDETAPE_WAIT_CMD, NULL);
1433		return ide_started;
1434	} else {
1435		hwif->OUTB(WIN_PACKETCMD, IDE_COMMAND_REG);
1436		return idetape_transfer_pc(drive);
1437	}
1438}
1439
1440/*
1441 *	General packet command callback function.
1442 */
1443static ide_startstop_t idetape_pc_callback (ide_drive_t *drive)
1444{
1445	idetape_tape_t *tape = drive->driver_data;
1446
1447	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1448
1449	idetape_end_request(drive, tape->pc->error ? 0 : 1, 0);
1450	return ide_stopped;
1451}
1452
1453/*
1454 *	A mode sense command is used to "sense" tape parameters.
1455 */
1456static void idetape_create_mode_sense_cmd (idetape_pc_t *pc, u8 page_code)
1457{
1458	idetape_init_pc(pc);
1459	pc->c[0] = MODE_SENSE;
1460	if (page_code != IDETAPE_BLOCK_DESCRIPTOR)
1461		pc->c[1] = 8;	/* DBD = 1 - Don't return block descriptors */
1462	pc->c[2] = page_code;
1463	/*
1464	 * Changed pc->c[3] to 0 (255 will at best return unused info).
1465	 *
1466	 * For SCSI this byte is defined as subpage instead of high byte
1467	 * of length and some IDE drives seem to interpret it this way
1468	 * and return an error when 255 is used.
1469	 */
1470	pc->c[3] = 0;
1471	pc->c[4] = 255;		/* (We will just discard data in that case) */
1472	if (page_code == IDETAPE_BLOCK_DESCRIPTOR)
1473		pc->request_transfer = 12;
1474	else if (page_code == IDETAPE_CAPABILITIES_PAGE)
1475		pc->request_transfer = 24;
1476	else
1477		pc->request_transfer = 50;
1478	pc->callback = &idetape_pc_callback;
1479}
1480
1481static void idetape_calculate_speeds(ide_drive_t *drive)
1482{
1483	idetape_tape_t *tape = drive->driver_data;
1484
1485	if (time_after(jiffies, tape->controlled_pipeline_head_time + 120 * HZ)) {
1486		tape->controlled_previous_pipeline_head = tape->controlled_last_pipeline_head;
1487		tape->controlled_previous_head_time = tape->controlled_pipeline_head_time;
1488		tape->controlled_last_pipeline_head = tape->pipeline_head;
1489		tape->controlled_pipeline_head_time = jiffies;
1490	}
1491	if (time_after(jiffies, tape->controlled_pipeline_head_time + 60 * HZ))
1492		tape->controlled_pipeline_head_speed = (tape->pipeline_head - tape->controlled_last_pipeline_head) * 32 * HZ / (jiffies - tape->controlled_pipeline_head_time);
1493	else if (time_after(jiffies, tape->controlled_previous_head_time))
1494		tape->controlled_pipeline_head_speed = (tape->pipeline_head - tape->controlled_previous_pipeline_head) * 32 * HZ / (jiffies - tape->controlled_previous_head_time);
1495
1496	if (tape->nr_pending_stages < tape->max_stages /*- 1 */) {
1497		/* -1 for read mode error recovery */
1498		if (time_after(jiffies, tape->uncontrolled_previous_head_time + 10 * HZ)) {
1499			tape->uncontrolled_pipeline_head_time = jiffies;
1500			tape->uncontrolled_pipeline_head_speed = (tape->pipeline_head - tape->uncontrolled_previous_pipeline_head) * 32 * HZ / (jiffies - tape->uncontrolled_previous_head_time);
1501		}
1502	} else {
1503		tape->uncontrolled_previous_head_time = jiffies;
1504		tape->uncontrolled_previous_pipeline_head = tape->pipeline_head;
1505		if (time_after(jiffies, tape->uncontrolled_pipeline_head_time + 30 * HZ)) {
1506			tape->uncontrolled_pipeline_head_time = jiffies;
1507		}
1508	}
1509	tape->pipeline_head_speed = max(tape->uncontrolled_pipeline_head_speed, tape->controlled_pipeline_head_speed);
1510
1511	if (tape->speed_control == 1) {
1512		if (tape->nr_pending_stages >= tape->max_stages / 2)
1513			tape->max_insert_speed = tape->pipeline_head_speed +
1514				(1100 - tape->pipeline_head_speed) * 2 * (tape->nr_pending_stages - tape->max_stages / 2) / tape->max_stages;
1515		else
1516			tape->max_insert_speed = 500 +
1517				(tape->pipeline_head_speed - 500) * 2 * tape->nr_pending_stages / tape->max_stages;
1518
1519		if (tape->nr_pending_stages >= tape->max_stages * 99 / 100)
1520			tape->max_insert_speed = 5000;
1521	} else
1522		tape->max_insert_speed = tape->speed_control;
1523
1524	tape->max_insert_speed = max(tape->max_insert_speed, 500);
1525}
1526
1527static ide_startstop_t idetape_media_access_finished (ide_drive_t *drive)
1528{
1529	idetape_tape_t *tape = drive->driver_data;
1530	idetape_pc_t *pc = tape->pc;
1531	u8 stat;
1532
1533	stat = ide_read_status(drive);
1534
1535	if (stat & SEEK_STAT) {
1536		if (stat & ERR_STAT) {
1537			/* Error detected */
1538			if (pc->c[0] != TEST_UNIT_READY)
1539				printk(KERN_ERR "ide-tape: %s: I/O error, ",
1540						tape->name);
1541			/* Retry operation */
1542			return idetape_retry_pc(drive);
1543		}
1544		pc->error = 0;
1545		if (tape->failed_pc == pc)
1546			tape->failed_pc = NULL;
1547	} else {
1548		pc->error = IDETAPE_ERROR_GENERAL;
1549		tape->failed_pc = NULL;
1550	}
1551	return pc->callback(drive);
1552}
1553
1554static ide_startstop_t idetape_rw_callback (ide_drive_t *drive)
1555{
1556	idetape_tape_t *tape = drive->driver_data;
1557	struct request *rq = HWGROUP(drive)->rq;
1558	int blocks = tape->pc->actually_transferred / tape->tape_block_size;
1559
1560	tape->avg_size += blocks * tape->tape_block_size;
1561	tape->insert_size += blocks * tape->tape_block_size;
1562	if (tape->insert_size > 1024 * 1024)
1563		tape->measure_insert_time = 1;
1564	if (tape->measure_insert_time) {
1565		tape->measure_insert_time = 0;
1566		tape->insert_time = jiffies;
1567		tape->insert_size = 0;
1568	}
1569	if (time_after(jiffies, tape->insert_time))
1570		tape->insert_speed = tape->insert_size / 1024 * HZ / (jiffies - tape->insert_time);
1571	if (time_after_eq(jiffies, tape->avg_time + HZ)) {
1572		tape->avg_speed = tape->avg_size * HZ / (jiffies - tape->avg_time) / 1024;
1573		tape->avg_size = 0;
1574		tape->avg_time = jiffies;
1575	}
1576	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1577
1578	tape->first_frame_position += blocks;
1579	rq->current_nr_sectors -= blocks;
1580
1581	if (!tape->pc->error)
1582		idetape_end_request(drive, 1, 0);
1583	else
1584		idetape_end_request(drive, tape->pc->error, 0);
1585	return ide_stopped;
1586}
1587
1588static void idetape_create_read_cmd(idetape_tape_t *tape, idetape_pc_t *pc, unsigned int length, struct idetape_bh *bh)
1589{
1590	idetape_init_pc(pc);
1591	pc->c[0] = READ_6;
1592	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
1593	pc->c[1] = 1;
1594	pc->callback = &idetape_rw_callback;
1595	pc->bh = bh;
1596	atomic_set(&bh->b_count, 0);
1597	pc->buffer = NULL;
1598	pc->request_transfer = pc->buffer_size = length * tape->tape_block_size;
1599	if (pc->request_transfer == tape->stage_size)
1600		set_bit(PC_DMA_RECOMMENDED, &pc->flags);
1601}
1602
1603static void idetape_create_read_buffer_cmd(idetape_tape_t *tape, idetape_pc_t *pc, unsigned int length, struct idetape_bh *bh)
1604{
1605	int size = 32768;
1606	struct idetape_bh *p = bh;
1607
1608	idetape_init_pc(pc);
1609	pc->c[0] = READ_BUFFER;
1610	pc->c[1] = IDETAPE_RETRIEVE_FAULTY_BLOCK;
1611	pc->c[7] = size >> 8;
1612	pc->c[8] = size & 0xff;
1613	pc->callback = &idetape_pc_callback;
1614	pc->bh = bh;
1615	atomic_set(&bh->b_count, 0);
1616	pc->buffer = NULL;
1617	while (p) {
1618		atomic_set(&p->b_count, 0);
1619		p = p->b_reqnext;
1620	}
1621	pc->request_transfer = pc->buffer_size = size;
1622}
1623
1624static void idetape_create_write_cmd(idetape_tape_t *tape, idetape_pc_t *pc, unsigned int length, struct idetape_bh *bh)
1625{
1626	idetape_init_pc(pc);
1627	pc->c[0] = WRITE_6;
1628	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
1629	pc->c[1] = 1;
1630	pc->callback = &idetape_rw_callback;
1631	set_bit(PC_WRITING, &pc->flags);
1632	pc->bh = bh;
1633	pc->b_data = bh->b_data;
1634	pc->b_count = atomic_read(&bh->b_count);
1635	pc->buffer = NULL;
1636	pc->request_transfer = pc->buffer_size = length * tape->tape_block_size;
1637	if (pc->request_transfer == tape->stage_size)
1638		set_bit(PC_DMA_RECOMMENDED, &pc->flags);
1639}
1640
1641/*
1642 * idetape_do_request is our request handling function.
1643 */
1644static ide_startstop_t idetape_do_request(ide_drive_t *drive,
1645					  struct request *rq, sector_t block)
1646{
1647	idetape_tape_t *tape = drive->driver_data;
1648	idetape_pc_t *pc = NULL;
1649	struct request *postponed_rq = tape->postponed_rq;
1650	u8 stat;
1651
1652	debug_log(DBG_SENSE, "sector: %ld, nr_sectors: %ld,"
1653			" current_nr_sectors: %d\n",
1654			rq->sector, rq->nr_sectors, rq->current_nr_sectors);
1655
1656	if (!blk_special_request(rq)) {
1657		/*
1658		 * We do not support buffer cache originated requests.
1659		 */
1660		printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
1661			"request queue (%d)\n", drive->name, rq->cmd_type);
1662		ide_end_request(drive, 0, 0);
1663		return ide_stopped;
1664	}
1665
1666	/*
1667	 *	Retry a failed packet command
1668	 */
1669	if (tape->failed_pc != NULL &&
1670	    tape->pc->c[0] == REQUEST_SENSE) {
1671		return idetape_issue_packet_command(drive, tape->failed_pc);
1672	}
1673	if (postponed_rq != NULL)
1674		if (rq != postponed_rq) {
1675			printk(KERN_ERR "ide-tape: ide-tape.c bug - "
1676					"Two DSC requests were queued\n");
1677			idetape_end_request(drive, 0, 0);
1678			return ide_stopped;
1679		}
1680
1681	tape->postponed_rq = NULL;
1682
1683	/*
1684	 * If the tape is still busy, postpone our request and service
1685	 * the other device meanwhile.
1686	 */
1687	stat = ide_read_status(drive);
1688
1689	if (!drive->dsc_overlap && !(rq->cmd[0] & REQ_IDETAPE_PC2))
1690		set_bit(IDETAPE_IGNORE_DSC, &tape->flags);
1691
1692	if (drive->post_reset == 1) {
1693		set_bit(IDETAPE_IGNORE_DSC, &tape->flags);
1694		drive->post_reset = 0;
1695	}
1696
1697	if (tape->tape_still_time > 100 && tape->tape_still_time < 200)
1698		tape->measure_insert_time = 1;
1699	if (time_after(jiffies, tape->insert_time))
1700		tape->insert_speed = tape->insert_size / 1024 * HZ / (jiffies - tape->insert_time);
1701	idetape_calculate_speeds(drive);
1702	if (!test_and_clear_bit(IDETAPE_IGNORE_DSC, &tape->flags) &&
1703	    (stat & SEEK_STAT) == 0) {
1704		if (postponed_rq == NULL) {
1705			tape->dsc_polling_start = jiffies;
1706			tape->dsc_polling_frequency = tape->best_dsc_rw_frequency;
1707			tape->dsc_timeout = jiffies + IDETAPE_DSC_RW_TIMEOUT;
1708		} else if (time_after(jiffies, tape->dsc_timeout)) {
1709			printk(KERN_ERR "ide-tape: %s: DSC timeout\n",
1710				tape->name);
1711			if (rq->cmd[0] & REQ_IDETAPE_PC2) {
1712				idetape_media_access_finished(drive);
1713				return ide_stopped;
1714			} else {
1715				return ide_do_reset(drive);
1716			}
1717		} else if (time_after(jiffies, tape->dsc_polling_start + IDETAPE_DSC_MA_THRESHOLD))
1718			tape->dsc_polling_frequency = IDETAPE_DSC_MA_SLOW;
1719		idetape_postpone_request(drive);
1720		return ide_stopped;
1721	}
1722	if (rq->cmd[0] & REQ_IDETAPE_READ) {
1723		tape->buffer_head++;
1724		tape->postpone_cnt = 0;
1725		pc = idetape_next_pc_storage(drive);
1726		idetape_create_read_cmd(tape, pc, rq->current_nr_sectors, (struct idetape_bh *)rq->special);
1727		goto out;
1728	}
1729	if (rq->cmd[0] & REQ_IDETAPE_WRITE) {
1730		tape->buffer_head++;
1731		tape->postpone_cnt = 0;
1732		pc = idetape_next_pc_storage(drive);
1733		idetape_create_write_cmd(tape, pc, rq->current_nr_sectors, (struct idetape_bh *)rq->special);
1734		goto out;
1735	}
1736	if (rq->cmd[0] & REQ_IDETAPE_READ_BUFFER) {
1737		tape->postpone_cnt = 0;
1738		pc = idetape_next_pc_storage(drive);
1739		idetape_create_read_buffer_cmd(tape, pc, rq->current_nr_sectors, (struct idetape_bh *)rq->special);
1740		goto out;
1741	}
1742	if (rq->cmd[0] & REQ_IDETAPE_PC1) {
1743		pc = (idetape_pc_t *) rq->buffer;
1744		rq->cmd[0] &= ~(REQ_IDETAPE_PC1);
1745		rq->cmd[0] |= REQ_IDETAPE_PC2;
1746		goto out;
1747	}
1748	if (rq->cmd[0] & REQ_IDETAPE_PC2) {
1749		idetape_media_access_finished(drive);
1750		return ide_stopped;
1751	}
1752	BUG();
1753out:
1754	return idetape_issue_packet_command(drive, pc);
1755}
1756
1757/*
1758 *	Pipeline related functions
1759 */
1760static inline int idetape_pipeline_active (idetape_tape_t *tape)
1761{
1762	int rc1, rc2;
1763
1764	rc1 = test_bit(IDETAPE_PIPELINE_ACTIVE, &tape->flags);
1765	rc2 = (tape->active_data_request != NULL);
1766	return rc1;
1767}
1768
1769/*
1770 *	idetape_kmalloc_stage uses __get_free_page to allocate a pipeline
1771 *	stage, along with all the necessary small buffers which together make
1772 *	a buffer of size tape->stage_size (or a bit more). We attempt to
1773 *	combine sequential pages as much as possible.
1774 *
1775 *	Returns a pointer to the new allocated stage, or NULL if we
1776 *	can't (or don't want to) allocate a stage.
1777 *
1778 *	Pipeline stages are optional and are used to increase performance.
1779 *	If we can't allocate them, we'll manage without them.
1780 */
1781static idetape_stage_t *__idetape_kmalloc_stage (idetape_tape_t *tape, int full, int clear)
1782{
1783	idetape_stage_t *stage;
1784	struct idetape_bh *prev_bh, *bh;
1785	int pages = tape->pages_per_stage;
1786	char *b_data = NULL;
1787
1788	if ((stage = kmalloc(sizeof (idetape_stage_t),GFP_KERNEL)) == NULL)
1789		return NULL;
1790	stage->next = NULL;
1791
1792	bh = stage->bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
1793	if (bh == NULL)
1794		goto abort;
1795	bh->b_reqnext = NULL;
1796	if ((bh->b_data = (char *) __get_free_page (GFP_KERNEL)) == NULL)
1797		goto abort;
1798	if (clear)
1799		memset(bh->b_data, 0, PAGE_SIZE);
1800	bh->b_size = PAGE_SIZE;
1801	atomic_set(&bh->b_count, full ? bh->b_size : 0);
1802
1803	while (--pages) {
1804		if ((b_data = (char *) __get_free_page (GFP_KERNEL)) == NULL)
1805			goto abort;
1806		if (clear)
1807			memset(b_data, 0, PAGE_SIZE);
1808		if (bh->b_data == b_data + PAGE_SIZE) {
1809			bh->b_size += PAGE_SIZE;
1810			bh->b_data -= PAGE_SIZE;
1811			if (full)
1812				atomic_add(PAGE_SIZE, &bh->b_count);
1813			continue;
1814		}
1815		if (b_data == bh->b_data + bh->b_size) {
1816			bh->b_size += PAGE_SIZE;
1817			if (full)
1818				atomic_add(PAGE_SIZE, &bh->b_count);
1819			continue;
1820		}
1821		prev_bh = bh;
1822		if ((bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL)) == NULL) {
1823			free_page((unsigned long) b_data);
1824			goto abort;
1825		}
1826		bh->b_reqnext = NULL;
1827		bh->b_data = b_data;
1828		bh->b_size = PAGE_SIZE;
1829		atomic_set(&bh->b_count, full ? bh->b_size : 0);
1830		prev_bh->b_reqnext = bh;
1831	}
1832	bh->b_size -= tape->excess_bh_size;
1833	if (full)
1834		atomic_sub(tape->excess_bh_size, &bh->b_count);
1835	return stage;
1836abort:
1837	__idetape_kfree_stage(stage);
1838	return NULL;
1839}
1840
1841static idetape_stage_t *idetape_kmalloc_stage (idetape_tape_t *tape)
1842{
1843	idetape_stage_t *cache_stage = tape->cache_stage;
1844
1845	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1846
1847	if (tape->nr_stages >= tape->max_stages)
1848		return NULL;
1849	if (cache_stage != NULL) {
1850		tape->cache_stage = NULL;
1851		return cache_stage;
1852	}
1853	return __idetape_kmalloc_stage(tape, 0, 0);
1854}
1855
1856static int idetape_copy_stage_from_user (idetape_tape_t *tape, idetape_stage_t *stage, const char __user *buf, int n)
1857{
1858	struct idetape_bh *bh = tape->bh;
1859	int count;
1860	int ret = 0;
1861
1862	while (n) {
1863		if (bh == NULL) {
1864			printk(KERN_ERR "ide-tape: bh == NULL in "
1865				"idetape_copy_stage_from_user\n");
1866			return 1;
1867		}
1868		count = min((unsigned int)(bh->b_size - atomic_read(&bh->b_count)), (unsigned int)n);
1869		if (copy_from_user(bh->b_data + atomic_read(&bh->b_count), buf, count))
1870			ret = 1;
1871		n -= count;
1872		atomic_add(count, &bh->b_count);
1873		buf += count;
1874		if (atomic_read(&bh->b_count) == bh->b_size) {
1875			bh = bh->b_reqnext;
1876			if (bh)
1877				atomic_set(&bh->b_count, 0);
1878		}
1879	}
1880	tape->bh = bh;
1881	return ret;
1882}
1883
1884static int idetape_copy_stage_to_user (idetape_tape_t *tape, char __user *buf, idetape_stage_t *stage, int n)
1885{
1886	struct idetape_bh *bh = tape->bh;
1887	int count;
1888	int ret = 0;
1889
1890	while (n) {
1891		if (bh == NULL) {
1892			printk(KERN_ERR "ide-tape: bh == NULL in "
1893				"idetape_copy_stage_to_user\n");
1894			return 1;
1895		}
1896		count = min(tape->b_count, n);
1897		if  (copy_to_user(buf, tape->b_data, count))
1898			ret = 1;
1899		n -= count;
1900		tape->b_data += count;
1901		tape->b_count -= count;
1902		buf += count;
1903		if (!tape->b_count) {
1904			tape->bh = bh = bh->b_reqnext;
1905			if (bh) {
1906				tape->b_data = bh->b_data;
1907				tape->b_count = atomic_read(&bh->b_count);
1908			}
1909		}
1910	}
1911	return ret;
1912}
1913
1914static void idetape_init_merge_stage (idetape_tape_t *tape)
1915{
1916	struct idetape_bh *bh = tape->merge_stage->bh;
1917
1918	tape->bh = bh;
1919	if (tape->chrdev_direction == idetape_direction_write)
1920		atomic_set(&bh->b_count, 0);
1921	else {
1922		tape->b_data = bh->b_data;
1923		tape->b_count = atomic_read(&bh->b_count);
1924	}
1925}
1926
1927static void idetape_switch_buffers (idetape_tape_t *tape, idetape_stage_t *stage)
1928{
1929	struct idetape_bh *tmp;
1930
1931	tmp = stage->bh;
1932	stage->bh = tape->merge_stage->bh;
1933	tape->merge_stage->bh = tmp;
1934	idetape_init_merge_stage(tape);
1935}
1936
1937/*
1938 *	idetape_add_stage_tail adds a new stage at the end of the pipeline.
1939 */
1940static void idetape_add_stage_tail (ide_drive_t *drive,idetape_stage_t *stage)
1941{
1942	idetape_tape_t *tape = drive->driver_data;
1943	unsigned long flags;
1944
1945	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1946
1947	spin_lock_irqsave(&tape->spinlock, flags);
1948	stage->next = NULL;
1949	if (tape->last_stage != NULL)
1950		tape->last_stage->next=stage;
1951	else
1952		tape->first_stage = tape->next_stage=stage;
1953	tape->last_stage = stage;
1954	if (tape->next_stage == NULL)
1955		tape->next_stage = tape->last_stage;
1956	tape->nr_stages++;
1957	tape->nr_pending_stages++;
1958	spin_unlock_irqrestore(&tape->spinlock, flags);
1959}
1960
1961/*
1962 *	idetape_wait_for_request installs a completion in a pending request
1963 *	and sleeps until it is serviced.
1964 *
1965 *	The caller should ensure that the request will not be serviced
1966 *	before we install the completion (usually by disabling interrupts).
1967 */
1968static void idetape_wait_for_request (ide_drive_t *drive, struct request *rq)
1969{
1970	DECLARE_COMPLETION_ONSTACK(wait);
1971	idetape_tape_t *tape = drive->driver_data;
1972
1973	if (rq == NULL || !blk_special_request(rq)) {
1974		printk (KERN_ERR "ide-tape: bug: Trying to sleep on non-valid request\n");
1975		return;
1976	}
1977	rq->end_io_data = &wait;
1978	rq->end_io = blk_end_sync_rq;
1979	spin_unlock_irq(&tape->spinlock);
1980	wait_for_completion(&wait);
1981	/* The stage and its struct request have been deallocated */
1982	spin_lock_irq(&tape->spinlock);
1983}
1984
1985static ide_startstop_t idetape_read_position_callback(ide_drive_t *drive)
1986{
1987	idetape_tape_t *tape = drive->driver_data;
1988	u8 *readpos = tape->pc->buffer;
1989
1990	debug_log(DBG_PROCS, "Enter %s\n", __func__);
1991
1992	if (!tape->pc->error) {
1993		debug_log(DBG_SENSE, "BOP - %s\n",
1994				(readpos[0] & 0x80) ? "Yes" : "No");
1995		debug_log(DBG_SENSE, "EOP - %s\n",
1996				(readpos[0] & 0x40) ? "Yes" : "No");
1997
1998		if (readpos[0] & 0x4) {
1999			printk(KERN_INFO "ide-tape: Block location is unknown"
2000					 "to the tape\n");
2001			clear_bit(IDETAPE_ADDRESS_VALID, &tape->flags);
2002			idetape_end_request(drive, 0, 0);
2003		} else {
2004			debug_log(DBG_SENSE, "Block Location - %u\n",
2005					be32_to_cpu(*(u32 *)&readpos[4]));
2006
2007			tape->partition = readpos[1];
2008			tape->first_frame_position =
2009				be32_to_cpu(*(u32 *)&readpos[4]);
2010			tape->last_frame_position =
2011				be32_to_cpu(*(u32 *)&readpos[8]);
2012			tape->blocks_in_buffer = readpos[15];
2013			set_bit(IDETAPE_ADDRESS_VALID, &tape->flags);
2014			idetape_end_request(drive, 1, 0);
2015		}
2016	} else {
2017		idetape_end_request(drive, 0, 0);
2018	}
2019	return ide_stopped;
2020}
2021
2022/*
2023 *	idetape_create_write_filemark_cmd will:
2024 *
2025 *		1.	Write a filemark if write_filemark=1.
2026 *		2.	Flush the device buffers without writing a filemark
2027 *			if write_filemark=0.
2028 *
2029 */
2030static void idetape_create_write_filemark_cmd (ide_drive_t *drive, idetape_pc_t *pc,int write_filemark)
2031{
2032	idetape_init_pc(pc);
2033	pc->c[0] = WRITE_FILEMARKS;
2034	pc->c[4] = write_filemark;
2035	set_bit(PC_WAIT_FOR_DSC, &pc->flags);
2036	pc->callback = &idetape_pc_callback;
2037}
2038
2039static void idetape_create_test_unit_ready_cmd(idetape_pc_t *pc)
2040{
2041	idetape_init_pc(pc);
2042	pc->c[0] = TEST_UNIT_READY;
2043	pc->callback = &idetape_pc_callback;
2044}
2045
2046/*
2047 *	idetape_queue_pc_tail is based on the following functions:
2048 *
2049 *	ide_do_drive_cmd from ide.c
2050 *	cdrom_queue_request and cdrom_queue_packet_command from ide-cd.c
2051 *
2052 *	We add a special packet command request to the tail of the request
2053 *	queue, and wait for it to be serviced.
2054 *
2055 *	This is not to be called from within the request handling part
2056 *	of the driver ! We allocate here data in the stack, and it is valid
2057 *	until the request is finished. This is not the case for the bottom
2058 *	part of the driver, where we are always leaving the functions to wait
2059 *	for an interrupt or a timer event.
2060 *
2061 *	From the bottom part of the driver, we should allocate safe memory
2062 *	using idetape_next_pc_storage and idetape_next_rq_storage, and add
2063 *	the request to the request list without waiting for it to be serviced !
2064 *	In that case, we usually use idetape_queue_pc_head.
2065 */
2066static int __idetape_queue_pc_tail (ide_drive_t *drive, idetape_pc_t *pc)
2067{
2068	struct ide_tape_obj *tape = drive->driver_data;
2069	struct request rq;
2070
2071	idetape_init_rq(&rq, REQ_IDETAPE_PC1);
2072	rq.buffer = (char *) pc;
2073	rq.rq_disk = tape->disk;
2074	return ide_do_drive_cmd(drive, &rq, ide_wait);
2075}
2076
2077static void idetape_create_load_unload_cmd (ide_drive_t *drive, idetape_pc_t *pc,int cmd)
2078{
2079	idetape_init_pc(pc);
2080	pc->c[0] = START_STOP;
2081	pc->c[4] = cmd;
2082	set_bit(PC_WAIT_FOR_DSC, &pc->flags);
2083	pc->callback = &idetape_pc_callback;
2084}
2085
2086static int idetape_wait_ready(ide_drive_t *drive, unsigned long timeout)
2087{
2088	idetape_tape_t *tape = drive->driver_data;
2089	idetape_pc_t pc;
2090	int load_attempted = 0;
2091
2092	/*
2093	 * Wait for the tape to become ready
2094	 */
2095	set_bit(IDETAPE_MEDIUM_PRESENT, &tape->flags);
2096	timeout += jiffies;
2097	while (time_before(jiffies, timeout)) {
2098		idetape_create_test_unit_ready_cmd(&pc);
2099		if (!__idetape_queue_pc_tail(drive, &pc))
2100			return 0;
2101		if ((tape->sense_key == 2 && tape->asc == 4 && tape->ascq == 2)
2102		    || (tape->asc == 0x3A)) {	/* no media */
2103			if (load_attempted)
2104				return -ENOMEDIUM;
2105			idetape_create_load_unload_cmd(drive, &pc, IDETAPE_LU_LOAD_MASK);
2106			__idetape_queue_pc_tail(drive, &pc);
2107			load_attempted = 1;
2108		/* not about to be ready */
2109		} else if (!(tape->sense_key == 2 && tape->asc == 4 &&
2110			     (tape->ascq == 1 || tape->ascq == 8)))
2111			return -EIO;
2112		msleep(100);
2113	}
2114	return -EIO;
2115}
2116
2117static int idetape_queue_pc_tail (ide_drive_t *drive,idetape_pc_t *pc)
2118{
2119	return __idetape_queue_pc_tail(drive, pc);
2120}
2121
2122static int idetape_flush_tape_buffers (ide_drive_t *drive)
2123{
2124	idetape_pc_t pc;
2125	int rc;
2126
2127	idetape_create_write_filemark_cmd(drive, &pc, 0);
2128	if ((rc = idetape_queue_pc_tail(drive, &pc)))
2129		return rc;
2130	idetape_wait_ready(drive, 60 * 5 * HZ);
2131	return 0;
2132}
2133
2134static void idetape_create_read_position_cmd (idetape_pc_t *pc)
2135{
2136	idetape_init_pc(pc);
2137	pc->c[0] = READ_POSITION;
2138	pc->request_transfer = 20;
2139	pc->callback = &idetape_read_position_callback;
2140}
2141
2142static int idetape_read_position (ide_drive_t *drive)
2143{
2144	idetape_tape_t *tape = drive->driver_data;
2145	idetape_pc_t pc;
2146	int position;
2147
2148	debug_log(DBG_PROCS, "Enter %s\n", __func__);
2149
2150	idetape_create_read_position_cmd(&pc);
2151	if (idetape_queue_pc_tail(drive, &pc))
2152		return -1;
2153	position = tape->first_frame_position;
2154	return position;
2155}
2156
2157static void idetape_create_locate_cmd (ide_drive_t *drive, idetape_pc_t *pc, unsigned int block, u8 partition, int skip)
2158{
2159	idetape_init_pc(pc);
2160	pc->c[0] = POSITION_TO_ELEMENT;
2161	pc->c[1] = 2;
2162	put_unaligned(cpu_to_be32(block), (unsigned int *) &pc->c[3]);
2163	pc->c[8] = partition;
2164	set_bit(PC_WAIT_FOR_DSC, &pc->flags);
2165	pc->callback = &idetape_pc_callback;
2166}
2167
2168static int idetape_create_prevent_cmd (ide_drive_t *drive, idetape_pc_t *pc, int prevent)
2169{
2170	idetape_tape_t *tape = drive->driver_data;
2171
2172	/* device supports locking according to capabilities page */
2173	if (!(tape->caps[6] & 0x01))
2174		return 0;
2175
2176	idetape_init_pc(pc);
2177	pc->c[0] = ALLOW_MEDIUM_REMOVAL;
2178	pc->c[4] = prevent;
2179	pc->callback = &idetape_pc_callback;
2180	return 1;
2181}
2182
2183static int __idetape_discard_read_pipeline (ide_drive_t *drive)
2184{
2185	idetape_tape_t *tape = drive->driver_data;
2186	unsigned long flags;
2187	int cnt;
2188
2189	if (tape->chrdev_direction != idetape_direction_read)
2190		return 0;
2191
2192	/* Remove merge stage. */
2193	cnt = tape->merge_stage_size / tape->tape_block_size;
2194	if (test_and_clear_bit(IDETAPE_FILEMARK, &tape->flags))
2195		++cnt;		/* Filemarks count as 1 sector */
2196	tape->merge_stage_size = 0;
2197	if (tape->merge_stage != NULL) {
2198		__idetape_kfree_stage(tape->merge_stage);
2199		tape->merge_stage = NULL;
2200	}
2201
2202	/* Clear pipeline flags. */
2203	clear_bit(IDETAPE_PIPELINE_ERROR, &tape->flags);
2204	tape->chrdev_direction = idetape_direction_none;
2205
2206	/* Remove pipeline stages. */
2207	if (tape->first_stage == NULL)
2208		return 0;
2209
2210	spin_lock_irqsave(&tape->spinlock, flags);
2211	tape->next_stage = NULL;
2212	if (idetape_pipeline_active(tape))
2213		idetape_wait_for_request(drive, tape->active_data_request);
2214	spin_unlock_irqrestore(&tape->spinlock, flags);
2215
2216	while (tape->first_stage != NULL) {
2217		struct request *rq_ptr = &tape->first_stage->rq;
2218
2219		cnt += rq_ptr->nr_sectors - rq_ptr->current_nr_sectors;
2220		if (rq_ptr->errors == IDETAPE_ERROR_FILEMARK)
2221			++cnt;
2222		idetape_remove_stage_head(drive);
2223	}
2224	tape->nr_pending_stages = 0;
2225	tape->max_stages = tape->min_pipeline;
2226	return cnt;
2227}
2228
2229/*
2230 *	idetape_position_tape positions the tape to the requested block
2231 *	using the LOCATE packet command. A READ POSITION command is then
2232 *	issued to check where we are positioned.
2233 *
2234 *	Like all higher level operations, we queue the commands at the tail
2235 *	of the request queue and wait for their completion.
2236 *
2237 */
2238static int idetape_position_tape (ide_drive_t *drive, unsigned int block, u8 partition, int skip)
2239{
2240	idetape_tape_t *tape = drive->driver_data;
2241	int retval;
2242	idetape_pc_t pc;
2243
2244	if (tape->chrdev_direction == idetape_direction_read)
2245		__idetape_discard_read_pipeline(drive);
2246	idetape_wait_ready(drive, 60 * 5 * HZ);
2247	idetape_create_locate_cmd(drive, &pc, block, partition, skip);
2248	retval = idetape_queue_pc_tail(drive, &pc);
2249	if (retval)
2250		return (retval);
2251
2252	idetape_create_read_position_cmd(&pc);
2253	return (idetape_queue_pc_tail(drive, &pc));
2254}
2255
2256static void idetape_discard_read_pipeline (ide_drive_t *drive, int restore_position)
2257{
2258	idetape_tape_t *tape = drive->driver_data;
2259	int cnt;
2260	int seek, position;
2261
2262	cnt = __idetape_discard_read_pipeline(drive);
2263	if (restore_position) {
2264		position = idetape_read_position(drive);
2265		seek = position > cnt ? position - cnt : 0;
2266		if (idetape_position_tape(drive, seek, 0, 0)) {
2267			printk(KERN_INFO "ide-tape: %s: position_tape failed in discard_pipeline()\n", tape->name);
2268			return;
2269		}
2270	}
2271}
2272
2273/*
2274 * idetape_queue_rw_tail generates a read/write request for the block
2275 * device interface and wait for it to be serviced.
2276 */
2277static int idetape_queue_rw_tail(ide_drive_t *drive, int cmd, int blocks, struct idetape_bh *bh)
2278{
2279	idetape_tape_t *tape = drive->driver_data;
2280	struct request rq;
2281
2282	debug_log(DBG_SENSE, "%s: cmd=%d\n", __func__, cmd);
2283
2284	if (idetape_pipeline_active(tape)) {
2285		printk(KERN_ERR "ide-tape: bug: the pipeline is active in %s\n",
2286				__func__);
2287		return (0);
2288	}
2289
2290	idetape_init_rq(&rq, cmd);
2291	rq.rq_disk = tape->disk;
2292	rq.special = (void *)bh;
2293	rq.sector = tape->first_frame_position;
2294	rq.nr_sectors = rq.current_nr_sectors = blocks;
2295	(void) ide_do_drive_cmd(drive, &rq, ide_wait);
2296
2297	if ((cmd & (REQ_IDETAPE_READ | REQ_IDETAPE_WRITE)) == 0)
2298		return 0;
2299
2300	if (tape->merge_stage)
2301		idetape_init_merge_stage(tape);
2302	if (rq.errors == IDETAPE_ERROR_GENERAL)
2303		return -EIO;
2304	return (tape->tape_block_size * (blocks-rq.current_nr_sectors));
2305}
2306
2307/*
2308 *	idetape_insert_pipeline_into_queue is used to start servicing the
2309 *	pipeline stages, starting from tape->next_stage.
2310 */
2311static void idetape_insert_pipeline_into_queue (ide_drive_t *drive)
2312{
2313	idetape_tape_t *tape = drive->driver_data;
2314
2315	if (tape->next_stage == NULL)
2316		return;
2317	if (!idetape_pipeline_active(tape)) {
2318		set_bit(IDETAPE_PIPELINE_ACTIVE, &tape->flags);
2319		idetape_activate_next_stage(drive);
2320		(void) ide_do_drive_cmd(drive, tape->active_data_request, ide_end);
2321	}
2322}
2323
2324static void idetape_create_inquiry_cmd (idetape_pc_t *pc)
2325{
2326	idetape_init_pc(pc);
2327	pc->c[0] = INQUIRY;
2328	pc->c[4] = pc->request_transfer = 254;
2329	pc->callback = &idetape_pc_callback;
2330}
2331
2332static void idetape_create_rewind_cmd (ide_drive_t *drive, idetape_pc_t *pc)
2333{
2334	idetape_init_pc(pc);
2335	pc->c[0] = REZERO_UNIT;
2336	set_bit(PC_WAIT_FOR_DSC, &pc->flags);
2337	pc->callback = &idetape_pc_callback;
2338}
2339
2340static void idetape_create_erase_cmd (idetape_pc_t *pc)
2341{
2342	idetape_init_pc(pc);
2343	pc->c[0] = ERASE;
2344	pc->c[1] = 1;
2345	set_bit(PC_WAIT_FOR_DSC, &pc->flags);
2346	pc->callback = &idetape_pc_callback;
2347}
2348
2349static void idetape_create_space_cmd (idetape_pc_t *pc,int count, u8 cmd)
2350{
2351	idetape_init_pc(pc);
2352	pc->c[0] = SPACE;
2353	put_unaligned(cpu_to_be32(count), (unsigned int *) &pc->c[1]);
2354	pc->c[1] = cmd;
2355	set_bit(PC_WAIT_FOR_DSC, &pc->flags);
2356	pc->callback = &idetape_pc_callback;
2357}
2358
2359static void idetape_wait_first_stage (ide_drive_t *drive)
2360{
2361	idetape_tape_t *tape = drive->driver_data;
2362	unsigned long flags;
2363
2364	if (tape->first_stage == NULL)
2365		return;
2366	spin_lock_irqsave(&tape->spinlock, flags);
2367	if (tape->active_stage == tape->first_stage)
2368		idetape_wait_for_request(drive, tape->active_data_request);
2369	spin_unlock_irqrestore(&tape->spinlock, flags);
2370}
2371
2372/*
2373 *	idetape_add_chrdev_write_request tries to add a character device
2374 *	originated write request to our pipeline. In case we don't succeed,
2375 *	we revert to non-pipelined operation mode for this request.
2376 *
2377 *	1.	Try to allocate a new pipeline stage.
2378 *	2.	If we can't, wait for more and more requests to be serviced
2379 *		and try again each time.
2380 *	3.	If we still can't allocate a stage, fallback to
2381 *		non-pipelined operation mode for this request.
2382 */
2383static int idetape_add_chrdev_write_request (ide_drive_t *drive, int blocks)
2384{
2385	idetape_tape_t *tape = drive->driver_data;
2386	idetape_stage_t *new_stage;
2387	unsigned long flags;
2388	struct request *rq;
2389
2390	debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
2391
2392     	/*
2393     	 *	Attempt to allocate a new stage.
2394	 *	Pay special attention to possible race conditions.
2395	 */
2396	while ((new_stage = idetape_kmalloc_stage(tape)) == NULL) {
2397		spin_lock_irqsave(&tape->spinlock, flags);
2398		if (idetape_pipeline_active(tape)) {
2399			idetape_wait_for_request(drive, tape->active_data_request);
2400			spin_unlock_irqrestore(&tape->spinlock, flags);
2401		} else {
2402			spin_unlock_irqrestore(&tape->spinlock, flags);
2403			idetape_insert_pipeline_into_queue(drive);
2404			if (idetape_pipeline_active(tape))
2405				continue;
2406			/*
2407			 *	Linux is short on memory. Fallback to
2408			 *	non-pipelined operation mode for this request.
2409			 */
2410			return idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks, tape->merge_stage->bh);
2411		}
2412	}
2413	rq = &new_stage->rq;
2414	idetape_init_rq(rq, REQ_IDETAPE_WRITE);
2415	/* Doesn't actually matter - We always assume sequential access */
2416	rq->sector = tape->first_frame_position;
2417	rq->nr_sectors = rq->current_nr_sectors = blocks;
2418
2419	idetape_switch_buffers(tape, new_stage);
2420	idetape_add_stage_tail(drive, new_stage);
2421	tape->pipeline_head++;
2422	idetape_calculate_speeds(drive);
2423
2424	/*
2425	 *	Estimate whether the tape has stopped writing by checking
2426	 *	if our write pipeline is currently empty. If we are not
2427	 *	writing anymore, wait for the pipeline to be full enough
2428	 *	(90%) before starting to service requests, so that we will
2429	 *	be able to keep up with the higher speeds of the tape.
2430	 */
2431	if (!idetape_pipeline_active(tape)) {
2432		if (tape->nr_stages >= tape->max_stages * 9 / 10 ||
2433		    tape->nr_stages >= tape->max_stages - tape->uncontrolled_pipeline_head_speed * 3 * 1024 / tape->tape_block_size) {
2434			tape->measure_insert_time = 1;
2435			tape->insert_time = jiffies;
2436			tape->insert_size = 0;
2437			tape->insert_speed = 0;
2438			idetape_insert_pipeline_into_queue(drive);
2439		}
2440	}
2441	if (test_and_clear_bit(IDETAPE_PIPELINE_ERROR, &tape->flags))
2442		/* Return a deferred error */
2443		return -EIO;
2444	return blocks;
2445}
2446
2447/*
2448 *	idetape_wait_for_pipeline will wait until all pending pipeline
2449 *	requests are serviced. Typically called on device close.
2450 */
2451static void idetape_wait_for_pipeline (ide_drive_t *drive)
2452{
2453	idetape_tape_t *tape = drive->driver_data;
2454	unsigned long flags;
2455
2456	while (tape->next_stage || idetape_pipeline_active(tape)) {
2457		idetape_insert_pipeline_into_queue(drive);
2458		spin_lock_irqsave(&tape->spinlock, flags);
2459		if (idetape_pipeline_active(tape))
2460			idetape_wait_for_request(drive, tape->active_data_request);
2461		spin_unlock_irqrestore(&tape->spinlock, flags);
2462	}
2463}
2464
2465static void idetape_empty_write_pipeline (ide_drive_t *drive)
2466{
2467	idetape_tape_t *tape = drive->driver_data;
2468	int blocks, min;
2469	struct idetape_bh *bh;
2470
2471	if (tape->chrdev_direction != idetape_direction_write) {
2472		printk(KERN_ERR "ide-tape: bug: Trying to empty write pipeline, but we are not writing.\n");
2473		return;
2474	}
2475	if (tape->merge_stage_size > tape->stage_size) {
2476		printk(KERN_ERR "ide-tape: bug: merge_buffer too big\n");
2477		tape->merge_stage_size = tape->stage_size;
2478	}
2479	if (tape->merge_stage_size) {
2480		blocks = tape->merge_stage_size / tape->tape_block_size;
2481		if (tape->merge_stage_size % tape->tape_block_size) {
2482			unsigned int i;
2483
2484			blocks++;
2485			i = tape->tape_block_size - tape->merge_stage_size % tape->tape_block_size;
2486			bh = tape->bh->b_reqnext;
2487			while (bh) {
2488				atomic_set(&bh->b_count, 0);
2489				bh = bh->b_reqnext;
2490			}
2491			bh = tape->bh;
2492			while (i) {
2493				if (bh == NULL) {
2494
2495					printk(KERN_INFO "ide-tape: bug, bh NULL\n");
2496					break;
2497				}
2498				min = min(i, (unsigned int)(bh->b_size - atomic_read(&bh->b_count)));
2499				memset(bh->b_data + atomic_read(&bh->b_count), 0, min);
2500				atomic_add(min, &bh->b_count);
2501				i -= min;
2502				bh = bh->b_reqnext;
2503			}
2504		}
2505		(void) idetape_add_chrdev_write_request(drive, blocks);
2506		tape->merge_stage_size = 0;
2507	}
2508	idetape_wait_for_pipeline(drive);
2509	if (tape->merge_stage != NULL) {
2510		__idetape_kfree_stage(tape->merge_stage);
2511		tape->merge_stage = NULL;
2512	}
2513	clear_bit(IDETAPE_PIPELINE_ERROR, &tape->flags);
2514	tape->chrdev_direction = idetape_direction_none;
2515
2516	/*
2517	 *	On the next backup, perform the feedback loop again.
2518	 *	(I don't want to keep sense information between backups,
2519	 *	 as some systems are constantly on, and the system load
2520	 *	 can be totally different on the next backup).
2521	 */
2522	tape->max_stages = tape->min_pipeline;
2523	if (tape->first_stage != NULL ||
2524	    tape->next_stage != NULL ||
2525	    tape->last_stage != NULL ||
2526	    tape->nr_stages != 0) {
2527		printk(KERN_ERR "ide-tape: ide-tape pipeline bug, "
2528			"first_stage %p, next_stage %p, "
2529			"last_stage %p, nr_stages %d\n",
2530			tape->first_stage, tape->next_stage,
2531			tape->last_stage, tape->nr_stages);
2532	}
2533}
2534
2535static void idetape_restart_speed_control (ide_drive_t *drive)
2536{
2537	idetape_tape_t *tape = drive->driver_data;
2538
2539	tape->restart_speed_control_req = 0;
2540	tape->pipeline_head = 0;
2541	tape->controlled_last_pipeline_head = tape->uncontrolled_last_pipeline_head = 0;
2542	tape->controlled_previous_pipeline_head = tape->uncontrolled_previous_pipeline_head = 0;
2543	tape->pipeline_head_speed = tape->controlled_pipeline_head_speed = 5000;
2544	tape->uncontrolled_pipeline_head_speed = 0;
2545	tape->controlled_pipeline_head_time = tape->uncontrolled_pipeline_head_time = jiffies;
2546	tape->controlled_previous_head_time = tape->uncontrolled_previous_head_time = jiffies;
2547}
2548
2549static int idetape_initiate_read (ide_drive_t *drive, int max_stages)
2550{
2551	idetape_tape_t *tape = drive->driver_data;
2552	idetape_stage_t *new_stage;
2553	struct request rq;
2554	int bytes_read;
2555	u16 blocks = *(u16 *)&tape->caps[12];
2556
2557	/* Initialize read operation */
2558	if (tape->chrdev_direction != idetape_direction_read) {
2559		if (tape->chrdev_direction == idetape_direction_write) {
2560			idetape_empty_write_pipeline(drive);
2561			idetape_flush_tape_buffers(drive);
2562		}
2563		if (tape->merge_stage || tape->merge_stage_size) {
2564			printk (KERN_ERR "ide-tape: merge_stage_size should be 0 now\n");
2565			tape->merge_stage_size = 0;
2566		}
2567		if ((tape->merge_stage = __idetape_kmalloc_stage(tape, 0, 0)) == NULL)
2568			return -ENOMEM;
2569		tape->chrdev_direction = idetape_direction_read;
2570
2571		/*
2572		 *	Issue a read 0 command to ensure that DSC handshake
2573		 *	is switched from completion mode to buffer available
2574		 *	mode.
2575		 *	No point in issuing this if DSC overlap isn't supported,
2576		 *	some drives (Seagate STT3401A) will return an error.
2577		 */
2578		if (drive->dsc_overlap) {
2579			bytes_read = idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, 0, tape->merge_stage->bh);
2580			if (bytes_read < 0) {
2581				__idetape_kfree_stage(tape->merge_stage);
2582				tape->merge_stage = NULL;
2583				tape->chrdev_direction = idetape_direction_none;
2584				return bytes_read;
2585			}
2586		}
2587	}
2588	if (tape->restart_speed_control_req)
2589		idetape_restart_speed_control(drive);
2590	idetape_init_rq(&rq, REQ_IDETAPE_READ);
2591	rq.sector = tape->first_frame_position;
2592	rq.nr_sectors = rq.current_nr_sectors = blocks;
2593	if (!test_bit(IDETAPE_PIPELINE_ERROR, &tape->flags) &&
2594	    tape->nr_stages < max_stages) {
2595		new_stage = idetape_kmalloc_stage(tape);
2596		while (new_stage != NULL) {
2597			new_stage->rq = rq;
2598			idetape_add_stage_tail(drive, new_stage);
2599			if (tape->nr_stages >= max_stages)
2600				break;
2601			new_stage = idetape_kmalloc_stage(tape);
2602		}
2603	}
2604	if (!idetape_pipeline_active(tape)) {
2605		if (tape->nr_pending_stages >= 3 * max_stages / 4) {
2606			tape->measure_insert_time = 1;
2607			tape->insert_time = jiffies;
2608			tape->insert_size = 0;
2609			tape->insert_speed = 0;
2610			idetape_insert_pipeline_into_queue(drive);
2611		}
2612	}
2613	return 0;
2614}
2615
2616/*
2617 *	idetape_add_chrdev_read_request is called from idetape_chrdev_read
2618 *	to service a character device read request and add read-ahead
2619 *	requests to our pipeline.
2620 */
2621static int idetape_add_chrdev_read_request (ide_drive_t *drive,int blocks)
2622{
2623	idetape_tape_t *tape = drive->driver_data;
2624	unsigned long flags;
2625	struct request *rq_ptr;
2626	int bytes_read;
2627
2628	debug_log(DBG_PROCS, "Enter %s, %d blocks\n", __func__, blocks);
2629
2630	/*
2631	 * If we are at a filemark, return a read length of 0
2632	 */
2633	if (test_bit(IDETAPE_FILEMARK, &tape->flags))
2634		return 0;
2635
2636	/*
2637	 * Wait for the next block to be available at the head
2638	 * of the pipeline
2639	 */
2640	idetape_initiate_read(drive, tape->max_stages);
2641	if (tape->first_stage == NULL) {
2642		if (test_bit(IDETAPE_PIPELINE_ERROR, &tape->flags))
2643			return 0;
2644		return idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, blocks, tape->merge_stage->bh);
2645	}
2646	idetape_wait_first_stage(drive);
2647	rq_ptr = &tape->first_stage->rq;
2648	bytes_read = tape->tape_block_size * (rq_ptr->nr_sectors - rq_ptr->current_nr_sectors);
2649	rq_ptr->nr_sectors = rq_ptr->current_nr_sectors = 0;
2650
2651
2652	if (rq_ptr->errors == IDETAPE_ERROR_EOD)
2653		return 0;
2654	else {
2655		idetape_switch_buffers(tape, tape->first_stage);
2656		if (rq_ptr->errors == IDETAPE_ERROR_FILEMARK)
2657			set_bit(IDETAPE_FILEMARK, &tape->flags);
2658		spin_lock_irqsave(&tape->spinlock, flags);
2659		idetape_remove_stage_head(drive);
2660		spin_unlock_irqrestore(&tape->spinlock, flags);
2661		tape->pipeline_head++;
2662		idetape_calculate_speeds(drive);
2663	}
2664	if (bytes_read > blocks * tape->tape_block_size) {
2665		printk(KERN_ERR "ide-tape: bug: trying to return more bytes than requested\n");
2666		bytes_read = blocks * tape->tape_block_size;
2667	}
2668	return (bytes_read);
2669}
2670
2671static void idetape_pad_zeros (ide_drive_t *drive, int bcount)
2672{
2673	idetape_tape_t *tape = drive->driver_data;
2674	struct idetape_bh *bh;
2675	int blocks;
2676
2677	while (bcount) {
2678		unsigned int count;
2679
2680		bh = tape->merge_stage->bh;
2681		count = min(tape->stage_size, bcount);
2682		bcount -= count;
2683		blocks = count / tape->tape_block_size;
2684		while (count) {
2685			atomic_set(&bh->b_count, min(count, (unsigned int)bh->b_size));
2686			memset(bh->b_data, 0, atomic_read(&bh->b_count));
2687			count -= atomic_read(&bh->b_count);
2688			bh = bh->b_reqnext;
2689		}
2690		idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks, tape->merge_stage->bh);
2691	}
2692}
2693
2694static int idetape_pipeline_size (ide_drive_t *drive)
2695{
2696	idetape_tape_t *tape = drive->driver_data;
2697	idetape_stage_t *stage;
2698	struct request *rq;
2699	int size = 0;
2700
2701	idetape_wait_for_pipeline(drive);
2702	stage = tape->first_stage;
2703	while (stage != NULL) {
2704		rq = &stage->rq;
2705		size += tape->tape_block_size * (rq->nr_sectors-rq->current_nr_sectors);
2706		if (rq->errors == IDETAPE_ERROR_FILEMARK)
2707			size += tape->tape_block_size;
2708		stage = stage->next;
2709	}
2710	size += tape->merge_stage_size;
2711	return size;
2712}
2713
2714/*
2715 *	Rewinds the tape to the Beginning Of the current Partition (BOP).
2716 *
2717 *	We currently support only one partition.
2718 */
2719static int idetape_rewind_tape (ide_drive_t *drive)
2720{
2721	int retval;
2722	idetape_pc_t pc;
2723	idetape_tape_t *tape;
2724	tape = drive->driver_data;
2725
2726	debug_log(DBG_SENSE, "Enter %s\n", __func__);
2727
2728	idetape_create_rewind_cmd(drive, &pc);
2729	retval = idetape_queue_pc_tail(drive, &pc);
2730	if (retval)
2731		return retval;
2732
2733	idetape_create_read_position_cmd(&pc);
2734	retval = idetape_queue_pc_tail(drive, &pc);
2735	if (retval)
2736		return retval;
2737	return 0;
2738}
2739
2740/*
2741 *	Our special ide-tape ioctl's.
2742 *
2743 *	Currently there aren't any ioctl's.
2744 *	mtio.h compatible commands should be issued to the character device
2745 *	interface.
2746 */
2747static int idetape_blkdev_ioctl(ide_drive_t *drive, unsigned int cmd, unsigned long arg)
2748{
2749	idetape_tape_t *tape = drive->driver_data;
2750	void __user *argp = (void __user *)arg;
2751
2752	struct idetape_config {
2753		int dsc_rw_frequency;
2754		int dsc_media_access_frequency;
2755		int nr_stages;
2756	} config;
2757
2758	debug_log(DBG_PROCS, "Enter %s\n", __func__);
2759
2760	switch (cmd) {
2761		case 0x0340:
2762			if (copy_from_user(&config, argp, sizeof(config)))
2763				return -EFAULT;
2764			tape->best_dsc_rw_frequency = config.dsc_rw_frequency;
2765			tape->max_stages = config.nr_stages;
2766			break;
2767		case 0x0350:
2768			config.dsc_rw_frequency = (int) tape->best_dsc_rw_frequency;
2769			config.nr_stages = tape->max_stages;
2770			if (copy_to_user(argp, &config, sizeof(config)))
2771				return -EFAULT;
2772			break;
2773		default:
2774			return -EIO;
2775	}
2776	return 0;
2777}
2778
2779/*
2780 *	idetape_space_over_filemarks is now a bit more complicated than just
2781 *	passing the command to the tape since we may have crossed some
2782 *	filemarks during our pipelined read-ahead mode.
2783 *
2784 *	As a minor side effect, the pipeline enables us to support MTFSFM when
2785 *	the filemark is in our internal pipeline even if the tape doesn't
2786 *	support spacing over filemarks in the reverse direction.
2787 */
2788static int idetape_space_over_filemarks (ide_drive_t *drive,short mt_op,int mt_count)
2789{
2790	idetape_tape_t *tape = drive->driver_data;
2791	idetape_pc_t pc;
2792	unsigned long flags;
2793	int retval,count=0;
2794	int sprev = !!(tape->caps[4] & 0x20);
2795
2796	if (mt_count == 0)
2797		return 0;
2798	if (MTBSF == mt_op || MTBSFM == mt_op) {
2799		if (!sprev)
2800			return -EIO;
2801		mt_count = - mt_count;
2802	}
2803
2804	if (tape->chrdev_direction == idetape_direction_read) {
2805		/*
2806		 *	We have a read-ahead buffer. Scan it for crossed
2807		 *	filemarks.
2808		 */
2809		tape->merge_stage_size = 0;
2810		if (test_and_clear_bit(IDETAPE_FILEMARK, &tape->flags))
2811			++count;
2812		while (tape->first_stage != NULL) {
2813			if (count == mt_count) {
2814				if (mt_op == MTFSFM)
2815					set_bit(IDETAPE_FILEMARK, &tape->flags);
2816				return 0;
2817			}
2818			spin_lock_irqsave(&tape->spinlock, flags);
2819			if (tape->first_stage == tape->active_stage) {
2820				/*
2821				 *	We have reached the active stage in the read pipeline.
2822				 *	There is no point in allowing the drive to continue
2823				 *	reading any farther, so we stop the pipeline.
2824				 *
2825				 *	This section should be moved to a separate subroutine,
2826				 *	because a similar function is performed in
2827				 *	__idetape_discard_read_pipeline(), for example.
2828				 */
2829				tape->next_stage = NULL;
2830				spin_unlock_irqrestore(&tape->spinlock, flags);
2831				idetape_wait_first_stage(drive);
2832				tape->next_stage = tape->first_stage->next;
2833			} else
2834				spin_unlock_irqrestore(&tape->spinlock, flags);
2835			if (tape->first_stage->rq.errors == IDETAPE_ERROR_FILEMARK)
2836				++count;
2837			idetape_remove_stage_head(drive);
2838		}
2839		idetape_discard_read_pipeline(drive, 0);
2840	}
2841
2842	/*
2843	 *	The filemark was not found in our internal pipeline.
2844	 *	Now we can issue the space command.
2845	 */
2846	switch (mt_op) {
2847		case MTFSF:
2848		case MTBSF:
2849			idetape_create_space_cmd(&pc,mt_count-count,IDETAPE_SPACE_OVER_FILEMARK);
2850			return (idetape_queue_pc_tail(drive, &pc));
2851		case MTFSFM:
2852		case MTBSFM:
2853			if (!sprev)
2854				return (-EIO);
2855			retval = idetape_space_over_filemarks(drive, MTFSF, mt_count-count);
2856			if (retval) return (retval);
2857			count = (MTBSFM == mt_op ? 1 : -1);
2858			return (idetape_space_over_filemarks(drive, MTFSF, count));
2859		default:
2860			printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",mt_op);
2861			return (-EIO);
2862	}
2863}
2864
2865
2866/*
2867 *	Our character device read / write functions.
2868 *
2869 *	The tape is optimized to maximize throughput when it is transferring
2870 *	an integral number of the "continuous transfer limit", which is
2871 *	a parameter of the specific tape (26 KB on my particular tape).
2872 *      (32 kB for Onstream)
2873 *
2874 *	As of version 1.3 of the driver, the character device provides an
2875 *	abstract continuous view of the media - any mix of block sizes (even 1
2876 *	byte) on the same backup/restore procedure is supported. The driver
2877 *	will internally convert the requests to the recommended transfer unit,
2878 *	so that an unmatch between the user's block size to the recommended
2879 *	size will only result in a (slightly) increased driver overhead, but
2880 *	will no longer hit performance.
2881 *      This is not applicable to Onstream.
2882 */
2883static ssize_t idetape_chrdev_read (struct file *file, char __user *buf,
2884				    size_t count, loff_t *ppos)
2885{
2886	struct ide_tape_obj *tape = ide_tape_f(file);
2887	ide_drive_t *drive = tape->drive;
2888	ssize_t bytes_read,temp, actually_read = 0, rc;
2889	ssize_t ret = 0;
2890	u16 ctl = *(u16 *)&tape->caps[12];
2891
2892	debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
2893
2894	if (tape->chrdev_direction != idetape_direction_read) {
2895		if (test_bit(IDETAPE_DETECT_BS, &tape->flags))
2896			if (count > tape->tape_block_size &&
2897			    (count % tape->tape_block_size) == 0)
2898				tape->user_bs_factor = count / tape->tape_block_size;
2899	}
2900	if ((rc = idetape_initiate_read(drive, tape->max_stages)) < 0)
2901		return rc;
2902	if (count == 0)
2903		return (0);
2904	if (tape->merge_stage_size) {
2905		actually_read = min((unsigned int)(tape->merge_stage_size), (unsigned int)count);
2906		if (idetape_copy_stage_to_user(tape, buf, tape->merge_stage, actually_read))
2907			ret = -EFAULT;
2908		buf += actually_read;
2909		tape->merge_stage_size -= actually_read;
2910		count -= actually_read;
2911	}
2912	while (count >= tape->stage_size) {
2913		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
2914		if (bytes_read <= 0)
2915			goto finish;
2916		if (idetape_copy_stage_to_user(tape, buf, tape->merge_stage, bytes_read))
2917			ret = -EFAULT;
2918		buf += bytes_read;
2919		count -= bytes_read;
2920		actually_read += bytes_read;
2921	}
2922	if (count) {
2923		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
2924		if (bytes_read <= 0)
2925			goto finish;
2926		temp = min((unsigned long)count, (unsigned long)bytes_read);
2927		if (idetape_copy_stage_to_user(tape, buf, tape->merge_stage, temp))
2928			ret = -EFAULT;
2929		actually_read += temp;
2930		tape->merge_stage_size = bytes_read-temp;
2931	}
2932finish:
2933	if (!actually_read && test_bit(IDETAPE_FILEMARK, &tape->flags)) {
2934		debug_log(DBG_SENSE, "%s: spacing over filemark\n", tape->name);
2935
2936		idetape_space_over_filemarks(drive, MTFSF, 1);
2937		return 0;
2938	}
2939
2940	return (ret) ? ret : actually_read;
2941}
2942
2943static ssize_t idetape_chrdev_write (struct file *file, const char __user *buf,
2944				     size_t count, loff_t *ppos)
2945{
2946	struct ide_tape_obj *tape = ide_tape_f(file);
2947	ide_drive_t *drive = tape->drive;
2948	ssize_t actually_written = 0;
2949	ssize_t ret = 0;
2950	u16 ctl = *(u16 *)&tape->caps[12];
2951
2952	/* The drive is write protected. */
2953	if (tape->write_prot)
2954		return -EACCES;
2955
2956	debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
2957
2958	/* Initialize write operation */
2959	if (tape->chrdev_direction != idetape_direction_write) {
2960		if (tape->chrdev_direction == idetape_direction_read)
2961			idetape_discard_read_pipeline(drive, 1);
2962		if (tape->merge_stage || tape->merge_stage_size) {
2963			printk(KERN_ERR "ide-tape: merge_stage_size "
2964				"should be 0 now\n");
2965			tape->merge_stage_size = 0;
2966		}
2967		if ((tape->merge_stage = __idetape_kmalloc_stage(tape, 0, 0)) == NULL)
2968			return -ENOMEM;
2969		tape->chrdev_direction = idetape_direction_write;
2970		idetape_init_merge_stage(tape);
2971
2972		/*
2973		 *	Issue a write 0 command to ensure that DSC handshake
2974		 *	is switched from completion mode to buffer available
2975		 *	mode.
2976		 *	No point in issuing this if DSC overlap isn't supported,
2977		 *	some drives (Seagate STT3401A) will return an error.
2978		 */
2979		if (drive->dsc_overlap) {
2980			ssize_t retval = idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, 0, tape->merge_stage->bh);
2981			if (retval < 0) {
2982				__idetape_kfree_stage(tape->merge_stage);
2983				tape->merge_stage = NULL;
2984				tape->chrdev_direction = idetape_direction_none;
2985				return retval;
2986			}
2987		}
2988	}
2989	if (count == 0)
2990		return (0);
2991	if (tape->restart_speed_control_req)
2992		idetape_restart_speed_control(drive);
2993	if (tape->merge_stage_size) {
2994		if (tape->merge_stage_size >= tape->stage_size) {
2995			printk(KERN_ERR "ide-tape: bug: merge buffer too big\n");
2996			tape->merge_stage_size = 0;
2997		}
2998		actually_written = min((unsigned int)(tape->stage_size - tape->merge_stage_size), (unsigned int)count);
2999		if (idetape_copy_stage_from_user(tape, tape->merge_stage, buf, actually_written))
3000				ret = -EFAULT;
3001		buf += actually_written;
3002		tape->merge_stage_size += actually_written;
3003		count -= actually_written;
3004
3005		if (tape->merge_stage_size == tape->stage_size) {
3006			ssize_t retval;
3007			tape->merge_stage_size = 0;
3008			retval = idetape_add_chrdev_write_request(drive, ctl);
3009			if (retval <= 0)
3010				return (retval);
3011		}
3012	}
3013	while (count >= tape->stage_size) {
3014		ssize_t retval;
3015		if (idetape_copy_stage_from_user(tape, tape->merge_stage, buf, tape->stage_size))
3016			ret = -EFAULT;
3017		buf += tape->stage_size;
3018		count -= tape->stage_size;
3019		retval = idetape_add_chrdev_write_request(drive, ctl);
3020		actually_written += tape->stage_size;
3021		if (retval <= 0)
3022			return (retval);
3023	}
3024	if (count) {
3025		actually_written += count;
3026		if (idetape_copy_stage_from_user(tape, tape->merge_stage, buf, count))
3027			ret = -EFAULT;
3028		tape->merge_stage_size += count;
3029	}
3030	return (ret) ? ret : actually_written;
3031}
3032
3033static int idetape_write_filemark (ide_drive_t *drive)
3034{
3035	idetape_pc_t pc;
3036
3037	/* Write a filemark */
3038	idetape_create_write_filemark_cmd(drive, &pc, 1);
3039	if (idetape_queue_pc_tail(drive, &pc)) {
3040		printk(KERN_ERR "ide-tape: Couldn't write a filemark\n");
3041		return -EIO;
3042	}
3043	return 0;
3044}
3045
3046/*
3047 * Called from idetape_chrdev_ioctl when the general mtio MTIOCTOP ioctl is
3048 * requested.
3049 *
3050 * Note: MTBSF and MTBSFM are not supported when the tape doesn't support
3051 * spacing over filemarks in the reverse direction. In this case, MTFSFM is also
3052 * usually not supported (it is supported in the rare case in which we crossed
3053 * the filemark during our read-ahead pipelined operation mode).
3054 *
3055 * The following commands are currently not supported:
3056 *
3057 * MTFSS, MTBSS, MTWSM, MTSETDENSITY, MTSETDRVBUFFER, MT_ST_BOOLEANS,
3058 * MT_ST_WRITE_THRESHOLD.
3059 */
3060static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
3061{
3062	idetape_tape_t *tape = drive->driver_data;
3063	idetape_pc_t pc;
3064	int i,retval;
3065
3066	debug_log(DBG_ERR, "Handling MTIOCTOP ioctl: mt_op=%d, mt_count=%d\n",
3067			mt_op, mt_count);
3068	/*
3069	 *	Commands which need our pipelined read-ahead stages.
3070	 */
3071	switch (mt_op) {
3072		case MTFSF:
3073		case MTFSFM:
3074		case MTBSF:
3075		case MTBSFM:
3076			if (!mt_count)
3077				return (0);
3078			return (idetape_space_over_filemarks(drive,mt_op,mt_count));
3079		default:
3080			break;
3081	}
3082	switch (mt_op) {
3083		case MTWEOF:
3084			if (tape->write_prot)
3085				return -EACCES;
3086			idetape_discard_read_pipeline(drive, 1);
3087			for (i = 0; i < mt_count; i++) {
3088				retval = idetape_write_filemark(drive);
3089				if (retval)
3090					return retval;
3091			}
3092			return (0);
3093		case MTREW:
3094			idetape_discard_read_pipeline(drive, 0);
3095			if (idetape_rewind_tape(drive))
3096				return -EIO;
3097			return 0;
3098		case MTLOAD:
3099			idetape_discard_read_pipeline(drive, 0);
3100			idetape_create_load_unload_cmd(drive, &pc, IDETAPE_LU_LOAD_MASK);
3101			return (idetape_queue_pc_tail(drive, &pc));
3102		case MTUNLOAD:
3103		case MTOFFL:
3104			/*
3105			 * If door is locked, attempt to unlock before
3106			 * attempting to eject.
3107			 */
3108			if (tape->door_locked) {
3109				if (idetape_create_prevent_cmd(drive, &pc, 0))
3110					if (!idetape_queue_pc_tail(drive, &pc))
3111						tape->door_locked = DOOR_UNLOCKED;
3112			}
3113			idetape_discard_read_pipeline(drive, 0);
3114			idetape_create_load_unload_cmd(drive, &pc,!IDETAPE_LU_LOAD_MASK);
3115			retval = idetape_queue_pc_tail(drive, &pc);
3116			if (!retval)
3117				clear_bit(IDETAPE_MEDIUM_PRESENT, &tape->flags);
3118			return retval;
3119		case MTNOP:
3120			idetape_discard_read_pipeline(drive, 0);
3121			return (idetape_flush_tape_buffers(drive));
3122		case MTRETEN:
3123			idetape_discard_read_pipeline(drive, 0);
3124			idetape_create_load_unload_cmd(drive, &pc,IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK);
3125			return (idetape_queue_pc_tail(drive, &pc));
3126		case MTEOM:
3127			idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD);
3128			return (idetape_queue_pc_tail(drive, &pc));
3129		case MTERASE:
3130			(void) idetape_rewind_tape(drive);
3131			idetape_create_erase_cmd(&pc);
3132			return (idetape_queue_pc_tail(drive, &pc));
3133		case MTSETBLK:
3134			if (mt_count) {
3135				if (mt_count < tape->tape_block_size || mt_count % tape->tape_block_size)
3136					return -EIO;
3137				tape->user_bs_factor = mt_count / tape->tape_block_size;
3138				clear_bit(IDETAPE_DETECT_BS, &tape->flags);
3139			} else
3140				set_bit(IDETAPE_DETECT_BS, &tape->flags);
3141			return 0;
3142		case MTSEEK:
3143			idetape_discard_read_pipeline(drive, 0);
3144			return idetape_position_tape(drive, mt_count * tape->user_bs_factor, tape->partition, 0);
3145		case MTSETPART:
3146			idetape_discard_read_pipeline(drive, 0);
3147			return (idetape_position_tape(drive, 0, mt_count, 0));
3148		case MTFSR:
3149		case MTBSR:
3150		case MTLOCK:
3151			if (!idetape_create_prevent_cmd(drive, &pc, 1))
3152				return 0;
3153			retval = idetape_queue_pc_tail(drive, &pc);
3154			if (retval) return retval;
3155			tape->door_locked = DOOR_EXPLICITLY_LOCKED;
3156			return 0;
3157		case MTUNLOCK:
3158			if (!idetape_create_prevent_cmd(drive, &pc, 0))
3159				return 0;
3160			retval = idetape_queue_pc_tail(drive, &pc);
3161			if (retval) return retval;
3162			tape->door_locked = DOOR_UNLOCKED;
3163			return 0;
3164		default:
3165			printk(KERN_ERR "ide-tape: MTIO operation %d not "
3166				"supported\n", mt_op);
3167			return (-EIO);
3168	}
3169}
3170
3171/*
3172 * Our character device ioctls. General mtio.h magnetic io commands are
3173 * supported here, and not in the corresponding block interface. Our own
3174 * ide-tape ioctls are supported on both interfaces.
3175 */
3176static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
3177				unsigned int cmd, unsigned long arg)
3178{
3179	struct ide_tape_obj *tape = ide_tape_f(file);
3180	ide_drive_t *drive = tape->drive;
3181	struct mtop mtop;
3182	struct mtget mtget;
3183	struct mtpos mtpos;
3184	int block_offset = 0, position = tape->first_frame_position;
3185	void __user *argp = (void __user *)arg;
3186
3187	debug_log(DBG_CHRDEV, "Enter %s, cmd=%u\n", __func__, cmd);
3188
3189	tape->restart_speed_control_req = 1;
3190	if (tape->chrdev_direction == idetape_direction_write) {
3191		idetape_empty_write_pipeline(drive);
3192		idetape_flush_tape_buffers(drive);
3193	}
3194	if (cmd == MTIOCGET || cmd == MTIOCPOS) {
3195		block_offset = idetape_pipeline_size(drive) / (tape->tape_block_size * tape->user_bs_factor);
3196		if ((position = idetape_read_position(drive)) < 0)
3197			return -EIO;
3198	}
3199	switch (cmd) {
3200		case MTIOCTOP:
3201			if (copy_from_user(&mtop, argp, sizeof (struct mtop)))
3202				return -EFAULT;
3203			return (idetape_mtioctop(drive,mtop.mt_op,mtop.mt_count));
3204		case MTIOCGET:
3205			memset(&mtget, 0, sizeof (struct mtget));
3206			mtget.mt_type = MT_ISSCSI2;
3207			mtget.mt_blkno = position / tape->user_bs_factor - block_offset;
3208			mtget.mt_dsreg = ((tape->tape_block_size * tape->user_bs_factor) << MT_ST_BLKSIZE_SHIFT) & MT_ST_BLKSIZE_MASK;
3209			if (tape->drv_write_prot) {
3210				mtget.mt_gstat |= GMT_WR_PROT(0xffffffff);
3211			}
3212			if (copy_to_user(argp, &mtget, sizeof(struct mtget)))
3213				return -EFAULT;
3214			return 0;
3215		case MTIOCPOS:
3216			mtpos.mt_blkno = position / tape->user_bs_factor - block_offset;
3217			if (copy_to_user(argp, &mtpos, sizeof(struct mtpos)))
3218				return -EFAULT;
3219			return 0;
3220		default:
3221			if (tape->chrdev_direction == idetape_direction_read)
3222				idetape_discard_read_pipeline(drive, 1);
3223			return idetape_blkdev_ioctl(drive, cmd, arg);
3224	}
3225}
3226
3227/*
3228 * Do a mode sense page 0 with block descriptor and if it succeeds set the tape
3229 * block size with the reported value.
3230 */
3231static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive)
3232{
3233	idetape_tape_t *tape = drive->driver_data;
3234	idetape_pc_t pc;
3235
3236	idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR);
3237	if (idetape_queue_pc_tail(drive, &pc)) {
3238		printk(KERN_ERR "ide-tape: Can't get block descriptor\n");
3239		if (tape->tape_block_size == 0) {
3240			printk(KERN_WARNING "ide-tape: Cannot deal with zero "
3241					    "block size, assuming 32k\n");
3242			tape->tape_block_size = 32768;
3243		}
3244		return;
3245	}
3246	tape->tape_block_size = (pc.buffer[4 + 5] << 16) +
3247				(pc.buffer[4 + 6] << 8)  +
3248				 pc.buffer[4 + 7];
3249	tape->drv_write_prot = (pc.buffer[2] & 0x80) >> 7;
3250}
3251
3252/*
3253 *	Our character device open function.
3254 */
3255static int idetape_chrdev_open (struct inode *inode, struct file *filp)
3256{
3257	unsigned int minor = iminor(inode), i = minor & ~0xc0;
3258	ide_drive_t *drive;
3259	idetape_tape_t *tape;
3260	idetape_pc_t pc;
3261	int retval;
3262
3263	if (i >= MAX_HWIFS * MAX_DRIVES)
3264		return -ENXIO;
3265
3266	tape = ide_tape_chrdev_get(i);
3267	if (!tape)
3268		return -ENXIO;
3269
3270	debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
3271
3272	/*
3273	 * We really want to do nonseekable_open(inode, filp); here, but some
3274	 * versions of tar incorrectly call lseek on tapes and bail out if that
3275	 * fails.  So we disallow pread() and pwrite(), but permit lseeks.
3276	 */
3277	filp->f_mode &= ~(FMODE_PREAD | FMODE_PWRITE);
3278
3279	drive = tape->drive;
3280
3281	filp->private_data = tape;
3282
3283	if (test_and_set_bit(IDETAPE_BUSY, &tape->flags)) {
3284		retval = -EBUSY;
3285		goto out_put_tape;
3286	}
3287
3288	retval = idetape_wait_ready(drive, 60 * HZ);
3289	if (retval) {
3290		clear_bit(IDETAPE_BUSY, &tape->flags);
3291		printk(KERN_ERR "ide-tape: %s: drive not ready\n", tape->name);
3292		goto out_put_tape;
3293	}
3294
3295	idetape_read_position(drive);
3296	if (!test_bit(IDETAPE_ADDRESS_VALID, &tape->flags))
3297		(void)idetape_rewind_tape(drive);
3298
3299	if (tape->chrdev_direction != idetape_direction_read)
3300		clear_bit(IDETAPE_PIPELINE_ERROR, &tape->flags);
3301
3302	/* Read block size and write protect status from drive. */
3303	ide_tape_get_bsize_from_bdesc(drive);
3304
3305	/* Set write protect flag if device is opened as read-only. */
3306	if ((filp->f_flags & O_ACCMODE) == O_RDONLY)
3307		tape->write_prot = 1;
3308	else
3309		tape->write_prot = tape->drv_write_prot;
3310
3311	/* Make sure drive isn't write protected if user wants to write. */
3312	if (tape->write_prot) {
3313		if ((filp->f_flags & O_ACCMODE) == O_WRONLY ||
3314		    (filp->f_flags & O_ACCMODE) == O_RDWR) {
3315			clear_bit(IDETAPE_BUSY, &tape->flags);
3316			retval = -EROFS;
3317			goto out_put_tape;
3318		}
3319	}
3320
3321	/*
3322	 * Lock the tape drive door so user can't eject.
3323	 */
3324	if (tape->chrdev_direction == idetape_direction_none) {
3325		if (idetape_create_prevent_cmd(drive, &pc, 1)) {
3326			if (!idetape_queue_pc_tail(drive, &pc)) {
3327				if (tape->door_locked != DOOR_EXPLICITLY_LOCKED)
3328					tape->door_locked = DOOR_LOCKED;
3329			}
3330		}
3331	}
3332	idetape_restart_speed_control(drive);
3333	tape->restart_speed_control_req = 0;
3334	return 0;
3335
3336out_put_tape:
3337	ide_tape_put(tape);
3338	return retval;
3339}
3340
3341static void idetape_write_release (ide_drive_t *drive, unsigned int minor)
3342{
3343	idetape_tape_t *tape = drive->driver_data;
3344
3345	idetape_empty_write_pipeline(drive);
3346	tape->merge_stage = __idetape_kmalloc_stage(tape, 1, 0);
3347	if (tape->merge_stage != NULL) {
3348		idetape_pad_zeros(drive, tape->tape_block_size * (tape->user_bs_factor - 1));
3349		__idetape_kfree_stage(tape->merge_stage);
3350		tape->merge_stage = NULL;
3351	}
3352	idetape_write_filemark(drive);
3353	idetape_flush_tape_buffers(drive);
3354	idetape_flush_tape_buffers(drive);
3355}
3356
3357/*
3358 *	Our character device release function.
3359 */
3360static int idetape_chrdev_release (struct inode *inode, struct file *filp)
3361{
3362	struct ide_tape_obj *tape = ide_tape_f(filp);
3363	ide_drive_t *drive = tape->drive;
3364	idetape_pc_t pc;
3365	unsigned int minor = iminor(inode);
3366
3367	lock_kernel();
3368	tape = drive->driver_data;
3369
3370	debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
3371
3372	if (tape->chrdev_direction == idetape_direction_write)
3373		idetape_write_release(drive, minor);
3374	if (tape->chrdev_direction == idetape_direction_read) {
3375		if (minor < 128)
3376			idetape_discard_read_pipeline(drive, 1);
3377		else
3378			idetape_wait_for_pipeline(drive);
3379	}
3380	if (tape->cache_stage != NULL) {
3381		__idetape_kfree_stage(tape->cache_stage);
3382		tape->cache_stage = NULL;
3383	}
3384	if (minor < 128 && test_bit(IDETAPE_MEDIUM_PRESENT, &tape->flags))
3385		(void) idetape_rewind_tape(drive);
3386	if (tape->chrdev_direction == idetape_direction_none) {
3387		if (tape->door_locked == DOOR_LOCKED) {
3388			if (idetape_create_prevent_cmd(drive, &pc, 0)) {
3389				if (!idetape_queue_pc_tail(drive, &pc))
3390					tape->door_locked = DOOR_UNLOCKED;
3391			}
3392		}
3393	}
3394	clear_bit(IDETAPE_BUSY, &tape->flags);
3395	ide_tape_put(tape);
3396	unlock_kernel();
3397	return 0;
3398}
3399
3400/*
3401 *	idetape_identify_device is called to check the contents of the
3402 *	ATAPI IDENTIFY command results. We return:
3403 *
3404 *	1	If the tape can be supported by us, based on the information
3405 *		we have so far.
3406 *
3407 *	0 	If this tape driver is not currently supported by us.
3408 */
3409static int idetape_identify_device (ide_drive_t *drive)
3410{
3411	struct idetape_id_gcw gcw;
3412	struct hd_driveid *id = drive->id;
3413
3414	if (drive->id_read == 0)
3415		return 1;
3416
3417	*((unsigned short *) &gcw) = id->config;
3418
3419	/* Check that we can support this device */
3420
3421	if (gcw.protocol != 2)
3422		printk(KERN_ERR "ide-tape: Protocol (0x%02x) is not ATAPI\n",
3423				gcw.protocol);
3424	else if (gcw.device_type != 1)
3425		printk(KERN_ERR "ide-tape: Device type (0x%02x) is not set "
3426				"to tape\n", gcw.device_type);
3427	else if (!gcw.removable)
3428		printk(KERN_ERR "ide-tape: The removable flag is not set\n");
3429	else if (gcw.packet_size != 0) {
3430		printk(KERN_ERR "ide-tape: Packet size (0x%02x) is not 12 "
3431				"bytes long\n", gcw.packet_size);
3432	} else
3433		return 1;
3434	return 0;
3435}
3436
3437static void idetape_get_inquiry_results(ide_drive_t *drive)
3438{
3439	char *r;
3440	idetape_tape_t *tape = drive->driver_data;
3441	idetape_pc_t pc;
3442
3443	idetape_create_inquiry_cmd(&pc);
3444	if (idetape_queue_pc_tail(drive, &pc)) {
3445		printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
3446				tape->name);
3447		return;
3448	}
3449	memcpy(tape->vendor_id, &pc.buffer[8], 8);
3450	memcpy(tape->product_id, &pc.buffer[16], 16);
3451	memcpy(tape->firmware_revision, &pc.buffer[32], 4);
3452
3453	ide_fixstring(tape->vendor_id, 10, 0);
3454	ide_fixstring(tape->product_id, 18, 0);
3455	ide_fixstring(tape->firmware_revision, 6, 0);
3456	r = tape->firmware_revision;
3457	if (*(r + 1) == '.')
3458		tape->firmware_revision_num = (*r - '0') * 100 +
3459			(*(r + 2) - '0') * 10 +	*(r + 3) - '0';
3460	printk(KERN_INFO "ide-tape: %s <-> %s: %s %s rev %s\n",
3461			drive->name, tape->name, tape->vendor_id,
3462			tape->product_id, tape->firmware_revision);
3463}
3464
3465/*
3466 * Ask the tape about its various parameters. In particular, we will adjust our
3467 * data transfer buffer	size to the recommended value as returned by the tape.
3468 */
3469static void idetape_get_mode_sense_results (ide_drive_t *drive)
3470{
3471	idetape_tape_t *tape = drive->driver_data;
3472	idetape_pc_t pc;
3473	u8 *caps;
3474	u8 speed, max_speed;
3475
3476	idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
3477	if (idetape_queue_pc_tail(drive, &pc)) {
3478		printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
3479				" some default values\n");
3480		tape->tape_block_size = 512;
3481		put_unaligned(52,   (u16 *)&tape->caps[12]);
3482		put_unaligned(540,  (u16 *)&tape->caps[14]);
3483		put_unaligned(6*52, (u16 *)&tape->caps[16]);
3484		return;
3485	}
3486	caps = pc.buffer + 4 + pc.buffer[3];
3487
3488	/* convert to host order and save for later use */
3489	speed = be16_to_cpu(*(u16 *)&caps[14]);
3490	max_speed = be16_to_cpu(*(u16 *)&caps[8]);
3491
3492	put_unaligned(max_speed, (u16 *)&caps[8]);
3493	put_unaligned(be16_to_cpu(*(u16 *)&caps[12]), (u16 *)&caps[12]);
3494	put_unaligned(speed, (u16 *)&caps[14]);
3495	put_unaligned(be16_to_cpu(*(u16 *)&caps[16]), (u16 *)&caps[16]);
3496
3497	if (!speed) {
3498		printk(KERN_INFO "ide-tape: %s: invalid tape speed "
3499				"(assuming 650KB/sec)\n", drive->name);
3500		put_unaligned(650, (u16 *)&caps[14]);
3501	}
3502	if (!max_speed) {
3503		printk(KERN_INFO "ide-tape: %s: invalid max_speed "
3504				"(assuming 650KB/sec)\n", drive->name);
3505		put_unaligned(650, (u16 *)&caps[8]);
3506	}
3507
3508	memcpy(&tape->caps, caps, 20);
3509	if (caps[7] & 0x02)
3510		tape->tape_block_size = 512;
3511	else if (caps[7] & 0x04)
3512		tape->tape_block_size = 1024;
3513}
3514
3515#ifdef CONFIG_IDE_PROC_FS
3516static void idetape_add_settings (ide_drive_t *drive)
3517{
3518	idetape_tape_t *tape = drive->driver_data;
3519
3520/*
3521 *			drive	setting name		read/write	data type	min			max			mul_factor			div_factor	data pointer				set function
3522 */
3523	ide_add_setting(drive, "buffer", SETTING_READ, TYPE_SHORT, 0, 0xffff,
3524			1, 2, (u16 *)&tape->caps[16], NULL);
3525	ide_add_setting(drive,	"pipeline_min",		SETTING_RW,	TYPE_INT,	1,			0xffff,			tape->stage_size / 1024,	1,		&tape->min_pipeline,			NULL);
3526	ide_add_setting(drive,	"pipeline",		SETTING_RW,	TYPE_INT,	1,			0xffff,			tape->stage_size / 1024,	1,		&tape->max_stages,			NULL);
3527	ide_add_setting(drive,	"pipeline_max",		SETTING_RW,	TYPE_INT,	1,			0xffff,			tape->stage_size / 1024,	1,		&tape->max_pipeline,			NULL);
3528	ide_add_setting(drive,	"pipeline_used",	SETTING_READ,	TYPE_INT,	0,			0xffff,			tape->stage_size / 1024,	1,		&tape->nr_stages,			NULL);
3529	ide_add_setting(drive,	"pipeline_pending",	SETTING_READ,	TYPE_INT,	0,			0xffff,			tape->stage_size / 1024,	1,		&tape->nr_pending_stages,		NULL);
3530	ide_add_setting(drive, "speed", SETTING_READ, TYPE_SHORT, 0, 0xffff,
3531			1, 1, (u16 *)&tape->caps[14], NULL);
3532	ide_add_setting(drive,	"stage",		SETTING_READ,	TYPE_INT,	0,			0xffff,			1,				1024,		&tape->stage_size,			NULL);
3533	ide_add_setting(drive,	"tdsc",			SETTING_RW,	TYPE_INT,	IDETAPE_DSC_RW_MIN,	IDETAPE_DSC_RW_MAX,	1000,				HZ,		&tape->best_dsc_rw_frequency,		NULL);
3534	ide_add_setting(drive,	"dsc_overlap",		SETTING_RW,	TYPE_BYTE,	0,			1,			1,				1,		&drive->dsc_overlap,			NULL);
3535	ide_add_setting(drive,	"pipeline_head_speed_c",SETTING_READ,	TYPE_INT,	0,			0xffff,			1,				1,		&tape->controlled_pipeline_head_speed,	NULL);
3536	ide_add_setting(drive,	"pipeline_head_speed_u",SETTING_READ,	TYPE_INT,	0,			0xffff,			1,				1,		&tape->uncontrolled_pipeline_head_speed,NULL);
3537	ide_add_setting(drive,	"avg_speed",		SETTING_READ,	TYPE_INT,	0,			0xffff,			1,				1,		&tape->avg_speed,			NULL);
3538	ide_add_setting(drive, "debug_mask", SETTING_RW, TYPE_INT, 0, 0xffff, 1,
3539			1, &tape->debug_mask, NULL);
3540}
3541#else
3542static inline void idetape_add_settings(ide_drive_t *drive) { ; }
3543#endif
3544
3545/*
3546 *	ide_setup is called to:
3547 *
3548 *		1.	Initialize our various state variables.
3549 *		2.	Ask the tape for its capabilities.
3550 *		3.	Allocate a buffer which will be used for data
3551 *			transfer. The buffer size is chosen based on
3552 *			the recommendation which we received in step (2).
3553 *
3554 *	Note that at this point ide.c already assigned us an irq, so that
3555 *	we can queue requests here and wait for their completion.
3556 */
3557static void idetape_setup (ide_drive_t *drive, idetape_tape_t *tape, int minor)
3558{
3559	unsigned long t1, tmid, tn, t;
3560	int speed;
3561	struct idetape_id_gcw gcw;
3562	int stage_size;
3563	struct sysinfo si;
3564	u16 *ctl = (u16 *)&tape->caps[12];
3565
3566	spin_lock_init(&tape->spinlock);
3567	drive->dsc_overlap = 1;
3568	if (drive->hwif->host_flags & IDE_HFLAG_NO_DSC) {
3569		printk(KERN_INFO "ide-tape: %s: disabling DSC overlap\n",
3570				 tape->name);
3571		drive->dsc_overlap = 0;
3572	}
3573	/* Seagate Travan drives do not support DSC overlap. */
3574	if (strstr(drive->id->model, "Seagate STT3401"))
3575		drive->dsc_overlap = 0;
3576	tape->minor = minor;
3577	tape->name[0] = 'h';
3578	tape->name[1] = 't';
3579	tape->name[2] = '0' + minor;
3580	tape->chrdev_direction = idetape_direction_none;
3581	tape->pc = tape->pc_stack;
3582	tape->max_insert_speed = 10000;
3583	tape->speed_control = 1;
3584	*((unsigned short *) &gcw) = drive->id->config;
3585	if (gcw.drq_type == 1)
3586		set_bit(IDETAPE_DRQ_INTERRUPT, &tape->flags);
3587
3588	tape->min_pipeline = tape->max_pipeline = tape->max_stages = 10;
3589
3590	idetape_get_inquiry_results(drive);
3591	idetape_get_mode_sense_results(drive);
3592	ide_tape_get_bsize_from_bdesc(drive);
3593	tape->user_bs_factor = 1;
3594	tape->stage_size = *ctl * tape->tape_block_size;
3595	while (tape->stage_size > 0xffff) {
3596		printk(KERN_NOTICE "ide-tape: decreasing stage size\n");
3597		*ctl /= 2;
3598		tape->stage_size = *ctl * tape->tape_block_size;
3599	}
3600	stage_size = tape->stage_size;
3601	tape->pages_per_stage = stage_size / PAGE_SIZE;
3602	if (stage_size % PAGE_SIZE) {
3603		tape->pages_per_stage++;
3604		tape->excess_bh_size = PAGE_SIZE - stage_size % PAGE_SIZE;
3605	}
3606
3607	/* Select the "best" DSC read/write polling freq and pipeline size. */
3608	speed = max(*(u16 *)&tape->caps[14], *(u16 *)&tape->caps[8]);
3609
3610	tape->max_stages = speed * 1000 * 10 / tape->stage_size;
3611
3612	/*
3613	 * 	Limit memory use for pipeline to 10% of physical memory
3614	 */
3615	si_meminfo(&si);
3616	if (tape->max_stages * tape->stage_size > si.totalram * si.mem_unit / 10)
3617		tape->max_stages = si.totalram * si.mem_unit / (10 * tape->stage_size);
3618	tape->max_stages   = min(tape->max_stages, IDETAPE_MAX_PIPELINE_STAGES);
3619	tape->min_pipeline = min(tape->max_stages, IDETAPE_MIN_PIPELINE_STAGES);
3620	tape->max_pipeline = min(tape->max_stages * 2, IDETAPE_MAX_PIPELINE_STAGES);
3621	if (tape->max_stages == 0)
3622		tape->max_stages = tape->min_pipeline = tape->max_pipeline = 1;
3623
3624	t1 = (tape->stage_size * HZ) / (speed * 1000);
3625	tmid = (*(u16 *)&tape->caps[16] * 32 * HZ) / (speed * 125);
3626	tn = (IDETAPE_FIFO_THRESHOLD * tape->stage_size * HZ) / (speed * 1000);
3627
3628	if (tape->max_stages)
3629		t = tn;
3630	else
3631		t = t1;
3632
3633	/*
3634	 *	Ensure that the number we got makes sense; limit
3635	 *	it within IDETAPE_DSC_RW_MIN and IDETAPE_DSC_RW_MAX.
3636	 */
3637	tape->best_dsc_rw_frequency = max_t(unsigned long, min_t(unsigned long, t, IDETAPE_DSC_RW_MAX), IDETAPE_DSC_RW_MIN);
3638	printk(KERN_INFO "ide-tape: %s <-> %s: %dKBps, %d*%dkB buffer, "
3639		"%dkB pipeline, %lums tDSC%s\n",
3640		drive->name, tape->name, *(u16 *)&tape->caps[14],
3641		(*(u16 *)&tape->caps[16] * 512) / tape->stage_size,
3642		tape->stage_size / 1024,
3643		tape->max_stages * tape->stage_size / 1024,
3644		tape->best_dsc_rw_frequency * 1000 / HZ,
3645		drive->using_dma ? ", DMA":"");
3646
3647	idetape_add_settings(drive);
3648}
3649
3650static void ide_tape_remove(ide_drive_t *drive)
3651{
3652	idetape_tape_t *tape = drive->driver_data;
3653
3654	ide_proc_unregister_driver(drive, tape->driver);
3655
3656	ide_unregister_region(tape->disk);
3657
3658	ide_tape_put(tape);
3659}
3660
3661static void ide_tape_release(struct kref *kref)
3662{
3663	struct ide_tape_obj *tape = to_ide_tape(kref);
3664	ide_drive_t *drive = tape->drive;
3665	struct gendisk *g = tape->disk;
3666
3667	BUG_ON(tape->first_stage != NULL || tape->merge_stage_size);
3668
3669	drive->dsc_overlap = 0;
3670	drive->driver_data = NULL;
3671	device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor));
3672	device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor + 128));
3673	idetape_devs[tape->minor] = NULL;
3674	g->private_data = NULL;
3675	put_disk(g);
3676	kfree(tape);
3677}
3678
3679#ifdef CONFIG_IDE_PROC_FS
3680static int proc_idetape_read_name
3681	(char *page, char **start, off_t off, int count, int *eof, void *data)
3682{
3683	ide_drive_t	*drive = (ide_drive_t *) data;
3684	idetape_tape_t	*tape = drive->driver_data;
3685	char		*out = page;
3686	int		len;
3687
3688	len = sprintf(out, "%s\n", tape->name);
3689	PROC_IDE_READ_RETURN(page, start, off, count, eof, len);
3690}
3691
3692static ide_proc_entry_t idetape_proc[] = {
3693	{ "capacity",	S_IFREG|S_IRUGO,	proc_ide_read_capacity, NULL },
3694	{ "name",	S_IFREG|S_IRUGO,	proc_idetape_read_name,	NULL },
3695	{ NULL, 0, NULL, NULL }
3696};
3697#endif
3698
3699static int ide_tape_probe(ide_drive_t *);
3700
3701static ide_driver_t idetape_driver = {
3702	.gen_driver = {
3703		.owner		= THIS_MODULE,
3704		.name		= "ide-tape",
3705		.bus		= &ide_bus_type,
3706	},
3707	.probe			= ide_tape_probe,
3708	.remove			= ide_tape_remove,
3709	.version		= IDETAPE_VERSION,
3710	.media			= ide_tape,
3711	.supports_dsc_overlap 	= 1,
3712	.do_request		= idetape_do_request,
3713	.end_request		= idetape_end_request,
3714	.error			= __ide_error,
3715	.abort			= __ide_abort,
3716#ifdef CONFIG_IDE_PROC_FS
3717	.proc			= idetape_proc,
3718#endif
3719};
3720
3721/*
3722 *	Our character device supporting functions, passed to register_chrdev.
3723 */
3724static const struct file_operations idetape_fops = {
3725	.owner		= THIS_MODULE,
3726	.read		= idetape_chrdev_read,
3727	.write		= idetape_chrdev_write,
3728	.ioctl		= idetape_chrdev_ioctl,
3729	.open		= idetape_chrdev_open,
3730	.release	= idetape_chrdev_release,
3731};
3732
3733static int idetape_open(struct inode *inode, struct file *filp)
3734{
3735	struct gendisk *disk = inode->i_bdev->bd_disk;
3736	struct ide_tape_obj *tape;
3737
3738	if (!(tape = ide_tape_get(disk)))
3739		return -ENXIO;
3740
3741	return 0;
3742}
3743
3744static int idetape_release(struct inode *inode, struct file *filp)
3745{
3746	struct gendisk *disk = inode->i_bdev->bd_disk;
3747	struct ide_tape_obj *tape = ide_tape_g(disk);
3748
3749	ide_tape_put(tape);
3750
3751	return 0;
3752}
3753
3754static int idetape_ioctl(struct inode *inode, struct file *file,
3755			unsigned int cmd, unsigned long arg)
3756{
3757	struct block_device *bdev = inode->i_bdev;
3758	struct ide_tape_obj *tape = ide_tape_g(bdev->bd_disk);
3759	ide_drive_t *drive = tape->drive;
3760	int err = generic_ide_ioctl(drive, file, bdev, cmd, arg);
3761	if (err == -EINVAL)
3762		err = idetape_blkdev_ioctl(drive, cmd, arg);
3763	return err;
3764}
3765
3766static struct block_device_operations idetape_block_ops = {
3767	.owner		= THIS_MODULE,
3768	.open		= idetape_open,
3769	.release	= idetape_release,
3770	.ioctl		= idetape_ioctl,
3771};
3772
3773static int ide_tape_probe(ide_drive_t *drive)
3774{
3775	idetape_tape_t *tape;
3776	struct gendisk *g;
3777	int minor;
3778
3779	if (!strstr("ide-tape", drive->driver_req))
3780		goto failed;
3781	if (!drive->present)
3782		goto failed;
3783	if (drive->media != ide_tape)
3784		goto failed;
3785	if (!idetape_identify_device (drive)) {
3786		printk(KERN_ERR "ide-tape: %s: not supported by this version of ide-tape\n", drive->name);
3787		goto failed;
3788	}
3789	if (drive->scsi) {
3790		printk("ide-tape: passing drive %s to ide-scsi emulation.\n", drive->name);
3791		goto failed;
3792	}
3793	if (strstr(drive->id->model, "OnStream DI-")) {
3794		printk(KERN_WARNING "ide-tape: Use drive %s with ide-scsi emulation and osst.\n", drive->name);
3795		printk(KERN_WARNING "ide-tape: OnStream support will be removed soon from ide-tape!\n");
3796	}
3797	tape = kzalloc(sizeof (idetape_tape_t), GFP_KERNEL);
3798	if (tape == NULL) {
3799		printk(KERN_ERR "ide-tape: %s: Can't allocate a tape structure\n", drive->name);
3800		goto failed;
3801	}
3802
3803	g = alloc_disk(1 << PARTN_BITS);
3804	if (!g)
3805		goto out_free_tape;
3806
3807	ide_init_disk(g, drive);
3808
3809	ide_proc_register_driver(drive, &idetape_driver);
3810
3811	kref_init(&tape->kref);
3812
3813	tape->drive = drive;
3814	tape->driver = &idetape_driver;
3815	tape->disk = g;
3816
3817	g->private_data = &tape->driver;
3818
3819	drive->driver_data = tape;
3820
3821	mutex_lock(&idetape_ref_mutex);
3822	for (minor = 0; idetape_devs[minor]; minor++)
3823		;
3824	idetape_devs[minor] = tape;
3825	mutex_unlock(&idetape_ref_mutex);
3826
3827	idetape_setup(drive, tape, minor);
3828
3829	device_create(idetape_sysfs_class, &drive->gendev,
3830		      MKDEV(IDETAPE_MAJOR, minor), "%s", tape->name);
3831	device_create(idetape_sysfs_class, &drive->gendev,
3832			MKDEV(IDETAPE_MAJOR, minor + 128), "n%s", tape->name);
3833
3834	g->fops = &idetape_block_ops;
3835	ide_register_region(g);
3836
3837	return 0;
3838
3839out_free_tape:
3840	kfree(tape);
3841failed:
3842	return -ENODEV;
3843}
3844
3845MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
3846MODULE_LICENSE("GPL");
3847
3848static void __exit idetape_exit (void)
3849{
3850	driver_unregister(&idetape_driver.gen_driver);
3851	class_destroy(idetape_sysfs_class);
3852	unregister_chrdev(IDETAPE_MAJOR, "ht");
3853}
3854
3855static int __init idetape_init(void)
3856{
3857	int error = 1;
3858	idetape_sysfs_class = class_create(THIS_MODULE, "ide_tape");
3859	if (IS_ERR(idetape_sysfs_class)) {
3860		idetape_sysfs_class = NULL;
3861		printk(KERN_ERR "Unable to create sysfs class for ide tapes\n");
3862		error = -EBUSY;
3863		goto out;
3864	}
3865
3866	if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
3867		printk(KERN_ERR "ide-tape: Failed to register character device interface\n");
3868		error = -EBUSY;
3869		goto out_free_class;
3870	}
3871
3872	error = driver_register(&idetape_driver.gen_driver);
3873	if (error)
3874		goto out_free_driver;
3875
3876	return 0;
3877
3878out_free_driver:
3879	driver_unregister(&idetape_driver.gen_driver);
3880out_free_class:
3881	class_destroy(idetape_sysfs_class);
3882out:
3883	return error;
3884}
3885
3886MODULE_ALIAS("ide:*m-tape*");
3887module_init(idetape_init);
3888module_exit(idetape_exit);
3889MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
3890