?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
amd64 port: mainly on the pmap headers, identify_cpu and initcpu
[dragonfly/port-amd64.git] / sys / dev / disk / ata / atapi-cd.c
blobd0db8cd58cfb24e5ee6f64712a8f011f3b4c2d4b
1 /*-
2 * Copyright (c) 1998,1999,2000,2001,2002 Søren Schmidt <sos@FreeBSD.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer,
10 * without modification, immediately at the beginning of the file.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 * $FreeBSD: src/sys/dev/ata/atapi-cd.c,v 1.48.2.20 2002/11/25 05:30:31 njl Exp $
29 * $DragonFly: src/sys/dev/disk/ata/atapi-cd.c,v 1.36 2007/06/03 03:44:16 dillon Exp $
30 */
31
32 #include "opt_ata.h"
33 #include <sys/param.h>
34 #include <sys/systm.h>
35 #include <sys/ata.h>
36 #include <sys/kernel.h>
37 #include <sys/malloc.h>
38 #include <sys/proc.h>
39 #include <sys/buf.h>
40 #include <sys/bus.h>
41 #include <sys/disk.h>
42 #include <sys/diskslice.h>
43 #include <sys/devicestat.h>
44 #include <sys/cdio.h>
45 #include <sys/cdrio.h>
46 #include <sys/dvdio.h>
47 #include <sys/fcntl.h>
48 #include <sys/conf.h>
49 #include <sys/ctype.h>
50 #include <sys/buf2.h>
51 #include <sys/thread2.h>
52
53 #include "ata-all.h"
54 #include "atapi-all.h"
55 #include "atapi-cd.h"
56
57 /* device structures */
58 static d_open_t acdopen;
59 static d_close_t acdclose;
60 static d_ioctl_t acdioctl;
61 static d_strategy_t acdstrategy;
62
63 static struct dev_ops acd_ops = {
64 { "acd", 117, D_DISK | D_TRACKCLOSE },
65 .d_open = acdopen,
66 .d_close = acdclose,
67 .d_read = physread,
68 .d_write = physwrite,
69 .d_ioctl = acdioctl,
70 .d_strategy = acdstrategy,
71 };
72
73 /* prototypes */
74 static struct acd_softc *acd_init_lun(struct ata_device *);
75 static void acd_make_dev(struct acd_softc *);
76 static void acd_set_ioparm(struct acd_softc *);
77 static void acd_describe(struct acd_softc *);
78 static void lba2msf(u_int32_t, u_int8_t *, u_int8_t *, u_int8_t *);
79 static u_int32_t msf2lba(u_int8_t, u_int8_t, u_int8_t);
80 static int acd_done(struct atapi_request *);
81 static void acd_read_toc(struct acd_softc *);
82 static int acd_play(struct acd_softc *, int, int);
83 static int acd_setchan(struct acd_softc *, u_int8_t, u_int8_t, u_int8_t, u_int8_t);
84 static void acd_select_slot(struct acd_softc *);
85 static int acd_init_writer(struct acd_softc *, int);
86 static int acd_fixate(struct acd_softc *, int);
87 static int acd_init_track(struct acd_softc *, struct cdr_track *);
88 static int acd_flush(struct acd_softc *);
89 static int acd_read_track_info(struct acd_softc *, int32_t, struct acd_track_info *);
90 static int acd_get_progress(struct acd_softc *, int *);
91 static int acd_send_cue(struct acd_softc *, struct cdr_cuesheet *);
92 static int acd_report_key(struct acd_softc *, struct dvd_authinfo *);
93 static int acd_send_key(struct acd_softc *, struct dvd_authinfo *);
94 static int acd_read_structure(struct acd_softc *, struct dvd_struct *);
95 static int acd_eject(struct acd_softc *, int);
96 static int acd_blank(struct acd_softc *, int);
97 static int acd_prevent_allow(struct acd_softc *, int);
98 static int acd_start_stop(struct acd_softc *, int);
99 static int acd_pause_resume(struct acd_softc *, int);
100 static int acd_mode_sense(struct acd_softc *, int, caddr_t, int);
101 static int acd_mode_select(struct acd_softc *, caddr_t, int);
102 static int acd_set_speed(struct acd_softc *, int, int);
103 static void acd_get_cap(struct acd_softc *);
104
105 /* internal vars */
106 static u_int32_t acd_lun_map = 0;
107 static MALLOC_DEFINE(M_ACD, "ACD driver", "ATAPI CD driver buffers");
108
109 int
110 acdattach(struct ata_device *atadev)
111 {
112 struct acd_softc *cdp;
113 struct changer *chp;
114
115 if ((cdp = acd_init_lun(atadev)) == NULL) {
116 ata_prtdev(atadev, "acd: out of memory\n");
117 return 0;
118 }
119
120 ata_set_name(atadev, "acd", cdp->lun);
121 ata_command(atadev, ATA_C_ATAPI_RESET, 0, 0, 0, ATA_IMMEDIATE);
122 acd_get_cap(cdp);
123
124 /* if this is a changer device, allocate the neeeded lun's */
125 if (cdp->cap.mech == MST_MECH_CHANGER) {
126 int8_t ccb[16] = { ATAPI_MECH_STATUS, 0, 0, 0, 0, 0, 0, 0,
127 sizeof(struct changer)>>8, sizeof(struct changer),
128 0, 0, 0, 0, 0, 0 };
129
130 chp = kmalloc(sizeof(struct changer), M_ACD, M_WAITOK | M_ZERO);
131 if (!atapi_queue_cmd(cdp->device, ccb, (caddr_t)chp,
132 sizeof(struct changer),
133 ATPR_F_READ, 60, NULL, NULL)) {
134 struct acd_softc *tmpcdp = cdp;
135 struct acd_softc **cdparr;
136 char *name;
137 int count;
138
139 chp->table_length = htons(chp->table_length);
140 cdparr = kmalloc(sizeof(struct acd_softc) * chp->slots,
141 M_ACD, M_WAITOK);
142 for (count = 0; count < chp->slots; count++) {
143 if (count > 0) {
144 tmpcdp = acd_init_lun(atadev);
145 if (!tmpcdp) {
146 ata_prtdev(atadev, "out of memory\n");
147 break;
148 }
149 }
150 cdparr[count] = tmpcdp;
151 tmpcdp->driver = cdparr;
152 tmpcdp->slot = count;
153 tmpcdp->changer_info = chp;
154 acd_make_dev(tmpcdp);
155 devstat_add_entry(tmpcdp->stats, "acd", tmpcdp->lun, DEV_BSIZE,
156 DEVSTAT_NO_ORDERED_TAGS,
157 DEVSTAT_TYPE_CDROM | DEVSTAT_TYPE_IF_IDE,
158 DEVSTAT_PRIORITY_CD);
159 }
160 name = kmalloc(strlen(atadev->name) + 2, M_ACD, M_WAITOK);
161 strcpy(name, atadev->name);
162 strcat(name, "-");
163 ata_free_name(atadev);
164 ata_set_name(atadev, name, cdp->lun + cdp->changer_info->slots - 1);
165 kfree(name, M_ACD);
166 }
167 }
168 else {
169 acd_make_dev(cdp);
170 devstat_add_entry(cdp->stats, "acd", cdp->lun, DEV_BSIZE,
171 DEVSTAT_NO_ORDERED_TAGS,
172 DEVSTAT_TYPE_CDROM | DEVSTAT_TYPE_IF_IDE,
173 DEVSTAT_PRIORITY_CD);
174 }
175 acd_describe(cdp);
176 atadev->driver = cdp;
177 return 1;
178 }
179
180 void
181 acddetach(struct ata_device *atadev)
182 {
183 struct acd_softc *cdp = atadev->driver;
184 struct acd_devlist *entry;
185 struct bio *bio;
186 int subdev;
187
188 if (cdp->changer_info) {
189 for (subdev = 0; subdev < cdp->changer_info->slots; subdev++) {
190 if (cdp->driver[subdev] == cdp)
191 continue;
192 while ((bio = bioq_first(&cdp->driver[subdev]->bio_queue))) {
193 bioq_remove(&cdp->driver[subdev]->bio_queue, bio);
194 bio->bio_buf->b_flags |= B_ERROR;
195 bio->bio_buf->b_error = ENXIO;
196 biodone(bio);
197 }
198 release_dev(cdp->driver[subdev]->dev);
199 while ((entry = TAILQ_FIRST(&cdp->driver[subdev]->dev_list))) {
200 release_dev(entry->dev);
201 TAILQ_REMOVE(&cdp->driver[subdev]->dev_list, entry, chain);
202 kfree(entry, M_ACD);
203 }
204 devstat_remove_entry(cdp->driver[subdev]->stats);
205 kfree(cdp->driver[subdev]->stats, M_ACD);
206 ata_free_lun(&acd_lun_map, cdp->driver[subdev]->lun);
207 kfree(cdp->driver[subdev], M_ACD);
208 }
209 kfree(cdp->driver, M_ACD);
210 kfree(cdp->changer_info, M_ACD);
211 }
212 while ((bio = bioq_first(&cdp->bio_queue))) {
213 bio->bio_buf->b_flags |= B_ERROR;
214 bio->bio_buf->b_error = ENXIO;
215 biodone(bio);
216 }
217 while ((entry = TAILQ_FIRST(&cdp->dev_list))) {
218 release_dev(entry->dev);
219 TAILQ_REMOVE(&cdp->dev_list, entry, chain);
220 kfree(entry, M_ACD);
221 }
222 disk_invalidate(&cdp->disk);
223 disk_destroy(&cdp->disk);
224 devstat_remove_entry(cdp->stats);
225 kfree(cdp->stats, M_ACD);
226 ata_free_name(atadev);
227 ata_free_lun(&acd_lun_map, cdp->lun);
228 kfree(cdp, M_ACD);
229 atadev->driver = NULL;
230 }
231
232 static struct acd_softc *
233 acd_init_lun(struct ata_device *atadev)
234 {
235 struct acd_softc *cdp;
236
237 cdp = kmalloc(sizeof(struct acd_softc), M_ACD, M_WAITOK | M_ZERO);
238 TAILQ_INIT(&cdp->dev_list);
239 bioq_init(&cdp->bio_queue);
240 cdp->device = atadev;
241 cdp->lun = ata_get_lun(&acd_lun_map);
242 cdp->block_size = 2048;
243 cdp->slot = -1;
244 cdp->changer_info = NULL;
245 cdp->stats = kmalloc(sizeof(struct devstat), M_ACD, M_WAITOK | M_ZERO);
246 return cdp;
247 }
248
249 static void
250 acd_make_dev(struct acd_softc *cdp)
251 {
252 cdev_t dev;
253
254 dev = disk_create(cdp->lun, &cdp->disk, &acd_ops);
255 dev->si_drv1 = cdp;
256 cdp->dev = dev;
257 cdp->device->flags |= ATA_D_MEDIA_CHANGED;
258 acd_set_ioparm(cdp);
259 }
260
261 static void
262 acd_set_ioparm(struct acd_softc *cdp)
263 {
264 struct disk_info info;
265
266 cdp->dev->si_iosize_max =
267 ((256*DEV_BSIZE)/cdp->block_size)*cdp->block_size;
268 cdp->dev->si_bsize_phys = cdp->block_size;
269 bzero(&info, sizeof(info));
270 info.d_media_blksize = cdp->block_size;
271 info.d_media_blocks = cdp->disk_size;
272 info.d_secpertrack = 100;
273 info.d_nheads = 1;
274 info.d_ncylinders = cdp->disk_size / info.d_secpertrack / info.d_nheads + 1;
275 info.d_secpercyl = info.d_secpertrack * info.d_nheads;
276 info.d_dsflags = DSO_ONESLICE | DSO_COMPATLABEL | DSO_COMPATPARTA |
277 DSO_RAWEXTENSIONS;
278 disk_setdiskinfo(&cdp->disk, &info);
279 }
280
281 static void
282 acd_describe(struct acd_softc *cdp)
283 {
284 int comma = 0;
285 char *mechanism;
286
287 if (bootverbose) {
288 ata_prtdev(cdp->device, "<%.40s/%.8s> %s drive at ata%d as %s\n",
289 cdp->device->param->model, cdp->device->param->revision,
290 (cdp->cap.write_dvdr) ? "DVD-R" :
291 (cdp->cap.write_dvdram) ? "DVD-RAM" :
292 (cdp->cap.write_cdrw) ? "CD-RW" :
293 (cdp->cap.write_cdr) ? "CD-R" :
294 (cdp->cap.read_dvdrom) ? "DVD-ROM" : "CDROM",
295 device_get_unit(cdp->device->channel->dev),
296 (cdp->device->unit == ATA_MASTER) ? "master" : "slave");
297
298 ata_prtdev(cdp->device, "%s", "");
299 if (cdp->cap.cur_read_speed) {
300 kprintf("read %dKB/s", cdp->cap.cur_read_speed * 1000 / 1024);
301 if (cdp->cap.max_read_speed)
302 kprintf(" (%dKB/s)", cdp->cap.max_read_speed * 1000 / 1024);
303 if ((cdp->cap.cur_write_speed) &&
304 (cdp->cap.write_cdr || cdp->cap.write_cdrw ||
305 cdp->cap.write_dvdr || cdp->cap.write_dvdram)) {
306 kprintf(" write %dKB/s", cdp->cap.cur_write_speed * 1000 / 1024);
307 if (cdp->cap.max_write_speed)
308 kprintf(" (%dKB/s)", cdp->cap.max_write_speed * 1000 / 1024);
309 }
310 comma = 1;
311 }
312 if (cdp->cap.buf_size) {
313 kprintf("%s %dKB buffer", comma ? "," : "", cdp->cap.buf_size);
314 comma = 1;
315 }
316 kprintf("%s %s\n", comma ? "," : "", ata_mode2str(cdp->device->mode));
317
318 ata_prtdev(cdp->device, "Reads:");
319 comma = 0;
320 if (cdp->cap.read_cdr) {
321 kprintf(" CD-R"); comma = 1;
322 }
323 if (cdp->cap.read_cdrw) {
324 kprintf("%s CD-RW", comma ? "," : ""); comma = 1;
325 }
326 if (cdp->cap.cd_da) {
327 if (cdp->cap.cd_da_stream)
328 kprintf("%s CD-DA stream", comma ? "," : "");
329 else
330 kprintf("%s CD-DA", comma ? "," : "");
331 comma = 1;
332 }
333 if (cdp->cap.read_dvdrom) {
334 kprintf("%s DVD-ROM", comma ? "," : ""); comma = 1;
335 }
336 if (cdp->cap.read_dvdr) {
337 kprintf("%s DVD-R", comma ? "," : ""); comma = 1;
338 }
339 if (cdp->cap.read_dvdram) {
340 kprintf("%s DVD-RAM", comma ? "," : ""); comma = 1;
341 }
342 if (cdp->cap.read_packet)
343 kprintf("%s packet", comma ? "," : "");
344
345 kprintf("\n");
346 ata_prtdev(cdp->device, "Writes:");
347 if (cdp->cap.write_cdr || cdp->cap.write_cdrw ||
348 cdp->cap.write_dvdr || cdp->cap.write_dvdram) {
349 comma = 0;
350 if (cdp->cap.write_cdr) {
351 kprintf(" CD-R" ); comma = 1;
352 }
353 if (cdp->cap.write_cdrw) {
354 kprintf("%s CD-RW", comma ? "," : ""); comma = 1;
355 }
356 if (cdp->cap.write_dvdr) {
357 kprintf("%s DVD-R", comma ? "," : ""); comma = 1;
358 }
359 if (cdp->cap.write_dvdram) {
360 kprintf("%s DVD-RAM", comma ? "," : ""); comma = 1;
361 }
362 if (cdp->cap.test_write) {
363 kprintf("%s test write", comma ? "," : ""); comma = 1;
364 }
365 if (cdp->cap.burnproof)
366 kprintf("%s burnproof", comma ? "," : "");
367 }
368 kprintf("\n");
369 if (cdp->cap.audio_play) {
370 ata_prtdev(cdp->device, "Audio: ");
371 if (cdp->cap.audio_play)
372 kprintf("play");
373 if (cdp->cap.max_vol_levels)
374 kprintf(", %d volume levels", cdp->cap.max_vol_levels);
375 kprintf("\n");
376 }
377 ata_prtdev(cdp->device, "Mechanism: ");
378 switch (cdp->cap.mech) {
379 case MST_MECH_CADDY:
380 mechanism = "caddy"; break;
381 case MST_MECH_TRAY:
382 mechanism = "tray"; break;
383 case MST_MECH_POPUP:
384 mechanism = "popup"; break;
385 case MST_MECH_CHANGER:
386 mechanism = "changer"; break;
387 case MST_MECH_CARTRIDGE:
388 mechanism = "cartridge"; break;
389 default:
390 mechanism = 0; break;
391 }
392 if (mechanism)
393 kprintf("%s%s", cdp->cap.eject ? "ejectable " : "", mechanism);
394 else if (cdp->cap.eject)
395 kprintf("ejectable");
396
397 if (cdp->cap.lock)
398 kprintf(cdp->cap.locked ? ", locked" : ", unlocked");
399 if (cdp->cap.prevent)
400 kprintf(", lock protected");
401 kprintf("\n");
402
403 if (cdp->cap.mech != MST_MECH_CHANGER) {
404 ata_prtdev(cdp->device, "Medium: ");
405 switch (cdp->cap.medium_type & MST_TYPE_MASK_HIGH) {
406 case MST_CDROM:
407 kprintf("CD-ROM "); break;
408 case MST_CDR:
409 kprintf("CD-R "); break;
410 case MST_CDRW:
411 kprintf("CD-RW "); break;
412 case MST_DOOR_OPEN:
413 kprintf("door open"); break;
414 case MST_NO_DISC:
415 kprintf("no/blank disc"); break;
416 case MST_FMT_ERROR:
417 kprintf("medium format error"); break;
418 }
419 if ((cdp->cap.medium_type & MST_TYPE_MASK_HIGH)<MST_TYPE_MASK_HIGH){
420 switch (cdp->cap.medium_type & MST_TYPE_MASK_LOW) {
421 case MST_DATA_120:
422 kprintf("120mm data disc"); break;
423 case MST_AUDIO_120:
424 kprintf("120mm audio disc"); break;
425 case MST_COMB_120:
426 kprintf("120mm data/audio disc"); break;
427 case MST_PHOTO_120:
428 kprintf("120mm photo disc"); break;
429 case MST_DATA_80:
430 kprintf("80mm data disc"); break;
431 case MST_AUDIO_80:
432 kprintf("80mm audio disc"); break;
433 case MST_COMB_80:
434 kprintf("80mm data/audio disc"); break;
435 case MST_PHOTO_80:
436 kprintf("80mm photo disc"); break;
437 case MST_FMT_NONE:
438 switch (cdp->cap.medium_type & MST_TYPE_MASK_HIGH) {
439 case MST_CDROM:
440 kprintf("unknown"); break;
441 case MST_CDR:
442 case MST_CDRW:
443 kprintf("blank"); break;
444 }
445 break;
446 default:
447 kprintf("unknown (0x%x)", cdp->cap.medium_type); break;
448 }
449 }
450 kprintf("\n");
451 }
452 }
453 else {
454 ata_prtdev(cdp->device, "%s ",
455 (cdp->cap.write_dvdr) ? "DVD-R" :
456 (cdp->cap.write_dvdram) ? "DVD-RAM" :
457 (cdp->cap.write_cdrw) ? "CD-RW" :
458 (cdp->cap.write_cdr) ? "CD-R" :
459 (cdp->cap.read_dvdrom) ? "DVD-ROM" : "CDROM");
460
461 if (cdp->changer_info)
462 kprintf("with %d CD changer ", cdp->changer_info->slots);
463
464 kprintf("<%.40s> at ata%d-%s %s\n", cdp->device->param->model,
465 device_get_unit(cdp->device->channel->dev),
466 (cdp->device->unit == ATA_MASTER) ? "master" : "slave",
467 ata_mode2str(cdp->device->mode) );
468 }
469 }
470
471 static __inline void
472 lba2msf(u_int32_t lba, u_int8_t *m, u_int8_t *s, u_int8_t *f)
473 {
474 lba += 150;
475 lba &= 0xffffff;
476 *m = lba / (60 * 75);
477 lba %= (60 * 75);
478 *s = lba / 75;
479 *f = lba % 75;
480 }
481
482 static __inline u_int32_t
483 msf2lba(u_int8_t m, u_int8_t s, u_int8_t f)
484 {
485 return (m * 60 + s) * 75 + f - 150;
486 }
487
488 static int
489 acdopen(struct dev_open_args *ap)
490 {
491 cdev_t dev = ap->a_head.a_dev;
492 struct acd_softc *cdp = dev->si_drv1;
493 int timeout = 60;
494
495 if (!cdp)
496 return ENXIO;
497
498 if (ap->a_oflags & FWRITE) {
499 if (count_dev(dev) > 1)
500 return EBUSY;
501 }
502
503 /* wait if drive is not finished loading the medium */
504 while (timeout--) {
505 struct atapi_reqsense *sense = cdp->device->result;
506
507 if (!atapi_test_ready(cdp->device))
508 break;
509 if (sense->sense_key == 2 && sense->asc == 4 && sense->ascq == 1)
510 tsleep(&timeout, 0, "acdld", hz / 2);
511 else
512 break;
513 }
514
515 if (cdp->changer_info && cdp->slot != cdp->changer_info->current_slot) {
516 acd_select_slot(cdp);
517 tsleep(&cdp->changer_info, 0, "acdopn", 0);
518 }
519 acd_prevent_allow(cdp, 1);
520 cdp->flags |= F_LOCKED;
521 acd_read_toc(cdp);
522 return 0;
523 }
524
525 static int
526 acdclose(struct dev_close_args *ap)
527 {
528 cdev_t dev = ap->a_head.a_dev;
529 struct acd_softc *cdp = dev->si_drv1;
530
531 if (!cdp)
532 return ENXIO;
533
534 if (cdp->changer_info && cdp->slot != cdp->changer_info->current_slot) {
535 acd_select_slot(cdp);
536 tsleep(&cdp->changer_info, 0, "acdclo", 0);
537 }
538 acd_prevent_allow(cdp, 0);
539 cdp->flags &= ~F_LOCKED;
540 return 0;
541 }
542
543 static int
544 acdioctl(struct dev_ioctl_args *ap)
545 {
546 cdev_t dev = ap->a_head.a_dev;
547 struct acd_softc *cdp = dev->si_drv1;
548 int error = 0;
549
550 if (!cdp)
551 return ENXIO;
552
553 if (cdp->changer_info && cdp->slot != cdp->changer_info->current_slot) {
554 acd_select_slot(cdp);
555 tsleep(&cdp->changer_info, 0, "acdctl", 0);
556 }
557 if (cdp->device->flags & ATA_D_MEDIA_CHANGED)
558 switch (ap->a_cmd) {
559 case CDIOCRESET:
560 atapi_test_ready(cdp->device);
561 break;
562
563 default:
564 acd_read_toc(cdp);
565 acd_prevent_allow(cdp, 1);
566 cdp->flags |= F_LOCKED;
567 break;
568 }
569 switch (ap->a_cmd) {
570
571 case CDIOCRESUME:
572 error = acd_pause_resume(cdp, 1);
573 break;
574
575 case CDIOCPAUSE:
576 error = acd_pause_resume(cdp, 0);
577 break;
578
579 case CDIOCSTART:
580 error = acd_start_stop(cdp, 1);
581 break;
582
583 case CDIOCSTOP:
584 error = acd_start_stop(cdp, 0);
585 break;
586
587 case CDIOCALLOW:
588 error = acd_prevent_allow(cdp, 0);
589 cdp->flags &= ~F_LOCKED;
590 break;
591
592 case CDIOCPREVENT:
593 error = acd_prevent_allow(cdp, 1);
594 cdp->flags |= F_LOCKED;
595 break;
596
597 case CDIOCRESET:
598 ; /* note: if no proc EPERM will be returned */
599 error = suser_cred(ap->a_cred, 0);
600 if (error)
601 break;
602 error = atapi_test_ready(cdp->device);
603 break;
604
605 case CDIOCEJECT:
606 if (count_dev(dev) > 1) {
607 error = EBUSY;
608 break;
609 }
610 error = acd_eject(cdp, 0);
611 break;
612
613 case CDIOCCLOSE:
614 if (count_dev(dev) > 1)
615 break;
616 error = acd_eject(cdp, 1);
617 break;
618
619 case CDIOREADTOCHEADER:
620 if (!cdp->toc.hdr.ending_track) {
621 error = EIO;
622 break;
623 }
624 bcopy(&cdp->toc.hdr, ap->a_data, sizeof(cdp->toc.hdr));
625 break;
626
627 case CDIOREADTOCENTRYS:
628 {
629 struct ioc_read_toc_entry *te = (struct ioc_read_toc_entry *)ap->a_data;
630 struct toc *toc = &cdp->toc;
631 int starting_track = te->starting_track;
632 int len;
633
634 if (!toc->hdr.ending_track) {
635 error = EIO;
636 break;
637 }
638
639 if (te->data_len < sizeof(toc->tab[0]) ||
640 (te->data_len % sizeof(toc->tab[0])) != 0 ||
641 (te->address_format != CD_MSF_FORMAT &&
642 te->address_format != CD_LBA_FORMAT)) {
643 error = EINVAL;
644 break;
645 }
646
647 if (!starting_track)
648 starting_track = toc->hdr.starting_track;
649 else if (starting_track == 170)
650 starting_track = toc->hdr.ending_track + 1;
651 else if (starting_track < toc->hdr.starting_track ||
652 starting_track > toc->hdr.ending_track + 1) {
653 error = EINVAL;
654 break;
655 }
656
657 len = ((toc->hdr.ending_track + 1 - starting_track) + 1) *
658 sizeof(toc->tab[0]);
659 if (te->data_len < len)
660 len = te->data_len;
661 if (len > sizeof(toc->tab)) {
662 error = EINVAL;
663 break;
664 }
665
666 if (te->address_format == CD_MSF_FORMAT) {
667 struct cd_toc_entry *entry;
668
669 toc = kmalloc(sizeof(struct toc), M_ACD, M_WAITOK | M_ZERO);
670 bcopy(&cdp->toc, toc, sizeof(struct toc));
671 entry = toc->tab + (toc->hdr.ending_track + 1 -
672 toc->hdr.starting_track) + 1;
673 while (--entry >= toc->tab)
674 lba2msf(ntohl(entry->addr.lba), &entry->addr.msf.minute,
675 &entry->addr.msf.second, &entry->addr.msf.frame);
676 }
677 error = copyout(toc->tab + starting_track - toc->hdr.starting_track,
678 te->data, len);
679 if (te->address_format == CD_MSF_FORMAT)
680 kfree(toc, M_ACD);
681 break;
682 }
683 case CDIOREADTOCENTRY:
684 {
685 struct ioc_read_toc_single_entry *te =
686 (struct ioc_read_toc_single_entry *)ap->a_data;
687 struct toc *toc = &cdp->toc;
688 u_char track = te->track;
689
690 if (!toc->hdr.ending_track) {
691 error = EIO;
692 break;
693 }
694
695 if (te->address_format != CD_MSF_FORMAT &&
696 te->address_format != CD_LBA_FORMAT) {
697 error = EINVAL;
698 break;
699 }
700
701 if (!track)
702 track = toc->hdr.starting_track;
703 else if (track == 170)
704 track = toc->hdr.ending_track + 1;
705 else if (track < toc->hdr.starting_track ||
706 track > toc->hdr.ending_track + 1) {
707 error = EINVAL;
708 break;
709 }
710
711 if (te->address_format == CD_MSF_FORMAT) {
712 struct cd_toc_entry *entry;
713
714 toc = kmalloc(sizeof(struct toc), M_ACD, M_WAITOK | M_ZERO);
715 bcopy(&cdp->toc, toc, sizeof(struct toc));
716
717 entry = toc->tab + (track - toc->hdr.starting_track);
718 lba2msf(ntohl(entry->addr.lba), &entry->addr.msf.minute,
719 &entry->addr.msf.second, &entry->addr.msf.frame);
720 }
721 bcopy(toc->tab + track - toc->hdr.starting_track,
722 &te->entry, sizeof(struct cd_toc_entry));
723 if (te->address_format == CD_MSF_FORMAT)
724 kfree(toc, M_ACD);
725 }
726 break;
727
728 case CDIOCREADSUBCHANNEL:
729 {
730 struct ioc_read_subchannel *args =
731 (struct ioc_read_subchannel *)ap->a_data;
732 u_int8_t format;
733 int8_t ccb[16] = { ATAPI_READ_SUBCHANNEL, 0, 0x40, 1, 0, 0, 0,
734 sizeof(cdp->subchan)>>8, sizeof(cdp->subchan),
735 0, 0, 0, 0, 0, 0, 0 };
736
737 if (args->data_len > sizeof(struct cd_sub_channel_info) ||
738 args->data_len < sizeof(struct cd_sub_channel_header)) {
739 error = EINVAL;
740 break;
741 }
742
743 format=args->data_format;
744 if ((format != CD_CURRENT_POSITION) &&
745 (format != CD_MEDIA_CATALOG) && (format != CD_TRACK_INFO)) {
746 error = EINVAL;
747 break;
748 }
749
750 ccb[1] = args->address_format & CD_MSF_FORMAT;
751
752 if ((error = atapi_queue_cmd(cdp->device,ccb,(caddr_t)&cdp->subchan,
753 sizeof(cdp->subchan), ATPR_F_READ, 10,
754 NULL, NULL)))
755 break;
756
757 if ((format == CD_MEDIA_CATALOG) || (format == CD_TRACK_INFO)) {
758 if (cdp->subchan.header.audio_status == 0x11) {
759 error = EINVAL;
760 break;
761 }
762
763 ccb[3] = format;
764 if (format == CD_TRACK_INFO)
765 ccb[6] = args->track;
766
767 if ((error = atapi_queue_cmd(cdp->device, ccb,
768 (caddr_t)&cdp->subchan,
769 sizeof(cdp->subchan), ATPR_F_READ,
770 10, NULL, NULL))) {
771 break;
772 }
773 }
774 error = copyout(&cdp->subchan, args->data, args->data_len);
775 break;
776 }
777
778 case CDIOCPLAYMSF:
779 {
780 struct ioc_play_msf *args = (struct ioc_play_msf *)ap->a_data;
781
782 error =
783 acd_play(cdp,
784 msf2lba(args->start_m, args->start_s, args->start_f),
785 msf2lba(args->end_m, args->end_s, args->end_f));
786 break;
787 }
788
789 case CDIOCPLAYBLOCKS:
790 {
791 struct ioc_play_blocks *args = (struct ioc_play_blocks *)ap->a_data;
792
793 error = acd_play(cdp, args->blk, args->blk + args->len);
794 break;
795 }
796
797 case CDIOCPLAYTRACKS:
798 {
799 struct ioc_play_track *args = (struct ioc_play_track *)ap->a_data;
800 int t1, t2;
801
802 if (!cdp->toc.hdr.ending_track) {
803 error = EIO;
804 break;
805 }
806 if (args->end_track < cdp->toc.hdr.ending_track + 1)
807 ++args->end_track;
808 if (args->end_track > cdp->toc.hdr.ending_track + 1)
809 args->end_track = cdp->toc.hdr.ending_track + 1;
810 t1 = args->start_track - cdp->toc.hdr.starting_track;
811 t2 = args->end_track - cdp->toc.hdr.starting_track;
812 if (t1 < 0 || t2 < 0 ||
813 t1 > (cdp->toc.hdr.ending_track-cdp->toc.hdr.starting_track)) {
814 error = EINVAL;
815 break;
816 }
817 error = acd_play(cdp, ntohl(cdp->toc.tab[t1].addr.lba),
818 ntohl(cdp->toc.tab[t2].addr.lba));
819 break;
820 }
821
822 case CDIOCREADAUDIO:
823 {
824 struct ioc_read_audio *args = (struct ioc_read_audio *)ap->a_data;
825 int32_t lba;
826 caddr_t buffer, ubuf = args->buffer;
827 int8_t ccb[16];
828 int frames;
829
830 if (!cdp->toc.hdr.ending_track) {
831 error = EIO;
832 break;
833 }
834
835 if ((frames = args->nframes) < 0) {
836 error = EINVAL;
837 break;
838 }
839
840 if (args->address_format == CD_LBA_FORMAT)
841 lba = args->address.lba;
842 else if (args->address_format == CD_MSF_FORMAT)
843 lba = msf2lba(args->address.msf.minute,
844 args->address.msf.second,
845 args->address.msf.frame);
846 else {
847 error = EINVAL;
848 break;
849 }
850
851 #ifndef CD_BUFFER_BLOCKS
852 #define CD_BUFFER_BLOCKS 13
853 #endif
854 if (!(buffer = kmalloc(CD_BUFFER_BLOCKS * 2352, M_ACD, M_WAITOK))){
855 error = ENOMEM;
856 break;
857 }
858 bzero(ccb, sizeof(ccb));
859 while (frames > 0) {
860 int8_t blocks;
861 int size;
862
863 blocks = (frames>CD_BUFFER_BLOCKS) ? CD_BUFFER_BLOCKS : frames;
864 size = blocks * 2352;
865
866 ccb[0] = ATAPI_READ_CD;
867 ccb[1] = 4;
868 ccb[2] = lba>>24;
869 ccb[3] = lba>>16;
870 ccb[4] = lba>>8;
871 ccb[5] = lba;
872 ccb[8] = blocks;
873 ccb[9] = 0xf0;
874 if ((error = atapi_queue_cmd(cdp->device, ccb, buffer, size,
875 ATPR_F_READ, 30, NULL,NULL)))
876 break;
877
878 if ((error = copyout(buffer, ubuf, size)))
879 break;
880
881 ubuf += size;
882 frames -= blocks;
883 lba += blocks;
884 }
885 kfree(buffer, M_ACD);
886 if (args->address_format == CD_LBA_FORMAT)
887 args->address.lba = lba;
888 else if (args->address_format == CD_MSF_FORMAT)
889 lba2msf(lba, &args->address.msf.minute,
890 &args->address.msf.second,
891 &args->address.msf.frame);
892 break;
893 }
894
895 case CDIOCGETVOL:
896 {
897 struct ioc_vol *arg = (struct ioc_vol *)ap->a_data;
898
899 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_AUDIO_PAGE,
900 (caddr_t)&cdp->au, sizeof(cdp->au))))
901 break;
902
903 if (cdp->au.page_code != ATAPI_CDROM_AUDIO_PAGE) {
904 error = EIO;
905 break;
906 }
907 arg->vol[0] = cdp->au.port[0].volume;
908 arg->vol[1] = cdp->au.port[1].volume;
909 arg->vol[2] = cdp->au.port[2].volume;
910 arg->vol[3] = cdp->au.port[3].volume;
911 break;
912 }
913
914 case CDIOCSETVOL:
915 {
916 struct ioc_vol *arg = (struct ioc_vol *)ap->a_data;
917
918 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_AUDIO_PAGE,
919 (caddr_t)&cdp->au, sizeof(cdp->au))))
920 break;
921 if (cdp->au.page_code != ATAPI_CDROM_AUDIO_PAGE) {
922 error = EIO;
923 break;
924 }
925 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_AUDIO_PAGE_MASK,
926 (caddr_t)&cdp->aumask,
927 sizeof(cdp->aumask))))
928 break;
929 cdp->au.data_length = 0;
930 cdp->au.port[0].channels = CHANNEL_0;
931 cdp->au.port[1].channels = CHANNEL_1;
932 cdp->au.port[0].volume = arg->vol[0] & cdp->aumask.port[0].volume;
933 cdp->au.port[1].volume = arg->vol[1] & cdp->aumask.port[1].volume;
934 cdp->au.port[2].volume = arg->vol[2] & cdp->aumask.port[2].volume;
935 cdp->au.port[3].volume = arg->vol[3] & cdp->aumask.port[3].volume;
936 error = acd_mode_select(cdp, (caddr_t)&cdp->au, sizeof(cdp->au));
937 break;
938 }
939 case CDIOCSETPATCH:
940 {
941 struct ioc_patch *arg = (struct ioc_patch *)ap->a_data;
942
943 error = acd_setchan(cdp, arg->patch[0], arg->patch[1],
944 arg->patch[2], arg->patch[3]);
945 break;
946 }
947
948 case CDIOCSETMONO:
949 error = acd_setchan(cdp, CHANNEL_0|CHANNEL_1, CHANNEL_0|CHANNEL_1, 0,0);
950 break;
951
952 case CDIOCSETSTEREO:
953 error = acd_setchan(cdp, CHANNEL_0, CHANNEL_1, 0, 0);
954 break;
955
956 case CDIOCSETMUTE:
957 error = acd_setchan(cdp, 0, 0, 0, 0);
958 break;
959
960 case CDIOCSETLEFT:
961 error = acd_setchan(cdp, CHANNEL_0, CHANNEL_0, 0, 0);
962 break;
963
964 case CDIOCSETRIGHT:
965 error = acd_setchan(cdp, CHANNEL_1, CHANNEL_1, 0, 0);
966 break;
967
968 case CDRIOCBLANK:
969 error = acd_blank(cdp, (*(int *)ap->a_data));
970 break;
971
972 case CDRIOCNEXTWRITEABLEADDR:
973 {
974 struct acd_track_info track_info;
975
976 if ((error = acd_read_track_info(cdp, 0xff, &track_info)))
977 break;
978
979 if (!track_info.nwa_valid) {
980 error = EINVAL;
981 break;
982 }
983 *(int*)ap->a_data = track_info.next_writeable_addr;
984 }
985 break;
986
987 case CDRIOCINITWRITER:
988 error = acd_init_writer(cdp, (*(int *)ap->a_data));
989 break;
990
991 case CDRIOCINITTRACK:
992 error = acd_init_track(cdp, (struct cdr_track *)ap->a_data);
993 break;
994
995 case CDRIOCFLUSH:
996 error = acd_flush(cdp);
997 break;
998
999 case CDRIOCFIXATE:
1000 error = acd_fixate(cdp, (*(int *)ap->a_data));
1001 break;
1002
1003 case CDRIOCREADSPEED:
1004 {
1005 int speed = *(int *)ap->a_data;
1006
1007 /* Preserve old behavior: units in multiples of CDROM speed */
1008 if (speed < 177)
1009 speed *= 177;
1010 error = acd_set_speed(cdp, speed, CDR_MAX_SPEED);
1011 }
1012 break;
1013
1014 case CDRIOCWRITESPEED:
1015 {
1016 int speed = *(int *)ap->a_data;
1017
1018 if (speed < 177)
1019 speed *= 177;
1020 error = acd_set_speed(cdp, CDR_MAX_SPEED, speed);
1021 }
1022 break;
1023
1024 case CDRIOCGETBLOCKSIZE:
1025 *(int *)ap->a_data = cdp->block_size;
1026 break;
1027
1028 case CDRIOCSETBLOCKSIZE:
1029 cdp->block_size = *(int *)ap->a_data;
1030 acd_set_ioparm(cdp);
1031 break;
1032
1033 case CDRIOCGETPROGRESS:
1034 error = acd_get_progress(cdp, (int *)ap->a_data);
1035 break;
1036
1037 case CDRIOCSENDCUE:
1038 error = acd_send_cue(cdp, (struct cdr_cuesheet *)ap->a_data);
1039 break;
1040
1041 case DVDIOCREPORTKEY:
1042 if (!cdp->cap.read_dvdrom)
1043 error = EINVAL;
1044 else
1045 error = acd_report_key(cdp, (struct dvd_authinfo *)ap->a_data);
1046 break;
1047
1048 case DVDIOCSENDKEY:
1049 if (!cdp->cap.read_dvdrom)
1050 error = EINVAL;
1051 else
1052 error = acd_send_key(cdp, (struct dvd_authinfo *)ap->a_data);
1053 break;
1054
1055 case DVDIOCREADSTRUCTURE:
1056 if (!cdp->cap.read_dvdrom)
1057 error = EINVAL;
1058 else
1059 error = acd_read_structure(cdp, (struct dvd_struct *)ap->a_data);
1060 break;
1061
1062 default:
1063 error = ENOTTY;
1064 }
1065 return error;
1066 }
1067
1068 static int
1069 acdstrategy(struct dev_strategy_args *ap)
1070 {
1071 cdev_t dev = ap->a_head.a_dev;
1072 struct bio *bio = ap->a_bio;
1073 struct buf *bp = bio->bio_buf;
1074 struct acd_softc *cdp = dev->si_drv1;
1075
1076 if (cdp->device->flags & ATA_D_DETACHING) {
1077 bp->b_flags |= B_ERROR;
1078 bp->b_error = ENXIO;
1079 biodone(bio);
1080 return(0);
1081 }
1082
1083 /* if it's a null transfer, return immediatly. */
1084 if (bp->b_bcount == 0) {
1085 bp->b_resid = 0;
1086 biodone(bio);
1087 return(0);
1088 }
1089
1090 KKASSERT(bio->bio_offset != NOOFFSET);
1091 bio->bio_driver_info = dev;
1092 bp->b_resid = bp->b_bcount;
1093
1094 crit_enter();
1095 bioqdisksort(&cdp->bio_queue, bio);
1096 crit_exit();
1097 ata_start(cdp->device->channel);
1098 return(0);
1099 }
1100
1101 void
1102 acd_start(struct ata_device *atadev)
1103 {
1104 struct acd_softc *cdp = atadev->driver;
1105 struct bio *bio = bioq_first(&cdp->bio_queue);
1106 struct buf *bp;
1107 cdev_t dev;
1108 u_int32_t lba, lastlba, count;
1109 int8_t ccb[16];
1110 int track, blocksize;
1111
1112 if (cdp->changer_info) {
1113 int i;
1114
1115 cdp = cdp->driver[cdp->changer_info->current_slot];
1116 bio = bioq_first(&cdp->bio_queue);
1117
1118 /* check for work pending on any other slot */
1119 for (i = 0; i < cdp->changer_info->slots; i++) {
1120 if (i == cdp->changer_info->current_slot)
1121 continue;
1122 if (bioq_first(&(cdp->driver[i]->bio_queue))) {
1123 if (bio == NULL || time_second > (cdp->timestamp + 10)) {
1124 acd_select_slot(cdp->driver[i]);
1125 return;
1126 }
1127 }
1128 }
1129 }
1130 if (bio == NULL)
1131 return;
1132 bioq_remove(&cdp->bio_queue, bio);
1133 dev = bio->bio_driver_info;
1134 bp = bio->bio_buf;
1135
1136 /* reject all queued entries if media changed */
1137 if (cdp->device->flags & ATA_D_MEDIA_CHANGED) {
1138 bp->b_flags |= B_ERROR;
1139 bp->b_error = EIO;
1140 biodone(bio);
1141 return;
1142 }
1143
1144 /*
1145 * Special track access is via the high 8 bits of bio_offset
1146 * (128-254). The first track is 129. 128 is used for direct
1147 * raw CD device access which bypasses the disk layer entirely
1148 * (so e.g. writes by burncd don't error out in the disk layer).
1149 */
1150 track = (bio->bio_offset >> 56) & 127;
1151
1152 if (track) {
1153 if (track > MAXTRK) {
1154 bp->b_flags |= B_ERROR;
1155 bp->b_error = EIO;
1156 biodone(bio);
1157 return;
1158 }
1159 blocksize = (cdp->toc.tab[track - 1].control & 4) ? 2048 : 2352;
1160 lastlba = ntohl(cdp->toc.tab[track].addr.lba);
1161 lba = (bio->bio_offset & 0x00FFFFFFFFFFFFFFULL) / blocksize;
1162 lba += ntohl(cdp->toc.tab[track - 1].addr.lba);
1163 } else {
1164 blocksize = cdp->block_size;
1165 lastlba = cdp->disk_size;
1166 lba = (bio->bio_offset & 0x00FFFFFFFFFFFFFFULL) / blocksize;
1167 }
1168 bzero(ccb, sizeof(ccb));
1169
1170 if (bp->b_bcount % blocksize != 0) {
1171 bp->b_flags |= B_ERROR;
1172 bp->b_error = EINVAL;
1173 biodone(bio);
1174 return;
1175 }
1176 count = bp->b_bcount / blocksize;
1177
1178 if (bp->b_cmd == BUF_CMD_READ) {
1179 /* if transfer goes beyond range adjust it to be within limits */
1180 if (lba + count > lastlba) {
1181 /* if we are entirely beyond EOM return EOF */
1182 if (lastlba <= lba) {
1183 bp->b_resid = bp->b_bcount;
1184 biodone(bio);
1185 return;
1186 }
1187 count = lastlba - lba;
1188 }
1189 switch (blocksize) {
1190 case 2048:
1191 ccb[0] = ATAPI_READ_BIG;
1192 break;
1193
1194 case 2352:
1195 ccb[0] = ATAPI_READ_CD;
1196 ccb[9] = 0xf8;
1197 break;
1198
1199 default:
1200 ccb[0] = ATAPI_READ_CD;
1201 ccb[9] = 0x10;
1202 }
1203 }
1204 else
1205 ccb[0] = ATAPI_WRITE_BIG;
1206
1207 ccb[1] = 0;
1208 ccb[2] = lba>>24;
1209 ccb[3] = lba>>16;
1210 ccb[4] = lba>>8;
1211 ccb[5] = lba;
1212 ccb[6] = count>>16;
1213 ccb[7] = count>>8;
1214 ccb[8] = count;
1215
1216 devstat_start_transaction(cdp->stats);
1217 bio->bio_caller_info1.ptr = cdp;
1218 atapi_queue_cmd(cdp->device, ccb, bp->b_data, count * blocksize,
1219 ((bp->b_cmd == BUF_CMD_READ) ? ATPR_F_READ : 0),
1220 (ccb[0] == ATAPI_WRITE_BIG) ? 60 : 30, acd_done, bio);
1221 }
1222
1223 static int
1224 acd_done(struct atapi_request *request)
1225 {
1226 struct bio *bio = request->driver;
1227 struct buf *bp = bio->bio_buf;
1228 struct acd_softc *cdp = bio->bio_caller_info1.ptr;
1229
1230 if (request->error) {
1231 bp->b_error = request->error;
1232 bp->b_flags |= B_ERROR;
1233 } else {
1234 bp->b_resid = bp->b_bcount - request->donecount;
1235 }
1236 devstat_end_transaction_buf(cdp->stats, bp);
1237 biodone(bio);
1238 return 0;
1239 }
1240
1241 static void
1242 acd_read_toc(struct acd_softc *cdp)
1243 {
1244 struct acd_devlist *entry;
1245 int track, ntracks, len;
1246 u_int32_t sizes[2];
1247 int8_t ccb[16];
1248
1249 bzero(&cdp->toc, sizeof(cdp->toc));
1250 bzero(ccb, sizeof(ccb));
1251
1252 if (atapi_test_ready(cdp->device) != 0)
1253 return;
1254
1255 cdp->device->flags &= ~ATA_D_MEDIA_CHANGED;
1256
1257 len = sizeof(struct ioc_toc_header) + sizeof(struct cd_toc_entry);
1258 ccb[0] = ATAPI_READ_TOC;
1259 ccb[7] = len>>8;
1260 ccb[8] = len;
1261 if (atapi_queue_cmd(cdp->device, ccb, (caddr_t)&cdp->toc, len,
1262 ATPR_F_READ | ATPR_F_QUIET, 30, NULL, NULL)) {
1263 bzero(&cdp->toc, sizeof(cdp->toc));
1264 return;
1265 }
1266 ntracks = cdp->toc.hdr.ending_track - cdp->toc.hdr.starting_track + 1;
1267 if (ntracks <= 0 || ntracks > MAXTRK) {
1268 bzero(&cdp->toc, sizeof(cdp->toc));
1269 return;
1270 }
1271
1272 len = sizeof(struct ioc_toc_header)+(ntracks+1)*sizeof(struct cd_toc_entry);
1273 bzero(ccb, sizeof(ccb));
1274 ccb[0] = ATAPI_READ_TOC;
1275 ccb[7] = len>>8;
1276 ccb[8] = len;
1277 if (atapi_queue_cmd(cdp->device, ccb, (caddr_t)&cdp->toc, len,
1278 ATPR_F_READ | ATPR_F_QUIET, 30, NULL, NULL)) {
1279 bzero(&cdp->toc, sizeof(cdp->toc));
1280 return;
1281 }
1282 cdp->toc.hdr.len = ntohs(cdp->toc.hdr.len);
1283
1284 cdp->block_size = (cdp->toc.tab[0].control & 4) ? 2048 : 2352;
1285 cdp->disk_size = 0;
1286 bzero(ccb, sizeof(ccb));
1287 ccb[0] = ATAPI_READ_CAPACITY;
1288 if (atapi_queue_cmd(cdp->device, ccb, (caddr_t)sizes, sizeof(sizes),
1289 ATPR_F_READ | ATPR_F_QUIET, 30, NULL, NULL)) {
1290 bzero(&cdp->toc, sizeof(cdp->toc));
1291 acd_set_ioparm(cdp);
1292 return;
1293 }
1294 cdp->disk_size = ntohl(sizes[0]) + 1;
1295 acd_set_ioparm(cdp);
1296
1297 while ((entry = TAILQ_FIRST(&cdp->dev_list))) {
1298 destroy_dev(entry->dev);
1299 TAILQ_REMOVE(&cdp->dev_list, entry, chain);
1300 kfree(entry, M_ACD);
1301 }
1302 for (track = 1; track <= ntracks; track ++) {
1303 char name[16];
1304
1305 ksprintf(name, "acd%dt%d", cdp->lun, track);
1306 entry = kmalloc(sizeof(struct acd_devlist), M_ACD, M_WAITOK | M_ZERO);
1307 entry->dev = make_dev(&acd_ops,
1308 dkmakepart(track + 128) | dkmakeunit(cdp->lun) |
1309 dkmakeslice(WHOLE_DISK_SLICE),
1310 0, 0, 0644, name, NULL);
1311 entry->dev->si_drv1 = cdp->dev->si_drv1;
1312 reference_dev(entry->dev);
1313 TAILQ_INSERT_TAIL(&cdp->dev_list, entry, chain);
1314 }
1315
1316 #ifdef ACD_DEBUG
1317 if (cdp->disk_size && cdp->toc.hdr.ending_track) {
1318 ata_prtdev(cdp->device, "(%d sectors (%d bytes)), %d tracks ",
1319 cdp->disk_size, cdp->block_size,
1320 cdp->toc.hdr.ending_track - cdp->toc.hdr.starting_track + 1);
1321 if (cdp->toc.tab[0].control & 4)
1322 kprintf("%dMB\n", cdp->disk_size / 512);
1323 else
1324 kprintf("%d:%d audio\n",
1325 cdp->disk_size / 75 / 60, cdp->disk_size / 75 % 60);
1326 }
1327 #endif
1328 }
1329
1330 static int
1331 acd_play(struct acd_softc *cdp, int start, int end)
1332 {
1333 int8_t ccb[16];
1334
1335 bzero(ccb, sizeof(ccb));
1336 ccb[0] = ATAPI_PLAY_MSF;
1337 lba2msf(start, &ccb[3], &ccb[4], &ccb[5]);
1338 lba2msf(end, &ccb[6], &ccb[7], &ccb[8]);
1339 return atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 10, NULL, NULL);
1340 }
1341
1342 static int
1343 acd_setchan(struct acd_softc *cdp,
1344 u_int8_t c0, u_int8_t c1, u_int8_t c2, u_int8_t c3)
1345 {
1346 int error;
1347
1348 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_AUDIO_PAGE, (caddr_t)&cdp->au,
1349 sizeof(cdp->au))))
1350 return error;
1351 if (cdp->au.page_code != ATAPI_CDROM_AUDIO_PAGE)
1352 return EIO;
1353 cdp->au.data_length = 0;
1354 cdp->au.port[0].channels = c0;
1355 cdp->au.port[1].channels = c1;
1356 cdp->au.port[2].channels = c2;
1357 cdp->au.port[3].channels = c3;
1358 return acd_mode_select(cdp, (caddr_t)&cdp->au, sizeof(cdp->au));
1359 }
1360
1361 static int
1362 acd_select_done1(struct atapi_request *request)
1363 {
1364 struct acd_softc *cdp = request->driver;
1365
1366 cdp->changer_info->current_slot = cdp->slot;
1367 cdp->driver[cdp->changer_info->current_slot]->timestamp = time_second;
1368 wakeup(&cdp->changer_info);
1369 return 0;
1370 }
1371
1372 static int
1373 acd_select_done(struct atapi_request *request)
1374 {
1375 struct acd_softc *cdp = request->driver;
1376 int8_t ccb[16] = { ATAPI_LOAD_UNLOAD, 0, 0, 0, 3, 0, 0, 0,
1377 cdp->slot, 0, 0, 0, 0, 0, 0, 0 };
1378
1379 /* load the wanted slot */
1380 atapi_queue_cmd(cdp->device, ccb, NULL, 0, ATPR_F_AT_HEAD, 30,
1381 acd_select_done1, cdp);
1382 return 0;
1383 }
1384
1385 static void
1386 acd_select_slot(struct acd_softc *cdp)
1387 {
1388 int8_t ccb[16] = { ATAPI_LOAD_UNLOAD, 0, 0, 0, 2, 0, 0, 0,
1389 cdp->changer_info->current_slot, 0, 0, 0, 0, 0, 0, 0 };
1390
1391 /* unload the current media from player */
1392 atapi_queue_cmd(cdp->device, ccb, NULL, 0, ATPR_F_AT_HEAD, 30,
1393 acd_select_done, cdp);
1394 }
1395
1396 static int
1397 acd_init_writer(struct acd_softc *cdp, int test_write)
1398 {
1399 int8_t ccb[16];
1400
1401 bzero(ccb, sizeof(ccb));
1402 ccb[0] = ATAPI_REZERO;
1403 atapi_queue_cmd(cdp->device, ccb, NULL, 0, ATPR_F_QUIET, 60, NULL, NULL);
1404 ccb[0] = ATAPI_SEND_OPC_INFO;
1405 ccb[1] = 0x01;
1406 atapi_queue_cmd(cdp->device, ccb, NULL, 0, ATPR_F_QUIET, 30, NULL, NULL);
1407 return 0;
1408 }
1409
1410 static int
1411 acd_fixate(struct acd_softc *cdp, int multisession)
1412 {
1413 int8_t ccb[16] = { ATAPI_CLOSE_TRACK, 0x01, 0x02, 0, 0, 0, 0, 0,
1414 0, 0, 0, 0, 0, 0, 0, 0 };
1415 int timeout = 5*60*2;
1416 int error;
1417 struct write_param param;
1418
1419 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_WRITE_PARAMETERS_PAGE,
1420 (caddr_t)&param, sizeof(param))))
1421 return error;
1422
1423 param.data_length = 0;
1424 if (multisession)
1425 param.session_type = CDR_SESS_MULTI;
1426 else
1427 param.session_type = CDR_SESS_NONE;
1428
1429 if ((error = acd_mode_select(cdp, (caddr_t)&param, param.page_length + 10)))
1430 return error;
1431
1432 error = atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 30, NULL, NULL);
1433 if (error)
1434 return error;
1435
1436 /* some drives just return ready, wait for the expected fixate time */
1437 if ((error = atapi_test_ready(cdp->device)) != EBUSY) {
1438 timeout = timeout / (cdp->cap.cur_write_speed / 177);
1439 tsleep(&error, 0, "acdfix", timeout * hz / 2);
1440 return atapi_test_ready(cdp->device);
1441 }
1442
1443 while (timeout-- > 0) {
1444 if ((error = atapi_test_ready(cdp->device)) != EBUSY)
1445 return error;
1446 tsleep(&error, 0, "acdcld", hz/2);
1447 }
1448 return EIO;
1449 }
1450
1451 static int
1452 acd_init_track(struct acd_softc *cdp, struct cdr_track *track)
1453 {
1454 struct write_param param;
1455 int error;
1456
1457 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_WRITE_PARAMETERS_PAGE,
1458 (caddr_t)&param, sizeof(param))))
1459 return error;
1460
1461 param.data_length = 0;
1462 param.page_code = ATAPI_CDROM_WRITE_PARAMETERS_PAGE;
1463 param.page_length = 0x32;
1464 param.test_write = track->test_write ? 1 : 0;
1465 param.write_type = CDR_WTYPE_TRACK;
1466 param.session_type = CDR_SESS_NONE;
1467 param.fp = 0;
1468 param.packet_size = 0;
1469
1470 if (cdp->cap.burnproof)
1471 param.burnproof = 1;
1472
1473 switch (track->datablock_type) {
1474
1475 case CDR_DB_RAW:
1476 if (track->preemp)
1477 param.track_mode = CDR_TMODE_AUDIO_PREEMP;
1478 else
1479 param.track_mode = CDR_TMODE_AUDIO;
1480 cdp->block_size = 2352;
1481 param.datablock_type = CDR_DB_RAW;
1482 param.session_format = CDR_SESS_CDROM;
1483 break;
1484
1485 case CDR_DB_ROM_MODE1:
1486 cdp->block_size = 2048;
1487 param.track_mode = CDR_TMODE_DATA;
1488 param.datablock_type = CDR_DB_ROM_MODE1;
1489 param.session_format = CDR_SESS_CDROM;
1490 break;
1491
1492 case CDR_DB_ROM_MODE2:
1493 cdp->block_size = 2336;
1494 param.track_mode = CDR_TMODE_DATA;
1495 param.datablock_type = CDR_DB_ROM_MODE2;
1496 param.session_format = CDR_SESS_CDROM;
1497 break;
1498
1499 case CDR_DB_XA_MODE1:
1500 cdp->block_size = 2048;
1501 param.track_mode = CDR_TMODE_DATA;
1502 param.datablock_type = CDR_DB_XA_MODE1;
1503 param.session_format = CDR_SESS_CDROM_XA;
1504 break;
1505
1506 case CDR_DB_XA_MODE2_F1:
1507 cdp->block_size = 2056;
1508 param.track_mode = CDR_TMODE_DATA;
1509 param.datablock_type = CDR_DB_XA_MODE2_F1;
1510 param.session_format = CDR_SESS_CDROM_XA;
1511 break;
1512
1513 case CDR_DB_XA_MODE2_F2:
1514 cdp->block_size = 2324;
1515 param.track_mode = CDR_TMODE_DATA;
1516 param.datablock_type = CDR_DB_XA_MODE2_F2;
1517 param.session_format = CDR_SESS_CDROM_XA;
1518 break;
1519
1520 case CDR_DB_XA_MODE2_MIX:
1521 cdp->block_size = 2332;
1522 param.track_mode = CDR_TMODE_DATA;
1523 param.datablock_type = CDR_DB_XA_MODE2_MIX;
1524 param.session_format = CDR_SESS_CDROM_XA;
1525 break;
1526 }
1527 acd_set_ioparm(cdp);
1528 return acd_mode_select(cdp, (caddr_t)&param, param.page_length + 10);
1529 }
1530
1531 static int
1532 acd_flush(struct acd_softc *cdp)
1533 {
1534 int8_t ccb[16] = { ATAPI_SYNCHRONIZE_CACHE, 0, 0, 0, 0, 0, 0, 0,
1535 0, 0, 0, 0, 0, 0, 0, 0 };
1536
1537 return atapi_queue_cmd(cdp->device, ccb, NULL, 0, ATPR_F_QUIET, 60,
1538 NULL, NULL);
1539 }
1540
1541 static int
1542 acd_read_track_info(struct acd_softc *cdp,
1543 int32_t lba, struct acd_track_info *info)
1544 {
1545 int8_t ccb[16] = { ATAPI_READ_TRACK_INFO, 1,
1546 lba>>24, lba>>16, lba>>8, lba,
1547 0,
1548 sizeof(*info)>>8, sizeof(*info),
1549 0, 0, 0, 0, 0, 0, 0 };
1550 int error;
1551
1552 if ((error = atapi_queue_cmd(cdp->device, ccb, (caddr_t)info, sizeof(*info),
1553 ATPR_F_READ, 30, NULL, NULL)))
1554 return error;
1555 info->track_start_addr = ntohl(info->track_start_addr);
1556 info->next_writeable_addr = ntohl(info->next_writeable_addr);
1557 info->free_blocks = ntohl(info->free_blocks);
1558 info->fixed_packet_size = ntohl(info->fixed_packet_size);
1559 info->track_length = ntohl(info->track_length);
1560 return 0;
1561 }
1562
1563 static int
1564 acd_get_progress(struct acd_softc *cdp, int *finished)
1565 {
1566 int8_t ccb[16] = { ATAPI_READ_CAPACITY, 0, 0, 0, 0, 0, 0, 0,
1567 0, 0, 0, 0, 0, 0, 0, 0 };
1568 struct atapi_reqsense *sense = cdp->device->result;
1569 char tmp[8];
1570
1571 if (atapi_test_ready(cdp->device) != EBUSY) {
1572 if (atapi_queue_cmd(cdp->device, ccb, tmp, sizeof(tmp),
1573 ATPR_F_READ, 30, NULL, NULL) != EBUSY) {
1574 *finished = 100;
1575 return 0;
1576 }
1577 }
1578 if (sense->sksv)
1579 *finished =
1580 ((sense->sk_specific2 | (sense->sk_specific1 << 8)) * 100) / 65535;
1581 else
1582 *finished = 0;
1583 return 0;
1584 }
1585
1586 static int
1587 acd_send_cue(struct acd_softc *cdp, struct cdr_cuesheet *cuesheet)
1588 {
1589 struct write_param param;
1590 int8_t ccb[16] = { ATAPI_SEND_CUE_SHEET, 0, 0, 0, 0, 0,
1591 cuesheet->len>>16, cuesheet->len>>8, cuesheet->len,
1592 0, 0, 0, 0, 0, 0, 0 };
1593 int8_t *buffer;
1594 int32_t error;
1595 #ifdef ACD_DEBUG
1596 int i;
1597 #endif
1598
1599 if ((error = acd_mode_sense(cdp, ATAPI_CDROM_WRITE_PARAMETERS_PAGE,
1600 (caddr_t)&param, sizeof(param))))
1601 return error;
1602 param.data_length = 0;
1603 param.page_code = ATAPI_CDROM_WRITE_PARAMETERS_PAGE;
1604 param.page_length = 0x32;
1605 param.test_write = cuesheet->test_write ? 1 : 0;
1606 param.write_type = CDR_WTYPE_SESSION;
1607 param.session_type = cuesheet->session_type;
1608 param.fp = 0;
1609 param.packet_size = 0;
1610 param.track_mode = CDR_TMODE_AUDIO;
1611 param.datablock_type = CDR_DB_RAW;
1612 param.session_format = cuesheet->session_format;
1613 if (cdp->cap.burnproof)
1614 param.burnproof = 1;
1615 if ((error = acd_mode_select(cdp, (caddr_t)&param, param.page_length + 10)))
1616 return error;
1617
1618 buffer = kmalloc(cuesheet->len, M_ACD, M_WAITOK);
1619 if (!buffer)
1620 return ENOMEM;
1621 if ((error = copyin(cuesheet->entries, buffer, cuesheet->len)))
1622 return error;
1623 #ifdef ACD_DEBUG
1624 kprintf("acd: cuesheet lenght = %d\n", cuesheet->len);
1625 for (i=0; i<cuesheet->len; i++)
1626 if (i%8)
1627 kprintf(" %02x", buffer[i]);
1628 else
1629 kprintf("\n%02x", buffer[i]);
1630 kprintf("\n");
1631 #endif
1632 error = atapi_queue_cmd(cdp->device, ccb, buffer, cuesheet->len, 0,
1633 30, NULL, NULL);
1634 kfree(buffer, M_ACD);
1635 return error;
1636 }
1637
1638 static int
1639 acd_report_key(struct acd_softc *cdp, struct dvd_authinfo *ai)
1640 {
1641 struct dvd_miscauth *d;
1642 u_int32_t lba = 0;
1643 int16_t length;
1644 int8_t ccb[16];
1645 int error;
1646
1647 /* this is common even for ai->format == DVD_INVALIDATE_AGID */
1648 bzero(ccb, sizeof(ccb));
1649 ccb[0] = ATAPI_REPORT_KEY;
1650 ccb[2] = (lba >> 24) & 0xff;
1651 ccb[3] = (lba >> 16) & 0xff;
1652 ccb[4] = (lba >> 8) & 0xff;
1653 ccb[5] = lba & 0xff;
1654 ccb[10] = (ai->agid << 6) | ai->format;
1655
1656 switch (ai->format) {
1657 case DVD_REPORT_AGID:
1658 case DVD_REPORT_ASF:
1659 case DVD_REPORT_RPC:
1660 length = 8;
1661 break;
1662 case DVD_REPORT_KEY1:
1663 length = 12;
1664 break;
1665 case DVD_REPORT_TITLE_KEY:
1666 length = 12;
1667 lba = ai->lba;
1668 break;
1669 case DVD_REPORT_CHALLENGE:
1670 length = 16;
1671 break;
1672 case DVD_INVALIDATE_AGID:
1673 return(atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 10, NULL, NULL));
1674 default:
1675 return EINVAL;
1676 }
1677
1678 ccb[8] = (length >> 8) & 0xff;
1679 ccb[9] = length & 0xff;
1680
1681 d = kmalloc(length, M_ACD, M_WAITOK | M_ZERO);
1682 d->length = htons(length - 2);
1683
1684 error = atapi_queue_cmd(cdp->device, ccb, (caddr_t)d, length,
1685 ATPR_F_READ, 10, NULL, NULL);
1686 if (error) {
1687 kfree(d, M_ACD);
1688 return(error);
1689 }
1690
1691 switch (ai->format) {
1692 case DVD_REPORT_AGID:
1693 ai->agid = d->data[3] >> 6;
1694 break;
1695
1696 case DVD_REPORT_CHALLENGE:
1697 bcopy(&d->data[0], &ai->keychal[0], 10);
1698 break;
1699
1700 case DVD_REPORT_KEY1:
1701 bcopy(&d->data[0], &ai->keychal[0], 5);
1702 break;
1703
1704 case DVD_REPORT_TITLE_KEY:
1705 ai->cpm = (d->data[0] >> 7);
1706 ai->cp_sec = (d->data[0] >> 6) & 0x1;
1707 ai->cgms = (d->data[0] >> 4) & 0x3;
1708 bcopy(&d->data[1], &ai->keychal[0], 5);
1709 break;
1710
1711 case DVD_REPORT_ASF:
1712 ai->asf = d->data[3] & 1;
1713 break;
1714
1715 case DVD_REPORT_RPC:
1716 ai->reg_type = (d->data[0] >> 6);
1717 ai->vend_rsts = (d->data[0] >> 3) & 0x7;
1718 ai->user_rsts = d->data[0] & 0x7;
1719 ai->region = d->data[1];
1720 ai->rpc_scheme = d->data[2];
1721 break;
1722
1723 case DVD_INVALIDATE_AGID:
1724 /* not reached */
1725 break;
1726
1727 default:
1728 error = EINVAL;
1729 }
1730 kfree(d, M_ACD);
1731 return error;
1732 }
1733
1734 static int
1735 acd_send_key(struct acd_softc *cdp, struct dvd_authinfo *ai)
1736 {
1737 struct dvd_miscauth *d;
1738 int16_t length;
1739 int8_t ccb[16];
1740 int error;
1741
1742 switch (ai->format) {
1743 case DVD_SEND_CHALLENGE:
1744 length = 16;
1745 d = kmalloc(length, M_ACD, M_WAITOK | M_ZERO);
1746 bcopy(ai->keychal, &d->data[0], 10);
1747 break;
1748
1749 case DVD_SEND_KEY2:
1750 length = 12;
1751 d = kmalloc(length, M_ACD, M_WAITOK | M_ZERO);
1752 bcopy(&ai->keychal[0], &d->data[0], 5);
1753 break;
1754
1755 case DVD_SEND_RPC:
1756 length = 8;
1757 d = kmalloc(length, M_ACD, M_WAITOK | M_ZERO);
1758 d->data[0] = ai->region;
1759 break;
1760
1761 default:
1762 return EINVAL;
1763 }
1764
1765 bzero(ccb, sizeof(ccb));
1766 ccb[0] = ATAPI_SEND_KEY;
1767 ccb[8] = (length >> 8) & 0xff;
1768 ccb[9] = length & 0xff;
1769 ccb[10] = (ai->agid << 6) | ai->format;
1770 d->length = htons(length - 2);
1771 error = atapi_queue_cmd(cdp->device, ccb, (caddr_t)d, length, 0,
1772 10, NULL, NULL);
1773 kfree(d, M_ACD);
1774 return error;
1775 }
1776
1777 static int
1778 acd_read_structure(struct acd_softc *cdp, struct dvd_struct *s)
1779 {
1780 struct dvd_miscauth *d;
1781 u_int16_t length;
1782 int8_t ccb[16];
1783 int error = 0;
1784
1785 switch(s->format) {
1786 case DVD_STRUCT_PHYSICAL:
1787 length = 21;
1788 break;
1789
1790 case DVD_STRUCT_COPYRIGHT:
1791 length = 8;
1792 break;
1793
1794 case DVD_STRUCT_DISCKEY:
1795 length = 2052;
1796 break;
1797
1798 case DVD_STRUCT_BCA:
1799 length = 192;
1800 break;
1801
1802 case DVD_STRUCT_MANUFACT:
1803 length = 2052;
1804 break;
1805
1806 case DVD_STRUCT_DDS:
1807 case DVD_STRUCT_PRERECORDED:
1808 case DVD_STRUCT_UNIQUEID:
1809 case DVD_STRUCT_LIST:
1810 case DVD_STRUCT_CMI:
1811 case DVD_STRUCT_RMD_LAST:
1812 case DVD_STRUCT_RMD_RMA:
1813 case DVD_STRUCT_DCB:
1814 return ENOSYS;
1815
1816 default:
1817 return EINVAL;
1818 }
1819
1820 d = kmalloc(length, M_ACD, M_WAITOK | M_ZERO);
1821 d->length = htons(length - 2);
1822
1823 bzero(ccb, sizeof(ccb));
1824 ccb[0] = ATAPI_READ_STRUCTURE;
1825 ccb[6] = s->layer_num;
1826 ccb[7] = s->format;
1827 ccb[8] = (length >> 8) & 0xff;
1828 ccb[9] = length & 0xff;
1829 ccb[10] = s->agid << 6;
1830 error = atapi_queue_cmd(cdp->device, ccb, (caddr_t)d, length, ATPR_F_READ,
1831 30, NULL, NULL);
1832 if (error) {
1833 kfree(d, M_ACD);
1834 return error;
1835 }
1836
1837 switch (s->format) {
1838 case DVD_STRUCT_PHYSICAL: {
1839 struct dvd_layer *layer = (struct dvd_layer *)&s->data[0];
1840
1841 layer->book_type = d->data[0] >> 4;
1842 layer->book_version = d->data[0] & 0xf;
1843 layer->disc_size = d->data[1] >> 4;
1844 layer->max_rate = d->data[1] & 0xf;
1845 layer->nlayers = (d->data[2] >> 5) & 3;
1846 layer->track_path = (d->data[2] >> 4) & 1;
1847 layer->layer_type = d->data[2] & 0xf;
1848 layer->linear_density = d->data[3] >> 4;
1849 layer->track_density = d->data[3] & 0xf;
1850 layer->start_sector = d->data[5] << 16 | d->data[6] << 8 | d->data[7];
1851 layer->end_sector = d->data[9] << 16 | d->data[10] << 8 | d->data[11];
1852 layer->end_sector_l0 = d->data[13] << 16 | d->data[14] << 8|d->data[15];
1853 layer->bca = d->data[16] >> 7;
1854 break;
1855 }
1856
1857 case DVD_STRUCT_COPYRIGHT:
1858 s->cpst = d->data[0];
1859 s->rmi = d->data[0];
1860 break;
1861
1862 case DVD_STRUCT_DISCKEY:
1863 bcopy(&d->data[0], &s->data[0], 2048);
1864 break;
1865
1866 case DVD_STRUCT_BCA:
1867 s->length = ntohs(d->length);
1868 bcopy(&d->data[0], &s->data[0], s->length);
1869 break;
1870
1871 case DVD_STRUCT_MANUFACT:
1872 s->length = ntohs(d->length);
1873 bcopy(&d->data[0], &s->data[0], s->length);
1874 break;
1875
1876 default:
1877 error = EINVAL;
1878 }
1879 kfree(d, M_ACD);
1880 return error;
1881 }
1882
1883 static int
1884 acd_eject(struct acd_softc *cdp, int close)
1885 {
1886 int error;
1887
1888 if ((error = acd_start_stop(cdp, 0)) == EBUSY) {
1889 if (!close)
1890 return 0;
1891 if ((error = acd_start_stop(cdp, 3)))
1892 return error;
1893 acd_read_toc(cdp);
1894 acd_prevent_allow(cdp, 1);
1895 cdp->flags |= F_LOCKED;
1896 return 0;
1897 }
1898 if (error)
1899 return error;
1900 if (close)
1901 return 0;
1902 acd_prevent_allow(cdp, 0);
1903 cdp->flags &= ~F_LOCKED;
1904 cdp->device->flags |= ATA_D_MEDIA_CHANGED;
1905 return acd_start_stop(cdp, 2);
1906 }
1907
1908 static int
1909 acd_blank(struct acd_softc *cdp, int blanktype)
1910 {
1911 int8_t ccb[16] = { ATAPI_BLANK, 0x10 | (blanktype & 0x7), 0, 0, 0, 0, 0, 0,
1912 0, 0, 0, 0, 0, 0, 0, 0 };
1913
1914 cdp->device->flags |= ATA_D_MEDIA_CHANGED;
1915 return atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 30, NULL, NULL);
1916 }
1917
1918 static int
1919 acd_prevent_allow(struct acd_softc *cdp, int lock)
1920 {
1921 int8_t ccb[16] = { ATAPI_PREVENT_ALLOW, 0, 0, 0, lock,
1922 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1923
1924 return atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 30, NULL, NULL);
1925 }
1926
1927 static int
1928 acd_start_stop(struct acd_softc *cdp, int start)
1929 {
1930 int8_t ccb[16] = { ATAPI_START_STOP, 0, 0, 0, start,
1931 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1932
1933 return atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 30, NULL, NULL);
1934 }
1935
1936 static int
1937 acd_pause_resume(struct acd_softc *cdp, int pause)
1938 {
1939 int8_t ccb[16] = { ATAPI_PAUSE, 0, 0, 0, 0, 0, 0, 0, pause,
1940 0, 0, 0, 0, 0, 0, 0 };
1941
1942 return atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 30, NULL, NULL);
1943 }
1944
1945 static int
1946 acd_mode_sense(struct acd_softc *cdp, int page, caddr_t pagebuf, int pagesize)
1947 {
1948 int8_t ccb[16] = { ATAPI_MODE_SENSE_BIG, 0, page, 0, 0, 0, 0,
1949 pagesize>>8, pagesize, 0, 0, 0, 0, 0, 0, 0 };
1950 int error;
1951
1952 error = atapi_queue_cmd(cdp->device, ccb, pagebuf, pagesize, ATPR_F_READ,
1953 10, NULL, NULL);
1954 #ifdef ACD_DEBUG
1955 atapi_dump("acd: mode sense ", pagebuf, pagesize);
1956 #endif
1957 return error;
1958 }
1959
1960 static int
1961 acd_mode_select(struct acd_softc *cdp, caddr_t pagebuf, int pagesize)
1962 {
1963 int8_t ccb[16] = { ATAPI_MODE_SELECT_BIG, 0x10, 0, 0, 0, 0, 0,
1964 pagesize>>8, pagesize, 0, 0, 0, 0, 0, 0, 0 };
1965
1966 #ifdef ACD_DEBUG
1967 ata_prtdev(cdp->device,
1968 "modeselect pagesize=%d\n", pagesize);
1969 atapi_dump("mode select ", pagebuf, pagesize);
1970 #endif
1971 return atapi_queue_cmd(cdp->device, ccb, pagebuf, pagesize, 0,
1972 30, NULL, NULL);
1973 }
1974
1975 static int
1976 acd_set_speed(struct acd_softc *cdp, int rdspeed, int wrspeed)
1977 {
1978 int8_t ccb[16] = { ATAPI_SET_SPEED, 0, rdspeed >> 8, rdspeed,
1979 wrspeed >> 8, wrspeed, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1980 int error;
1981
1982 error = atapi_queue_cmd(cdp->device, ccb, NULL, 0, 0, 30, NULL, NULL);
1983 if (!error)
1984 acd_get_cap(cdp);
1985 return error;
1986 }
1987
1988 static void
1989 acd_get_cap(struct acd_softc *cdp)
1990 {
1991 int retry = 5;
1992
1993 /* get drive capabilities, some drives needs this repeated */
1994 while (retry-- && acd_mode_sense(cdp, ATAPI_CDROM_CAP_PAGE,
1995 (caddr_t)&cdp->cap, sizeof(cdp->cap)))
1996
1997 cdp->cap.max_read_speed = ntohs(cdp->cap.max_read_speed);
1998 cdp->cap.cur_read_speed = ntohs(cdp->cap.cur_read_speed);
1999 cdp->cap.max_write_speed = ntohs(cdp->cap.max_write_speed);
2000 cdp->cap.cur_write_speed = max(ntohs(cdp->cap.cur_write_speed), 177);
2001 cdp->cap.max_vol_levels = ntohs(cdp->cap.max_vol_levels);
2002 cdp->cap.buf_size = ntohs(cdp->cap.buf_size);
2003 }
A repo for keeping AMD64 port code before merging with the master