ide-tape.c 66.9 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
 */
typedef struct ide_tape_obj {
169 170 171
	ide_drive_t		*drive;
	struct ide_driver	*driver;
	struct gendisk		*disk;
172
	struct device		dev;
L
Linus Torvalds 已提交
173 174 175 176 177 178 179 180

	/*
	 *	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
static void ide_tape_release(struct device *);
271

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
		else
282
			get_device(&tape->dev);
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);
293
	put_device(&tape->dev);
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
	tape = idetape_devs[i];
	if (tape)
311
		get_device(&tape->dev);
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
		}
		prev_bh = bh;
		bh = bh->b_reqnext;
		kfree(prev_bh);
	}
}

static int idetape_end_request(ide_drive_t *drive, int uptodate, int nr_sects)
{
482
	struct request *rq = drive->hwif->rq;
L
Linus Torvalds 已提交
483 484 485 486
	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
	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) {
534
		struct request *rq = drive->hwif->rq;
535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551
		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
 * Postpone the current request so that ide.c will be able to service requests
579
 * from another device on the same port 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__);

587 588
	tape->postponed_rq = drive->hwif->rq;

589
	ide_stall_queue(drive, tape->dsc_poll_freq);
L
Linus Torvalds 已提交
590 591
}

592 593 594 595 596 597 598 599 600 601 602 603
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);
}

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

	return bcount;
613
}
614

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

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

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

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

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

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

	pc->retries++;

698
	return ide_issue_pc(drive);
L
Linus Torvalds 已提交
699 700
}

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

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

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

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

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

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

773 774 775 776 777 778 779 780 781
	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);
	}
782 783

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

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

795 796 797 798
	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 已提交
799

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

1386
	idetape_init_read(drive);
1387 1388

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

2092 2093 2094 2095
	*(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 已提交
2096

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

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

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

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

2120
#ifdef CONFIG_IDE_PROC_FS
2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135
#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; \
}

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

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

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 已提交
2150
ide_devset_rw_flag(dsc_overlap, IDE_DFLAG_DSC_OVERLAP);
2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169

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 },
2170
};
2171
#endif
L
Linus Torvalds 已提交
2172 2173

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

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

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

	drive->dev_flags |= IDE_DFLAG_DSC_OVERLAP;

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

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

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

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

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

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

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

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

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

2258
	ide_proc_unregister_driver(drive, tape->driver);
2259
	device_del(&tape->dev);
L
Linus Torvalds 已提交
2260 2261
	ide_unregister_region(tape->disk);

2262 2263 2264
	mutex_lock(&idetape_ref_mutex);
	put_device(&tape->dev);
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2265 2266
}

2267
static void ide_tape_release(struct device *dev)
L
Linus Torvalds 已提交
2268
{
2269
	struct ide_tape_obj *tape = to_ide_drv(dev, ide_tape_obj);
L
Linus Torvalds 已提交
2270 2271 2272
	ide_drive_t *drive = tape->drive;
	struct gendisk *g = tape->disk;

2273
	BUG_ON(tape->merge_bh_size);
2274

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

2286
#ifdef CONFIG_IDE_PROC_FS
L
Linus Torvalds 已提交
2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303
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 }
};
2304 2305 2306 2307 2308 2309 2310 2311 2312 2313

static ide_proc_entry_t *ide_tape_proc_entries(ide_drive_t *drive)
{
	return idetape_proc;
}

static const struct ide_proc_devset *ide_tape_proc_devsets(ide_drive_t *drive)
{
	return idetape_settings;
}
L
Linus Torvalds 已提交
2314 2315
#endif

2316
static int ide_tape_probe(ide_drive_t *);
L
Linus Torvalds 已提交
2317

2318
static struct ide_driver idetape_driver = {
2319
	.gen_driver = {
2320
		.owner		= THIS_MODULE,
2321 2322 2323
		.name		= "ide-tape",
		.bus		= &ide_bus_type,
	},
2324 2325
	.probe			= ide_tape_probe,
	.remove			= ide_tape_remove,
L
Linus Torvalds 已提交
2326 2327 2328
	.version		= IDETAPE_VERSION,
	.do_request		= idetape_do_request,
	.end_request		= idetape_end_request,
2329
#ifdef CONFIG_IDE_PROC_FS
2330 2331
	.proc_entries		= ide_tape_proc_entries,
	.proc_devsets		= ide_tape_proc_devsets,
2332
#endif
L
Linus Torvalds 已提交
2333 2334
};

2335
/* Our character device supporting functions, passed to register_chrdev. */
2336
static const struct file_operations idetape_fops = {
L
Linus Torvalds 已提交
2337 2338 2339 2340 2341 2342 2343 2344
	.owner		= THIS_MODULE,
	.read		= idetape_chrdev_read,
	.write		= idetape_chrdev_write,
	.ioctl		= idetape_chrdev_ioctl,
	.open		= idetape_chrdev_open,
	.release	= idetape_chrdev_release,
};

A
Al Viro 已提交
2345
static int idetape_open(struct block_device *bdev, fmode_t mode)
L
Linus Torvalds 已提交
2346
{
A
Al Viro 已提交
2347
	struct ide_tape_obj *tape = ide_tape_get(bdev->bd_disk);
L
Linus Torvalds 已提交
2348

2349
	if (!tape)
L
Linus Torvalds 已提交
2350 2351 2352 2353 2354
		return -ENXIO;

	return 0;
}

A
Al Viro 已提交
2355
static int idetape_release(struct gendisk *disk, fmode_t mode)
L
Linus Torvalds 已提交
2356
{
B
Borislav Petkov 已提交
2357
	struct ide_tape_obj *tape = ide_drv_g(disk, ide_tape_obj);
L
Linus Torvalds 已提交
2358 2359 2360 2361 2362

	ide_tape_put(tape);
	return 0;
}

A
Al Viro 已提交
2363
static int idetape_ioctl(struct block_device *bdev, fmode_t mode,
L
Linus Torvalds 已提交
2364 2365
			unsigned int cmd, unsigned long arg)
{
B
Borislav Petkov 已提交
2366
	struct ide_tape_obj *tape = ide_drv_g(bdev->bd_disk, ide_tape_obj);
L
Linus Torvalds 已提交
2367
	ide_drive_t *drive = tape->drive;
2368
	int err = generic_ide_ioctl(drive, bdev, cmd, arg);
L
Linus Torvalds 已提交
2369 2370 2371 2372 2373 2374 2375
	if (err == -EINVAL)
		err = idetape_blkdev_ioctl(drive, cmd, arg);
	return err;
}

static struct block_device_operations idetape_block_ops = {
	.owner		= THIS_MODULE,
A
Al Viro 已提交
2376 2377 2378
	.open		= idetape_open,
	.release	= idetape_release,
	.locked_ioctl	= idetape_ioctl,
L
Linus Torvalds 已提交
2379 2380
};

2381
static int ide_tape_probe(ide_drive_t *drive)
L
Linus Torvalds 已提交
2382 2383 2384 2385 2386 2387 2388
{
	idetape_tape_t *tape;
	struct gendisk *g;
	int minor;

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

L
Linus Torvalds 已提交
2390 2391
	if (drive->media != ide_tape)
		goto failed;
2392

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

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

	ide_init_disk(g, drive);

2412 2413 2414 2415 2416 2417
	tape->dev.parent = &drive->gendev;
	tape->dev.release = ide_tape_release;
	dev_set_name(&tape->dev, dev_name(&drive->gendev));

	if (device_register(&tape->dev))
		goto out_free_disk;
L
Linus Torvalds 已提交
2418 2419 2420 2421 2422 2423 2424 2425 2426

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

	g->private_data = &tape->driver;

	drive->driver_data = tape;

2427
	mutex_lock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2428 2429 2430
	for (minor = 0; idetape_devs[minor]; minor++)
		;
	idetape_devs[minor] = tape;
2431
	mutex_unlock(&idetape_ref_mutex);
L
Linus Torvalds 已提交
2432 2433 2434

	idetape_setup(drive, tape, minor);

2435 2436 2437 2438 2439
	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);
2440

L
Linus Torvalds 已提交
2441 2442 2443 2444
	g->fops = &idetape_block_ops;
	ide_register_region(g);

	return 0;
2445

2446 2447
out_free_disk:
	put_disk(g);
L
Linus Torvalds 已提交
2448 2449 2450
out_free_tape:
	kfree(tape);
failed:
2451
	return -ENODEV;
L
Linus Torvalds 已提交
2452 2453
}

2454
static void __exit idetape_exit(void)
L
Linus Torvalds 已提交
2455
{
2456
	driver_unregister(&idetape_driver.gen_driver);
2457
	class_destroy(idetape_sysfs_class);
L
Linus Torvalds 已提交
2458 2459 2460
	unregister_chrdev(IDETAPE_MAJOR, "ht");
}

2461
static int __init idetape_init(void)
L
Linus Torvalds 已提交
2462
{
2463 2464 2465 2466 2467 2468 2469 2470 2471
	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 已提交
2472
	if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
2473 2474
		printk(KERN_ERR "ide-tape: Failed to register chrdev"
				" interface\n");
2475 2476
		error = -EBUSY;
		goto out_free_class;
L
Linus Torvalds 已提交
2477
	}
2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490

	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 已提交
2491 2492
}

2493
MODULE_ALIAS("ide:*m-tape*");
L
Linus Torvalds 已提交
2494 2495 2496
module_init(idetape_init);
module_exit(idetape_exit);
MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
2497 2498
MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
MODULE_LICENSE("GPL");