Merge from vendor branch CVS:
[dragonfly.git] / sys / dev / disk / mcd / mcd.c
1 /*
2  * Copyright 1993 by Holger Veit (data part)
3  * Copyright 1993 by Brian Moore (audio part)
4  * Changes Copyright 1993 by Gary Clark II
5  * Changes Copyright (C) 1994-1995 by Andrey A. Chernov, Moscow, Russia
6  *
7  * Rewrote probe routine to work on newer Mitsumi drives.
8  * Additional changes (C) 1994 by Jordan K. Hubbard
9  *
10  * All rights reserved.
11  *
12  * Redistribution and use in source and binary forms, with or without
13  * modification, are permitted provided that the following conditions
14  * are met:
15  * 1. Redistributions of source code must retain the above copyright
16  *    notice, this list of conditions and the following disclaimer.
17  * 2. Redistributions in binary form must reproduce the above copyright
18  *    notice, this list of conditions and the following disclaimer in the
19  *    documentation and/or other materials provided with the distribution.
20  * 3. All advertising materials mentioning features or use of this software
21  *    must display the following acknowledgement:
22  *      This software was developed by Holger Veit and Brian Moore
23  *      for use with "386BSD" and similar operating systems.
24  *    "Similar operating systems" includes mainly non-profit oriented
25  *    systems for research and education, including but not restricted to
26  *    "NetBSD", "FreeBSD", "Mach" (by CMU).
27  * 4. Neither the name of the developer(s) nor the name "386BSD"
28  *    may be used to endorse or promote products derived from this
29  *    software without specific prior written permission.
30  *
31  * THIS SOFTWARE IS PROVIDED BY THE DEVELOPER(S) ``AS IS'' AND ANY
32  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
33  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
34  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE DEVELOPER(S) BE
35  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
36  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
37  * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
38  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
39  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
40  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
41  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
42  *
43  * $FreeBSD: src/sys/i386/isa/mcd.c,v 1.115 2000/01/29 16:17:34 peter Exp $
44  * $DragonFly: src/sys/dev/disk/mcd/Attic/mcd.c,v 1.11 2004/09/19 01:37:13 dillon Exp $
45  */
46 static const char COPYRIGHT[] = "mcd-driver (C)1993 by H.Veit & B.Moore";
47
48 #include "use_mcd.h"
49
50 #include <sys/param.h>
51 #include <sys/systm.h>
52 #include <sys/bootmaj.h>
53 #include <sys/conf.h>
54 #include <sys/fcntl.h>
55 #include <sys/buf.h>
56 #include <sys/cdio.h>
57 #include <sys/disklabel.h>
58 #include <sys/kernel.h>
59 #include <sys/buf2.h>
60 #include <machine/clock.h>
61
62 #include <bus/isa/i386/isa_device.h>
63 #include "mcdreg.h"
64
65 #define MCD_TRACE(format, args...)                                              \
66 {                                                                       \
67         if (mcd_data[unit].debug) {                                     \
68                 printf("mcd%d: status=0x%02x: ",                        \
69                         unit, mcd_data[unit].status);                   \
70                 printf(format, ## args);                                \
71         }                                                               \
72 }
73
74 #define mcd_part(dev)   ((minor(dev)) & 7)
75 #define mcd_unit(dev)   (((minor(dev)) & 0x38) >> 3)
76 #define mcd_phys(dev)   (((minor(dev)) & 0x40) >> 6)
77 #define RAW_PART        2
78
79 /* flags */
80 #define MCDVALID        0x0001  /* parameters loaded */
81 #define MCDINIT         0x0002  /* device is init'd */
82 #define MCDNEWMODEL     0x0004  /* device is new model */
83 #define MCDLABEL        0x0008  /* label is read */
84 #define MCDPROBING      0x0010  /* probing */
85 #define MCDREADRAW      0x0020  /* read raw mode (2352 bytes) */
86 #define MCDVOLINFO      0x0040  /* already read volinfo */
87 #define MCDTOC          0x0080  /* already read toc */
88 #define MCDMBXBSY       0x0100  /* local mbx is busy */
89
90 /* status */
91 #define MCDAUDIOBSY     MCD_ST_AUDIOBSY         /* playing audio */
92 #define MCDDSKCHNG      MCD_ST_DSKCHNG          /* sensed change of disk */
93 #define MCDDSKIN        MCD_ST_DSKIN            /* sensed disk in drive */
94 #define MCDDOOROPEN     MCD_ST_DOOROPEN         /* sensed door open */
95
96 /* These are apparently the different states a mitsumi can get up to */
97 #define MCDCDABSENT     0x0030
98 #define MCDCDPRESENT    0x0020
99 #define MCDSCLOSED      0x0080
100 #define MCDSOPEN        0x00a0
101
102 #define MCD_MD_UNKNOWN  (-1)
103
104 /* toc */
105 #define MCD_MAXTOCS     104     /* from the Linux driver */
106 #define MCD_LASTPLUS1   170     /* special toc entry */
107
108 #define MCD_TYPE_UNKNOWN        0
109 #define MCD_TYPE_LU002S         1
110 #define MCD_TYPE_LU005S         2
111 #define MCD_TYPE_LU006S         3
112 #define MCD_TYPE_FX001          4
113 #define MCD_TYPE_FX001D         5
114
115 struct mcd_mbx {
116         short           unit;
117         short           port;
118         short           retry;
119         short           nblk;
120         int             sz;
121         u_long          skip;
122         struct buf      *bp;
123         int             p_offset;
124         short           count;
125         short           mode;
126 };
127
128 static struct mcd_data {
129         short   type;
130         char    *name;
131         short   config;
132         short   flags;
133         u_char  read_command;
134         short   status;
135         int     blksize;
136         u_long  disksize;
137         int     iobase;
138         struct disklabel dlabel;
139         int     partflags[MAXPARTITIONS];
140         int     openflags;
141         struct mcd_volinfo volinfo;
142         struct mcd_qchninfo toc[MCD_MAXTOCS];
143         short   audio_status;
144         short   curr_mode;
145         struct mcd_read2 lastpb;
146         short   debug;
147         struct buf_queue_head head;             /* head of buf queue */
148         struct mcd_mbx mbx;
149         struct callout callout;
150 } mcd_data[NMCD];
151
152 /* reader state machine */
153 #define MCD_S_BEGIN     0
154 #define MCD_S_BEGIN1    1
155 #define MCD_S_WAITSTAT  2
156 #define MCD_S_WAITMODE  3
157 #define MCD_S_WAITREAD  4
158
159 /* prototypes */
160 static  void    mcd_start(int unit);
161 static  int     mcd_getdisklabel(int unit);
162 #ifdef NOTYET
163 static  void    mcd_configure(struct mcd_data *cd);
164 #endif
165 static  int     mcd_get(int unit, char *buf, int nmax);
166 static  int     mcd_setflags(int unit,struct mcd_data *cd);
167 static  int     mcd_getstat(int unit,int sflg);
168 static  int     mcd_send(int unit, int cmd,int nretrys);
169 static  void    hsg2msf(int hsg, bcd_t *msf);
170 static  int     msf2hsg(bcd_t *msf, int relative);
171 static  int     mcd_volinfo(int unit);
172 static  ointhand2_t     mcdintr;
173 static  int     mcd_waitrdy(int port,int dly);
174 static  timeout_t mcd_timeout;
175 static  void    mcd_doread(int state, struct mcd_mbx *mbxin);
176 static  void    mcd_soft_reset(int unit);
177 static  int     mcd_hard_reset(int unit);
178 static  int     mcd_setmode(int unit, int mode);
179 static  int     mcd_getqchan(int unit, struct mcd_qchninfo *q);
180 static  int     mcd_subchan(int unit, struct ioc_read_subchannel *sc);
181 static  int     mcd_toc_header(int unit, struct ioc_toc_header *th);
182 static  int     mcd_read_toc(int unit);
183 static  int     mcd_toc_entrys(int unit, struct ioc_read_toc_entry *te);
184 #if 0
185 static  int     mcd_toc_entry(int unit, struct ioc_read_toc_single_entry *te);
186 #endif
187 static  int     mcd_stop(int unit);
188 static  int     mcd_eject(int unit);
189 static  int     mcd_inject(int unit);
190 static  int     mcd_playtracks(int unit, struct ioc_play_track *pt);
191 static  int     mcd_play(int unit, struct mcd_read2 *pb);
192 static  int     mcd_playmsf(int unit, struct ioc_play_msf *pt);
193 static  int     mcd_playblocks(int unit, struct ioc_play_blocks *);
194 static  int     mcd_pause(int unit);
195 static  int     mcd_resume(int unit);
196 static  int     mcd_lock_door(int unit, int lock);
197 static  int     mcd_close_tray(int unit);
198
199 static  int     mcd_probe(struct isa_device *dev);
200 static  int     mcd_attach(struct isa_device *dev);
201 struct  isa_driver      mcddriver = { mcd_probe, mcd_attach, "mcd" };
202
203 static  d_open_t        mcdopen;
204 static  d_close_t       mcdclose;
205 static  d_ioctl_t       mcdioctl;
206 static  d_psize_t       mcdsize;
207 static  d_strategy_t    mcdstrategy;
208
209 static struct cdevsw mcd_cdevsw = {
210         /* name */      "mcd",
211         /* maj */       MCD_CDEV_MAJOR,
212         /* flags */     D_DISK,
213         /* port */      NULL,
214         /* clone */     NULL,
215
216         /* open */      mcdopen,
217         /* close */     mcdclose,
218         /* read */      physread,
219         /* write */     nowrite,
220         /* ioctl */     mcdioctl,
221         /* poll */      nopoll,
222         /* mmap */      nommap,
223         /* strategy */  mcdstrategy,
224         /* dump */      nodump,
225         /* psize */     nopsize
226 };
227
228 #define mcd_put(port,byte)      outb(port,byte)
229
230 #define MCD_RETRYS      5
231 #define MCD_RDRETRYS    8
232
233 #define CLOSE_TRAY_SECS 8
234 #define DISK_SENSE_SECS 3
235 #define WAIT_FRAC 4
236
237 /* several delays */
238 #define RDELAY_WAITSTAT 300
239 #define RDELAY_WAITMODE 300
240 #define RDELAY_WAITREAD 800
241
242 #define MIN_DELAY       15
243 #define DELAY_GETREPLY  5000000
244
245 int mcd_attach(struct isa_device *dev)
246 {
247         int     unit = dev->id_unit;
248         struct mcd_data *cd = mcd_data + unit;
249
250         dev->id_ointr = mcdintr;
251         cd->iobase = dev->id_iobase;
252         cd->flags |= MCDINIT;
253         callout_init(&cd->callout);
254         mcd_soft_reset(unit);
255         bufq_init(&cd->head);
256
257 #ifdef NOTYET
258         /* wire controller for interrupts and dma */
259         mcd_configure(cd);
260 #endif
261         /* name filled in probe */
262         cdevsw_add(&mcd_cdevsw, dkunitmask(), dkmakeunit(unit));
263         make_dev(&mcd_cdevsw, dkmakeminor(unit, 0, 0),
264             UID_ROOT, GID_OPERATOR, 0640, "rmcd%da", unit);
265         make_dev(&mcd_cdevsw, dkmakeminor(unit, 0, RAW_PART),
266             UID_ROOT, GID_OPERATOR, 0640, "rmcd%dc", unit);
267         make_dev(&mcd_cdevsw, dkmakeminor(unit, 0, 0),
268             UID_ROOT, GID_OPERATOR, 0640, "mcd%da", unit);
269         make_dev(&mcd_cdevsw, dkmakeminor(unit, 0, RAW_PART),
270             UID_ROOT, GID_OPERATOR, 0640, "mcd%dc", unit);
271         return 1;
272 }
273
274 int mcdopen(dev_t dev, int flags, int fmt, struct thread *td)
275 {
276         int unit,part,phys,r,retry;
277         struct mcd_data *cd;
278
279         unit = mcd_unit(dev);
280         if (unit >= NMCD)
281                 return ENXIO;
282
283         cd = mcd_data + unit;
284         part = mcd_part(dev);
285         phys = mcd_phys(dev);
286
287         /* not initialized*/
288         if (!(cd->flags & MCDINIT))
289                 return ENXIO;
290
291         /* invalidated in the meantime? mark all open part's invalid */
292         if (!(cd->flags & MCDVALID) && cd->openflags)
293                 return ENXIO;
294
295         if (mcd_getstat(unit,1) == -1)
296                 return EIO;
297
298         if (    (cd->status & (MCDDSKCHNG|MCDDOOROPEN))
299             || !(cd->status & MCDDSKIN))
300                 for (retry = 0; retry < DISK_SENSE_SECS * WAIT_FRAC; retry++) {
301                         (void) tsleep((caddr_t)cd, PCATCH, "mcdsn1", hz/WAIT_FRAC);
302                         if ((r = mcd_getstat(unit,1)) == -1)
303                                 return EIO;
304                         if (r != -2)
305                                 break;
306                 }
307
308         if ((   (cd->status & (MCDDOOROPEN|MCDDSKCHNG))
309              || !(cd->status & MCDDSKIN)
310             )
311             && major(dev) == MCD_CDEV_MAJOR && part == RAW_PART
312            ) {
313                 cd->openflags |= (1<<part);
314                 if (phys)
315                         cd->partflags[part] |= MCDREADRAW;
316                 return 0;
317         }
318         if (cd->status & MCDDOOROPEN) {
319                 printf("mcd%d: door is open\n", unit);
320                 return ENXIO;
321         }
322         if (!(cd->status & MCDDSKIN)) {
323                 printf("mcd%d: no CD inside\n", unit);
324                 return ENXIO;
325         }
326         if (cd->status & MCDDSKCHNG) {
327                 printf("mcd%d: CD not sensed\n", unit);
328                 return ENXIO;
329         }
330
331         if (mcdsize(dev) < 0) {
332                 if (major(dev) == MCD_CDEV_MAJOR && part == RAW_PART) {
333                         cd->openflags |= (1<<part);
334                         if (phys)
335                                 cd->partflags[part] |= MCDREADRAW;
336                         return 0;
337                 }
338                 printf("mcd%d: failed to get disk size\n",unit);
339                 return ENXIO;
340         } else
341                 cd->flags |= MCDVALID;
342
343         /* XXX get a default disklabel */
344         mcd_getdisklabel(unit);
345
346 MCD_TRACE("open: partition=%d, disksize = %ld, blksize=%d\n",
347         part, cd->disksize, cd->blksize);
348
349         dev->si_bsize_phys = cd->blksize;
350
351         if (part == RAW_PART ||
352                 (part < cd->dlabel.d_npartitions &&
353                 cd->dlabel.d_partitions[part].p_fstype != FS_UNUSED)) {
354                 cd->openflags |= (1<<part);
355                 if (part == RAW_PART && phys)
356                         cd->partflags[part] |= MCDREADRAW;
357                 (void) mcd_lock_door(unit, MCD_LK_LOCK);
358                 if (!(cd->flags & MCDVALID))
359                         return ENXIO;
360                 return 0;
361         }
362
363         return ENXIO;
364 }
365
366 int mcdclose(dev_t dev, int flags, int fmt, struct thread *td)
367 {
368         int unit,part;
369         struct mcd_data *cd;
370
371         unit = mcd_unit(dev);
372         if (unit >= NMCD)
373                 return ENXIO;
374
375         cd = mcd_data + unit;
376         part = mcd_part(dev);
377
378         if (!(cd->flags & MCDINIT) || !(cd->openflags & (1<<part)))
379                 return ENXIO;
380
381         MCD_TRACE("close: partition=%d\n", part);
382
383         (void) mcd_lock_door(unit, MCD_LK_UNLOCK);
384         cd->openflags &= ~(1<<part);
385         cd->partflags[part] &= ~MCDREADRAW;
386
387         return 0;
388 }
389
390 void
391 mcdstrategy(struct buf *bp)
392 {
393         struct mcd_data *cd;
394         int s;
395
396         int unit = mcd_unit(bp->b_dev);
397
398         cd = mcd_data + unit;
399
400         /* test validity */
401 /*MCD_TRACE("strategy: buf=0x%lx, unit=%ld, block#=%ld bcount=%ld\n",
402         bp,unit,bp->b_blkno,bp->b_bcount);*/
403         if (unit >= NMCD || bp->b_blkno < 0) {
404                 printf("mcdstrategy: unit = %d, blkno = %ld, bcount = %ld\n",
405                         unit, (long)bp->b_blkno, bp->b_bcount);
406                 printf("mcd: mcdstratregy failure");
407                 bp->b_error = EINVAL;
408                 bp->b_flags |= B_ERROR;
409                 goto bad;
410         }
411
412         /* if device invalidated (e.g. media change, door open), error */
413         if (!(cd->flags & MCDVALID)) {
414 MCD_TRACE("strategy: drive not valid\n");
415                 bp->b_error = EIO;
416                 goto bad;
417         }
418
419         /* read only */
420         if (!(bp->b_flags & B_READ)) {
421                 bp->b_error = EROFS;
422                 goto bad;
423         }
424
425         /* no data to read */
426         if (bp->b_bcount == 0)
427                 goto done;
428
429         /* for non raw access, check partition limits */
430         if (mcd_part(bp->b_dev) != RAW_PART) {
431                 if (!(cd->flags & MCDLABEL)) {
432                         bp->b_error = EIO;
433                         goto bad;
434                 }
435                 /* adjust transfer if necessary */
436                 if (bounds_check_with_label(bp,&cd->dlabel,1) <= 0) {
437                         goto done;
438                 }
439         } else {
440                 bp->b_pblkno = bp->b_blkno;
441                 bp->b_resid = 0;
442         }
443
444         /* queue it */
445         s = splbio();
446         bufqdisksort(&cd->head, bp);
447         splx(s);
448
449         /* now check whether we can perform processing */
450         mcd_start(unit);
451         return;
452
453 bad:
454         bp->b_flags |= B_ERROR;
455 done:
456         bp->b_resid = bp->b_bcount;
457         biodone(bp);
458         return;
459 }
460
461 static void mcd_start(int unit)
462 {
463         struct mcd_data *cd = mcd_data + unit;
464         struct partition *p;
465         struct buf *bp;
466         int s = splbio();
467
468         if (cd->flags & MCDMBXBSY) {
469                 splx(s);
470                 return;
471         }
472
473         bp = bufq_first(&cd->head);
474         if (bp != 0) {
475                 /* block found to process, dequeue */
476                 /*MCD_TRACE("mcd_start: found block bp=0x%x\n",bp,0,0,0);*/
477                 bufq_remove(&cd->head, bp);
478                 splx(s);
479         } else {
480                 /* nothing to do */
481                 splx(s);
482                 return;
483         }
484
485         /* changed media? */
486         if (!(cd->flags & MCDVALID)) {
487                 MCD_TRACE("mcd_start: drive not valid\n");
488                 return;
489         }
490
491         p = cd->dlabel.d_partitions + mcd_part(bp->b_dev);
492
493         cd->flags |= MCDMBXBSY;
494         if (cd->partflags[mcd_part(bp->b_dev)] & MCDREADRAW)
495                 cd->flags |= MCDREADRAW;
496         cd->mbx.unit = unit;
497         cd->mbx.port = cd->iobase;
498         cd->mbx.retry = MCD_RETRYS;
499         cd->mbx.bp = bp;
500         cd->mbx.p_offset = p->p_offset;
501
502         /* calling the read routine */
503         mcd_doread(MCD_S_BEGIN,&(cd->mbx));
504         /* triggers mcd_start, when successful finished */
505         return;
506 }
507
508 int mcdioctl(dev_t dev, u_long cmd, caddr_t addr, int flags, struct thread *td)
509 {
510         struct mcd_data *cd;
511         int unit,part,retry,r;
512
513         unit = mcd_unit(dev);
514         part = mcd_part(dev);
515         cd = mcd_data + unit;
516
517         if (mcd_getstat(unit, 1) == -1) /* detect disk change too */
518                 return EIO;
519 MCD_TRACE("ioctl called 0x%lx\n", cmd);
520
521         switch (cmd) {
522         case CDIOCSETPATCH:
523         case CDIOCGETVOL:
524         case CDIOCSETVOL:
525         case CDIOCSETMONO:
526         case CDIOCSETSTERIO:
527         case CDIOCSETMUTE:
528         case CDIOCSETLEFT:
529         case CDIOCSETRIGHT:
530                 return EINVAL;
531         case CDIOCEJECT:
532                 return mcd_eject(unit);
533         case CDIOCSETDEBUG:
534                 cd->debug = 1;
535                 return 0;
536         case CDIOCCLRDEBUG:
537                 cd->debug = 0;
538                 return 0;
539         case CDIOCRESET:
540                 return mcd_hard_reset(unit);
541         case CDIOCALLOW:
542                 return mcd_lock_door(unit, MCD_LK_UNLOCK);
543         case CDIOCPREVENT:
544                 return mcd_lock_door(unit, MCD_LK_LOCK);
545         case CDIOCCLOSE:
546                 return mcd_inject(unit);
547         }
548
549         if (!(cd->flags & MCDVALID)) {
550                 if (   major(dev) != MCD_CDEV_MAJOR
551                     || part != RAW_PART
552                     || !(cd->openflags & (1<<RAW_PART))
553                    )
554                         return ENXIO;
555                 if (    (cd->status & (MCDDSKCHNG|MCDDOOROPEN))
556                     || !(cd->status & MCDDSKIN))
557                         for (retry = 0; retry < DISK_SENSE_SECS * WAIT_FRAC; retry++) {
558                                 (void) tsleep((caddr_t)cd, PCATCH, "mcdsn2", hz/WAIT_FRAC);
559                                 if ((r = mcd_getstat(unit,1)) == -1)
560                                         return EIO;
561                                 if (r != -2)
562                                         break;
563                         }
564                 if (   (cd->status & (MCDDOOROPEN|MCDDSKCHNG))
565                     || !(cd->status & MCDDSKIN)
566                     || mcdsize(dev) < 0
567                    )
568                         return ENXIO;
569                 cd->flags |= MCDVALID;
570                 mcd_getdisklabel(unit);
571                 if (mcd_phys(dev))
572                         cd->partflags[part] |= MCDREADRAW;
573                 (void) mcd_lock_door(unit, MCD_LK_LOCK);
574                 if (!(cd->flags & MCDVALID))
575                         return ENXIO;
576         }
577
578         switch (cmd) {
579         case DIOCGDINFO:
580                 *(struct disklabel *) addr = cd->dlabel;
581                 return 0;
582         case DIOCGPART:
583                 ((struct partinfo *) addr)->disklab = &cd->dlabel;
584                 ((struct partinfo *) addr)->part =
585                     &cd->dlabel.d_partitions[mcd_part(dev)];
586                 return 0;
587
588                 /*
589                  * a bit silly, but someone might want to test something on a
590                  * section of cdrom.
591                  */
592         case DIOCWDINFO:
593         case DIOCSDINFO:
594                 if ((flags & FWRITE) == 0)
595                         return EBADF;
596                 else {
597                         return setdisklabel(&cd->dlabel,
598                             (struct disklabel *) addr,
599                             0);
600                 }
601         case DIOCWLABEL:
602                 return EBADF;
603         case CDIOCPLAYTRACKS:
604                 return mcd_playtracks(unit, (struct ioc_play_track *) addr);
605         case CDIOCPLAYBLOCKS:
606                 return mcd_playblocks(unit, (struct ioc_play_blocks *) addr);
607         case CDIOCPLAYMSF:
608                 return mcd_playmsf(unit, (struct ioc_play_msf *) addr);
609         case CDIOCREADSUBCHANNEL:
610                 return mcd_subchan(unit, (struct ioc_read_subchannel *) addr);
611         case CDIOREADTOCHEADER:
612                 return mcd_toc_header(unit, (struct ioc_toc_header *) addr);
613         case CDIOREADTOCENTRYS:
614                 return mcd_toc_entrys(unit, (struct ioc_read_toc_entry *) addr);
615         case CDIOCRESUME:
616                 return mcd_resume(unit);
617         case CDIOCPAUSE:
618                 return mcd_pause(unit);
619         case CDIOCSTART:
620                 if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
621                         return EIO;
622                 return 0;
623         case CDIOCSTOP:
624                 return mcd_stop(unit);
625         default:
626                 return ENOTTY;
627         }
628         /*NOTREACHED*/
629 }
630
631 /* this could have been taken from scsi/cd.c, but it is not clear
632  * whether the scsi cd driver is linked in
633  */
634 static int mcd_getdisklabel(int unit)
635 {
636         struct mcd_data *cd = mcd_data + unit;
637
638         if (cd->flags & MCDLABEL)
639                 return -1;
640
641         bzero(&cd->dlabel,sizeof(struct disklabel));
642         /* filled with spaces first */
643         strncpy(cd->dlabel.d_typename,"               ",
644                 sizeof(cd->dlabel.d_typename));
645         strncpy(cd->dlabel.d_typename, cd->name,
646                 min(strlen(cd->name), sizeof(cd->dlabel.d_typename) - 1));
647         strncpy(cd->dlabel.d_packname,"unknown        ",
648                 sizeof(cd->dlabel.d_packname));
649         cd->dlabel.d_secsize    = cd->blksize;
650         cd->dlabel.d_nsectors   = 100;
651         cd->dlabel.d_ntracks    = 1;
652         cd->dlabel.d_ncylinders = (cd->disksize/100)+1;
653         cd->dlabel.d_secpercyl  = 100;
654         cd->dlabel.d_secperunit = cd->disksize;
655         cd->dlabel.d_rpm        = 300;
656         cd->dlabel.d_interleave = 1;
657         cd->dlabel.d_flags      = D_REMOVABLE;
658         cd->dlabel.d_npartitions= 1;
659         cd->dlabel.d_partitions[0].p_offset = 0;
660         cd->dlabel.d_partitions[0].p_size = cd->disksize;
661         cd->dlabel.d_partitions[0].p_fstype = 9;
662         cd->dlabel.d_magic      = DISKMAGIC;
663         cd->dlabel.d_magic2     = DISKMAGIC;
664         cd->dlabel.d_checksum   = dkcksum(&cd->dlabel);
665
666         cd->flags |= MCDLABEL;
667         return 0;
668 }
669
670 int mcdsize(dev_t dev)
671 {
672         int size;
673         int unit = mcd_unit(dev);
674         struct mcd_data *cd = mcd_data + unit;
675
676         if (mcd_volinfo(unit) == 0) {
677                 cd->blksize = MCDBLK;
678                 size = msf2hsg(cd->volinfo.vol_msf, 0);
679                 cd->disksize = size * (MCDBLK/DEV_BSIZE);
680                 return 0;
681         }
682         return -1;
683 }
684
685 /***************************************************************
686  * lower level of driver starts here
687  **************************************************************/
688
689 #ifdef NOTDEF
690 static char
691 irqs[] = {
692         0x00,0x00,0x10,0x20,0x00,0x30,0x00,0x00,
693         0x00,0x10,0x40,0x50,0x00,0x00,0x00,0x00
694 };
695
696 static char
697 drqs[] = {
698         0x00,0x01,0x00,0x03,0x00,0x05,0x06,0x07,
699 };
700 #endif
701
702 #ifdef NOT_YET
703 static void
704 mcd_configure(struct mcd_data *cd)
705 {
706         outb(cd->iobase+mcd_config,cd->config);
707 }
708 #endif
709
710 /* Wait for non-busy - return 0 on timeout */
711 static int
712 twiddle_thumbs(int port, int unit, int count, char *whine)
713 {
714         int i;
715
716         for (i = 0; i < count; i++) {
717                 if (!(inb(port+MCD_FLAGS) & MFL_STATUS_NOT_AVAIL))
718                         return 1;
719                 }
720         if (bootverbose)
721                 printf("mcd%d: timeout %s\n", unit, whine);
722         return 0;
723 }
724
725 /* check to see if a Mitsumi CD-ROM is attached to the ISA bus */
726
727 int
728 mcd_probe(struct isa_device *dev)
729 {
730         int port = dev->id_iobase;
731         int unit = dev->id_unit;
732         int i, j;
733         unsigned char stbytes[3];
734
735         mcd_data[unit].flags = MCDPROBING;
736
737 #ifdef NOTDEF
738         /* get irq/drq configuration word */
739         mcd_data[unit].config = irqs[dev->id_irq]; /* | drqs[dev->id_drq];*/
740 #else
741         mcd_data[unit].config = 0;
742 #endif
743
744         /* send a reset */
745         outb(port+MCD_FLAGS, M_RESET);
746
747         /*
748          * delay awhile by getting any pending garbage (old data) and
749          * throwing it away.
750          */
751         for (i = 1000000; i != 0; i--)
752                 inb(port+MCD_FLAGS);
753
754         /* Get status */
755         outb(port+MCD_DATA, MCD_CMDGETSTAT);
756         if (!twiddle_thumbs(port, unit, 1000000, "getting status"))
757                 return 0;       /* Timeout */
758         /* Get version information */
759         outb(port+MCD_DATA, MCD_CMDCONTINFO);
760         for (j = 0; j < 3; j++) {
761                 if (!twiddle_thumbs(port, unit, 3000, "getting version info"))
762                         return 0;
763                 stbytes[j] = (inb(port+MCD_DATA) & 0xFF);
764         }
765         if (stbytes[1] == stbytes[2])
766                 return 0;
767         if (stbytes[2] >= 4 || stbytes[1] != 'M') {
768                 outb(port+MCD_CTRL, M_PICKLE);
769                 mcd_data[unit].flags |= MCDNEWMODEL;
770         }
771         mcd_data[unit].read_command = MCD_CMDSINGLESPEEDREAD;
772         switch (stbytes[1]) {
773         case 'M':
774                 if (stbytes[2] <= 2) {
775                         mcd_data[unit].type = MCD_TYPE_LU002S;
776                         mcd_data[unit].name = "Mitsumi LU002S";
777                 } else if (stbytes[2] <= 5) {
778                         mcd_data[unit].type = MCD_TYPE_LU005S;
779                         mcd_data[unit].name = "Mitsumi LU005S";
780                 } else {
781                         mcd_data[unit].type = MCD_TYPE_LU006S;
782                         mcd_data[unit].name = "Mitsumi LU006S";
783                 }
784                 break;
785         case 'F':
786                 mcd_data[unit].type = MCD_TYPE_FX001;
787                 mcd_data[unit].name = "Mitsumi FX001";
788                 break;
789         case 'D':
790                 mcd_data[unit].type = MCD_TYPE_FX001D;
791                 mcd_data[unit].name = "Mitsumi FX001D";
792                 mcd_data[unit].read_command = MCD_CMDDOUBLESPEEDREAD;
793                 break;
794         default:
795                 mcd_data[unit].type = MCD_TYPE_UNKNOWN;
796                 mcd_data[unit].name = "Mitsumi ???";
797                 break;
798         }
799         printf("mcd%d: type %s, version info: %c %x\n", unit, mcd_data[unit].name,
800                 stbytes[1], stbytes[2]);
801
802         return 4;
803 }
804
805
806 static int
807 mcd_waitrdy(int port,int dly)
808 {
809         int i;
810
811         /* wait until flag port senses status ready */
812         for (i=0; i<dly; i+=MIN_DELAY) {
813                 if (!(inb(port+MCD_FLAGS) & MFL_STATUS_NOT_AVAIL))
814                         return 0;
815                 DELAY(MIN_DELAY);
816         }
817         return -1;
818 }
819
820 static int
821 mcd_getreply(int unit,int dly)
822 {
823         struct  mcd_data *cd = mcd_data + unit;
824         int     port = cd->iobase;
825
826         /* wait data to become ready */
827         if (mcd_waitrdy(port,dly)<0) {
828                 printf("mcd%d: timeout getreply\n",unit);
829                 return -1;
830         }
831
832         /* get the data */
833         return inb(port+mcd_status) & 0xFF;
834 }
835
836 static int
837 mcd_getstat(int unit,int sflg)
838 {
839         int     i;
840         struct  mcd_data *cd = mcd_data + unit;
841         int     port = cd->iobase;
842
843         /* get the status */
844         if (sflg)
845                 outb(port+mcd_command, MCD_CMDGETSTAT);
846         i = mcd_getreply(unit,DELAY_GETREPLY);
847         if (i<0 || (i & MCD_ST_CMDCHECK)) {
848                 cd->curr_mode = MCD_MD_UNKNOWN;
849                 return -1;
850         }
851
852         cd->status = i;
853
854         if (mcd_setflags(unit,cd) < 0)
855                 return -2;
856         return cd->status;
857 }
858
859 static int
860 mcd_setflags(int unit, struct mcd_data *cd)
861 {
862         /* check flags */
863         if (    (cd->status & (MCDDSKCHNG|MCDDOOROPEN))
864             || !(cd->status & MCDDSKIN)) {
865                 MCD_TRACE("setflags: sensed DSKCHNG or DOOROPEN or !DSKIN\n");
866                 mcd_soft_reset(unit);
867                 return -1;
868         }
869
870         if (cd->status & MCDAUDIOBSY)
871                 cd->audio_status = CD_AS_PLAY_IN_PROGRESS;
872         else if (cd->audio_status == CD_AS_PLAY_IN_PROGRESS)
873                 cd->audio_status = CD_AS_PLAY_COMPLETED;
874         return 0;
875 }
876
877 static int
878 mcd_get(int unit, char *buf, int nmax)
879 {
880         int i,k;
881
882         for (i=0; i<nmax; i++) {
883                 /* wait for data */
884                 if ((k = mcd_getreply(unit,DELAY_GETREPLY)) < 0) {
885                         printf("mcd%d: timeout mcd_get\n",unit);
886                         return -1;
887                 }
888                 buf[i] = k;
889         }
890         return i;
891 }
892
893 static int
894 mcd_send(int unit, int cmd,int nretrys)
895 {
896         int i,k=0;
897         int port = mcd_data[unit].iobase;
898
899 /*MCD_TRACE("mcd_send: command = 0x%02x\n",cmd,0,0,0);*/
900         for (i=0; i<nretrys; i++) {
901                 outb(port+mcd_command, cmd);
902                 if ((k=mcd_getstat(unit,0)) != -1)
903                         break;
904         }
905         if (k == -2) {
906                 printf("mcd%d: media changed\n",unit);
907                 return -1;
908         }
909         if (i == nretrys) {
910                 printf("mcd%d: mcd_send retry cnt exceeded\n",unit);
911                 return -1;
912         }
913 /*MCD_TRACE("mcd_send: done\n",0,0,0,0);*/
914         return 0;
915 }
916
917 static void
918 hsg2msf(int hsg, bcd_t *msf)
919 {
920         hsg += 150;
921         F_msf(msf) = bin2bcd(hsg % 75);
922         hsg /= 75;
923         S_msf(msf) = bin2bcd(hsg % 60);
924         hsg /= 60;
925         M_msf(msf) = bin2bcd(hsg);
926 }
927
928 static int
929 msf2hsg(bcd_t *msf, int relative)
930 {
931         return (bcd2bin(M_msf(msf)) * 60 + bcd2bin(S_msf(msf))) * 75 +
932                 bcd2bin(F_msf(msf)) - (!relative) * 150;
933 }
934
935 static int
936 mcd_volinfo(int unit)
937 {
938         struct mcd_data *cd = mcd_data + unit;
939
940         /* Just return if we already have it */
941         if (cd->flags & MCDVOLINFO) return 0;
942
943 /*MCD_TRACE("mcd_volinfo: enter\n",0,0,0,0);*/
944
945         /* send volume info command */
946         if (mcd_send(unit,MCD_CMDGETVOLINFO,MCD_RETRYS) < 0)
947                 return EIO;
948
949         /* get data */
950         if (mcd_get(unit,(char*) &cd->volinfo,sizeof(struct mcd_volinfo)) < 0) {
951                 printf("mcd%d: mcd_volinfo: error read data\n",unit);
952                 return EIO;
953         }
954
955         if (cd->volinfo.trk_low > 0 &&
956             cd->volinfo.trk_high >= cd->volinfo.trk_low
957            ) {
958                 cd->flags |= MCDVOLINFO;        /* volinfo is OK */
959                 return 0;
960         }
961
962         return EINVAL;
963 }
964
965 static void
966 mcdintr(unit)
967         int unit;
968 {
969         MCD_TRACE("stray interrupt\n");
970 }
971
972 /* state machine to process read requests
973  * initialize with MCD_S_BEGIN: calculate sizes, and read status
974  * MCD_S_WAITSTAT: wait for status reply, set mode
975  * MCD_S_WAITMODE: waits for status reply from set mode, set read command
976  * MCD_S_WAITREAD: wait for read ready, read data
977  */
978 static struct mcd_mbx *mbxsave;
979
980 static void
981 mcd_timeout(void *arg)
982 {
983         mcd_doread((int)arg, mbxsave);
984 }
985
986 static void
987 mcd_doread(int state, struct mcd_mbx *mbxin)
988 {
989         struct mcd_mbx *mbx = (state!=MCD_S_BEGIN) ? mbxsave : mbxin;
990         int     unit = mbx->unit;
991         int     port = mbx->port;
992         int     com_port = mbx->port + mcd_command;
993         int     data_port = mbx->port + mcd_rdata;
994         struct  buf *bp = mbx->bp;
995         struct  mcd_data *cd = mcd_data + unit;
996
997         int     rm,i,k;
998         struct mcd_read2 rbuf;
999         int     blknum;
1000         caddr_t addr;
1001
1002 loop:
1003         switch (state) {
1004         case MCD_S_BEGIN:
1005                 mbx = mbxsave = mbxin;
1006
1007         case MCD_S_BEGIN1:
1008 retry_status:
1009                 /* get status */
1010                 outb(com_port, MCD_CMDGETSTAT);
1011                 mbx->count = RDELAY_WAITSTAT;
1012                 callout_reset(&cd->callout, hz / 100, 
1013                                 mcd_timeout, (void *)MCD_S_WAITSTAT);
1014                 return;
1015         case MCD_S_WAITSTAT:
1016                 callout_stop(&cd->callout);
1017                 if (mbx->count-- >= 0) {
1018                         if (inb(port+MCD_FLAGS) & MFL_STATUS_NOT_AVAIL) {
1019                                 /* XXX */
1020                                 callout_reset(&cd->callout, hz / 100,
1021                                         mcd_timeout, (void *)MCD_S_WAITSTAT);
1022                                 return;
1023                         }
1024                         cd->status = inb(port+mcd_status) & 0xFF;
1025                         if (cd->status & MCD_ST_CMDCHECK)
1026                                 goto retry_status;
1027                         if (mcd_setflags(unit,cd) < 0)
1028                                 goto changed;
1029                         MCD_TRACE("got WAITSTAT delay=%d\n",
1030                                 RDELAY_WAITSTAT-mbx->count);
1031                         /* reject, if audio active */
1032                         if (cd->status & MCDAUDIOBSY) {
1033                                 printf("mcd%d: audio is active\n",unit);
1034                                 goto readerr;
1035                         }
1036
1037 retry_mode:
1038                         /* to check for raw/cooked mode */
1039                         if (cd->flags & MCDREADRAW) {
1040                                 rm = MCD_MD_RAW;
1041                                 mbx->sz = MCDRBLK;
1042                         } else {
1043                                 rm = MCD_MD_COOKED;
1044                                 mbx->sz = cd->blksize;
1045                         }
1046
1047                         if (rm == cd->curr_mode)
1048                                 goto modedone;
1049
1050                         mbx->count = RDELAY_WAITMODE;
1051
1052                         cd->curr_mode = MCD_MD_UNKNOWN;
1053                         mbx->mode = rm;
1054                         mcd_put(com_port, MCD_CMDSETMODE);
1055                         mcd_put(com_port, rm);
1056
1057                         callout_reset(&cd->callout, hz / 100,
1058                                         mcd_timeout, (void *)MCD_S_WAITMODE);
1059                         return;
1060                 } else {
1061                         printf("mcd%d: timeout getstatus\n",unit);
1062                         goto readerr;
1063                 }
1064
1065         case MCD_S_WAITMODE:
1066                 callout_stop(&cd->callout);
1067                 if (mbx->count-- < 0) {
1068                         printf("mcd%d: timeout set mode\n",unit);
1069                         goto readerr;
1070                 }
1071                 if (inb(port+MCD_FLAGS) & MFL_STATUS_NOT_AVAIL) {
1072                         callout_reset(&cd->callout, hz / 100,
1073                                         mcd_timeout, (void *)MCD_S_WAITMODE);
1074                         return;
1075                 }
1076                 cd->status = inb(port+mcd_status) & 0xFF;
1077                 if (cd->status & MCD_ST_CMDCHECK) {
1078                         cd->curr_mode = MCD_MD_UNKNOWN;
1079                         goto retry_mode;
1080                 }
1081                 if (mcd_setflags(unit,cd) < 0)
1082                         goto changed;
1083                 cd->curr_mode = mbx->mode;
1084                 MCD_TRACE("got WAITMODE delay=%d\n",
1085                         RDELAY_WAITMODE-mbx->count);
1086 modedone:
1087                 /* for first block */
1088                 mbx->nblk = (bp->b_bcount + (mbx->sz-1)) / mbx->sz;
1089                 mbx->skip = 0;
1090
1091 nextblock:
1092                 blknum  = (bp->b_blkno / (mbx->sz/DEV_BSIZE))
1093                         + mbx->p_offset + mbx->skip/mbx->sz;
1094
1095                 MCD_TRACE("mcd_doread: read blknum=%d for bp=%p\n",
1096                         blknum, bp);
1097
1098                 /* build parameter block */
1099                 hsg2msf(blknum,rbuf.start_msf);
1100 retry_read:
1101                 /* send the read command */
1102                 cpu_disable_intr();
1103                 mcd_put(com_port,cd->read_command);
1104                 mcd_put(com_port,rbuf.start_msf[0]);
1105                 mcd_put(com_port,rbuf.start_msf[1]);
1106                 mcd_put(com_port,rbuf.start_msf[2]);
1107                 mcd_put(com_port,0);
1108                 mcd_put(com_port,0);
1109                 mcd_put(com_port,1);
1110                 cpu_enable_intr();
1111
1112                 /* Spin briefly (<= 2ms) to avoid missing next block */
1113                 for (i = 0; i < 20; i++) {
1114                         k = inb(port+MCD_FLAGS);
1115                         if (!(k & MFL_DATA_NOT_AVAIL))
1116                                 goto got_it;
1117                         DELAY(100);
1118                 }
1119
1120                 mbx->count = RDELAY_WAITREAD;
1121                 callout_reset(&cd->callout, hz / 100,
1122                                 mcd_timeout, (void *)MCD_S_WAITREAD);
1123                 return;
1124         case MCD_S_WAITREAD:
1125                 callout_stop(&cd->callout);
1126                 if (mbx->count-- > 0) {
1127                         k = inb(port+MCD_FLAGS);
1128                         if (!(k & MFL_DATA_NOT_AVAIL)) { /* XXX */
1129                                 MCD_TRACE("got data delay=%d\n",
1130                                         RDELAY_WAITREAD-mbx->count);
1131                         got_it:
1132                                 /* data is ready */
1133                                 addr    = bp->b_data + mbx->skip;
1134
1135                                 outb(port+mcd_ctl2,0x04);       /* XXX */
1136                                 for (i=0; i<mbx->sz; i++)
1137                                         *addr++ = inb(data_port);
1138                                 outb(port+mcd_ctl2,0x0c);       /* XXX */
1139
1140                                 k = inb(port+MCD_FLAGS);
1141                                 /* If we still have some junk, read it too */
1142                                 if (!(k & MFL_DATA_NOT_AVAIL)) {
1143                                         outb(port+mcd_ctl2,0x04);       /* XXX */
1144                                         (void)inb(data_port);
1145                                         (void)inb(data_port);
1146                                         outb(port+mcd_ctl2,0x0c);       /* XXX */
1147                                 }
1148
1149                                 if (--mbx->nblk > 0) {
1150                                         mbx->skip += mbx->sz;
1151                                         goto nextblock;
1152                                 }
1153
1154                                 /* return buffer */
1155                                 bp->b_resid = 0;
1156                                 biodone(bp);
1157
1158                                 cd->flags &= ~(MCDMBXBSY|MCDREADRAW);
1159                                 mcd_start(mbx->unit);
1160                                 return;
1161                         }
1162                         if (!(k & MFL_STATUS_NOT_AVAIL)) {
1163                                 cd->status = inb(port+mcd_status) & 0xFF;
1164                                 if (cd->status & MCD_ST_CMDCHECK)
1165                                         goto retry_read;
1166                                 if (mcd_setflags(unit,cd) < 0)
1167                                         goto changed;
1168                         }
1169                         callout_reset(&cd->callout, hz / 100,
1170                                         mcd_timeout, (void *)MCD_S_WAITREAD);
1171                         return;
1172                 } else {
1173                         printf("mcd%d: timeout read data\n",unit);
1174                         goto readerr;
1175                 }
1176         }
1177
1178 readerr:
1179         if (mbx->retry-- > 0) {
1180                 printf("mcd%d: retrying\n",unit);
1181                 state = MCD_S_BEGIN1;
1182                 goto loop;
1183         }
1184 harderr:
1185         /* invalidate the buffer */
1186         bp->b_flags |= B_ERROR;
1187         bp->b_resid = bp->b_bcount;
1188         biodone(bp);
1189
1190         cd->flags &= ~(MCDMBXBSY|MCDREADRAW);
1191         mcd_start(mbx->unit);
1192         return;
1193
1194 changed:
1195         printf("mcd%d: media changed\n", unit);
1196         goto harderr;
1197
1198 #ifdef NOTDEF
1199         printf("mcd%d: unit timeout, resetting\n",mbx->unit);
1200         outb(mbx->port+mcd_reset,MCD_CMDRESET);
1201         DELAY(300000);
1202         (void)mcd_getstat(mbx->unit,1);
1203         (void)mcd_getstat(mbx->unit,1);
1204         /*cd->status &= ~MCDDSKCHNG; */
1205         cd->debug = 1; /* preventive set debug mode */
1206
1207 #endif
1208
1209 }
1210
1211 static int
1212 mcd_lock_door(int unit, int lock)
1213 {
1214         struct mcd_data *cd = mcd_data + unit;
1215         int port = cd->iobase;
1216
1217         outb(port+mcd_command, MCD_CMDLOCKDRV);
1218         outb(port+mcd_command, lock);
1219         if (mcd_getstat(unit,0) == -1)
1220                 return EIO;
1221         return 0;
1222 }
1223
1224 static int
1225 mcd_close_tray(int unit)
1226 {
1227         struct mcd_data *cd = mcd_data + unit;
1228         int port = cd->iobase;
1229         int retry, r;
1230
1231         if (mcd_getstat(unit,1) == -1)
1232                 return EIO;
1233         if (cd->status & MCDDOOROPEN) {
1234                 outb(port+mcd_command, MCD_CMDCLOSETRAY);
1235                 for (retry = 0; retry < CLOSE_TRAY_SECS * WAIT_FRAC; retry++) {
1236                         if (inb(port+MCD_FLAGS) & MFL_STATUS_NOT_AVAIL)
1237                                 (void) tsleep((caddr_t)cd, PCATCH, "mcdcls", hz/WAIT_FRAC);
1238                         else {
1239                                 if ((r = mcd_getstat(unit,0)) == -1)
1240                                         return EIO;
1241                                 return 0;
1242                         }
1243                 }
1244                 return ENXIO;
1245         }
1246         return 0;
1247 }
1248
1249 static int
1250 mcd_eject(int unit)
1251 {
1252         struct mcd_data *cd = mcd_data + unit;
1253         int port = cd->iobase, r;
1254
1255         if (mcd_getstat(unit,1) == -1)    /* detect disk change too */
1256                 return EIO;
1257         if (cd->status & MCDDOOROPEN)
1258                 return 0;
1259         if ((r = mcd_stop(unit)) == EIO)
1260                 return r;
1261         outb(port+mcd_command, MCD_CMDEJECTDISK);
1262         if (mcd_getstat(unit,0) == -1)
1263                 return EIO;
1264         return 0;
1265 }
1266
1267 static int
1268 mcd_inject(int unit)
1269 {
1270         struct mcd_data *cd = mcd_data + unit;
1271
1272         if (mcd_getstat(unit,1) == -1)    /* detect disk change too */
1273                 return EIO;
1274         if (cd->status & MCDDOOROPEN)
1275                 return mcd_close_tray(unit);
1276         return 0;
1277 }
1278
1279 static int
1280 mcd_hard_reset(int unit)
1281 {
1282         struct mcd_data *cd = mcd_data + unit;
1283         int port = cd->iobase;
1284
1285         outb(port+mcd_reset,MCD_CMDRESET);
1286         cd->curr_mode = MCD_MD_UNKNOWN;
1287         cd->audio_status = CD_AS_AUDIO_INVALID;
1288         return 0;
1289 }
1290
1291 static void
1292 mcd_soft_reset(int unit)
1293 {
1294         struct mcd_data *cd = mcd_data + unit;
1295         int i;
1296
1297         cd->flags &= (MCDINIT|MCDPROBING|MCDNEWMODEL);
1298         cd->curr_mode = MCD_MD_UNKNOWN;
1299         for (i=0; i<MAXPARTITIONS; i++) cd->partflags[i] = 0;
1300         cd->audio_status = CD_AS_AUDIO_INVALID;
1301 }
1302
1303 static int
1304 mcd_setmode(int unit, int mode)
1305 {
1306         struct mcd_data *cd = mcd_data + unit;
1307         int port = cd->iobase;
1308         int retry, st;
1309
1310         if (cd->curr_mode == mode)
1311                 return 0;
1312         if (cd->debug)
1313                 printf("mcd%d: setting mode to %d\n", unit, mode);
1314         for(retry=0; retry<MCD_RETRYS; retry++)
1315         {
1316                 cd->curr_mode = MCD_MD_UNKNOWN;
1317                 outb(port+mcd_command, MCD_CMDSETMODE);
1318                 outb(port+mcd_command, mode);
1319                 if ((st = mcd_getstat(unit, 0)) >= 0) {
1320                         cd->curr_mode = mode;
1321                         return 0;
1322                 }
1323                 if (st == -2) {
1324                         printf("mcd%d: media changed\n", unit);
1325                         break;
1326                 }
1327         }
1328
1329         return -1;
1330 }
1331
1332 static int
1333 mcd_toc_header(int unit, struct ioc_toc_header *th)
1334 {
1335         struct mcd_data *cd = mcd_data + unit;
1336         int r;
1337
1338         if ((r = mcd_volinfo(unit)) != 0)
1339                 return r;
1340
1341         th->starting_track = bcd2bin(cd->volinfo.trk_low);
1342         th->ending_track = bcd2bin(cd->volinfo.trk_high);
1343         th->len = 2 * sizeof(u_char) /* start & end tracks */ +
1344                   (th->ending_track + 1 - th->starting_track + 1) *
1345                   sizeof(struct cd_toc_entry);
1346
1347         return 0;
1348 }
1349
1350 static int
1351 mcd_read_toc(int unit)
1352 {
1353         struct mcd_data *cd = mcd_data + unit;
1354         struct ioc_toc_header th;
1355         struct mcd_qchninfo q;
1356         int rc, trk, idx, retry;
1357
1358         /* Only read TOC if needed */
1359         if (cd->flags & MCDTOC)
1360                 return 0;
1361
1362         if (cd->debug)
1363                 printf("mcd%d: reading toc header\n", unit);
1364
1365         if ((rc = mcd_toc_header(unit, &th)) != 0)
1366                 return rc;
1367
1368         if (mcd_send(unit, MCD_CMDSTOPAUDIO, MCD_RETRYS) < 0)
1369                 return EIO;
1370
1371         if (mcd_setmode(unit, MCD_MD_TOC) != 0)
1372                 return EIO;
1373
1374         if (cd->debug)
1375                 printf("mcd%d: get_toc reading qchannel info\n",unit);
1376
1377         for(trk=th.starting_track; trk<=th.ending_track; trk++)
1378                 cd->toc[trk].idx_no = 0;
1379         trk = th.ending_track - th.starting_track + 1;
1380         for(retry=0; retry<600 && trk>0; retry++)
1381         {
1382                 if (mcd_getqchan(unit, &q) < 0) break;
1383                 idx = bcd2bin(q.idx_no);
1384                 if (idx>=th.starting_track && idx<=th.ending_track && q.trk_no==0) {
1385                         if (cd->toc[idx].idx_no == 0) {
1386                                 cd->toc[idx] = q;
1387                                 trk--;
1388                         }
1389                 }
1390         }
1391
1392         if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
1393                 return EIO;
1394
1395         if (trk != 0)
1396                 return ENXIO;
1397
1398         /* add a fake last+1 */
1399         idx = th.ending_track + 1;
1400         cd->toc[idx].control = cd->toc[idx-1].control;
1401         cd->toc[idx].addr_type = cd->toc[idx-1].addr_type;
1402         cd->toc[idx].trk_no = 0;
1403         cd->toc[idx].idx_no = MCD_LASTPLUS1;
1404         cd->toc[idx].hd_pos_msf[0] = cd->volinfo.vol_msf[0];
1405         cd->toc[idx].hd_pos_msf[1] = cd->volinfo.vol_msf[1];
1406         cd->toc[idx].hd_pos_msf[2] = cd->volinfo.vol_msf[2];
1407
1408         if (cd->debug)
1409         { int i;
1410         for (i = th.starting_track; i <= idx; i++)
1411                 printf("mcd%d: trk %d idx %d pos %d %d %d\n",
1412                         unit, i,
1413                         cd->toc[i].idx_no > 0x99 ? cd->toc[i].idx_no :
1414                         bcd2bin(cd->toc[i].idx_no),
1415                         bcd2bin(cd->toc[i].hd_pos_msf[0]),
1416                         bcd2bin(cd->toc[i].hd_pos_msf[1]),
1417                         bcd2bin(cd->toc[i].hd_pos_msf[2]));
1418         }
1419
1420         cd->flags |= MCDTOC;
1421
1422         return 0;
1423 }
1424
1425 #if 0
1426 static int
1427 mcd_toc_entry(int unit, struct ioc_read_toc_single_entry *te)
1428 {
1429         struct mcd_data *cd = mcd_data + unit;
1430         struct ioc_toc_header th;
1431         int rc, trk;
1432
1433         if (te->address_format != CD_MSF_FORMAT
1434             && te->address_format != CD_LBA_FORMAT)
1435                 return EINVAL;
1436
1437         /* Copy the toc header */
1438         if ((rc = mcd_toc_header(unit, &th)) != 0)
1439                 return rc;
1440
1441         /* verify starting track */
1442         trk = te->track;
1443         if (trk == 0)
1444                 trk = th.starting_track;
1445         else if (trk == MCD_LASTPLUS1)
1446                 trk = th.ending_track + 1;
1447         else if (trk < th.starting_track || trk > th.ending_track + 1)
1448                 return EINVAL;
1449
1450         /* Make sure we have a valid toc */
1451         if ((rc=mcd_read_toc(unit)) != 0)
1452                 return rc;
1453
1454         /* Copy the TOC data. */
1455         if (cd->toc[trk].idx_no == 0)
1456                 return EIO;
1457
1458         te->entry.control = cd->toc[trk].control;
1459         te->entry.addr_type = cd->toc[trk].addr_type;
1460         te->entry.track =
1461                 cd->toc[trk].idx_no > 0x99 ? cd->toc[trk].idx_no :
1462                 bcd2bin(cd->toc[trk].idx_no);
1463         switch (te->address_format) {
1464         case CD_MSF_FORMAT:
1465                 te->entry.addr.msf.unused = 0;
1466                 te->entry.addr.msf.minute = bcd2bin(cd->toc[trk].hd_pos_msf[0]);
1467                 te->entry.addr.msf.second = bcd2bin(cd->toc[trk].hd_pos_msf[1]);
1468                 te->entry.addr.msf.frame = bcd2bin(cd->toc[trk].hd_pos_msf[2]);
1469                 break;
1470         case CD_LBA_FORMAT:
1471                 te->entry.addr.lba = htonl(msf2hsg(cd->toc[trk].hd_pos_msf, 0));
1472                 break;
1473         }
1474         return 0;
1475 }
1476 #endif
1477
1478 static int
1479 mcd_toc_entrys(int unit, struct ioc_read_toc_entry *te)
1480 {
1481         struct mcd_data *cd = mcd_data + unit;
1482         struct cd_toc_entry entries[MCD_MAXTOCS];
1483         struct ioc_toc_header th;
1484         int rc, n, trk, len;
1485
1486         if (   te->data_len < sizeof(entries[0])
1487             || (te->data_len % sizeof(entries[0])) != 0
1488             || (te->address_format != CD_MSF_FORMAT
1489                 && te->address_format != CD_LBA_FORMAT)
1490            )
1491                 return EINVAL;
1492
1493         /* Copy the toc header */
1494         if ((rc = mcd_toc_header(unit, &th)) != 0)
1495                 return rc;
1496
1497         /* verify starting track */
1498         trk = te->starting_track;
1499         if (trk == 0)
1500                 trk = th.starting_track;
1501         else if (trk == MCD_LASTPLUS1)
1502                 trk = th.ending_track + 1;
1503         else if (trk < th.starting_track || trk > th.ending_track + 1)
1504                 return EINVAL;
1505
1506         len = ((th.ending_track + 1 - trk) + 1) *
1507                 sizeof(entries[0]);
1508         if (te->data_len < len)
1509                 len = te->data_len;
1510         if (len > sizeof(entries))
1511                 return EINVAL;
1512
1513         /* Make sure we have a valid toc */
1514         if ((rc=mcd_read_toc(unit)) != 0)
1515                 return rc;
1516
1517         /* Copy the TOC data. */
1518         for (n = 0; len > 0 && trk <= th.ending_track + 1; trk++) {
1519                 if (cd->toc[trk].idx_no == 0)
1520                         continue;
1521                 entries[n].control = cd->toc[trk].control;
1522                 entries[n].addr_type = cd->toc[trk].addr_type;
1523                 entries[n].track =
1524                         cd->toc[trk].idx_no > 0x99 ? cd->toc[trk].idx_no :
1525                         bcd2bin(cd->toc[trk].idx_no);
1526                 switch (te->address_format) {
1527                 case CD_MSF_FORMAT:
1528                         entries[n].addr.msf.unused = 0;
1529                         entries[n].addr.msf.minute = bcd2bin(cd->toc[trk].hd_pos_msf[0]);
1530                         entries[n].addr.msf.second = bcd2bin(cd->toc[trk].hd_pos_msf[1]);
1531                         entries[n].addr.msf.frame = bcd2bin(cd->toc[trk].hd_pos_msf[2]);
1532                         break;
1533                 case CD_LBA_FORMAT:
1534                         entries[n].addr.lba = htonl(msf2hsg(cd->toc[trk].hd_pos_msf, 0));
1535                         break;
1536                 }
1537                 len -= sizeof(struct cd_toc_entry);
1538                 n++;
1539         }
1540
1541         /* copy the data back */
1542         return copyout(entries, te->data, n * sizeof(struct cd_toc_entry));
1543 }
1544
1545 static int
1546 mcd_stop(int unit)
1547 {
1548         struct mcd_data *cd = mcd_data + unit;
1549
1550         /* Verify current status */
1551         if (cd->audio_status != CD_AS_PLAY_IN_PROGRESS &&
1552             cd->audio_status != CD_AS_PLAY_PAUSED &&
1553             cd->audio_status != CD_AS_PLAY_COMPLETED) {
1554                 if (cd->debug)
1555                         printf("mcd%d: stop attempted when not playing, audio status %d\n",
1556                                 unit, cd->audio_status);
1557                 return EINVAL;
1558         }
1559         if (cd->audio_status == CD_AS_PLAY_IN_PROGRESS)
1560                 if (mcd_send(unit, MCD_CMDSTOPAUDIO, MCD_RETRYS) < 0)
1561                         return EIO;
1562         cd->audio_status = CD_AS_PLAY_COMPLETED;
1563         return 0;
1564 }
1565
1566 static int
1567 mcd_getqchan(int unit, struct mcd_qchninfo *q)
1568 {
1569         struct mcd_data *cd = mcd_data + unit;
1570
1571         if (mcd_send(unit, MCD_CMDGETQCHN, MCD_RETRYS) < 0)
1572                 return -1;
1573         if (mcd_get(unit, (char *) q, sizeof(struct mcd_qchninfo)) < 0)
1574                 return -1;
1575         if (cd->debug) {
1576                 printf("mcd%d: getqchan control=0x%x addr_type=0x%x trk=%d ind=%d ttm=%d:%d.%d dtm=%d:%d.%d\n",
1577                 unit,
1578                 q->control, q->addr_type, bcd2bin(q->trk_no),
1579                 bcd2bin(q->idx_no),
1580                 bcd2bin(q->trk_size_msf[0]), bcd2bin(q->trk_size_msf[1]),
1581                 bcd2bin(q->trk_size_msf[2]),
1582                 bcd2bin(q->hd_pos_msf[0]), bcd2bin(q->hd_pos_msf[1]),
1583                 bcd2bin(q->hd_pos_msf[2]));
1584         }
1585         return 0;
1586 }
1587
1588 static int
1589 mcd_subchan(int unit, struct ioc_read_subchannel *sc)
1590 {
1591         struct mcd_data *cd = mcd_data + unit;
1592         struct mcd_qchninfo q;
1593         struct cd_sub_channel_info data;
1594         int lba;
1595
1596         if (cd->debug)
1597                 printf("mcd%d: subchan af=%d, df=%d\n", unit,
1598                         sc->address_format,
1599                         sc->data_format);
1600
1601         if (sc->address_format != CD_MSF_FORMAT &&
1602             sc->address_format != CD_LBA_FORMAT)
1603                 return EINVAL;
1604
1605         if (sc->data_format != CD_CURRENT_POSITION &&
1606             sc->data_format != CD_MEDIA_CATALOG)
1607                 return EINVAL;
1608
1609         if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
1610                 return EIO;
1611
1612         if (mcd_getqchan(unit, &q) < 0)
1613                 return EIO;
1614
1615         data.header.audio_status = cd->audio_status;
1616         data.what.position.data_format = sc->data_format;
1617
1618         switch (sc->data_format) {
1619         case CD_MEDIA_CATALOG:
1620                 data.what.media_catalog.mc_valid = 1;
1621                 data.what.media_catalog.mc_number[0] = '\0';
1622                 break;
1623
1624         case CD_CURRENT_POSITION:
1625                 data.what.position.control = q.control;
1626                 data.what.position.addr_type = q.addr_type;
1627                 data.what.position.track_number = bcd2bin(q.trk_no);
1628                 data.what.position.index_number = bcd2bin(q.idx_no);
1629                 switch (sc->address_format) {
1630                 case CD_MSF_FORMAT:
1631                         data.what.position.reladdr.msf.unused = 0;
1632                         data.what.position.reladdr.msf.minute = bcd2bin(q.trk_size_msf[0]);
1633                         data.what.position.reladdr.msf.second = bcd2bin(q.trk_size_msf[1]);
1634                         data.what.position.reladdr.msf.frame = bcd2bin(q.trk_size_msf[2]);
1635                         data.what.position.absaddr.msf.unused = 0;
1636                         data.what.position.absaddr.msf.minute = bcd2bin(q.hd_pos_msf[0]);
1637                         data.what.position.absaddr.msf.second = bcd2bin(q.hd_pos_msf[1]);
1638                         data.what.position.absaddr.msf.frame = bcd2bin(q.hd_pos_msf[2]);
1639                         break;
1640                 case CD_LBA_FORMAT:
1641                         lba = msf2hsg(q.trk_size_msf, 1);
1642                         /*
1643                          * Pre-gap has index number of 0, and decreasing MSF
1644                          * address.  Must be converted to negative LBA, per
1645                          * SCSI spec.
1646                          */
1647                         if (data.what.position.index_number == 0)
1648                                 lba = -lba;
1649                         data.what.position.reladdr.lba = htonl(lba);
1650                         data.what.position.absaddr.lba = htonl(msf2hsg(q.hd_pos_msf, 0));
1651                         break;
1652                 }
1653                 break;
1654         }
1655
1656         return copyout(&data, sc->data, min(sizeof(struct cd_sub_channel_info), sc->data_len));
1657 }
1658
1659 static int
1660 mcd_playmsf(int unit, struct ioc_play_msf *p)
1661 {
1662         struct mcd_data *cd = mcd_data + unit;
1663         struct mcd_read2 pb;
1664
1665         if (cd->debug)
1666                 printf("mcd%d: playmsf: from %d:%d.%d to %d:%d.%d\n",
1667                     unit,
1668                     p->start_m, p->start_s, p->start_f,
1669                     p->end_m, p->end_s, p->end_f);
1670
1671         if ((p->start_m * 60 * 75 + p->start_s * 75 + p->start_f) >=
1672             (p->end_m * 60 * 75 + p->end_s * 75 + p->end_f) ||
1673             (p->end_m * 60 * 75 + p->end_s * 75 + p->end_f) >
1674             M_msf(cd->volinfo.vol_msf) * 60 * 75 +
1675             S_msf(cd->volinfo.vol_msf) * 75 +
1676             F_msf(cd->volinfo.vol_msf))
1677                 return EINVAL;
1678
1679         pb.start_msf[0] = bin2bcd(p->start_m);
1680         pb.start_msf[1] = bin2bcd(p->start_s);
1681         pb.start_msf[2] = bin2bcd(p->start_f);
1682         pb.end_msf[0] = bin2bcd(p->end_m);
1683         pb.end_msf[1] = bin2bcd(p->end_s);
1684         pb.end_msf[2] = bin2bcd(p->end_f);
1685
1686         if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
1687                 return EIO;
1688
1689         return mcd_play(unit, &pb);
1690 }
1691
1692 static int
1693 mcd_playtracks(int unit, struct ioc_play_track *pt)
1694 {
1695         struct mcd_data *cd = mcd_data + unit;
1696         struct mcd_read2 pb;
1697         int a = pt->start_track;
1698         int z = pt->end_track;
1699         int rc, i;
1700
1701         if ((rc = mcd_read_toc(unit)) != 0)
1702                 return rc;
1703
1704         if (cd->debug)
1705                 printf("mcd%d: playtracks from %d:%d to %d:%d\n", unit,
1706                         a, pt->start_index, z, pt->end_index);
1707
1708         if (   a < bcd2bin(cd->volinfo.trk_low)
1709             || a > bcd2bin(cd->volinfo.trk_high)
1710             || a > z
1711             || z < bcd2bin(cd->volinfo.trk_low)
1712             || z > bcd2bin(cd->volinfo.trk_high))
1713                 return EINVAL;
1714
1715         for (i = 0; i < 3; i++) {
1716                 pb.start_msf[i] = cd->toc[a].hd_pos_msf[i];
1717                 pb.end_msf[i] = cd->toc[z+1].hd_pos_msf[i];
1718         }
1719
1720         if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
1721                 return EIO;
1722
1723         return mcd_play(unit, &pb);
1724 }
1725
1726 static int
1727 mcd_playblocks(int unit, struct ioc_play_blocks *p)
1728 {
1729         struct mcd_data *cd = mcd_data + unit;
1730         struct mcd_read2 pb;
1731
1732         if (cd->debug)
1733                 printf("mcd%d: playblocks: blkno %d length %d\n",
1734                     unit, p->blk, p->len);
1735
1736         if (p->blk > cd->disksize || p->len > cd->disksize ||
1737             p->blk < 0 || p->len < 0 ||
1738             (p->blk + p->len) > cd->disksize)
1739                 return EINVAL;
1740
1741         hsg2msf(p->blk, pb.start_msf);
1742         hsg2msf(p->blk + p->len, pb.end_msf);
1743
1744         if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
1745                 return EIO;
1746
1747         return mcd_play(unit, &pb);
1748 }
1749
1750 static int
1751 mcd_play(int unit, struct mcd_read2 *pb)
1752 {
1753         struct mcd_data *cd = mcd_data + unit;
1754         int com_port = cd->iobase + mcd_command;
1755         int retry, st = -1, status;
1756
1757         cd->lastpb = *pb;
1758         for(retry=0; retry<MCD_RETRYS; retry++) {
1759
1760                 cpu_disable_intr();
1761                 outb(com_port, MCD_CMDSINGLESPEEDREAD);
1762                 outb(com_port, pb->start_msf[0]);
1763                 outb(com_port, pb->start_msf[1]);
1764                 outb(com_port, pb->start_msf[2]);
1765                 outb(com_port, pb->end_msf[0]);
1766                 outb(com_port, pb->end_msf[1]);
1767                 outb(com_port, pb->end_msf[2]);
1768                 cpu_enable_intr();
1769
1770                 status=mcd_getstat(unit, 0);
1771                 if (status == -1)
1772                         continue;
1773                 else if (status != -2)
1774                         st = 0;
1775                 break;
1776         }
1777
1778         if (status == -2) {
1779                 printf("mcd%d: media changed\n", unit);
1780                 return ENXIO;
1781         }
1782         if (cd->debug)
1783                 printf("mcd%d: mcd_play retry=%d, status=0x%02x\n", unit, retry, status);
1784         if (st < 0)
1785                 return ENXIO;
1786         cd->audio_status = CD_AS_PLAY_IN_PROGRESS;
1787         return 0;
1788 }
1789
1790 static int
1791 mcd_pause(int unit)
1792 {
1793         struct mcd_data *cd = mcd_data + unit;
1794         struct mcd_qchninfo q;
1795         int rc;
1796
1797         /* Verify current status */
1798         if (cd->audio_status != CD_AS_PLAY_IN_PROGRESS &&
1799             cd->audio_status != CD_AS_PLAY_PAUSED) {
1800                 if (cd->debug)
1801                         printf("mcd%d: pause attempted when not playing, audio status %d\n",
1802                                unit, cd->audio_status);
1803                 return EINVAL;
1804         }
1805
1806         /* Get the current position */
1807         if (mcd_getqchan(unit, &q) < 0)
1808                 return EIO;
1809
1810         /* Copy it into lastpb */
1811         cd->lastpb.start_msf[0] = q.hd_pos_msf[0];
1812         cd->lastpb.start_msf[1] = q.hd_pos_msf[1];
1813         cd->lastpb.start_msf[2] = q.hd_pos_msf[2];
1814
1815         /* Stop playing */
1816         if ((rc=mcd_stop(unit)) != 0)
1817                 return rc;
1818
1819         /* Set the proper status and exit */
1820         cd->audio_status = CD_AS_PLAY_PAUSED;
1821         return 0;
1822 }
1823
1824 static int
1825 mcd_resume(int unit)
1826 {
1827         struct mcd_data *cd = mcd_data + unit;
1828
1829         if (cd->audio_status != CD_AS_PLAY_PAUSED)
1830                 return EINVAL;
1831         return mcd_play(unit, &cd->lastpb);
1832 }