ide-tape.c 84.2 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2 3
 * IDE ATAPI streaming tape driver.
 *
4 5
 * Copyright (C) 1995-1999  Gadi Oxman <gadio@netvision.net.il>
 * Copyright (C) 2003-2005  Bartlomiej Zolnierkiewicz
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13
 *
 * This driver was constructed as a student project in the software laboratory
 * of the faculty of electrical engineering in the Technion - Israel's
 * Institute Of Technology, with the guide of Avner Lottem and Dr. Ilana David.
 *
 * It is hereby placed under the terms of the GNU general public license.
 * (See linux/COPYING).
 *
14 15
 * For a historical changelog see
 * Documentation/ide/ChangeLog.ide-tape.1995-2002
L
Linus Torvalds 已提交
16 17
 */

18
#define IDETAPE_VERSION "1.20"
L
Linus Torvalds 已提交
19 20 21 22 23 24 25 26 27

#include <linux/module.h>
#include <linux/types.h>
#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/timer.h>
#include <linux/mm.h>
#include <linux/interrupt.h>
28
#include <linux/jiffies.h>
L
Linus Torvalds 已提交
29 30 31 32 33 34 35 36 37
#include <linux/major.h>
#include <linux/errno.h>
#include <linux/genhd.h>
#include <linux/slab.h>
#include <linux/pci.h>
#include <linux/ide.h>
#include <linux/smp_lock.h>
#include <linux/completion.h>
#include <linux/bitops.h>
38
#include <linux/mutex.h>
39
#include <scsi/scsi.h>
L
Linus Torvalds 已提交
40 41

#include <asm/byteorder.h>
42 43 44
#include <linux/irq.h>
#include <linux/uaccess.h>
#include <linux/io.h>
L
Linus Torvalds 已提交
45 46 47
#include <asm/unaligned.h>
#include <linux/mtio.h>

48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73
enum {
	/* output errors only */
	DBG_ERR =		(1 << 0),
	/* output all sense key/asc */
	DBG_SENSE =		(1 << 1),
	/* info regarding all chrdev-related procedures */
	DBG_CHRDEV =		(1 << 2),
	/* all remaining procedures */
	DBG_PROCS =		(1 << 3),
	/* buffer alloc info (pc_stack & rq_stack) */
	DBG_PCRQ_STACK =	(1 << 4),
};

/* define to see debug info */
#define IDETAPE_DEBUG_LOG		0

#if IDETAPE_DEBUG_LOG
#define debug_log(lvl, fmt, args...)			\
{							\
	if (tape->debug_mask & lvl)			\
	printk(KERN_INFO "ide-tape: " fmt, ## args);	\
}
#else
#define debug_log(lvl, fmt, args...) do {} while (0)
#endif

L
Linus Torvalds 已提交
74 75
/**************************** Tunable parameters *****************************/
/*
76 77
 * After each failed packet command we issue a request sense command and retry
 * the packet command IDETAPE_MAX_PC_RETRIES times.
L
Linus Torvalds 已提交
78
 *
79
 * Setting IDETAPE_MAX_PC_RETRIES to 0 will disable retries.
L
Linus Torvalds 已提交
80 81 82 83
 */
#define IDETAPE_MAX_PC_RETRIES		3

/*
84 85
 * With each packet command, we allocate a buffer of IDETAPE_PC_BUFFER_SIZE
 * bytes. This is used for several packet commands (Not for READ/WRITE commands)
L
Linus Torvalds 已提交
86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103
 */
#define IDETAPE_PC_BUFFER_SIZE		256

/*
 *	In various places in the driver, we need to allocate storage
 *	for packet commands and requests, which will remain valid while
 *	we leave the driver to wait for an interrupt or a timeout event.
 */
#define IDETAPE_PC_STACK		(10 + IDETAPE_MAX_PC_RETRIES)

/*
 * Some drives (for example, Seagate STT3401A Travan) require a very long
 * timeout, because they don't return an interrupt or clear their busy bit
 * until after the command completes (even retension commands).
 */
#define IDETAPE_WAIT_CMD		(900*HZ)

/*
104 105 106 107
 * The following parameter is used to select the point in the internal tape fifo
 * in which we will start to refill the buffer. Decreasing the following
 * parameter will improve the system's latency and interactive response, while
 * using a high value might improve system throughput.
L
Linus Torvalds 已提交
108
 */
109
#define IDETAPE_FIFO_THRESHOLD		2
L
Linus Torvalds 已提交
110 111

/*
112
 * DSC polling parameters.
L
Linus Torvalds 已提交
113
 *
114 115
 * Polling for DSC (a single bit in the status register) is a very important
 * function in ide-tape. There are two cases in which we poll for DSC:
L
Linus Torvalds 已提交
116
 *
117 118 119 120 121
 * 1. Before a read/write packet command, to ensure that we can transfer data
 * from/to the tape's data buffers, without causing an actual media access.
 * In case the tape is not ready yet, we take out our request from the device
 * request queue, so that ide.c could service requests from the other device
 * on the same interface in the meantime.
L
Linus Torvalds 已提交
122
 *
123 124 125 126 127 128 129 130
 * 2. After the successful initialization of a "media access packet command",
 * which is a command that can take a long time to complete (the interval can
 * range from several seconds to even an hour). Again, we postpone our request
 * in the middle to free the bus for the other device. The polling frequency
 * here should be lower than the read/write frequency since those media access
 * commands are slow. We start from a "fast" frequency - IDETAPE_DSC_MA_FAST
 * (1 second), and if we don't receive DSC after IDETAPE_DSC_MA_THRESHOLD
 * (5 min), we switch it to a lower frequency - IDETAPE_DSC_MA_SLOW (1 min).
L
Linus Torvalds 已提交
131
 *
132 133
 * We also set a timeout for the timer, in case something goes wrong. The
 * timeout should be longer then the maximum execution time of a tape operation.
L
Linus Torvalds 已提交
134
 */
135 136

/* DSC timings. */
L
Linus Torvalds 已提交
137 138 139 140 141 142 143 144 145 146
#define IDETAPE_DSC_RW_MIN		5*HZ/100	/* 50 msec */
#define IDETAPE_DSC_RW_MAX		40*HZ/100	/* 400 msec */
#define IDETAPE_DSC_RW_TIMEOUT		2*60*HZ		/* 2 minutes */
#define IDETAPE_DSC_MA_FAST		2*HZ		/* 2 seconds */
#define IDETAPE_DSC_MA_THRESHOLD	5*60*HZ		/* 5 minutes */
#define IDETAPE_DSC_MA_SLOW		30*HZ		/* 30 seconds */
#define IDETAPE_DSC_MA_TIMEOUT		2*60*60*HZ	/* 2 hours */

/*************************** End of tunable parameters ***********************/

147
/* Read/Write error simulation */
L
Linus Torvalds 已提交
148 149
#define SIMULATE_ERRORS			0

150 151 152 153 154 155
/* tape directions */
enum {
	IDETAPE_DIR_NONE  = (1 << 0),
	IDETAPE_DIR_READ  = (1 << 1),
	IDETAPE_DIR_WRITE = (1 << 2),
};
L
Linus Torvalds 已提交
156 157

struct idetape_bh {
158
	u32 b_size;
L
Linus Torvalds 已提交
159 160 161 162 163
	atomic_t b_count;
	struct idetape_bh *b_reqnext;
	char *b_data;
};

164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200
/* Tape door status */
#define DOOR_UNLOCKED			0
#define DOOR_LOCKED			1
#define DOOR_EXPLICITLY_LOCKED		2

/* Some defines for the SPACE command */
#define IDETAPE_SPACE_OVER_FILEMARK	1
#define IDETAPE_SPACE_TO_EOD		3

/* Some defines for the LOAD UNLOAD command */
#define IDETAPE_LU_LOAD_MASK		1
#define IDETAPE_LU_RETENSION_MASK	2
#define IDETAPE_LU_EOT_MASK		4

/*
 * Special requests for our block device strategy routine.
 *
 * In order to service a character device command, we add special requests to
 * the tail of our block device request queue and wait for their completion.
 */

enum {
	REQ_IDETAPE_PC1		= (1 << 0), /* packet command (first stage) */
	REQ_IDETAPE_PC2		= (1 << 1), /* packet command (second stage) */
	REQ_IDETAPE_READ	= (1 << 2),
	REQ_IDETAPE_WRITE	= (1 << 3),
};

/* Error codes returned in rq->errors to the higher part of the driver. */
#define IDETAPE_ERROR_GENERAL		101
#define IDETAPE_ERROR_FILEMARK		102
#define IDETAPE_ERROR_EOD		103

/* Structures related to the SELECT SENSE / MODE SENSE packet commands. */
#define IDETAPE_BLOCK_DESCRIPTOR	0
#define IDETAPE_CAPABILITIES_PAGE	0x2a

201 202 203 204 205 206
/* Tape flag bits values. */
enum {
	IDETAPE_FLAG_IGNORE_DSC		= (1 << 0),
	/* 0 When the tape position is unknown */
	IDETAPE_FLAG_ADDRESS_VALID	= (1 <<	1),
	/* Device already opened */
207
	IDETAPE_FLAG_BUSY		= (1 << 2),
208
	/* Attempt to auto-detect the current user block size */
209
	IDETAPE_FLAG_DETECT_BS		= (1 << 3),
210
	/* Currently on a filemark */
211
	IDETAPE_FLAG_FILEMARK		= (1 << 4),
212
	/* DRQ interrupt device */
213
	IDETAPE_FLAG_DRQ_INTERRUPT	= (1 << 5),
214
	/* 0 = no tape is loaded, so we don't rewind after ejecting */
215
	IDETAPE_FLAG_MEDIUM_PRESENT	= (1 << 6),
216 217
};

218
/* A pipeline stage. */
L
Linus Torvalds 已提交
219 220 221 222 223 224 225
typedef struct idetape_stage_s {
	struct request rq;			/* The corresponding request */
	struct idetape_bh *bh;			/* The data buffers */
	struct idetape_stage_s *next;		/* Pointer to the next stage */
} idetape_stage_t;

/*
226 227
 * Most of our global data which we need to save even as we leave the driver due
 * to an interrupt or a timer event is stored in the struct defined below.
L
Linus Torvalds 已提交
228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250
 */
typedef struct ide_tape_obj {
	ide_drive_t	*drive;
	ide_driver_t	*driver;
	struct gendisk	*disk;
	struct kref	kref;

	/*
	 *	Since a typical character device operation requires more
	 *	than one packet command, we provide here enough memory
	 *	for the maximum of interconnected packet commands.
	 *	The packet commands are stored in the circular array pc_stack.
	 *	pc_stack_index points to the last used entry, and warps around
	 *	to the start when we get to the last array entry.
	 *
	 *	pc points to the current processed packet command.
	 *
	 *	failed_pc points to the last failed packet command, or contains
	 *	NULL if we do not need to retry any packet command. This is
	 *	required since an additional packet command is needed before the
	 *	retry, to get detailed information on what went wrong.
	 */
	/* Current packet command */
251
	struct ide_atapi_pc *pc;
L
Linus Torvalds 已提交
252
	/* Last failed packet command */
253
	struct ide_atapi_pc *failed_pc;
L
Linus Torvalds 已提交
254
	/* Packet command stack */
255
	struct ide_atapi_pc pc_stack[IDETAPE_PC_STACK];
L
Linus Torvalds 已提交
256 257 258 259 260 261 262
	/* Next free packet command storage space */
	int pc_stack_index;
	struct request rq_stack[IDETAPE_PC_STACK];
	/* We implement a circular array */
	int rq_stack_index;

	/*
263
	 * DSC polling variables.
L
Linus Torvalds 已提交
264
	 *
265 266 267 268 269 270
	 * While polling for DSC we use postponed_rq to postpone the current
	 * request so that ide.c will be able to service pending requests on the
	 * other device. Note that at most we will have only one DSC (usually
	 * data transfer) request in the device request queue. Additional
	 * requests can be queued in our internal pipeline, but they will be
	 * visible to ide.c only one at a time.
L
Linus Torvalds 已提交
271 272 273 274 275 276 277
	 */
	struct request *postponed_rq;
	/* The time in which we started polling for DSC */
	unsigned long dsc_polling_start;
	/* Timer used to poll for dsc */
	struct timer_list dsc_timer;
	/* Read/Write dsc polling frequency */
278 279
	unsigned long best_dsc_rw_freq;
	unsigned long dsc_poll_freq;
L
Linus Torvalds 已提交
280 281
	unsigned long dsc_timeout;

282
	/* Read position information */
L
Linus Torvalds 已提交
283 284
	u8 partition;
	/* Current block */
285
	unsigned int first_frame;
L
Linus Torvalds 已提交
286

287
	/* Last error information */
L
Linus Torvalds 已提交
288 289
	u8 sense_key, asc, ascq;

290
	/* Character device operation */
L
Linus Torvalds 已提交
291 292 293 294
	unsigned int minor;
	/* device name */
	char name[4];
	/* Current character device data transfer direction */
295
	u8 chrdev_dir;
L
Linus Torvalds 已提交
296

297 298
	/* tape block size, usually 512 or 1024 bytes */
	unsigned short blk_size;
L
Linus Torvalds 已提交
299
	int user_bs_factor;
300

L
Linus Torvalds 已提交
301
	/* Copy of the tape's Capabilities and Mechanical Page */
302
	u8 caps[20];
L
Linus Torvalds 已提交
303 304

	/*
305
	 * Active data transfer request parameters.
L
Linus Torvalds 已提交
306
	 *
307 308 309
	 * At most, there is only one ide-tape originated data transfer request
	 * in the device request queue. This allows ide.c to easily service
	 * requests from the other device when we postpone our active request.
L
Linus Torvalds 已提交
310
	 */
311

312
	/* Data buffer size chosen based on the tape's recommendation */
L
Linus Torvalds 已提交
313 314 315 316 317 318
	int stage_size;
	idetape_stage_t *merge_stage;
	int merge_stage_size;
	struct idetape_bh *bh;
	char *b_data;
	int b_count;
319

320
	/* Pipeline parameters. */
L
Linus Torvalds 已提交
321 322 323 324 325 326 327
	int pages_per_stage;
	/* Wasted space in each stage */
	int excess_bh_size;

	/* Status/Action flags: long for set_bit */
	unsigned long flags;
	/* protects the ide-tape queue */
328
	spinlock_t lock;
L
Linus Torvalds 已提交
329

330
	/* Measures average tape speed */
L
Linus Torvalds 已提交
331 332 333 334 335 336 337 338 339 340 341
	unsigned long avg_time;
	int avg_size;
	int avg_speed;

	/* the door is currently locked */
	int door_locked;
	/* the tape hardware is write protected */
	char drv_write_prot;
	/* the tape is write protected (hardware or opened as read-only) */
	char write_prot;

342
	u32 debug_mask;
L
Linus Torvalds 已提交
343 344
} idetape_tape_t;

345
static DEFINE_MUTEX(idetape_ref_mutex);
L
Linus Torvalds 已提交
346

347 348
static struct class *idetape_sysfs_class;

L
Linus Torvalds 已提交
349 350 351 352 353 354 355 356 357
#define to_ide_tape(obj) container_of(obj, struct ide_tape_obj, kref)

#define ide_tape_g(disk) \
	container_of((disk)->private_data, struct ide_tape_obj, driver)

static struct ide_tape_obj *ide_tape_get(struct gendisk *disk)
{
	struct ide_tape_obj *tape = NULL;

358
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
359 360 361
	tape = ide_tape_g(disk);
	if (tape)
		kref_get(&tape->kref);
362
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
363 364 365 366 367 368 369
	return tape;
}

static void ide_tape_release(struct kref *);

static void ide_tape_put(struct ide_tape_obj *tape)
{
370
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
371
	kref_put(&tape->kref, ide_tape_release);
372
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
373 374 375
}

/*
376 377
 * The variables below are used for the character device interface. Additional
 * state variables are defined in our ide_drive_t structure.
L
Linus Torvalds 已提交
378
 */
379
static struct ide_tape_obj *idetape_devs[MAX_HWIFS * MAX_DRIVES];
L
Linus Torvalds 已提交
380 381 382 383 384 385 386

#define ide_tape_f(file) ((file)->private_data)

static struct ide_tape_obj *ide_tape_chrdev_get(unsigned int i)
{
	struct ide_tape_obj *tape = NULL;

387
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
388 389 390
	tape = idetape_devs[i];
	if (tape)
		kref_get(&tape->kref);
391
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
392 393 394
	return tape;
}

395
static void idetape_input_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
396
				  unsigned int bcount)
L
Linus Torvalds 已提交
397 398 399 400 401 402 403 404
{
	struct idetape_bh *bh = pc->bh;
	int count;

	while (bcount) {
		if (bh == NULL) {
			printk(KERN_ERR "ide-tape: bh == NULL in "
				"idetape_input_buffers\n");
405
			ide_atapi_discard_data(drive, bcount);
L
Linus Torvalds 已提交
406 407
			return;
		}
408 409 410 411 412
		count = min(
			(unsigned int)(bh->b_size - atomic_read(&bh->b_count)),
			bcount);
		HWIF(drive)->atapi_input_bytes(drive, bh->b_data +
					atomic_read(&bh->b_count), count);
L
Linus Torvalds 已提交
413 414 415 416 417 418 419 420 421 422 423
		bcount -= count;
		atomic_add(count, &bh->b_count);
		if (atomic_read(&bh->b_count) == bh->b_size) {
			bh = bh->b_reqnext;
			if (bh)
				atomic_set(&bh->b_count, 0);
		}
	}
	pc->bh = bh;
}

424
static void idetape_output_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
425
				   unsigned int bcount)
L
Linus Torvalds 已提交
426 427 428 429 430 431
{
	struct idetape_bh *bh = pc->bh;
	int count;

	while (bcount) {
		if (bh == NULL) {
432 433
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
L
Linus Torvalds 已提交
434 435 436 437 438 439 440 441
			return;
		}
		count = min((unsigned int)pc->b_count, (unsigned int)bcount);
		HWIF(drive)->atapi_output_bytes(drive, pc->b_data, count);
		bcount -= count;
		pc->b_data += count;
		pc->b_count -= count;
		if (!pc->b_count) {
442 443
			bh = bh->b_reqnext;
			pc->bh = bh;
L
Linus Torvalds 已提交
444 445 446 447 448 449 450 451
			if (bh) {
				pc->b_data = bh->b_data;
				pc->b_count = atomic_read(&bh->b_count);
			}
		}
	}
}

452
static void idetape_update_buffers(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
453 454 455
{
	struct idetape_bh *bh = pc->bh;
	int count;
456
	unsigned int bcount = pc->xferred;
L
Linus Torvalds 已提交
457

458
	if (pc->flags & PC_FLAG_WRITING)
L
Linus Torvalds 已提交
459 460 461
		return;
	while (bcount) {
		if (bh == NULL) {
462 463
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
L
Linus Torvalds 已提交
464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
			return;
		}
		count = min((unsigned int)bh->b_size, (unsigned int)bcount);
		atomic_set(&bh->b_count, count);
		if (atomic_read(&bh->b_count) == bh->b_size)
			bh = bh->b_reqnext;
		bcount -= count;
	}
	pc->bh = bh;
}

/*
 *	idetape_next_pc_storage returns a pointer to a place in which we can
 *	safely store a packet command, even though we intend to leave the
 *	driver. A storage space for a maximum of IDETAPE_PC_STACK packet
 *	commands is allocated at initialization time.
 */
481
static struct ide_atapi_pc *idetape_next_pc_storage(ide_drive_t *drive)
L
Linus Torvalds 已提交
482 483 484
{
	idetape_tape_t *tape = drive->driver_data;

485 486
	debug_log(DBG_PCRQ_STACK, "pc_stack_index=%d\n", tape->pc_stack_index);

L
Linus Torvalds 已提交
487
	if (tape->pc_stack_index == IDETAPE_PC_STACK)
488
		tape->pc_stack_index = 0;
L
Linus Torvalds 已提交
489 490 491 492 493 494 495 496
	return (&tape->pc_stack[tape->pc_stack_index++]);
}

/*
 *	idetape_next_rq_storage is used along with idetape_next_pc_storage.
 *	Since we queue packet commands in the request queue, we need to
 *	allocate a request, along with the allocation of a packet command.
 */
497

L
Linus Torvalds 已提交
498 499 500 501 502 503
/**************************************************************
 *                                                            *
 *  This should get fixed to use kmalloc(.., GFP_ATOMIC)      *
 *  followed later on by kfree().   -ml                       *
 *                                                            *
 **************************************************************/
504 505

static struct request *idetape_next_rq_storage(ide_drive_t *drive)
L
Linus Torvalds 已提交
506 507 508
{
	idetape_tape_t *tape = drive->driver_data;

509 510
	debug_log(DBG_PCRQ_STACK, "rq_stack_index=%d\n", tape->rq_stack_index);

L
Linus Torvalds 已提交
511
	if (tape->rq_stack_index == IDETAPE_PC_STACK)
512
		tape->rq_stack_index = 0;
L
Linus Torvalds 已提交
513 514 515
	return (&tape->rq_stack[tape->rq_stack_index++]);
}

516
static void idetape_init_pc(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
517 518 519 520
{
	memset(pc->c, 0, 12);
	pc->retries = 0;
	pc->flags = 0;
521 522 523
	pc->req_xfer = 0;
	pc->buf = pc->pc_buf;
	pc->buf_size = IDETAPE_PC_BUFFER_SIZE;
L
Linus Torvalds 已提交
524 525 526 527 528
	pc->bh = NULL;
	pc->b_data = NULL;
}

/*
529 530
 * called on each failed packet command retry to analyze the request sense. We
 * currently do not utilize this information.
L
Linus Torvalds 已提交
531
 */
532
static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
L
Linus Torvalds 已提交
533 534
{
	idetape_tape_t *tape = drive->driver_data;
535
	struct ide_atapi_pc *pc = tape->failed_pc;
L
Linus Torvalds 已提交
536

537 538 539
	tape->sense_key = sense[2] & 0xF;
	tape->asc       = sense[12];
	tape->ascq      = sense[13];
540 541 542

	debug_log(DBG_ERR, "pc = %x, sense key = %x, asc = %x, ascq = %x\n",
		 pc->c[0], tape->sense_key, tape->asc, tape->ascq);
L
Linus Torvalds 已提交
543

544
	/* Correct pc->xferred by asking the tape.	 */
545
	if (pc->flags & PC_FLAG_DMA_ERROR) {
546
		pc->xferred = pc->req_xfer -
547
			tape->blk_size *
548
			be32_to_cpu(get_unaligned((u32 *)&sense[3]));
L
Linus Torvalds 已提交
549 550 551 552 553 554 555 556
		idetape_update_buffers(pc);
	}

	/*
	 * If error was the result of a zero-length read or write command,
	 * with sense key=5, asc=0x22, ascq=0, let it slide.  Some drives
	 * (i.e. Seagate STT3401A Travan) don't support 0-length read/writes.
	 */
557
	if ((pc->c[0] == READ_6 || pc->c[0] == WRITE_6)
558 559 560
	    /* length == 0 */
	    && pc->c[4] == 0 && pc->c[3] == 0 && pc->c[2] == 0) {
		if (tape->sense_key == 5) {
L
Linus Torvalds 已提交
561 562 563
			/* don't report an error, everything's ok */
			pc->error = 0;
			/* don't retry read/write */
564
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
565 566
		}
	}
567
	if (pc->c[0] == READ_6 && (sense[2] & 0x80)) {
L
Linus Torvalds 已提交
568
		pc->error = IDETAPE_ERROR_FILEMARK;
569
		pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
570
	}
571
	if (pc->c[0] == WRITE_6) {
572 573
		if ((sense[2] & 0x40) || (tape->sense_key == 0xd
		     && tape->asc == 0x0 && tape->ascq == 0x2)) {
L
Linus Torvalds 已提交
574
			pc->error = IDETAPE_ERROR_EOD;
575
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
576 577
		}
	}
578
	if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
579
		if (tape->sense_key == 8) {
L
Linus Torvalds 已提交
580
			pc->error = IDETAPE_ERROR_EOD;
581
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
582
		}
583
		if (!(pc->flags & PC_FLAG_ABORT) &&
584
		    pc->xferred)
L
Linus Torvalds 已提交
585 586 587 588
			pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
	}
}

589
/* Free a stage along with its related buffers completely. */
590
static void __idetape_kfree_stage(idetape_stage_t *stage)
L
Linus Torvalds 已提交
591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611
{
	struct idetape_bh *prev_bh, *bh = stage->bh;
	int size;

	while (bh != NULL) {
		if (bh->b_data != NULL) {
			size = (int) bh->b_size;
			while (size > 0) {
				free_page((unsigned long) bh->b_data);
				size -= PAGE_SIZE;
				bh->b_data += PAGE_SIZE;
			}
		}
		prev_bh = bh;
		bh = bh->b_reqnext;
		kfree(prev_bh);
	}
	kfree(stage);
}

/*
612 613
 * Finish servicing a request and insert a pending pipeline request into the
 * main device queue.
L
Linus Torvalds 已提交
614 615 616 617 618 619 620 621
 */
static int idetape_end_request(ide_drive_t *drive, int uptodate, int nr_sects)
{
	struct request *rq = HWGROUP(drive)->rq;
	idetape_tape_t *tape = drive->driver_data;
	unsigned long flags;
	int error;

622
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
623 624

	switch (uptodate) {
625 626 627
	case 0:	error = IDETAPE_ERROR_GENERAL; break;
	case 1: error = 0; break;
	default: error = uptodate;
L
Linus Torvalds 已提交
628 629 630 631 632
	}
	rq->errors = error;
	if (error)
		tape->failed_pc = NULL;

633 634 635 636 637
	if (!blk_special_request(rq)) {
		ide_end_request(drive, uptodate, nr_sects);
		return 0;
	}

638
	spin_lock_irqsave(&tape->lock, flags);
L
Linus Torvalds 已提交
639 640 641

	ide_end_drive_cmd(drive, 0, 0);

642
	spin_unlock_irqrestore(&tape->lock, flags);
L
Linus Torvalds 已提交
643 644 645
	return 0;
}

646
static ide_startstop_t idetape_request_sense_callback(ide_drive_t *drive)
L
Linus Torvalds 已提交
647 648 649
{
	idetape_tape_t *tape = drive->driver_data;

650 651
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
652
	if (!tape->pc->error) {
653
		idetape_analyze_error(drive, tape->pc->buf);
L
Linus Torvalds 已提交
654 655
		idetape_end_request(drive, 1, 0);
	} else {
656 657
		printk(KERN_ERR "ide-tape: Error in REQUEST SENSE itself - "
				"Aborting request!\n");
L
Linus Torvalds 已提交
658 659 660 661 662
		idetape_end_request(drive, 0, 0);
	}
	return ide_stopped;
}

663
static void idetape_create_request_sense_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
664
{
665
	idetape_init_pc(pc);
666
	pc->c[0] = REQUEST_SENSE;
L
Linus Torvalds 已提交
667
	pc->c[4] = 20;
668 669
	pc->req_xfer = 20;
	pc->idetape_callback = &idetape_request_sense_callback;
L
Linus Torvalds 已提交
670 671 672 673 674
}

static void idetape_init_rq(struct request *rq, u8 cmd)
{
	memset(rq, 0, sizeof(*rq));
675
	rq->cmd_type = REQ_TYPE_SPECIAL;
L
Linus Torvalds 已提交
676 677 678 679
	rq->cmd[0] = cmd;
}

/*
680 681 682 683 684
 * Generate a new packet command request in front of the request queue, before
 * the current request, so that it will be processed immediately, on the next
 * pass through the driver. The function below is called from the request
 * handling part of the driver (the "bottom" part). Safe storage for the request
 * should be allocated with ide_tape_next_{pc,rq}_storage() prior to that.
L
Linus Torvalds 已提交
685
 *
686 687 688
 * Memory for those requests is pre-allocated at initialization time, and is
 * limited to IDETAPE_PC_STACK requests. We assume that we have enough space for
 * the maximum possible number of inter-dependent packet commands.
L
Linus Torvalds 已提交
689
 *
690 691 692
 * The higher level of the driver - The ioctl handler and the character device
 * handling functions should queue request to the lower level part and wait for
 * their completion using idetape_queue_pc_tail or idetape_queue_rw_tail.
L
Linus Torvalds 已提交
693
 */
694
static void idetape_queue_pc_head(ide_drive_t *drive, struct ide_atapi_pc *pc,
695
				  struct request *rq)
L
Linus Torvalds 已提交
696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712
{
	struct ide_tape_obj *tape = drive->driver_data;

	idetape_init_rq(rq, REQ_IDETAPE_PC1);
	rq->buffer = (char *) pc;
	rq->rq_disk = tape->disk;
	(void) ide_do_drive_cmd(drive, rq, ide_preempt);
}

/*
 *	idetape_retry_pc is called when an error was detected during the
 *	last packet command. We queue a request sense packet command in
 *	the head of the request list.
 */
static ide_startstop_t idetape_retry_pc (ide_drive_t *drive)
{
	idetape_tape_t *tape = drive->driver_data;
713
	struct ide_atapi_pc *pc;
L
Linus Torvalds 已提交
714 715
	struct request *rq;

716
	(void)ide_read_error(drive);
L
Linus Torvalds 已提交
717 718 719
	pc = idetape_next_pc_storage(drive);
	rq = idetape_next_rq_storage(drive);
	idetape_create_request_sense_cmd(pc);
720
	set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
L
Linus Torvalds 已提交
721 722 723 724 725
	idetape_queue_pc_head(drive, pc, rq);
	return ide_stopped;
}

/*
726 727
 * Postpone the current request so that ide.c will be able to service requests
 * from another device on the same hwgroup while we are polling for DSC.
L
Linus Torvalds 已提交
728
 */
729
static void idetape_postpone_request(ide_drive_t *drive)
L
Linus Torvalds 已提交
730 731 732
{
	idetape_tape_t *tape = drive->driver_data;

733 734
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
735
	tape->postponed_rq = HWGROUP(drive)->rq;
736
	ide_stall_queue(drive, tape->dsc_poll_freq);
L
Linus Torvalds 已提交
737 738
}

739
typedef void idetape_io_buf(ide_drive_t *, struct ide_atapi_pc *, unsigned int);
740

L
Linus Torvalds 已提交
741
/*
742 743 744 745
 * This is the usual interrupt handler which will be called during a packet
 * command. We will transfer some of the data (as requested by the drive) and
 * will re-point interrupt handler to us. When data transfer is finished, we
 * will act according to the algorithm described before
746
 * idetape_issue_pc.
L
Linus Torvalds 已提交
747
 */
748
static ide_startstop_t idetape_pc_intr(ide_drive_t *drive)
L
Linus Torvalds 已提交
749 750 751
{
	ide_hwif_t *hwif = drive->hwif;
	idetape_tape_t *tape = drive->driver_data;
752
	struct ide_atapi_pc *pc = tape->pc;
753 754
	xfer_func_t *xferfunc;
	idetape_io_buf *iobuf;
L
Linus Torvalds 已提交
755 756
	unsigned int temp;
#if SIMULATE_ERRORS
757
	static int error_sim_count;
L
Linus Torvalds 已提交
758
#endif
759
	u16 bcount;
760
	u8 stat, ireason;
L
Linus Torvalds 已提交
761

762
	debug_log(DBG_PROCS, "Enter %s - interrupt handler\n", __func__);
L
Linus Torvalds 已提交
763 764

	/* Clear the interrupt */
765
	stat = ide_read_status(drive);
L
Linus Torvalds 已提交
766

767
	if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
768
		if (hwif->dma_ops->dma_end(drive) || (stat & ERR_STAT)) {
L
Linus Torvalds 已提交
769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789
			/*
			 * A DMA error is sometimes expected. For example,
			 * if the tape is crossing a filemark during a
			 * READ command, it will issue an irq and position
			 * itself before the filemark, so that only a partial
			 * data transfer will occur (which causes the DMA
			 * error). In that case, we will later ask the tape
			 * how much bytes of the original request were
			 * actually transferred (we can't receive that
			 * information from the DMA engine on most chipsets).
			 */

			/*
			 * On the contrary, a DMA error is never expected;
			 * it usually indicates a hardware error or abort.
			 * If the tape crosses a filemark during a READ
			 * command, it will issue an irq and position itself
			 * after the filemark (not before). Only a partial
			 * data transfer will occur, but no DMA error.
			 * (AS, 19 Apr 2001)
			 */
790
			pc->flags |= PC_FLAG_DMA_ERROR;
L
Linus Torvalds 已提交
791
		} else {
792
			pc->xferred = pc->req_xfer;
L
Linus Torvalds 已提交
793 794
			idetape_update_buffers(pc);
		}
795 796
		debug_log(DBG_PROCS, "DMA finished\n");

L
Linus Torvalds 已提交
797 798 799
	}

	/* No more interrupts */
800
	if ((stat & DRQ_STAT) == 0) {
801
		debug_log(DBG_SENSE, "Packet command completed, %d bytes"
802
				" transferred\n", pc->xferred);
L
Linus Torvalds 已提交
803

804
		pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
L
Linus Torvalds 已提交
805 806 807
		local_irq_enable();

#if SIMULATE_ERRORS
808
		if ((pc->c[0] == WRITE_6 || pc->c[0] == READ_6) &&
L
Linus Torvalds 已提交
809 810 811
		    (++error_sim_count % 100) == 0) {
			printk(KERN_INFO "ide-tape: %s: simulating error\n",
				tape->name);
812
			stat |= ERR_STAT;
L
Linus Torvalds 已提交
813 814
		}
#endif
815
		if ((stat & ERR_STAT) && pc->c[0] == REQUEST_SENSE)
816
			stat &= ~ERR_STAT;
817
		if ((stat & ERR_STAT) || (pc->flags & PC_FLAG_DMA_ERROR)) {
818
			/* Error detected */
819 820
			debug_log(DBG_ERR, "%s: I/O error\n", tape->name);

821
			if (pc->c[0] == REQUEST_SENSE) {
822 823
				printk(KERN_ERR "ide-tape: I/O error in request"
						" sense command\n");
L
Linus Torvalds 已提交
824 825
				return ide_do_reset(drive);
			}
826 827 828
			debug_log(DBG_ERR, "[cmd %x]: check condition\n",
					pc->c[0]);

L
Linus Torvalds 已提交
829 830 831 832
			/* Retry operation */
			return idetape_retry_pc(drive);
		}
		pc->error = 0;
833
		if ((pc->flags & PC_FLAG_WAIT_FOR_DSC) &&
834
		    (stat & SEEK_STAT) == 0) {
L
Linus Torvalds 已提交
835 836
			/* Media access command */
			tape->dsc_polling_start = jiffies;
837
			tape->dsc_poll_freq = IDETAPE_DSC_MA_FAST;
L
Linus Torvalds 已提交
838 839 840 841 842 843 844 845
			tape->dsc_timeout = jiffies + IDETAPE_DSC_MA_TIMEOUT;
			/* Allow ide.c to handle other requests */
			idetape_postpone_request(drive);
			return ide_stopped;
		}
		if (tape->failed_pc == pc)
			tape->failed_pc = NULL;
		/* Command finished - Call the callback function */
846
		return pc->idetape_callback(drive);
L
Linus Torvalds 已提交
847
	}
848 849 850

	if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
		pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
L
Linus Torvalds 已提交
851 852 853
		printk(KERN_ERR "ide-tape: The tape wants to issue more "
				"interrupts in DMA mode\n");
		printk(KERN_ERR "ide-tape: DMA disabled, reverting to PIO\n");
854
		ide_dma_off(drive);
L
Linus Torvalds 已提交
855 856 857
		return ide_do_reset(drive);
	}
	/* Get the number of bytes to transfer on this interrupt. */
858 859
	bcount = (hwif->INB(hwif->io_ports[IDE_BCOUNTH_OFFSET]) << 8) |
		  hwif->INB(hwif->io_ports[IDE_BCOUNTL_OFFSET]);
L
Linus Torvalds 已提交
860

861
	ireason = hwif->INB(hwif->io_ports[IDE_IREASON_OFFSET]);
L
Linus Torvalds 已提交
862

863
	if (ireason & CD) {
864
		printk(KERN_ERR "ide-tape: CoD != 0 in %s\n", __func__);
L
Linus Torvalds 已提交
865 866
		return ide_do_reset(drive);
	}
867
	if (((ireason & IO) == IO) == !!(pc->flags & PC_FLAG_WRITING)) {
L
Linus Torvalds 已提交
868 869
		/* Hopefully, we will never get here */
		printk(KERN_ERR "ide-tape: We wanted to %s, ",
870
				(ireason & IO) ? "Write" : "Read");
L
Linus Torvalds 已提交
871
		printk(KERN_ERR "ide-tape: but the tape wants us to %s !\n",
872
				(ireason & IO) ? "Read" : "Write");
L
Linus Torvalds 已提交
873 874
		return ide_do_reset(drive);
	}
875
	if (!(pc->flags & PC_FLAG_WRITING)) {
L
Linus Torvalds 已提交
876
		/* Reading - Check that we have enough space */
877 878 879
		temp = pc->xferred + bcount;
		if (temp > pc->req_xfer) {
			if (temp > pc->buf_size) {
880 881 882
				printk(KERN_ERR "ide-tape: The tape wants to "
					"send us more data than expected "
					"- discarding data\n");
883
				ide_atapi_discard_data(drive, bcount);
884 885
				ide_set_handler(drive, &idetape_pc_intr,
						IDETAPE_WAIT_CMD, NULL);
L
Linus Torvalds 已提交
886 887
				return ide_started;
			}
888 889
			debug_log(DBG_SENSE, "The tape wants to send us more "
				"data than expected - allowing transfer\n");
L
Linus Torvalds 已提交
890
		}
891 892
		iobuf = &idetape_input_buffers;
		xferfunc = hwif->atapi_input_bytes;
L
Linus Torvalds 已提交
893
	} else {
894 895
		iobuf = &idetape_output_buffers;
		xferfunc = hwif->atapi_output_bytes;
L
Linus Torvalds 已提交
896
	}
897 898 899 900

	if (pc->bh)
		iobuf(drive, pc, bcount);
	else
901
		xferfunc(drive, pc->cur_pos, bcount);
902

L
Linus Torvalds 已提交
903
	/* Update the current position */
904 905
	pc->xferred += bcount;
	pc->cur_pos += bcount;
906 907 908 909

	debug_log(DBG_SENSE, "[cmd %x] transferred %d bytes on that intr.\n",
			pc->c[0], bcount);

L
Linus Torvalds 已提交
910 911 912 913 914 915
	/* And set the interrupt handler again */
	ide_set_handler(drive, &idetape_pc_intr, IDETAPE_WAIT_CMD, NULL);
	return ide_started;
}

/*
916
 * Packet Command Interface
L
Linus Torvalds 已提交
917
 *
918 919 920
 * The current Packet Command is available in tape->pc, and will not change
 * until we finish handling it. Each packet command is associated with a
 * callback function that will be called when the command is finished.
L
Linus Torvalds 已提交
921
 *
922
 * The handling will be done in three stages:
L
Linus Torvalds 已提交
923
 *
924 925
 * 1. idetape_issue_pc will send the packet command to the drive, and will set
 * the interrupt handler to idetape_pc_intr.
L
Linus Torvalds 已提交
926
 *
927 928
 * 2. On each interrupt, idetape_pc_intr will be called. This step will be
 * repeated until the device signals us that no more interrupts will be issued.
L
Linus Torvalds 已提交
929
 *
930 931 932 933 934 935 936
 * 3. ATAPI Tape media access commands have immediate status with a delayed
 * process. In case of a successful initiation of a media access packet command,
 * the DSC bit will be set when the actual execution of the command is finished.
 * Since the tape drive will not issue an interrupt, we have to poll for this
 * event. In this case, we define the request as "low priority request" by
 * setting rq_status to IDETAPE_RQ_POSTPONED, set a timer to poll for DSC and
 * exit the driver.
L
Linus Torvalds 已提交
937
 *
938 939
 * ide.c will then give higher priority to requests which originate from the
 * other device, until will change rq_status to RQ_ACTIVE.
L
Linus Torvalds 已提交
940
 *
941
 * 4. When the packet command is finished, it will be checked for errors.
L
Linus Torvalds 已提交
942
 *
943 944 945
 * 5. In case an error was found, we queue a request sense packet command in
 * front of the request queue and retry the operation up to
 * IDETAPE_MAX_PC_RETRIES times.
L
Linus Torvalds 已提交
946
 *
947 948 949
 * 6. In case no error was found, or we decided to give up and not to retry
 * again, the callback function will be called and then we will handle the next
 * request.
L
Linus Torvalds 已提交
950 951 952 953 954
 */
static ide_startstop_t idetape_transfer_pc(ide_drive_t *drive)
{
	ide_hwif_t *hwif = drive->hwif;
	idetape_tape_t *tape = drive->driver_data;
955
	struct ide_atapi_pc *pc = tape->pc;
L
Linus Torvalds 已提交
956 957
	int retries = 100;
	ide_startstop_t startstop;
958
	u8 ireason;
L
Linus Torvalds 已提交
959

960 961 962
	if (ide_wait_stat(&startstop, drive, DRQ_STAT, BUSY_STAT, WAIT_READY)) {
		printk(KERN_ERR "ide-tape: Strange, packet command initiated "
				"yet DRQ isn't asserted\n");
L
Linus Torvalds 已提交
963 964
		return startstop;
	}
965
	ireason = hwif->INB(hwif->io_ports[IDE_IREASON_OFFSET]);
966
	while (retries-- && ((ireason & CD) == 0 || (ireason & IO))) {
L
Linus Torvalds 已提交
967 968 969
		printk(KERN_ERR "ide-tape: (IO,CoD != (0,1) while issuing "
				"a packet command, retrying\n");
		udelay(100);
970
		ireason = hwif->INB(hwif->io_ports[IDE_IREASON_OFFSET]);
L
Linus Torvalds 已提交
971 972 973
		if (retries == 0) {
			printk(KERN_ERR "ide-tape: (IO,CoD != (0,1) while "
					"issuing a packet command, ignoring\n");
974 975
			ireason |= CD;
			ireason &= ~IO;
L
Linus Torvalds 已提交
976 977
		}
	}
978
	if ((ireason & CD) == 0 || (ireason & IO)) {
L
Linus Torvalds 已提交
979 980 981 982 983 984 985 986
		printk(KERN_ERR "ide-tape: (IO,CoD) != (0,1) while issuing "
				"a packet command\n");
		return ide_do_reset(drive);
	}
	/* Set the interrupt routine */
	ide_set_handler(drive, &idetape_pc_intr, IDETAPE_WAIT_CMD, NULL);
#ifdef CONFIG_BLK_DEV_IDEDMA
	/* Begin DMA, if necessary */
987
	if (pc->flags & PC_FLAG_DMA_IN_PROGRESS)
988
		hwif->dma_ops->dma_start(drive);
L
Linus Torvalds 已提交
989 990 991 992 993 994
#endif
	/* Send the actual packet */
	HWIF(drive)->atapi_output_bytes(drive, pc->c, 12);
	return ide_started;
}

995 996
static ide_startstop_t idetape_issue_pc(ide_drive_t *drive,
		struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
997 998 999 1000
{
	ide_hwif_t *hwif = drive->hwif;
	idetape_tape_t *tape = drive->driver_data;
	int dma_ok = 0;
1001
	u16 bcount;
L
Linus Torvalds 已提交
1002

1003 1004
	if (tape->pc->c[0] == REQUEST_SENSE &&
	    pc->c[0] == REQUEST_SENSE) {
L
Linus Torvalds 已提交
1005 1006 1007 1008
		printk(KERN_ERR "ide-tape: possible ide-tape.c bug - "
			"Two request sense in serial were issued\n");
	}

1009
	if (tape->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
L
Linus Torvalds 已提交
1010 1011 1012 1013 1014
		tape->failed_pc = pc;
	/* Set the current packet command */
	tape->pc = pc;

	if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
1015
		(pc->flags & PC_FLAG_ABORT)) {
L
Linus Torvalds 已提交
1016
		/*
1017 1018 1019
		 * We will "abort" retrying a packet command in case legitimate
		 * error code was received (crossing a filemark, or end of the
		 * media, for example).
L
Linus Torvalds 已提交
1020
		 */
1021
		if (!(pc->flags & PC_FLAG_ABORT)) {
1022
			if (!(pc->c[0] == TEST_UNIT_READY &&
L
Linus Torvalds 已提交
1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035
			      tape->sense_key == 2 && tape->asc == 4 &&
			     (tape->ascq == 1 || tape->ascq == 8))) {
				printk(KERN_ERR "ide-tape: %s: I/O error, "
						"pc = %2x, key = %2x, "
						"asc = %2x, ascq = %2x\n",
						tape->name, pc->c[0],
						tape->sense_key, tape->asc,
						tape->ascq);
			}
			/* Giving up */
			pc->error = IDETAPE_ERROR_GENERAL;
		}
		tape->failed_pc = NULL;
1036
		return pc->idetape_callback(drive);
L
Linus Torvalds 已提交
1037
	}
1038
	debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
L
Linus Torvalds 已提交
1039 1040 1041

	pc->retries++;
	/* We haven't transferred any data yet */
1042 1043
	pc->xferred = 0;
	pc->cur_pos = pc->buf;
L
Linus Torvalds 已提交
1044
	/* Request to transfer the entire buffer at once */
1045
	bcount = pc->req_xfer;
L
Linus Torvalds 已提交
1046

1047 1048
	if (pc->flags & PC_FLAG_DMA_ERROR) {
		pc->flags &= ~PC_FLAG_DMA_ERROR;
L
Linus Torvalds 已提交
1049 1050
		printk(KERN_WARNING "ide-tape: DMA disabled, "
				"reverting to PIO\n");
1051
		ide_dma_off(drive);
L
Linus Torvalds 已提交
1052
	}
1053
	if ((pc->flags & PC_FLAG_DMA_RECOMMENDED) && drive->using_dma)
1054
		dma_ok = !hwif->dma_ops->dma_setup(drive);
L
Linus Torvalds 已提交
1055

1056 1057 1058
	ide_pktcmd_tf_load(drive, IDE_TFLAG_NO_SELECT_MASK |
			   IDE_TFLAG_OUT_DEVICE, bcount, dma_ok);

1059 1060 1061 1062
	if (dma_ok)
		/* Will begin DMA later */
		pc->flags |= PC_FLAG_DMA_IN_PROGRESS;
	if (test_bit(IDETAPE_FLAG_DRQ_INTERRUPT, &tape->flags)) {
1063 1064
		ide_execute_command(drive, WIN_PACKETCMD, &idetape_transfer_pc,
				    IDETAPE_WAIT_CMD, NULL);
L
Linus Torvalds 已提交
1065 1066
		return ide_started;
	} else {
1067
		hwif->OUTB(WIN_PACKETCMD, hwif->io_ports[IDE_COMMAND_OFFSET]);
L
Linus Torvalds 已提交
1068 1069 1070 1071
		return idetape_transfer_pc(drive);
	}
}

1072
static ide_startstop_t idetape_pc_callback(ide_drive_t *drive)
L
Linus Torvalds 已提交
1073 1074
{
	idetape_tape_t *tape = drive->driver_data;
1075 1076

	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1077 1078 1079 1080 1081

	idetape_end_request(drive, tape->pc->error ? 0 : 1, 0);
	return ide_stopped;
}

1082
/* A mode sense command is used to "sense" tape parameters. */
1083
static void idetape_create_mode_sense_cmd(struct ide_atapi_pc *pc, u8 page_code)
L
Linus Torvalds 已提交
1084 1085
{
	idetape_init_pc(pc);
1086
	pc->c[0] = MODE_SENSE;
L
Linus Torvalds 已提交
1087
	if (page_code != IDETAPE_BLOCK_DESCRIPTOR)
1088 1089
		/* DBD = 1 - Don't return block descriptors */
		pc->c[1] = 8;
L
Linus Torvalds 已提交
1090 1091 1092 1093 1094 1095 1096 1097 1098
	pc->c[2] = page_code;
	/*
	 * Changed pc->c[3] to 0 (255 will at best return unused info).
	 *
	 * For SCSI this byte is defined as subpage instead of high byte
	 * of length and some IDE drives seem to interpret it this way
	 * and return an error when 255 is used.
	 */
	pc->c[3] = 0;
1099 1100
	/* We will just discard data in that case */
	pc->c[4] = 255;
L
Linus Torvalds 已提交
1101
	if (page_code == IDETAPE_BLOCK_DESCRIPTOR)
1102
		pc->req_xfer = 12;
L
Linus Torvalds 已提交
1103
	else if (page_code == IDETAPE_CAPABILITIES_PAGE)
1104
		pc->req_xfer = 24;
L
Linus Torvalds 已提交
1105
	else
1106 1107
		pc->req_xfer = 50;
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1108 1109
}

1110
static ide_startstop_t idetape_media_access_finished(ide_drive_t *drive)
L
Linus Torvalds 已提交
1111 1112
{
	idetape_tape_t *tape = drive->driver_data;
1113
	struct ide_atapi_pc *pc = tape->pc;
1114
	u8 stat;
L
Linus Torvalds 已提交
1115

1116 1117
	stat = ide_read_status(drive);

1118 1119
	if (stat & SEEK_STAT) {
		if (stat & ERR_STAT) {
L
Linus Torvalds 已提交
1120
			/* Error detected */
1121
			if (pc->c[0] != TEST_UNIT_READY)
L
Linus Torvalds 已提交
1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
				printk(KERN_ERR "ide-tape: %s: I/O error, ",
						tape->name);
			/* Retry operation */
			return idetape_retry_pc(drive);
		}
		pc->error = 0;
		if (tape->failed_pc == pc)
			tape->failed_pc = NULL;
	} else {
		pc->error = IDETAPE_ERROR_GENERAL;
		tape->failed_pc = NULL;
	}
1134
	return pc->idetape_callback(drive);
L
Linus Torvalds 已提交
1135 1136
}

1137
static ide_startstop_t idetape_rw_callback(ide_drive_t *drive)
L
Linus Torvalds 已提交
1138 1139 1140
{
	idetape_tape_t *tape = drive->driver_data;
	struct request *rq = HWGROUP(drive)->rq;
1141
	int blocks = tape->pc->xferred / tape->blk_size;
L
Linus Torvalds 已提交
1142

1143
	tape->avg_size += blocks * tape->blk_size;
1144

1145
	if (time_after_eq(jiffies, tape->avg_time + HZ)) {
1146 1147
		tape->avg_speed = tape->avg_size * HZ /
				(jiffies - tape->avg_time) / 1024;
L
Linus Torvalds 已提交
1148 1149 1150
		tape->avg_size = 0;
		tape->avg_time = jiffies;
	}
1151
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1152

1153
	tape->first_frame += blocks;
L
Linus Torvalds 已提交
1154 1155 1156 1157 1158 1159 1160 1161 1162
	rq->current_nr_sectors -= blocks;

	if (!tape->pc->error)
		idetape_end_request(drive, 1, 0);
	else
		idetape_end_request(drive, tape->pc->error, 0);
	return ide_stopped;
}

1163 1164
static void idetape_create_read_cmd(idetape_tape_t *tape,
		struct ide_atapi_pc *pc,
1165
		unsigned int length, struct idetape_bh *bh)
L
Linus Torvalds 已提交
1166 1167
{
	idetape_init_pc(pc);
1168
	pc->c[0] = READ_6;
1169
	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1170
	pc->c[1] = 1;
1171
	pc->idetape_callback = &idetape_rw_callback;
L
Linus Torvalds 已提交
1172 1173
	pc->bh = bh;
	atomic_set(&bh->b_count, 0);
1174 1175 1176 1177
	pc->buf = NULL;
	pc->buf_size = length * tape->blk_size;
	pc->req_xfer = pc->buf_size;
	if (pc->req_xfer == tape->stage_size)
1178
		pc->flags |= PC_FLAG_DMA_RECOMMENDED;
L
Linus Torvalds 已提交
1179 1180
}

1181 1182
static void idetape_create_write_cmd(idetape_tape_t *tape,
		struct ide_atapi_pc *pc,
1183
		unsigned int length, struct idetape_bh *bh)
L
Linus Torvalds 已提交
1184 1185
{
	idetape_init_pc(pc);
1186
	pc->c[0] = WRITE_6;
1187
	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1188
	pc->c[1] = 1;
1189
	pc->idetape_callback = &idetape_rw_callback;
1190
	pc->flags |= PC_FLAG_WRITING;
L
Linus Torvalds 已提交
1191 1192 1193
	pc->bh = bh;
	pc->b_data = bh->b_data;
	pc->b_count = atomic_read(&bh->b_count);
1194 1195 1196 1197
	pc->buf = NULL;
	pc->buf_size = length * tape->blk_size;
	pc->req_xfer = pc->buf_size;
	if (pc->req_xfer == tape->stage_size)
1198
		pc->flags |= PC_FLAG_DMA_RECOMMENDED;
L
Linus Torvalds 已提交
1199 1200 1201 1202 1203 1204
}

static ide_startstop_t idetape_do_request(ide_drive_t *drive,
					  struct request *rq, sector_t block)
{
	idetape_tape_t *tape = drive->driver_data;
1205
	struct ide_atapi_pc *pc = NULL;
L
Linus Torvalds 已提交
1206
	struct request *postponed_rq = tape->postponed_rq;
1207
	u8 stat;
L
Linus Torvalds 已提交
1208

1209 1210
	debug_log(DBG_SENSE, "sector: %ld, nr_sectors: %ld,"
			" current_nr_sectors: %d\n",
L
Linus Torvalds 已提交
1211 1212
			rq->sector, rq->nr_sectors, rq->current_nr_sectors);

1213
	if (!blk_special_request(rq)) {
1214
		/* We do not support buffer cache originated requests. */
L
Linus Torvalds 已提交
1215
		printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
1216
			"request queue (%d)\n", drive->name, rq->cmd_type);
L
Linus Torvalds 已提交
1217 1218 1219 1220
		ide_end_request(drive, 0, 0);
		return ide_stopped;
	}

1221
	/* Retry a failed packet command */
1222
	if (tape->failed_pc && tape->pc->c[0] == REQUEST_SENSE)
1223
		return idetape_issue_pc(drive, tape->failed_pc);
1224

L
Linus Torvalds 已提交
1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238
	if (postponed_rq != NULL)
		if (rq != postponed_rq) {
			printk(KERN_ERR "ide-tape: ide-tape.c bug - "
					"Two DSC requests were queued\n");
			idetape_end_request(drive, 0, 0);
			return ide_stopped;
		}

	tape->postponed_rq = NULL;

	/*
	 * If the tape is still busy, postpone our request and service
	 * the other device meanwhile.
	 */
1239
	stat = ide_read_status(drive);
L
Linus Torvalds 已提交
1240 1241

	if (!drive->dsc_overlap && !(rq->cmd[0] & REQ_IDETAPE_PC2))
1242
		set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
L
Linus Torvalds 已提交
1243 1244

	if (drive->post_reset == 1) {
1245
		set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
L
Linus Torvalds 已提交
1246 1247 1248
		drive->post_reset = 0;
	}

1249
	if (!test_and_clear_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags) &&
1250
	    (stat & SEEK_STAT) == 0) {
L
Linus Torvalds 已提交
1251 1252
		if (postponed_rq == NULL) {
			tape->dsc_polling_start = jiffies;
1253
			tape->dsc_poll_freq = tape->best_dsc_rw_freq;
L
Linus Torvalds 已提交
1254 1255 1256 1257 1258 1259 1260 1261 1262 1263
			tape->dsc_timeout = jiffies + IDETAPE_DSC_RW_TIMEOUT;
		} else if (time_after(jiffies, tape->dsc_timeout)) {
			printk(KERN_ERR "ide-tape: %s: DSC timeout\n",
				tape->name);
			if (rq->cmd[0] & REQ_IDETAPE_PC2) {
				idetape_media_access_finished(drive);
				return ide_stopped;
			} else {
				return ide_do_reset(drive);
			}
1264 1265 1266
		} else if (time_after(jiffies,
					tape->dsc_polling_start +
					IDETAPE_DSC_MA_THRESHOLD))
1267
			tape->dsc_poll_freq = IDETAPE_DSC_MA_SLOW;
L
Linus Torvalds 已提交
1268 1269 1270 1271 1272
		idetape_postpone_request(drive);
		return ide_stopped;
	}
	if (rq->cmd[0] & REQ_IDETAPE_READ) {
		pc = idetape_next_pc_storage(drive);
1273 1274
		idetape_create_read_cmd(tape, pc, rq->current_nr_sectors,
					(struct idetape_bh *)rq->special);
L
Linus Torvalds 已提交
1275 1276 1277 1278
		goto out;
	}
	if (rq->cmd[0] & REQ_IDETAPE_WRITE) {
		pc = idetape_next_pc_storage(drive);
1279 1280
		idetape_create_write_cmd(tape, pc, rq->current_nr_sectors,
					 (struct idetape_bh *)rq->special);
L
Linus Torvalds 已提交
1281 1282 1283
		goto out;
	}
	if (rq->cmd[0] & REQ_IDETAPE_PC1) {
1284
		pc = (struct ide_atapi_pc *) rq->buffer;
L
Linus Torvalds 已提交
1285 1286 1287 1288 1289 1290 1291 1292 1293 1294
		rq->cmd[0] &= ~(REQ_IDETAPE_PC1);
		rq->cmd[0] |= REQ_IDETAPE_PC2;
		goto out;
	}
	if (rq->cmd[0] & REQ_IDETAPE_PC2) {
		idetape_media_access_finished(drive);
		return ide_stopped;
	}
	BUG();
out:
1295
	return idetape_issue_pc(drive, pc);
L
Linus Torvalds 已提交
1296 1297
}

1298
/* Pipeline related functions */
L
Linus Torvalds 已提交
1299 1300

/*
1301 1302 1303 1304
 * The function below uses __get_free_page to allocate a pipeline stage, along
 * with all the necessary small buffers which together make a buffer of size
 * tape->stage_size (or a bit more). We attempt to combine sequential pages as
 * much as possible.
L
Linus Torvalds 已提交
1305
 *
1306 1307
 * It returns a pointer to the new allocated stage, or NULL if we can't (or
 * don't want to) allocate a stage.
L
Linus Torvalds 已提交
1308
 *
1309 1310
 * Pipeline stages are optional and are used to increase performance. If we
 * can't allocate them, we'll manage without them.
L
Linus Torvalds 已提交
1311
 */
1312 1313
static idetape_stage_t *__idetape_kmalloc_stage(idetape_tape_t *tape, int full,
						int clear)
L
Linus Torvalds 已提交
1314 1315 1316 1317 1318 1319
{
	idetape_stage_t *stage;
	struct idetape_bh *prev_bh, *bh;
	int pages = tape->pages_per_stage;
	char *b_data = NULL;

1320 1321
	stage = kmalloc(sizeof(idetape_stage_t), GFP_KERNEL);
	if (!stage)
L
Linus Torvalds 已提交
1322 1323 1324
		return NULL;
	stage->next = NULL;

1325 1326
	stage->bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
	bh = stage->bh;
L
Linus Torvalds 已提交
1327 1328 1329
	if (bh == NULL)
		goto abort;
	bh->b_reqnext = NULL;
1330 1331
	bh->b_data = (char *) __get_free_page(GFP_KERNEL);
	if (!bh->b_data)
L
Linus Torvalds 已提交
1332 1333 1334 1335 1336 1337 1338
		goto abort;
	if (clear)
		memset(bh->b_data, 0, PAGE_SIZE);
	bh->b_size = PAGE_SIZE;
	atomic_set(&bh->b_count, full ? bh->b_size : 0);

	while (--pages) {
1339 1340
		b_data = (char *) __get_free_page(GFP_KERNEL);
		if (!b_data)
L
Linus Torvalds 已提交
1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357
			goto abort;
		if (clear)
			memset(b_data, 0, PAGE_SIZE);
		if (bh->b_data == b_data + PAGE_SIZE) {
			bh->b_size += PAGE_SIZE;
			bh->b_data -= PAGE_SIZE;
			if (full)
				atomic_add(PAGE_SIZE, &bh->b_count);
			continue;
		}
		if (b_data == bh->b_data + bh->b_size) {
			bh->b_size += PAGE_SIZE;
			if (full)
				atomic_add(PAGE_SIZE, &bh->b_count);
			continue;
		}
		prev_bh = bh;
1358 1359
		bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
		if (!bh) {
L
Linus Torvalds 已提交
1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377
			free_page((unsigned long) b_data);
			goto abort;
		}
		bh->b_reqnext = NULL;
		bh->b_data = b_data;
		bh->b_size = PAGE_SIZE;
		atomic_set(&bh->b_count, full ? bh->b_size : 0);
		prev_bh->b_reqnext = bh;
	}
	bh->b_size -= tape->excess_bh_size;
	if (full)
		atomic_sub(tape->excess_bh_size, &bh->b_count);
	return stage;
abort:
	__idetape_kfree_stage(stage);
	return NULL;
}

1378
static int idetape_copy_stage_from_user(idetape_tape_t *tape,
1379
					const char __user *buf, int n)
L
Linus Torvalds 已提交
1380 1381 1382
{
	struct idetape_bh *bh = tape->bh;
	int count;
1383
	int ret = 0;
L
Linus Torvalds 已提交
1384 1385 1386

	while (n) {
		if (bh == NULL) {
1387 1388
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
1389
			return 1;
L
Linus Torvalds 已提交
1390
		}
1391 1392 1393 1394 1395
		count = min((unsigned int)
				(bh->b_size - atomic_read(&bh->b_count)),
				(unsigned int)n);
		if (copy_from_user(bh->b_data + atomic_read(&bh->b_count), buf,
				count))
1396
			ret = 1;
L
Linus Torvalds 已提交
1397 1398 1399 1400 1401 1402 1403 1404 1405 1406
		n -= count;
		atomic_add(count, &bh->b_count);
		buf += count;
		if (atomic_read(&bh->b_count) == bh->b_size) {
			bh = bh->b_reqnext;
			if (bh)
				atomic_set(&bh->b_count, 0);
		}
	}
	tape->bh = bh;
1407
	return ret;
L
Linus Torvalds 已提交
1408 1409
}

1410
static int idetape_copy_stage_to_user(idetape_tape_t *tape, char __user *buf,
1411
				      int n)
L
Linus Torvalds 已提交
1412 1413 1414
{
	struct idetape_bh *bh = tape->bh;
	int count;
1415
	int ret = 0;
L
Linus Torvalds 已提交
1416 1417 1418

	while (n) {
		if (bh == NULL) {
1419 1420
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
1421
			return 1;
L
Linus Torvalds 已提交
1422 1423
		}
		count = min(tape->b_count, n);
1424 1425
		if  (copy_to_user(buf, tape->b_data, count))
			ret = 1;
L
Linus Torvalds 已提交
1426 1427 1428 1429 1430
		n -= count;
		tape->b_data += count;
		tape->b_count -= count;
		buf += count;
		if (!tape->b_count) {
1431 1432
			bh = bh->b_reqnext;
			tape->bh = bh;
L
Linus Torvalds 已提交
1433 1434 1435 1436 1437 1438
			if (bh) {
				tape->b_data = bh->b_data;
				tape->b_count = atomic_read(&bh->b_count);
			}
		}
	}
1439
	return ret;
L
Linus Torvalds 已提交
1440 1441
}

1442
static void idetape_init_merge_stage(idetape_tape_t *tape)
L
Linus Torvalds 已提交
1443 1444
{
	struct idetape_bh *bh = tape->merge_stage->bh;
1445

L
Linus Torvalds 已提交
1446
	tape->bh = bh;
1447
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
L
Linus Torvalds 已提交
1448 1449 1450 1451 1452 1453 1454
		atomic_set(&bh->b_count, 0);
	else {
		tape->b_data = bh->b_data;
		tape->b_count = atomic_read(&bh->b_count);
	}
}

1455
static ide_startstop_t idetape_read_position_callback(ide_drive_t *drive)
L
Linus Torvalds 已提交
1456 1457
{
	idetape_tape_t *tape = drive->driver_data;
1458
	u8 *readpos = tape->pc->buf;
1459 1460

	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1461 1462

	if (!tape->pc->error) {
1463 1464 1465 1466 1467 1468 1469 1470
		debug_log(DBG_SENSE, "BOP - %s\n",
				(readpos[0] & 0x80) ? "Yes" : "No");
		debug_log(DBG_SENSE, "EOP - %s\n",
				(readpos[0] & 0x40) ? "Yes" : "No");

		if (readpos[0] & 0x4) {
			printk(KERN_INFO "ide-tape: Block location is unknown"
					 "to the tape\n");
1471
			clear_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags);
L
Linus Torvalds 已提交
1472 1473
			idetape_end_request(drive, 0, 0);
		} else {
1474
			debug_log(DBG_SENSE, "Block Location - %u\n",
1475 1476 1477
					be32_to_cpu(*(u32 *)&readpos[4]));

			tape->partition = readpos[1];
1478
			tape->first_frame =
1479
				be32_to_cpu(*(u32 *)&readpos[4]);
1480
			set_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags);
L
Linus Torvalds 已提交
1481 1482 1483 1484 1485 1486 1487 1488 1489
			idetape_end_request(drive, 1, 0);
		}
	} else {
		idetape_end_request(drive, 0, 0);
	}
	return ide_stopped;
}

/*
1490 1491
 * Write a filemark if write_filemark=1. Flush the device buffers without
 * writing a filemark otherwise.
L
Linus Torvalds 已提交
1492
 */
1493
static void idetape_create_write_filemark_cmd(ide_drive_t *drive,
1494
		struct ide_atapi_pc *pc, int write_filemark)
L
Linus Torvalds 已提交
1495 1496
{
	idetape_init_pc(pc);
1497
	pc->c[0] = WRITE_FILEMARKS;
L
Linus Torvalds 已提交
1498
	pc->c[4] = write_filemark;
1499
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1500
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1501 1502
}

1503
static void idetape_create_test_unit_ready_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1504 1505
{
	idetape_init_pc(pc);
1506
	pc->c[0] = TEST_UNIT_READY;
1507
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1508 1509 1510
}

/*
1511 1512 1513 1514 1515 1516
 * We add a special packet command request to the tail of the request queue, and
 * wait for it to be serviced. This is not to be called from within the request
 * handling part of the driver! We allocate here data on the stack and it is
 * valid until the request is finished. This is not the case for the bottom part
 * of the driver, where we are always leaving the functions to wait for an
 * interrupt or a timer event.
L
Linus Torvalds 已提交
1517
 *
1518 1519 1520 1521
 * From the bottom part of the driver, we should allocate safe memory using
 * idetape_next_pc_storage() and ide_tape_next_rq_storage(), and add the request
 * to the request list without waiting for it to be serviced! In that case, we
 * usually use idetape_queue_pc_head().
L
Linus Torvalds 已提交
1522
 */
1523
static int idetape_queue_pc_tail(ide_drive_t *drive, struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1524 1525 1526 1527 1528 1529 1530 1531 1532 1533
{
	struct ide_tape_obj *tape = drive->driver_data;
	struct request rq;

	idetape_init_rq(&rq, REQ_IDETAPE_PC1);
	rq.buffer = (char *) pc;
	rq.rq_disk = tape->disk;
	return ide_do_drive_cmd(drive, &rq, ide_wait);
}

1534 1535
static void idetape_create_load_unload_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc, int cmd)
L
Linus Torvalds 已提交
1536 1537
{
	idetape_init_pc(pc);
1538
	pc->c[0] = START_STOP;
L
Linus Torvalds 已提交
1539
	pc->c[4] = cmd;
1540
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1541
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1542 1543 1544 1545 1546
}

static int idetape_wait_ready(ide_drive_t *drive, unsigned long timeout)
{
	idetape_tape_t *tape = drive->driver_data;
1547
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1548 1549
	int load_attempted = 0;

1550
	/* Wait for the tape to become ready */
1551
	set_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags);
L
Linus Torvalds 已提交
1552 1553 1554
	timeout += jiffies;
	while (time_before(jiffies, timeout)) {
		idetape_create_test_unit_ready_cmd(&pc);
1555
		if (!idetape_queue_pc_tail(drive, &pc))
L
Linus Torvalds 已提交
1556 1557
			return 0;
		if ((tape->sense_key == 2 && tape->asc == 4 && tape->ascq == 2)
1558 1559
		    || (tape->asc == 0x3A)) {
			/* no media */
L
Linus Torvalds 已提交
1560 1561
			if (load_attempted)
				return -ENOMEDIUM;
1562 1563
			idetape_create_load_unload_cmd(drive, &pc,
							IDETAPE_LU_LOAD_MASK);
1564
			idetape_queue_pc_tail(drive, &pc);
L
Linus Torvalds 已提交
1565 1566 1567 1568 1569
			load_attempted = 1;
		/* not about to be ready */
		} else if (!(tape->sense_key == 2 && tape->asc == 4 &&
			     (tape->ascq == 1 || tape->ascq == 8)))
			return -EIO;
1570
		msleep(100);
L
Linus Torvalds 已提交
1571 1572 1573 1574
	}
	return -EIO;
}

1575
static int idetape_flush_tape_buffers(ide_drive_t *drive)
L
Linus Torvalds 已提交
1576
{
1577
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1578 1579 1580
	int rc;

	idetape_create_write_filemark_cmd(drive, &pc, 0);
1581 1582
	rc = idetape_queue_pc_tail(drive, &pc);
	if (rc)
L
Linus Torvalds 已提交
1583 1584 1585 1586 1587
		return rc;
	idetape_wait_ready(drive, 60 * 5 * HZ);
	return 0;
}

1588
static void idetape_create_read_position_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1589 1590
{
	idetape_init_pc(pc);
1591
	pc->c[0] = READ_POSITION;
1592 1593
	pc->req_xfer = 20;
	pc->idetape_callback = &idetape_read_position_callback;
L
Linus Torvalds 已提交
1594 1595
}

1596
static int idetape_read_position(ide_drive_t *drive)
L
Linus Torvalds 已提交
1597 1598
{
	idetape_tape_t *tape = drive->driver_data;
1599
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1600 1601
	int position;

1602
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1603 1604 1605 1606

	idetape_create_read_position_cmd(&pc);
	if (idetape_queue_pc_tail(drive, &pc))
		return -1;
1607
	position = tape->first_frame;
L
Linus Torvalds 已提交
1608 1609 1610
	return position;
}

1611 1612
static void idetape_create_locate_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc,
1613
		unsigned int block, u8 partition, int skip)
L
Linus Torvalds 已提交
1614 1615
{
	idetape_init_pc(pc);
1616
	pc->c[0] = POSITION_TO_ELEMENT;
L
Linus Torvalds 已提交
1617
	pc->c[1] = 2;
1618
	put_unaligned(cpu_to_be32(block), (unsigned int *) &pc->c[3]);
L
Linus Torvalds 已提交
1619
	pc->c[8] = partition;
1620
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1621
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1622 1623
}

1624 1625
static int idetape_create_prevent_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc, int prevent)
L
Linus Torvalds 已提交
1626 1627 1628
{
	idetape_tape_t *tape = drive->driver_data;

1629 1630
	/* device supports locking according to capabilities page */
	if (!(tape->caps[6] & 0x01))
L
Linus Torvalds 已提交
1631 1632 1633
		return 0;

	idetape_init_pc(pc);
1634
	pc->c[0] = ALLOW_MEDIUM_REMOVAL;
L
Linus Torvalds 已提交
1635
	pc->c[4] = prevent;
1636
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1637 1638 1639
	return 1;
}

1640
static int __idetape_discard_read_pipeline(ide_drive_t *drive)
L
Linus Torvalds 已提交
1641 1642 1643
{
	idetape_tape_t *tape = drive->driver_data;

1644
	if (tape->chrdev_dir != IDETAPE_DIR_READ)
L
Linus Torvalds 已提交
1645 1646
		return 0;

1647
	clear_bit(IDETAPE_FLAG_FILEMARK, &tape->flags);
L
Linus Torvalds 已提交
1648 1649 1650 1651 1652 1653
	tape->merge_stage_size = 0;
	if (tape->merge_stage != NULL) {
		__idetape_kfree_stage(tape->merge_stage);
		tape->merge_stage = NULL;
	}

1654
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1655

1656
	return 0;
L
Linus Torvalds 已提交
1657 1658 1659
}

/*
1660 1661 1662 1663
 * Position the tape to the requested block using the LOCATE packet command.
 * A READ POSITION command is then issued to check where we are positioned. Like
 * all higher level operations, we queue the commands at the tail of the request
 * queue and wait for their completion.
L
Linus Torvalds 已提交
1664
 */
1665 1666
static int idetape_position_tape(ide_drive_t *drive, unsigned int block,
		u8 partition, int skip)
L
Linus Torvalds 已提交
1667 1668 1669
{
	idetape_tape_t *tape = drive->driver_data;
	int retval;
1670
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1671

1672
	if (tape->chrdev_dir == IDETAPE_DIR_READ)
L
Linus Torvalds 已提交
1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683
		__idetape_discard_read_pipeline(drive);
	idetape_wait_ready(drive, 60 * 5 * HZ);
	idetape_create_locate_cmd(drive, &pc, block, partition, skip);
	retval = idetape_queue_pc_tail(drive, &pc);
	if (retval)
		return (retval);

	idetape_create_read_position_cmd(&pc);
	return (idetape_queue_pc_tail(drive, &pc));
}

1684 1685
static void idetape_discard_read_pipeline(ide_drive_t *drive,
					  int restore_position)
L
Linus Torvalds 已提交
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695
{
	idetape_tape_t *tape = drive->driver_data;
	int cnt;
	int seek, position;

	cnt = __idetape_discard_read_pipeline(drive);
	if (restore_position) {
		position = idetape_read_position(drive);
		seek = position > cnt ? position - cnt : 0;
		if (idetape_position_tape(drive, seek, 0, 0)) {
1696 1697
			printk(KERN_INFO "ide-tape: %s: position_tape failed in"
					 " discard_pipeline()\n", tape->name);
L
Linus Torvalds 已提交
1698 1699 1700 1701 1702 1703
			return;
		}
	}
}

/*
1704 1705
 * Generate a read/write request for the block device interface and wait for it
 * to be serviced.
L
Linus Torvalds 已提交
1706
 */
1707 1708
static int idetape_queue_rw_tail(ide_drive_t *drive, int cmd, int blocks,
				 struct idetape_bh *bh)
L
Linus Torvalds 已提交
1709 1710 1711 1712
{
	idetape_tape_t *tape = drive->driver_data;
	struct request rq;

1713 1714
	debug_log(DBG_SENSE, "%s: cmd=%d\n", __func__, cmd);

L
Linus Torvalds 已提交
1715 1716 1717
	idetape_init_rq(&rq, cmd);
	rq.rq_disk = tape->disk;
	rq.special = (void *)bh;
1718
	rq.sector = tape->first_frame;
1719 1720
	rq.nr_sectors		= blocks;
	rq.current_nr_sectors	= blocks;
L
Linus Torvalds 已提交
1721 1722 1723 1724 1725 1726 1727 1728 1729
	(void) ide_do_drive_cmd(drive, &rq, ide_wait);

	if ((cmd & (REQ_IDETAPE_READ | REQ_IDETAPE_WRITE)) == 0)
		return 0;

	if (tape->merge_stage)
		idetape_init_merge_stage(tape);
	if (rq.errors == IDETAPE_ERROR_GENERAL)
		return -EIO;
1730
	return (tape->blk_size * (blocks-rq.current_nr_sectors));
L
Linus Torvalds 已提交
1731 1732
}

1733
static void idetape_create_inquiry_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1734 1735
{
	idetape_init_pc(pc);
1736
	pc->c[0] = INQUIRY;
1737
	pc->c[4] = 254;
1738 1739
	pc->req_xfer = 254;
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1740 1741
}

1742 1743
static void idetape_create_rewind_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1744 1745
{
	idetape_init_pc(pc);
1746
	pc->c[0] = REZERO_UNIT;
1747
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1748
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1749 1750
}

1751
static void idetape_create_erase_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1752 1753
{
	idetape_init_pc(pc);
1754
	pc->c[0] = ERASE;
L
Linus Torvalds 已提交
1755
	pc->c[1] = 1;
1756
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1757
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1758 1759
}

1760
static void idetape_create_space_cmd(struct ide_atapi_pc *pc, int count, u8 cmd)
L
Linus Torvalds 已提交
1761 1762
{
	idetape_init_pc(pc);
1763
	pc->c[0] = SPACE;
1764
	put_unaligned(cpu_to_be32(count), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1765
	pc->c[1] = cmd;
1766
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
1767
	pc->idetape_callback = &idetape_pc_callback;
L
Linus Torvalds 已提交
1768 1769
}

1770
/* Queue up a character device originated write request. */
1771
static int idetape_add_chrdev_write_request(ide_drive_t *drive, int blocks)
L
Linus Torvalds 已提交
1772 1773 1774
{
	idetape_tape_t *tape = drive->driver_data;

1775
	debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1776

1777 1778
	return idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE,
				     blocks, tape->merge_stage->bh);
L
Linus Torvalds 已提交
1779 1780
}

1781
static void idetape_empty_write_pipeline(ide_drive_t *drive)
L
Linus Torvalds 已提交
1782 1783 1784 1785
{
	idetape_tape_t *tape = drive->driver_data;
	int blocks, min;
	struct idetape_bh *bh;
1786

1787
	if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
1788 1789
		printk(KERN_ERR "ide-tape: bug: Trying to empty write pipeline,"
				" but we are not writing.\n");
L
Linus Torvalds 已提交
1790 1791 1792 1793 1794 1795 1796
		return;
	}
	if (tape->merge_stage_size > tape->stage_size) {
		printk(KERN_ERR "ide-tape: bug: merge_buffer too big\n");
		tape->merge_stage_size = tape->stage_size;
	}
	if (tape->merge_stage_size) {
1797 1798
		blocks = tape->merge_stage_size / tape->blk_size;
		if (tape->merge_stage_size % tape->blk_size) {
L
Linus Torvalds 已提交
1799 1800 1801
			unsigned int i;

			blocks++;
1802 1803
			i = tape->blk_size - tape->merge_stage_size %
				tape->blk_size;
L
Linus Torvalds 已提交
1804 1805 1806 1807 1808 1809 1810 1811
			bh = tape->bh->b_reqnext;
			while (bh) {
				atomic_set(&bh->b_count, 0);
				bh = bh->b_reqnext;
			}
			bh = tape->bh;
			while (i) {
				if (bh == NULL) {
1812 1813
					printk(KERN_INFO "ide-tape: bug,"
							 " bh NULL\n");
L
Linus Torvalds 已提交
1814 1815
					break;
				}
1816 1817 1818 1819
				min = min(i, (unsigned int)(bh->b_size -
						atomic_read(&bh->b_count)));
				memset(bh->b_data + atomic_read(&bh->b_count),
						0, min);
L
Linus Torvalds 已提交
1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831
				atomic_add(min, &bh->b_count);
				i -= min;
				bh = bh->b_reqnext;
			}
		}
		(void) idetape_add_chrdev_write_request(drive, blocks);
		tape->merge_stage_size = 0;
	}
	if (tape->merge_stage != NULL) {
		__idetape_kfree_stage(tape->merge_stage);
		tape->merge_stage = NULL;
	}
1832
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1833 1834
}

1835
static int idetape_init_read(ide_drive_t *drive)
L
Linus Torvalds 已提交
1836 1837 1838 1839 1840
{
	idetape_tape_t *tape = drive->driver_data;
	int bytes_read;

	/* Initialize read operation */
1841 1842
	if (tape->chrdev_dir != IDETAPE_DIR_READ) {
		if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
L
Linus Torvalds 已提交
1843 1844 1845 1846
			idetape_empty_write_pipeline(drive);
			idetape_flush_tape_buffers(drive);
		}
		if (tape->merge_stage || tape->merge_stage_size) {
1847 1848
			printk(KERN_ERR "ide-tape: merge_stage_size should be"
					 " 0 now\n");
L
Linus Torvalds 已提交
1849 1850
			tape->merge_stage_size = 0;
		}
1851 1852
		tape->merge_stage = __idetape_kmalloc_stage(tape, 0, 0);
		if (!tape->merge_stage)
L
Linus Torvalds 已提交
1853
			return -ENOMEM;
1854
		tape->chrdev_dir = IDETAPE_DIR_READ;
L
Linus Torvalds 已提交
1855 1856

		/*
1857 1858 1859 1860
		 * Issue a read 0 command to ensure that DSC handshake is
		 * switched from completion mode to buffer available mode.
		 * No point in issuing this if DSC overlap isn't supported, some
		 * drives (Seagate STT3401A) will return an error.
L
Linus Torvalds 已提交
1861 1862
		 */
		if (drive->dsc_overlap) {
1863 1864 1865
			bytes_read = idetape_queue_rw_tail(drive,
							REQ_IDETAPE_READ, 0,
							tape->merge_stage->bh);
L
Linus Torvalds 已提交
1866 1867 1868
			if (bytes_read < 0) {
				__idetape_kfree_stage(tape->merge_stage);
				tape->merge_stage = NULL;
1869
				tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1870 1871 1872 1873
				return bytes_read;
			}
		}
	}
1874

L
Linus Torvalds 已提交
1875 1876 1877 1878
	return 0;
}

/*
1879 1880
 * Called from idetape_chrdev_read() to service a character device read request
 * and add read-ahead requests to our pipeline.
L
Linus Torvalds 已提交
1881
 */
1882
static int idetape_add_chrdev_read_request(ide_drive_t *drive, int blocks)
L
Linus Torvalds 已提交
1883 1884 1885
{
	idetape_tape_t *tape = drive->driver_data;

1886
	debug_log(DBG_PROCS, "Enter %s, %d blocks\n", __func__, blocks);
L
Linus Torvalds 已提交
1887

1888
	/* If we are at a filemark, return a read length of 0 */
1889
	if (test_bit(IDETAPE_FLAG_FILEMARK, &tape->flags))
L
Linus Torvalds 已提交
1890 1891
		return 0;

1892
	idetape_init_read(drive);
1893 1894 1895

	return idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, blocks,
				     tape->merge_stage->bh);
L
Linus Torvalds 已提交
1896 1897
}

1898
static void idetape_pad_zeros(ide_drive_t *drive, int bcount)
L
Linus Torvalds 已提交
1899 1900 1901 1902
{
	idetape_tape_t *tape = drive->driver_data;
	struct idetape_bh *bh;
	int blocks;
1903

L
Linus Torvalds 已提交
1904 1905 1906 1907 1908 1909
	while (bcount) {
		unsigned int count;

		bh = tape->merge_stage->bh;
		count = min(tape->stage_size, bcount);
		bcount -= count;
1910
		blocks = count / tape->blk_size;
L
Linus Torvalds 已提交
1911
		while (count) {
1912 1913
			atomic_set(&bh->b_count,
				   min(count, (unsigned int)bh->b_size));
L
Linus Torvalds 已提交
1914 1915 1916 1917
			memset(bh->b_data, 0, atomic_read(&bh->b_count));
			count -= atomic_read(&bh->b_count);
			bh = bh->b_reqnext;
		}
1918 1919
		idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks,
				      tape->merge_stage->bh);
L
Linus Torvalds 已提交
1920 1921 1922 1923
	}
}

/*
1924 1925 1926
 * Rewinds the tape to the Beginning Of the current Partition (BOP). We
 * currently support only one partition.
 */
1927
static int idetape_rewind_tape(ide_drive_t *drive)
L
Linus Torvalds 已提交
1928 1929
{
	int retval;
1930
	struct ide_atapi_pc pc;
1931 1932 1933 1934 1935
	idetape_tape_t *tape;
	tape = drive->driver_data;

	debug_log(DBG_SENSE, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947
	idetape_create_rewind_cmd(drive, &pc);
	retval = idetape_queue_pc_tail(drive, &pc);
	if (retval)
		return retval;

	idetape_create_read_position_cmd(&pc);
	retval = idetape_queue_pc_tail(drive, &pc);
	if (retval)
		return retval;
	return 0;
}

1948
/* mtio.h compatible commands should be issued to the chrdev interface. */
1949 1950
static int idetape_blkdev_ioctl(ide_drive_t *drive, unsigned int cmd,
				unsigned long arg)
L
Linus Torvalds 已提交
1951 1952 1953 1954
{
	idetape_tape_t *tape = drive->driver_data;
	void __user *argp = (void __user *)arg;

1955 1956 1957 1958 1959 1960
	struct idetape_config {
		int dsc_rw_frequency;
		int dsc_media_access_frequency;
		int nr_stages;
	} config;

1961 1962
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
1963
	switch (cmd) {
1964 1965 1966 1967 1968 1969 1970
	case 0x0340:
		if (copy_from_user(&config, argp, sizeof(config)))
			return -EFAULT;
		tape->best_dsc_rw_freq = config.dsc_rw_frequency;
		break;
	case 0x0350:
		config.dsc_rw_frequency = (int) tape->best_dsc_rw_freq;
1971
		config.nr_stages = 1;
1972 1973 1974 1975 1976
		if (copy_to_user(argp, &config, sizeof(config)))
			return -EFAULT;
		break;
	default:
		return -EIO;
L
Linus Torvalds 已提交
1977 1978 1979 1980
	}
	return 0;
}

1981 1982
static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op,
					int mt_count)
L
Linus Torvalds 已提交
1983 1984
{
	idetape_tape_t *tape = drive->driver_data;
1985
	struct ide_atapi_pc pc;
1986
	int retval, count = 0;
1987
	int sprev = !!(tape->caps[4] & 0x20);
L
Linus Torvalds 已提交
1988 1989 1990 1991

	if (mt_count == 0)
		return 0;
	if (MTBSF == mt_op || MTBSFM == mt_op) {
1992
		if (!sprev)
L
Linus Torvalds 已提交
1993
			return -EIO;
1994
		mt_count = -mt_count;
L
Linus Torvalds 已提交
1995 1996
	}

1997
	if (tape->chrdev_dir == IDETAPE_DIR_READ) {
L
Linus Torvalds 已提交
1998
		tape->merge_stage_size = 0;
1999
		if (test_and_clear_bit(IDETAPE_FLAG_FILEMARK, &tape->flags))
L
Linus Torvalds 已提交
2000 2001 2002 2003 2004
			++count;
		idetape_discard_read_pipeline(drive, 0);
	}

	/*
2005 2006
	 * The filemark was not found in our internal pipeline;	now we can issue
	 * the space command.
L
Linus Torvalds 已提交
2007 2008
	 */
	switch (mt_op) {
2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027
	case MTFSF:
	case MTBSF:
		idetape_create_space_cmd(&pc, mt_count - count,
					 IDETAPE_SPACE_OVER_FILEMARK);
		return idetape_queue_pc_tail(drive, &pc);
	case MTFSFM:
	case MTBSFM:
		if (!sprev)
			return -EIO;
		retval = idetape_space_over_filemarks(drive, MTFSF,
						      mt_count - count);
		if (retval)
			return retval;
		count = (MTBSFM == mt_op ? 1 : -1);
		return idetape_space_over_filemarks(drive, MTFSF, count);
	default:
		printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",
				mt_op);
		return -EIO;
L
Linus Torvalds 已提交
2028 2029 2030 2031
	}
}

/*
2032
 * Our character device read / write functions.
L
Linus Torvalds 已提交
2033
 *
2034 2035 2036
 * The tape is optimized to maximize throughput when it is transferring an
 * integral number of the "continuous transfer limit", which is a parameter of
 * the specific tape (26kB on my particular tape, 32kB for Onstream).
L
Linus Torvalds 已提交
2037
 *
2038 2039 2040 2041 2042 2043 2044
 * As of version 1.3 of the driver, the character device provides an abstract
 * continuous view of the media - any mix of block sizes (even 1 byte) on the
 * same backup/restore procedure is supported. The driver will internally
 * convert the requests to the recommended transfer unit, so that an unmatch
 * between the user's block size to the recommended size will only result in a
 * (slightly) increased driver overhead, but will no longer hit performance.
 * This is not applicable to Onstream.
L
Linus Torvalds 已提交
2045
 */
2046 2047
static ssize_t idetape_chrdev_read(struct file *file, char __user *buf,
				   size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
2048 2049 2050
{
	struct ide_tape_obj *tape = ide_tape_f(file);
	ide_drive_t *drive = tape->drive;
2051
	ssize_t bytes_read, temp, actually_read = 0, rc;
2052
	ssize_t ret = 0;
2053
	u16 ctl = *(u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
2054

2055
	debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
L
Linus Torvalds 已提交
2056

2057
	if (tape->chrdev_dir != IDETAPE_DIR_READ) {
2058
		if (test_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags))
2059 2060 2061
			if (count > tape->blk_size &&
			    (count % tape->blk_size) == 0)
				tape->user_bs_factor = count / tape->blk_size;
L
Linus Torvalds 已提交
2062
	}
2063
	rc = idetape_init_read(drive);
2064
	if (rc < 0)
L
Linus Torvalds 已提交
2065 2066 2067 2068
		return rc;
	if (count == 0)
		return (0);
	if (tape->merge_stage_size) {
2069 2070
		actually_read = min((unsigned int)(tape->merge_stage_size),
				    (unsigned int)count);
2071
		if (idetape_copy_stage_to_user(tape, buf, actually_read))
2072
			ret = -EFAULT;
L
Linus Torvalds 已提交
2073 2074 2075 2076 2077
		buf += actually_read;
		tape->merge_stage_size -= actually_read;
		count -= actually_read;
	}
	while (count >= tape->stage_size) {
2078
		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
L
Linus Torvalds 已提交
2079 2080
		if (bytes_read <= 0)
			goto finish;
2081
		if (idetape_copy_stage_to_user(tape, buf, bytes_read))
2082
			ret = -EFAULT;
L
Linus Torvalds 已提交
2083 2084 2085 2086 2087
		buf += bytes_read;
		count -= bytes_read;
		actually_read += bytes_read;
	}
	if (count) {
2088
		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
L
Linus Torvalds 已提交
2089 2090 2091
		if (bytes_read <= 0)
			goto finish;
		temp = min((unsigned long)count, (unsigned long)bytes_read);
2092
		if (idetape_copy_stage_to_user(tape, buf, temp))
2093
			ret = -EFAULT;
L
Linus Torvalds 已提交
2094 2095 2096 2097
		actually_read += temp;
		tape->merge_stage_size = bytes_read-temp;
	}
finish:
2098
	if (!actually_read && test_bit(IDETAPE_FLAG_FILEMARK, &tape->flags)) {
2099 2100
		debug_log(DBG_SENSE, "%s: spacing over filemark\n", tape->name);

L
Linus Torvalds 已提交
2101 2102 2103
		idetape_space_over_filemarks(drive, MTFSF, 1);
		return 0;
	}
2104

2105
	return ret ? ret : actually_read;
L
Linus Torvalds 已提交
2106 2107
}

2108
static ssize_t idetape_chrdev_write(struct file *file, const char __user *buf,
L
Linus Torvalds 已提交
2109 2110 2111 2112
				     size_t count, loff_t *ppos)
{
	struct ide_tape_obj *tape = ide_tape_f(file);
	ide_drive_t *drive = tape->drive;
2113 2114
	ssize_t actually_written = 0;
	ssize_t ret = 0;
2115
	u16 ctl = *(u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
2116 2117 2118 2119 2120

	/* The drive is write protected. */
	if (tape->write_prot)
		return -EACCES;

2121
	debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
L
Linus Torvalds 已提交
2122 2123

	/* Initialize write operation */
2124 2125
	if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
		if (tape->chrdev_dir == IDETAPE_DIR_READ)
L
Linus Torvalds 已提交
2126 2127 2128 2129 2130 2131
			idetape_discard_read_pipeline(drive, 1);
		if (tape->merge_stage || tape->merge_stage_size) {
			printk(KERN_ERR "ide-tape: merge_stage_size "
				"should be 0 now\n");
			tape->merge_stage_size = 0;
		}
2132 2133
		tape->merge_stage = __idetape_kmalloc_stage(tape, 0, 0);
		if (!tape->merge_stage)
L
Linus Torvalds 已提交
2134
			return -ENOMEM;
2135
		tape->chrdev_dir = IDETAPE_DIR_WRITE;
L
Linus Torvalds 已提交
2136 2137 2138
		idetape_init_merge_stage(tape);

		/*
2139 2140 2141 2142
		 * Issue a write 0 command to ensure that DSC handshake is
		 * switched from completion mode to buffer available mode. No
		 * point in issuing this if DSC overlap isn't supported, some
		 * drives (Seagate STT3401A) will return an error.
L
Linus Torvalds 已提交
2143 2144
		 */
		if (drive->dsc_overlap) {
2145 2146 2147
			ssize_t retval = idetape_queue_rw_tail(drive,
							REQ_IDETAPE_WRITE, 0,
							tape->merge_stage->bh);
L
Linus Torvalds 已提交
2148 2149 2150
			if (retval < 0) {
				__idetape_kfree_stage(tape->merge_stage);
				tape->merge_stage = NULL;
2151
				tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
2152 2153 2154 2155 2156 2157 2158 2159
				return retval;
			}
		}
	}
	if (count == 0)
		return (0);
	if (tape->merge_stage_size) {
		if (tape->merge_stage_size >= tape->stage_size) {
2160
			printk(KERN_ERR "ide-tape: bug: merge buf too big\n");
L
Linus Torvalds 已提交
2161 2162
			tape->merge_stage_size = 0;
		}
2163 2164 2165
		actually_written = min((unsigned int)
				(tape->stage_size - tape->merge_stage_size),
				(unsigned int)count);
2166
		if (idetape_copy_stage_from_user(tape, buf, actually_written))
2167
				ret = -EFAULT;
L
Linus Torvalds 已提交
2168 2169 2170 2171 2172
		buf += actually_written;
		tape->merge_stage_size += actually_written;
		count -= actually_written;

		if (tape->merge_stage_size == tape->stage_size) {
2173
			ssize_t retval;
L
Linus Torvalds 已提交
2174
			tape->merge_stage_size = 0;
2175
			retval = idetape_add_chrdev_write_request(drive, ctl);
L
Linus Torvalds 已提交
2176 2177 2178 2179 2180
			if (retval <= 0)
				return (retval);
		}
	}
	while (count >= tape->stage_size) {
2181
		ssize_t retval;
2182
		if (idetape_copy_stage_from_user(tape, buf, tape->stage_size))
2183
			ret = -EFAULT;
L
Linus Torvalds 已提交
2184 2185
		buf += tape->stage_size;
		count -= tape->stage_size;
2186
		retval = idetape_add_chrdev_write_request(drive, ctl);
L
Linus Torvalds 已提交
2187 2188 2189 2190 2191 2192
		actually_written += tape->stage_size;
		if (retval <= 0)
			return (retval);
	}
	if (count) {
		actually_written += count;
2193
		if (idetape_copy_stage_from_user(tape, buf, count))
2194
			ret = -EFAULT;
L
Linus Torvalds 已提交
2195 2196
		tape->merge_stage_size += count;
	}
2197
	return ret ? ret : actually_written;
L
Linus Torvalds 已提交
2198 2199
}

2200
static int idetape_write_filemark(ide_drive_t *drive)
L
Linus Torvalds 已提交
2201
{
2202
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213

	/* Write a filemark */
	idetape_create_write_filemark_cmd(drive, &pc, 1);
	if (idetape_queue_pc_tail(drive, &pc)) {
		printk(KERN_ERR "ide-tape: Couldn't write a filemark\n");
		return -EIO;
	}
	return 0;
}

/*
2214 2215
 * Called from idetape_chrdev_ioctl when the general mtio MTIOCTOP ioctl is
 * requested.
L
Linus Torvalds 已提交
2216
 *
2217 2218 2219 2220
 * Note: MTBSF and MTBSFM are not supported when the tape doesn't support
 * spacing over filemarks in the reverse direction. In this case, MTFSFM is also
 * usually not supported (it is supported in the rare case in which we crossed
 * the filemark during our read-ahead pipelined operation mode).
L
Linus Torvalds 已提交
2221
 *
2222
 * The following commands are currently not supported:
L
Linus Torvalds 已提交
2223
 *
2224 2225
 * MTFSS, MTBSS, MTWSM, MTSETDENSITY, MTSETDRVBUFFER, MT_ST_BOOLEANS,
 * MT_ST_WRITE_THRESHOLD.
L
Linus Torvalds 已提交
2226
 */
2227
static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
L
Linus Torvalds 已提交
2228 2229
{
	idetape_tape_t *tape = drive->driver_data;
2230
	struct ide_atapi_pc pc;
2231
	int i, retval;
L
Linus Torvalds 已提交
2232

2233 2234
	debug_log(DBG_ERR, "Handling MTIOCTOP ioctl: mt_op=%d, mt_count=%d\n",
			mt_op, mt_count);
2235

2236
	/* Commands which need our pipelined read-ahead stages. */
L
Linus Torvalds 已提交
2237
	switch (mt_op) {
2238 2239 2240 2241 2242 2243 2244 2245 2246
	case MTFSF:
	case MTFSFM:
	case MTBSF:
	case MTBSFM:
		if (!mt_count)
			return 0;
		return idetape_space_over_filemarks(drive, mt_op, mt_count);
	default:
		break;
L
Linus Torvalds 已提交
2247
	}
2248

L
Linus Torvalds 已提交
2249
	switch (mt_op) {
2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285
	case MTWEOF:
		if (tape->write_prot)
			return -EACCES;
		idetape_discard_read_pipeline(drive, 1);
		for (i = 0; i < mt_count; i++) {
			retval = idetape_write_filemark(drive);
			if (retval)
				return retval;
		}
		return 0;
	case MTREW:
		idetape_discard_read_pipeline(drive, 0);
		if (idetape_rewind_tape(drive))
			return -EIO;
		return 0;
	case MTLOAD:
		idetape_discard_read_pipeline(drive, 0);
		idetape_create_load_unload_cmd(drive, &pc,
					       IDETAPE_LU_LOAD_MASK);
		return idetape_queue_pc_tail(drive, &pc);
	case MTUNLOAD:
	case MTOFFL:
		/*
		 * If door is locked, attempt to unlock before
		 * attempting to eject.
		 */
		if (tape->door_locked) {
			if (idetape_create_prevent_cmd(drive, &pc, 0))
				if (!idetape_queue_pc_tail(drive, &pc))
					tape->door_locked = DOOR_UNLOCKED;
		}
		idetape_discard_read_pipeline(drive, 0);
		idetape_create_load_unload_cmd(drive, &pc,
					      !IDETAPE_LU_LOAD_MASK);
		retval = idetape_queue_pc_tail(drive, &pc);
		if (!retval)
2286
			clear_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags);
2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306
		return retval;
	case MTNOP:
		idetape_discard_read_pipeline(drive, 0);
		return idetape_flush_tape_buffers(drive);
	case MTRETEN:
		idetape_discard_read_pipeline(drive, 0);
		idetape_create_load_unload_cmd(drive, &pc,
			IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK);
		return idetape_queue_pc_tail(drive, &pc);
	case MTEOM:
		idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD);
		return idetape_queue_pc_tail(drive, &pc);
	case MTERASE:
		(void)idetape_rewind_tape(drive);
		idetape_create_erase_cmd(&pc);
		return idetape_queue_pc_tail(drive, &pc);
	case MTSETBLK:
		if (mt_count) {
			if (mt_count < tape->blk_size ||
			    mt_count % tape->blk_size)
L
Linus Torvalds 已提交
2307
				return -EIO;
2308
			tape->user_bs_factor = mt_count / tape->blk_size;
2309
			clear_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags);
2310
		} else
2311
			set_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags);
2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323
		return 0;
	case MTSEEK:
		idetape_discard_read_pipeline(drive, 0);
		return idetape_position_tape(drive,
			mt_count * tape->user_bs_factor, tape->partition, 0);
	case MTSETPART:
		idetape_discard_read_pipeline(drive, 0);
		return idetape_position_tape(drive, 0, mt_count, 0);
	case MTFSR:
	case MTBSR:
	case MTLOCK:
		if (!idetape_create_prevent_cmd(drive, &pc, 1))
L
Linus Torvalds 已提交
2324
			return 0;
2325 2326
		retval = idetape_queue_pc_tail(drive, &pc);
		if (retval)
L
Linus Torvalds 已提交
2327
			return retval;
2328 2329 2330 2331
		tape->door_locked = DOOR_EXPLICITLY_LOCKED;
		return 0;
	case MTUNLOCK:
		if (!idetape_create_prevent_cmd(drive, &pc, 0))
L
Linus Torvalds 已提交
2332
			return 0;
2333 2334 2335 2336 2337 2338 2339 2340 2341
		retval = idetape_queue_pc_tail(drive, &pc);
		if (retval)
			return retval;
		tape->door_locked = DOOR_UNLOCKED;
		return 0;
	default:
		printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",
				mt_op);
		return -EIO;
L
Linus Torvalds 已提交
2342 2343 2344 2345
	}
}

/*
2346 2347 2348
 * Our character device ioctls. General mtio.h magnetic io commands are
 * supported here, and not in the corresponding block interface. Our own
 * ide-tape ioctls are supported on both interfaces.
L
Linus Torvalds 已提交
2349
 */
2350 2351
static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
				unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
2352 2353 2354 2355 2356 2357
{
	struct ide_tape_obj *tape = ide_tape_f(file);
	ide_drive_t *drive = tape->drive;
	struct mtop mtop;
	struct mtget mtget;
	struct mtpos mtpos;
2358
	int block_offset = 0, position = tape->first_frame;
L
Linus Torvalds 已提交
2359 2360
	void __user *argp = (void __user *)arg;

2361
	debug_log(DBG_CHRDEV, "Enter %s, cmd=%u\n", __func__, cmd);
L
Linus Torvalds 已提交
2362

2363
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
L
Linus Torvalds 已提交
2364 2365 2366 2367
		idetape_empty_write_pipeline(drive);
		idetape_flush_tape_buffers(drive);
	}
	if (cmd == MTIOCGET || cmd == MTIOCPOS) {
2368
		block_offset = tape->merge_stage_size /
2369
			(tape->blk_size * tape->user_bs_factor);
2370 2371
		position = idetape_read_position(drive);
		if (position < 0)
L
Linus Torvalds 已提交
2372 2373 2374
			return -EIO;
	}
	switch (cmd) {
2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401
	case MTIOCTOP:
		if (copy_from_user(&mtop, argp, sizeof(struct mtop)))
			return -EFAULT;
		return idetape_mtioctop(drive, mtop.mt_op, mtop.mt_count);
	case MTIOCGET:
		memset(&mtget, 0, sizeof(struct mtget));
		mtget.mt_type = MT_ISSCSI2;
		mtget.mt_blkno = position / tape->user_bs_factor - block_offset;
		mtget.mt_dsreg =
			((tape->blk_size * tape->user_bs_factor)
			 << MT_ST_BLKSIZE_SHIFT) & MT_ST_BLKSIZE_MASK;

		if (tape->drv_write_prot)
			mtget.mt_gstat |= GMT_WR_PROT(0xffffffff);

		if (copy_to_user(argp, &mtget, sizeof(struct mtget)))
			return -EFAULT;
		return 0;
	case MTIOCPOS:
		mtpos.mt_blkno = position / tape->user_bs_factor - block_offset;
		if (copy_to_user(argp, &mtpos, sizeof(struct mtpos)))
			return -EFAULT;
		return 0;
	default:
		if (tape->chrdev_dir == IDETAPE_DIR_READ)
			idetape_discard_read_pipeline(drive, 1);
		return idetape_blkdev_ioctl(drive, cmd, arg);
L
Linus Torvalds 已提交
2402 2403 2404
	}
}

2405 2406 2407 2408 2409 2410 2411
/*
 * Do a mode sense page 0 with block descriptor and if it succeeds set the tape
 * block size with the reported value.
 */
static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive)
{
	idetape_tape_t *tape = drive->driver_data;
2412
	struct ide_atapi_pc pc;
2413 2414 2415 2416

	idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR);
	if (idetape_queue_pc_tail(drive, &pc)) {
		printk(KERN_ERR "ide-tape: Can't get block descriptor\n");
2417
		if (tape->blk_size == 0) {
2418 2419
			printk(KERN_WARNING "ide-tape: Cannot deal with zero "
					    "block size, assuming 32k\n");
2420
			tape->blk_size = 32768;
2421 2422 2423
		}
		return;
	}
2424 2425 2426 2427
	tape->blk_size = (pc.buf[4 + 5] << 16) +
				(pc.buf[4 + 6] << 8)  +
				 pc.buf[4 + 7];
	tape->drv_write_prot = (pc.buf[2] & 0x80) >> 7;
2428
}
L
Linus Torvalds 已提交
2429

2430
static int idetape_chrdev_open(struct inode *inode, struct file *filp)
L
Linus Torvalds 已提交
2431 2432 2433 2434
{
	unsigned int minor = iminor(inode), i = minor & ~0xc0;
	ide_drive_t *drive;
	idetape_tape_t *tape;
2435
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
2436 2437
	int retval;

2438 2439 2440 2441 2442 2443 2444 2445 2446
	if (i >= MAX_HWIFS * MAX_DRIVES)
		return -ENXIO;

	tape = ide_tape_chrdev_get(i);
	if (!tape)
		return -ENXIO;

	debug_log(DBG_CHRDEV, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457
	/*
	 * We really want to do nonseekable_open(inode, filp); here, but some
	 * versions of tar incorrectly call lseek on tapes and bail out if that
	 * fails.  So we disallow pread() and pwrite(), but permit lseeks.
	 */
	filp->f_mode &= ~(FMODE_PREAD | FMODE_PWRITE);

	drive = tape->drive;

	filp->private_data = tape;

2458
	if (test_and_set_bit(IDETAPE_FLAG_BUSY, &tape->flags)) {
L
Linus Torvalds 已提交
2459 2460 2461 2462 2463 2464
		retval = -EBUSY;
		goto out_put_tape;
	}

	retval = idetape_wait_ready(drive, 60 * HZ);
	if (retval) {
2465
		clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
L
Linus Torvalds 已提交
2466 2467 2468 2469 2470
		printk(KERN_ERR "ide-tape: %s: drive not ready\n", tape->name);
		goto out_put_tape;
	}

	idetape_read_position(drive);
2471
	if (!test_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags))
L
Linus Torvalds 已提交
2472 2473 2474
		(void)idetape_rewind_tape(drive);

	/* Read block size and write protect status from drive. */
2475
	ide_tape_get_bsize_from_bdesc(drive);
L
Linus Torvalds 已提交
2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486

	/* Set write protect flag if device is opened as read-only. */
	if ((filp->f_flags & O_ACCMODE) == O_RDONLY)
		tape->write_prot = 1;
	else
		tape->write_prot = tape->drv_write_prot;

	/* Make sure drive isn't write protected if user wants to write. */
	if (tape->write_prot) {
		if ((filp->f_flags & O_ACCMODE) == O_WRONLY ||
		    (filp->f_flags & O_ACCMODE) == O_RDWR) {
2487
			clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
L
Linus Torvalds 已提交
2488 2489 2490 2491 2492
			retval = -EROFS;
			goto out_put_tape;
		}
	}

2493
	/* Lock the tape drive door so user can't eject. */
2494
	if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
L
Linus Torvalds 已提交
2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508
		if (idetape_create_prevent_cmd(drive, &pc, 1)) {
			if (!idetape_queue_pc_tail(drive, &pc)) {
				if (tape->door_locked != DOOR_EXPLICITLY_LOCKED)
					tape->door_locked = DOOR_LOCKED;
			}
		}
	}
	return 0;

out_put_tape:
	ide_tape_put(tape);
	return retval;
}

2509
static void idetape_write_release(ide_drive_t *drive, unsigned int minor)
L
Linus Torvalds 已提交
2510 2511 2512 2513 2514 2515
{
	idetape_tape_t *tape = drive->driver_data;

	idetape_empty_write_pipeline(drive);
	tape->merge_stage = __idetape_kmalloc_stage(tape, 1, 0);
	if (tape->merge_stage != NULL) {
2516 2517
		idetape_pad_zeros(drive, tape->blk_size *
				(tape->user_bs_factor - 1));
L
Linus Torvalds 已提交
2518 2519 2520 2521 2522 2523 2524 2525
		__idetape_kfree_stage(tape->merge_stage);
		tape->merge_stage = NULL;
	}
	idetape_write_filemark(drive);
	idetape_flush_tape_buffers(drive);
	idetape_flush_tape_buffers(drive);
}

2526
static int idetape_chrdev_release(struct inode *inode, struct file *filp)
L
Linus Torvalds 已提交
2527 2528 2529
{
	struct ide_tape_obj *tape = ide_tape_f(filp);
	ide_drive_t *drive = tape->drive;
2530
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
2531 2532 2533 2534
	unsigned int minor = iminor(inode);

	lock_kernel();
	tape = drive->driver_data;
2535 2536

	debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
2537

2538
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
L
Linus Torvalds 已提交
2539
		idetape_write_release(drive, minor);
2540
	if (tape->chrdev_dir == IDETAPE_DIR_READ) {
L
Linus Torvalds 已提交
2541 2542 2543
		if (minor < 128)
			idetape_discard_read_pipeline(drive, 1);
	}
2544

2545
	if (minor < 128 && test_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags))
L
Linus Torvalds 已提交
2546
		(void) idetape_rewind_tape(drive);
2547
	if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
L
Linus Torvalds 已提交
2548 2549 2550 2551 2552 2553 2554
		if (tape->door_locked == DOOR_LOCKED) {
			if (idetape_create_prevent_cmd(drive, &pc, 0)) {
				if (!idetape_queue_pc_tail(drive, &pc))
					tape->door_locked = DOOR_UNLOCKED;
			}
		}
	}
2555
	clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
L
Linus Torvalds 已提交
2556 2557 2558 2559 2560 2561
	ide_tape_put(tape);
	unlock_kernel();
	return 0;
}

/*
2562
 * check the contents of the ATAPI IDENTIFY command results. We return:
L
Linus Torvalds 已提交
2563
 *
2564 2565
 * 1 - If the tape can be supported by us, based on the information we have so
 * far.
L
Linus Torvalds 已提交
2566
 *
2567
 * 0 - If this tape driver is not currently supported by us.
L
Linus Torvalds 已提交
2568
 */
2569
static int idetape_identify_device(ide_drive_t *drive)
L
Linus Torvalds 已提交
2570
{
2571
	u8 gcw[2], protocol, device_type, removable, packet_size;
L
Linus Torvalds 已提交
2572 2573 2574 2575

	if (drive->id_read == 0)
		return 1;

2576
	*((unsigned short *) &gcw) = drive->id->config;
L
Linus Torvalds 已提交
2577

2578 2579 2580 2581
	protocol	=   (gcw[1] & 0xC0) >> 6;
	device_type	=    gcw[1] & 0x1F;
	removable	= !!(gcw[0] & 0x80);
	packet_size	=    gcw[0] & 0x3;
L
Linus Torvalds 已提交
2582

2583 2584
	/* Check that we can support this device */
	if (protocol != 2)
2585
		printk(KERN_ERR "ide-tape: Protocol (0x%02x) is not ATAPI\n",
2586 2587
				protocol);
	else if (device_type != 1)
2588
		printk(KERN_ERR "ide-tape: Device type (0x%02x) is not set "
2589 2590
				"to tape\n", device_type);
	else if (!removable)
L
Linus Torvalds 已提交
2591
		printk(KERN_ERR "ide-tape: The removable flag is not set\n");
2592
	else if (packet_size != 0) {
2593 2594
		printk(KERN_ERR "ide-tape: Packet size (0x%02x) is not 12"
				" bytes\n", packet_size);
L
Linus Torvalds 已提交
2595 2596 2597 2598 2599
	} else
		return 1;
	return 0;
}

2600
static void idetape_get_inquiry_results(ide_drive_t *drive)
L
Linus Torvalds 已提交
2601 2602
{
	idetape_tape_t *tape = drive->driver_data;
2603
	struct ide_atapi_pc pc;
2604
	char fw_rev[6], vendor_id[10], product_id[18];
2605

L
Linus Torvalds 已提交
2606 2607
	idetape_create_inquiry_cmd(&pc);
	if (idetape_queue_pc_tail(drive, &pc)) {
2608 2609
		printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
				tape->name);
L
Linus Torvalds 已提交
2610 2611
		return;
	}
2612 2613 2614
	memcpy(vendor_id, &pc.buf[8], 8);
	memcpy(product_id, &pc.buf[16], 16);
	memcpy(fw_rev, &pc.buf[32], 4);
2615 2616 2617 2618 2619

	ide_fixstring(vendor_id, 10, 0);
	ide_fixstring(product_id, 18, 0);
	ide_fixstring(fw_rev, 6, 0);

2620
	printk(KERN_INFO "ide-tape: %s <-> %s: %s %s rev %s\n",
2621
			drive->name, tape->name, vendor_id, product_id, fw_rev);
L
Linus Torvalds 已提交
2622 2623 2624
}

/*
2625 2626
 * Ask the tape about its various parameters. In particular, we will adjust our
 * data transfer buffer	size to the recommended value as returned by the tape.
L
Linus Torvalds 已提交
2627
 */
2628
static void idetape_get_mode_sense_results(ide_drive_t *drive)
L
Linus Torvalds 已提交
2629 2630
{
	idetape_tape_t *tape = drive->driver_data;
2631
	struct ide_atapi_pc pc;
2632 2633
	u8 *caps;
	u8 speed, max_speed;
2634

L
Linus Torvalds 已提交
2635 2636
	idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
	if (idetape_queue_pc_tail(drive, &pc)) {
2637 2638
		printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
				" some default values\n");
2639
		tape->blk_size = 512;
2640 2641 2642
		put_unaligned(52,   (u16 *)&tape->caps[12]);
		put_unaligned(540,  (u16 *)&tape->caps[14]);
		put_unaligned(6*52, (u16 *)&tape->caps[16]);
L
Linus Torvalds 已提交
2643 2644
		return;
	}
2645
	caps = pc.buf + 4 + pc.buf[3];
2646 2647 2648 2649

	/* convert to host order and save for later use */
	speed = be16_to_cpu(*(u16 *)&caps[14]);
	max_speed = be16_to_cpu(*(u16 *)&caps[8]);
L
Linus Torvalds 已提交
2650

2651 2652 2653 2654
	put_unaligned(max_speed, (u16 *)&caps[8]);
	put_unaligned(be16_to_cpu(*(u16 *)&caps[12]), (u16 *)&caps[12]);
	put_unaligned(speed, (u16 *)&caps[14]);
	put_unaligned(be16_to_cpu(*(u16 *)&caps[16]), (u16 *)&caps[16]);
L
Linus Torvalds 已提交
2655

2656 2657 2658 2659
	if (!speed) {
		printk(KERN_INFO "ide-tape: %s: invalid tape speed "
				"(assuming 650KB/sec)\n", drive->name);
		put_unaligned(650, (u16 *)&caps[14]);
L
Linus Torvalds 已提交
2660
	}
2661 2662 2663 2664
	if (!max_speed) {
		printk(KERN_INFO "ide-tape: %s: invalid max_speed "
				"(assuming 650KB/sec)\n", drive->name);
		put_unaligned(650, (u16 *)&caps[8]);
L
Linus Torvalds 已提交
2665 2666
	}

2667 2668
	memcpy(&tape->caps, caps, 20);
	if (caps[7] & 0x02)
2669
		tape->blk_size = 512;
2670
	else if (caps[7] & 0x04)
2671
		tape->blk_size = 1024;
L
Linus Torvalds 已提交
2672 2673
}

2674
#ifdef CONFIG_IDE_PROC_FS
2675
static void idetape_add_settings(ide_drive_t *drive)
L
Linus Torvalds 已提交
2676 2677 2678
{
	idetape_tape_t *tape = drive->driver_data;

2679 2680 2681 2682
	ide_add_setting(drive, "buffer", SETTING_READ, TYPE_SHORT, 0, 0xffff,
			1, 2, (u16 *)&tape->caps[16], NULL);
	ide_add_setting(drive, "speed", SETTING_READ, TYPE_SHORT, 0, 0xffff,
			1, 1, (u16 *)&tape->caps[14], NULL);
2683 2684 2685 2686 2687
	ide_add_setting(drive, "stage", SETTING_READ, TYPE_INT,	0, 0xffff, 1,
			1024, &tape->stage_size, NULL);
	ide_add_setting(drive, "tdsc", SETTING_RW, TYPE_INT, IDETAPE_DSC_RW_MIN,
			IDETAPE_DSC_RW_MAX, 1000, HZ, &tape->best_dsc_rw_freq,
			NULL);
2688 2689 2690 2691
	ide_add_setting(drive, "dsc_overlap", SETTING_RW, TYPE_BYTE, 0, 1, 1,
			1, &drive->dsc_overlap, NULL);
	ide_add_setting(drive, "avg_speed", SETTING_READ, TYPE_INT, 0, 0xffff,
			1, 1, &tape->avg_speed, NULL);
2692 2693
	ide_add_setting(drive, "debug_mask", SETTING_RW, TYPE_INT, 0, 0xffff, 1,
			1, &tape->debug_mask, NULL);
L
Linus Torvalds 已提交
2694
}
2695 2696 2697
#else
static inline void idetape_add_settings(ide_drive_t *drive) { ; }
#endif
L
Linus Torvalds 已提交
2698 2699

/*
2700
 * The function below is called to:
L
Linus Torvalds 已提交
2701
 *
2702 2703 2704 2705
 * 1. Initialize our various state variables.
 * 2. Ask the tape for its capabilities.
 * 3. Allocate a buffer which will be used for data transfer. The buffer size
 * is chosen based on the recommendation which we received in step 2.
L
Linus Torvalds 已提交
2706
 *
2707 2708
 * Note that at this point ide.c already assigned us an irq, so that we can
 * queue requests here and wait for their completion.
L
Linus Torvalds 已提交
2709
 */
2710
static void idetape_setup(ide_drive_t *drive, idetape_tape_t *tape, int minor)
L
Linus Torvalds 已提交
2711
{
2712
	unsigned long t;
L
Linus Torvalds 已提交
2713 2714
	int speed;
	int stage_size;
2715
	u8 gcw[2];
2716
	u16 *ctl = (u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
2717

2718
	spin_lock_init(&tape->lock);
L
Linus Torvalds 已提交
2719
	drive->dsc_overlap = 1;
2720 2721 2722 2723
	if (drive->hwif->host_flags & IDE_HFLAG_NO_DSC) {
		printk(KERN_INFO "ide-tape: %s: disabling DSC overlap\n",
				 tape->name);
		drive->dsc_overlap = 0;
L
Linus Torvalds 已提交
2724 2725 2726 2727 2728 2729 2730 2731
	}
	/* Seagate Travan drives do not support DSC overlap. */
	if (strstr(drive->id->model, "Seagate STT3401"))
		drive->dsc_overlap = 0;
	tape->minor = minor;
	tape->name[0] = 'h';
	tape->name[1] = 't';
	tape->name[2] = '0' + minor;
2732
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
2733 2734
	tape->pc = tape->pc_stack;
	*((unsigned short *) &gcw) = drive->id->config;
2735 2736 2737

	/* Command packet DRQ type */
	if (((gcw[0] & 0x60) >> 5) == 1)
2738
		set_bit(IDETAPE_FLAG_DRQ_INTERRUPT, &tape->flags);
L
Linus Torvalds 已提交
2739 2740 2741

	idetape_get_inquiry_results(drive);
	idetape_get_mode_sense_results(drive);
2742
	ide_tape_get_bsize_from_bdesc(drive);
L
Linus Torvalds 已提交
2743
	tape->user_bs_factor = 1;
2744
	tape->stage_size = *ctl * tape->blk_size;
L
Linus Torvalds 已提交
2745 2746
	while (tape->stage_size > 0xffff) {
		printk(KERN_NOTICE "ide-tape: decreasing stage size\n");
2747
		*ctl /= 2;
2748
		tape->stage_size = *ctl * tape->blk_size;
L
Linus Torvalds 已提交
2749 2750 2751 2752 2753 2754 2755 2756
	}
	stage_size = tape->stage_size;
	tape->pages_per_stage = stage_size / PAGE_SIZE;
	if (stage_size % PAGE_SIZE) {
		tape->pages_per_stage++;
		tape->excess_bh_size = PAGE_SIZE - stage_size % PAGE_SIZE;
	}

2757
	/* select the "best" DSC read/write polling freq */
2758
	speed = max(*(u16 *)&tape->caps[14], *(u16 *)&tape->caps[8]);
L
Linus Torvalds 已提交
2759

2760
	t = (IDETAPE_FIFO_THRESHOLD * tape->stage_size * HZ) / (speed * 1000);
L
Linus Torvalds 已提交
2761 2762

	/*
2763 2764
	 * Ensure that the number we got makes sense; limit it within
	 * IDETAPE_DSC_RW_MIN and IDETAPE_DSC_RW_MAX.
L
Linus Torvalds 已提交
2765
	 */
2766 2767 2768
	tape->best_dsc_rw_freq = max_t(unsigned long,
				min_t(unsigned long, t, IDETAPE_DSC_RW_MAX),
				IDETAPE_DSC_RW_MIN);
L
Linus Torvalds 已提交
2769
	printk(KERN_INFO "ide-tape: %s <-> %s: %dKBps, %d*%dkB buffer, "
2770
		"%lums tDSC%s\n",
2771 2772
		drive->name, tape->name, *(u16 *)&tape->caps[14],
		(*(u16 *)&tape->caps[16] * 512) / tape->stage_size,
L
Linus Torvalds 已提交
2773
		tape->stage_size / 1024,
2774
		tape->best_dsc_rw_freq * 1000 / HZ,
L
Linus Torvalds 已提交
2775 2776 2777 2778 2779
		drive->using_dma ? ", DMA":"");

	idetape_add_settings(drive);
}

2780
static void ide_tape_remove(ide_drive_t *drive)
L
Linus Torvalds 已提交
2781 2782 2783
{
	idetape_tape_t *tape = drive->driver_data;

2784
	ide_proc_unregister_driver(drive, tape->driver);
L
Linus Torvalds 已提交
2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796

	ide_unregister_region(tape->disk);

	ide_tape_put(tape);
}

static void ide_tape_release(struct kref *kref)
{
	struct ide_tape_obj *tape = to_ide_tape(kref);
	ide_drive_t *drive = tape->drive;
	struct gendisk *g = tape->disk;

2797
	BUG_ON(tape->merge_stage_size);
2798

L
Linus Torvalds 已提交
2799 2800
	drive->dsc_overlap = 0;
	drive->driver_data = NULL;
2801
	device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor));
2802 2803
	device_destroy(idetape_sysfs_class,
			MKDEV(IDETAPE_MAJOR, tape->minor + 128));
L
Linus Torvalds 已提交
2804 2805 2806 2807 2808 2809
	idetape_devs[tape->minor] = NULL;
	g->private_data = NULL;
	put_disk(g);
	kfree(tape);
}

2810
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829
static int proc_idetape_read_name
	(char *page, char **start, off_t off, int count, int *eof, void *data)
{
	ide_drive_t	*drive = (ide_drive_t *) data;
	idetape_tape_t	*tape = drive->driver_data;
	char		*out = page;
	int		len;

	len = sprintf(out, "%s\n", tape->name);
	PROC_IDE_READ_RETURN(page, start, off, count, eof, len);
}

static ide_proc_entry_t idetape_proc[] = {
	{ "capacity",	S_IFREG|S_IRUGO,	proc_ide_read_capacity, NULL },
	{ "name",	S_IFREG|S_IRUGO,	proc_idetape_read_name,	NULL },
	{ NULL, 0, NULL, NULL }
};
#endif

2830
static int ide_tape_probe(ide_drive_t *);
L
Linus Torvalds 已提交
2831 2832

static ide_driver_t idetape_driver = {
2833
	.gen_driver = {
2834
		.owner		= THIS_MODULE,
2835 2836 2837
		.name		= "ide-tape",
		.bus		= &ide_bus_type,
	},
2838 2839
	.probe			= ide_tape_probe,
	.remove			= ide_tape_remove,
L
Linus Torvalds 已提交
2840 2841 2842 2843 2844 2845 2846
	.version		= IDETAPE_VERSION,
	.media			= ide_tape,
	.supports_dsc_overlap 	= 1,
	.do_request		= idetape_do_request,
	.end_request		= idetape_end_request,
	.error			= __ide_error,
	.abort			= __ide_abort,
2847
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2848
	.proc			= idetape_proc,
2849
#endif
L
Linus Torvalds 已提交
2850 2851
};

2852
/* Our character device supporting functions, passed to register_chrdev. */
2853
static const struct file_operations idetape_fops = {
L
Linus Torvalds 已提交
2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866
	.owner		= THIS_MODULE,
	.read		= idetape_chrdev_read,
	.write		= idetape_chrdev_write,
	.ioctl		= idetape_chrdev_ioctl,
	.open		= idetape_chrdev_open,
	.release	= idetape_chrdev_release,
};

static int idetape_open(struct inode *inode, struct file *filp)
{
	struct gendisk *disk = inode->i_bdev->bd_disk;
	struct ide_tape_obj *tape;

2867 2868
	tape = ide_tape_get(disk);
	if (!tape)
L
Linus Torvalds 已提交
2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902
		return -ENXIO;

	return 0;
}

static int idetape_release(struct inode *inode, struct file *filp)
{
	struct gendisk *disk = inode->i_bdev->bd_disk;
	struct ide_tape_obj *tape = ide_tape_g(disk);

	ide_tape_put(tape);

	return 0;
}

static int idetape_ioctl(struct inode *inode, struct file *file,
			unsigned int cmd, unsigned long arg)
{
	struct block_device *bdev = inode->i_bdev;
	struct ide_tape_obj *tape = ide_tape_g(bdev->bd_disk);
	ide_drive_t *drive = tape->drive;
	int err = generic_ide_ioctl(drive, file, bdev, cmd, arg);
	if (err == -EINVAL)
		err = idetape_blkdev_ioctl(drive, cmd, arg);
	return err;
}

static struct block_device_operations idetape_block_ops = {
	.owner		= THIS_MODULE,
	.open		= idetape_open,
	.release	= idetape_release,
	.ioctl		= idetape_ioctl,
};

2903
static int ide_tape_probe(ide_drive_t *drive)
L
Linus Torvalds 已提交
2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914
{
	idetape_tape_t *tape;
	struct gendisk *g;
	int minor;

	if (!strstr("ide-tape", drive->driver_req))
		goto failed;
	if (!drive->present)
		goto failed;
	if (drive->media != ide_tape)
		goto failed;
2915 2916 2917
	if (!idetape_identify_device(drive)) {
		printk(KERN_ERR "ide-tape: %s: not supported by this version of"
				" the driver\n", drive->name);
L
Linus Torvalds 已提交
2918 2919 2920
		goto failed;
	}
	if (drive->scsi) {
2921 2922
		printk(KERN_INFO "ide-tape: passing drive %s to ide-scsi"
				 " emulation.\n", drive->name);
L
Linus Torvalds 已提交
2923 2924
		goto failed;
	}
2925
	tape = kzalloc(sizeof(idetape_tape_t), GFP_KERNEL);
L
Linus Torvalds 已提交
2926
	if (tape == NULL) {
2927 2928
		printk(KERN_ERR "ide-tape: %s: Can't allocate a tape struct\n",
				drive->name);
L
Linus Torvalds 已提交
2929 2930 2931 2932 2933 2934 2935 2936 2937
		goto failed;
	}

	g = alloc_disk(1 << PARTN_BITS);
	if (!g)
		goto out_free_tape;

	ide_init_disk(g, drive);

2938
	ide_proc_register_driver(drive, &idetape_driver);
L
Linus Torvalds 已提交
2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949

	kref_init(&tape->kref);

	tape->drive = drive;
	tape->driver = &idetape_driver;
	tape->disk = g;

	g->private_data = &tape->driver;

	drive->driver_data = tape;

2950
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2951 2952 2953
	for (minor = 0; idetape_devs[minor]; minor++)
		;
	idetape_devs[minor] = tape;
2954
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2955 2956 2957

	idetape_setup(drive, tape, minor);

2958 2959 2960 2961
	device_create(idetape_sysfs_class, &drive->gendev,
		      MKDEV(IDETAPE_MAJOR, minor), "%s", tape->name);
	device_create(idetape_sysfs_class, &drive->gendev,
			MKDEV(IDETAPE_MAJOR, minor + 128), "n%s", tape->name);
2962

L
Linus Torvalds 已提交
2963 2964 2965 2966
	g->fops = &idetape_block_ops;
	ide_register_region(g);

	return 0;
2967

L
Linus Torvalds 已提交
2968 2969 2970
out_free_tape:
	kfree(tape);
failed:
2971
	return -ENODEV;
L
Linus Torvalds 已提交
2972 2973
}

2974
static void __exit idetape_exit(void)
L
Linus Torvalds 已提交
2975
{
2976
	driver_unregister(&idetape_driver.gen_driver);
2977
	class_destroy(idetape_sysfs_class);
L
Linus Torvalds 已提交
2978 2979 2980
	unregister_chrdev(IDETAPE_MAJOR, "ht");
}

2981
static int __init idetape_init(void)
L
Linus Torvalds 已提交
2982
{
2983 2984 2985 2986 2987 2988 2989 2990 2991
	int error = 1;
	idetape_sysfs_class = class_create(THIS_MODULE, "ide_tape");
	if (IS_ERR(idetape_sysfs_class)) {
		idetape_sysfs_class = NULL;
		printk(KERN_ERR "Unable to create sysfs class for ide tapes\n");
		error = -EBUSY;
		goto out;
	}

L
Linus Torvalds 已提交
2992
	if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
2993 2994
		printk(KERN_ERR "ide-tape: Failed to register chrdev"
				" interface\n");
2995 2996
		error = -EBUSY;
		goto out_free_class;
L
Linus Torvalds 已提交
2997
	}
2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010

	error = driver_register(&idetape_driver.gen_driver);
	if (error)
		goto out_free_driver;

	return 0;

out_free_driver:
	driver_unregister(&idetape_driver.gen_driver);
out_free_class:
	class_destroy(idetape_sysfs_class);
out:
	return error;
L
Linus Torvalds 已提交
3011 3012
}

3013
MODULE_ALIAS("ide:*m-tape*");
L
Linus Torvalds 已提交
3014 3015 3016
module_init(idetape_init);
module_exit(idetape_exit);
MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
3017 3018
MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
MODULE_LICENSE("GPL");