ide-tape.c 78.8 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 148 149 150 151 152
/* tape directions */
enum {
	IDETAPE_DIR_NONE  = (1 << 0),
	IDETAPE_DIR_READ  = (1 << 1),
	IDETAPE_DIR_WRITE = (1 << 2),
};
L
Linus Torvalds 已提交
153 154

struct idetape_bh {
155
	u32 b_size;
L
Linus Torvalds 已提交
156 157 158 159 160
	atomic_t b_count;
	struct idetape_bh *b_reqnext;
	char *b_data;
};

161 162 163 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
/* 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

198 199 200 201 202 203
/* 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 */
204
	IDETAPE_FLAG_BUSY		= (1 << 2),
205
	/* Attempt to auto-detect the current user block size */
206
	IDETAPE_FLAG_DETECT_BS		= (1 << 3),
207
	/* Currently on a filemark */
208
	IDETAPE_FLAG_FILEMARK		= (1 << 4),
209
	/* DRQ interrupt device */
210
	IDETAPE_FLAG_DRQ_INTERRUPT	= (1 << 5),
211
	/* 0 = no tape is loaded, so we don't rewind after ejecting */
212
	IDETAPE_FLAG_MEDIUM_PRESENT	= (1 << 6),
213 214
};

L
Linus Torvalds 已提交
215
/*
216 217
 * 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 已提交
218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240
 */
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 */
241
	struct ide_atapi_pc *pc;
L
Linus Torvalds 已提交
242
	/* Last failed packet command */
243
	struct ide_atapi_pc *failed_pc;
L
Linus Torvalds 已提交
244
	/* Packet command stack */
245
	struct ide_atapi_pc pc_stack[IDETAPE_PC_STACK];
L
Linus Torvalds 已提交
246 247 248 249 250 251 252
	/* 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;

	/*
253
	 * DSC polling variables.
L
Linus Torvalds 已提交
254
	 *
255 256 257
	 * 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
258
	 * data transfer) request in the device request queue.
L
Linus Torvalds 已提交
259 260 261 262 263 264 265
	 */
	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 */
266 267
	unsigned long best_dsc_rw_freq;
	unsigned long dsc_poll_freq;
L
Linus Torvalds 已提交
268 269
	unsigned long dsc_timeout;

270
	/* Read position information */
L
Linus Torvalds 已提交
271 272
	u8 partition;
	/* Current block */
273
	unsigned int first_frame;
L
Linus Torvalds 已提交
274

275
	/* Last error information */
L
Linus Torvalds 已提交
276 277
	u8 sense_key, asc, ascq;

278
	/* Character device operation */
L
Linus Torvalds 已提交
279 280 281 282
	unsigned int minor;
	/* device name */
	char name[4];
	/* Current character device data transfer direction */
283
	u8 chrdev_dir;
L
Linus Torvalds 已提交
284

285 286
	/* tape block size, usually 512 or 1024 bytes */
	unsigned short blk_size;
L
Linus Torvalds 已提交
287
	int user_bs_factor;
288

L
Linus Torvalds 已提交
289
	/* Copy of the tape's Capabilities and Mechanical Page */
290
	u8 caps[20];
L
Linus Torvalds 已提交
291 292

	/*
293
	 * Active data transfer request parameters.
L
Linus Torvalds 已提交
294
	 *
295 296 297
	 * 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 已提交
298
	 */
299

300
	/* Data buffer size chosen based on the tape's recommendation */
301
	int buffer_size;
302 303
	/* merge buffer */
	struct idetape_bh *merge_bh;
304 305
	/* size of the merge buffer */
	int merge_bh_size;
306
	/* pointer to current buffer head within the merge buffer */
L
Linus Torvalds 已提交
307 308 309
	struct idetape_bh *bh;
	char *b_data;
	int b_count;
310

311
	int pages_per_buffer;
L
Linus Torvalds 已提交
312 313 314 315 316 317
	/* Wasted space in each stage */
	int excess_bh_size;

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

320
	/* Measures average tape speed */
L
Linus Torvalds 已提交
321 322 323 324 325 326 327 328 329 330 331
	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;

332
	u32 debug_mask;
L
Linus Torvalds 已提交
333 334
} idetape_tape_t;

335
static DEFINE_MUTEX(idetape_ref_mutex);
L
Linus Torvalds 已提交
336

337 338
static struct class *idetape_sysfs_class;

L
Linus Torvalds 已提交
339 340 341 342 343 344 345 346 347
#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;

348
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
349 350 351
	tape = ide_tape_g(disk);
	if (tape)
		kref_get(&tape->kref);
352
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
353 354 355 356 357 358 359
	return tape;
}

static void ide_tape_release(struct kref *);

static void ide_tape_put(struct ide_tape_obj *tape)
{
360
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
361
	kref_put(&tape->kref, ide_tape_release);
362
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
363 364 365
}

/*
366 367
 * The variables below are used for the character device interface. Additional
 * state variables are defined in our ide_drive_t structure.
L
Linus Torvalds 已提交
368
 */
369
static struct ide_tape_obj *idetape_devs[MAX_HWIFS * MAX_DRIVES];
L
Linus Torvalds 已提交
370 371 372 373 374 375 376

#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;

377
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
378 379 380
	tape = idetape_devs[i];
	if (tape)
		kref_get(&tape->kref);
381
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
382 383 384
	return tape;
}

385
static void idetape_input_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
386
				  unsigned int bcount)
L
Linus Torvalds 已提交
387 388 389 390 391 392 393 394
{
	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");
395
			ide_pad_transfer(drive, 0, bcount);
L
Linus Torvalds 已提交
396 397
			return;
		}
398 399 400
		count = min(
			(unsigned int)(bh->b_size - atomic_read(&bh->b_count)),
			bcount);
401
		drive->hwif->input_data(drive, NULL, bh->b_data +
402
					atomic_read(&bh->b_count), count);
L
Linus Torvalds 已提交
403 404 405 406 407 408 409 410 411 412 413
		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;
}

414
static void idetape_output_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
415
				   unsigned int bcount)
L
Linus Torvalds 已提交
416 417 418 419 420 421
{
	struct idetape_bh *bh = pc->bh;
	int count;

	while (bcount) {
		if (bh == NULL) {
422 423
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
L
Linus Torvalds 已提交
424 425 426
			return;
		}
		count = min((unsigned int)pc->b_count, (unsigned int)bcount);
427
		drive->hwif->output_data(drive, NULL, pc->b_data, count);
L
Linus Torvalds 已提交
428 429 430 431
		bcount -= count;
		pc->b_data += count;
		pc->b_count -= count;
		if (!pc->b_count) {
432 433
			bh = bh->b_reqnext;
			pc->bh = bh;
L
Linus Torvalds 已提交
434 435 436 437 438 439 440 441
			if (bh) {
				pc->b_data = bh->b_data;
				pc->b_count = atomic_read(&bh->b_count);
			}
		}
	}
}

442
static void idetape_update_buffers(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
443 444 445
{
	struct idetape_bh *bh = pc->bh;
	int count;
446
	unsigned int bcount = pc->xferred;
L
Linus Torvalds 已提交
447

448
	if (pc->flags & PC_FLAG_WRITING)
L
Linus Torvalds 已提交
449 450 451
		return;
	while (bcount) {
		if (bh == NULL) {
452 453
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
L
Linus Torvalds 已提交
454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
			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.
 */
471
static struct ide_atapi_pc *idetape_next_pc_storage(ide_drive_t *drive)
L
Linus Torvalds 已提交
472 473 474
{
	idetape_tape_t *tape = drive->driver_data;

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

L
Linus Torvalds 已提交
477
	if (tape->pc_stack_index == IDETAPE_PC_STACK)
478
		tape->pc_stack_index = 0;
L
Linus Torvalds 已提交
479 480 481 482 483 484 485 486
	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.
 */
487

L
Linus Torvalds 已提交
488 489 490 491 492 493
/**************************************************************
 *                                                            *
 *  This should get fixed to use kmalloc(.., GFP_ATOMIC)      *
 *  followed later on by kfree().   -ml                       *
 *                                                            *
 **************************************************************/
494 495

static struct request *idetape_next_rq_storage(ide_drive_t *drive)
L
Linus Torvalds 已提交
496 497 498
{
	idetape_tape_t *tape = drive->driver_data;

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

L
Linus Torvalds 已提交
501
	if (tape->rq_stack_index == IDETAPE_PC_STACK)
502
		tape->rq_stack_index = 0;
L
Linus Torvalds 已提交
503 504 505 506
	return (&tape->rq_stack[tape->rq_stack_index++]);
}

/*
507 508
 * called on each failed packet command retry to analyze the request sense. We
 * currently do not utilize this information.
L
Linus Torvalds 已提交
509
 */
510
static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
L
Linus Torvalds 已提交
511 512
{
	idetape_tape_t *tape = drive->driver_data;
513
	struct ide_atapi_pc *pc = tape->failed_pc;
L
Linus Torvalds 已提交
514

515 516 517
	tape->sense_key = sense[2] & 0xF;
	tape->asc       = sense[12];
	tape->ascq      = sense[13];
518 519 520

	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 已提交
521

522
	/* Correct pc->xferred by asking the tape.	 */
523
	if (pc->flags & PC_FLAG_DMA_ERROR) {
524
		pc->xferred = pc->req_xfer -
525
			tape->blk_size *
526
			get_unaligned_be32(&sense[3]);
L
Linus Torvalds 已提交
527 528 529 530 531 532 533 534
		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.
	 */
535
	if ((pc->c[0] == READ_6 || pc->c[0] == WRITE_6)
536 537 538
	    /* length == 0 */
	    && pc->c[4] == 0 && pc->c[3] == 0 && pc->c[2] == 0) {
		if (tape->sense_key == 5) {
L
Linus Torvalds 已提交
539 540 541
			/* don't report an error, everything's ok */
			pc->error = 0;
			/* don't retry read/write */
542
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
543 544
		}
	}
545
	if (pc->c[0] == READ_6 && (sense[2] & 0x80)) {
L
Linus Torvalds 已提交
546
		pc->error = IDETAPE_ERROR_FILEMARK;
547
		pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
548
	}
549
	if (pc->c[0] == WRITE_6) {
550 551
		if ((sense[2] & 0x40) || (tape->sense_key == 0xd
		     && tape->asc == 0x0 && tape->ascq == 0x2)) {
L
Linus Torvalds 已提交
552
			pc->error = IDETAPE_ERROR_EOD;
553
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
554 555
		}
	}
556
	if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
557
		if (tape->sense_key == 8) {
L
Linus Torvalds 已提交
558
			pc->error = IDETAPE_ERROR_EOD;
559
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
560
		}
561
		if (!(pc->flags & PC_FLAG_ABORT) &&
562
		    pc->xferred)
L
Linus Torvalds 已提交
563 564 565 566
			pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
	}
}

567
/* Free data buffers completely. */
568
static void ide_tape_kfree_buffer(idetape_tape_t *tape)
L
Linus Torvalds 已提交
569
{
570
	struct idetape_bh *prev_bh, *bh = tape->merge_bh;
571 572 573 574 575 576 577 578 579 580 581 582

	while (bh) {
		u32 size = bh->b_size;

		while (size) {
			unsigned int order = fls(size >> PAGE_SHIFT)-1;

			if (bh->b_data)
				free_pages((unsigned long)bh->b_data, order);

			size &= (order-1);
			bh->b_data += (1 << order) * PAGE_SIZE;
L
Linus Torvalds 已提交
583 584 585 586 587
		}
		prev_bh = bh;
		bh = bh->b_reqnext;
		kfree(prev_bh);
	}
588
	kfree(tape->merge_bh);
L
Linus Torvalds 已提交
589 590 591 592 593 594 595 596 597
}

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;

598
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
599 600

	switch (uptodate) {
601 602 603
	case 0:	error = IDETAPE_ERROR_GENERAL; break;
	case 1: error = 0; break;
	default: error = uptodate;
L
Linus Torvalds 已提交
604 605 606 607 608
	}
	rq->errors = error;
	if (error)
		tape->failed_pc = NULL;

609 610 611 612 613
	if (!blk_special_request(rq)) {
		ide_end_request(drive, uptodate, nr_sects);
		return 0;
	}

614
	spin_lock_irqsave(&tape->lock, flags);
L
Linus Torvalds 已提交
615 616 617

	ide_end_drive_cmd(drive, 0, 0);

618
	spin_unlock_irqrestore(&tape->lock, flags);
L
Linus Torvalds 已提交
619 620 621
	return 0;
}

622
static void ide_tape_callback(ide_drive_t *drive)
L
Linus Torvalds 已提交
623 624
{
	idetape_tape_t *tape = drive->driver_data;
625 626
	struct ide_atapi_pc *pc = tape->pc;
	int uptodate = pc->error ? 0 : 1;
L
Linus Torvalds 已提交
627

628 629
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674
	if (pc->c[0] == REQUEST_SENSE) {
		if (uptodate)
			idetape_analyze_error(drive, pc->buf);
		else
			printk(KERN_ERR "ide-tape: Error in REQUEST SENSE "
					"itself - Aborting request!\n");
	} else if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
		struct request *rq = drive->hwif->hwgroup->rq;
		int blocks = pc->xferred / tape->blk_size;

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

		if (time_after_eq(jiffies, tape->avg_time + HZ)) {
			tape->avg_speed = tape->avg_size * HZ /
				(jiffies - tape->avg_time) / 1024;
			tape->avg_size = 0;
			tape->avg_time = jiffies;
		}

		tape->first_frame += blocks;
		rq->current_nr_sectors -= blocks;

		if (pc->error)
			uptodate = pc->error;
	} else if (pc->c[0] == READ_POSITION && uptodate) {
		u8 *readpos = tape->pc->buf;

		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");
			clear_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags);
			uptodate = 0;
		} else {
			debug_log(DBG_SENSE, "Block Location - %u\n",
					be32_to_cpu(*(u32 *)&readpos[4]));

			tape->partition = readpos[1];
			tape->first_frame = be32_to_cpu(*(u32 *)&readpos[4]);
			set_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags);
		}
L
Linus Torvalds 已提交
675
	}
676 677

	idetape_end_request(drive, uptodate, 0);
L
Linus Torvalds 已提交
678 679
}

680 681 682 683 684 685 686 687 688 689
static void idetape_init_pc(struct ide_atapi_pc *pc)
{
	memset(pc->c, 0, 12);
	pc->retries = 0;
	pc->flags = 0;
	pc->req_xfer = 0;
	pc->buf = pc->pc_buf;
	pc->buf_size = IDETAPE_PC_BUFFER_SIZE;
	pc->bh = NULL;
	pc->b_data = NULL;
690
	pc->callback = ide_tape_callback;
691 692
}

693
static void idetape_create_request_sense_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
694
{
695
	idetape_init_pc(pc);
696
	pc->c[0] = REQUEST_SENSE;
L
Linus Torvalds 已提交
697
	pc->c[4] = 20;
698
	pc->req_xfer = 20;
L
Linus Torvalds 已提交
699 700 701 702
}

static void idetape_init_rq(struct request *rq, u8 cmd)
{
703
	blk_rq_init(NULL, rq);
704
	rq->cmd_type = REQ_TYPE_SPECIAL;
L
Linus Torvalds 已提交
705 706 707 708
	rq->cmd[0] = cmd;
}

/*
709 710 711 712 713
 * 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 已提交
714
 *
715 716 717
 * 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 已提交
718
 *
719 720 721
 * 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 已提交
722
 */
723
static void idetape_queue_pc_head(ide_drive_t *drive, struct ide_atapi_pc *pc,
724
				  struct request *rq)
L
Linus Torvalds 已提交
725 726 727 728
{
	struct ide_tape_obj *tape = drive->driver_data;

	idetape_init_rq(rq, REQ_IDETAPE_PC1);
729
	rq->cmd_flags |= REQ_PREEMPT;
L
Linus Torvalds 已提交
730 731
	rq->buffer = (char *) pc;
	rq->rq_disk = tape->disk;
732
	ide_do_drive_cmd(drive, rq);
L
Linus Torvalds 已提交
733 734 735 736 737 738 739
}

/*
 *	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.
 */
740
static void idetape_retry_pc(ide_drive_t *drive)
L
Linus Torvalds 已提交
741 742
{
	idetape_tape_t *tape = drive->driver_data;
743
	struct ide_atapi_pc *pc;
L
Linus Torvalds 已提交
744 745
	struct request *rq;

746
	(void)ide_read_error(drive);
L
Linus Torvalds 已提交
747 748 749
	pc = idetape_next_pc_storage(drive);
	rq = idetape_next_rq_storage(drive);
	idetape_create_request_sense_cmd(pc);
750
	set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
L
Linus Torvalds 已提交
751 752 753 754
	idetape_queue_pc_head(drive, pc, rq);
}

/*
755 756
 * 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 已提交
757
 */
758
static void idetape_postpone_request(ide_drive_t *drive)
L
Linus Torvalds 已提交
759 760 761
{
	idetape_tape_t *tape = drive->driver_data;

762 763
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
764
	tape->postponed_rq = HWGROUP(drive)->rq;
765
	ide_stall_queue(drive, tape->dsc_poll_freq);
L
Linus Torvalds 已提交
766 767
}

768
typedef void idetape_io_buf(ide_drive_t *, struct ide_atapi_pc *, unsigned int);
769

L
Linus Torvalds 已提交
770
/*
771 772 773 774
 * 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
775
 * idetape_issue_pc.
L
Linus Torvalds 已提交
776
 */
777
static ide_startstop_t idetape_pc_intr(ide_drive_t *drive)
L
Linus Torvalds 已提交
778 779 780
{
	ide_hwif_t *hwif = drive->hwif;
	idetape_tape_t *tape = drive->driver_data;
781
	struct ide_atapi_pc *pc = tape->pc;
782 783
	xfer_func_t *xferfunc;
	idetape_io_buf *iobuf;
L
Linus Torvalds 已提交
784
	unsigned int temp;
785
	u16 bcount;
786
	u8 stat, ireason;
L
Linus Torvalds 已提交
787

788
	debug_log(DBG_PROCS, "Enter %s - interrupt handler\n", __func__);
L
Linus Torvalds 已提交
789 790

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

793
	if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
794
		if (hwif->dma_ops->dma_end(drive) || (stat & ERR_STAT)) {
795
			pc->flags |= PC_FLAG_DMA_ERROR;
L
Linus Torvalds 已提交
796
		} else {
797
			pc->xferred = pc->req_xfer;
L
Linus Torvalds 已提交
798 799
			idetape_update_buffers(pc);
		}
800 801
		debug_log(DBG_PROCS, "DMA finished\n");

L
Linus Torvalds 已提交
802 803 804
	}

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

809
		pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
810
		local_irq_enable_in_hardirq();
L
Linus Torvalds 已提交
811

812
		if ((stat & ERR_STAT) && pc->c[0] == REQUEST_SENSE)
813
			stat &= ~ERR_STAT;
814
		if ((stat & ERR_STAT) || (pc->flags & PC_FLAG_DMA_ERROR)) {
815
			/* Error detected */
816 817
			debug_log(DBG_ERR, "%s: I/O error\n", tape->name);

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

L
Linus Torvalds 已提交
826
			/* Retry operation */
827 828
			idetape_retry_pc(drive);
			return ide_stopped;
L
Linus Torvalds 已提交
829 830
		}
		pc->error = 0;
831
		if ((pc->flags & PC_FLAG_WAIT_FOR_DSC) &&
832
		    (stat & SEEK_STAT) == 0) {
L
Linus Torvalds 已提交
833 834
			/* Media access command */
			tape->dsc_polling_start = jiffies;
835
			tape->dsc_poll_freq = IDETAPE_DSC_MA_FAST;
L
Linus Torvalds 已提交
836 837 838 839 840 841 842 843
			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 */
844
		pc->callback(drive);
845
		return ide_stopped;
L
Linus Torvalds 已提交
846
	}
847 848 849

	if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
		pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
850 851
		printk(KERN_ERR "%s: The device wants to issue more interrupts "
				"in DMA mode\n", drive->name);
852
		ide_dma_off(drive);
L
Linus Torvalds 已提交
853 854 855
		return ide_do_reset(drive);
	}
	/* Get the number of bytes to transfer on this interrupt. */
856 857
	bcount = (hwif->INB(hwif->io_ports.lbah_addr) << 8) |
		  hwif->INB(hwif->io_ports.lbam_addr);
L
Linus Torvalds 已提交
858

859
	ireason = hwif->INB(hwif->io_ports.nsect_addr);
L
Linus Torvalds 已提交
860

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

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

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

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

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

/*
915
 * Packet Command Interface
L
Linus Torvalds 已提交
916
 *
917 918 919
 * 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 已提交
920
 *
921
 * The handling will be done in three stages:
L
Linus Torvalds 已提交
922
 *
923 924
 * 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 已提交
925
 *
926 927
 * 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 已提交
928
 *
929 930 931 932 933 934 935
 * 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 已提交
936
 *
937 938
 * 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 已提交
939
 *
940
 * 4. When the packet command is finished, it will be checked for errors.
L
Linus Torvalds 已提交
941
 *
942 943 944
 * 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 已提交
945
 *
946 947 948
 * 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 已提交
949
 */
950 951 952 953
static ide_startstop_t idetape_transfer_pc(ide_drive_t *drive)
{
	idetape_tape_t *tape = drive->driver_data;

954 955
	return ide_transfer_pc(drive, tape->pc, idetape_pc_intr,
			       IDETAPE_WAIT_CMD, NULL);
L
Linus Torvalds 已提交
956 957
}

958 959
static ide_startstop_t idetape_issue_pc(ide_drive_t *drive,
		struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
960 961 962
{
	idetape_tape_t *tape = drive->driver_data;

963 964
	if (tape->pc->c[0] == REQUEST_SENSE &&
	    pc->c[0] == REQUEST_SENSE) {
L
Linus Torvalds 已提交
965 966 967 968
		printk(KERN_ERR "ide-tape: possible ide-tape.c bug - "
			"Two request sense in serial were issued\n");
	}

969
	if (tape->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
L
Linus Torvalds 已提交
970 971 972 973 974
		tape->failed_pc = pc;
	/* Set the current packet command */
	tape->pc = pc;

	if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
975
		(pc->flags & PC_FLAG_ABORT)) {
L
Linus Torvalds 已提交
976
		/*
977 978 979
		 * 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 已提交
980
		 */
981
		if (!(pc->flags & PC_FLAG_ABORT)) {
982
			if (!(pc->c[0] == TEST_UNIT_READY &&
L
Linus Torvalds 已提交
983 984 985 986 987 988 989 990 991 992 993 994 995
			      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;
996
		pc->callback(drive);
997
		return ide_stopped;
L
Linus Torvalds 已提交
998
	}
999
	debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
L
Linus Torvalds 已提交
1000 1001

	pc->retries++;
1002

1003 1004
	return ide_issue_pc(drive, pc, idetape_transfer_pc,
			    IDETAPE_WAIT_CMD, NULL);
L
Linus Torvalds 已提交
1005 1006
}

1007
/* A mode sense command is used to "sense" tape parameters. */
1008
static void idetape_create_mode_sense_cmd(struct ide_atapi_pc *pc, u8 page_code)
L
Linus Torvalds 已提交
1009 1010
{
	idetape_init_pc(pc);
1011
	pc->c[0] = MODE_SENSE;
L
Linus Torvalds 已提交
1012
	if (page_code != IDETAPE_BLOCK_DESCRIPTOR)
1013 1014
		/* DBD = 1 - Don't return block descriptors */
		pc->c[1] = 8;
L
Linus Torvalds 已提交
1015 1016 1017 1018 1019 1020 1021 1022 1023
	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;
1024 1025
	/* We will just discard data in that case */
	pc->c[4] = 255;
L
Linus Torvalds 已提交
1026
	if (page_code == IDETAPE_BLOCK_DESCRIPTOR)
1027
		pc->req_xfer = 12;
L
Linus Torvalds 已提交
1028
	else if (page_code == IDETAPE_CAPABILITIES_PAGE)
1029
		pc->req_xfer = 24;
L
Linus Torvalds 已提交
1030
	else
1031
		pc->req_xfer = 50;
L
Linus Torvalds 已提交
1032 1033
}

1034
static ide_startstop_t idetape_media_access_finished(ide_drive_t *drive)
L
Linus Torvalds 已提交
1035 1036
{
	idetape_tape_t *tape = drive->driver_data;
1037
	struct ide_atapi_pc *pc = tape->pc;
1038
	u8 stat;
L
Linus Torvalds 已提交
1039

1040 1041
	stat = ide_read_status(drive);

1042 1043
	if (stat & SEEK_STAT) {
		if (stat & ERR_STAT) {
L
Linus Torvalds 已提交
1044
			/* Error detected */
1045
			if (pc->c[0] != TEST_UNIT_READY)
L
Linus Torvalds 已提交
1046 1047 1048
				printk(KERN_ERR "ide-tape: %s: I/O error, ",
						tape->name);
			/* Retry operation */
1049 1050
			idetape_retry_pc(drive);
			return ide_stopped;
L
Linus Torvalds 已提交
1051 1052 1053 1054 1055 1056 1057 1058
		}
		pc->error = 0;
		if (tape->failed_pc == pc)
			tape->failed_pc = NULL;
	} else {
		pc->error = IDETAPE_ERROR_GENERAL;
		tape->failed_pc = NULL;
	}
1059
	pc->callback(drive);
1060
	return ide_stopped;
L
Linus Torvalds 已提交
1061 1062
}

1063 1064
static void idetape_create_read_cmd(idetape_tape_t *tape,
		struct ide_atapi_pc *pc,
1065
		unsigned int length, struct idetape_bh *bh)
L
Linus Torvalds 已提交
1066 1067
{
	idetape_init_pc(pc);
1068
	pc->c[0] = READ_6;
1069
	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1070 1071 1072
	pc->c[1] = 1;
	pc->bh = bh;
	atomic_set(&bh->b_count, 0);
1073 1074 1075
	pc->buf = NULL;
	pc->buf_size = length * tape->blk_size;
	pc->req_xfer = pc->buf_size;
1076
	if (pc->req_xfer == tape->buffer_size)
1077
		pc->flags |= PC_FLAG_DMA_OK;
L
Linus Torvalds 已提交
1078 1079
}

1080 1081
static void idetape_create_write_cmd(idetape_tape_t *tape,
		struct ide_atapi_pc *pc,
1082
		unsigned int length, struct idetape_bh *bh)
L
Linus Torvalds 已提交
1083 1084
{
	idetape_init_pc(pc);
1085
	pc->c[0] = WRITE_6;
1086
	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1087
	pc->c[1] = 1;
1088
	pc->flags |= PC_FLAG_WRITING;
L
Linus Torvalds 已提交
1089 1090 1091
	pc->bh = bh;
	pc->b_data = bh->b_data;
	pc->b_count = atomic_read(&bh->b_count);
1092 1093 1094
	pc->buf = NULL;
	pc->buf_size = length * tape->blk_size;
	pc->req_xfer = pc->buf_size;
1095
	if (pc->req_xfer == tape->buffer_size)
1096
		pc->flags |= PC_FLAG_DMA_OK;
L
Linus Torvalds 已提交
1097 1098 1099 1100 1101 1102
}

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

1107 1108
	debug_log(DBG_SENSE, "sector: %ld, nr_sectors: %ld,"
			" current_nr_sectors: %d\n",
L
Linus Torvalds 已提交
1109 1110
			rq->sector, rq->nr_sectors, rq->current_nr_sectors);

1111
	if (!blk_special_request(rq)) {
1112
		/* We do not support buffer cache originated requests. */
L
Linus Torvalds 已提交
1113
		printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
1114
			"request queue (%d)\n", drive->name, rq->cmd_type);
L
Linus Torvalds 已提交
1115 1116 1117 1118
		ide_end_request(drive, 0, 0);
		return ide_stopped;
	}

1119
	/* Retry a failed packet command */
1120 1121 1122 1123
	if (tape->failed_pc && tape->pc->c[0] == REQUEST_SENSE) {
		pc = tape->failed_pc;
		goto out;
	}
1124

L
Linus Torvalds 已提交
1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138
	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.
	 */
1139
	stat = ide_read_status(drive);
L
Linus Torvalds 已提交
1140 1141

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

	if (drive->post_reset == 1) {
1145
		set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
L
Linus Torvalds 已提交
1146 1147 1148
		drive->post_reset = 0;
	}

1149
	if (!test_and_clear_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags) &&
1150
	    (stat & SEEK_STAT) == 0) {
L
Linus Torvalds 已提交
1151 1152
		if (postponed_rq == NULL) {
			tape->dsc_polling_start = jiffies;
1153
			tape->dsc_poll_freq = tape->best_dsc_rw_freq;
L
Linus Torvalds 已提交
1154 1155 1156 1157 1158 1159 1160 1161 1162 1163
			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);
			}
1164 1165 1166
		} else if (time_after(jiffies,
					tape->dsc_polling_start +
					IDETAPE_DSC_MA_THRESHOLD))
1167
			tape->dsc_poll_freq = IDETAPE_DSC_MA_SLOW;
L
Linus Torvalds 已提交
1168 1169 1170 1171 1172
		idetape_postpone_request(drive);
		return ide_stopped;
	}
	if (rq->cmd[0] & REQ_IDETAPE_READ) {
		pc = idetape_next_pc_storage(drive);
1173 1174
		idetape_create_read_cmd(tape, pc, rq->current_nr_sectors,
					(struct idetape_bh *)rq->special);
L
Linus Torvalds 已提交
1175 1176 1177 1178
		goto out;
	}
	if (rq->cmd[0] & REQ_IDETAPE_WRITE) {
		pc = idetape_next_pc_storage(drive);
1179 1180
		idetape_create_write_cmd(tape, pc, rq->current_nr_sectors,
					 (struct idetape_bh *)rq->special);
L
Linus Torvalds 已提交
1181 1182 1183
		goto out;
	}
	if (rq->cmd[0] & REQ_IDETAPE_PC1) {
1184
		pc = (struct ide_atapi_pc *) rq->buffer;
L
Linus Torvalds 已提交
1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
		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:
1195 1196 1197
	if (test_bit(IDETAPE_FLAG_DRQ_INTERRUPT, &tape->flags))
		pc->flags |= PC_FLAG_DRQ_INTERRUPT;

1198
	return idetape_issue_pc(drive, pc);
L
Linus Torvalds 已提交
1199 1200 1201
}

/*
1202
 * The function below uses __get_free_pages to allocate a data buffer of size
1203
 * tape->buffer_size (or a bit more). We attempt to combine sequential pages as
1204
 * much as possible.
L
Linus Torvalds 已提交
1205
 *
1206 1207
 * It returns a pointer to the newly allocated buffer, or NULL in case of
 * failure.
L
Linus Torvalds 已提交
1208
 */
1209 1210
static struct idetape_bh *ide_tape_kmalloc_buffer(idetape_tape_t *tape,
						  int full, int clear)
L
Linus Torvalds 已提交
1211
{
1212
	struct idetape_bh *prev_bh, *bh, *merge_bh;
1213
	int pages = tape->pages_per_buffer;
1214
	unsigned int order, b_allocd;
L
Linus Torvalds 已提交
1215 1216
	char *b_data = NULL;

1217 1218
	merge_bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
	bh = merge_bh;
L
Linus Torvalds 已提交
1219 1220
	if (bh == NULL)
		goto abort;
1221 1222 1223

	order = fls(pages) - 1;
	bh->b_data = (char *) __get_free_pages(GFP_KERNEL, order);
1224
	if (!bh->b_data)
L
Linus Torvalds 已提交
1225
		goto abort;
1226 1227 1228
	b_allocd = (1 << order) * PAGE_SIZE;
	pages &= (order-1);

L
Linus Torvalds 已提交
1229
	if (clear)
1230 1231 1232
		memset(bh->b_data, 0, b_allocd);
	bh->b_reqnext = NULL;
	bh->b_size = b_allocd;
L
Linus Torvalds 已提交
1233 1234
	atomic_set(&bh->b_count, full ? bh->b_size : 0);

1235 1236 1237
	while (pages) {
		order = fls(pages) - 1;
		b_data = (char *) __get_free_pages(GFP_KERNEL, order);
1238
		if (!b_data)
L
Linus Torvalds 已提交
1239
			goto abort;
1240 1241
		b_allocd = (1 << order) * PAGE_SIZE;

L
Linus Torvalds 已提交
1242
		if (clear)
1243 1244 1245 1246 1247 1248
			memset(b_data, 0, b_allocd);

		/* newly allocated page frames below buffer header or ...*/
		if (bh->b_data == b_data + b_allocd) {
			bh->b_size += b_allocd;
			bh->b_data -= b_allocd;
L
Linus Torvalds 已提交
1249
			if (full)
1250
				atomic_add(b_allocd, &bh->b_count);
L
Linus Torvalds 已提交
1251 1252
			continue;
		}
1253
		/* they are above the header */
L
Linus Torvalds 已提交
1254
		if (b_data == bh->b_data + bh->b_size) {
1255
			bh->b_size += b_allocd;
L
Linus Torvalds 已提交
1256
			if (full)
1257
				atomic_add(b_allocd, &bh->b_count);
L
Linus Torvalds 已提交
1258 1259 1260
			continue;
		}
		prev_bh = bh;
1261 1262
		bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
		if (!bh) {
1263
			free_pages((unsigned long) b_data, order);
L
Linus Torvalds 已提交
1264 1265 1266 1267
			goto abort;
		}
		bh->b_reqnext = NULL;
		bh->b_data = b_data;
1268
		bh->b_size = b_allocd;
L
Linus Torvalds 已提交
1269 1270
		atomic_set(&bh->b_count, full ? bh->b_size : 0);
		prev_bh->b_reqnext = bh;
1271 1272

		pages &= (order-1);
L
Linus Torvalds 已提交
1273
	}
1274

L
Linus Torvalds 已提交
1275 1276 1277
	bh->b_size -= tape->excess_bh_size;
	if (full)
		atomic_sub(tape->excess_bh_size, &bh->b_count);
1278
	return merge_bh;
L
Linus Torvalds 已提交
1279
abort:
1280
	ide_tape_kfree_buffer(tape);
L
Linus Torvalds 已提交
1281 1282 1283
	return NULL;
}

1284
static int idetape_copy_stage_from_user(idetape_tape_t *tape,
1285
					const char __user *buf, int n)
L
Linus Torvalds 已提交
1286 1287 1288
{
	struct idetape_bh *bh = tape->bh;
	int count;
1289
	int ret = 0;
L
Linus Torvalds 已提交
1290 1291 1292

	while (n) {
		if (bh == NULL) {
1293 1294
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
1295
			return 1;
L
Linus Torvalds 已提交
1296
		}
1297 1298 1299 1300 1301
		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))
1302
			ret = 1;
L
Linus Torvalds 已提交
1303 1304 1305 1306 1307 1308 1309 1310 1311 1312
		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;
1313
	return ret;
L
Linus Torvalds 已提交
1314 1315
}

1316
static int idetape_copy_stage_to_user(idetape_tape_t *tape, char __user *buf,
1317
				      int n)
L
Linus Torvalds 已提交
1318 1319 1320
{
	struct idetape_bh *bh = tape->bh;
	int count;
1321
	int ret = 0;
L
Linus Torvalds 已提交
1322 1323 1324

	while (n) {
		if (bh == NULL) {
1325 1326
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
1327
			return 1;
L
Linus Torvalds 已提交
1328 1329
		}
		count = min(tape->b_count, n);
1330 1331
		if  (copy_to_user(buf, tape->b_data, count))
			ret = 1;
L
Linus Torvalds 已提交
1332 1333 1334 1335 1336
		n -= count;
		tape->b_data += count;
		tape->b_count -= count;
		buf += count;
		if (!tape->b_count) {
1337 1338
			bh = bh->b_reqnext;
			tape->bh = bh;
L
Linus Torvalds 已提交
1339 1340 1341 1342 1343 1344
			if (bh) {
				tape->b_data = bh->b_data;
				tape->b_count = atomic_read(&bh->b_count);
			}
		}
	}
1345
	return ret;
L
Linus Torvalds 已提交
1346 1347
}

1348
static void idetape_init_merge_buffer(idetape_tape_t *tape)
L
Linus Torvalds 已提交
1349
{
1350 1351
	struct idetape_bh *bh = tape->merge_bh;
	tape->bh = tape->merge_bh;
1352

1353
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
L
Linus Torvalds 已提交
1354 1355 1356 1357 1358 1359 1360 1361
		atomic_set(&bh->b_count, 0);
	else {
		tape->b_data = bh->b_data;
		tape->b_count = atomic_read(&bh->b_count);
	}
}

/*
1362 1363
 * Write a filemark if write_filemark=1. Flush the device buffers without
 * writing a filemark otherwise.
L
Linus Torvalds 已提交
1364
 */
1365
static void idetape_create_write_filemark_cmd(ide_drive_t *drive,
1366
		struct ide_atapi_pc *pc, int write_filemark)
L
Linus Torvalds 已提交
1367 1368
{
	idetape_init_pc(pc);
1369
	pc->c[0] = WRITE_FILEMARKS;
L
Linus Torvalds 已提交
1370
	pc->c[4] = write_filemark;
1371
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1372 1373
}

1374
static void idetape_create_test_unit_ready_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1375 1376
{
	idetape_init_pc(pc);
1377
	pc->c[0] = TEST_UNIT_READY;
L
Linus Torvalds 已提交
1378 1379 1380
}

/*
1381 1382 1383 1384 1385 1386
 * 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 已提交
1387
 *
1388 1389 1390 1391
 * 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 已提交
1392
 */
1393
static int idetape_queue_pc_tail(ide_drive_t *drive, struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1394 1395
{
	struct ide_tape_obj *tape = drive->driver_data;
1396 1397
	struct request *rq;
	int error;
L
Linus Torvalds 已提交
1398

1399 1400 1401 1402 1403 1404 1405
	rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
	rq->cmd_type = REQ_TYPE_SPECIAL;
	rq->cmd[0] = REQ_IDETAPE_PC1;
	rq->buffer = (char *)pc;
	error = blk_execute_rq(drive->queue, tape->disk, rq, 0);
	blk_put_request(rq);
	return error;
L
Linus Torvalds 已提交
1406 1407
}

1408 1409
static void idetape_create_load_unload_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc, int cmd)
L
Linus Torvalds 已提交
1410 1411
{
	idetape_init_pc(pc);
1412
	pc->c[0] = START_STOP;
L
Linus Torvalds 已提交
1413
	pc->c[4] = cmd;
1414
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1415 1416 1417 1418 1419
}

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

1423
	/* Wait for the tape to become ready */
1424
	set_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags);
L
Linus Torvalds 已提交
1425 1426 1427
	timeout += jiffies;
	while (time_before(jiffies, timeout)) {
		idetape_create_test_unit_ready_cmd(&pc);
1428
		if (!idetape_queue_pc_tail(drive, &pc))
L
Linus Torvalds 已提交
1429 1430
			return 0;
		if ((tape->sense_key == 2 && tape->asc == 4 && tape->ascq == 2)
1431 1432
		    || (tape->asc == 0x3A)) {
			/* no media */
L
Linus Torvalds 已提交
1433 1434
			if (load_attempted)
				return -ENOMEDIUM;
1435 1436
			idetape_create_load_unload_cmd(drive, &pc,
							IDETAPE_LU_LOAD_MASK);
1437
			idetape_queue_pc_tail(drive, &pc);
L
Linus Torvalds 已提交
1438 1439 1440 1441 1442
			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;
1443
		msleep(100);
L
Linus Torvalds 已提交
1444 1445 1446 1447
	}
	return -EIO;
}

1448
static int idetape_flush_tape_buffers(ide_drive_t *drive)
L
Linus Torvalds 已提交
1449
{
1450
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1451 1452 1453
	int rc;

	idetape_create_write_filemark_cmd(drive, &pc, 0);
1454 1455
	rc = idetape_queue_pc_tail(drive, &pc);
	if (rc)
L
Linus Torvalds 已提交
1456 1457 1458 1459 1460
		return rc;
	idetape_wait_ready(drive, 60 * 5 * HZ);
	return 0;
}

1461
static void idetape_create_read_position_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1462 1463
{
	idetape_init_pc(pc);
1464
	pc->c[0] = READ_POSITION;
1465
	pc->req_xfer = 20;
L
Linus Torvalds 已提交
1466 1467
}

1468
static int idetape_read_position(ide_drive_t *drive)
L
Linus Torvalds 已提交
1469 1470
{
	idetape_tape_t *tape = drive->driver_data;
1471
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1472 1473
	int position;

1474
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1475 1476 1477 1478

	idetape_create_read_position_cmd(&pc);
	if (idetape_queue_pc_tail(drive, &pc))
		return -1;
1479
	position = tape->first_frame;
L
Linus Torvalds 已提交
1480 1481 1482
	return position;
}

1483 1484
static void idetape_create_locate_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc,
1485
		unsigned int block, u8 partition, int skip)
L
Linus Torvalds 已提交
1486 1487
{
	idetape_init_pc(pc);
1488
	pc->c[0] = POSITION_TO_ELEMENT;
L
Linus Torvalds 已提交
1489
	pc->c[1] = 2;
1490
	put_unaligned(cpu_to_be32(block), (unsigned int *) &pc->c[3]);
L
Linus Torvalds 已提交
1491
	pc->c[8] = partition;
1492
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1493 1494
}

1495 1496
static int idetape_create_prevent_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc, int prevent)
L
Linus Torvalds 已提交
1497 1498 1499
{
	idetape_tape_t *tape = drive->driver_data;

1500 1501
	/* device supports locking according to capabilities page */
	if (!(tape->caps[6] & 0x01))
L
Linus Torvalds 已提交
1502 1503 1504
		return 0;

	idetape_init_pc(pc);
1505
	pc->c[0] = ALLOW_MEDIUM_REMOVAL;
L
Linus Torvalds 已提交
1506 1507 1508 1509
	pc->c[4] = prevent;
	return 1;
}

1510
static void __ide_tape_discard_merge_buffer(ide_drive_t *drive)
L
Linus Torvalds 已提交
1511 1512 1513
{
	idetape_tape_t *tape = drive->driver_data;

1514
	if (tape->chrdev_dir != IDETAPE_DIR_READ)
1515
		return;
L
Linus Torvalds 已提交
1516

1517
	clear_bit(IDETAPE_FLAG_FILEMARK, &tape->flags);
1518
	tape->merge_bh_size = 0;
1519 1520 1521
	if (tape->merge_bh != NULL) {
		ide_tape_kfree_buffer(tape);
		tape->merge_bh = NULL;
L
Linus Torvalds 已提交
1522 1523
	}

1524
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1525 1526 1527
}

/*
1528 1529 1530 1531
 * 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 已提交
1532
 */
1533 1534
static int idetape_position_tape(ide_drive_t *drive, unsigned int block,
		u8 partition, int skip)
L
Linus Torvalds 已提交
1535 1536 1537
{
	idetape_tape_t *tape = drive->driver_data;
	int retval;
1538
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1539

1540
	if (tape->chrdev_dir == IDETAPE_DIR_READ)
1541
		__ide_tape_discard_merge_buffer(drive);
L
Linus Torvalds 已提交
1542 1543 1544 1545 1546 1547 1548 1549 1550 1551
	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));
}

1552
static void ide_tape_discard_merge_buffer(ide_drive_t *drive,
1553
					  int restore_position)
L
Linus Torvalds 已提交
1554 1555 1556 1557
{
	idetape_tape_t *tape = drive->driver_data;
	int seek, position;

1558
	__ide_tape_discard_merge_buffer(drive);
L
Linus Torvalds 已提交
1559 1560
	if (restore_position) {
		position = idetape_read_position(drive);
1561
		seek = position > 0 ? position : 0;
L
Linus Torvalds 已提交
1562
		if (idetape_position_tape(drive, seek, 0, 0)) {
1563
			printk(KERN_INFO "ide-tape: %s: position_tape failed in"
1564
					 " %s\n", tape->name, __func__);
L
Linus Torvalds 已提交
1565 1566 1567 1568 1569 1570
			return;
		}
	}
}

/*
1571 1572
 * Generate a read/write request for the block device interface and wait for it
 * to be serviced.
L
Linus Torvalds 已提交
1573
 */
1574 1575
static int idetape_queue_rw_tail(ide_drive_t *drive, int cmd, int blocks,
				 struct idetape_bh *bh)
L
Linus Torvalds 已提交
1576 1577
{
	idetape_tape_t *tape = drive->driver_data;
1578 1579
	struct request *rq;
	int ret, errors;
L
Linus Torvalds 已提交
1580

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

1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595
	rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
	rq->cmd_type = REQ_TYPE_SPECIAL;
	rq->cmd[0] = cmd;
	rq->rq_disk = tape->disk;
	rq->special = (void *)bh;
	rq->sector = tape->first_frame;
	rq->nr_sectors = blocks;
	rq->current_nr_sectors = blocks;
	blk_execute_rq(drive->queue, tape->disk, rq, 0);

	errors = rq->errors;
	ret = tape->blk_size * (blocks - rq->current_nr_sectors);
	blk_put_request(rq);
L
Linus Torvalds 已提交
1596 1597 1598 1599

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

1600 1601
	if (tape->merge_bh)
		idetape_init_merge_buffer(tape);
1602
	if (errors == IDETAPE_ERROR_GENERAL)
L
Linus Torvalds 已提交
1603
		return -EIO;
1604
	return ret;
L
Linus Torvalds 已提交
1605 1606
}

1607
static void idetape_create_inquiry_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1608 1609
{
	idetape_init_pc(pc);
1610
	pc->c[0] = INQUIRY;
1611
	pc->c[4] = 254;
1612
	pc->req_xfer = 254;
L
Linus Torvalds 已提交
1613 1614
}

1615 1616
static void idetape_create_rewind_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1617 1618
{
	idetape_init_pc(pc);
1619
	pc->c[0] = REZERO_UNIT;
1620
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1621 1622
}

1623
static void idetape_create_erase_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1624 1625
{
	idetape_init_pc(pc);
1626
	pc->c[0] = ERASE;
L
Linus Torvalds 已提交
1627
	pc->c[1] = 1;
1628
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1629 1630
}

1631
static void idetape_create_space_cmd(struct ide_atapi_pc *pc, int count, u8 cmd)
L
Linus Torvalds 已提交
1632 1633
{
	idetape_init_pc(pc);
1634
	pc->c[0] = SPACE;
1635
	put_unaligned(cpu_to_be32(count), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1636
	pc->c[1] = cmd;
1637
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1638 1639
}

1640
/* Queue up a character device originated write request. */
1641
static int idetape_add_chrdev_write_request(ide_drive_t *drive, int blocks)
L
Linus Torvalds 已提交
1642 1643 1644
{
	idetape_tape_t *tape = drive->driver_data;

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

1647
	return idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE,
1648
				     blocks, tape->merge_bh);
L
Linus Torvalds 已提交
1649 1650
}

1651
static void ide_tape_flush_merge_buffer(ide_drive_t *drive)
L
Linus Torvalds 已提交
1652 1653 1654 1655
{
	idetape_tape_t *tape = drive->driver_data;
	int blocks, min;
	struct idetape_bh *bh;
1656

1657
	if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
1658
		printk(KERN_ERR "ide-tape: bug: Trying to empty merge buffer"
1659
				" but we are not writing.\n");
L
Linus Torvalds 已提交
1660 1661
		return;
	}
1662
	if (tape->merge_bh_size > tape->buffer_size) {
L
Linus Torvalds 已提交
1663
		printk(KERN_ERR "ide-tape: bug: merge_buffer too big\n");
1664
		tape->merge_bh_size = tape->buffer_size;
L
Linus Torvalds 已提交
1665
	}
1666 1667 1668
	if (tape->merge_bh_size) {
		blocks = tape->merge_bh_size / tape->blk_size;
		if (tape->merge_bh_size % tape->blk_size) {
L
Linus Torvalds 已提交
1669 1670 1671
			unsigned int i;

			blocks++;
1672
			i = tape->blk_size - tape->merge_bh_size %
1673
				tape->blk_size;
L
Linus Torvalds 已提交
1674 1675 1676 1677 1678 1679 1680 1681
			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) {
1682 1683
					printk(KERN_INFO "ide-tape: bug,"
							 " bh NULL\n");
L
Linus Torvalds 已提交
1684 1685
					break;
				}
1686 1687 1688 1689
				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 已提交
1690 1691 1692 1693 1694 1695
				atomic_add(min, &bh->b_count);
				i -= min;
				bh = bh->b_reqnext;
			}
		}
		(void) idetape_add_chrdev_write_request(drive, blocks);
1696
		tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1697
	}
1698 1699 1700
	if (tape->merge_bh != NULL) {
		ide_tape_kfree_buffer(tape);
		tape->merge_bh = NULL;
L
Linus Torvalds 已提交
1701
	}
1702
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1703 1704
}

1705
static int idetape_init_read(ide_drive_t *drive)
L
Linus Torvalds 已提交
1706 1707 1708 1709 1710
{
	idetape_tape_t *tape = drive->driver_data;
	int bytes_read;

	/* Initialize read operation */
1711 1712
	if (tape->chrdev_dir != IDETAPE_DIR_READ) {
		if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
1713
			ide_tape_flush_merge_buffer(drive);
L
Linus Torvalds 已提交
1714 1715
			idetape_flush_tape_buffers(drive);
		}
1716
		if (tape->merge_bh || tape->merge_bh_size) {
1717
			printk(KERN_ERR "ide-tape: merge_bh_size should be"
1718
					 " 0 now\n");
1719
			tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1720
		}
1721 1722
		tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
		if (!tape->merge_bh)
L
Linus Torvalds 已提交
1723
			return -ENOMEM;
1724
		tape->chrdev_dir = IDETAPE_DIR_READ;
L
Linus Torvalds 已提交
1725 1726

		/*
1727 1728 1729 1730
		 * 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 已提交
1731 1732
		 */
		if (drive->dsc_overlap) {
1733 1734
			bytes_read = idetape_queue_rw_tail(drive,
							REQ_IDETAPE_READ, 0,
1735
							tape->merge_bh);
L
Linus Torvalds 已提交
1736
			if (bytes_read < 0) {
1737 1738
				ide_tape_kfree_buffer(tape);
				tape->merge_bh = NULL;
1739
				tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1740 1741 1742 1743
				return bytes_read;
			}
		}
	}
1744

L
Linus Torvalds 已提交
1745 1746 1747
	return 0;
}

1748
/* called from idetape_chrdev_read() to service a chrdev read request. */
1749
static int idetape_add_chrdev_read_request(ide_drive_t *drive, int blocks)
L
Linus Torvalds 已提交
1750 1751 1752
{
	idetape_tape_t *tape = drive->driver_data;

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

1755
	/* If we are at a filemark, return a read length of 0 */
1756
	if (test_bit(IDETAPE_FLAG_FILEMARK, &tape->flags))
L
Linus Torvalds 已提交
1757 1758
		return 0;

1759
	idetape_init_read(drive);
1760 1761

	return idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, blocks,
1762
				     tape->merge_bh);
L
Linus Torvalds 已提交
1763 1764
}

1765
static void idetape_pad_zeros(ide_drive_t *drive, int bcount)
L
Linus Torvalds 已提交
1766 1767 1768 1769
{
	idetape_tape_t *tape = drive->driver_data;
	struct idetape_bh *bh;
	int blocks;
1770

L
Linus Torvalds 已提交
1771 1772 1773
	while (bcount) {
		unsigned int count;

1774
		bh = tape->merge_bh;
1775
		count = min(tape->buffer_size, bcount);
L
Linus Torvalds 已提交
1776
		bcount -= count;
1777
		blocks = count / tape->blk_size;
L
Linus Torvalds 已提交
1778
		while (count) {
1779 1780
			atomic_set(&bh->b_count,
				   min(count, (unsigned int)bh->b_size));
L
Linus Torvalds 已提交
1781 1782 1783 1784
			memset(bh->b_data, 0, atomic_read(&bh->b_count));
			count -= atomic_read(&bh->b_count);
			bh = bh->b_reqnext;
		}
1785
		idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks,
1786
				      tape->merge_bh);
L
Linus Torvalds 已提交
1787 1788 1789 1790
	}
}

/*
1791 1792 1793
 * Rewinds the tape to the Beginning Of the current Partition (BOP). We
 * currently support only one partition.
 */
1794
static int idetape_rewind_tape(ide_drive_t *drive)
L
Linus Torvalds 已提交
1795 1796
{
	int retval;
1797
	struct ide_atapi_pc pc;
1798 1799 1800 1801 1802
	idetape_tape_t *tape;
	tape = drive->driver_data;

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

L
Linus Torvalds 已提交
1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814
	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;
}

1815
/* mtio.h compatible commands should be issued to the chrdev interface. */
1816 1817
static int idetape_blkdev_ioctl(ide_drive_t *drive, unsigned int cmd,
				unsigned long arg)
L
Linus Torvalds 已提交
1818 1819 1820 1821
{
	idetape_tape_t *tape = drive->driver_data;
	void __user *argp = (void __user *)arg;

1822 1823 1824 1825 1826 1827
	struct idetape_config {
		int dsc_rw_frequency;
		int dsc_media_access_frequency;
		int nr_stages;
	} config;

1828 1829
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
1830
	switch (cmd) {
1831 1832 1833 1834 1835 1836 1837
	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;
1838
		config.nr_stages = 1;
1839 1840 1841 1842 1843
		if (copy_to_user(argp, &config, sizeof(config)))
			return -EFAULT;
		break;
	default:
		return -EIO;
L
Linus Torvalds 已提交
1844 1845 1846 1847
	}
	return 0;
}

1848 1849
static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op,
					int mt_count)
L
Linus Torvalds 已提交
1850 1851
{
	idetape_tape_t *tape = drive->driver_data;
1852
	struct ide_atapi_pc pc;
1853
	int retval, count = 0;
1854
	int sprev = !!(tape->caps[4] & 0x20);
L
Linus Torvalds 已提交
1855 1856 1857 1858

	if (mt_count == 0)
		return 0;
	if (MTBSF == mt_op || MTBSFM == mt_op) {
1859
		if (!sprev)
L
Linus Torvalds 已提交
1860
			return -EIO;
1861
		mt_count = -mt_count;
L
Linus Torvalds 已提交
1862 1863
	}

1864
	if (tape->chrdev_dir == IDETAPE_DIR_READ) {
1865
		tape->merge_bh_size = 0;
1866
		if (test_and_clear_bit(IDETAPE_FLAG_FILEMARK, &tape->flags))
L
Linus Torvalds 已提交
1867
			++count;
1868
		ide_tape_discard_merge_buffer(drive, 0);
L
Linus Torvalds 已提交
1869 1870 1871
	}

	switch (mt_op) {
1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890
	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 已提交
1891 1892 1893 1894
	}
}

/*
1895
 * Our character device read / write functions.
L
Linus Torvalds 已提交
1896
 *
1897 1898 1899
 * 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 已提交
1900
 *
1901 1902 1903 1904 1905 1906 1907
 * 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 已提交
1908
 */
1909 1910
static ssize_t idetape_chrdev_read(struct file *file, char __user *buf,
				   size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
1911 1912 1913
{
	struct ide_tape_obj *tape = ide_tape_f(file);
	ide_drive_t *drive = tape->drive;
1914
	ssize_t bytes_read, temp, actually_read = 0, rc;
1915
	ssize_t ret = 0;
1916
	u16 ctl = *(u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
1917

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

1920
	if (tape->chrdev_dir != IDETAPE_DIR_READ) {
1921
		if (test_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags))
1922 1923 1924
			if (count > tape->blk_size &&
			    (count % tape->blk_size) == 0)
				tape->user_bs_factor = count / tape->blk_size;
L
Linus Torvalds 已提交
1925
	}
1926
	rc = idetape_init_read(drive);
1927
	if (rc < 0)
L
Linus Torvalds 已提交
1928 1929 1930
		return rc;
	if (count == 0)
		return (0);
1931 1932
	if (tape->merge_bh_size) {
		actually_read = min((unsigned int)(tape->merge_bh_size),
1933
				    (unsigned int)count);
1934
		if (idetape_copy_stage_to_user(tape, buf, actually_read))
1935
			ret = -EFAULT;
L
Linus Torvalds 已提交
1936
		buf += actually_read;
1937
		tape->merge_bh_size -= actually_read;
L
Linus Torvalds 已提交
1938 1939
		count -= actually_read;
	}
1940
	while (count >= tape->buffer_size) {
1941
		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
L
Linus Torvalds 已提交
1942 1943
		if (bytes_read <= 0)
			goto finish;
1944
		if (idetape_copy_stage_to_user(tape, buf, bytes_read))
1945
			ret = -EFAULT;
L
Linus Torvalds 已提交
1946 1947 1948 1949 1950
		buf += bytes_read;
		count -= bytes_read;
		actually_read += bytes_read;
	}
	if (count) {
1951
		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
L
Linus Torvalds 已提交
1952 1953 1954
		if (bytes_read <= 0)
			goto finish;
		temp = min((unsigned long)count, (unsigned long)bytes_read);
1955
		if (idetape_copy_stage_to_user(tape, buf, temp))
1956
			ret = -EFAULT;
L
Linus Torvalds 已提交
1957
		actually_read += temp;
1958
		tape->merge_bh_size = bytes_read-temp;
L
Linus Torvalds 已提交
1959 1960
	}
finish:
1961
	if (!actually_read && test_bit(IDETAPE_FLAG_FILEMARK, &tape->flags)) {
1962 1963
		debug_log(DBG_SENSE, "%s: spacing over filemark\n", tape->name);

L
Linus Torvalds 已提交
1964 1965 1966
		idetape_space_over_filemarks(drive, MTFSF, 1);
		return 0;
	}
1967

1968
	return ret ? ret : actually_read;
L
Linus Torvalds 已提交
1969 1970
}

1971
static ssize_t idetape_chrdev_write(struct file *file, const char __user *buf,
L
Linus Torvalds 已提交
1972 1973 1974 1975
				     size_t count, loff_t *ppos)
{
	struct ide_tape_obj *tape = ide_tape_f(file);
	ide_drive_t *drive = tape->drive;
1976 1977
	ssize_t actually_written = 0;
	ssize_t ret = 0;
1978
	u16 ctl = *(u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
1979 1980 1981 1982 1983

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

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

	/* Initialize write operation */
1987 1988
	if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
		if (tape->chrdev_dir == IDETAPE_DIR_READ)
1989
			ide_tape_discard_merge_buffer(drive, 1);
1990
		if (tape->merge_bh || tape->merge_bh_size) {
1991
			printk(KERN_ERR "ide-tape: merge_bh_size "
L
Linus Torvalds 已提交
1992
				"should be 0 now\n");
1993
			tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1994
		}
1995 1996
		tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
		if (!tape->merge_bh)
L
Linus Torvalds 已提交
1997
			return -ENOMEM;
1998
		tape->chrdev_dir = IDETAPE_DIR_WRITE;
1999
		idetape_init_merge_buffer(tape);
L
Linus Torvalds 已提交
2000 2001

		/*
2002 2003 2004 2005
		 * 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 已提交
2006 2007
		 */
		if (drive->dsc_overlap) {
2008 2009
			ssize_t retval = idetape_queue_rw_tail(drive,
							REQ_IDETAPE_WRITE, 0,
2010
							tape->merge_bh);
L
Linus Torvalds 已提交
2011
			if (retval < 0) {
2012 2013
				ide_tape_kfree_buffer(tape);
				tape->merge_bh = NULL;
2014
				tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
2015 2016 2017 2018 2019 2020
				return retval;
			}
		}
	}
	if (count == 0)
		return (0);
2021 2022
	if (tape->merge_bh_size) {
		if (tape->merge_bh_size >= tape->buffer_size) {
2023
			printk(KERN_ERR "ide-tape: bug: merge buf too big\n");
2024
			tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
2025
		}
2026
		actually_written = min((unsigned int)
2027
				(tape->buffer_size - tape->merge_bh_size),
2028
				(unsigned int)count);
2029
		if (idetape_copy_stage_from_user(tape, buf, actually_written))
2030
				ret = -EFAULT;
L
Linus Torvalds 已提交
2031
		buf += actually_written;
2032
		tape->merge_bh_size += actually_written;
L
Linus Torvalds 已提交
2033 2034
		count -= actually_written;

2035
		if (tape->merge_bh_size == tape->buffer_size) {
2036
			ssize_t retval;
2037
			tape->merge_bh_size = 0;
2038
			retval = idetape_add_chrdev_write_request(drive, ctl);
L
Linus Torvalds 已提交
2039 2040 2041 2042
			if (retval <= 0)
				return (retval);
		}
	}
2043
	while (count >= tape->buffer_size) {
2044
		ssize_t retval;
2045
		if (idetape_copy_stage_from_user(tape, buf, tape->buffer_size))
2046
			ret = -EFAULT;
2047 2048
		buf += tape->buffer_size;
		count -= tape->buffer_size;
2049
		retval = idetape_add_chrdev_write_request(drive, ctl);
2050
		actually_written += tape->buffer_size;
L
Linus Torvalds 已提交
2051 2052 2053 2054 2055
		if (retval <= 0)
			return (retval);
	}
	if (count) {
		actually_written += count;
2056
		if (idetape_copy_stage_from_user(tape, buf, count))
2057
			ret = -EFAULT;
2058
		tape->merge_bh_size += count;
L
Linus Torvalds 已提交
2059
	}
2060
	return ret ? ret : actually_written;
L
Linus Torvalds 已提交
2061 2062
}

2063
static int idetape_write_filemark(ide_drive_t *drive)
L
Linus Torvalds 已提交
2064
{
2065
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076

	/* 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;
}

/*
2077 2078
 * Called from idetape_chrdev_ioctl when the general mtio MTIOCTOP ioctl is
 * requested.
L
Linus Torvalds 已提交
2079
 *
2080 2081
 * 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
2082
 * usually not supported.
L
Linus Torvalds 已提交
2083
 *
2084
 * The following commands are currently not supported:
L
Linus Torvalds 已提交
2085
 *
2086 2087
 * MTFSS, MTBSS, MTWSM, MTSETDENSITY, MTSETDRVBUFFER, MT_ST_BOOLEANS,
 * MT_ST_WRITE_THRESHOLD.
L
Linus Torvalds 已提交
2088
 */
2089
static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
L
Linus Torvalds 已提交
2090 2091
{
	idetape_tape_t *tape = drive->driver_data;
2092
	struct ide_atapi_pc pc;
2093
	int i, retval;
L
Linus Torvalds 已提交
2094

2095 2096
	debug_log(DBG_ERR, "Handling MTIOCTOP ioctl: mt_op=%d, mt_count=%d\n",
			mt_op, mt_count);
2097

L
Linus Torvalds 已提交
2098
	switch (mt_op) {
2099 2100 2101 2102 2103 2104 2105 2106 2107
	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 已提交
2108
	}
2109

L
Linus Torvalds 已提交
2110
	switch (mt_op) {
2111 2112 2113
	case MTWEOF:
		if (tape->write_prot)
			return -EACCES;
2114
		ide_tape_discard_merge_buffer(drive, 1);
2115 2116 2117 2118 2119 2120 2121
		for (i = 0; i < mt_count; i++) {
			retval = idetape_write_filemark(drive);
			if (retval)
				return retval;
		}
		return 0;
	case MTREW:
2122
		ide_tape_discard_merge_buffer(drive, 0);
2123 2124 2125 2126
		if (idetape_rewind_tape(drive))
			return -EIO;
		return 0;
	case MTLOAD:
2127
		ide_tape_discard_merge_buffer(drive, 0);
2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141
		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;
		}
2142
		ide_tape_discard_merge_buffer(drive, 0);
2143 2144 2145 2146
		idetape_create_load_unload_cmd(drive, &pc,
					      !IDETAPE_LU_LOAD_MASK);
		retval = idetape_queue_pc_tail(drive, &pc);
		if (!retval)
2147
			clear_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags);
2148 2149
		return retval;
	case MTNOP:
2150
		ide_tape_discard_merge_buffer(drive, 0);
2151 2152
		return idetape_flush_tape_buffers(drive);
	case MTRETEN:
2153
		ide_tape_discard_merge_buffer(drive, 0);
2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167
		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 已提交
2168
				return -EIO;
2169
			tape->user_bs_factor = mt_count / tape->blk_size;
2170
			clear_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags);
2171
		} else
2172
			set_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags);
2173 2174
		return 0;
	case MTSEEK:
2175
		ide_tape_discard_merge_buffer(drive, 0);
2176 2177 2178
		return idetape_position_tape(drive,
			mt_count * tape->user_bs_factor, tape->partition, 0);
	case MTSETPART:
2179
		ide_tape_discard_merge_buffer(drive, 0);
2180 2181 2182 2183 2184
		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 已提交
2185
			return 0;
2186 2187
		retval = idetape_queue_pc_tail(drive, &pc);
		if (retval)
L
Linus Torvalds 已提交
2188
			return retval;
2189 2190 2191 2192
		tape->door_locked = DOOR_EXPLICITLY_LOCKED;
		return 0;
	case MTUNLOCK:
		if (!idetape_create_prevent_cmd(drive, &pc, 0))
L
Linus Torvalds 已提交
2193
			return 0;
2194 2195 2196 2197 2198 2199 2200 2201 2202
		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 已提交
2203 2204 2205 2206
	}
}

/*
2207 2208 2209
 * 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 已提交
2210
 */
2211 2212
static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
				unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
2213 2214 2215 2216 2217 2218
{
	struct ide_tape_obj *tape = ide_tape_f(file);
	ide_drive_t *drive = tape->drive;
	struct mtop mtop;
	struct mtget mtget;
	struct mtpos mtpos;
2219
	int block_offset = 0, position = tape->first_frame;
L
Linus Torvalds 已提交
2220 2221
	void __user *argp = (void __user *)arg;

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

2224
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
2225
		ide_tape_flush_merge_buffer(drive);
L
Linus Torvalds 已提交
2226 2227 2228
		idetape_flush_tape_buffers(drive);
	}
	if (cmd == MTIOCGET || cmd == MTIOCPOS) {
2229
		block_offset = tape->merge_bh_size /
2230
			(tape->blk_size * tape->user_bs_factor);
2231 2232
		position = idetape_read_position(drive);
		if (position < 0)
L
Linus Torvalds 已提交
2233 2234 2235
			return -EIO;
	}
	switch (cmd) {
2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260
	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)
2261
			ide_tape_discard_merge_buffer(drive, 1);
2262
		return idetape_blkdev_ioctl(drive, cmd, arg);
L
Linus Torvalds 已提交
2263 2264 2265
	}
}

2266 2267 2268 2269 2270 2271 2272
/*
 * 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;
2273
	struct ide_atapi_pc pc;
2274 2275 2276 2277

	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");
2278
		if (tape->blk_size == 0) {
2279 2280
			printk(KERN_WARNING "ide-tape: Cannot deal with zero "
					    "block size, assuming 32k\n");
2281
			tape->blk_size = 32768;
2282 2283 2284
		}
		return;
	}
2285 2286 2287 2288
	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;
2289
}
L
Linus Torvalds 已提交
2290

2291
static int idetape_chrdev_open(struct inode *inode, struct file *filp)
L
Linus Torvalds 已提交
2292 2293 2294 2295
{
	unsigned int minor = iminor(inode), i = minor & ~0xc0;
	ide_drive_t *drive;
	idetape_tape_t *tape;
2296
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
2297 2298
	int retval;

2299 2300 2301 2302 2303 2304 2305 2306 2307
	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 已提交
2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318
	/*
	 * 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;

2319
	if (test_and_set_bit(IDETAPE_FLAG_BUSY, &tape->flags)) {
L
Linus Torvalds 已提交
2320 2321 2322 2323 2324 2325
		retval = -EBUSY;
		goto out_put_tape;
	}

	retval = idetape_wait_ready(drive, 60 * HZ);
	if (retval) {
2326
		clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
L
Linus Torvalds 已提交
2327 2328 2329 2330 2331
		printk(KERN_ERR "ide-tape: %s: drive not ready\n", tape->name);
		goto out_put_tape;
	}

	idetape_read_position(drive);
2332
	if (!test_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags))
L
Linus Torvalds 已提交
2333 2334 2335
		(void)idetape_rewind_tape(drive);

	/* Read block size and write protect status from drive. */
2336
	ide_tape_get_bsize_from_bdesc(drive);
L
Linus Torvalds 已提交
2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347

	/* 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) {
2348
			clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
L
Linus Torvalds 已提交
2349 2350 2351 2352 2353
			retval = -EROFS;
			goto out_put_tape;
		}
	}

2354
	/* Lock the tape drive door so user can't eject. */
2355
	if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
L
Linus Torvalds 已提交
2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369
		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;
}

2370
static void idetape_write_release(ide_drive_t *drive, unsigned int minor)
L
Linus Torvalds 已提交
2371 2372 2373
{
	idetape_tape_t *tape = drive->driver_data;

2374
	ide_tape_flush_merge_buffer(drive);
2375 2376
	tape->merge_bh = ide_tape_kmalloc_buffer(tape, 1, 0);
	if (tape->merge_bh != NULL) {
2377 2378
		idetape_pad_zeros(drive, tape->blk_size *
				(tape->user_bs_factor - 1));
2379 2380
		ide_tape_kfree_buffer(tape);
		tape->merge_bh = NULL;
L
Linus Torvalds 已提交
2381 2382 2383 2384 2385 2386
	}
	idetape_write_filemark(drive);
	idetape_flush_tape_buffers(drive);
	idetape_flush_tape_buffers(drive);
}

2387
static int idetape_chrdev_release(struct inode *inode, struct file *filp)
L
Linus Torvalds 已提交
2388 2389 2390
{
	struct ide_tape_obj *tape = ide_tape_f(filp);
	ide_drive_t *drive = tape->drive;
2391
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
2392 2393 2394 2395
	unsigned int minor = iminor(inode);

	lock_kernel();
	tape = drive->driver_data;
2396 2397

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

2399
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
L
Linus Torvalds 已提交
2400
		idetape_write_release(drive, minor);
2401
	if (tape->chrdev_dir == IDETAPE_DIR_READ) {
L
Linus Torvalds 已提交
2402
		if (minor < 128)
2403
			ide_tape_discard_merge_buffer(drive, 1);
L
Linus Torvalds 已提交
2404
	}
2405

2406
	if (minor < 128 && test_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags))
L
Linus Torvalds 已提交
2407
		(void) idetape_rewind_tape(drive);
2408
	if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
L
Linus Torvalds 已提交
2409 2410 2411 2412 2413 2414 2415
		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;
			}
		}
	}
2416
	clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
L
Linus Torvalds 已提交
2417 2418 2419 2420 2421 2422
	ide_tape_put(tape);
	unlock_kernel();
	return 0;
}

/*
2423
 * check the contents of the ATAPI IDENTIFY command results. We return:
L
Linus Torvalds 已提交
2424
 *
2425 2426
 * 1 - If the tape can be supported by us, based on the information we have so
 * far.
L
Linus Torvalds 已提交
2427
 *
2428
 * 0 - If this tape driver is not currently supported by us.
L
Linus Torvalds 已提交
2429
 */
2430
static int idetape_identify_device(ide_drive_t *drive)
L
Linus Torvalds 已提交
2431
{
2432
	u8 gcw[2], protocol, device_type, removable, packet_size;
L
Linus Torvalds 已提交
2433 2434 2435 2436

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

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

2439 2440 2441 2442
	protocol	=   (gcw[1] & 0xC0) >> 6;
	device_type	=    gcw[1] & 0x1F;
	removable	= !!(gcw[0] & 0x80);
	packet_size	=    gcw[0] & 0x3;
L
Linus Torvalds 已提交
2443

2444 2445
	/* Check that we can support this device */
	if (protocol != 2)
2446
		printk(KERN_ERR "ide-tape: Protocol (0x%02x) is not ATAPI\n",
2447 2448
				protocol);
	else if (device_type != 1)
2449
		printk(KERN_ERR "ide-tape: Device type (0x%02x) is not set "
2450 2451
				"to tape\n", device_type);
	else if (!removable)
L
Linus Torvalds 已提交
2452
		printk(KERN_ERR "ide-tape: The removable flag is not set\n");
2453
	else if (packet_size != 0) {
2454 2455
		printk(KERN_ERR "ide-tape: Packet size (0x%02x) is not 12"
				" bytes\n", packet_size);
L
Linus Torvalds 已提交
2456 2457 2458 2459 2460
	} else
		return 1;
	return 0;
}

2461
static void idetape_get_inquiry_results(ide_drive_t *drive)
L
Linus Torvalds 已提交
2462 2463
{
	idetape_tape_t *tape = drive->driver_data;
2464
	struct ide_atapi_pc pc;
2465
	char fw_rev[6], vendor_id[10], product_id[18];
2466

L
Linus Torvalds 已提交
2467 2468
	idetape_create_inquiry_cmd(&pc);
	if (idetape_queue_pc_tail(drive, &pc)) {
2469 2470
		printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
				tape->name);
L
Linus Torvalds 已提交
2471 2472
		return;
	}
2473 2474 2475
	memcpy(vendor_id, &pc.buf[8], 8);
	memcpy(product_id, &pc.buf[16], 16);
	memcpy(fw_rev, &pc.buf[32], 4);
2476 2477 2478 2479 2480

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

2481
	printk(KERN_INFO "ide-tape: %s <-> %s: %s %s rev %s\n",
2482
			drive->name, tape->name, vendor_id, product_id, fw_rev);
L
Linus Torvalds 已提交
2483 2484 2485
}

/*
2486 2487
 * 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 已提交
2488
 */
2489
static void idetape_get_mode_sense_results(ide_drive_t *drive)
L
Linus Torvalds 已提交
2490 2491
{
	idetape_tape_t *tape = drive->driver_data;
2492
	struct ide_atapi_pc pc;
2493 2494
	u8 *caps;
	u8 speed, max_speed;
2495

L
Linus Torvalds 已提交
2496 2497
	idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
	if (idetape_queue_pc_tail(drive, &pc)) {
2498 2499
		printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
				" some default values\n");
2500
		tape->blk_size = 512;
2501 2502 2503
		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 已提交
2504 2505
		return;
	}
2506
	caps = pc.buf + 4 + pc.buf[3];
2507 2508 2509 2510

	/* 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 已提交
2511

2512 2513 2514 2515
	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 已提交
2516

2517 2518 2519 2520
	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 已提交
2521
	}
2522 2523 2524 2525
	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 已提交
2526 2527
	}

2528 2529
	memcpy(&tape->caps, caps, 20);
	if (caps[7] & 0x02)
2530
		tape->blk_size = 512;
2531
	else if (caps[7] & 0x04)
2532
		tape->blk_size = 1024;
L
Linus Torvalds 已提交
2533 2534
}

2535
#ifdef CONFIG_IDE_PROC_FS
2536
static void idetape_add_settings(ide_drive_t *drive)
L
Linus Torvalds 已提交
2537 2538 2539
{
	idetape_tape_t *tape = drive->driver_data;

2540 2541 2542 2543
	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);
2544 2545
	ide_add_setting(drive, "buffer_size", SETTING_READ, TYPE_INT, 0, 0xffff,
			1, 1024, &tape->buffer_size, NULL);
2546 2547 2548
	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);
2549 2550 2551 2552
	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);
2553 2554
	ide_add_setting(drive, "debug_mask", SETTING_RW, TYPE_INT, 0, 0xffff, 1,
			1, &tape->debug_mask, NULL);
L
Linus Torvalds 已提交
2555
}
2556 2557 2558
#else
static inline void idetape_add_settings(ide_drive_t *drive) { ; }
#endif
L
Linus Torvalds 已提交
2559 2560

/*
2561
 * The function below is called to:
L
Linus Torvalds 已提交
2562
 *
2563 2564 2565 2566
 * 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 已提交
2567
 *
2568 2569
 * 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 已提交
2570
 */
2571
static void idetape_setup(ide_drive_t *drive, idetape_tape_t *tape, int minor)
L
Linus Torvalds 已提交
2572
{
2573
	unsigned long t;
L
Linus Torvalds 已提交
2574
	int speed;
2575
	int buffer_size;
2576
	u8 gcw[2];
2577
	u16 *ctl = (u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
2578

2579
	spin_lock_init(&tape->lock);
L
Linus Torvalds 已提交
2580
	drive->dsc_overlap = 1;
2581 2582 2583 2584
	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 已提交
2585 2586 2587 2588 2589 2590 2591 2592
	}
	/* 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;
2593
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
2594 2595
	tape->pc = tape->pc_stack;
	*((unsigned short *) &gcw) = drive->id->config;
2596 2597 2598

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

	idetape_get_inquiry_results(drive);
	idetape_get_mode_sense_results(drive);
2603
	ide_tape_get_bsize_from_bdesc(drive);
L
Linus Torvalds 已提交
2604
	tape->user_bs_factor = 1;
2605 2606
	tape->buffer_size = *ctl * tape->blk_size;
	while (tape->buffer_size > 0xffff) {
L
Linus Torvalds 已提交
2607
		printk(KERN_NOTICE "ide-tape: decreasing stage size\n");
2608
		*ctl /= 2;
2609
		tape->buffer_size = *ctl * tape->blk_size;
L
Linus Torvalds 已提交
2610
	}
2611
	buffer_size = tape->buffer_size;
2612
	tape->pages_per_buffer = buffer_size / PAGE_SIZE;
2613
	if (buffer_size % PAGE_SIZE) {
2614
		tape->pages_per_buffer++;
2615
		tape->excess_bh_size = PAGE_SIZE - buffer_size % PAGE_SIZE;
L
Linus Torvalds 已提交
2616 2617
	}

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

2621
	t = (IDETAPE_FIFO_THRESHOLD * tape->buffer_size * HZ) / (speed * 1000);
L
Linus Torvalds 已提交
2622 2623

	/*
2624 2625
	 * Ensure that the number we got makes sense; limit it within
	 * IDETAPE_DSC_RW_MIN and IDETAPE_DSC_RW_MAX.
L
Linus Torvalds 已提交
2626
	 */
2627 2628
	tape->best_dsc_rw_freq = clamp_t(unsigned long, t, IDETAPE_DSC_RW_MIN,
					 IDETAPE_DSC_RW_MAX);
L
Linus Torvalds 已提交
2629
	printk(KERN_INFO "ide-tape: %s <-> %s: %dKBps, %d*%dkB buffer, "
2630
		"%lums tDSC%s\n",
2631
		drive->name, tape->name, *(u16 *)&tape->caps[14],
2632 2633
		(*(u16 *)&tape->caps[16] * 512) / tape->buffer_size,
		tape->buffer_size / 1024,
2634
		tape->best_dsc_rw_freq * 1000 / HZ,
L
Linus Torvalds 已提交
2635 2636 2637 2638 2639
		drive->using_dma ? ", DMA":"");

	idetape_add_settings(drive);
}

2640
static void ide_tape_remove(ide_drive_t *drive)
L
Linus Torvalds 已提交
2641 2642 2643
{
	idetape_tape_t *tape = drive->driver_data;

2644
	ide_proc_unregister_driver(drive, tape->driver);
L
Linus Torvalds 已提交
2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656

	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;

2657
	BUG_ON(tape->merge_bh_size);
2658

L
Linus Torvalds 已提交
2659 2660
	drive->dsc_overlap = 0;
	drive->driver_data = NULL;
2661
	device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor));
2662 2663
	device_destroy(idetape_sysfs_class,
			MKDEV(IDETAPE_MAJOR, tape->minor + 128));
L
Linus Torvalds 已提交
2664 2665 2666 2667 2668 2669
	idetape_devs[tape->minor] = NULL;
	g->private_data = NULL;
	put_disk(g);
	kfree(tape);
}

2670
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689
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

2690
static int ide_tape_probe(ide_drive_t *);
L
Linus Torvalds 已提交
2691 2692

static ide_driver_t idetape_driver = {
2693
	.gen_driver = {
2694
		.owner		= THIS_MODULE,
2695 2696 2697
		.name		= "ide-tape",
		.bus		= &ide_bus_type,
	},
2698 2699
	.probe			= ide_tape_probe,
	.remove			= ide_tape_remove,
L
Linus Torvalds 已提交
2700 2701 2702 2703 2704 2705 2706
	.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,
2707
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2708
	.proc			= idetape_proc,
2709
#endif
L
Linus Torvalds 已提交
2710 2711
};

2712
/* Our character device supporting functions, passed to register_chrdev. */
2713
static const struct file_operations idetape_fops = {
L
Linus Torvalds 已提交
2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726
	.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;

2727 2728
	tape = ide_tape_get(disk);
	if (!tape)
L
Linus Torvalds 已提交
2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762
		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,
};

2763
static int ide_tape_probe(ide_drive_t *drive)
L
Linus Torvalds 已提交
2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774
{
	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;
2775 2776 2777
	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 已提交
2778 2779
		goto failed;
	}
2780
	tape = kzalloc(sizeof(idetape_tape_t), GFP_KERNEL);
L
Linus Torvalds 已提交
2781
	if (tape == NULL) {
2782 2783
		printk(KERN_ERR "ide-tape: %s: Can't allocate a tape struct\n",
				drive->name);
L
Linus Torvalds 已提交
2784 2785 2786 2787 2788 2789 2790 2791 2792
		goto failed;
	}

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

	ide_init_disk(g, drive);

2793
	ide_proc_register_driver(drive, &idetape_driver);
L
Linus Torvalds 已提交
2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804

	kref_init(&tape->kref);

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

	g->private_data = &tape->driver;

	drive->driver_data = tape;

2805
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2806 2807 2808
	for (minor = 0; idetape_devs[minor]; minor++)
		;
	idetape_devs[minor] = tape;
2809
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2810 2811 2812

	idetape_setup(drive, tape, minor);

2813 2814 2815 2816
	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);
2817

L
Linus Torvalds 已提交
2818 2819 2820 2821
	g->fops = &idetape_block_ops;
	ide_register_region(g);

	return 0;
2822

L
Linus Torvalds 已提交
2823 2824 2825
out_free_tape:
	kfree(tape);
failed:
2826
	return -ENODEV;
L
Linus Torvalds 已提交
2827 2828
}

2829
static void __exit idetape_exit(void)
L
Linus Torvalds 已提交
2830
{
2831
	driver_unregister(&idetape_driver.gen_driver);
2832
	class_destroy(idetape_sysfs_class);
L
Linus Torvalds 已提交
2833 2834 2835
	unregister_chrdev(IDETAPE_MAJOR, "ht");
}

2836
static int __init idetape_init(void)
L
Linus Torvalds 已提交
2837
{
2838 2839 2840 2841 2842 2843 2844 2845 2846
	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 已提交
2847
	if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
2848 2849
		printk(KERN_ERR "ide-tape: Failed to register chrdev"
				" interface\n");
2850 2851
		error = -EBUSY;
		goto out_free_class;
L
Linus Torvalds 已提交
2852
	}
2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865

	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 已提交
2866 2867
}

2868
MODULE_ALIAS("ide:*m-tape*");
L
Linus Torvalds 已提交
2869 2870 2871
module_init(idetape_init);
module_exit(idetape_exit);
MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
2872 2873
MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
MODULE_LICENSE("GPL");