ide-cd.c 45.0 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 * ATAPI CD-ROM driver.
L
Linus Torvalds 已提交
3
 *
4 5 6
 * Copyright (C) 1994-1996   Scott Snyder <snyder@fnald0.fnal.gov>
 * Copyright (C) 1996-1998   Erik Andersen <andersee@debian.org>
 * Copyright (C) 1998-2000   Jens Axboe <axboe@suse.de>
7
 * Copyright (C) 2005, 2007-2009  Bartlomiej Zolnierkiewicz
L
Linus Torvalds 已提交
8 9 10 11 12 13 14
 *
 * May be copied or modified under the terms of the GNU General Public
 * License.  See linux/COPYING for more information.
 *
 * See Documentation/cdrom/ide-cd for usage information.
 *
 * Suggestions are welcome. Patches that work are more welcome though. ;-)
15 16 17
 *
 * Documentation:
 *	Mt. Fuji (SFF8090 version 4) and ATAPI (SFF-8020i rev 2.6) standards.
L
Linus Torvalds 已提交
18
 *
19 20 21 22
 * For historical changelog please see:
 *	Documentation/ide/ChangeLog.ide-cd.1994-2004
 */

23 24 25
#define DRV_NAME "ide-cd"
#define PFX DRV_NAME ": "

26
#define IDECD_VERSION "5.00"
L
Linus Torvalds 已提交
27 28 29 30 31 32 33 34 35 36 37 38

#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/timer.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/errno.h>
#include <linux/cdrom.h>
#include <linux/ide.h>
#include <linux/completion.h>
39
#include <linux/mutex.h>
40
#include <linux/bcd.h>
L
Linus Torvalds 已提交
41

B
Borislav Petkov 已提交
42 43
/* For SCSI -> ATAPI command conversion */
#include <scsi/scsi.h>
L
Linus Torvalds 已提交
44

B
Borislav Petkov 已提交
45 46
#include <linux/irq.h>
#include <linux/io.h>
L
Linus Torvalds 已提交
47
#include <asm/byteorder.h>
B
Borislav Petkov 已提交
48
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
49 50 51 52
#include <asm/unaligned.h>

#include "ide-cd.h"

53
static DEFINE_MUTEX(idecd_ref_mutex);
L
Linus Torvalds 已提交
54

55
static void ide_cd_release(struct device *);
56

L
Linus Torvalds 已提交
57 58 59 60
static struct cdrom_info *ide_cd_get(struct gendisk *disk)
{
	struct cdrom_info *cd = NULL;

61
	mutex_lock(&idecd_ref_mutex);
B
Borislav Petkov 已提交
62
	cd = ide_drv_g(disk, cdrom_info);
63
	if (cd) {
64
		if (ide_device_get(cd->drive))
65
			cd = NULL;
66
		else
67
			get_device(&cd->dev);
68

69
	}
70
	mutex_unlock(&idecd_ref_mutex);
L
Linus Torvalds 已提交
71 72 73 74 75
	return cd;
}

static void ide_cd_put(struct cdrom_info *cd)
{
76 77
	ide_drive_t *drive = cd->drive;

78
	mutex_lock(&idecd_ref_mutex);
79
	put_device(&cd->dev);
80
	ide_device_put(drive);
81
	mutex_unlock(&idecd_ref_mutex);
L
Linus Torvalds 已提交
82 83
}

B
Borislav Petkov 已提交
84
/*
L
Linus Torvalds 已提交
85 86 87
 * Generic packet command support and error handling routines.
 */

B
Borislav Petkov 已提交
88
/* Mark that we've seen a media change and invalidate our internal buffers. */
89
static void cdrom_saw_media_change(ide_drive_t *drive)
L
Linus Torvalds 已提交
90
{
91
	drive->dev_flags |= IDE_DFLAG_MEDIA_CHANGED;
92
	drive->atapi_flags &= ~IDE_AFLAG_TOC_VALID;
L
Linus Torvalds 已提交
93 94
}

95
static int cdrom_log_sense(ide_drive_t *drive, struct request *rq)
L
Linus Torvalds 已提交
96
{
97
	struct request_sense *sense = &drive->sense_data;
L
Linus Torvalds 已提交
98 99
	int log = 0;

100
	if (!sense || !rq || (rq->cmd_flags & REQ_QUIET))
L
Linus Torvalds 已提交
101 102
		return 0;

103 104
	ide_debug_log(IDE_DBG_SENSE, "sense_key: 0x%x", sense->sense_key);

L
Linus Torvalds 已提交
105
	switch (sense->sense_key) {
106 107 108 109 110
	case NO_SENSE:
	case RECOVERED_ERROR:
		break;
	case NOT_READY:
		/*
B
Borislav Petkov 已提交
111 112
		 * don't care about tray state messages for e.g. capacity
		 * commands or in-progress or becoming ready
113 114
		 */
		if (sense->asc == 0x3a || sense->asc == 0x04)
L
Linus Torvalds 已提交
115
			break;
116 117 118 119
		log = 1;
		break;
	case ILLEGAL_REQUEST:
		/*
B
Borislav Petkov 已提交
120 121
		 * don't log START_STOP unit with LoEj set, since we cannot
		 * reliably check if drive can auto-close
122 123
		 */
		if (rq->cmd[0] == GPCMD_START_STOP_UNIT && sense->asc == 0x24)
L
Linus Torvalds 已提交
124
			break;
125 126 127 128
		log = 1;
		break;
	case UNIT_ATTENTION:
		/*
B
Borislav Petkov 已提交
129 130 131
		 * Make good and sure we've seen this potential media change.
		 * Some drives (i.e. Creative) fail to present the correct sense
		 * key in the error register.
132 133 134 135 136 137
		 */
		cdrom_saw_media_change(drive);
		break;
	default:
		log = 1;
		break;
L
Linus Torvalds 已提交
138 139 140 141
	}
	return log;
}

142
static void cdrom_analyze_sense_data(ide_drive_t *drive,
143
				     struct request *failed_command)
L
Linus Torvalds 已提交
144
{
145 146
	struct request_sense *sense = &drive->sense_data;
	struct cdrom_info *info = drive->driver_data;
A
Alan Cox 已提交
147 148 149
	unsigned long sector;
	unsigned long bio_sectors;

B
Borislav Petkov 已提交
150 151
	ide_debug_log(IDE_DBG_SENSE, "error_code: 0x%x, sense_key: 0x%x",
				     sense->error_code, sense->sense_key);
152 153

	if (failed_command)
B
Borislav Petkov 已提交
154 155
		ide_debug_log(IDE_DBG_SENSE, "failed cmd: 0x%x",
					     failed_command->cmd[0]);
156

157
	if (!cdrom_log_sense(drive, failed_command))
L
Linus Torvalds 已提交
158 159 160
		return;

	/*
B
Borislav Petkov 已提交
161 162 163
	 * If a read toc is executed for a CD-R or CD-RW medium where the first
	 * toc has not been recorded yet, it will fail with 05/24/00 (which is a
	 * confusing error)
L
Linus Torvalds 已提交
164 165 166 167 168
	 */
	if (failed_command && failed_command->cmd[0] == GPCMD_READ_TOC_PMA_ATIP)
		if (sense->sense_key == 0x05 && sense->asc == 0x24)
			return;

B
Borislav Petkov 已提交
169 170
	/* current error */
	if (sense->error_code == 0x70) {
171
		switch (sense->sense_key) {
A
Alan Cox 已提交
172 173 174 175 176 177 178 179 180 181 182 183 184
		case MEDIUM_ERROR:
		case VOLUME_OVERFLOW:
		case ILLEGAL_REQUEST:
			if (!sense->valid)
				break;
			if (failed_command == NULL ||
					!blk_fs_request(failed_command))
				break;
			sector = (sense->information[0] << 24) |
				 (sense->information[1] << 16) |
				 (sense->information[2] <<  8) |
				 (sense->information[3]);

185
			if (queue_logical_block_size(drive->queue) == 2048)
B
Borislav Petkov 已提交
186 187
				/* device sector size is 2K */
				sector <<= 2;
188 189

			bio_sectors = max(bio_sectors(failed_command->bio), 4U);
190
			sector &= ~(bio_sectors - 1);
A
Alan Cox 已提交
191

192 193 194 195 196 197 198 199
			/*
			 * The SCSI specification allows for the value
			 * returned by READ CAPACITY to be up to 75 2K
			 * sectors past the last readable block.
			 * Therefore, if we hit a medium error within the
			 * last 75 2K sectors, we decrease the saved size
			 * value.
			 */
A
Alan Cox 已提交
200
			if (sector < get_capacity(info->disk) &&
201
			    drive->probed_capacity - sector < 4 * 75)
A
Alan Cox 已提交
202
				set_capacity(info->disk, sector);
203 204
		}
	}
L
Linus Torvalds 已提交
205

206
	ide_cd_log_error(drive->name, failed_command, sense);
L
Linus Torvalds 已提交
207 208
}

209 210 211
static void ide_cd_complete_failed_rq(ide_drive_t *drive, struct request *rq)
{
	/*
T
Tejun Heo 已提交
212
	 * For REQ_TYPE_SENSE, "rq->special" points to the original
213 214 215
	 * failed request.  Also, the sense data should be read
	 * directly from rq which might be different from the original
	 * sense buffer if it got copied during mapping.
216
	 */
T
Tejun Heo 已提交
217
	struct request *failed = (struct request *)rq->special;
218
	void *sense = bio_data(rq->bio);
219 220 221

	if (failed) {
		if (failed->sense) {
222 223 224 225 226 227
			/*
			 * Sense is always read into drive->sense_data.
			 * Copy back if the failed request has its
			 * sense pointer set.
			 */
			memcpy(failed->sense, sense, 18);
228 229
			failed->sense_len = rq->sense_len;
		}
230
		cdrom_analyze_sense_data(drive, failed);
231 232 233 234

		if (ide_end_rq(drive, failed, -EIO, blk_rq_bytes(failed)))
			BUG();
	} else
235
		cdrom_analyze_sense_data(drive, NULL);
236 237
}

238

B
Borislav Petkov 已提交
239
/*
240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274
 * Allow the drive 5 seconds to recover; some devices will return NOT_READY
 * while flushing data from cache.
 *
 * returns: 0 failed (write timeout expired)
 *	    1 success
 */
static int ide_cd_breathe(ide_drive_t *drive, struct request *rq)
{

	struct cdrom_info *info = drive->driver_data;

	if (!rq->errors)
		info->write_timeout = jiffies +	ATAPI_WAIT_WRITE_BUSY;

	rq->errors = 1;

	if (time_after(jiffies, info->write_timeout))
		return 0;
	else {
		struct request_queue *q = drive->queue;
		unsigned long flags;

		/*
		 * take a breather relying on the unplug timer to kick us again
		 */

		spin_lock_irqsave(q->queue_lock, flags);
		blk_plug_device(q);
		spin_unlock_irqrestore(q->queue_lock, flags);

		return 1;
	}
}

/**
B
Borislav Petkov 已提交
275 276
 * Returns:
 * 0: if the request should be continued.
277 278
 * 1: if the request will be going through error recovery.
 * 2: if the request should be ended.
B
Borislav Petkov 已提交
279
 */
280
static int cdrom_decode_status(ide_drive_t *drive, u8 stat)
L
Linus Torvalds 已提交
281
{
282
	ide_hwif_t *hwif = drive->hwif;
283
	struct request *rq = hwif->rq;
284
	int err, sense_key, do_end_request = 0;
L
Linus Torvalds 已提交
285

B
Borislav Petkov 已提交
286
	/* get the IDE error register */
287
	err = ide_read_error(drive);
L
Linus Torvalds 已提交
288 289
	sense_key = err >> 4;

290 291 292
	ide_debug_log(IDE_DBG_RQ, "cmd: 0x%x, rq->cmd_type: 0x%x, err: 0x%x, "
				  "stat 0x%x",
				  rq->cmd[0], rq->cmd_type, err, stat);
293

294
	if (blk_sense_request(rq)) {
B
Borislav Petkov 已提交
295 296 297 298 299
		/*
		 * We got an error trying to get sense info from the drive
		 * (probably while trying to recover from a former error).
		 * Just give up.
		 */
300
		rq->cmd_flags |= REQ_FAILED;
301
		return 2;
302
	}
L
Linus Torvalds 已提交
303

304 305 306
	/* if we have an error, pass CHECK_CONDITION as the SCSI status byte */
	if (blk_pc_request(rq) && !rq->errors)
		rq->errors = SAM_STAT_CHECK_CONDITION;
L
Linus Torvalds 已提交
307

308 309
	if (blk_noretry_request(rq))
		do_end_request = 1;
L
Linus Torvalds 已提交
310

311 312
	switch (sense_key) {
	case NOT_READY:
313 314 315 316
		if (blk_fs_request(rq) && rq_data_dir(rq) == WRITE) {
			if (ide_cd_breathe(drive, rq))
				return 1;
		} else {
317
			cdrom_saw_media_change(drive);
L
Linus Torvalds 已提交
318

319
			if (blk_fs_request(rq) && !blk_rq_quiet(rq))
320 321
				printk(KERN_ERR PFX "%s: tray open\n",
					drive->name);
L
Linus Torvalds 已提交
322
		}
323 324 325 326
		do_end_request = 1;
		break;
	case UNIT_ATTENTION:
		cdrom_saw_media_change(drive);
L
Linus Torvalds 已提交
327

328 329
		if (blk_fs_request(rq) == 0)
			return 0;
330

B
Borislav Petkov 已提交
331
		/*
332 333
		 * Arrange to retry the request but be sure to give up if we've
		 * retried too many times.
B
Borislav Petkov 已提交
334
		 */
335 336 337 338
		if (++rq->errors > ERROR_MAX)
			do_end_request = 1;
		break;
	case ILLEGAL_REQUEST:
339
		/*
340 341 342 343 344
		 * Don't print error message for this condition -- SFF8090i
		 * indicates that 5/24/00 is the correct response to a request
		 * to close the tray if the drive doesn't have that capability.
		 *
		 * cdrom_log_sense() knows this!
345
		 */
346 347 348 349 350 351 352 353
		if (rq->cmd[0] == GPCMD_START_STOP_UNIT)
			break;
		/* fall-through */
	case DATA_PROTECT:
		/*
		 * No point in retrying after an illegal request or data
		 * protect error.
		 */
354
		if (!blk_rq_quiet(rq))
355 356 357 358 359 360 361 362
			ide_dump_status(drive, "command error", stat);
		do_end_request = 1;
		break;
	case MEDIUM_ERROR:
		/*
		 * No point in re-trying a zillion times on a bad sector.
		 * If we got here the error is not correctable.
		 */
363
		if (!blk_rq_quiet(rq))
364 365 366 367 368 369
			ide_dump_status(drive, "media error "
					"(bad sector)", stat);
		do_end_request = 1;
		break;
	case BLANK_CHECK:
		/* disk appears blank? */
370
		if (!blk_rq_quiet(rq))
371 372 373 374 375 376 377 378 379 380 381 382 383 384
			ide_dump_status(drive, "media error (blank)",
					stat);
		do_end_request = 1;
		break;
	default:
		if (blk_fs_request(rq) == 0)
			break;
		if (err & ~ATA_ABORTED) {
			/* go to the default handler for other errors */
			ide_error(drive, "cdrom_decode_status", stat);
			return 1;
		} else if (++rq->errors > ERROR_MAX)
			/* we've racked up too many retries, abort */
			do_end_request = 1;
L
Linus Torvalds 已提交
385 386
	}

387 388 389 390 391 392 393 394 395 396 397 398 399 400
	if (blk_fs_request(rq) == 0) {
		rq->cmd_flags |= REQ_FAILED;
		do_end_request = 1;
	}

	/*
	 * End a request through request sense analysis when we have sense data.
	 * We need this in order to perform end of media processing.
	 */
	if (do_end_request)
		goto end_request;

	/* if we got a CHECK_CONDITION status, queue a request sense command */
	if (stat & ATA_ERR)
401
		return ide_queue_sense_rq(drive, NULL) ? 2 : 1;
402 403
	return 1;

404
end_request:
405
	if (stat & ATA_ERR) {
406
		hwif->rq = NULL;
407
		return ide_queue_sense_rq(drive, rq) ? 2 : 1;
408
	} else
409
		return 2;
L
Linus Torvalds 已提交
410 411
}

412
static void ide_cd_request_sense_fixup(ide_drive_t *drive, struct ide_cmd *cmd)
413
{
414 415
	struct request *rq = cmd->rq;

B
Borislav Petkov 已提交
416
	ide_debug_log(IDE_DBG_FUNC, "rq->cmd[0]: 0x%x", rq->cmd[0]);
417

418 419 420 421 422
	/*
	 * Some of the trailing request sense fields are optional,
	 * and some drives don't send them.  Sigh.
	 */
	if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
423 424
	    cmd->nleft > 0 && cmd->nleft <= 5)
		cmd->nleft = 0;
425 426
}

427 428 429 430
int ide_cd_queue_pc(ide_drive_t *drive, const unsigned char *cmd,
		    int write, void *buffer, unsigned *bufflen,
		    struct request_sense *sense, int timeout,
		    unsigned int cmd_flags)
L
Linus Torvalds 已提交
431
{
432 433
	struct cdrom_info *info = drive->driver_data;
	struct request_sense local_sense;
L
Linus Torvalds 已提交
434
	int retries = 10;
435
	unsigned int flags = 0;
L
Linus Torvalds 已提交
436

437 438
	if (!sense)
		sense = &local_sense;
L
Linus Torvalds 已提交
439

B
Borislav Petkov 已提交
440 441 442
	ide_debug_log(IDE_DBG_PC, "cmd[0]: 0x%x, write: 0x%x, timeout: %d, "
				  "cmd_flags: 0x%x",
				  cmd[0], write, timeout, cmd_flags);
443

B
Borislav Petkov 已提交
444
	/* start of retry loop */
L
Linus Torvalds 已提交
445
	do {
446
		struct request *rq;
L
Linus Torvalds 已提交
447 448
		int error;

449 450 451 452 453 454 455 456
		rq = blk_get_request(drive->queue, write, __GFP_WAIT);

		memcpy(rq->cmd, cmd, BLK_MAX_CDB);
		rq->cmd_type = REQ_TYPE_ATA_PC;
		rq->sense = sense;
		rq->cmd_flags |= cmd_flags;
		rq->timeout = timeout;
		if (buffer) {
457 458 459 460 461 462
			error = blk_rq_map_kern(drive->queue, rq, buffer,
						*bufflen, GFP_NOIO);
			if (error) {
				blk_put_request(rq);
				return error;
			}
463 464 465 466 467
		}

		error = blk_execute_rq(drive->queue, info->disk, rq, 0);

		if (buffer)
T
Tejun Heo 已提交
468
			*bufflen = rq->resid_len;
469 470 471

		flags = rq->cmd_flags;
		blk_put_request(rq);
L
Linus Torvalds 已提交
472

B
Borislav Petkov 已提交
473 474 475 476
		/*
		 * FIXME: we should probably abort/retry or something in case of
		 * failure.
		 */
477
		if (flags & REQ_FAILED) {
B
Borislav Petkov 已提交
478 479 480 481
			/*
			 * The request failed.  Retry if it was due to a unit
			 * attention status (usually means media was changed).
			 */
482
			struct request_sense *reqbuf = sense;
L
Linus Torvalds 已提交
483 484 485 486 487

			if (reqbuf->sense_key == UNIT_ATTENTION)
				cdrom_saw_media_change(drive);
			else if (reqbuf->sense_key == NOT_READY &&
				 reqbuf->asc == 4 && reqbuf->ascq != 4) {
B
Borislav Petkov 已提交
488 489 490 491 492
				/*
				 * The drive is in the process of loading
				 * a disk.  Retry, but wait a little to give
				 * the drive time to complete the load.
				 */
L
Linus Torvalds 已提交
493 494
				ssleep(2);
			} else {
B
Borislav Petkov 已提交
495
				/* otherwise, don't retry */
L
Linus Torvalds 已提交
496 497 498 499 500
				retries = 0;
			}
			--retries;
		}

B
Borislav Petkov 已提交
501
		/* end of retry loop */
502
	} while ((flags & REQ_FAILED) && retries >= 0);
L
Linus Torvalds 已提交
503

B
Borislav Petkov 已提交
504
	/* return an error if the command failed */
505
	return (flags & REQ_FAILED) ? -EIO : 0;
L
Linus Torvalds 已提交
506 507
}

508 509 510 511 512 513 514 515 516 517 518
static void ide_cd_error_cmd(ide_drive_t *drive, struct ide_cmd *cmd)
{
	unsigned int nr_bytes = cmd->nbytes - cmd->nleft;

	if (cmd->tf_flags & IDE_TFLAG_WRITE)
		nr_bytes -= cmd->last_xfer_len;

	if (nr_bytes > 0)
		ide_complete_rq(drive, 0, nr_bytes);
}

L
Linus Torvalds 已提交
519 520
static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
{
521
	ide_hwif_t *hwif = drive->hwif;
522
	struct ide_cmd *cmd = &hwif->cmd;
523
	struct request *rq = hwif->rq;
524
	ide_expiry_t *expiry = NULL;
525
	int dma_error = 0, dma, thislen, uptodate = 0;
T
Tejun Heo 已提交
526
	int write = (rq_data_dir(rq) == WRITE) ? 1 : 0, rc = 0;
527
	int sense = blk_sense_request(rq);
528
	unsigned int timeout;
529
	u16 len;
530
	u8 ireason, stat;
L
Linus Torvalds 已提交
531

532
	ide_debug_log(IDE_DBG_PC, "cmd: 0x%x, write: 0x%x", rq->cmd[0], write);
533

B
Borislav Petkov 已提交
534
	/* check for errors */
535
	dma = drive->dma;
L
Linus Torvalds 已提交
536
	if (dma) {
537
		drive->dma = 0;
538
		drive->waiting_for_dma = 0;
539
		dma_error = hwif->dma_ops->dma_end(drive);
540
		ide_dma_unmap_sg(drive, cmd);
541
		if (dma_error) {
542
			printk(KERN_ERR PFX "%s: DMA %s error\n", drive->name,
543
					write ? "write" : "read");
544 545
			ide_dma_off(drive);
		}
L
Linus Torvalds 已提交
546 547
	}

548 549 550 551 552 553 554 555 556 557
	/* check status */
	stat = hwif->tp_ops->read_status(hwif);

	if (!OK_STAT(stat, 0, BAD_R_STAT)) {
		rc = cdrom_decode_status(drive, stat);
		if (rc) {
			if (rc == 2)
				goto out_end;
			return ide_stopped;
		}
558
	}
L
Linus Torvalds 已提交
559

B
Borislav Petkov 已提交
560
	/* using dma, transfer is complete now */
L
Linus Torvalds 已提交
561
	if (dma) {
562
		if (dma_error)
L
Linus Torvalds 已提交
563
			return ide_error(drive, "dma error", stat);
564
		uptodate = 1;
565
		goto out_end;
L
Linus Torvalds 已提交
566 567
	}

568
	ide_read_bcount_and_ireason(drive, &len, &ireason);
569

570
	thislen = blk_fs_request(rq) ? len : cmd->nleft;
L
Linus Torvalds 已提交
571 572 573
	if (thislen > len)
		thislen = len;

B
Borislav Petkov 已提交
574 575
	ide_debug_log(IDE_DBG_PC, "DRQ: stat: 0x%x, thislen: %d",
				  stat, thislen);
576

B
Borislav Petkov 已提交
577
	/* If DRQ is clear, the command has completed. */
578
	if ((stat & ATA_DRQ) == 0) {
579 580 581 582 583 584
		if (blk_fs_request(rq)) {
			/*
			 * If we're not done reading/writing, complain.
			 * Otherwise, complete the command normally.
			 */
			uptodate = 1;
585
			if (cmd->nleft > 0) {
586
				printk(KERN_ERR PFX "%s: %s: data underrun "
587 588
					"(%u bytes)\n", drive->name, __func__,
					cmd->nleft);
589 590 591 592 593
				if (!write)
					rq->cmd_flags |= REQ_FAILED;
				uptodate = 0;
			}
		} else if (!blk_pc_request(rq)) {
594
			ide_cd_request_sense_fixup(drive, cmd);
595

596
			uptodate = cmd->nleft ? 0 : 1;
597 598 599 600 601 602 603 604 605 606 607

			/*
			 * suck out the remaining bytes from the drive in an
			 * attempt to complete the data xfer. (see BZ#13399)
			 */
			if (!(stat & ATA_ERR) && !uptodate && thislen) {
				ide_pio_bytes(drive, cmd, write, thislen);
				uptodate = cmd->nleft ? 0 : 1;
			}

			if (!uptodate)
608
				rq->cmd_flags |= REQ_FAILED;
609
		}
610
		goto out_end;
611
	}
L
Linus Torvalds 已提交
612

613
	rc = ide_check_ireason(drive, rq, len, ireason, write);
614 615
	if (rc)
		goto out_end;
616

617
	cmd->last_xfer_len = 0;
L
Linus Torvalds 已提交
618

B
Borislav Petkov 已提交
619 620 621
	ide_debug_log(IDE_DBG_PC, "data transfer, rq->cmd_type: 0x%x, "
				  "ireason: 0x%x",
				  rq->cmd_type, ireason);
622

B
Borislav Petkov 已提交
623
	/* transfer data */
L
Linus Torvalds 已提交
624
	while (thislen > 0) {
625
		int blen = min_t(int, thislen, cmd->nleft);
L
Linus Torvalds 已提交
626

627
		if (cmd->nleft == 0)
L
Linus Torvalds 已提交
628 629
			break;

630 631
		ide_pio_bytes(drive, cmd, write, blen);
		cmd->last_xfer_len += blen;
L
Linus Torvalds 已提交
632 633 634 635

		thislen -= blen;
		len -= blen;

636
		if (sense && write == 0)
A
Andreas Schwab 已提交
637
			rq->sense_len += blen;
L
Linus Torvalds 已提交
638 639
	}

B
Borislav Petkov 已提交
640
	/* pad, if necessary */
641 642 643 644 645 646 647 648 649
	if (len > 0) {
		if (blk_fs_request(rq) == 0 || write == 0)
			ide_pad_transfer(drive, write, len);
		else {
			printk(KERN_ERR PFX "%s: confused, missing data\n",
				drive->name);
			blk_dump_rq_flags(rq, "cdrom_newpc_intr");
		}
	}
L
Linus Torvalds 已提交
650

651 652 653 654
	if (blk_pc_request(rq)) {
		timeout = rq->timeout;
	} else {
		timeout = ATAPI_WAIT_PC;
655
		if (!blk_fs_request(rq))
656
			expiry = ide_cd_expiry;
657 658
	}

659 660
	hwif->expiry = expiry;
	ide_set_handler(drive, cdrom_newpc_intr, timeout);
L
Linus Torvalds 已提交
661
	return ide_started;
662

663
out_end:
664
	if (blk_pc_request(rq) && rc == 0) {
665
		rq->resid_len = 0;
T
Tejun Heo 已提交
666
		blk_end_request_all(rq, 0);
667
		hwif->rq = NULL;
668
	} else {
669 670 671 672
		if (sense && uptodate)
			ide_cd_complete_failed_rq(drive, rq);

		if (blk_fs_request(rq)) {
673
			if (cmd->nleft == 0)
674 675 676 677 678 679
				uptodate = 1;
		} else {
			if (uptodate <= 0 && rq->errors == 0)
				rq->errors = -EIO;
		}

680
		if (uptodate == 0 && rq->bio)
681 682
			ide_cd_error_cmd(drive, cmd);

683
		/* make sure it's fully ended */
684
		if (blk_fs_request(rq) == 0) {
685
			rq->resid_len -= cmd->nbytes - cmd->nleft;
686
			if (uptodate == 0 && (cmd->tf_flags & IDE_TFLAG_WRITE))
T
Tejun Heo 已提交
687
				rq->resid_len += cmd->last_xfer_len;
688 689
		}

T
Tejun Heo 已提交
690
		ide_complete_rq(drive, uptodate ? 0 : -EIO, blk_rq_bytes(rq));
691

692 693
		if (sense && rc == 2)
			ide_error(drive, "request sense failure", stat);
694 695
	}
	return ide_stopped;
L
Linus Torvalds 已提交
696 697
}

698
static ide_startstop_t cdrom_start_rw(ide_drive_t *drive, struct request *rq)
L
Linus Torvalds 已提交
699
{
700
	struct cdrom_info *cd = drive->driver_data;
701
	struct request_queue *q = drive->queue;
702 703
	int write = rq_data_dir(rq) == WRITE;
	unsigned short sectors_per_frame =
704
		queue_logical_block_size(q) >> SECTOR_BITS;
L
Linus Torvalds 已提交
705

706
	ide_debug_log(IDE_DBG_RQ, "rq->cmd[0]: 0x%x, rq->cmd_flags: 0x%x, "
B
Borislav Petkov 已提交
707
				  "secs_per_frame: %u",
708
				  rq->cmd[0], rq->cmd_flags, sectors_per_frame);
709

710
	if (write) {
B
Borislav Petkov 已提交
711
		/* disk has become write protected */
712
		if (get_disk_ro(cd->disk))
713 714 715 716 717 718
			return ide_stopped;
	} else {
		/*
		 * We may be retrying this request after an error.  Fix up any
		 * weirdness which might be present in the request packet.
		 */
719
		q->prep_rq_fn(q, rq);
L
Linus Torvalds 已提交
720 721
	}

722
	/* fs requests *must* be hardware frame aligned */
723 724
	if ((blk_rq_sectors(rq) & (sectors_per_frame - 1)) ||
	    (blk_rq_pos(rq) & (sectors_per_frame - 1)))
725 726 727 728
		return ide_stopped;

	/* use DMA, if possible */
	drive->dma = !!(drive->dev_flags & IDE_DFLAG_USING_DMA);
L
Linus Torvalds 已提交
729

730 731
	if (write)
		cd->devinfo.media_written = 1;
L
Linus Torvalds 已提交
732

733 734
	rq->timeout = ATAPI_WAIT_PC;

735
	return ide_started;
L
Linus Torvalds 已提交
736 737
}

738
static void cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
L
Linus Torvalds 已提交
739 740
{

B
Borislav Petkov 已提交
741 742
	ide_debug_log(IDE_DBG_PC, "rq->cmd[0]: 0x%x, rq->cmd_type: 0x%x",
				  rq->cmd[0], rq->cmd_type);
743

744 745 746 747
	if (blk_pc_request(rq))
		rq->cmd_flags |= REQ_QUIET;
	else
		rq->cmd_flags &= ~REQ_FAILED;
L
Linus Torvalds 已提交
748

749
	drive->dma = 0;
L
Linus Torvalds 已提交
750

B
Borislav Petkov 已提交
751
	/* sg request */
752
	if (rq->bio) {
753
		struct request_queue *q = drive->queue;
754
		char *buf = bio_data(rq->bio);
755 756
		unsigned int alignment;

757
		drive->dma = !!(drive->dev_flags & IDE_DFLAG_USING_DMA);
L
Linus Torvalds 已提交
758 759 760

		/*
		 * check if dma is safe
761 762 763
		 *
		 * NOTE! The "len" and "addr" checks should possibly have
		 * separate masks.
L
Linus Torvalds 已提交
764
		 */
765
		alignment = queue_dma_alignment(q) | q->dma_pad_mask;
766
		if ((unsigned long)buf & alignment
T
Tejun Heo 已提交
767
		    || blk_rq_bytes(rq) & q->dma_pad_mask
768
		    || object_is_on_stack(buf))
769
			drive->dma = 0;
L
Linus Torvalds 已提交
770 771 772
	}
}

773
static ide_startstop_t ide_cd_do_request(ide_drive_t *drive, struct request *rq,
774
					sector_t block)
L
Linus Torvalds 已提交
775
{
776
	struct ide_cmd cmd;
777
	int uptodate = 0, nsectors;
778

B
Borislav Petkov 已提交
779 780 781 782 783
	ide_debug_log(IDE_DBG_RQ, "cmd: 0x%x, block: %llu",
				  rq->cmd[0], (unsigned long long)block);

	if (drive->debug_mask & IDE_DBG_RQ)
		blk_dump_rq_flags(rq, "ide_cd_do_request");
784

L
Linus Torvalds 已提交
785
	if (blk_fs_request(rq)) {
786
		if (cdrom_start_rw(drive, rq) == ide_stopped)
787
			goto out_end;
788
	} else if (blk_sense_request(rq) || blk_pc_request(rq) ||
789
		   rq->cmd_type == REQ_TYPE_ATA_PC) {
790 791 792
		if (!rq->timeout)
			rq->timeout = ATAPI_WAIT_PC;

793
		cdrom_do_block_pc(drive, rq);
794
	} else if (blk_special_request(rq)) {
B
Borislav Petkov 已提交
795
		/* right now this can only be a reset... */
796 797
		uptodate = 1;
		goto out_end;
798 799
	} else
		BUG();
800

801 802 803
	/* prepare sense request for this command */
	ide_prep_sense(drive, rq);

804 805 806 807 808 809 810
	memset(&cmd, 0, sizeof(cmd));

	if (rq_data_dir(rq))
		cmd.tf_flags |= IDE_TFLAG_WRITE;

	cmd.rq = rq;

T
Tejun Heo 已提交
811 812
	if (blk_fs_request(rq) || blk_rq_bytes(rq)) {
		ide_init_sg_cmd(&cmd, blk_rq_bytes(rq));
813 814 815
		ide_map_sg(drive, &cmd);
	}

816
	return ide_issue_pc(drive, &cmd);
817
out_end:
818
	nsectors = blk_rq_sectors(rq);
819 820 821 822 823 824

	if (nsectors == 0)
		nsectors = 1;

	ide_complete_rq(drive, uptodate ? 0 : -EIO, nsectors << 9);

825
	return ide_stopped;
L
Linus Torvalds 已提交
826 827
}

B
Borislav Petkov 已提交
828
/*
L
Linus Torvalds 已提交
829 830
 * Ioctl handling.
 *
B
Borislav Petkov 已提交
831 832 833 834 835
 * Routines which queue packet commands take as a final argument a pointer to a
 * request_sense struct. If execution of the command results in an error with a
 * CHECK CONDITION status, this structure will be filled with the results of the
 * subsequent request sense command. The pointer can also be NULL, in which case
 * no sense information is returned.
L
Linus Torvalds 已提交
836
 */
837
static void msf_from_bcd(struct atapi_msf *msf)
L
Linus Torvalds 已提交
838
{
A
Adrian Bunk 已提交
839 840 841
	msf->minute = bcd2bin(msf->minute);
	msf->second = bcd2bin(msf->second);
	msf->frame  = bcd2bin(msf->frame);
L
Linus Torvalds 已提交
842 843
}

844
int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
L
Linus Torvalds 已提交
845 846 847
{
	struct cdrom_info *info = drive->driver_data;
	struct cdrom_device_info *cdi = &info->devinfo;
848
	unsigned char cmd[BLK_MAX_CDB];
L
Linus Torvalds 已提交
849

B
Borislav Petkov 已提交
850
	ide_debug_log(IDE_DBG_FUNC, "enter");
851

852 853
	memset(cmd, 0, BLK_MAX_CDB);
	cmd[0] = GPCMD_TEST_UNIT_READY;
L
Linus Torvalds 已提交
854

855
	/*
B
Borislav Petkov 已提交
856 857
	 * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to switch CDs
	 * instead of supporting the LOAD_UNLOAD opcode.
858
	 */
859
	cmd[7] = cdi->sanyo_slot % 3;
L
Linus Torvalds 已提交
860

861
	return ide_cd_queue_pc(drive, cmd, 0, NULL, NULL, sense, 0, REQ_QUIET);
L
Linus Torvalds 已提交
862 863 864 865 866 867 868
}

static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
			       unsigned long *sectors_per_frame,
			       struct request_sense *sense)
{
	struct {
869 870
		__be32 lba;
		__be32 blocklen;
L
Linus Torvalds 已提交
871 872 873
	} capbuf;

	int stat;
874 875
	unsigned char cmd[BLK_MAX_CDB];
	unsigned len = sizeof(capbuf);
876
	u32 blocklen;
L
Linus Torvalds 已提交
877

B
Borislav Petkov 已提交
878
	ide_debug_log(IDE_DBG_FUNC, "enter");
879

880 881
	memset(cmd, 0, BLK_MAX_CDB);
	cmd[0] = GPCMD_READ_CDVD_CAPACITY;
L
Linus Torvalds 已提交
882

883 884
	stat = ide_cd_queue_pc(drive, cmd, 0, &capbuf, &len, sense, 0,
			       REQ_QUIET);
885 886 887 888
	if (stat)
		return stat;

	/*
889 890 891
	 * Sanity check the given block size, in so far as making
	 * sure the sectors_per_frame we give to the caller won't
	 * end up being bogus.
892
	 */
893
	blocklen = be32_to_cpu(capbuf.blocklen);
894
	blocklen = (blocklen >> SECTOR_BITS) << SECTOR_BITS;
895 896 897 898 899
	switch (blocklen) {
	case 512:
	case 1024:
	case 2048:
	case 4096:
900 901
		break;
	default:
902 903
		printk_once(KERN_ERR PFX "%s: weird block size %u; "
				"setting default block size to 2048\n",
904
				drive->name, blocklen);
905
		blocklen = 2048;
906
		break;
L
Linus Torvalds 已提交
907 908
	}

909
	*capacity = 1 + be32_to_cpu(capbuf.lba);
910
	*sectors_per_frame = blocklen >> SECTOR_BITS;
B
Borislav Petkov 已提交
911

B
Borislav Petkov 已提交
912 913
	ide_debug_log(IDE_DBG_PROBE, "cap: %lu, sectors_per_frame: %lu",
				     *capacity, *sectors_per_frame);
B
Borislav Petkov 已提交
914

915
	return 0;
L
Linus Torvalds 已提交
916 917 918 919 920 921
}

static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
				int format, char *buf, int buflen,
				struct request_sense *sense)
{
922
	unsigned char cmd[BLK_MAX_CDB];
L
Linus Torvalds 已提交
923

B
Borislav Petkov 已提交
924
	ide_debug_log(IDE_DBG_FUNC, "enter");
925

926
	memset(cmd, 0, BLK_MAX_CDB);
L
Linus Torvalds 已提交
927

928 929 930 931 932
	cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
	cmd[6] = trackno;
	cmd[7] = (buflen >> 8);
	cmd[8] = (buflen & 0xff);
	cmd[9] = (format << 6);
L
Linus Torvalds 已提交
933 934

	if (msf_flag)
935
		cmd[1] = 2;
L
Linus Torvalds 已提交
936

937
	return ide_cd_queue_pc(drive, cmd, 0, buf, &buflen, sense, 0, REQ_QUIET);
L
Linus Torvalds 已提交
938 939 940
}

/* Try to read the entire TOC for the disk into our internal buffer. */
941
int ide_cd_read_toc(ide_drive_t *drive, struct request_sense *sense)
L
Linus Torvalds 已提交
942 943 944 945 946 947 948 949 950 951 952 953
{
	int stat, ntracks, i;
	struct cdrom_info *info = drive->driver_data;
	struct cdrom_device_info *cdi = &info->devinfo;
	struct atapi_toc *toc = info->toc;
	struct {
		struct atapi_toc_header hdr;
		struct atapi_toc_entry  ent;
	} ms_tmp;
	long last_written;
	unsigned long sectors_per_frame = SECTORS_PER_FRAME;

B
Borislav Petkov 已提交
954
	ide_debug_log(IDE_DBG_FUNC, "enter");
955

L
Linus Torvalds 已提交
956
	if (toc == NULL) {
B
Borislav Petkov 已提交
957
		/* try to allocate space */
J
Jesper Juhl 已提交
958
		toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
L
Linus Torvalds 已提交
959
		if (toc == NULL) {
960
			printk(KERN_ERR PFX "%s: No cdrom TOC buffer!\n",
961
					drive->name);
L
Linus Torvalds 已提交
962 963
			return -ENOMEM;
		}
J
Jesper Juhl 已提交
964
		info->toc = toc;
L
Linus Torvalds 已提交
965 966
	}

B
Borislav Petkov 已提交
967 968 969 970
	/*
	 * Check to see if the existing data is still valid. If it is,
	 * just return.
	 */
L
Linus Torvalds 已提交
971 972
	(void) cdrom_check_status(drive, sense);

973
	if (drive->atapi_flags & IDE_AFLAG_TOC_VALID)
L
Linus Torvalds 已提交
974 975
		return 0;

B
Borislav Petkov 已提交
976
	/* try to get the total cdrom capacity and sector size */
L
Linus Torvalds 已提交
977 978 979 980 981 982
	stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
				   sense);
	if (stat)
		toc->capacity = 0x1fffff;

	set_capacity(info->disk, toc->capacity * sectors_per_frame);
B
Borislav Petkov 已提交
983
	/* save a private copy of the TOC capacity for error handling */
A
Alan Cox 已提交
984 985
	drive->probed_capacity = toc->capacity * sectors_per_frame;

986 987
	blk_queue_logical_block_size(drive->queue,
				     sectors_per_frame << SECTOR_BITS);
L
Linus Torvalds 已提交
988

B
Borislav Petkov 已提交
989
	/* first read just the header, so we know how long the TOC is */
L
Linus Torvalds 已提交
990 991
	stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
				    sizeof(struct atapi_toc_header), sense);
J
Jesper Juhl 已提交
992 993
	if (stat)
		return stat;
L
Linus Torvalds 已提交
994

995
	if (drive->atapi_flags & IDE_AFLAG_TOCTRACKS_AS_BCD) {
A
Adrian Bunk 已提交
996 997
		toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
		toc->hdr.last_track  = bcd2bin(toc->hdr.last_track);
L
Linus Torvalds 已提交
998 999 1000 1001 1002 1003 1004 1005
	}

	ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
	if (ntracks <= 0)
		return -EIO;
	if (ntracks > MAX_TRACKS)
		ntracks = MAX_TRACKS;

B
Borislav Petkov 已提交
1006
	/* now read the whole schmeer */
L
Linus Torvalds 已提交
1007 1008 1009 1010 1011 1012 1013
	stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
				  (char *)&toc->hdr,
				   sizeof(struct atapi_toc_header) +
				   (ntracks + 1) *
				   sizeof(struct atapi_toc_entry), sense);

	if (stat && toc->hdr.first_track > 1) {
B
Borislav Petkov 已提交
1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
		/*
		 * Cds with CDI tracks only don't have any TOC entries, despite
		 * of this the returned values are
		 * first_track == last_track = number of CDI tracks + 1,
		 * so that this case is indistinguishable from the same layout
		 * plus an additional audio track. If we get an error for the
		 * regular case, we assume a CDI without additional audio
		 * tracks. In this case the readable TOC is empty (CDI tracks
		 * are not included) and only holds the Leadout entry.
		 *
		 * Heiko Eißfeldt.
		 */
L
Linus Torvalds 已提交
1026 1027 1028 1029 1030 1031 1032
		ntracks = 0;
		stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
					   (char *)&toc->hdr,
					   sizeof(struct atapi_toc_header) +
					   (ntracks + 1) *
					   sizeof(struct atapi_toc_entry),
					   sense);
1033
		if (stat)
L
Linus Torvalds 已提交
1034
			return stat;
1035

1036
		if (drive->atapi_flags & IDE_AFLAG_TOCTRACKS_AS_BCD) {
A
Adrian Bunk 已提交
1037 1038
			toc->hdr.first_track = (u8)bin2bcd(CDROM_LEADOUT);
			toc->hdr.last_track = (u8)bin2bcd(CDROM_LEADOUT);
1039
		} else {
L
Linus Torvalds 已提交
1040 1041 1042 1043 1044 1045 1046 1047
			toc->hdr.first_track = CDROM_LEADOUT;
			toc->hdr.last_track = CDROM_LEADOUT;
		}
	}

	if (stat)
		return stat;

1048
	toc->hdr.toc_length = be16_to_cpu(toc->hdr.toc_length);
L
Linus Torvalds 已提交
1049

1050
	if (drive->atapi_flags & IDE_AFLAG_TOCTRACKS_AS_BCD) {
A
Adrian Bunk 已提交
1051 1052
		toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
		toc->hdr.last_track  = bcd2bin(toc->hdr.last_track);
L
Linus Torvalds 已提交
1053 1054
	}

1055
	for (i = 0; i <= ntracks; i++) {
1056 1057
		if (drive->atapi_flags & IDE_AFLAG_TOCADDR_AS_BCD) {
			if (drive->atapi_flags & IDE_AFLAG_TOCTRACKS_AS_BCD)
A
Adrian Bunk 已提交
1058
				toc->ent[i].track = bcd2bin(toc->ent[i].track);
L
Linus Torvalds 已提交
1059 1060
			msf_from_bcd(&toc->ent[i].addr.msf);
		}
1061 1062 1063
		toc->ent[i].addr.lba = msf_to_lba(toc->ent[i].addr.msf.minute,
						  toc->ent[i].addr.msf.second,
						  toc->ent[i].addr.msf.frame);
L
Linus Torvalds 已提交
1064 1065 1066
	}

	if (toc->hdr.first_track != CDROM_LEADOUT) {
B
Borislav Petkov 已提交
1067
		/* read the multisession information */
L
Linus Torvalds 已提交
1068 1069
		stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
					   sizeof(ms_tmp), sense);
J
Jesper Juhl 已提交
1070 1071
		if (stat)
			return stat;
L
Linus Torvalds 已提交
1072 1073 1074

		toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
	} else {
1075 1076
		ms_tmp.hdr.last_track = CDROM_LEADOUT;
		ms_tmp.hdr.first_track = ms_tmp.hdr.last_track;
L
Linus Torvalds 已提交
1077 1078 1079
		toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
	}

1080
	if (drive->atapi_flags & IDE_AFLAG_TOCADDR_AS_BCD) {
B
Borislav Petkov 已提交
1081
		/* re-read multisession information using MSF format */
L
Linus Torvalds 已提交
1082 1083 1084 1085 1086
		stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
					   sizeof(ms_tmp), sense);
		if (stat)
			return stat;

1087
		msf_from_bcd(&ms_tmp.ent.addr.msf);
L
Linus Torvalds 已提交
1088
		toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
1089
						   ms_tmp.ent.addr.msf.second,
L
Linus Torvalds 已提交
1090 1091 1092 1093 1094
						   ms_tmp.ent.addr.msf.frame);
	}

	toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);

B
Borislav Petkov 已提交
1095
	/* now try to get the total cdrom capacity */
L
Linus Torvalds 已提交
1096 1097 1098 1099
	stat = cdrom_get_last_written(cdi, &last_written);
	if (!stat && (last_written > toc->capacity)) {
		toc->capacity = last_written;
		set_capacity(info->disk, toc->capacity * sectors_per_frame);
A
Alan Cox 已提交
1100
		drive->probed_capacity = toc->capacity * sectors_per_frame;
L
Linus Torvalds 已提交
1101 1102 1103
	}

	/* Remember that we've read this stuff. */
1104
	drive->atapi_flags |= IDE_AFLAG_TOC_VALID;
L
Linus Torvalds 已提交
1105 1106 1107 1108

	return 0;
}

1109
int ide_cdrom_get_capabilities(ide_drive_t *drive, u8 *buf)
E
Eric Piel 已提交
1110 1111 1112 1113
{
	struct cdrom_info *info = drive->driver_data;
	struct cdrom_device_info *cdi = &info->devinfo;
	struct packet_command cgc;
1114
	int stat, attempts = 3, size = ATAPI_CAPABILITIES_PAGE_SIZE;
E
Eric Piel 已提交
1115

B
Borislav Petkov 已提交
1116
	ide_debug_log(IDE_DBG_FUNC, "enter");
1117

1118
	if ((drive->atapi_flags & IDE_AFLAG_FULL_CAPS_PAGE) == 0)
1119
		size -= ATAPI_CAPABILITIES_PAGE_PAD_SIZE;
E
Eric Piel 已提交
1120

1121
	init_cdrom_command(&cgc, buf, size, CGC_DATA_UNKNOWN);
B
Borislav Petkov 已提交
1122 1123
	do {
		/* we seem to get stat=0x01,err=0x00 the first time (??) */
E
Eric Piel 已提交
1124 1125 1126 1127 1128 1129 1130
		stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
		if (!stat)
			break;
	} while (--attempts);
	return stat;
}

1131
void ide_cdrom_update_speed(ide_drive_t *drive, u8 *buf)
E
Eric Piel 已提交
1132
{
1133
	struct cdrom_info *cd = drive->driver_data;
1134 1135
	u16 curspeed, maxspeed;

B
Borislav Petkov 已提交
1136
	ide_debug_log(IDE_DBG_FUNC, "enter");
1137

1138
	if (drive->atapi_flags & IDE_AFLAG_LE_SPEED_FIELDS) {
1139 1140
		curspeed = le16_to_cpup((__le16 *)&buf[8 + 14]);
		maxspeed = le16_to_cpup((__le16 *)&buf[8 + 8]);
E
Eric Piel 已提交
1141
	} else {
1142 1143
		curspeed = be16_to_cpup((__be16 *)&buf[8 + 14]);
		maxspeed = be16_to_cpup((__be16 *)&buf[8 + 8]);
E
Eric Piel 已提交
1144
	}
1145

B
Borislav Petkov 已提交
1146 1147
	ide_debug_log(IDE_DBG_PROBE, "curspeed: %u, maxspeed: %u",
				     curspeed, maxspeed);
B
Borislav Petkov 已提交
1148

1149 1150
	cd->current_speed = (curspeed + (176/2)) / 176;
	cd->max_speed = (maxspeed + (176/2)) / 176;
E
Eric Piel 已提交
1151 1152
}

1153 1154 1155 1156 1157 1158
#define IDE_CD_CAPABILITIES \
	(CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
	 CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
	 CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
	 CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
	 CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
L
Linus Torvalds 已提交
1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171

static struct cdrom_device_ops ide_cdrom_dops = {
	.open			= ide_cdrom_open_real,
	.release		= ide_cdrom_release_real,
	.drive_status		= ide_cdrom_drive_status,
	.media_changed		= ide_cdrom_check_media_change_real,
	.tray_move		= ide_cdrom_tray_move,
	.lock_door		= ide_cdrom_lock_door,
	.select_speed		= ide_cdrom_select_speed,
	.get_last_session	= ide_cdrom_get_last_session,
	.get_mcn		= ide_cdrom_get_mcn,
	.reset			= ide_cdrom_reset,
	.audio_ioctl		= ide_cdrom_audio_ioctl,
1172
	.capability		= IDE_CD_CAPABILITIES,
L
Linus Torvalds 已提交
1173 1174 1175
	.generic_packet		= ide_cdrom_packet,
};

1176
static int ide_cdrom_register(ide_drive_t *drive, int nslots)
L
Linus Torvalds 已提交
1177 1178 1179 1180
{
	struct cdrom_info *info = drive->driver_data;
	struct cdrom_device_info *devinfo = &info->devinfo;

B
Borislav Petkov 已提交
1181
	ide_debug_log(IDE_DBG_PROBE, "nslots: %d", nslots);
1182

L
Linus Torvalds 已提交
1183
	devinfo->ops = &ide_cdrom_dops;
1184
	devinfo->speed = info->current_speed;
L
Linus Torvalds 已提交
1185
	devinfo->capacity = nslots;
J
Jesper Juhl 已提交
1186
	devinfo->handle = drive;
L
Linus Torvalds 已提交
1187 1188
	strcpy(devinfo->name, drive->name);

1189
	if (drive->atapi_flags & IDE_AFLAG_NO_SPEED_SELECT)
1190 1191
		devinfo->mask |= CDC_SELECT_SPEED;

L
Linus Torvalds 已提交
1192 1193 1194 1195
	devinfo->disk = info->disk;
	return register_cdrom(devinfo);
}

1196
static int ide_cdrom_probe_capabilities(ide_drive_t *drive)
L
Linus Torvalds 已提交
1197
{
1198 1199
	struct cdrom_info *cd = drive->driver_data;
	struct cdrom_device_info *cdi = &cd->devinfo;
1200 1201
	u8 buf[ATAPI_CAPABILITIES_PAGE_SIZE];
	mechtype_t mechtype;
L
Linus Torvalds 已提交
1202 1203
	int nslots = 1;

B
Borislav Petkov 已提交
1204 1205
	ide_debug_log(IDE_DBG_PROBE, "media: 0x%x, atapi_flags: 0x%lx",
				     drive->media, drive->atapi_flags);
1206

1207 1208 1209 1210
	cdi->mask = (CDC_CD_R | CDC_CD_RW | CDC_DVD | CDC_DVD_R |
		     CDC_DVD_RAM | CDC_SELECT_DISC | CDC_PLAY_AUDIO |
		     CDC_MO_DRIVE | CDC_RAM);

L
Linus Torvalds 已提交
1211
	if (drive->media == ide_optical) {
1212
		cdi->mask &= ~(CDC_MO_DRIVE | CDC_RAM);
1213
		printk(KERN_ERR PFX "%s: ATAPI magneto-optical drive\n",
1214
				drive->name);
L
Linus Torvalds 已提交
1215 1216 1217
		return nslots;
	}

1218 1219
	if (drive->atapi_flags & IDE_AFLAG_PRE_ATAPI12) {
		drive->atapi_flags &= ~IDE_AFLAG_NO_EJECT;
1220
		cdi->mask &= ~CDC_PLAY_AUDIO;
L
Linus Torvalds 已提交
1221 1222 1223 1224
		return nslots;
	}

	/*
B
Borislav Petkov 已提交
1225 1226 1227 1228
	 * We have to cheat a little here. the packet will eventually be queued
	 * with ide_cdrom_packet(), which extracts the drive from cdi->handle.
	 * Since this device hasn't been registered with the Uniform layer yet,
	 * it can't do this. Same goes for cdi->ops.
L
Linus Torvalds 已提交
1229
	 */
J
Jesper Juhl 已提交
1230
	cdi->handle = drive;
L
Linus Torvalds 已提交
1231 1232
	cdi->ops = &ide_cdrom_dops;

1233
	if (ide_cdrom_get_capabilities(drive, buf))
L
Linus Torvalds 已提交
1234 1235
		return 0;

1236
	if ((buf[8 + 6] & 0x01) == 0)
1237
		drive->dev_flags &= ~IDE_DFLAG_DOORLOCKING;
1238
	if (buf[8 + 6] & 0x08)
1239
		drive->atapi_flags &= ~IDE_AFLAG_NO_EJECT;
1240
	if (buf[8 + 3] & 0x01)
1241
		cdi->mask &= ~CDC_CD_R;
1242
	if (buf[8 + 3] & 0x02)
1243
		cdi->mask &= ~(CDC_CD_RW | CDC_RAM);
1244
	if (buf[8 + 2] & 0x38)
1245
		cdi->mask &= ~CDC_DVD;
1246
	if (buf[8 + 3] & 0x20)
1247
		cdi->mask &= ~(CDC_DVD_RAM | CDC_RAM);
1248
	if (buf[8 + 3] & 0x10)
1249
		cdi->mask &= ~CDC_DVD_R;
1250
	if ((buf[8 + 4] & 0x01) || (drive->atapi_flags & IDE_AFLAG_PLAY_AUDIO_OK))
1251
		cdi->mask &= ~CDC_PLAY_AUDIO;
1252 1253

	mechtype = buf[8 + 6] >> 5;
B
Borislav Petkov 已提交
1254 1255 1256
	if (mechtype == mechtype_caddy ||
	    mechtype == mechtype_popup ||
	    (drive->atapi_flags & IDE_AFLAG_NO_AUTOCLOSE))
1257
		cdi->mask |= CDC_CLOSE_TRAY;
L
Linus Torvalds 已提交
1258 1259

	if (cdi->sanyo_slot > 0) {
1260
		cdi->mask &= ~CDC_SELECT_DISC;
L
Linus Torvalds 已提交
1261
		nslots = 3;
1262 1263
	} else if (mechtype == mechtype_individual_changer ||
		   mechtype == mechtype_cartridge_changer) {
1264 1265
		nslots = cdrom_number_of_slots(cdi);
		if (nslots > 1)
1266
			cdi->mask &= ~CDC_SELECT_DISC;
L
Linus Torvalds 已提交
1267 1268
	}

1269
	ide_cdrom_update_speed(drive, buf);
1270

1271
	printk(KERN_INFO PFX "%s: ATAPI", drive->name);
1272 1273

	/* don't print speed if the drive reported 0 */
1274 1275
	if (cd->max_speed)
		printk(KERN_CONT " %dX", cd->max_speed);
1276

1277
	printk(KERN_CONT " %s", (cdi->mask & CDC_DVD) ? "CD-ROM" : "DVD-ROM");
L
Linus Torvalds 已提交
1278

1279 1280 1281
	if ((cdi->mask & CDC_DVD_R) == 0 || (cdi->mask & CDC_DVD_RAM) == 0)
		printk(KERN_CONT " DVD%s%s",
				 (cdi->mask & CDC_DVD_R) ? "" : "-R",
1282
				 (cdi->mask & CDC_DVD_RAM) ? "" : "/RAM");
L
Linus Torvalds 已提交
1283

1284 1285 1286 1287
	if ((cdi->mask & CDC_CD_R) == 0 || (cdi->mask & CDC_CD_RW) == 0)
		printk(KERN_CONT " CD%s%s",
				 (cdi->mask & CDC_CD_R) ? "" : "-R",
				 (cdi->mask & CDC_CD_RW) ? "" : "/RW");
L
Linus Torvalds 已提交
1288

1289 1290 1291 1292
	if ((cdi->mask & CDC_SELECT_DISC) == 0)
		printk(KERN_CONT " changer w/%d slots", nslots);
	else
		printk(KERN_CONT " drive");
L
Linus Torvalds 已提交
1293

1294 1295
	printk(KERN_CONT ", %dkB Cache\n",
			 be16_to_cpup((__be16 *)&buf[8 + 12]));
L
Linus Torvalds 已提交
1296 1297 1298 1299

	return nslots;
}

B
Borislav Petkov 已提交
1300
/* standard prep_rq_fn that builds 10 byte cmds */
1301
static int ide_cdrom_prep_fs(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
1302
{
1303
	int hard_sect = queue_logical_block_size(q);
1304 1305
	long block = (long)blk_rq_pos(rq) / (hard_sect >> 9);
	unsigned long blocks = blk_rq_sectors(rq) / (hard_sect >> 9);
L
Linus Torvalds 已提交
1306

1307
	memset(rq->cmd, 0, BLK_MAX_CDB);
L
Linus Torvalds 已提交
1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338

	if (rq_data_dir(rq) == READ)
		rq->cmd[0] = GPCMD_READ_10;
	else
		rq->cmd[0] = GPCMD_WRITE_10;

	/*
	 * fill in lba
	 */
	rq->cmd[2] = (block >> 24) & 0xff;
	rq->cmd[3] = (block >> 16) & 0xff;
	rq->cmd[4] = (block >>  8) & 0xff;
	rq->cmd[5] = block & 0xff;

	/*
	 * and transfer length
	 */
	rq->cmd[7] = (blocks >> 8) & 0xff;
	rq->cmd[8] = blocks & 0xff;
	rq->cmd_len = 10;
	return BLKPREP_OK;
}

/*
 * Most of the SCSI commands are supported directly by ATAPI devices.
 * This transform handles the few exceptions.
 */
static int ide_cdrom_prep_pc(struct request *rq)
{
	u8 *c = rq->cmd;

B
Borislav Petkov 已提交
1339
	/* transform 6-byte read/write commands to the 10-byte version */
L
Linus Torvalds 已提交
1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360
	if (c[0] == READ_6 || c[0] == WRITE_6) {
		c[8] = c[4];
		c[5] = c[3];
		c[4] = c[2];
		c[3] = c[1] & 0x1f;
		c[2] = 0;
		c[1] &= 0xe0;
		c[0] += (READ_10 - READ_6);
		rq->cmd_len = 10;
		return BLKPREP_OK;
	}

	/*
	 * it's silly to pretend we understand 6-byte sense commands, just
	 * reject with ILLEGAL_REQUEST and the caller should take the
	 * appropriate action
	 */
	if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
		rq->errors = ILLEGAL_REQUEST;
		return BLKPREP_KILL;
	}
1361

L
Linus Torvalds 已提交
1362 1363 1364
	return BLKPREP_OK;
}

1365
static int ide_cdrom_prep_fn(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
1366
{
1367
	if (blk_fs_request(rq))
L
Linus Torvalds 已提交
1368
		return ide_cdrom_prep_fs(q, rq);
1369
	else if (blk_pc_request(rq))
L
Linus Torvalds 已提交
1370 1371 1372 1373 1374
		return ide_cdrom_prep_pc(rq);

	return 0;
}

1375 1376 1377 1378 1379 1380
struct cd_list_entry {
	const char	*id_model;
	const char	*id_firmware;
	unsigned int	cd_flags;
};

1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391
#ifdef CONFIG_IDE_PROC_FS
static sector_t ide_cdrom_capacity(ide_drive_t *drive)
{
	unsigned long capacity, sectors_per_frame;

	if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
		return 0;

	return capacity * sectors_per_frame;
}

1392 1393
static int proc_idecd_read_capacity(char *page, char **start, off_t off,
					int count, int *eof, void *data)
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406
{
	ide_drive_t *drive = data;
	int len;

	len = sprintf(page, "%llu\n", (long long)ide_cdrom_capacity(drive));
	PROC_IDE_READ_RETURN(page, start, off, count, eof, len);
}

static ide_proc_entry_t idecd_proc[] = {
	{ "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
	{ NULL, 0, NULL, NULL }
};

1407 1408 1409 1410 1411 1412 1413
static ide_proc_entry_t *ide_cd_proc_entries(ide_drive_t *drive)
{
	return idecd_proc;
}

static const struct ide_proc_devset *ide_cd_proc_devsets(ide_drive_t *drive)
{
1414
	return NULL;
1415
}
1416 1417
#endif

1418 1419
static const struct cd_list_entry ide_cd_quirks_list[] = {
	/* SCR-3231 doesn't support the SET_CD_SPEED command. */
1420
	{ "SAMSUNG CD-ROM SCR-3231", NULL,   IDE_AFLAG_NO_SPEED_SELECT	     },
1421
	/* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
1422 1423
	{ "NEC CD-ROM DRIVE:260",    "1.01", IDE_AFLAG_TOCADDR_AS_BCD |
					     IDE_AFLAG_PRE_ATAPI12,	     },
1424
	/* Vertos 300, some versions of this drive like to talk BCD. */
1425
	{ "V003S0DS",		     NULL,   IDE_AFLAG_VERTOS_300_SSD,	     },
1426
	/* Vertos 600 ESD. */
1427
	{ "V006E0DS",		     NULL,   IDE_AFLAG_VERTOS_600_ESD,	     },
1428 1429 1430 1431
	/*
	 * Sanyo 3 CD changer uses a non-standard command for CD changing
	 * (by default standard ATAPI support for CD changers is used).
	 */
1432 1433 1434
	{ "CD-ROM CDR-C3 G",	     NULL,   IDE_AFLAG_SANYO_3CD	     },
	{ "CD-ROM CDR-C3G",	     NULL,   IDE_AFLAG_SANYO_3CD	     },
	{ "CD-ROM CDR_C36",	     NULL,   IDE_AFLAG_SANYO_3CD	     },
1435
	/* Stingray 8X CD-ROM. */
1436
	{ "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL, IDE_AFLAG_PRE_ATAPI12 },
1437 1438 1439 1440
	/*
	 * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
	 * mode sense page capabilities size, but older drives break.
	 */
1441 1442
	{ "ATAPI CD ROM DRIVE 50X MAX",	NULL,	IDE_AFLAG_FULL_CAPS_PAGE     },
	{ "WPI CDS-32X",		NULL,	IDE_AFLAG_FULL_CAPS_PAGE     },
1443
	/* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
1444
	{ "",			     "241N", IDE_AFLAG_LE_SPEED_FIELDS       },
1445 1446 1447 1448
	/*
	 * Some drives used by Apple don't advertise audio play
	 * but they do support reading TOC & audio datas.
	 */
1449 1450 1451 1452 1453
	{ "MATSHITADVD-ROM SR-8187", NULL,   IDE_AFLAG_PLAY_AUDIO_OK	     },
	{ "MATSHITADVD-ROM SR-8186", NULL,   IDE_AFLAG_PLAY_AUDIO_OK	     },
	{ "MATSHITADVD-ROM SR-8176", NULL,   IDE_AFLAG_PLAY_AUDIO_OK	     },
	{ "MATSHITADVD-ROM SR-8174", NULL,   IDE_AFLAG_PLAY_AUDIO_OK	     },
	{ "Optiarc DVD RW AD-5200A", NULL,   IDE_AFLAG_PLAY_AUDIO_OK	     },
1454
	{ "Optiarc DVD RW AD-7200A", NULL,   IDE_AFLAG_PLAY_AUDIO_OK	     },
B
Borislav Petkov 已提交
1455
	{ "Optiarc DVD RW AD-7543A", NULL,   IDE_AFLAG_NO_AUTOCLOSE	     },
1456
	{ "TEAC CD-ROM CD-224E",     NULL,   IDE_AFLAG_NO_AUTOCLOSE	     },
1457 1458 1459
	{ NULL, NULL, 0 }
};

1460
static unsigned int ide_cd_flags(u16 *id)
1461 1462 1463 1464
{
	const struct cd_list_entry *cle = ide_cd_quirks_list;

	while (cle->id_model) {
1465
		if (strcmp(cle->id_model, (char *)&id[ATA_ID_PROD]) == 0 &&
1466
		    (cle->id_firmware == NULL ||
1467
		     strstr((char *)&id[ATA_ID_FW_REV], cle->id_firmware)))
1468 1469 1470 1471 1472 1473 1474
			return cle->cd_flags;
		cle++;
	}

	return 0;
}

1475
static int ide_cdrom_setup(ide_drive_t *drive)
L
Linus Torvalds 已提交
1476
{
1477 1478
	struct cdrom_info *cd = drive->driver_data;
	struct cdrom_device_info *cdi = &cd->devinfo;
1479
	struct request_queue *q = drive->queue;
1480 1481
	u16 *id = drive->id;
	char *fw_rev = (char *)&id[ATA_ID_FW_REV];
L
Linus Torvalds 已提交
1482 1483
	int nslots;

B
Borislav Petkov 已提交
1484
	ide_debug_log(IDE_DBG_PROBE, "enter");
1485

1486 1487 1488 1489 1490
	blk_queue_prep_rq(q, ide_cdrom_prep_fn);
	blk_queue_dma_alignment(q, 31);
	blk_queue_update_dma_pad(q, 15);

	q->unplug_delay = max((1 * HZ) / 1000, 1);
L
Linus Torvalds 已提交
1491

1492 1493
	drive->dev_flags |= IDE_DFLAG_MEDIA_CHANGED;
	drive->atapi_flags = IDE_AFLAG_NO_EJECT | ide_cd_flags(id);
L
Linus Torvalds 已提交
1494

1495
	if ((drive->atapi_flags & IDE_AFLAG_VERTOS_300_SSD) &&
1496
	    fw_rev[4] == '1' && fw_rev[6] <= '2')
1497 1498 1499
		drive->atapi_flags |= (IDE_AFLAG_TOCTRACKS_AS_BCD |
				     IDE_AFLAG_TOCADDR_AS_BCD);
	else if ((drive->atapi_flags & IDE_AFLAG_VERTOS_600_ESD) &&
1500
		 fw_rev[4] == '1' && fw_rev[6] <= '2')
1501 1502
		drive->atapi_flags |= IDE_AFLAG_TOCTRACKS_AS_BCD;
	else if (drive->atapi_flags & IDE_AFLAG_SANYO_3CD)
B
Borislav Petkov 已提交
1503 1504
		/* 3 => use CD in slot 0 */
		cdi->sanyo_slot = 3;
L
Linus Torvalds 已提交
1505

1506
	nslots = ide_cdrom_probe_capabilities(drive);
L
Linus Torvalds 已提交
1507

1508
	blk_queue_logical_block_size(q, CD_FRAMESIZE);
L
Linus Torvalds 已提交
1509 1510

	if (ide_cdrom_register(drive, nslots)) {
1511
		printk(KERN_ERR PFX "%s: %s failed to register device with the"
1512
				" cdrom driver.\n", drive->name, __func__);
1513
		cd->devinfo.handle = NULL;
L
Linus Torvalds 已提交
1514 1515
		return 1;
	}
1516 1517

	ide_proc_register_driver(drive, cd->driver);
L
Linus Torvalds 已提交
1518 1519 1520
	return 0;
}

1521
static void ide_cd_remove(ide_drive_t *drive)
L
Linus Torvalds 已提交
1522 1523 1524
{
	struct cdrom_info *info = drive->driver_data;

B
Borislav Petkov 已提交
1525
	ide_debug_log(IDE_DBG_FUNC, "enter");
1526

1527
	ide_proc_unregister_driver(drive, info->driver);
1528
	device_del(&info->dev);
L
Linus Torvalds 已提交
1529 1530
	del_gendisk(info->disk);

1531 1532 1533
	mutex_lock(&idecd_ref_mutex);
	put_device(&info->dev);
	mutex_unlock(&idecd_ref_mutex);
L
Linus Torvalds 已提交
1534 1535
}

1536
static void ide_cd_release(struct device *dev)
L
Linus Torvalds 已提交
1537
{
1538
	struct cdrom_info *info = to_ide_drv(dev, cdrom_info);
L
Linus Torvalds 已提交
1539 1540 1541 1542
	struct cdrom_device_info *devinfo = &info->devinfo;
	ide_drive_t *drive = info->drive;
	struct gendisk *g = info->disk;

B
Borislav Petkov 已提交
1543
	ide_debug_log(IDE_DBG_FUNC, "enter");
1544

1545
	kfree(info->toc);
1546 1547
	if (devinfo->handle == drive)
		unregister_cdrom(devinfo);
L
Linus Torvalds 已提交
1548 1549 1550 1551 1552 1553 1554
	drive->driver_data = NULL;
	blk_queue_prep_rq(drive->queue, NULL);
	g->private_data = NULL;
	put_disk(g);
	kfree(info);
}

1555
static int ide_cd_probe(ide_drive_t *);
L
Linus Torvalds 已提交
1556

1557
static struct ide_driver ide_cdrom_driver = {
1558
	.gen_driver = {
1559
		.owner		= THIS_MODULE,
1560 1561 1562
		.name		= "ide-cdrom",
		.bus		= &ide_bus_type,
	},
1563 1564
	.probe			= ide_cd_probe,
	.remove			= ide_cd_remove,
L
Linus Torvalds 已提交
1565
	.version		= IDECD_VERSION,
1566
	.do_request		= ide_cd_do_request,
1567
#ifdef CONFIG_IDE_PROC_FS
1568 1569
	.proc_entries		= ide_cd_proc_entries,
	.proc_devsets		= ide_cd_proc_devsets,
1570
#endif
L
Linus Torvalds 已提交
1571 1572
};

A
Al Viro 已提交
1573
static int idecd_open(struct block_device *bdev, fmode_t mode)
L
Linus Torvalds 已提交
1574
{
A
Al Viro 已提交
1575
	struct cdrom_info *info = ide_cd_get(bdev->bd_disk);
L
Linus Torvalds 已提交
1576 1577
	int rc = -ENOMEM;

1578
	if (!info)
L
Linus Torvalds 已提交
1579 1580
		return -ENXIO;

A
Al Viro 已提交
1581
	rc = cdrom_open(&info->devinfo, bdev, mode);
L
Linus Torvalds 已提交
1582 1583 1584 1585 1586 1587 1588

	if (rc < 0)
		ide_cd_put(info);

	return rc;
}

A
Al Viro 已提交
1589
static int idecd_release(struct gendisk *disk, fmode_t mode)
L
Linus Torvalds 已提交
1590
{
B
Borislav Petkov 已提交
1591
	struct cdrom_info *info = ide_drv_g(disk, cdrom_info);
L
Linus Torvalds 已提交
1592

A
Al Viro 已提交
1593
	cdrom_release(&info->devinfo, mode);
L
Linus Torvalds 已提交
1594 1595 1596 1597 1598 1599

	ide_cd_put(info);

	return 0;
}

1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624
static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
{
	struct packet_command cgc;
	char buffer[16];
	int stat;
	char spindown;

	if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
		return -EFAULT;

	init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);

	stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
	if (stat)
		return stat;

	buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
	return cdrom_mode_select(cdi, &cgc);
}

static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
{
	struct packet_command cgc;
	char buffer[16];
	int stat;
1625
	char spindown;
1626 1627 1628 1629 1630 1631 1632 1633

	init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);

	stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
	if (stat)
		return stat;

	spindown = buffer[11] & 0x0f;
1634
	if (copy_to_user((void __user *)arg, &spindown, sizeof(char)))
1635 1636 1637 1638
		return -EFAULT;
	return 0;
}

A
Al Viro 已提交
1639
static int idecd_ioctl(struct block_device *bdev, fmode_t mode,
L
Linus Torvalds 已提交
1640 1641
			unsigned int cmd, unsigned long arg)
{
B
Borislav Petkov 已提交
1642
	struct cdrom_info *info = ide_drv_g(bdev->bd_disk, cdrom_info);
L
Linus Torvalds 已提交
1643 1644
	int err;

1645
	switch (cmd) {
1646
	case CDROMSETSPINDOWN:
1647
		return idecd_set_spindown(&info->devinfo, arg);
1648
	case CDROMGETSPINDOWN:
1649 1650 1651
		return idecd_get_spindown(&info->devinfo, arg);
	default:
		break;
1652
	}
1653

1654
	err = generic_ide_ioctl(info->drive, bdev, cmd, arg);
L
Linus Torvalds 已提交
1655
	if (err == -EINVAL)
A
Al Viro 已提交
1656
		err = cdrom_ioctl(&info->devinfo, bdev, mode, cmd, arg);
L
Linus Torvalds 已提交
1657 1658 1659 1660 1661 1662

	return err;
}

static int idecd_media_changed(struct gendisk *disk)
{
B
Borislav Petkov 已提交
1663
	struct cdrom_info *info = ide_drv_g(disk, cdrom_info);
L
Linus Torvalds 已提交
1664 1665 1666 1667 1668
	return cdrom_media_changed(&info->devinfo);
}

static int idecd_revalidate_disk(struct gendisk *disk)
{
B
Borislav Petkov 已提交
1669
	struct cdrom_info *info = ide_drv_g(disk, cdrom_info);
L
Linus Torvalds 已提交
1670
	struct request_sense sense;
1671 1672 1673

	ide_cd_read_toc(info->drive, &sense);

L
Linus Torvalds 已提交
1674 1675 1676 1677
	return  0;
}

static struct block_device_operations idecd_ops = {
1678
	.owner			= THIS_MODULE,
A
Al Viro 已提交
1679 1680 1681
	.open			= idecd_open,
	.release		= idecd_release,
	.locked_ioctl		= idecd_ioctl,
1682 1683
	.media_changed		= idecd_media_changed,
	.revalidate_disk	= idecd_revalidate_disk
L
Linus Torvalds 已提交
1684 1685
};

B
Borislav Petkov 已提交
1686
/* module options */
1687 1688 1689
static unsigned long debug_mask;
module_param(debug_mask, ulong, 0644);

L
Linus Torvalds 已提交
1690 1691
MODULE_DESCRIPTION("ATAPI CD-ROM Driver");

1692
static int ide_cd_probe(ide_drive_t *drive)
L
Linus Torvalds 已提交
1693 1694 1695 1696 1697
{
	struct cdrom_info *info;
	struct gendisk *g;
	struct request_sense sense;

B
Borislav Petkov 已提交
1698 1699
	ide_debug_log(IDE_DBG_PROBE, "driver_req: %s, media: 0x%x",
				     drive->driver_req, drive->media);
1700

L
Linus Torvalds 已提交
1701 1702
	if (!strstr("ide-cdrom", drive->driver_req))
		goto failed;
1703

L
Linus Torvalds 已提交
1704 1705
	if (drive->media != ide_cdrom && drive->media != ide_optical)
		goto failed;
1706

1707
	drive->debug_mask = debug_mask;
1708
	drive->irq_handler = cdrom_newpc_intr;
1709

1710
	info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
L
Linus Torvalds 已提交
1711
	if (info == NULL) {
1712
		printk(KERN_ERR PFX "%s: Can't allocate a cdrom structure\n",
1713
				drive->name);
L
Linus Torvalds 已提交
1714 1715 1716 1717 1718 1719 1720 1721 1722
		goto failed;
	}

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

	ide_init_disk(g, drive);

1723 1724 1725 1726 1727 1728
	info->dev.parent = &drive->gendev;
	info->dev.release = ide_cd_release;
	dev_set_name(&info->dev, dev_name(&drive->gendev));

	if (device_register(&info->dev))
		goto out_free_disk;
L
Linus Torvalds 已提交
1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741

	info->drive = drive;
	info->driver = &ide_cdrom_driver;
	info->disk = g;

	g->private_data = &info->driver;

	drive->driver_data = info;

	g->minors = 1;
	g->driverfs_dev = &drive->gendev;
	g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
	if (ide_cdrom_setup(drive)) {
1742
		put_device(&info->dev);
L
Linus Torvalds 已提交
1743 1744 1745
		goto failed;
	}

1746
	ide_cd_read_toc(drive, &sense);
L
Linus Torvalds 已提交
1747 1748 1749 1750 1751
	g->fops = &idecd_ops;
	g->flags |= GENHD_FL_REMOVABLE;
	add_disk(g);
	return 0;

1752 1753
out_free_disk:
	put_disk(g);
L
Linus Torvalds 已提交
1754 1755 1756
out_free_cd:
	kfree(info);
failed:
1757
	return -ENODEV;
L
Linus Torvalds 已提交
1758 1759 1760 1761
}

static void __exit ide_cdrom_exit(void)
{
1762
	driver_unregister(&ide_cdrom_driver.gen_driver);
L
Linus Torvalds 已提交
1763
}
1764 1765

static int __init ide_cdrom_init(void)
L
Linus Torvalds 已提交
1766
{
1767
	printk(KERN_INFO DRV_NAME " driver " IDECD_VERSION "\n");
1768
	return driver_register(&ide_cdrom_driver.gen_driver);
L
Linus Torvalds 已提交
1769 1770
}

1771
MODULE_ALIAS("ide:*m-cdrom*");
1772
MODULE_ALIAS("ide-cd");
L
Linus Torvalds 已提交
1773 1774 1775
module_init(ide_cdrom_init);
module_exit(ide_cdrom_exit);
MODULE_LICENSE("GPL");