ide-tape.c 66.6 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 19
#define DRV_NAME "ide-tape"

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

#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>
30
#include <linux/jiffies.h>
L
Linus Torvalds 已提交
31 32 33 34 35 36 37 38 39
#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>
40
#include <linux/mutex.h>
41
#include <scsi/scsi.h>
L
Linus Torvalds 已提交
42 43

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

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),
};

/* 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 86 87
 * 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 已提交
88
 */
89
#define IDETAPE_FIFO_THRESHOLD		2
L
Linus Torvalds 已提交
90 91

/*
92
 * DSC polling parameters.
L
Linus Torvalds 已提交
93
 *
94 95
 * 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 已提交
96
 *
97 98 99 100 101
 * 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 已提交
102
 *
103 104 105 106 107 108 109 110
 * 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 已提交
111
 *
112 113
 * 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 已提交
114
 */
115 116

/* DSC timings. */
L
Linus Torvalds 已提交
117 118 119 120 121 122 123 124 125 126
#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 ***********************/

127 128 129 130 131 132
/* tape directions */
enum {
	IDETAPE_DIR_NONE  = (1 << 0),
	IDETAPE_DIR_READ  = (1 << 1),
	IDETAPE_DIR_WRITE = (1 << 2),
};
L
Linus Torvalds 已提交
133 134

struct idetape_bh {
135
	u32 b_size;
L
Linus Torvalds 已提交
136 137 138 139 140
	atomic_t b_count;
	struct idetape_bh *b_reqnext;
	char *b_data;
};

141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
/* 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

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

L
Linus Torvalds 已提交
164
/*
165 166
 * 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 已提交
167 168 169 170 171 172 173 174 175 176 177 178 179 180
 */
typedef struct ide_tape_obj {
	ide_drive_t	*drive;
	ide_driver_t	*driver;
	struct gendisk	*disk;
	struct kref	kref;

	/*
	 *	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.
	 */
	/* Last failed packet command */
181
	struct ide_atapi_pc *failed_pc;
182 183
	/* used by REQ_IDETAPE_{READ,WRITE} requests */
	struct ide_atapi_pc queued_pc;
184

L
Linus Torvalds 已提交
185
	/*
186
	 * DSC polling variables.
L
Linus Torvalds 已提交
187
	 *
188 189 190
	 * 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
191
	 * data transfer) request in the device request queue.
L
Linus Torvalds 已提交
192 193 194 195 196 197 198
	 */
	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 */
199 200
	unsigned long best_dsc_rw_freq;
	unsigned long dsc_poll_freq;
L
Linus Torvalds 已提交
201 202
	unsigned long dsc_timeout;

203
	/* Read position information */
L
Linus Torvalds 已提交
204 205
	u8 partition;
	/* Current block */
206
	unsigned int first_frame;
L
Linus Torvalds 已提交
207

208
	/* Last error information */
L
Linus Torvalds 已提交
209 210
	u8 sense_key, asc, ascq;

211
	/* Character device operation */
L
Linus Torvalds 已提交
212 213 214 215
	unsigned int minor;
	/* device name */
	char name[4];
	/* Current character device data transfer direction */
216
	u8 chrdev_dir;
L
Linus Torvalds 已提交
217

218 219
	/* tape block size, usually 512 or 1024 bytes */
	unsigned short blk_size;
L
Linus Torvalds 已提交
220
	int user_bs_factor;
221

L
Linus Torvalds 已提交
222
	/* Copy of the tape's Capabilities and Mechanical Page */
223
	u8 caps[20];
L
Linus Torvalds 已提交
224 225

	/*
226
	 * Active data transfer request parameters.
L
Linus Torvalds 已提交
227
	 *
228 229 230
	 * 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 已提交
231
	 */
232

233
	/* Data buffer size chosen based on the tape's recommendation */
234
	int buffer_size;
235 236
	/* merge buffer */
	struct idetape_bh *merge_bh;
237 238
	/* size of the merge buffer */
	int merge_bh_size;
239
	/* pointer to current buffer head within the merge buffer */
L
Linus Torvalds 已提交
240 241 242
	struct idetape_bh *bh;
	char *b_data;
	int b_count;
243

244
	int pages_per_buffer;
L
Linus Torvalds 已提交
245 246 247 248
	/* Wasted space in each stage */
	int excess_bh_size;

	/* protects the ide-tape queue */
249
	spinlock_t lock;
L
Linus Torvalds 已提交
250

251
	/* Measures average tape speed */
L
Linus Torvalds 已提交
252 253 254 255 256 257 258 259 260 261 262
	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;

263
	u32 debug_mask;
L
Linus Torvalds 已提交
264 265
} idetape_tape_t;

266
static DEFINE_MUTEX(idetape_ref_mutex);
L
Linus Torvalds 已提交
267

268 269
static struct class *idetape_sysfs_class;

270 271
static void ide_tape_release(struct kref *);

L
Linus Torvalds 已提交
272 273 274 275
static struct ide_tape_obj *ide_tape_get(struct gendisk *disk)
{
	struct ide_tape_obj *tape = NULL;

276
	mutex_lock(&idetape_ref_mutex);
B
Borislav Petkov 已提交
277
	tape = ide_drv_g(disk, ide_tape_obj);
278
	if (tape) {
279
		if (ide_device_get(tape->drive))
280
			tape = NULL;
281 282
		else
			kref_get(&tape->kref);
283
	}
284
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
285 286 287 288 289
	return tape;
}

static void ide_tape_put(struct ide_tape_obj *tape)
{
290 291
	ide_drive_t *drive = tape->drive;

292
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
293
	kref_put(&tape->kref, ide_tape_release);
294
	ide_device_put(drive);
295
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
296 297 298
}

/*
299 300
 * The variables below are used for the character device interface. Additional
 * state variables are defined in our ide_drive_t structure.
L
Linus Torvalds 已提交
301
 */
302
static struct ide_tape_obj *idetape_devs[MAX_HWIFS * MAX_DRIVES];
L
Linus Torvalds 已提交
303 304 305 306 307

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

308
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
309 310 311
	tape = idetape_devs[i];
	if (tape)
		kref_get(&tape->kref);
312
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
313 314 315
	return tape;
}

316
static void idetape_input_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
317
				  unsigned int bcount)
L
Linus Torvalds 已提交
318 319 320 321 322 323 324 325
{
	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");
326
			ide_pad_transfer(drive, 0, bcount);
L
Linus Torvalds 已提交
327 328
			return;
		}
329 330 331
		count = min(
			(unsigned int)(bh->b_size - atomic_read(&bh->b_count)),
			bcount);
332
		drive->hwif->tp_ops->input_data(drive, NULL, bh->b_data +
333
					atomic_read(&bh->b_count), count);
L
Linus Torvalds 已提交
334 335 336 337 338 339 340 341 342 343 344
		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;
}

345
static void idetape_output_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
346
				   unsigned int bcount)
L
Linus Torvalds 已提交
347 348 349 350 351 352
{
	struct idetape_bh *bh = pc->bh;
	int count;

	while (bcount) {
		if (bh == NULL) {
353 354
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
L
Linus Torvalds 已提交
355 356 357
			return;
		}
		count = min((unsigned int)pc->b_count, (unsigned int)bcount);
358
		drive->hwif->tp_ops->output_data(drive, NULL, pc->b_data, count);
L
Linus Torvalds 已提交
359 360 361 362
		bcount -= count;
		pc->b_data += count;
		pc->b_count -= count;
		if (!pc->b_count) {
363 364
			bh = bh->b_reqnext;
			pc->bh = bh;
L
Linus Torvalds 已提交
365 366 367 368 369 370 371 372
			if (bh) {
				pc->b_data = bh->b_data;
				pc->b_count = atomic_read(&bh->b_count);
			}
		}
	}
}

373
static void idetape_update_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
374 375 376
{
	struct idetape_bh *bh = pc->bh;
	int count;
377
	unsigned int bcount = pc->xferred;
L
Linus Torvalds 已提交
378

379
	if (pc->flags & PC_FLAG_WRITING)
L
Linus Torvalds 已提交
380 381 382
		return;
	while (bcount) {
		if (bh == NULL) {
383 384
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
L
Linus Torvalds 已提交
385 386 387 388 389 390 391 392 393 394 395 396
			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;
}

/*
397 398
 * called on each failed packet command retry to analyze the request sense. We
 * currently do not utilize this information.
L
Linus Torvalds 已提交
399
 */
400
static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
L
Linus Torvalds 已提交
401 402
{
	idetape_tape_t *tape = drive->driver_data;
403
	struct ide_atapi_pc *pc = tape->failed_pc;
L
Linus Torvalds 已提交
404

405 406 407
	tape->sense_key = sense[2] & 0xF;
	tape->asc       = sense[12];
	tape->ascq      = sense[13];
408 409 410

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

412
	/* Correct pc->xferred by asking the tape.	 */
413
	if (pc->flags & PC_FLAG_DMA_ERROR) {
414
		pc->xferred = pc->req_xfer -
415
			tape->blk_size *
416
			get_unaligned_be32(&sense[3]);
417
		idetape_update_buffers(drive, pc);
L
Linus Torvalds 已提交
418 419 420 421 422 423 424
	}

	/*
	 * 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.
	 */
425
	if ((pc->c[0] == READ_6 || pc->c[0] == WRITE_6)
426 427 428
	    /* length == 0 */
	    && pc->c[4] == 0 && pc->c[3] == 0 && pc->c[2] == 0) {
		if (tape->sense_key == 5) {
L
Linus Torvalds 已提交
429 430 431
			/* don't report an error, everything's ok */
			pc->error = 0;
			/* don't retry read/write */
432
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
433 434
		}
	}
435
	if (pc->c[0] == READ_6 && (sense[2] & 0x80)) {
L
Linus Torvalds 已提交
436
		pc->error = IDETAPE_ERROR_FILEMARK;
437
		pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
438
	}
439
	if (pc->c[0] == WRITE_6) {
440 441
		if ((sense[2] & 0x40) || (tape->sense_key == 0xd
		     && tape->asc == 0x0 && tape->ascq == 0x2)) {
L
Linus Torvalds 已提交
442
			pc->error = IDETAPE_ERROR_EOD;
443
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
444 445
		}
	}
446
	if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
447
		if (tape->sense_key == 8) {
L
Linus Torvalds 已提交
448
			pc->error = IDETAPE_ERROR_EOD;
449
			pc->flags |= PC_FLAG_ABORT;
L
Linus Torvalds 已提交
450
		}
451
		if (!(pc->flags & PC_FLAG_ABORT) &&
452
		    pc->xferred)
L
Linus Torvalds 已提交
453 454 455 456
			pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
	}
}

457
/* Free data buffers completely. */
458
static void ide_tape_kfree_buffer(idetape_tape_t *tape)
L
Linus Torvalds 已提交
459
{
460
	struct idetape_bh *prev_bh, *bh = tape->merge_bh;
461 462 463 464 465 466 467 468 469 470 471 472

	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 已提交
473 474 475 476 477 478 479 480 481 482 483 484 485 486
		}
		prev_bh = bh;
		bh = bh->b_reqnext;
		kfree(prev_bh);
	}
}

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;

487
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
488 489

	switch (uptodate) {
490 491 492
	case 0:	error = IDETAPE_ERROR_GENERAL; break;
	case 1: error = 0; break;
	default: error = uptodate;
L
Linus Torvalds 已提交
493 494 495 496 497
	}
	rq->errors = error;
	if (error)
		tape->failed_pc = NULL;

498 499 500 501 502
	if (!blk_special_request(rq)) {
		ide_end_request(drive, uptodate, nr_sects);
		return 0;
	}

503
	spin_lock_irqsave(&tape->lock, flags);
L
Linus Torvalds 已提交
504 505 506

	ide_end_drive_cmd(drive, 0, 0);

507
	spin_unlock_irqrestore(&tape->lock, flags);
L
Linus Torvalds 已提交
508 509 510
	return 0;
}

511 512 513
static void ide_tape_handle_dsc(ide_drive_t *);

static void ide_tape_callback(ide_drive_t *drive, int dsc)
L
Linus Torvalds 已提交
514 515
{
	idetape_tape_t *tape = drive->driver_data;
516
	struct ide_atapi_pc *pc = drive->pc;
517
	int uptodate = pc->error ? 0 : 1;
L
Linus Torvalds 已提交
518

519 520
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

521 522 523
	if (dsc)
		ide_tape_handle_dsc(drive);

524 525 526
	if (tape->failed_pc == pc)
		tape->failed_pc = NULL;

527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551
	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) {
552
		u8 *readpos = pc->buf;
553 554 555 556 557 558 559 560 561

		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");
562
			clear_bit(IDE_AFLAG_ADDRESS_VALID, &drive->atapi_flags);
563 564 565
			uptodate = 0;
		} else {
			debug_log(DBG_SENSE, "Block Location - %u\n",
566
					be32_to_cpup((__be32 *)&readpos[4]));
567 568

			tape->partition = readpos[1];
569
			tape->first_frame = be32_to_cpup((__be32 *)&readpos[4]);
570
			set_bit(IDE_AFLAG_ADDRESS_VALID, &drive->atapi_flags);
571
		}
L
Linus Torvalds 已提交
572
	}
573 574

	idetape_end_request(drive, uptodate, 0);
L
Linus Torvalds 已提交
575 576 577
}

/*
578 579
 * 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 已提交
580
 */
581
static void idetape_postpone_request(ide_drive_t *drive)
L
Linus Torvalds 已提交
582 583 584
{
	idetape_tape_t *tape = drive->driver_data;

585 586
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
587
	tape->postponed_rq = HWGROUP(drive)->rq;
588
	ide_stall_queue(drive, tape->dsc_poll_freq);
L
Linus Torvalds 已提交
589 590
}

591 592 593 594 595 596 597 598 599 600 601 602
static void ide_tape_handle_dsc(ide_drive_t *drive)
{
	idetape_tape_t *tape = drive->driver_data;

	/* Media access command */
	tape->dsc_polling_start = jiffies;
	tape->dsc_poll_freq = IDETAPE_DSC_MA_FAST;
	tape->dsc_timeout = jiffies + IDETAPE_DSC_MA_TIMEOUT;
	/* Allow ide.c to handle other requests */
	idetape_postpone_request(drive);
}

603
static int ide_tape_io_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
604 605 606 607 608 609
				unsigned int bcount, int write)
{
	if (write)
		idetape_output_buffers(drive, pc, bcount);
	else
		idetape_input_buffers(drive, pc, bcount);
610 611

	return bcount;
612
}
613

L
Linus Torvalds 已提交
614
/*
615
 * Packet Command Interface
L
Linus Torvalds 已提交
616
 *
617
 * The current Packet Command is available in drive->pc, and will not change
618 619
 * 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 已提交
620
 *
621
 * The handling will be done in three stages:
L
Linus Torvalds 已提交
622
 *
623
 * 1. idetape_issue_pc will send the packet command to the drive, and will set
624
 * the interrupt handler to ide_pc_intr.
L
Linus Torvalds 已提交
625
 *
626
 * 2. On each interrupt, ide_pc_intr will be called. This step will be
627
 * repeated until the device signals us that no more interrupts will be issued.
L
Linus Torvalds 已提交
628
 *
629 630 631 632 633 634 635
 * 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 已提交
636
 *
637 638
 * 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 已提交
639
 *
640
 * 4. When the packet command is finished, it will be checked for errors.
L
Linus Torvalds 已提交
641
 *
642 643 644
 * 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 已提交
645
 *
646 647 648
 * 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 已提交
649 650
 */

651 652
static ide_startstop_t idetape_issue_pc(ide_drive_t *drive,
		struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
653 654 655
{
	idetape_tape_t *tape = drive->driver_data;

656
	if (drive->pc->c[0] == REQUEST_SENSE &&
657
	    pc->c[0] == REQUEST_SENSE) {
L
Linus Torvalds 已提交
658 659 660 661
		printk(KERN_ERR "ide-tape: possible ide-tape.c bug - "
			"Two request sense in serial were issued\n");
	}

662
	if (tape->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
L
Linus Torvalds 已提交
663
		tape->failed_pc = pc;
664

L
Linus Torvalds 已提交
665
	/* Set the current packet command */
666
	drive->pc = pc;
L
Linus Torvalds 已提交
667 668

	if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
669
		(pc->flags & PC_FLAG_ABORT)) {
L
Linus Torvalds 已提交
670
		/*
671 672 673
		 * 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 已提交
674
		 */
675
		if (!(pc->flags & PC_FLAG_ABORT)) {
676
			if (!(pc->c[0] == TEST_UNIT_READY &&
L
Linus Torvalds 已提交
677 678 679 680 681 682 683 684 685 686 687 688 689
			      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;
690
		drive->pc_callback(drive, 0);
691
		return ide_stopped;
L
Linus Torvalds 已提交
692
	}
693
	debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
L
Linus Torvalds 已提交
694 695 696

	pc->retries++;

697
	return ide_issue_pc(drive, WAIT_TAPE_CMD, NULL);
L
Linus Torvalds 已提交
698 699
}

700
/* A mode sense command is used to "sense" tape parameters. */
701
static void idetape_create_mode_sense_cmd(struct ide_atapi_pc *pc, u8 page_code)
L
Linus Torvalds 已提交
702
{
703
	ide_init_pc(pc);
704
	pc->c[0] = MODE_SENSE;
L
Linus Torvalds 已提交
705
	if (page_code != IDETAPE_BLOCK_DESCRIPTOR)
706 707
		/* DBD = 1 - Don't return block descriptors */
		pc->c[1] = 8;
L
Linus Torvalds 已提交
708 709 710 711 712 713 714 715 716
	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;
717 718
	/* We will just discard data in that case */
	pc->c[4] = 255;
L
Linus Torvalds 已提交
719
	if (page_code == IDETAPE_BLOCK_DESCRIPTOR)
720
		pc->req_xfer = 12;
L
Linus Torvalds 已提交
721
	else if (page_code == IDETAPE_CAPABILITIES_PAGE)
722
		pc->req_xfer = 24;
L
Linus Torvalds 已提交
723
	else
724
		pc->req_xfer = 50;
L
Linus Torvalds 已提交
725 726
}

727
static ide_startstop_t idetape_media_access_finished(ide_drive_t *drive)
L
Linus Torvalds 已提交
728
{
729
	ide_hwif_t *hwif = drive->hwif;
L
Linus Torvalds 已提交
730
	idetape_tape_t *tape = drive->driver_data;
731
	struct ide_atapi_pc *pc = drive->pc;
732
	u8 stat;
L
Linus Torvalds 已提交
733

734
	stat = hwif->tp_ops->read_status(hwif);
735

736 737
	if (stat & ATA_DSC) {
		if (stat & ATA_ERR) {
L
Linus Torvalds 已提交
738
			/* Error detected */
739
			if (pc->c[0] != TEST_UNIT_READY)
L
Linus Torvalds 已提交
740 741 742
				printk(KERN_ERR "ide-tape: %s: I/O error, ",
						tape->name);
			/* Retry operation */
743
			ide_retry_pc(drive, tape->disk);
744
			return ide_stopped;
L
Linus Torvalds 已提交
745 746 747 748 749 750
		}
		pc->error = 0;
	} else {
		pc->error = IDETAPE_ERROR_GENERAL;
		tape->failed_pc = NULL;
	}
751
	drive->pc_callback(drive, 0);
L
Linus Torvalds 已提交
752 753 754
	return ide_stopped;
}

755
static void ide_tape_create_rw_cmd(idetape_tape_t *tape,
756 757
				   struct ide_atapi_pc *pc, struct request *rq,
				   u8 opcode)
L
Linus Torvalds 已提交
758
{
759 760 761
	struct idetape_bh *bh = (struct idetape_bh *)rq->special;
	unsigned int length = rq->current_nr_sectors;

762
	ide_init_pc(pc);
763
	put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
764 765
	pc->c[1] = 1;
	pc->bh = bh;
766 767 768
	pc->buf = NULL;
	pc->buf_size = length * tape->blk_size;
	pc->req_xfer = pc->buf_size;
769
	if (pc->req_xfer == tape->buffer_size)
770
		pc->flags |= PC_FLAG_DMA_OK;
L
Linus Torvalds 已提交
771

772 773 774 775 776 777 778 779 780
	if (opcode == READ_6) {
		pc->c[0] = READ_6;
		atomic_set(&bh->b_count, 0);
	} else if (opcode == WRITE_6) {
		pc->c[0] = WRITE_6;
		pc->flags |= PC_FLAG_WRITING;
		pc->b_data = bh->b_data;
		pc->b_count = atomic_read(&bh->b_count);
	}
781 782

	memcpy(rq->cmd, pc->c, 12);
L
Linus Torvalds 已提交
783 784 785 786 787
}

static ide_startstop_t idetape_do_request(ide_drive_t *drive,
					  struct request *rq, sector_t block)
{
788
	ide_hwif_t *hwif = drive->hwif;
L
Linus Torvalds 已提交
789
	idetape_tape_t *tape = drive->driver_data;
790
	struct ide_atapi_pc *pc = NULL;
L
Linus Torvalds 已提交
791
	struct request *postponed_rq = tape->postponed_rq;
792
	u8 stat;
L
Linus Torvalds 已提交
793

794 795 796 797
	debug_log(DBG_SENSE, "sector: %llu, nr_sectors: %lu,"
			" current_nr_sectors: %u\n",
			(unsigned long long)rq->sector, rq->nr_sectors,
			rq->current_nr_sectors);
L
Linus Torvalds 已提交
798

799
	if (!blk_special_request(rq)) {
800
		/* We do not support buffer cache originated requests. */
L
Linus Torvalds 已提交
801
		printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
802
			"request queue (%d)\n", drive->name, rq->cmd_type);
L
Linus Torvalds 已提交
803 804 805 806
		ide_end_request(drive, 0, 0);
		return ide_stopped;
	}

807
	/* Retry a failed packet command */
808
	if (tape->failed_pc && drive->pc->c[0] == REQUEST_SENSE) {
809 810 811
		pc = tape->failed_pc;
		goto out;
	}
812

L
Linus Torvalds 已提交
813 814 815 816 817 818 819 820 821 822 823 824 825 826
	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.
	 */
827
	stat = hwif->tp_ops->read_status(hwif);
L
Linus Torvalds 已提交
828

B
Bartlomiej Zolnierkiewicz 已提交
829 830
	if ((drive->dev_flags & IDE_DFLAG_DSC_OVERLAP) == 0 &&
	    (rq->cmd[13] & REQ_IDETAPE_PC2) == 0)
831
		set_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags);
L
Linus Torvalds 已提交
832

B
Bartlomiej Zolnierkiewicz 已提交
833
	if (drive->dev_flags & IDE_DFLAG_POST_RESET) {
834
		set_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags);
B
Bartlomiej Zolnierkiewicz 已提交
835
		drive->dev_flags &= ~IDE_DFLAG_POST_RESET;
L
Linus Torvalds 已提交
836 837
	}

838
	if (!test_and_clear_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags) &&
839
	    (stat & ATA_DSC) == 0) {
L
Linus Torvalds 已提交
840 841
		if (postponed_rq == NULL) {
			tape->dsc_polling_start = jiffies;
842
			tape->dsc_poll_freq = tape->best_dsc_rw_freq;
L
Linus Torvalds 已提交
843 844 845 846
			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);
847
			if (rq->cmd[13] & REQ_IDETAPE_PC2) {
L
Linus Torvalds 已提交
848 849 850 851 852
				idetape_media_access_finished(drive);
				return ide_stopped;
			} else {
				return ide_do_reset(drive);
			}
853 854 855
		} else if (time_after(jiffies,
					tape->dsc_polling_start +
					IDETAPE_DSC_MA_THRESHOLD))
856
			tape->dsc_poll_freq = IDETAPE_DSC_MA_SLOW;
L
Linus Torvalds 已提交
857 858 859
		idetape_postpone_request(drive);
		return ide_stopped;
	}
860
	if (rq->cmd[13] & REQ_IDETAPE_READ) {
861
		pc = &tape->queued_pc;
862
		ide_tape_create_rw_cmd(tape, pc, rq, READ_6);
L
Linus Torvalds 已提交
863 864
		goto out;
	}
865
	if (rq->cmd[13] & REQ_IDETAPE_WRITE) {
866
		pc = &tape->queued_pc;
867
		ide_tape_create_rw_cmd(tape, pc, rq, WRITE_6);
L
Linus Torvalds 已提交
868 869
		goto out;
	}
870
	if (rq->cmd[13] & REQ_IDETAPE_PC1) {
871
		pc = (struct ide_atapi_pc *) rq->buffer;
872 873
		rq->cmd[13] &= ~(REQ_IDETAPE_PC1);
		rq->cmd[13] |= REQ_IDETAPE_PC2;
L
Linus Torvalds 已提交
874 875
		goto out;
	}
876
	if (rq->cmd[13] & REQ_IDETAPE_PC2) {
L
Linus Torvalds 已提交
877 878 879 880
		idetape_media_access_finished(drive);
		return ide_stopped;
	}
	BUG();
881

882
out:
883
	return idetape_issue_pc(drive, pc);
L
Linus Torvalds 已提交
884 885 886
}

/*
887
 * The function below uses __get_free_pages to allocate a data buffer of size
888
 * tape->buffer_size (or a bit more). We attempt to combine sequential pages as
889
 * much as possible.
L
Linus Torvalds 已提交
890
 *
891 892
 * It returns a pointer to the newly allocated buffer, or NULL in case of
 * failure.
L
Linus Torvalds 已提交
893
 */
894 895
static struct idetape_bh *ide_tape_kmalloc_buffer(idetape_tape_t *tape,
						  int full, int clear)
L
Linus Torvalds 已提交
896
{
897
	struct idetape_bh *prev_bh, *bh, *merge_bh;
898
	int pages = tape->pages_per_buffer;
899
	unsigned int order, b_allocd;
L
Linus Torvalds 已提交
900 901
	char *b_data = NULL;

902 903
	merge_bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
	bh = merge_bh;
L
Linus Torvalds 已提交
904 905
	if (bh == NULL)
		goto abort;
906 907 908

	order = fls(pages) - 1;
	bh->b_data = (char *) __get_free_pages(GFP_KERNEL, order);
909
	if (!bh->b_data)
L
Linus Torvalds 已提交
910
		goto abort;
911 912 913
	b_allocd = (1 << order) * PAGE_SIZE;
	pages &= (order-1);

L
Linus Torvalds 已提交
914
	if (clear)
915 916 917
		memset(bh->b_data, 0, b_allocd);
	bh->b_reqnext = NULL;
	bh->b_size = b_allocd;
L
Linus Torvalds 已提交
918 919
	atomic_set(&bh->b_count, full ? bh->b_size : 0);

920 921 922
	while (pages) {
		order = fls(pages) - 1;
		b_data = (char *) __get_free_pages(GFP_KERNEL, order);
923
		if (!b_data)
L
Linus Torvalds 已提交
924
			goto abort;
925 926
		b_allocd = (1 << order) * PAGE_SIZE;

L
Linus Torvalds 已提交
927
		if (clear)
928 929 930 931 932 933
			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 已提交
934
			if (full)
935
				atomic_add(b_allocd, &bh->b_count);
L
Linus Torvalds 已提交
936 937
			continue;
		}
938
		/* they are above the header */
L
Linus Torvalds 已提交
939
		if (b_data == bh->b_data + bh->b_size) {
940
			bh->b_size += b_allocd;
L
Linus Torvalds 已提交
941
			if (full)
942
				atomic_add(b_allocd, &bh->b_count);
L
Linus Torvalds 已提交
943 944 945
			continue;
		}
		prev_bh = bh;
946 947
		bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
		if (!bh) {
948
			free_pages((unsigned long) b_data, order);
L
Linus Torvalds 已提交
949 950 951 952
			goto abort;
		}
		bh->b_reqnext = NULL;
		bh->b_data = b_data;
953
		bh->b_size = b_allocd;
L
Linus Torvalds 已提交
954 955
		atomic_set(&bh->b_count, full ? bh->b_size : 0);
		prev_bh->b_reqnext = bh;
956 957

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

L
Linus Torvalds 已提交
960 961 962
	bh->b_size -= tape->excess_bh_size;
	if (full)
		atomic_sub(tape->excess_bh_size, &bh->b_count);
963
	return merge_bh;
L
Linus Torvalds 已提交
964
abort:
965
	ide_tape_kfree_buffer(tape);
L
Linus Torvalds 已提交
966 967 968
	return NULL;
}

969
static int idetape_copy_stage_from_user(idetape_tape_t *tape,
970
					const char __user *buf, int n)
L
Linus Torvalds 已提交
971 972 973
{
	struct idetape_bh *bh = tape->bh;
	int count;
974
	int ret = 0;
L
Linus Torvalds 已提交
975 976 977

	while (n) {
		if (bh == NULL) {
978 979
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
980
			return 1;
L
Linus Torvalds 已提交
981
		}
982 983 984 985 986
		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))
987
			ret = 1;
L
Linus Torvalds 已提交
988 989 990 991 992 993 994 995 996 997
		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;
998
	return ret;
L
Linus Torvalds 已提交
999 1000
}

1001
static int idetape_copy_stage_to_user(idetape_tape_t *tape, char __user *buf,
1002
				      int n)
L
Linus Torvalds 已提交
1003 1004 1005
{
	struct idetape_bh *bh = tape->bh;
	int count;
1006
	int ret = 0;
L
Linus Torvalds 已提交
1007 1008 1009

	while (n) {
		if (bh == NULL) {
1010 1011
			printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
					__func__);
1012
			return 1;
L
Linus Torvalds 已提交
1013 1014
		}
		count = min(tape->b_count, n);
1015 1016
		if  (copy_to_user(buf, tape->b_data, count))
			ret = 1;
L
Linus Torvalds 已提交
1017 1018 1019 1020 1021
		n -= count;
		tape->b_data += count;
		tape->b_count -= count;
		buf += count;
		if (!tape->b_count) {
1022 1023
			bh = bh->b_reqnext;
			tape->bh = bh;
L
Linus Torvalds 已提交
1024 1025 1026 1027 1028 1029
			if (bh) {
				tape->b_data = bh->b_data;
				tape->b_count = atomic_read(&bh->b_count);
			}
		}
	}
1030
	return ret;
L
Linus Torvalds 已提交
1031 1032
}

1033
static void idetape_init_merge_buffer(idetape_tape_t *tape)
L
Linus Torvalds 已提交
1034
{
1035 1036
	struct idetape_bh *bh = tape->merge_bh;
	tape->bh = tape->merge_bh;
1037

1038
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
L
Linus Torvalds 已提交
1039 1040 1041 1042 1043 1044 1045 1046
		atomic_set(&bh->b_count, 0);
	else {
		tape->b_data = bh->b_data;
		tape->b_count = atomic_read(&bh->b_count);
	}
}

/*
1047 1048
 * Write a filemark if write_filemark=1. Flush the device buffers without
 * writing a filemark otherwise.
L
Linus Torvalds 已提交
1049
 */
1050
static void idetape_create_write_filemark_cmd(ide_drive_t *drive,
1051
		struct ide_atapi_pc *pc, int write_filemark)
L
Linus Torvalds 已提交
1052
{
1053
	ide_init_pc(pc);
1054
	pc->c[0] = WRITE_FILEMARKS;
L
Linus Torvalds 已提交
1055
	pc->c[4] = write_filemark;
1056
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1057 1058 1059 1060 1061
}

static int idetape_wait_ready(ide_drive_t *drive, unsigned long timeout)
{
	idetape_tape_t *tape = drive->driver_data;
1062
	struct gendisk *disk = tape->disk;
L
Linus Torvalds 已提交
1063 1064
	int load_attempted = 0;

1065
	/* Wait for the tape to become ready */
1066
	set_bit(IDE_AFLAG_MEDIUM_PRESENT, &drive->atapi_flags);
L
Linus Torvalds 已提交
1067 1068
	timeout += jiffies;
	while (time_before(jiffies, timeout)) {
1069
		if (ide_do_test_unit_ready(drive, disk) == 0)
L
Linus Torvalds 已提交
1070 1071
			return 0;
		if ((tape->sense_key == 2 && tape->asc == 4 && tape->ascq == 2)
1072 1073
		    || (tape->asc == 0x3A)) {
			/* no media */
L
Linus Torvalds 已提交
1074 1075
			if (load_attempted)
				return -ENOMEDIUM;
1076
			ide_do_start_stop(drive, disk, IDETAPE_LU_LOAD_MASK);
L
Linus Torvalds 已提交
1077 1078 1079 1080 1081
			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;
1082
		msleep(100);
L
Linus Torvalds 已提交
1083 1084 1085 1086
	}
	return -EIO;
}

1087
static int idetape_flush_tape_buffers(ide_drive_t *drive)
L
Linus Torvalds 已提交
1088
{
1089
	struct ide_tape_obj *tape = drive->driver_data;
1090
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1091 1092 1093
	int rc;

	idetape_create_write_filemark_cmd(drive, &pc, 0);
1094
	rc = ide_queue_pc_tail(drive, tape->disk, &pc);
1095
	if (rc)
L
Linus Torvalds 已提交
1096 1097 1098 1099 1100
		return rc;
	idetape_wait_ready(drive, 60 * 5 * HZ);
	return 0;
}

1101
static void idetape_create_read_position_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1102
{
1103
	ide_init_pc(pc);
1104
	pc->c[0] = READ_POSITION;
1105
	pc->req_xfer = 20;
L
Linus Torvalds 已提交
1106 1107
}

1108
static int idetape_read_position(ide_drive_t *drive)
L
Linus Torvalds 已提交
1109 1110
{
	idetape_tape_t *tape = drive->driver_data;
1111
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1112 1113
	int position;

1114
	debug_log(DBG_PROCS, "Enter %s\n", __func__);
L
Linus Torvalds 已提交
1115 1116

	idetape_create_read_position_cmd(&pc);
1117
	if (ide_queue_pc_tail(drive, tape->disk, &pc))
L
Linus Torvalds 已提交
1118
		return -1;
1119
	position = tape->first_frame;
L
Linus Torvalds 已提交
1120 1121 1122
	return position;
}

1123 1124
static void idetape_create_locate_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc,
1125
		unsigned int block, u8 partition, int skip)
L
Linus Torvalds 已提交
1126
{
1127
	ide_init_pc(pc);
1128
	pc->c[0] = POSITION_TO_ELEMENT;
L
Linus Torvalds 已提交
1129
	pc->c[1] = 2;
1130
	put_unaligned(cpu_to_be32(block), (unsigned int *) &pc->c[3]);
L
Linus Torvalds 已提交
1131
	pc->c[8] = partition;
1132
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1133 1134
}

1135
static void __ide_tape_discard_merge_buffer(ide_drive_t *drive)
L
Linus Torvalds 已提交
1136 1137 1138
{
	idetape_tape_t *tape = drive->driver_data;

1139
	if (tape->chrdev_dir != IDETAPE_DIR_READ)
1140
		return;
L
Linus Torvalds 已提交
1141

1142
	clear_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags);
1143
	tape->merge_bh_size = 0;
1144 1145 1146
	if (tape->merge_bh != NULL) {
		ide_tape_kfree_buffer(tape);
		tape->merge_bh = NULL;
L
Linus Torvalds 已提交
1147 1148
	}

1149
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1150 1151 1152
}

/*
1153 1154 1155 1156
 * 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 已提交
1157
 */
1158 1159
static int idetape_position_tape(ide_drive_t *drive, unsigned int block,
		u8 partition, int skip)
L
Linus Torvalds 已提交
1160 1161
{
	idetape_tape_t *tape = drive->driver_data;
1162
	struct gendisk *disk = tape->disk;
L
Linus Torvalds 已提交
1163
	int retval;
1164
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1165

1166
	if (tape->chrdev_dir == IDETAPE_DIR_READ)
1167
		__ide_tape_discard_merge_buffer(drive);
L
Linus Torvalds 已提交
1168 1169
	idetape_wait_ready(drive, 60 * 5 * HZ);
	idetape_create_locate_cmd(drive, &pc, block, partition, skip);
1170
	retval = ide_queue_pc_tail(drive, disk, &pc);
L
Linus Torvalds 已提交
1171 1172 1173 1174
	if (retval)
		return (retval);

	idetape_create_read_position_cmd(&pc);
1175
	return ide_queue_pc_tail(drive, disk, &pc);
L
Linus Torvalds 已提交
1176 1177
}

1178
static void ide_tape_discard_merge_buffer(ide_drive_t *drive,
1179
					  int restore_position)
L
Linus Torvalds 已提交
1180 1181 1182 1183
{
	idetape_tape_t *tape = drive->driver_data;
	int seek, position;

1184
	__ide_tape_discard_merge_buffer(drive);
L
Linus Torvalds 已提交
1185 1186
	if (restore_position) {
		position = idetape_read_position(drive);
1187
		seek = position > 0 ? position : 0;
L
Linus Torvalds 已提交
1188
		if (idetape_position_tape(drive, seek, 0, 0)) {
1189
			printk(KERN_INFO "ide-tape: %s: position_tape failed in"
1190
					 " %s\n", tape->name, __func__);
L
Linus Torvalds 已提交
1191 1192 1193 1194 1195 1196
			return;
		}
	}
}

/*
1197 1198
 * Generate a read/write request for the block device interface and wait for it
 * to be serviced.
L
Linus Torvalds 已提交
1199
 */
1200 1201
static int idetape_queue_rw_tail(ide_drive_t *drive, int cmd, int blocks,
				 struct idetape_bh *bh)
L
Linus Torvalds 已提交
1202 1203
{
	idetape_tape_t *tape = drive->driver_data;
1204 1205
	struct request *rq;
	int ret, errors;
L
Linus Torvalds 已提交
1206

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

1209 1210
	rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
	rq->cmd_type = REQ_TYPE_SPECIAL;
1211
	rq->cmd[13] = cmd;
1212 1213 1214 1215 1216 1217 1218 1219 1220 1221
	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 已提交
1222 1223 1224 1225

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

1226 1227
	if (tape->merge_bh)
		idetape_init_merge_buffer(tape);
1228
	if (errors == IDETAPE_ERROR_GENERAL)
L
Linus Torvalds 已提交
1229
		return -EIO;
1230
	return ret;
L
Linus Torvalds 已提交
1231 1232
}

1233
static void idetape_create_inquiry_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1234
{
1235
	ide_init_pc(pc);
1236
	pc->c[0] = INQUIRY;
1237
	pc->c[4] = 254;
1238
	pc->req_xfer = 254;
L
Linus Torvalds 已提交
1239 1240
}

1241 1242
static void idetape_create_rewind_cmd(ide_drive_t *drive,
		struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1243
{
1244
	ide_init_pc(pc);
1245
	pc->c[0] = REZERO_UNIT;
1246
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1247 1248
}

1249
static void idetape_create_erase_cmd(struct ide_atapi_pc *pc)
L
Linus Torvalds 已提交
1250
{
1251
	ide_init_pc(pc);
1252
	pc->c[0] = ERASE;
L
Linus Torvalds 已提交
1253
	pc->c[1] = 1;
1254
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1255 1256
}

1257
static void idetape_create_space_cmd(struct ide_atapi_pc *pc, int count, u8 cmd)
L
Linus Torvalds 已提交
1258
{
1259
	ide_init_pc(pc);
1260
	pc->c[0] = SPACE;
1261
	put_unaligned(cpu_to_be32(count), (unsigned int *) &pc->c[1]);
L
Linus Torvalds 已提交
1262
	pc->c[1] = cmd;
1263
	pc->flags |= PC_FLAG_WAIT_FOR_DSC;
L
Linus Torvalds 已提交
1264 1265
}

1266
/* Queue up a character device originated write request. */
1267
static int idetape_add_chrdev_write_request(ide_drive_t *drive, int blocks)
L
Linus Torvalds 已提交
1268 1269 1270
{
	idetape_tape_t *tape = drive->driver_data;

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

1273
	return idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE,
1274
				     blocks, tape->merge_bh);
L
Linus Torvalds 已提交
1275 1276
}

1277
static void ide_tape_flush_merge_buffer(ide_drive_t *drive)
L
Linus Torvalds 已提交
1278 1279 1280 1281
{
	idetape_tape_t *tape = drive->driver_data;
	int blocks, min;
	struct idetape_bh *bh;
1282

1283
	if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
1284
		printk(KERN_ERR "ide-tape: bug: Trying to empty merge buffer"
1285
				" but we are not writing.\n");
L
Linus Torvalds 已提交
1286 1287
		return;
	}
1288
	if (tape->merge_bh_size > tape->buffer_size) {
L
Linus Torvalds 已提交
1289
		printk(KERN_ERR "ide-tape: bug: merge_buffer too big\n");
1290
		tape->merge_bh_size = tape->buffer_size;
L
Linus Torvalds 已提交
1291
	}
1292 1293 1294
	if (tape->merge_bh_size) {
		blocks = tape->merge_bh_size / tape->blk_size;
		if (tape->merge_bh_size % tape->blk_size) {
L
Linus Torvalds 已提交
1295 1296 1297
			unsigned int i;

			blocks++;
1298
			i = tape->blk_size - tape->merge_bh_size %
1299
				tape->blk_size;
L
Linus Torvalds 已提交
1300 1301 1302 1303 1304 1305 1306 1307
			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) {
1308 1309
					printk(KERN_INFO "ide-tape: bug,"
							 " bh NULL\n");
L
Linus Torvalds 已提交
1310 1311
					break;
				}
1312 1313 1314 1315
				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 已提交
1316 1317 1318 1319 1320 1321
				atomic_add(min, &bh->b_count);
				i -= min;
				bh = bh->b_reqnext;
			}
		}
		(void) idetape_add_chrdev_write_request(drive, blocks);
1322
		tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1323
	}
1324 1325 1326
	if (tape->merge_bh != NULL) {
		ide_tape_kfree_buffer(tape);
		tape->merge_bh = NULL;
L
Linus Torvalds 已提交
1327
	}
1328
	tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1329 1330
}

1331
static int idetape_init_read(ide_drive_t *drive)
L
Linus Torvalds 已提交
1332 1333 1334 1335 1336
{
	idetape_tape_t *tape = drive->driver_data;
	int bytes_read;

	/* Initialize read operation */
1337 1338
	if (tape->chrdev_dir != IDETAPE_DIR_READ) {
		if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
1339
			ide_tape_flush_merge_buffer(drive);
L
Linus Torvalds 已提交
1340 1341
			idetape_flush_tape_buffers(drive);
		}
1342
		if (tape->merge_bh || tape->merge_bh_size) {
1343
			printk(KERN_ERR "ide-tape: merge_bh_size should be"
1344
					 " 0 now\n");
1345
			tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1346
		}
1347 1348
		tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
		if (!tape->merge_bh)
L
Linus Torvalds 已提交
1349
			return -ENOMEM;
1350
		tape->chrdev_dir = IDETAPE_DIR_READ;
L
Linus Torvalds 已提交
1351 1352

		/*
1353 1354 1355 1356
		 * 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 已提交
1357
		 */
B
Bartlomiej Zolnierkiewicz 已提交
1358
		if (drive->dev_flags & IDE_DFLAG_DSC_OVERLAP) {
1359 1360
			bytes_read = idetape_queue_rw_tail(drive,
							REQ_IDETAPE_READ, 0,
1361
							tape->merge_bh);
L
Linus Torvalds 已提交
1362
			if (bytes_read < 0) {
1363 1364
				ide_tape_kfree_buffer(tape);
				tape->merge_bh = NULL;
1365
				tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1366 1367 1368 1369
				return bytes_read;
			}
		}
	}
1370

L
Linus Torvalds 已提交
1371 1372 1373
	return 0;
}

1374
/* called from idetape_chrdev_read() to service a chrdev read request. */
1375
static int idetape_add_chrdev_read_request(ide_drive_t *drive, int blocks)
L
Linus Torvalds 已提交
1376 1377 1378
{
	idetape_tape_t *tape = drive->driver_data;

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

1381
	/* If we are at a filemark, return a read length of 0 */
1382
	if (test_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags))
L
Linus Torvalds 已提交
1383 1384
		return 0;

1385
	idetape_init_read(drive);
1386 1387

	return idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, blocks,
1388
				     tape->merge_bh);
L
Linus Torvalds 已提交
1389 1390
}

1391
static void idetape_pad_zeros(ide_drive_t *drive, int bcount)
L
Linus Torvalds 已提交
1392 1393 1394 1395
{
	idetape_tape_t *tape = drive->driver_data;
	struct idetape_bh *bh;
	int blocks;
1396

L
Linus Torvalds 已提交
1397 1398 1399
	while (bcount) {
		unsigned int count;

1400
		bh = tape->merge_bh;
1401
		count = min(tape->buffer_size, bcount);
L
Linus Torvalds 已提交
1402
		bcount -= count;
1403
		blocks = count / tape->blk_size;
L
Linus Torvalds 已提交
1404
		while (count) {
1405 1406
			atomic_set(&bh->b_count,
				   min(count, (unsigned int)bh->b_size));
L
Linus Torvalds 已提交
1407 1408 1409 1410
			memset(bh->b_data, 0, atomic_read(&bh->b_count));
			count -= atomic_read(&bh->b_count);
			bh = bh->b_reqnext;
		}
1411
		idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks,
1412
				      tape->merge_bh);
L
Linus Torvalds 已提交
1413 1414 1415 1416
	}
}

/*
1417 1418 1419
 * Rewinds the tape to the Beginning Of the current Partition (BOP). We
 * currently support only one partition.
 */
1420
static int idetape_rewind_tape(ide_drive_t *drive)
L
Linus Torvalds 已提交
1421
{
1422 1423
	struct ide_tape_obj *tape = drive->driver_data;
	struct gendisk *disk = tape->disk;
L
Linus Torvalds 已提交
1424
	int retval;
1425
	struct ide_atapi_pc pc;
1426 1427 1428

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

L
Linus Torvalds 已提交
1429
	idetape_create_rewind_cmd(drive, &pc);
1430
	retval = ide_queue_pc_tail(drive, disk, &pc);
L
Linus Torvalds 已提交
1431 1432 1433 1434
	if (retval)
		return retval;

	idetape_create_read_position_cmd(&pc);
1435
	retval = ide_queue_pc_tail(drive, disk, &pc);
L
Linus Torvalds 已提交
1436 1437 1438 1439 1440
	if (retval)
		return retval;
	return 0;
}

1441
/* mtio.h compatible commands should be issued to the chrdev interface. */
1442 1443
static int idetape_blkdev_ioctl(ide_drive_t *drive, unsigned int cmd,
				unsigned long arg)
L
Linus Torvalds 已提交
1444 1445 1446 1447
{
	idetape_tape_t *tape = drive->driver_data;
	void __user *argp = (void __user *)arg;

1448 1449 1450 1451 1452 1453
	struct idetape_config {
		int dsc_rw_frequency;
		int dsc_media_access_frequency;
		int nr_stages;
	} config;

1454 1455
	debug_log(DBG_PROCS, "Enter %s\n", __func__);

L
Linus Torvalds 已提交
1456
	switch (cmd) {
1457 1458 1459 1460 1461 1462 1463
	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;
1464
		config.nr_stages = 1;
1465 1466 1467 1468 1469
		if (copy_to_user(argp, &config, sizeof(config)))
			return -EFAULT;
		break;
	default:
		return -EIO;
L
Linus Torvalds 已提交
1470 1471 1472 1473
	}
	return 0;
}

1474 1475
static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op,
					int mt_count)
L
Linus Torvalds 已提交
1476 1477
{
	idetape_tape_t *tape = drive->driver_data;
1478
	struct gendisk *disk = tape->disk;
1479
	struct ide_atapi_pc pc;
1480
	int retval, count = 0;
1481
	int sprev = !!(tape->caps[4] & 0x20);
L
Linus Torvalds 已提交
1482 1483 1484 1485

	if (mt_count == 0)
		return 0;
	if (MTBSF == mt_op || MTBSFM == mt_op) {
1486
		if (!sprev)
L
Linus Torvalds 已提交
1487
			return -EIO;
1488
		mt_count = -mt_count;
L
Linus Torvalds 已提交
1489 1490
	}

1491
	if (tape->chrdev_dir == IDETAPE_DIR_READ) {
1492
		tape->merge_bh_size = 0;
1493
		if (test_and_clear_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags))
L
Linus Torvalds 已提交
1494
			++count;
1495
		ide_tape_discard_merge_buffer(drive, 0);
L
Linus Torvalds 已提交
1496 1497 1498
	}

	switch (mt_op) {
1499 1500 1501 1502
	case MTFSF:
	case MTBSF:
		idetape_create_space_cmd(&pc, mt_count - count,
					 IDETAPE_SPACE_OVER_FILEMARK);
1503
		return ide_queue_pc_tail(drive, disk, &pc);
1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
	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 已提交
1518 1519 1520 1521
	}
}

/*
1522
 * Our character device read / write functions.
L
Linus Torvalds 已提交
1523
 *
1524 1525 1526
 * 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 已提交
1527
 *
1528 1529 1530 1531 1532 1533 1534
 * 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 已提交
1535
 */
1536 1537
static ssize_t idetape_chrdev_read(struct file *file, char __user *buf,
				   size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
1538
{
B
Borislav Petkov 已提交
1539
	struct ide_tape_obj *tape = file->private_data;
L
Linus Torvalds 已提交
1540
	ide_drive_t *drive = tape->drive;
1541
	ssize_t bytes_read, temp, actually_read = 0, rc;
1542
	ssize_t ret = 0;
1543
	u16 ctl = *(u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
1544

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

1547
	if (tape->chrdev_dir != IDETAPE_DIR_READ) {
1548
		if (test_bit(IDE_AFLAG_DETECT_BS, &drive->atapi_flags))
1549 1550 1551
			if (count > tape->blk_size &&
			    (count % tape->blk_size) == 0)
				tape->user_bs_factor = count / tape->blk_size;
L
Linus Torvalds 已提交
1552
	}
1553
	rc = idetape_init_read(drive);
1554
	if (rc < 0)
L
Linus Torvalds 已提交
1555 1556 1557
		return rc;
	if (count == 0)
		return (0);
1558 1559
	if (tape->merge_bh_size) {
		actually_read = min((unsigned int)(tape->merge_bh_size),
1560
				    (unsigned int)count);
1561
		if (idetape_copy_stage_to_user(tape, buf, actually_read))
1562
			ret = -EFAULT;
L
Linus Torvalds 已提交
1563
		buf += actually_read;
1564
		tape->merge_bh_size -= actually_read;
L
Linus Torvalds 已提交
1565 1566
		count -= actually_read;
	}
1567
	while (count >= tape->buffer_size) {
1568
		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
L
Linus Torvalds 已提交
1569 1570
		if (bytes_read <= 0)
			goto finish;
1571
		if (idetape_copy_stage_to_user(tape, buf, bytes_read))
1572
			ret = -EFAULT;
L
Linus Torvalds 已提交
1573 1574 1575 1576 1577
		buf += bytes_read;
		count -= bytes_read;
		actually_read += bytes_read;
	}
	if (count) {
1578
		bytes_read = idetape_add_chrdev_read_request(drive, ctl);
L
Linus Torvalds 已提交
1579 1580 1581
		if (bytes_read <= 0)
			goto finish;
		temp = min((unsigned long)count, (unsigned long)bytes_read);
1582
		if (idetape_copy_stage_to_user(tape, buf, temp))
1583
			ret = -EFAULT;
L
Linus Torvalds 已提交
1584
		actually_read += temp;
1585
		tape->merge_bh_size = bytes_read-temp;
L
Linus Torvalds 已提交
1586 1587
	}
finish:
1588
	if (!actually_read && test_bit(IDE_AFLAG_FILEMARK, &drive->atapi_flags)) {
1589 1590
		debug_log(DBG_SENSE, "%s: spacing over filemark\n", tape->name);

L
Linus Torvalds 已提交
1591 1592 1593
		idetape_space_over_filemarks(drive, MTFSF, 1);
		return 0;
	}
1594

1595
	return ret ? ret : actually_read;
L
Linus Torvalds 已提交
1596 1597
}

1598
static ssize_t idetape_chrdev_write(struct file *file, const char __user *buf,
L
Linus Torvalds 已提交
1599 1600
				     size_t count, loff_t *ppos)
{
B
Borislav Petkov 已提交
1601
	struct ide_tape_obj *tape = file->private_data;
L
Linus Torvalds 已提交
1602
	ide_drive_t *drive = tape->drive;
1603 1604
	ssize_t actually_written = 0;
	ssize_t ret = 0;
1605
	u16 ctl = *(u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
1606 1607 1608 1609 1610

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

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

	/* Initialize write operation */
1614 1615
	if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
		if (tape->chrdev_dir == IDETAPE_DIR_READ)
1616
			ide_tape_discard_merge_buffer(drive, 1);
1617
		if (tape->merge_bh || tape->merge_bh_size) {
1618
			printk(KERN_ERR "ide-tape: merge_bh_size "
L
Linus Torvalds 已提交
1619
				"should be 0 now\n");
1620
			tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1621
		}
1622 1623
		tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
		if (!tape->merge_bh)
L
Linus Torvalds 已提交
1624
			return -ENOMEM;
1625
		tape->chrdev_dir = IDETAPE_DIR_WRITE;
1626
		idetape_init_merge_buffer(tape);
L
Linus Torvalds 已提交
1627 1628

		/*
1629 1630 1631 1632
		 * 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 已提交
1633
		 */
B
Bartlomiej Zolnierkiewicz 已提交
1634
		if (drive->dev_flags & IDE_DFLAG_DSC_OVERLAP) {
1635 1636
			ssize_t retval = idetape_queue_rw_tail(drive,
							REQ_IDETAPE_WRITE, 0,
1637
							tape->merge_bh);
L
Linus Torvalds 已提交
1638
			if (retval < 0) {
1639 1640
				ide_tape_kfree_buffer(tape);
				tape->merge_bh = NULL;
1641
				tape->chrdev_dir = IDETAPE_DIR_NONE;
L
Linus Torvalds 已提交
1642 1643 1644 1645 1646 1647
				return retval;
			}
		}
	}
	if (count == 0)
		return (0);
1648 1649
	if (tape->merge_bh_size) {
		if (tape->merge_bh_size >= tape->buffer_size) {
1650
			printk(KERN_ERR "ide-tape: bug: merge buf too big\n");
1651
			tape->merge_bh_size = 0;
L
Linus Torvalds 已提交
1652
		}
1653
		actually_written = min((unsigned int)
1654
				(tape->buffer_size - tape->merge_bh_size),
1655
				(unsigned int)count);
1656
		if (idetape_copy_stage_from_user(tape, buf, actually_written))
1657
				ret = -EFAULT;
L
Linus Torvalds 已提交
1658
		buf += actually_written;
1659
		tape->merge_bh_size += actually_written;
L
Linus Torvalds 已提交
1660 1661
		count -= actually_written;

1662
		if (tape->merge_bh_size == tape->buffer_size) {
1663
			ssize_t retval;
1664
			tape->merge_bh_size = 0;
1665
			retval = idetape_add_chrdev_write_request(drive, ctl);
L
Linus Torvalds 已提交
1666 1667 1668 1669
			if (retval <= 0)
				return (retval);
		}
	}
1670
	while (count >= tape->buffer_size) {
1671
		ssize_t retval;
1672
		if (idetape_copy_stage_from_user(tape, buf, tape->buffer_size))
1673
			ret = -EFAULT;
1674 1675
		buf += tape->buffer_size;
		count -= tape->buffer_size;
1676
		retval = idetape_add_chrdev_write_request(drive, ctl);
1677
		actually_written += tape->buffer_size;
L
Linus Torvalds 已提交
1678 1679 1680 1681 1682
		if (retval <= 0)
			return (retval);
	}
	if (count) {
		actually_written += count;
1683
		if (idetape_copy_stage_from_user(tape, buf, count))
1684
			ret = -EFAULT;
1685
		tape->merge_bh_size += count;
L
Linus Torvalds 已提交
1686
	}
1687
	return ret ? ret : actually_written;
L
Linus Torvalds 已提交
1688 1689
}

1690
static int idetape_write_filemark(ide_drive_t *drive)
L
Linus Torvalds 已提交
1691
{
1692
	struct ide_tape_obj *tape = drive->driver_data;
1693
	struct ide_atapi_pc pc;
L
Linus Torvalds 已提交
1694 1695 1696

	/* Write a filemark */
	idetape_create_write_filemark_cmd(drive, &pc, 1);
1697
	if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
L
Linus Torvalds 已提交
1698 1699 1700 1701 1702 1703 1704
		printk(KERN_ERR "ide-tape: Couldn't write a filemark\n");
		return -EIO;
	}
	return 0;
}

/*
1705 1706
 * Called from idetape_chrdev_ioctl when the general mtio MTIOCTOP ioctl is
 * requested.
L
Linus Torvalds 已提交
1707
 *
1708 1709
 * 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
1710
 * usually not supported.
L
Linus Torvalds 已提交
1711
 *
1712
 * The following commands are currently not supported:
L
Linus Torvalds 已提交
1713
 *
1714 1715
 * MTFSS, MTBSS, MTWSM, MTSETDENSITY, MTSETDRVBUFFER, MT_ST_BOOLEANS,
 * MT_ST_WRITE_THRESHOLD.
L
Linus Torvalds 已提交
1716
 */
1717
static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
L
Linus Torvalds 已提交
1718 1719
{
	idetape_tape_t *tape = drive->driver_data;
1720
	struct gendisk *disk = tape->disk;
1721
	struct ide_atapi_pc pc;
1722
	int i, retval;
L
Linus Torvalds 已提交
1723

1724 1725
	debug_log(DBG_ERR, "Handling MTIOCTOP ioctl: mt_op=%d, mt_count=%d\n",
			mt_op, mt_count);
1726

L
Linus Torvalds 已提交
1727
	switch (mt_op) {
1728 1729 1730 1731 1732 1733 1734 1735 1736
	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 已提交
1737
	}
1738

L
Linus Torvalds 已提交
1739
	switch (mt_op) {
1740 1741 1742
	case MTWEOF:
		if (tape->write_prot)
			return -EACCES;
1743
		ide_tape_discard_merge_buffer(drive, 1);
1744 1745 1746 1747 1748 1749 1750
		for (i = 0; i < mt_count; i++) {
			retval = idetape_write_filemark(drive);
			if (retval)
				return retval;
		}
		return 0;
	case MTREW:
1751
		ide_tape_discard_merge_buffer(drive, 0);
1752 1753 1754 1755
		if (idetape_rewind_tape(drive))
			return -EIO;
		return 0;
	case MTLOAD:
1756
		ide_tape_discard_merge_buffer(drive, 0);
1757
		return ide_do_start_stop(drive, disk, IDETAPE_LU_LOAD_MASK);
1758 1759 1760 1761 1762 1763 1764
	case MTUNLOAD:
	case MTOFFL:
		/*
		 * If door is locked, attempt to unlock before
		 * attempting to eject.
		 */
		if (tape->door_locked) {
1765
			if (!ide_set_media_lock(drive, disk, 0))
1766
				tape->door_locked = DOOR_UNLOCKED;
1767
		}
1768
		ide_tape_discard_merge_buffer(drive, 0);
1769
		retval = ide_do_start_stop(drive, disk, !IDETAPE_LU_LOAD_MASK);
1770
		if (!retval)
1771
			clear_bit(IDE_AFLAG_MEDIUM_PRESENT, &drive->atapi_flags);
1772 1773
		return retval;
	case MTNOP:
1774
		ide_tape_discard_merge_buffer(drive, 0);
1775 1776
		return idetape_flush_tape_buffers(drive);
	case MTRETEN:
1777
		ide_tape_discard_merge_buffer(drive, 0);
1778
		return ide_do_start_stop(drive, disk,
1779 1780 1781
			IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK);
	case MTEOM:
		idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD);
1782
		return ide_queue_pc_tail(drive, disk, &pc);
1783 1784 1785
	case MTERASE:
		(void)idetape_rewind_tape(drive);
		idetape_create_erase_cmd(&pc);
1786
		return ide_queue_pc_tail(drive, disk, &pc);
1787 1788 1789 1790
	case MTSETBLK:
		if (mt_count) {
			if (mt_count < tape->blk_size ||
			    mt_count % tape->blk_size)
L
Linus Torvalds 已提交
1791
				return -EIO;
1792
			tape->user_bs_factor = mt_count / tape->blk_size;
1793
			clear_bit(IDE_AFLAG_DETECT_BS, &drive->atapi_flags);
1794
		} else
1795
			set_bit(IDE_AFLAG_DETECT_BS, &drive->atapi_flags);
1796 1797
		return 0;
	case MTSEEK:
1798
		ide_tape_discard_merge_buffer(drive, 0);
1799 1800 1801
		return idetape_position_tape(drive,
			mt_count * tape->user_bs_factor, tape->partition, 0);
	case MTSETPART:
1802
		ide_tape_discard_merge_buffer(drive, 0);
1803 1804 1805 1806
		return idetape_position_tape(drive, 0, mt_count, 0);
	case MTFSR:
	case MTBSR:
	case MTLOCK:
1807
		retval = ide_set_media_lock(drive, disk, 1);
1808
		if (retval)
L
Linus Torvalds 已提交
1809
			return retval;
1810 1811 1812
		tape->door_locked = DOOR_EXPLICITLY_LOCKED;
		return 0;
	case MTUNLOCK:
1813
		retval = ide_set_media_lock(drive, disk, 0);
1814 1815 1816 1817 1818 1819 1820 1821
		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 已提交
1822 1823 1824 1825
	}
}

/*
1826 1827 1828
 * 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 已提交
1829
 */
1830 1831
static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
				unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
1832
{
B
Borislav Petkov 已提交
1833
	struct ide_tape_obj *tape = file->private_data;
L
Linus Torvalds 已提交
1834 1835 1836 1837
	ide_drive_t *drive = tape->drive;
	struct mtop mtop;
	struct mtget mtget;
	struct mtpos mtpos;
1838
	int block_offset = 0, position = tape->first_frame;
L
Linus Torvalds 已提交
1839 1840
	void __user *argp = (void __user *)arg;

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

1843
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
1844
		ide_tape_flush_merge_buffer(drive);
L
Linus Torvalds 已提交
1845 1846 1847
		idetape_flush_tape_buffers(drive);
	}
	if (cmd == MTIOCGET || cmd == MTIOCPOS) {
1848
		block_offset = tape->merge_bh_size /
1849
			(tape->blk_size * tape->user_bs_factor);
1850 1851
		position = idetape_read_position(drive);
		if (position < 0)
L
Linus Torvalds 已提交
1852 1853 1854
			return -EIO;
	}
	switch (cmd) {
1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879
	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)
1880
			ide_tape_discard_merge_buffer(drive, 1);
1881
		return idetape_blkdev_ioctl(drive, cmd, arg);
L
Linus Torvalds 已提交
1882 1883 1884
	}
}

1885 1886 1887 1888 1889 1890 1891
/*
 * 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;
1892
	struct ide_atapi_pc pc;
1893 1894

	idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR);
1895
	if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
1896
		printk(KERN_ERR "ide-tape: Can't get block descriptor\n");
1897
		if (tape->blk_size == 0) {
1898 1899
			printk(KERN_WARNING "ide-tape: Cannot deal with zero "
					    "block size, assuming 32k\n");
1900
			tape->blk_size = 32768;
1901 1902 1903
		}
		return;
	}
1904 1905 1906 1907
	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;
1908
}
L
Linus Torvalds 已提交
1909

1910
static int idetape_chrdev_open(struct inode *inode, struct file *filp)
L
Linus Torvalds 已提交
1911 1912 1913 1914 1915 1916
{
	unsigned int minor = iminor(inode), i = minor & ~0xc0;
	ide_drive_t *drive;
	idetape_tape_t *tape;
	int retval;

1917 1918 1919
	if (i >= MAX_HWIFS * MAX_DRIVES)
		return -ENXIO;

1920
	lock_kernel();
1921
	tape = ide_tape_chrdev_get(i);
1922 1923
	if (!tape) {
		unlock_kernel();
1924
		return -ENXIO;
1925
	}
1926 1927 1928

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

L
Linus Torvalds 已提交
1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939
	/*
	 * 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;

1940
	if (test_and_set_bit(IDE_AFLAG_BUSY, &drive->atapi_flags)) {
L
Linus Torvalds 已提交
1941 1942 1943 1944 1945 1946
		retval = -EBUSY;
		goto out_put_tape;
	}

	retval = idetape_wait_ready(drive, 60 * HZ);
	if (retval) {
1947
		clear_bit(IDE_AFLAG_BUSY, &drive->atapi_flags);
L
Linus Torvalds 已提交
1948 1949 1950 1951 1952
		printk(KERN_ERR "ide-tape: %s: drive not ready\n", tape->name);
		goto out_put_tape;
	}

	idetape_read_position(drive);
1953
	if (!test_bit(IDE_AFLAG_ADDRESS_VALID, &drive->atapi_flags))
L
Linus Torvalds 已提交
1954 1955 1956
		(void)idetape_rewind_tape(drive);

	/* Read block size and write protect status from drive. */
1957
	ide_tape_get_bsize_from_bdesc(drive);
L
Linus Torvalds 已提交
1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968

	/* 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) {
1969
			clear_bit(IDE_AFLAG_BUSY, &drive->atapi_flags);
L
Linus Torvalds 已提交
1970 1971 1972 1973 1974
			retval = -EROFS;
			goto out_put_tape;
		}
	}

1975
	/* Lock the tape drive door so user can't eject. */
1976
	if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
1977
		if (!ide_set_media_lock(drive, tape->disk, 1)) {
1978 1979
			if (tape->door_locked != DOOR_EXPLICITLY_LOCKED)
				tape->door_locked = DOOR_LOCKED;
L
Linus Torvalds 已提交
1980 1981
		}
	}
1982
	unlock_kernel();
L
Linus Torvalds 已提交
1983 1984 1985 1986
	return 0;

out_put_tape:
	ide_tape_put(tape);
1987
	unlock_kernel();
L
Linus Torvalds 已提交
1988 1989 1990
	return retval;
}

1991
static void idetape_write_release(ide_drive_t *drive, unsigned int minor)
L
Linus Torvalds 已提交
1992 1993 1994
{
	idetape_tape_t *tape = drive->driver_data;

1995
	ide_tape_flush_merge_buffer(drive);
1996 1997
	tape->merge_bh = ide_tape_kmalloc_buffer(tape, 1, 0);
	if (tape->merge_bh != NULL) {
1998 1999
		idetape_pad_zeros(drive, tape->blk_size *
				(tape->user_bs_factor - 1));
2000 2001
		ide_tape_kfree_buffer(tape);
		tape->merge_bh = NULL;
L
Linus Torvalds 已提交
2002 2003 2004 2005 2006 2007
	}
	idetape_write_filemark(drive);
	idetape_flush_tape_buffers(drive);
	idetape_flush_tape_buffers(drive);
}

2008
static int idetape_chrdev_release(struct inode *inode, struct file *filp)
L
Linus Torvalds 已提交
2009
{
B
Borislav Petkov 已提交
2010
	struct ide_tape_obj *tape = filp->private_data;
L
Linus Torvalds 已提交
2011 2012 2013 2014 2015
	ide_drive_t *drive = tape->drive;
	unsigned int minor = iminor(inode);

	lock_kernel();
	tape = drive->driver_data;
2016 2017

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

2019
	if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
L
Linus Torvalds 已提交
2020
		idetape_write_release(drive, minor);
2021
	if (tape->chrdev_dir == IDETAPE_DIR_READ) {
L
Linus Torvalds 已提交
2022
		if (minor < 128)
2023
			ide_tape_discard_merge_buffer(drive, 1);
L
Linus Torvalds 已提交
2024
	}
2025

2026
	if (minor < 128 && test_bit(IDE_AFLAG_MEDIUM_PRESENT, &drive->atapi_flags))
L
Linus Torvalds 已提交
2027
		(void) idetape_rewind_tape(drive);
2028
	if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
L
Linus Torvalds 已提交
2029
		if (tape->door_locked == DOOR_LOCKED) {
2030
			if (!ide_set_media_lock(drive, tape->disk, 0))
2031
				tape->door_locked = DOOR_UNLOCKED;
L
Linus Torvalds 已提交
2032 2033
		}
	}
2034
	clear_bit(IDE_AFLAG_BUSY, &drive->atapi_flags);
L
Linus Torvalds 已提交
2035 2036 2037 2038 2039
	ide_tape_put(tape);
	unlock_kernel();
	return 0;
}

2040
static void idetape_get_inquiry_results(ide_drive_t *drive)
L
Linus Torvalds 已提交
2041 2042
{
	idetape_tape_t *tape = drive->driver_data;
2043
	struct ide_atapi_pc pc;
B
Borislav Petkov 已提交
2044
	char fw_rev[4], vendor_id[8], product_id[16];
2045

L
Linus Torvalds 已提交
2046
	idetape_create_inquiry_cmd(&pc);
2047
	if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
2048 2049
		printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
				tape->name);
L
Linus Torvalds 已提交
2050 2051
		return;
	}
2052 2053 2054
	memcpy(vendor_id, &pc.buf[8], 8);
	memcpy(product_id, &pc.buf[16], 16);
	memcpy(fw_rev, &pc.buf[32], 4);
2055

B
Borislav Petkov 已提交
2056 2057 2058
	ide_fixstring(vendor_id, 8, 0);
	ide_fixstring(product_id, 16, 0);
	ide_fixstring(fw_rev, 4, 0);
2059

B
Borislav Petkov 已提交
2060
	printk(KERN_INFO "ide-tape: %s <-> %s: %.8s %.16s rev %.4s\n",
2061
			drive->name, tape->name, vendor_id, product_id, fw_rev);
L
Linus Torvalds 已提交
2062 2063 2064
}

/*
2065 2066
 * 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 已提交
2067
 */
2068
static void idetape_get_mode_sense_results(ide_drive_t *drive)
L
Linus Torvalds 已提交
2069 2070
{
	idetape_tape_t *tape = drive->driver_data;
2071
	struct ide_atapi_pc pc;
2072 2073
	u8 *caps;
	u8 speed, max_speed;
2074

L
Linus Torvalds 已提交
2075
	idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
2076
	if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
2077 2078
		printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
				" some default values\n");
2079
		tape->blk_size = 512;
2080 2081 2082
		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 已提交
2083 2084
		return;
	}
2085
	caps = pc.buf + 4 + pc.buf[3];
2086 2087

	/* convert to host order and save for later use */
2088 2089
	speed = be16_to_cpup((__be16 *)&caps[14]);
	max_speed = be16_to_cpup((__be16 *)&caps[8]);
L
Linus Torvalds 已提交
2090

2091 2092 2093 2094
	*(u16 *)&caps[8] = max_speed;
	*(u16 *)&caps[12] = be16_to_cpup((__be16 *)&caps[12]);
	*(u16 *)&caps[14] = speed;
	*(u16 *)&caps[16] = be16_to_cpup((__be16 *)&caps[16]);
L
Linus Torvalds 已提交
2095

2096 2097 2098
	if (!speed) {
		printk(KERN_INFO "ide-tape: %s: invalid tape speed "
				"(assuming 650KB/sec)\n", drive->name);
2099
		*(u16 *)&caps[14] = 650;
L
Linus Torvalds 已提交
2100
	}
2101 2102 2103
	if (!max_speed) {
		printk(KERN_INFO "ide-tape: %s: invalid max_speed "
				"(assuming 650KB/sec)\n", drive->name);
2104
		*(u16 *)&caps[8] = 650;
L
Linus Torvalds 已提交
2105 2106
	}

2107
	memcpy(&tape->caps, caps, 20);
2108 2109 2110

	/* device lacks locking support according to capabilities page */
	if ((caps[6] & 1) == 0)
2111
		drive->dev_flags &= ~IDE_DFLAG_DOORLOCKING;
2112

2113
	if (caps[7] & 0x02)
2114
		tape->blk_size = 512;
2115
	else if (caps[7] & 0x04)
2116
		tape->blk_size = 1024;
L
Linus Torvalds 已提交
2117 2118
}

2119
#ifdef CONFIG_IDE_PROC_FS
2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134
#define ide_tape_devset_get(name, field) \
static int get_##name(ide_drive_t *drive) \
{ \
	idetape_tape_t *tape = drive->driver_data; \
	return tape->field; \
}

#define ide_tape_devset_set(name, field) \
static int set_##name(ide_drive_t *drive, int arg) \
{ \
	idetape_tape_t *tape = drive->driver_data; \
	tape->field = arg; \
	return 0; \
}

2135
#define ide_tape_devset_rw_field(_name, _field) \
2136 2137
ide_tape_devset_get(_name, _field) \
ide_tape_devset_set(_name, _field) \
2138
IDE_DEVSET(_name, DS_SYNC, get_##_name, set_##_name)
2139

2140
#define ide_tape_devset_r_field(_name, _field) \
2141
ide_tape_devset_get(_name, _field) \
2142
IDE_DEVSET(_name, 0, get_##_name, NULL)
2143 2144 2145 2146 2147 2148

static int mulf_tdsc(ide_drive_t *drive)	{ return 1000; }
static int divf_tdsc(ide_drive_t *drive)	{ return   HZ; }
static int divf_buffer(ide_drive_t *drive)	{ return    2; }
static int divf_buffer_size(ide_drive_t *drive)	{ return 1024; }

B
Bartlomiej Zolnierkiewicz 已提交
2149
ide_devset_rw_flag(dsc_overlap, IDE_DFLAG_DSC_OVERLAP);
2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168

ide_tape_devset_rw_field(debug_mask, debug_mask);
ide_tape_devset_rw_field(tdsc, best_dsc_rw_freq);

ide_tape_devset_r_field(avg_speed, avg_speed);
ide_tape_devset_r_field(speed, caps[14]);
ide_tape_devset_r_field(buffer, caps[16]);
ide_tape_devset_r_field(buffer_size, buffer_size);

static const struct ide_proc_devset idetape_settings[] = {
	__IDE_PROC_DEVSET(avg_speed,	0, 0xffff, NULL, NULL),
	__IDE_PROC_DEVSET(buffer,	0, 0xffff, NULL, divf_buffer),
	__IDE_PROC_DEVSET(buffer_size,	0, 0xffff, NULL, divf_buffer_size),
	__IDE_PROC_DEVSET(debug_mask,	0, 0xffff, NULL, NULL),
	__IDE_PROC_DEVSET(dsc_overlap,	0,      1, NULL, NULL),
	__IDE_PROC_DEVSET(speed,	0, 0xffff, NULL, NULL),
	__IDE_PROC_DEVSET(tdsc,		IDETAPE_DSC_RW_MIN, IDETAPE_DSC_RW_MAX,
					mulf_tdsc, divf_tdsc),
	{ 0 },
2169
};
2170
#endif
L
Linus Torvalds 已提交
2171 2172

/*
2173
 * The function below is called to:
L
Linus Torvalds 已提交
2174
 *
2175 2176 2177 2178
 * 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 已提交
2179
 *
2180 2181
 * 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 已提交
2182
 */
2183
static void idetape_setup(ide_drive_t *drive, idetape_tape_t *tape, int minor)
L
Linus Torvalds 已提交
2184
{
2185
	unsigned long t;
L
Linus Torvalds 已提交
2186
	int speed;
2187
	int buffer_size;
2188
	u16 *ctl = (u16 *)&tape->caps[12];
L
Linus Torvalds 已提交
2189

2190 2191 2192
	drive->pc_callback	 = ide_tape_callback;
	drive->pc_update_buffers = idetape_update_buffers;
	drive->pc_io_buffers	 = ide_tape_io_buffers;
2193

2194
	spin_lock_init(&tape->lock);
B
Bartlomiej Zolnierkiewicz 已提交
2195 2196 2197

	drive->dev_flags |= IDE_DFLAG_DSC_OVERLAP;

2198 2199 2200
	if (drive->hwif->host_flags & IDE_HFLAG_NO_DSC) {
		printk(KERN_INFO "ide-tape: %s: disabling DSC overlap\n",
				 tape->name);
B
Bartlomiej Zolnierkiewicz 已提交
2201
		drive->dev_flags &= ~IDE_DFLAG_DSC_OVERLAP;
L
Linus Torvalds 已提交
2202
	}
B
Bartlomiej Zolnierkiewicz 已提交
2203

L
Linus Torvalds 已提交
2204
	/* Seagate Travan drives do not support DSC overlap. */
2205
	if (strstr((char *)&drive->id[ATA_ID_PROD], "Seagate STT3401"))
B
Bartlomiej Zolnierkiewicz 已提交
2206 2207
		drive->dev_flags &= ~IDE_DFLAG_DSC_OVERLAP;

L
Linus Torvalds 已提交
2208 2209 2210 2211
	tape->minor = minor;
	tape->name[0] = 'h';
	tape->name[1] = 't';
	tape->name[2] = '0' + minor;
2212
	tape->chrdev_dir = IDETAPE_DIR_NONE;
2213

L
Linus Torvalds 已提交
2214 2215
	idetape_get_inquiry_results(drive);
	idetape_get_mode_sense_results(drive);
2216
	ide_tape_get_bsize_from_bdesc(drive);
L
Linus Torvalds 已提交
2217
	tape->user_bs_factor = 1;
2218 2219
	tape->buffer_size = *ctl * tape->blk_size;
	while (tape->buffer_size > 0xffff) {
L
Linus Torvalds 已提交
2220
		printk(KERN_NOTICE "ide-tape: decreasing stage size\n");
2221
		*ctl /= 2;
2222
		tape->buffer_size = *ctl * tape->blk_size;
L
Linus Torvalds 已提交
2223
	}
2224
	buffer_size = tape->buffer_size;
2225
	tape->pages_per_buffer = buffer_size / PAGE_SIZE;
2226
	if (buffer_size % PAGE_SIZE) {
2227
		tape->pages_per_buffer++;
2228
		tape->excess_bh_size = PAGE_SIZE - buffer_size % PAGE_SIZE;
L
Linus Torvalds 已提交
2229 2230
	}

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

2234
	t = (IDETAPE_FIFO_THRESHOLD * tape->buffer_size * HZ) / (speed * 1000);
L
Linus Torvalds 已提交
2235 2236

	/*
2237 2238
	 * Ensure that the number we got makes sense; limit it within
	 * IDETAPE_DSC_RW_MIN and IDETAPE_DSC_RW_MAX.
L
Linus Torvalds 已提交
2239
	 */
2240 2241
	tape->best_dsc_rw_freq = clamp_t(unsigned long, t, IDETAPE_DSC_RW_MIN,
					 IDETAPE_DSC_RW_MAX);
L
Linus Torvalds 已提交
2242
	printk(KERN_INFO "ide-tape: %s <-> %s: %dKBps, %d*%dkB buffer, "
2243
		"%lums tDSC%s\n",
2244
		drive->name, tape->name, *(u16 *)&tape->caps[14],
2245 2246
		(*(u16 *)&tape->caps[16] * 512) / tape->buffer_size,
		tape->buffer_size / 1024,
2247
		tape->best_dsc_rw_freq * 1000 / HZ,
B
Bartlomiej Zolnierkiewicz 已提交
2248
		(drive->dev_flags & IDE_DFLAG_USING_DMA) ? ", DMA" : "");
L
Linus Torvalds 已提交
2249

2250
	ide_proc_register_driver(drive, tape->driver);
L
Linus Torvalds 已提交
2251 2252
}

2253
static void ide_tape_remove(ide_drive_t *drive)
L
Linus Torvalds 已提交
2254 2255 2256
{
	idetape_tape_t *tape = drive->driver_data;

2257
	ide_proc_unregister_driver(drive, tape->driver);
L
Linus Torvalds 已提交
2258 2259 2260 2261 2262 2263 2264 2265

	ide_unregister_region(tape->disk);

	ide_tape_put(tape);
}

static void ide_tape_release(struct kref *kref)
{
B
Borislav Petkov 已提交
2266
	struct ide_tape_obj *tape = to_ide_drv(kref, ide_tape_obj);
L
Linus Torvalds 已提交
2267 2268 2269
	ide_drive_t *drive = tape->drive;
	struct gendisk *g = tape->disk;

2270
	BUG_ON(tape->merge_bh_size);
2271

B
Bartlomiej Zolnierkiewicz 已提交
2272
	drive->dev_flags &= ~IDE_DFLAG_DSC_OVERLAP;
L
Linus Torvalds 已提交
2273
	drive->driver_data = NULL;
2274
	device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor));
2275 2276
	device_destroy(idetape_sysfs_class,
			MKDEV(IDETAPE_MAJOR, tape->minor + 128));
L
Linus Torvalds 已提交
2277 2278 2279 2280 2281 2282
	idetape_devs[tape->minor] = NULL;
	g->private_data = NULL;
	put_disk(g);
	kfree(tape);
}

2283
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302
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

2303
static int ide_tape_probe(ide_drive_t *);
L
Linus Torvalds 已提交
2304 2305

static ide_driver_t idetape_driver = {
2306
	.gen_driver = {
2307
		.owner		= THIS_MODULE,
2308 2309 2310
		.name		= "ide-tape",
		.bus		= &ide_bus_type,
	},
2311 2312
	.probe			= ide_tape_probe,
	.remove			= ide_tape_remove,
L
Linus Torvalds 已提交
2313 2314 2315 2316
	.version		= IDETAPE_VERSION,
	.do_request		= idetape_do_request,
	.end_request		= idetape_end_request,
	.error			= __ide_error,
2317
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2318
	.proc			= idetape_proc,
2319
	.settings		= idetape_settings,
2320
#endif
L
Linus Torvalds 已提交
2321 2322
};

2323
/* Our character device supporting functions, passed to register_chrdev. */
2324
static const struct file_operations idetape_fops = {
L
Linus Torvalds 已提交
2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337
	.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;

2338 2339
	tape = ide_tape_get(disk);
	if (!tape)
L
Linus Torvalds 已提交
2340 2341 2342 2343 2344 2345 2346 2347
		return -ENXIO;

	return 0;
}

static int idetape_release(struct inode *inode, struct file *filp)
{
	struct gendisk *disk = inode->i_bdev->bd_disk;
B
Borislav Petkov 已提交
2348
	struct ide_tape_obj *tape = ide_drv_g(disk, ide_tape_obj);
L
Linus Torvalds 已提交
2349 2350 2351 2352 2353 2354 2355 2356 2357 2358

	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;
B
Borislav Petkov 已提交
2359
	struct ide_tape_obj *tape = ide_drv_g(bdev->bd_disk, ide_tape_obj);
L
Linus Torvalds 已提交
2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373
	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,
};

2374
static int ide_tape_probe(ide_drive_t *drive)
L
Linus Torvalds 已提交
2375 2376 2377 2378 2379 2380 2381
{
	idetape_tape_t *tape;
	struct gendisk *g;
	int minor;

	if (!strstr("ide-tape", drive->driver_req))
		goto failed;
2382

L
Linus Torvalds 已提交
2383 2384
	if (drive->media != ide_tape)
		goto failed;
2385

B
Bartlomiej Zolnierkiewicz 已提交
2386 2387
	if ((drive->dev_flags & IDE_DFLAG_ID_READ) &&
	    ide_check_atapi_device(drive, DRV_NAME) == 0) {
2388 2389
		printk(KERN_ERR "ide-tape: %s: not supported by this version of"
				" the driver\n", drive->name);
L
Linus Torvalds 已提交
2390 2391
		goto failed;
	}
2392
	tape = kzalloc(sizeof(idetape_tape_t), GFP_KERNEL);
L
Linus Torvalds 已提交
2393
	if (tape == NULL) {
2394 2395
		printk(KERN_ERR "ide-tape: %s: Can't allocate a tape struct\n",
				drive->name);
L
Linus Torvalds 已提交
2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414
		goto failed;
	}

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

	ide_init_disk(g, drive);

	kref_init(&tape->kref);

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

	g->private_data = &tape->driver;

	drive->driver_data = tape;

2415
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2416 2417 2418
	for (minor = 0; idetape_devs[minor]; minor++)
		;
	idetape_devs[minor] = tape;
2419
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2420 2421 2422

	idetape_setup(drive, tape, minor);

2423 2424 2425 2426 2427
	device_create(idetape_sysfs_class, &drive->gendev,
		      MKDEV(IDETAPE_MAJOR, minor), NULL, "%s", tape->name);
	device_create(idetape_sysfs_class, &drive->gendev,
		      MKDEV(IDETAPE_MAJOR, minor + 128), NULL,
		      "n%s", tape->name);
2428

L
Linus Torvalds 已提交
2429 2430 2431 2432
	g->fops = &idetape_block_ops;
	ide_register_region(g);

	return 0;
2433

L
Linus Torvalds 已提交
2434 2435 2436
out_free_tape:
	kfree(tape);
failed:
2437
	return -ENODEV;
L
Linus Torvalds 已提交
2438 2439
}

2440
static void __exit idetape_exit(void)
L
Linus Torvalds 已提交
2441
{
2442
	driver_unregister(&idetape_driver.gen_driver);
2443
	class_destroy(idetape_sysfs_class);
L
Linus Torvalds 已提交
2444 2445 2446
	unregister_chrdev(IDETAPE_MAJOR, "ht");
}

2447
static int __init idetape_init(void)
L
Linus Torvalds 已提交
2448
{
2449 2450 2451 2452 2453 2454 2455 2456 2457
	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 已提交
2458
	if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
2459 2460
		printk(KERN_ERR "ide-tape: Failed to register chrdev"
				" interface\n");
2461 2462
		error = -EBUSY;
		goto out_free_class;
L
Linus Torvalds 已提交
2463
	}
2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476

	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 已提交
2477 2478
}

2479
MODULE_ALIAS("ide:*m-tape*");
L
Linus Torvalds 已提交
2480 2481 2482
module_init(idetape_init);
module_exit(idetape_exit);
MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
2483 2484
MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
MODULE_LICENSE("GPL");