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