1#include <linux/kernel.h> 2#include <linux/mm.h> 3#include <linux/fs.h> 4#include <linux/errno.h> 5#include <linux/string.h> 6#include <linux/blkdev.h> 7#include <linux/blkpg.h> 8#include <linux/cdrom.h> 9#include <linux/delay.h> 10#include <linux/slab.h> 11#include <asm/io.h> 12#include <asm/uaccess.h> 13 14#include <scsi/scsi.h> 15#include <scsi/scsi_dbg.h> 16#include <scsi/scsi_device.h> 17#include <scsi/scsi_eh.h> 18#include <scsi/scsi_host.h> 19#include <scsi/scsi_ioctl.h> 20#include <scsi/scsi_cmnd.h> 21 22#include "sr.h" 23 24 25/* The sr_is_xa() seems to trigger firmware bugs with some drives :-( 26 * It is off by default and can be turned on with this module parameter */ 27static int xa_test = 0; 28 29module_param(xa_test, int, S_IRUGO | S_IWUSR); 30 31/* primitive to determine whether we need to have GFP_DMA set based on 32 * the status of the unchecked_isa_dma flag in the host structure */ 33#define SR_GFP_DMA(cd) (((cd)->device->host->unchecked_isa_dma) ? GFP_DMA : 0) 34 35 36static int sr_read_tochdr(struct cdrom_device_info *cdi, 37 struct cdrom_tochdr *tochdr) 38{ 39 struct scsi_cd *cd = cdi->handle; 40 struct packet_command cgc; 41 int result; 42 unsigned char *buffer; 43 44 buffer = kmalloc(32, GFP_KERNEL | SR_GFP_DMA(cd)); 45 if (!buffer) 46 return -ENOMEM; 47 48 memset(&cgc, 0, sizeof(struct packet_command)); 49 cgc.timeout = IOCTL_TIMEOUT; 50 cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 51 cgc.cmd[8] = 12; /* LSB of length */ 52 cgc.buffer = buffer; 53 cgc.buflen = 12; 54 cgc.quiet = 1; 55 cgc.data_direction = DMA_FROM_DEVICE; 56 57 result = sr_do_ioctl(cd, &cgc); 58 59 tochdr->cdth_trk0 = buffer[2]; 60 tochdr->cdth_trk1 = buffer[3]; 61 62 kfree(buffer); 63 return result; 64} 65 66static int sr_read_tocentry(struct cdrom_device_info *cdi, 67 struct cdrom_tocentry *tocentry) 68{ 69 struct scsi_cd *cd = cdi->handle; 70 struct packet_command cgc; 71 int result; 72 unsigned char *buffer; 73 74 buffer = kmalloc(32, GFP_KERNEL | SR_GFP_DMA(cd)); 75 if (!buffer) 76 return -ENOMEM; 77 78 memset(&cgc, 0, sizeof(struct packet_command)); 79 cgc.timeout = IOCTL_TIMEOUT; 80 cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 81 cgc.cmd[1] |= (tocentry->cdte_format == CDROM_MSF) ? 0x02 : 0; 82 cgc.cmd[6] = tocentry->cdte_track; 83 cgc.cmd[8] = 12; /* LSB of length */ 84 cgc.buffer = buffer; 85 cgc.buflen = 12; 86 cgc.data_direction = DMA_FROM_DEVICE; 87 88 result = sr_do_ioctl(cd, &cgc); 89 90 tocentry->cdte_ctrl = buffer[5] & 0xf; 91 tocentry->cdte_adr = buffer[5] >> 4; 92 tocentry->cdte_datamode = (tocentry->cdte_ctrl & 0x04) ? 1 : 0; 93 if (tocentry->cdte_format == CDROM_MSF) { 94 tocentry->cdte_addr.msf.minute = buffer[9]; 95 tocentry->cdte_addr.msf.second = buffer[10]; 96 tocentry->cdte_addr.msf.frame = buffer[11]; 97 } else 98 tocentry->cdte_addr.lba = (((((buffer[8] << 8) + buffer[9]) << 8) 99 + buffer[10]) << 8) + buffer[11]; 100 101 kfree(buffer); 102 return result; 103} 104 105#define IOCTL_RETRIES 3 106 107/* ATAPI drives don't have a SCMD_PLAYAUDIO_TI command. When these drives 108 are emulating a SCSI device via the idescsi module, they need to have 109 CDROMPLAYTRKIND commands translated into CDROMPLAYMSF commands for them */ 110 111static int sr_fake_playtrkind(struct cdrom_device_info *cdi, struct cdrom_ti *ti) 112{ 113 struct cdrom_tocentry trk0_te, trk1_te; 114 struct cdrom_tochdr tochdr; 115 struct packet_command cgc; 116 int ntracks, ret; 117 118 ret = sr_read_tochdr(cdi, &tochdr); 119 if (ret) 120 return ret; 121 122 ntracks = tochdr.cdth_trk1 - tochdr.cdth_trk0 + 1; 123 124 if (ti->cdti_trk1 == ntracks) 125 ti->cdti_trk1 = CDROM_LEADOUT; 126 else if (ti->cdti_trk1 != CDROM_LEADOUT) 127 ti->cdti_trk1 ++; 128 129 trk0_te.cdte_track = ti->cdti_trk0; 130 trk0_te.cdte_format = CDROM_MSF; 131 trk1_te.cdte_track = ti->cdti_trk1; 132 trk1_te.cdte_format = CDROM_MSF; 133 134 ret = sr_read_tocentry(cdi, &trk0_te); 135 if (ret) 136 return ret; 137 ret = sr_read_tocentry(cdi, &trk1_te); 138 if (ret) 139 return ret; 140 141 memset(&cgc, 0, sizeof(struct packet_command)); 142 cgc.cmd[0] = GPCMD_PLAY_AUDIO_MSF; 143 cgc.cmd[3] = trk0_te.cdte_addr.msf.minute; 144 cgc.cmd[4] = trk0_te.cdte_addr.msf.second; 145 cgc.cmd[5] = trk0_te.cdte_addr.msf.frame; 146 cgc.cmd[6] = trk1_te.cdte_addr.msf.minute; 147 cgc.cmd[7] = trk1_te.cdte_addr.msf.second; 148 cgc.cmd[8] = trk1_te.cdte_addr.msf.frame; 149 cgc.data_direction = DMA_NONE; 150 cgc.timeout = IOCTL_TIMEOUT; 151 return sr_do_ioctl(cdi->handle, &cgc); 152} 153 154static int sr_play_trkind(struct cdrom_device_info *cdi, 155 struct cdrom_ti *ti) 156 157{ 158 struct scsi_cd *cd = cdi->handle; 159 struct packet_command cgc; 160 int result; 161 162 memset(&cgc, 0, sizeof(struct packet_command)); 163 cgc.timeout = IOCTL_TIMEOUT; 164 cgc.cmd[0] = GPCMD_PLAYAUDIO_TI; 165 cgc.cmd[4] = ti->cdti_trk0; 166 cgc.cmd[5] = ti->cdti_ind0; 167 cgc.cmd[7] = ti->cdti_trk1; 168 cgc.cmd[8] = ti->cdti_ind1; 169 cgc.data_direction = DMA_NONE; 170 171 result = sr_do_ioctl(cd, &cgc); 172 if (result == -EDRIVE_CANT_DO_THIS) 173 result = sr_fake_playtrkind(cdi, ti); 174 175 return result; 176} 177 178/* We do our own retries because we want to know what the specific 179 error code is. Normally the UNIT_ATTENTION code will automatically 180 clear after one error */ 181 182int sr_do_ioctl(Scsi_CD *cd, struct packet_command *cgc) 183{ 184 struct scsi_device *SDev; 185 struct scsi_sense_hdr sshdr; 186 int result, err = 0, retries = 0; 187 struct request_sense *sense = cgc->sense; 188 189 SDev = cd->device; 190 191 if (!sense) { 192 sense = kmalloc(SCSI_SENSE_BUFFERSIZE, GFP_KERNEL); 193 if (!sense) { 194 err = -ENOMEM; 195 goto out; 196 } 197 } 198 199 retry: 200 if (!scsi_block_when_processing_errors(SDev)) { 201 err = -ENODEV; 202 goto out; 203 } 204 205 memset(sense, 0, sizeof(*sense)); 206 result = scsi_execute(SDev, cgc->cmd, cgc->data_direction, 207 cgc->buffer, cgc->buflen, (char *)sense, 208 cgc->timeout, IOCTL_RETRIES, 0, NULL); 209 210 scsi_normalize_sense((char *)sense, sizeof(*sense), &sshdr); 211 212 /* Minimal error checking. Ignore cases we know about, and report the rest. */ 213 if (driver_byte(result) != 0) { 214 switch (sshdr.sense_key) { 215 case UNIT_ATTENTION: 216 SDev->changed = 1; 217 if (!cgc->quiet) 218 printk(KERN_INFO "%s: disc change detected.\n", cd->cdi.name); 219 if (retries++ < 10) 220 goto retry; 221 err = -ENOMEDIUM; 222 break; 223 case NOT_READY: /* This happens if there is no disc in drive */ 224 if (sshdr.asc == 0x04 && 225 sshdr.ascq == 0x01) { 226 /* sense: Logical unit is in process of becoming ready */ 227 if (!cgc->quiet) 228 printk(KERN_INFO "%s: CDROM not ready yet.\n", cd->cdi.name); 229 if (retries++ < 10) { 230 /* sleep 2 sec and try again */ 231 ssleep(2); 232 goto retry; 233 } else { 234 /* 20 secs are enough? */ 235 err = -ENOMEDIUM; 236 break; 237 } 238 } 239 if (!cgc->quiet) 240 printk(KERN_INFO "%s: CDROM not ready. Make sure there is a disc in the drive.\n", cd->cdi.name); 241#ifdef DEBUG 242 scsi_print_sense_hdr("sr", &sshdr); 243#endif 244 err = -ENOMEDIUM; 245 break; 246 case ILLEGAL_REQUEST: 247 err = -EIO; 248 if (sshdr.asc == 0x20 && 249 sshdr.ascq == 0x00) 250 /* sense: Invalid command operation code */ 251 err = -EDRIVE_CANT_DO_THIS; 252#ifdef DEBUG 253 __scsi_print_command(cgc->cmd); 254 scsi_print_sense_hdr("sr", &sshdr); 255#endif 256 break; 257 default: 258 printk(KERN_ERR "%s: CDROM (ioctl) error, command: ", cd->cdi.name); 259 __scsi_print_command(cgc->cmd); 260 scsi_print_sense_hdr("sr", &sshdr); 261 err = -EIO; 262 } 263 } 264 265 /* Wake up a process waiting for device */ 266 out: 267 if (!cgc->sense) 268 kfree(sense); 269 cgc->stat = err; 270 return err; 271} 272 273/* ---------------------------------------------------------------------- */ 274/* interface to cdrom.c */ 275 276int sr_tray_move(struct cdrom_device_info *cdi, int pos) 277{ 278 Scsi_CD *cd = cdi->handle; 279 struct packet_command cgc; 280 281 memset(&cgc, 0, sizeof(struct packet_command)); 282 cgc.cmd[0] = GPCMD_START_STOP_UNIT; 283 cgc.cmd[4] = (pos == 0) ? 0x03 /* close */ : 0x02 /* eject */ ; 284 cgc.data_direction = DMA_NONE; 285 cgc.timeout = IOCTL_TIMEOUT; 286 return sr_do_ioctl(cd, &cgc); 287} 288 289int sr_lock_door(struct cdrom_device_info *cdi, int lock) 290{ 291 Scsi_CD *cd = cdi->handle; 292 293 return scsi_set_medium_removal(cd->device, lock ? 294 SCSI_REMOVAL_PREVENT : SCSI_REMOVAL_ALLOW); 295} 296 297int sr_drive_status(struct cdrom_device_info *cdi, int slot) 298{ 299 struct scsi_cd *cd = cdi->handle; 300 struct scsi_sense_hdr sshdr; 301 struct media_event_desc med; 302 303 if (CDSL_CURRENT != slot) { 304 /* we have no changer support */ 305 return -EINVAL; 306 } 307 if (0 == sr_test_unit_ready(cd->device, &sshdr)) 308 return CDS_DISC_OK; 309 310 /* SK/ASC/ASCQ of 2/4/1 means "unit is becoming ready" */ 311 if (scsi_sense_valid(&sshdr) && sshdr.sense_key == NOT_READY 312 && sshdr.asc == 0x04 && sshdr.ascq == 0x01) 313 return CDS_DRIVE_NOT_READY; 314 315 if (!cdrom_get_media_event(cdi, &med)) { 316 if (med.media_present) 317 return CDS_DISC_OK; 318 else if (med.door_open) 319 return CDS_TRAY_OPEN; 320 else 321 return CDS_NO_DISC; 322 } 323 324 /* 325 * 0x04 is format in progress .. but there must be a disc present! 326 */ 327 if (sshdr.sense_key == NOT_READY && sshdr.asc == 0x04) 328 return CDS_DISC_OK; 329 330 /* 331 * If not using Mt Fuji extended media tray reports, 332 * just return TRAY_OPEN since ATAPI doesn't provide 333 * any other way to detect this... 334 */ 335 if (scsi_sense_valid(&sshdr) && 336 /* 0x3a is medium not present */ 337 sshdr.asc == 0x3a) 338 return CDS_NO_DISC; 339 else 340 return CDS_TRAY_OPEN; 341 342 return CDS_DRIVE_NOT_READY; 343} 344 345int sr_disk_status(struct cdrom_device_info *cdi) 346{ 347 Scsi_CD *cd = cdi->handle; 348 struct cdrom_tochdr toc_h; 349 struct cdrom_tocentry toc_e; 350 int i, rc, have_datatracks = 0; 351 352 /* look for data tracks */ 353 rc = sr_read_tochdr(cdi, &toc_h); 354 if (rc) 355 return (rc == -ENOMEDIUM) ? CDS_NO_DISC : CDS_NO_INFO; 356 357 for (i = toc_h.cdth_trk0; i <= toc_h.cdth_trk1; i++) { 358 toc_e.cdte_track = i; 359 toc_e.cdte_format = CDROM_LBA; 360 if (sr_read_tocentry(cdi, &toc_e)) 361 return CDS_NO_INFO; 362 if (toc_e.cdte_ctrl & CDROM_DATA_TRACK) { 363 have_datatracks = 1; 364 break; 365 } 366 } 367 if (!have_datatracks) 368 return CDS_AUDIO; 369 370 if (cd->xa_flag) 371 return CDS_XA_2_1; 372 else 373 return CDS_DATA_1; 374} 375 376int sr_get_last_session(struct cdrom_device_info *cdi, 377 struct cdrom_multisession *ms_info) 378{ 379 Scsi_CD *cd = cdi->handle; 380 381 ms_info->addr.lba = cd->ms_offset; 382 ms_info->xa_flag = cd->xa_flag || cd->ms_offset > 0; 383 384 return 0; 385} 386 387int sr_get_mcn(struct cdrom_device_info *cdi, struct cdrom_mcn *mcn) 388{ 389 Scsi_CD *cd = cdi->handle; 390 struct packet_command cgc; 391 char *buffer = kmalloc(32, GFP_KERNEL | SR_GFP_DMA(cd)); 392 int result; 393 394 if (!buffer) 395 return -ENOMEM; 396 397 memset(&cgc, 0, sizeof(struct packet_command)); 398 cgc.cmd[0] = GPCMD_READ_SUBCHANNEL; 399 cgc.cmd[2] = 0x40; /* I do want the subchannel info */ 400 cgc.cmd[3] = 0x02; /* Give me medium catalog number info */ 401 cgc.cmd[8] = 24; 402 cgc.buffer = buffer; 403 cgc.buflen = 24; 404 cgc.data_direction = DMA_FROM_DEVICE; 405 cgc.timeout = IOCTL_TIMEOUT; 406 result = sr_do_ioctl(cd, &cgc); 407 408 memcpy(mcn->medium_catalog_number, buffer + 9, 13); 409 mcn->medium_catalog_number[13] = 0; 410 411 kfree(buffer); 412 return result; 413} 414 415int sr_reset(struct cdrom_device_info *cdi) 416{ 417 return 0; 418} 419 420int sr_select_speed(struct cdrom_device_info *cdi, int speed) 421{ 422 Scsi_CD *cd = cdi->handle; 423 struct packet_command cgc; 424 425 if (speed == 0) 426 speed = 0xffff; /* set to max */ 427 else 428 speed *= 177; /* Nx to kbyte/s */ 429 430 memset(&cgc, 0, sizeof(struct packet_command)); 431 cgc.cmd[0] = GPCMD_SET_SPEED; /* SET CD SPEED */ 432 cgc.cmd[2] = (speed >> 8) & 0xff; /* MSB for speed (in kbytes/sec) */ 433 cgc.cmd[3] = speed & 0xff; /* LSB */ 434 cgc.data_direction = DMA_NONE; 435 cgc.timeout = IOCTL_TIMEOUT; 436 437 if (sr_do_ioctl(cd, &cgc)) 438 return -EIO; 439 return 0; 440} 441 442/* ----------------------------------------------------------------------- */ 443/* this is called by the generic cdrom driver. arg is a _kernel_ pointer, */ 444/* because the generic cdrom driver does the user access stuff for us. */ 445/* only cdromreadtochdr and cdromreadtocentry are left - for use with the */ 446/* sr_disk_status interface for the generic cdrom driver. */ 447 448int sr_audio_ioctl(struct cdrom_device_info *cdi, unsigned int cmd, void *arg) 449{ 450 switch (cmd) { 451 case CDROMREADTOCHDR: 452 return sr_read_tochdr(cdi, arg); 453 case CDROMREADTOCENTRY: 454 return sr_read_tocentry(cdi, arg); 455 case CDROMPLAYTRKIND: 456 return sr_play_trkind(cdi, arg); 457 default: 458 return -EINVAL; 459 } 460} 461 462/* ----------------------------------------------------------------------- 463 * a function to read all sorts of funny cdrom sectors using the READ_CD 464 * scsi-3 mmc command 465 * 466 * lba: linear block address 467 * format: 0 = data (anything) 468 * 1 = audio 469 * 2 = data (mode 1) 470 * 3 = data (mode 2) 471 * 4 = data (mode 2 form1) 472 * 5 = data (mode 2 form2) 473 * blksize: 2048 | 2336 | 2340 | 2352 474 */ 475 476static int sr_read_cd(Scsi_CD *cd, unsigned char *dest, int lba, int format, int blksize) 477{ 478 struct packet_command cgc; 479 480#ifdef DEBUG 481 printk("%s: sr_read_cd lba=%d format=%d blksize=%d\n", 482 cd->cdi.name, lba, format, blksize); 483#endif 484 485 memset(&cgc, 0, sizeof(struct packet_command)); 486 cgc.cmd[0] = GPCMD_READ_CD; /* READ_CD */ 487 cgc.cmd[1] = ((format & 7) << 2); 488 cgc.cmd[2] = (unsigned char) (lba >> 24) & 0xff; 489 cgc.cmd[3] = (unsigned char) (lba >> 16) & 0xff; 490 cgc.cmd[4] = (unsigned char) (lba >> 8) & 0xff; 491 cgc.cmd[5] = (unsigned char) lba & 0xff; 492 cgc.cmd[8] = 1; 493 switch (blksize) { 494 case 2336: 495 cgc.cmd[9] = 0x58; 496 break; 497 case 2340: 498 cgc.cmd[9] = 0x78; 499 break; 500 case 2352: 501 cgc.cmd[9] = 0xf8; 502 break; 503 default: 504 cgc.cmd[9] = 0x10; 505 break; 506 } 507 cgc.buffer = dest; 508 cgc.buflen = blksize; 509 cgc.data_direction = DMA_FROM_DEVICE; 510 cgc.timeout = IOCTL_TIMEOUT; 511 return sr_do_ioctl(cd, &cgc); 512} 513 514/* 515 * read sectors with blocksizes other than 2048 516 */ 517 518static int sr_read_sector(Scsi_CD *cd, int lba, int blksize, unsigned char *dest) 519{ 520 struct packet_command cgc; 521 int rc; 522 523 /* we try the READ CD command first... */ 524 if (cd->readcd_known) { 525 rc = sr_read_cd(cd, dest, lba, 0, blksize); 526 if (-EDRIVE_CANT_DO_THIS != rc) 527 return rc; 528 cd->readcd_known = 0; 529 printk("CDROM does'nt support READ CD (0xbe) command\n"); 530 /* fall & retry the other way */ 531 } 532 /* ... if this fails, we switch the blocksize using MODE SELECT */ 533 if (blksize != cd->device->sector_size) { 534 if (0 != (rc = sr_set_blocklength(cd, blksize))) 535 return rc; 536 } 537#ifdef DEBUG 538 printk("%s: sr_read_sector lba=%d blksize=%d\n", cd->cdi.name, lba, blksize); 539#endif 540 541 memset(&cgc, 0, sizeof(struct packet_command)); 542 cgc.cmd[0] = GPCMD_READ_10; 543 cgc.cmd[2] = (unsigned char) (lba >> 24) & 0xff; 544 cgc.cmd[3] = (unsigned char) (lba >> 16) & 0xff; 545 cgc.cmd[4] = (unsigned char) (lba >> 8) & 0xff; 546 cgc.cmd[5] = (unsigned char) lba & 0xff; 547 cgc.cmd[8] = 1; 548 cgc.buffer = dest; 549 cgc.buflen = blksize; 550 cgc.data_direction = DMA_FROM_DEVICE; 551 cgc.timeout = IOCTL_TIMEOUT; 552 rc = sr_do_ioctl(cd, &cgc); 553 554 return rc; 555} 556 557/* 558 * read a sector in raw mode to check the sector format 559 * ret: 1 == mode2 (XA), 0 == mode1, <0 == error 560 */ 561 562int sr_is_xa(Scsi_CD *cd) 563{ 564 unsigned char *raw_sector; 565 int is_xa; 566 567 if (!xa_test) 568 return 0; 569 570 raw_sector = kmalloc(2048, GFP_KERNEL | SR_GFP_DMA(cd)); 571 if (!raw_sector) 572 return -ENOMEM; 573 if (0 == sr_read_sector(cd, cd->ms_offset + 16, 574 CD_FRAMESIZE_RAW1, raw_sector)) { 575 is_xa = (raw_sector[3] == 0x02) ? 1 : 0; 576 } else { 577 /* read a raw sector failed for some reason. */ 578 is_xa = -1; 579 } 580 kfree(raw_sector); 581#ifdef DEBUG 582 printk("%s: sr_is_xa: %d\n", cd->cdi.name, is_xa); 583#endif 584 return is_xa; 585} 586