freebsd-dev/sys/i386/isa/matcd/matcd.c
Eivind Eklund 1c413ddaf0 Fix 3-byte buffer overflow.
Also, while I'm here, fix up some more after those that haven't
noticed #endif isn't a comment introducer.
1998-12-13 23:36:16 +00:00

2750 lines
88 KiB
C

/*matcd.c--------------------------------------------------------------------
Matsushita(Panasonic) / Creative CD-ROM Driver (matcd)
Authored by Frank Durda IV
Copyright 1994, 1995 Frank Durda IV. All rights reserved.
"FDIV" is a trademark of Frank Durda IV.
Redistribution and use in source and binary forms, with or
without modification, are permitted provided that the following
conditions are met:
1. Redistributions of source code must retain the above copyright
notice positioned at the very beginning of this file without
modification, all copyright strings, all related programming
codes that display the copyright strings, this list of
conditions and the following disclaimer.
2. Redistributions in binary form must contain all copyright strings
and related programming code that display the copyright strings.
3. Redistributions in binary form must reproduce the above copyright
notice, this list of conditions and the following disclaimer in
the documentation and/or other materials provided with the
distribution.
4. All advertising materials mentioning features or use of this
software must display the following acknowledgement:
"The Matsushita/Panasonic CD-ROM driver was developed
by Frank Durda IV for use with "FreeBSD" and similar
operating systems."
"Similar operating systems" includes mainly non-profit oriented
systems for research and education, including but not restricted
to "NetBSD", "386BSD", and "Mach" (by CMU). The wording of the
acknowledgement (in electronic form or printed text) may not be
changed without permission from the author.
5. Absolutely no warranty of function, fitness or purpose is made
by the author Frank Durda IV.
6. Neither the name of the author nor the name "FreeBSD" may
be used to endorse or promote products derived from this software
without specific prior written permission.
(The author can be reached at bsdmail@nemesis.lonestar.org)
7. The product containing this software must meet all of these
conditions even if it is unsupported, not a complete system
and/or does not contain compiled code.
8. These conditions will be in force for the full life of the
copyright.
9. If all the above conditions are met, modifications to other
parts of this file may be freely made, although any person
or persons making changes do not receive the right to add their
name or names to the copyright strings and notices in this
software. Persons making changes are encouraged to insert edit
history in matcd.c and to put your name and details of the
change there.
10. You must have prior written permission from the author to
deviate from these terms.
Vendors who produce product(s) containing this code are encouraged
(but not required) to provide copies of the finished product(s) to
the author and to correspond with the author about development
activity relating to this code. Donations of development hardware
and/or software are also welcome. (This is one of the faster ways
to get a driver developed for a device.)
THIS SOFTWARE IS PROVIDED BY THE DEVELOPER(S) ``AS IS'' AND ANY
EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE DEVELOPER(S) BE
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
-----------------------------------------------------------------------------
Dedicated to: My family, my Grandfather,
and Max, my Golden Retriever
Thanks to: Jordan Hubbard (jkh) for getting me ramped-up to 2.x system
quickly enough to make the 2.1 release. He put up with
plenty of silly questions and might get the post of
ambassador some day.
and The people who donated equipment and other material to make
development of this driver possible. Donations and
sponsors for projects are appreciated.
-----No changes are allowed above this line------------------------------------
Edit History - (should be in sync with any source control log entries)
Never seen one of these before? Ok, here is how it works.
Every time you change the code, you increment the edit number,
that number over there in the <%d> and in the (%d) in the
version string. You never set this number lower than it is.
Near, or preferably on lines that change, insert the edit
number. If there is a number there already, you can replace it
with a newer one. This makes searches for code changes very fast.
In the edit history, start with the edit number, and a good
description of what changes were made. Then follow it with
the date, your name and an EMAIL address where you can be reached.
Please follow this practice; it helps leave understandable code in
your wake.
FYI, you have major and minor release codes. Major releases numbered
1 thru n. Major feature additions should get a new major release
number. Minor releases start with a null and then letters
A thru Z. So 3A(456) is Major release 3, Minor release 1,
Edit 456 (in Microsoft-ese that would be 03.01.456), and 5(731)
is Major release 5, Minor release 0, Edit 731. Typically only the
author will change the major and minor release codes in small
projects.
EDIT edit Edit HISTORY history History
<1> This initial version is to get basic filesystem I/O working
using the SoundBlaster 16 interface. The stand-alone adapter
card doesn't work yet.
December 1994 Frank Durda IV bsdmail@nemesis.lonestar.org
<2> Corrections to resolve a race condition when multiple drives
on the same controller was active. Fixed drive 1 & 2 swap
problem. See selectdrive().
21-Jan-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<3> Added automatic probing and support for all Creative Labs sound
cards with the Creative/Panasonic interface and the stand-alone
interface adapters. See AUTOHUNT and FULLCONFIG conditionals
for more information.
21-Jan-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<4> Rebundled debug conditionals.
14-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<5> Changes needed to work on FreeBSD 2.1. Also added draincmd
since some conditions cause the drive to produce surprise data.
See setmode and draincmd
19-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<6> Got rid of some redundant error code by creating chk_error().
Also built a nice generic bus-lock function.
20-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<7> Improved comments, general structuring.
Fixed a problem with disc eject not working if LOCKDRIVE was set.
Apparently the drive will reject an EJECT command if the drive
is LOCKED.
21-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
Edit number code marking begins here - earlier edits were during development.
<8> Final device name selected and actually made to compile under
>2.0. For newer systems, it is "matcd", for older it is "mat".
24-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<9> Added some additional disk-related ioctl functions that didn't
make it into earlier versions.
26-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<10> Updated some conditionals so the code will compile under
1.1.5.1, although this is not the supported platform.
Also found that some other devices probe code was changing the
settings for the port 0x302 debug board, so added code to set it
to a sane state before we use it.
26-Feb-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<11> The Copyright and Use statement has been replaced in all files
with a new version.
1-Mar-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<12> Added ioctls having to do with audio volume, routing and playback
speed. Also added some code I think is for dynamic loading.
12-Mar-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<13> Added ioctls to return TOC headers and entries.
19-Mar-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<14> More ioctls to finish out general audio support and some clean-up.
Also fixed a bug in open where CD label information would not
always be cleared after a disc change.
Added a check to block attempts to resume audio if already playing.
The resulting sound is a cross between Kryten and Max Headroom.
But, if you *want* this "feature", enable #define KRYTEN
in options.h.
So it is not BSD-ish enough, eh? What, too many comments? :-)
21-Mar-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<15> LOCKDRIVE has been modified so that a new series of minor
numbers are created. When these are opened, the selected
drive will have its door locked and the device must be completely
closed to unlock the media. The EJECT ioctl will be refused
when the drive is locked this way. This is useful for
servers and other places where the media needs to remain in the
drive. Bit 7 of the minor number controls locking.
As of this edit, the code compiles with no warnings with -Wall set.
22-Mar-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<16> Added a new check in the probe code that looks for the drive
interface being in an idle state after issuing a reset. If this
isn't the case, then the device at this location isn't a
Matsushita CD-ROM drive. This will prevent hangs in draincmd later.
Added the tray close ioctl. This required modifications to open
to allow the character devices to be "partially" opened so that
the close ioctl could be issued when the open would otherwise fail.
Close also delays slightly after completing because the drive
doesn't update its disc and media status instantly.
Also created the capability ioctl that lets an application find out
up front what things a drive can do.
Fixed a global spelling error.
Changed matcddriver structure to simply say "matcd". The original
string "matcd interface " broke the kernel -c boot mechanism.
Updated the #includes in response to a complaint in first release.
Updated and tested conditionals so that driver will still compile
under FreeBSD 1.1.5.1 as well as 2.0 and early 2.1.
4-Apr-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<17> The function matcd_toc_entries which is executed in response to
the CDIOREADTOCENTRYS ioctl didn't cope with programs that only
requested part of the TOC. This change is based on code submitted
by Doug Robson (dfr@render.com).
(This change was introduced out of order and exists in FreeBSD
2.0.5 without the version stamp being updated. I.N.M.F.)
1-Jun-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<18> While working on the TEAC CD-ROM driver (teaccd) that is reusing
chunks of code from this driver, I discovered several functions,
arrays and other things that should have been declared 'static'.
These changes are necessary if the TEAC CD-ROM driver is to be
present at the same time as matcd.
Also fixed the residual buss vs bus symbols and strings.
There are no functional code changes in this edit.
2-May-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<19> Creative has changed the Status port slightly in their
sound boards based on the Vibra-16 (and probably the Vibra-16S)
chipset. This change masks some unused bits that were formally
on all the time and are doing different things in this design.
The changes are transparent to all other supported boards.
20-Jun-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<20> Code was added to detect non-Creative (SoundBlaster) host
interfaces, and the driver will switch to code compatible with the
detected host interface. This should add support for MediaVision,
IBM, Reveal, and other compatible adapters with split
data/status-ports. This code allows a mix of SoundBlaster (Type 0)
and non-SoundBlaster (Type 1) boards in the same system with no
special configuration.
I also updated the attach code to display the interface type and
changed the host interface probe messages to reflect the "c" for
controller in controller-specific messages as the existing messages
were confusing when a second card was in place . The kernel -c
tables have been updated accordingly, so you now have a matcdc%d
controller to change settings on.
24-Jun-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<21> Added interface handling code in two of those "this should not
happen" routines, draincmd and get_stat. Since these routines are
called by functions during probing that may not know what type
interface is out there, the code assumes that a given adapter is
both a type 0 and a type 1 adapter at the same time. Plus,
this code gets executed once in a very long time so the cost of
assuming both host adapter types is not significant.
4-Jul-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<22> Four external interface prototypes were altered by someone else.
I believe these changes are for making GCC and/or the linker shut-up
when building some other part of the system since matcd already
compiles -Wall with no warnings...
8-Sep-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<23> This change implements the ioctls for preventing media removal
and allowing media removal.
Currently, these calls will work according to the following rules:
No "l" devs opened Any "l" dev open
CDALLOW accepted always rejected always
CDPREVENT accepted always accepted always
One refinement might be to allow CDALLOW/CDPREVENT to always
work if UID 0 issued the ioctl, but that will wait for later.
I also made a change to the information that the toc_entry code
returns so that xcdplayer won't malfunction. (It would not play
the last track on a non-mixed mode audio CD.) Unlike cdplayer,
xcdplayer asks for track information one track at a time, and
calls for information on the lead-out track by its official
number (0xaa), rather than referring to the "after last" (n+1) track
as cdplayer does. Anyway, this change should make both players
happy.
16-Sep-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<24> In Edit 15 when the extra devs were created for selective locking,
the door locking was broken if a non-locking dev on the drive is
closed. The problem was caused by not tracking locked devs and
non-locking devs as being different partitions. The change is to
simply use the locking dev bit to flag a set of shadow partitions
when it comes to lock operations. All other operations treat the
locked and unlocked partitions as being identical.
18-Sep-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<25> During work on Edit 23, I noted that on slow and very busy systems,
sometimes the driver would go to sleep forever. The problem appears
to have been a race condition caused by doing separate timeout/sleep
calls without using SPL first. The change here is to use tsleep
which provides the equivalent of timeout/sleep timeout/tsleep if the
last paremeter is tsleep is set to the time value that would have been
given to timeout.
I also fixed some duplicate location strings in the tsleep calls.
24-Sep-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<26> Moved a function declaration that generated two warnings with
the FULLCONFIG/FULLDRIVER conditionals disabled.
Updated the igot function so that it correctly reports limited
functions when a sub-set driver is compiled.
Eliminated FULLCONFIG conditional and now set controller counts
based on the NMATCD #define produced by the config process.
Also, disable the audio-related ioctls based on the BOOTMFS
conditional to help make the boot floppy kernel smaller.
18-Oct-95 Frank Durda IV bsdmail@nemesis.lonestar.org
<27> Incorporated changes needed to move the cdevsw and bdevsw
entries into the drivers (including this one). Also
include a quick first pass cut at DEVFS suppport.
---------------------------------------------------------------------------*/
/*Match this format: Version_dc(d)__dd-mmm-yy */
static char MATCDVERSION[]="Version 1(26) 18-Oct-95";
/* The following strings may not be changed*/
static char MATCDCOPYRIGHT[] = "Matsushita CD-ROM driver, Copr. 1994,1995 Frank Durda IV";
/* The proceeding strings may not be changed*/
/* $Id: matcd.c,v 1.36 1998/07/15 10:11:21 bde Exp $ */
/*---------------------------------------------------------------------------
Include declarations
---------------------------------------------------------------------------*/
#include "matcd.h"
#include "opt_devfs.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/buf.h>
#include <sys/dkbad.h>
#include <sys/cdio.h>
#include <sys/disklabel.h>
#include <sys/fcntl.h>
#include "i386/isa/matcd/options.h" /*Conditional compile options
and probe port hints*/
#include "i386/isa/matcd/matcddrv.h" /*Drive-related defs & strings*/
#include "i386/isa/matcd/creative.h" /*Host interface related defs*/
#include <sys/conf.h>
#include <sys/kernel.h>
#ifdef DEVFS
#include <sys/devfsext.h>
#endif /*DEVFS*/
#include <i386/isa/isa_device.h>
/*---------------------------------------------------------------------------
Defines and structures
---------------------------------------------------------------------------*/
#define DRIVESPERC 4 /*This is a constant*/
#define TOTALDRIVES NUMCTRLRS*DRIVESPERC /*Max possible drives*/
#define TICKRES 10 /*Our coarse timer resolution*/
#define ISABUSKHZ 8330 /*Number of IN/OUT ISA/sec*/
#define MAXTRKS 101 /*Maximum possible tracks*/
#define RAW_DEVICE 46 /*<16>Dev number for raw device*/
#define MATCDBLK 2048 /*Standard block size*/
#define MATCDRBLK 2352 /*Raw and/or DA block size*/
#define MATCD_RETRYS 5 /*Number of retries for read ops*/
#define MATCD_READ_1 0x80 /*Read state machine defines*/
#define MATCD_READ_2 0x90 /*Read state machine defines*/
struct matcd_volinfo {
unsigned char type; /*00 CD-DA or CD-ROM
10 CD-I
20 XA */
unsigned char trk_low; /*Normally 1*/
unsigned char trk_high; /*Highest track number*/
unsigned char vol_msf[3]; /*Size of disc in min/sec/frame*/
};
struct matcd_mbx {
short controller;
short ldrive;
short partition;
short port;
short iftype; /*<20>Host interface type*/
short retry;
short nblk;
int sz;
u_long skip;
struct buf *bp;
int p_offset;
short count;
};
static struct matcd_data {
short drivemode; /*Last state drive was set to*/
short flags;
short status; /*Last audio-related function*/
int blksize;
u_long disksize;
short iobase;
short iftype; /*<20>Host interface type*/
struct disklabel dlabel;
unsigned int partflags[MAXPARTITIONS];
unsigned int openflags;
struct matcd_volinfo volinfo;
struct matcd_mbx mbx;
u_char patch[2]; /*<12>Last known audio routing*/
u_char volume[2]; /*<12>Last known volume setting*/
#ifdef DEVFS
void *ra_devfs_token; /* handle for devfs entry */
void *rc_devfs_token;
void *a_devfs_token;
void *c_devfs_token;
void *rla_devfs_token;
void *rlc_devfs_token;
void *la_devfs_token;
void *lc_devfs_token;
#endif /* DEVFS */
} matcd_data[TOTALDRIVES];
/* Bit equates for matcd_data.flags*/
#define MATCDINIT 0x0001 /*Probe ran on host adapter*/
#define MATCDLABEL 0x0004 /*Valid TOC exists*/
#define MATCDLOCK 0x0008 /*<15>Drive door is locked*/
#define MATCDWARN 0x0020 /*Have reported an open disc change*/
/* Bit equates for matcd_data.partflags*/
#define MATCDOPEN 0x0001
#define MATCDREADRAW 0x0002
/* Error classes returned by chk_error()*/
#define ERR_RETRY 1 /*A retry might recover this*/
#define ERR_INIT 2 /*A retry certainly will get this*/
#define ERR_FATAL 3 /*This cannot be recovered from*/
static struct buf_queue_head request_head[NUMCTRLRS]; /*<18>A queue for each host interface*/
static int nextcontroller=0; /*<18>Number of interface units found*/
static int drivepresent=0; /*<18>Don't change this - see license*/
static int iftype; /*<20>Probe/Attach i.f. type relay*/
static unsigned char if_state[4]={0,0,0,0}; /*<18>State of the host I/F and bus*/
/* Flags in the if_state array
*/
#define BUSBUSY 0x01 /*<18>Bus is already busy*/
struct matcd_read2 {
unsigned char start_msf[3];
unsigned char end_msf[3];
};
/* This mystery structure is supposed to make dynamic driver
loading possible.
*/
/*---------------------------------------------------------------------------
These macros take apart the minor number and yield the
partition, drive on controller, and controller.
This must match the settings in /dev/MAKEDEV.
---------------------------------------------------------------------------*/
#define matcd_partition(dev) ((minor(dev)) & 0x07)
#define matcd_ldrive(dev) (((minor(dev)) & 0x78) >> 3)
#define matcd_cdrive(dev) (((minor(dev)) & 0x18) >> 3)
#define matcd_controller(dev) (((minor(dev)) & 0x60) >> 5)
#ifdef LOCKDRIVE
#define matcd_lockable(dev) (((minor(dev)) & 0x80) >> 5)
#endif /*LOCKDRIVE*/
/*---------------------------------------------------------------------------
Entry points and other connections to/from kernel - see also conf.h
--- not any more :)
---------------------------------------------------------------------------*/
static int matcd_probe(struct isa_device *dev);
static int matcd_attach(struct isa_device *dev);
struct isa_driver matcddriver={matcd_probe, matcd_attach,
"matcdc"};
static d_open_t matcdopen;
static d_read_t matcdread;
static d_close_t matcdclose;
static d_ioctl_t matcdioctl;
static d_psize_t matcdsize;
static d_strategy_t matcdstrategy;
#define CDEV_MAJOR 46
#define BDEV_MAJOR 17
static struct cdevsw matcd_cdevsw = {
matcdopen, matcdclose, matcdread, nowrite,
matcdioctl, nostop, nullreset, nodevtotty,
seltrue, nommap, matcdstrategy, "matcd",
NULL, -1, nodump, nopsize,
D_DISK, 0, -1 };
/*---------------------------------------------------------------------------
Internal function declarations
---------------------------------------------------------------------------*/
static void matcd_drvinit(void *unused);
static void matcd_start(int controller);
static void zero_cmd(char *);
static void matcd_pread(int port, int count, unsigned char * data);
static int matcd_fastcmd(int port,int ldrive,int cdrive,
unsigned char * cp);
static void matcd_slowcmd(int port,int ldrive,int cdrive,
unsigned char * cp);
static timeout_t matcd_timeout;
static void matcd_blockread(int state);
static void selectdrive(int port,int drive);
static void doreset(int port,int cdrive);
static int doprobe(int port,int cdrive);
static void lockbus(int controller, int ldrive);
static void unlockbus(int controller, int ldrive);
static int matcd_volinfo(int ldrive);
static void draincmd(int port,int cdrive,int ldrive);
static int get_error(int port, int ldrive, int cdrive);
static int chk_error(int errnum);
static int msf_to_blk(unsigned char * cd);
#ifdef FULLDRIVER
static int matcd_playtracks(int ldrive, int cdrive, int controller,
struct ioc_play_track *pt);
static int matcd_playmsf(int ldrive, int cdrive, int controller,
struct ioc_play_msf *pt);
static int matcd_pause(int ldrive, int cdrive, int controller,
int action);
static int matcd_stop(int ldrive, int cdrive, int controller);
static int matcd_level(int ldrive, int cdrive, int controller,
struct ioc_vol * volume, unsigned long action);
static int matcd_patch(int ldrive, int cdrive, int controller,
struct ioc_patch * routing);
static int matcd_route(int ldrive, int cdrive, int controller,
unsigned long command);
static int matcd_pitch(int ldrive, int cdrive, int controller,
struct ioc_pitch * speed);
#endif /*FULLDRIVER*/
static int matcd_toc_header(int ldrive, int cdrive, int controller,
struct ioc_toc_header * toc);
static int matcd_toc_entries(int ldrive, int cdrive,
int controller,
struct ioc_read_toc_entry *ioc_entry);
static int matcd_toc_entry(int ldrive, int cdrive,
int controller,
struct ioc_read_toc_single_entry *ioc_entry);
static int matcd_read_subq(int ldrive, int cdrive, int controller,
struct ioc_read_subchannel * sqp);
static int matcd_igot(struct ioc_capability * sqp);
static int waitforit(int timelimit, int state, int port,
char * where);
static int get_stat(int port, int ldrive);
static int media_chk(struct matcd_data *cd,int errnum,
int ldrive,int test);
static int matcd_eject(int ldrive, int cdrive, int controller);
static int matcd_doorclose(int ldrive, int cdrive, int controller);
static int matcd_dlock(int ldrive, int cdrive,
int controller, int action);
static int docmd(char * cmd, int ldrive, int cdrive,
int controller, int port);
/*---------------------------------------------------------------------------
matcdopen - Open the device
This routine actually gets called every time anybody opens
any partition on a drive. But the first call is the one that
does all the work.
<15> If LOCKDRIVE is enabled, additional minor number devices allow
<15> the drive to be locked while being accessed.
---------------------------------------------------------------------------*/
int matcdopen(dev_t dev, int flags, int fmt,
struct proc *p)
{
int cdrive,ldrive,partition,controller,lock;
struct matcd_data *cd;
int i,z,port;
unsigned char cmd[MAXCMDSIZ];
ldrive=matcd_ldrive(dev);
cdrive=matcd_cdrive(dev);
partition=matcd_partition(dev);
controller=matcd_controller(dev);
lock=matcd_lockable(dev);
cd= &matcd_data[ldrive];
port=cd->iobase; /*and port#*/
if (ldrive >= TOTALDRIVES) return(ENXIO);
#ifdef DEBUGOPEN
printf("matcd%d: Open: dev %x partition %x controller %x flags %x cdrive %x\n",
ldrive,(int)dev,partition,controller,cd->flags,
matcd_cdrive(dev));
#endif /*DEBUGOPEN*/
if (!(cd->flags & MATCDINIT)) { /*Did probe find this drive*/
return(ENXIO);
}
if (!(cd->flags & MATCDLABEL) &&
cd->openflags) { /*Has drive completely closed?*/
return(ENXIO); /*No, all partitions must close*/
}
/* Now, test to see if the media is ready
*/
lockbus(controller,ldrive);
zero_cmd(cmd);
cmd[0]=NOP; /*Test drive*/
matcd_slowcmd(port,ldrive,cdrive,cmd);
i=waitforit(10*TICKRES,DTEN,port,"matopen");
z=get_stat(port,ldrive); /*Read status byte*/
#ifdef DEBUGOPEN
printf("matcd%d Result of NOP is %x %x\n",ldrive,i,z);
#endif /*DEBUGOPEN*/
if ((z & MATCD_ST_DSKIN)==0) { /*Is there a disc in the drive?*/
#ifdef DEBUGOPEN
printf("matcd%d: No Disc in open\n",ldrive);
#endif /*DEBUGOPEN*/
unlockbus(controller, ldrive); /*Release bus lock*/
cd->flags &= ~MATCDLABEL; /*<16>Mark label as invalid*/
if (major(dev)==RAW_DEVICE) { /*<16>Is the char device?*/
return(0); /*<16>Allow Semi open*/
}
else {
return(ENXIO); /*<16>Normally blow off*/
}
}
if (z & MATCD_ST_ERROR) { /*Was there an error*/
i=get_error(port,ldrive,cdrive);/*Find out what it was*/
#ifdef DEBUGOPEN
printf("matcd%d NOP Error was %x\n",ldrive,i);
#endif /*DEBUGOPEN*/
if (cd->openflags) { /*Any parts open?*/
if (media_chk(cd,i,ldrive,0)) { /*<14>Was it a disc chg?*/
#ifdef DEBUGOPEN
printf("matcd%d: Disc change detected i %x z %x\n",
ldrive,i,z);
#endif /*DEBUGOPEN*/
unlockbus(controller, ldrive); /*Release bus lock*/
return(ENOTTY);
}
} else {
media_chk(cd,i,ldrive,1);/*<14>Was it a disc chg?*/
/*<14>Clear volume info*/
}
}
unlockbus(controller, ldrive); /*Release bus lock*/
/* Here we fill in the disklabel structure although most is
hardcoded.
*/
if ((cd->flags & MATCDLABEL)==0) {
bzero(&cd->dlabel,sizeof(struct disklabel));
/* Now we query the drive for the actual size of the media.
This is where we find out of there is any media or if the
media isn't a Mode 1 or Mode 2/XA disc.
See version information about Mode 2/XA support.
*/
lockbus(controller,ldrive);
i=matcdsize(dev);
unlockbus(controller, ldrive); /*Release bus lock*/
#ifdef DEBUGOPEN
printf("matcd%d: Bus unlocked in open\n",ldrive);
#endif /*DEBUGOPEN*/
if (i < 0) {
printf("matcd%d: Could not read the disc size\n",ldrive);
return(ENXIO);
} /*matcdsize filled in rest of dlabel*/
/* Based on the results, fill in the variable entries in the disklabel
*/
cd->dlabel.d_secsize=cd->blksize;
cd->dlabel.d_ncylinders=(cd->disksize/100)+1;
cd->dlabel.d_secperunit=cd->disksize;
cd->dlabel.d_partitions[0].p_size=cd->disksize;
cd->dlabel.d_checksum=dkcksum(&cd->dlabel);
/* Now fill in the hardcoded section
*/
/*123456789012345678*/
strncpy(cd->dlabel.d_typename,"Matsushita CDR ",16);
strncpy(cd->dlabel.d_packname,"(c) 1994, fdiv ",16);
cd->dlabel.d_magic=DISKMAGIC;
cd->dlabel.d_magic2=DISKMAGIC;
cd->dlabel.d_nsectors=100;
cd->dlabel.d_secpercyl=100;
cd->dlabel.d_ntracks=1;
cd->dlabel.d_interleave=1;
cd->dlabel.d_rpm=300;
cd->dlabel.d_npartitions=1; /*See note below*/
cd->dlabel.d_partitions[0].p_offset=0;
cd->dlabel.d_partitions[0].p_fstype=9;
cd->dlabel.d_flags=D_REMOVABLE;
/* I originally considered allowing the partition match tracks or
sessions on the media, but since you are allowed up to 99
tracks in the RedBook world, this would not fit in with the
BSD fixed partition count scheme. So ioctls will be used to shift
the track to be accessed into partition 1.
*/
cd->flags |= MATCDLABEL; /*Mark drive as having TOC*/
}
#ifdef DEBUGOPEN
printf("matcd%d open2: partition=%d disksize=%d blksize=%x flags=%x\n",
ldrive,partition,(int)cd->disksize,cd->blksize,cd->flags);
#endif /*DEBUGOPEN*/
#ifdef LOCKDRIVE
if (cd->openflags==0 && lock) {
zero_cmd(cmd);
cmd[0]=LOCK; /*Lock drive*/
cmd[1]=1;
docmd(cmd,ldrive,cdrive,controller,port);/*<15>Issue cmd*/
cd->flags |= MATCDLOCK; /*<15>Drive is now locked*/
}
#endif /*LOCKDRIVE*/
cd->openflags |= (1<<(partition+lock));/*<24>Mark partition open*/
if (partition==RAW_PART ||
(partition < cd->dlabel.d_npartitions &&
cd->dlabel.d_partitions[partition].p_fstype != FS_UNUSED)) {
cd->partflags[partition] |= MATCDOPEN;
if (partition == RAW_PART) {
cd->partflags[partition] |= MATCDREADRAW;
}
#ifdef DEBUGOPEN
printf("matcd%d: Open is complete - openflags %x\n",
ldrive,cd->openflags);
#endif /*DEBUGOPEN*/
return(0);
}
#ifdef DEBUGOPEN
printf("matcd%d: Open FAILED\n",ldrive);
#endif /*DEBUGOPEN*/
return(ENXIO);
}
/*---------------------------------------------------------------------------
matcdclose - Close the device
Close may not do much other than clear some driver settings.
Note that audio playback will continue.
<15> If you define LOCKDRIVE, and the drive has been opened using
<15> one of the locking minor numbers, code in close will unlock
<15> the drive.
---------------------------------------------------------------------------*/
int matcdclose(dev_t dev, int flags, int fmt,
struct proc *p)
{
int ldrive,cdrive,port,partition,controller,lock;
struct matcd_data *cd;
#ifdef LOCKDRIVE
unsigned char cmd[MAXCMDSIZ];
#endif /*LOCKDRIVE*/
ldrive=matcd_ldrive(dev);
cdrive=matcd_cdrive(dev);
lock=matcd_lockable(dev);
cd=matcd_data+ldrive;
port=cd->iobase; /*and port#*/
if (ldrive >= TOTALDRIVES)
return(ENXIO);
partition = matcd_partition(dev);
controller=matcd_controller(dev);
#ifdef DEBUGOPEN
printf("matcd%d: Close partition=%d flags %x openflags %x partflags %x\n",
ldrive,partition,cd->flags,cd->openflags,
cd->partflags[partition]);
#endif /*DEBUGOPEN*/
if (!(cd->flags & MATCDINIT))
return(ENXIO);
cd->partflags[partition] &= ~(MATCDOPEN|MATCDREADRAW);
cd->openflags &= ~(1<<(partition+lock));
if (cd->openflags==0) { /*<24>Really last close?*/
#ifdef LOCKDRIVE
if (cd->flags & MATCDLOCK) { /*<24>Was drive locked?*/
zero_cmd(cmd); /*Yes, so unlock it*/
cmd[0]=LOCK; /*Unlock drive*/
docmd(cmd,ldrive,cdrive,controller,port);
}
#endif /*LOCKDRIVE*/
cd->flags &= ~(MATCDWARN|MATCDLOCK);
/*<15>Clear warning flag*/
}
return(0);
}
static int
matcdread(dev_t dev, struct uio *uio, int ioflag)
{
return (physio(matcdstrategy, NULL, dev, 1, minphys, uio));
}
/*---------------------------------------------------------------------------
matcdstrategy - Accepts I/O requests from kernel for processing
This routine accepts a read request block pointer (historically
but somewhat inaccurately called *bp for buffer pointer).
Various sanity checks are performed on the request.
When we are happy with the request and the state of the device,
the request is added to the queue of requests for the interface
that the drive is connected to. We support multiple interfaces
so there are multiple queues. Once the request is added, we
call the matcd_start routine to start the device in case it isn't
doing something already. All I/O including ioctl requests
rely on the current request starting the next one before exiting.
---------------------------------------------------------------------------*/
void matcdstrategy(struct buf *bp)
{
struct matcd_data *cd;
int s;
int ldrive,controller;
ldrive=matcd_ldrive(bp->b_dev);
controller=matcd_controller(bp->b_dev);
cd= &matcd_data[ldrive];
#ifdef DEBUGIO
printf("matcd%d: Strategy: buf=0x%lx, block#=%ld bcount=%ld\n",
ldrive,(unsigned long)bp,bp->b_blkno,bp->b_bcount);
#endif /*DEBUGIO*/
if (ldrive >= TOTALDRIVES || bp->b_blkno < 0) {
printf("matcd%d: Bogus parameters received - kernel may be corrupted\n",ldrive);
bp->b_error=EINVAL;
goto bad;
}
if (!(cd->flags & MATCDLABEL)) {
bp->b_error = EIO;
goto bad;
}
if (!(bp->b_flags & B_READ)) {
bp->b_error = EROFS;
goto bad;
}
if (bp->b_bcount==0) /*Request is zero-length - all done*/
goto done;
if (matcd_partition(bp->b_dev) != RAW_PART) {
if (bounds_check_with_label(bp,&cd->dlabel,1) <= 0) {
goto done;
}
} else {
bp->b_pblkno=bp->b_blkno;
bp->b_resid=0;
}
s=splbio(); /*Make sure we don't get intr'ed*/
bufqdisksort(&request_head[controller], bp);/*Add new request (bp) to queue (dp
and sort the requests in a way that
may not be ideal for CD-ROM media*/
matcd_start(controller); /*Ok, with our newly sorted queue,
see if we can start an I/O operation
right now*/
splx(s); /*Return priorities to normal*/
return; /*All done*/
bad: bp->b_flags |= B_ERROR; /*Request bad in some way*/
done: bp->b_resid = bp->b_bcount; /*Show amount of data un read*/
biodone(bp); /*Signal we have done all we plan to*/
return;
}
/*---------------------------------------------------------------------------
matcd_start - Pull a request from the queue and consider doing it.
---------------------------------------------------------------------------*/
static void matcd_start(int controller)
{
struct matcd_data *cd;
struct buf *bp;
struct partition *p;
int part,ldrive;
bp = bufq_first(&request_head[controller]);
if (bp == NULL) { /*Nothing on read queue to do?*/
wakeup((caddr_t)&matcd_data->status); /*Wakeup any blocked*/
return; /* opens, ioctls, etc*/
}
ldrive=matcd_ldrive(bp->b_dev); /*Get logical drive#*/
cd=&matcd_data[ldrive]; /*Get pointer to data for this drive*/
#ifdef DEBUGIO
printf("matcd%d: In start controller %d\n",ldrive,controller);
#endif /*DEBUGIO*/
if (if_state[controller] & BUSBUSY) {
#ifdef DEBUGIO
printf("matcd%d: Dropping thread in start, controller %d\n",
ldrive,controller);
#endif /*DEBUGIO*/
return;
}
/* Ok, the controller is idle (not necessarily the drive) and so
get the command to do and issue it
*/
bufq_remove(&request_head[controller], bp);
part=matcd_partition(bp->b_dev);
p=cd->dlabel.d_partitions + part;
if_state[controller] |= BUSBUSY;/*<18>Mark bus as busy*/
cd->mbx.ldrive=ldrive; /*Save current logical drive*/
cd->mbx.controller=controller; /*and controller*/
cd->mbx.partition=part; /*and partition (2048 vs 2532)*/
cd->mbx.port=cd->iobase; /*and port#*/
cd->mbx.iftype=cd->iftype; /*<20>interface type*/
cd->mbx.retry=MATCD_RETRYS; /*and the retry count*/
cd->mbx.bp=bp; /*and the bp*/
cd->mbx.p_offset=p->p_offset; /*and where the data will go*/
matcd_blockread(MATCD_READ_1+ldrive); /*Actually start the read*/
return; /*Dropping thread. matcd_blockread
must have scheduled a timeout or
we will go to sleep forever*/
}
/*---------------------------------------------------------------------------
matcdioctl - Process things that aren't block reads
In this driver, ioctls are used mainly to change
the mode the drive is running in, play audio and other
things that don't fit into the block read scheme of things.
---------------------------------------------------------------------------*/
int matcdioctl(dev_t dev, u_long command, caddr_t addr,
int flags, struct proc *p)
{
struct matcd_data *cd;
int ldrive,cdrive,partition;
int port, controller;
#ifdef DEBUGIOCTL
int i;
#endif /*DEBUGIOCTL*/
ldrive=matcd_ldrive(dev);
cdrive=matcd_cdrive(dev);
partition=matcd_partition(dev);
controller=ldrive>>2;
cd = &matcd_data[ldrive];
port=cd->iobase;
#ifdef DEBUGIOCTL
printf("matcd%d: ioctl %lx cdrive %x parms ",ldrive,command,cdrive);
for (i=0;i<10;i++) {
printf("%02x ",(unsigned int)addr[i]);
}
printf(" flags %x\n",cd->flags);
#endif /*DEBUGIOCTL*/
if (command==CDIOCCLOSE) /*<16>Allow close if door open*/
return(matcd_doorclose(ldrive, cdrive, controller));
if (!(cd->flags & MATCDLABEL)) /*Did we read TOC OK?*/
return(EIO); /*<16>then drive really isn't ready*/
switch(command) {
case DIOCSBAD:
return(EINVAL);
case DIOCGDINFO:
*(struct disklabel *) addr = cd->dlabel;
return(0);
case DIOCGPART:
((struct partinfo *) addr)->disklab=&cd->dlabel;
((struct partinfo *) addr)->part=
&cd->dlabel.d_partitions[matcd_partition(dev)];
return(0);
case DIOCWDINFO:
case DIOCSDINFO:
if ((flags & FWRITE) == 0) {
return(EBADF);
}
else {
return setdisklabel(&cd->dlabel,
(struct disklabel *) addr, 0);
}
case DIOCWLABEL:
return(EBADF);
case CDIOCEJECT:
return(matcd_eject(ldrive, cdrive, controller));
case CDIOCALLOW:
return(matcd_dlock(ldrive, cdrive,
controller,0));
case CDIOCPREVENT:
return(matcd_dlock(ldrive, cdrive,
controller, MATCDLOCK));
#ifdef FULLDRIVER
case CDIOCPLAYTRACKS:
return(matcd_playtracks(ldrive, cdrive, controller,
(struct ioc_play_track *) addr));
case CDIOCPLAYMSF:
return(matcd_playmsf(ldrive, cdrive, controller,
(struct ioc_play_msf *) addr));
case CDIOCRESUME:
return(matcd_pause(ldrive, cdrive, controller,RESUME));
case CDIOCPAUSE:
return(matcd_pause(ldrive, cdrive, controller,0));
case CDIOCSTOP:
return(matcd_stop(ldrive, cdrive, controller));
case CDIOCGETVOL:
case CDIOCSETVOL:
return(matcd_level(ldrive, cdrive, controller,
(struct ioc_vol *) addr, command));
case CDIOCSETMONO: /*<12>This drive can't do mono*/
return(EINVAL); /*<12>but it looks like it should*/
/*<12>SRC OUT SRC OUT*/
case CDIOCSETSTEREO: /*<12>0 -> L 1 -> R*/
case CDIOCSETMUTE: /*<12>0 -> NULL 1 -> NULL*/
case CDIOCSETLEFT: /*<12>0 -> L&R 1 -> NULL*/
case CDIOCSETRIGHT: /*<12>0 -> NULL 1 -> L&R*/
/*<12>Adjust audio routing*/
return(matcd_route(ldrive, cdrive, controller, command));
case CDIOCSETPATCH: /*<12>Allow precise routing*/
return(matcd_patch(ldrive, cdrive, controller,
(struct ioc_patch *) addr));
case CDIOCPITCH: /*<12>Adjust playback speed*/
return(matcd_pitch(ldrive, cdrive, controller,
(struct ioc_pitch *) addr));
case CDIOCSTART: /*<12>Only reason this isn't*/
return(EINVAL); /*<12>implemented is I can't find out*/
/*<12>what it should do!*/
#endif /*FULLDRIVER*/
case CDIOREADTOCHEADER:
return(matcd_toc_header(ldrive, cdrive, controller,
(struct ioc_toc_header *) addr));
case CDIOREADTOCENTRYS:
return(matcd_toc_entries(ldrive, cdrive, controller,
(struct ioc_read_toc_entry *) addr));
case CDIOREADTOCENTRY:
return(matcd_toc_entry(ldrive, cdrive, controller,
(struct ioc_read_toc_single_entry *) addr));
case CDIOCREADSUBCHANNEL:
return(matcd_read_subq(ldrive, cdrive, controller,
(struct ioc_read_subchannel *) addr));
case CDIOCCAPABILITY: /*<16>Request drive/driver capability*/
return(matcd_igot((struct ioc_capability *) addr));
case CDIOCRESET: /*<12>There is no way to hard reset*/
return(EINVAL); /*<12>just one drive*/
default:
return(ENOTTY);
}
}
/*---------------------------------------------------------------------------
matcdsize - Reports how many blocks exist on the disc.
---------------------------------------------------------------------------*/
int matcdsize(dev_t dev)
{
int size,blksize;
int ldrive,part;
struct matcd_data *cd;
ldrive=matcd_ldrive(dev);
part=matcd_partition(dev);
if (part==RAW_PART)
blksize=MATCDRBLK; /*2352*/
else
blksize=MATCDBLK; /*2048*/
cd = &matcd_data[ldrive];
if (matcd_volinfo(ldrive) >= 0) {
cd->blksize=blksize;
size=msf_to_blk((char * )&cd->volinfo.vol_msf);
cd->disksize=size*(blksize/DEV_BSIZE);
#ifdef DEBUGOPEN
printf("matcd%d: Media size %d\n",ldrive,size);
#endif /*DEBUGOPEN*/
return(0);
}
return(-1);
}
/*---------------------------------------------------------------------------
matcd_probe - Search for host interface/adapters
The probe routine hunts for the first drive on the interface since
there is no way to locate just the adapter. It also resets the
entire drive chain while it is there. matcd_attach() takes care of
the rest of the initialization.
The probe routine can be compiled two ways. In AUTOHUNT mode,
the kernel config file can say "port?" and we will check all ports
listed in the port_hint array (see above).
Without AUTOHUNT set, the config file must list a specific port
address to check.
Note that specifying the explicit addresses makes boot-up a lot
faster.
The probe will locate Panasonic/Creative interface on the following
Creative adapter boards:
#1330A Sound Blaster PRO
#1730 Sound Blaster 16
#1740 Sound Blaster 16 (cost reduced)
#2230 Sound Blaster 16 (cost reduced)
#2770 Sound Blaster 16 Value (cost reduced)
#1810 omniCD upgrade kit adapter card (stand-alone CD)
#3100 PhoneBlaster SB16 + Sierra 14.4K modem combo
Creative releases a newer and cheaper-to-make Sound Blaster
board every few months, so by the original release date of this
software, there are probably 8 different board models called
Sound Blaster 16. These include "Vibra", "Value", etc.
Please report additional part numbers and board descriptions
and new port numbers that work to the author.
---------------------------------------------------------------------------*/
static int
matcd_probe(struct isa_device *dev)
{
int i,cdrive;
unsigned char y;
int port = dev->id_iobase; /*Take port hint from config file*/
cdrive=nextcontroller; /*Controller defined by pass for now*/
if (nextcontroller==NUMCTRLRS) {
printf("matcdc%d: - Too many interfaces specified in config\n",
nextcontroller);
return(0);
}
if (nextcontroller==0) { /*Very first time to be called*/
for (i=0; i<TOTALDRIVES; i++) {
matcd_data[i].drivemode=MODE_UNKNOWN;
matcd_data[i].flags=0;
}
}
i=nextcontroller*DRIVESPERC; /*Precompute controller offset*/
for (y=0; y<DRIVESPERC; y++) {
matcd_data[i+y].flags=0;
}
#ifdef DEBUGPROBE
printf("matcdc%d: In probe i %d y %d port %x\n",
nextcontroller,i,y,port);
#endif /*DEBUGPROBE*/
#ifdef AUTOHUNT
#ifdef DEBUGPROBE
printf("matcd%d: size of port_hints %d\n",
nextcontroller,sizeof(port_hints));
#endif /*DEBUGPROBE*/
if (port==-1) {
for(i=0;i<(sizeof(port_hints)/sizeof(short));i++) {
port=port_hints[i];
#ifdef DEBUGPROBE
printf("matcdc%d: Port hint %x\n",nextcontroller,port);
#endif /*DEBUGPROBE*/
if (port==-1) {
dev->id_iobase=-1; /*Put port ? back*/
return(0);/*Nothing left to try*/
}
if (port!=0) { /*Untested port found*/
dev->id_iobase=port;
port_hints[i]=0;/*Don't use that port again*/
if (doprobe(port,cdrive)==0) return(NUMPORTS);
}
}
dev->id_iobase=-1; /*Put port ? back as it was*/
return(0); /*Interface not found*/
} else { /*Config specified a port*/
i=0; /*so eliminate it from the hint list*/
for(i=0;;i++) { /*or we might try to assign it again*/
if (port_hints[i]== -1) break; /*End of list*/
if (port_hints[i]==port) {
port_hints[i]=0; /*Clear duplicate*/
break;
}
}
if (doprobe(port,cdrive)==0) return(NUMPORTS);
else return(0);
}
#else /*AUTOHUNT*/
if (port==-1) {
printf("matcdc%d: AUTOHUNT disabled but port? specified in config\n",
nextcontroller);
return(0);
}
if (doprobe(port,cdrive)==0) return(NUMPORTS);
else return(0);
#endif /*AUTOHUNT*/
}
/*---------------------------------------------------------------------------
doprobe - Common probe code that actually checks the ports we
have decided to test.
<20> Edit 20 changes adds code to determine if the host interface
is one that behaves like the Creative SoundBlaster cards,
or whether the host interface like those used by some boards
made by Media Vision and a version known as Lasermate.
---------------------------------------------------------------------------*/
int doprobe(int port,int cdrive)
{
unsigned char cmd[MAXCMDSIZ];
int i;
#ifdef RESETONBOOT
doreset(port,cdrive); /*Reset what might be our device*/
#endif /*RESETONBOOT*/
outb(port+PHASE,0); /*<16>Guarantee status phase*/
zero_cmd(cmd);
cmd[0]=NOP; /*A reasonably harmless command.
This command will fail after
power-up or after reset. That's OK*/
#ifdef RESETONBOOT
if (((inb(port+STATUS) & (DTEN|STEN)) != (DTEN|STEN)) ||
(inb(port+DATA) != 0xff))
return(-1); /*<20>Something detected but it isn't
the device we wanted*/
#endif /*RESETONBOOT*/
if (matcd_fastcmd(port,0,0,cmd)==0) {/*Issue command*/
outb(port+PHASE,1); /*<20>Switch to Creative Data phase*/
i=inb(port+CMD); /*<20>Read a byte in data phase*/
outb(port+PHASE,0); /*<20>Switch to Creative Status phase*/
if ((inb(port+STATUS) & (DTEN|STEN))
== (DTEN|STEN)) { /*<20>Drive went idle*/
iftype=1; /*<20>It is not a Creative interface.*/
} else { /*<20>Status byte still available*/
iftype=0;
inb(port+CMD); /*<20>Read status byte*/
}
#ifdef DEBUGPROBE
printf("matcdc%d: Probe found something\n",nextcontroller);
#endif /*DEBUGPROBE*/
/*------Don't change anything below this line - see license -----------------*/
if (drivepresent==0) { /*Don't change*/
printf("matcd - Matsushita (Panasonic) CD-ROM Driver by FDIV, %s\n",
/*Don't change*/
MATCDVERSION); /*Don't change*/
drivepresent++; /*Don't change*/
if (drivepresent==0) /*Don't change - make LINT happy*/
printf("%s\n",MATCDCOPYRIGHT); /*Don't change*/
} /*Don't change*/
/*------Don't change anything above this line - see license -----------------*/
return(0); /*Drive 0 detected*/
}
#ifdef DEBUGPROBE
printf("matcdc%d: Probe DID NOT find something\n",nextcontroller);
#endif /*DEBUGPROBE*/
return(1);
}
/*---------------------------------------------------------------------------
matcd_attach - Locates drives on the adapters that were located.
If we got here, we located an interface and at least one
drive. Now we figure out how many drives are under that
interface. The Panasonic interface is too simple to call
it a controller, but in the existing PDP model, that is
what it would be.
---------------------------------------------------------------------------*/
static int
matcd_attach(struct isa_device *dev)
{
int i;
unsigned int z,cdrive;
unsigned char cmd[MAXCMDSIZ];
unsigned char data[12];
struct matcd_data *cd;
int port = dev->id_iobase; /*Take port ID selected in probe()*/
#ifdef DEBUGPROBE
printf("matcdc: Attach dev %x id_unit %d\n",
(unsigned int)dev,dev->id_unit);
#endif /*DEBUGPROBE*/
printf("matcdc%d Host interface type %d\n",
nextcontroller,iftype);
bufq_init(&request_head[nextcontroller]);
for (cdrive=0; cdrive<4; cdrive++) { /*We're hunting drives...*/
zero_cmd(cmd);
cmd[0]=NOP; /*A reasonably harmless command.
This command will fail after
power-up or after reset. It's OK*/
i=cdrive+(DRIVESPERC*nextcontroller);
if (matcd_fastcmd(port,i,cdrive,cmd)==0) { /*Issue cmd*/
z=get_stat(port,cdrive);/*Read status byte*/
if ((z & MATCD_ST_ERROR)) { /*If there was an error,
we must ask for error info
or subsequent cmds fail*/
zero_cmd(cmd);
cmd[0]=READERROR; /*Inquire*/
matcd_fastcmd(port,i,cdrive,cmd);
matcd_pread(port,8,data);/*Read data returned*/
z=get_stat(port,i);/*Read status byte*/
#ifdef DEBUGPROBE
printf("matcd%d: Status byte %x ",i,z);
#endif /*DEBUGPROBE*/
}
zero_cmd(cmd);
cmd[0]=READID; /*Get drive ID*/
matcd_fastcmd(port,i,cdrive,cmd);
matcd_pread(port,10,data);/*Read Drive Parm*/
get_stat(port,i); /*Read and toss status byte*/
data[10]=0; /*Build ASCIZ string*/
printf("matcd%d: [%s] ",i,data);
cd=&matcd_data[i];
cd->flags |= MATCDINIT;
cd->iobase=dev->id_iobase;
cd->iftype=iftype;
cd->openflags=0;
cd->volume[0]=cd->volume[1]=DEFVOL;
/*<12>Match volume drive resets to*/
cd->patch[0]=0x01; /*<12>Channel 0 to Left*/
cd->patch[1]=0x02; /*<12>Channel 1 to Right*/
cd->status=CD_AS_NO_STATUS;
for (i=0; i<MAXPARTITIONS; i++) {
cd->partflags[i]=0;
}
#ifdef DEVFS
cd->ra_devfs_token = devfs_add_devswf(&matcd_cdevsw,
dkmakeminor(i, 0, 0), DV_CHR,
UID_ROOT, GID_OPERATOR, 0640, "rmatcd%da", i);
cd->rc_devfs_token = devfs_add_devswf(&matcd_cdevsw,
dkmakeminor(i, 0, RAW_PART), DV_CHR,
UID_ROOT, GID_OPERATOR, 0640, "rmatcd%dc", i);
cd->a_devfs_token = devfs_add_devswf(&matcd_cdevsw,
dkmakeminor(i, 0, 0), DV_BLK,
UID_ROOT, GID_OPERATOR, 0640, "matcd%da", i);
cd->c_devfs_token = devfs_add_devswf(&matcd_cdevsw,
dkmakeminor(i, 0, RAW_PART), DV_BLK,
UID_ROOT, GID_OPERATOR, 0640, "matcd%dc", i);
cd->rla_devfs_token = devfs_add_devswf(&matcd_cdevsw,
0x80 | dkmakeminor(i, 0, 0), DV_CHR,
UID_ROOT, GID_OPERATOR, 0640, "rmatcd%dla", i);
cd->rlc_devfs_token = devfs_add_devswf(&matcd_cdevsw,
0x80 | dkmakeminor(i, 0, RAW_PART), DV_CHR,
UID_ROOT, GID_OPERATOR, 0640, "rmatcd%dc", i);
cd->la_devfs_token = devfs_add_devswf(&matcd_cdevsw,
0x80 | dkmakeminor(i, 0, 0), DV_BLK,
UID_ROOT, GID_OPERATOR, 0640, "matcd%dla", i);
cd->lc_devfs_token = devfs_add_devswf(&matcd_cdevsw,
0x80 | dkmakeminor(i, 0, RAW_PART), DV_BLK,
UID_ROOT, GID_OPERATOR, 0640, "matcd%dlc", i);
#endif
}
}
nextcontroller++; /*Bump ctlr assign to next number*/
printf("\n"); /*End line of drive reports*/
return(1);
}
/*---------------------------------------------------------------------------
zero_cmd - Initialize command buffer
---------------------------------------------------------------------------*/
void zero_cmd(char * lcmd)
{
int i;
for (i=0; i<MAXCMDSIZ; lcmd[i++]=0);
return;
}
/*---------------------------------------------------------------------------
doreset - Resets all the drives connected to a interface
---------------------------------------------------------------------------*/
void doreset(int port,int cdrive)
{
register int i,z;
outb(port+RESET,0); /*Reset what might be our device*/
/*Although this ensures a known
state, it does close the drive
door (if open) and aborts any
audio playback in progress. */
for (i=0;i<(125*ISABUSKHZ);i++){/*DELAY 500msec minimum. Worst
case is door open and none or
unreadable media */
z=inb(port+CMD); /*This makes the loop run at a
known speed. This value is ok
for 8.33MHz bus*/
}
for (i=0;i<4;i++) {
matcd_data[(cdrive*4)+i].drivemode=MODE_UNKNOWN;
}
return;
}
/*---------------------------------------------------------------------------
matcd_fastcmd - Send a command to a drive
This routine executed commands that return instantly (or reasonably
quick), such as RESET, NOP, READ ERROR, etc. The only difference
between it and handling for slower commands, is the slower commands
will invoke a timeout/sleep if they don't get an instant response.
Fastcmd is mainly used in probe(), attach() and error related
functions. Every attempt should be made to NOT use this
function for any command that might be executed when the system
is up.
---------------------------------------------------------------------------*/
int matcd_fastcmd(int port,int ldrive,int cdrive,unsigned char * cp)
{
unsigned int i;
unsigned char z;
int level;
#ifdef DEBUGCMD
unsigned char *cx;
#endif /*DEBUGCMD*/
draincmd(port,cdrive,ldrive); /*Make sure bus is really idle*/
#ifdef DEBUGCMD
cx=cp;
printf("matcd%d: Fast Send port %x sel %d command %x %x %x %x %x %x %x\n",
ldrive,port,cdrive,cx[0],cx[1],cx[2],cx[3],cx[4],cx[5],cx[6]);
#endif /*DEBUGCMD*/
selectdrive(port,cdrive); /*Enable the desired target drive*/
level=splhigh(); /*----------------------------------------*/
for (i=0; i<7; i++) { /*The seven bytes of the command*/
outb(port+CMD,*cp++); /*must be sent within 10msec or*/
} /*the drive will ignore the cmd*/
splx(level); /*------------------------------------------------*/
/* Now we wait a maximum of 240msec for a response.
Only in a few rare cases does it take this long.
If it is longer, the command should probably be slept on
rather than increasing the timing value
*/
for (i=0; i<(60*ISABUSKHZ); i++) {
z = (inb(port+STATUS)) & (DTEN|STEN);
if (z != (DTEN|STEN)) break;
}
/* We are now either in a data or status phase, OR we timed-out.*/
if (z == (DTEN|STEN)) {
#ifdef DEBUGCMD
printf("matcd%d: Command time-out\n",ldrive);
#endif /*DEBUGCMD*/
return(-1);
}
if (z != DTEN) {
return(1);
}
return(0);
}
/*---------------------------------------------------------------------------
matcd_slowcmd - Issue a command to the drive
This routine is for commands that might take a long time, such
as a read or seek. The caller must determine if the command
completes instantly or schedule a poll later on.
---------------------------------------------------------------------------*/
void matcd_slowcmd(int port,int ldrive,int cdrive,unsigned char * cp)
{
unsigned int i;
int level,size;
#ifdef DEBUGCMD
unsigned char *cx;
#endif /*DEBUGCMD*/
draincmd(port,cdrive,ldrive); /*Make sure bus is really idle*/
#ifdef DEBUGCMD
cx=cp;
printf("matcd%d: Slow Send port %x sel %d command %x %x %x %x %x %x %x\n",
ldrive,port,cdrive,cx[0],cx[1],cx[2],cx[3],cx[4],cx[5],cx[6]);
#endif /*DEBUGCMD*/
selectdrive(port,cdrive); /*Enable the desired target drive*/
if (*cp==ABORT) size=1;
else size=7;
level=splhigh(); /*----------------------------------------*/
for (i=0; i<size; i++) { /*The seven bytes of the command*/
outb(port+CMD,*cp++); /*must be sent within 10msec or*/
} /*the drive will ignore the cmd*/
splx(level); /*------------------------------------------------*/
return;
}
/*---------------------------------------------------------------------------
draincmd - Makes certain the bus is idle and throws away
any residual data from the drive if there is any.
Called as preface to most commands.
Added in Edit 5.
This was added because switching drive modes causes
the drive to emit buffers that were meant to be sent
to the D-to-A to be sent to the host. See setmode.
---------------------------------------------------------------------------*/
void draincmd(int port,int cdrive,int ldrive)
{
int i,z;
i=inb(port+STATUS);
if ((i & (DTEN|STEN)) == (DTEN|STEN)) return;
printf("matcd%d: in draincmd: bus not idle %x - trying to fix\n",
ldrive,inb(port+STATUS));
if ((i & (DTEN|STEN)) == STEN) {
#ifdef DEBUGCMD
printf("matcd%d: Data present READING - ",ldrive);
#endif /*DEBUGCMD*/
i=0;
outb(port+PHASE,1); /*<16>Enable data read*/
while ((inb(port+STATUS) & (DTEN|STEN)) == STEN) {
inb(port+DATA); /*<21>Ok for Creative*/
inb(port+ALTDATA); /*<21>Ok for others*/
i++;
}
outb(port+PHASE,0);
#ifdef DEBUGCMD
printf("%d bytes read\n",i);
#endif /*DEBUGCMD*/
}
#ifdef DEBUGCMD
printf("matcd%d: Now read status: ",ldrive);
#endif /*DEBUGCMD*/
i=get_stat(port,ldrive); /*Read status byte*/
z=inb(port+STATUS); /*Read bus status*/
#ifdef DEBUGCMD
printf("Data byte %x and status is now %x\n",i,z);
#endif /*DEBUGCMD*/
if ((z & (DTEN|STEN)) != (DTEN|STEN)) {
printf("matcd%d: Bus not idle %x - resetting\n",
cdrive,inb(port+STATUS));
doreset(port,cdrive);
}
return;
}
/*---------------------------------------------------------------------------
selectdrive - Swaps drive select bits
On Creative SB/SB16/stand-alone adapters, possibly to make them
hard to reverse engineer, the drive select signals are swapped.
---------------------------------------------------------------------------*/
void selectdrive(int port,int drive)
{
switch(drive) {
case 0: /*0x00 -> 0x00*/
outb(port+SELECT,CRDRIVE0);
break;
case 1: /*0x01 -> 0x02*/
outb(port+SELECT,CRDRIVE1);
break;
case 2: /*0x02 -> 0x01*/
outb(port+SELECT,CRDRIVE2);
break;
case 3: /*0x03 -> 0x03*/
outb(port+SELECT,CRDRIVE3);
break;
}
return;
}
/*---------------------------------------------------------------------------
matcd_pread - Read small blocks of control data from a drive
---------------------------------------------------------------------------*/
void matcd_pread(int port, int count, unsigned char * data)
{
int i;
for (i=0; i<count; i++) {
*data++ = inb(port+CMD);
}
return;
}
/*---------------------------------------------------------------------------
matcd_setmode - Configures disc to run in the desired data mode
This routine assumes the drive is already idle.
NOTE - Undocumented action of hardware: If you change (or reaffirm) data
modes with MODESELECT + BLOCKPARAM immediately after a command was
issued that aborted a DA play operation, the drive will unexpectedly
return 2532 bytes of data in a data phase on the first or second
subsequent command.
Original Symptom: drive will refuse to go idle after reading data
and status expected for a command. State mechanics for this are
not fully understood.
---------------------------------------------------------------------------*/
static int
matcd_setmode(int ldrive, int mode)
{
struct matcd_data *cd;
int retries;
int i,port,cdrive;
unsigned char cmd[MAXCMDSIZ];
cd = matcd_data + ldrive;
retries=3;
cdrive=ldrive&0x03;
port=cd->iobase;
if (cd->drivemode==mode) {
return(0); /*Drive already set*/
}
/* The drive is not in the right mode, so we need to set it.
*/
zero_cmd(cmd);
cmd[0]=MODESELECT; /*Set drive transfer modes*/
/* cmd[1]=BLOCKPARAM; BLOCKPARAM==0*/
cmd[2]=mode;
switch(mode) {
case MODE_DATA:
cmd[3]=0x08; /*2048 bytes*/
break;
case MODE_USER:
cmd[3]=0x09; /*2352 bytes*/
cmd[4]=0x30;
break;
case MODE_DA:
cmd[3]=0x09; /*2352 bytes*/
cmd[4]=0x30;
break;
}
i=0;
while(retries-- > 0) {
i=matcd_fastcmd(port,ldrive,cdrive,cmd);
get_stat(port,ldrive); /*Read and toss status byte*/
if (i==0) {
cd->drivemode=mode; /*Set new mode*/
return(i);
}
get_error(port,ldrive,cdrive);
}
cd->drivemode=MODE_UNKNOWN; /*We failed*/
return(i);
}
/*---------------------------------------------------------------------------
matcd_volinfo - Read information from disc Table of Contents
---------------------------------------------------------------------------*/
static int matcd_volinfo(int ldrive)
{
struct matcd_data *cd;
int port,i;
int z,cdrive;
int retry;
unsigned char cmd[MAXCMDSIZ];
unsigned char data[12];
retry=10; /*<16>This may take a long time*/
cd = &matcd_data[ldrive];
cdrive=ldrive&0x03;
port=cd->iobase;
#ifdef DEBUGOPEN
printf("matcd%d: In volinfo, port %x\n",ldrive,port);
#endif /*DEBUGOPEN*/
while(retry>0) {
zero_cmd(cmd);
cmd[0]=READDINFO; /*Read Disc Info*/
matcd_slowcmd(port,ldrive,cdrive,cmd);
i=waitforit(10*TICKRES,DTEN,port,"matvinf");
if (i) { /*THIS SHOULD NOT HAPPEN*/
z=get_stat(port,ldrive);/*Read status byte*/
printf("matcd%d: command failed, status %x\n",
ldrive,z);
return(-1);
}
matcd_pread(port, 6, data); /*Read data returned*/
z=get_stat(port,ldrive);/*Read status byte*/
#ifdef DEBUGOPEN
printf("matcd%d: Data got was %x %x %x %x %x %x ",ldrive,
data[0],data[1],data[2], data[3],data[4],data[5]);
printf("status byte %x\n",z);
#endif /*DEBUGOPEN*/
if ((z & MATCD_ST_ERROR)==0)
break; /*No Error*/
/* If media change or other error, you have to read error data or
the drive will reject subsequent commands.
*/
if (chk_error(get_error(port, ldrive, cdrive))==ERR_FATAL) {
#ifdef DEBUGOPEN
printf("matcd%d: command failed, status %x\n",
ldrive,z);
#endif /*DEBUGOPEN*/
return(-1);
}
tsleep((caddr_t)&nextcontroller, PRIBIO, "matvi2", hz);
if ((--retry)==0) return(-1);
#ifdef DEBUGOPEN
printf("matcd%d: Retrying",ldrive);
#endif /*DEBUGOPEN*/
}
#ifdef DEBUGOPEN
printf("matcd%d: Status port %x \n",ldrive,inb(port+STATUS));
#endif /*DEBUGOPEN*/
cd->volinfo.type=data[0];
cd->volinfo.trk_high=data[2];
cd->volinfo.trk_low=data[1];
cd->volinfo.vol_msf[0]=data[3];
cd->volinfo.vol_msf[1]=data[4];
cd->volinfo.vol_msf[2]=data[5];
if (cd->volinfo.trk_low + cd->volinfo.trk_high) {
cd->flags |= MATCDLABEL;
return(0);
}
return(-1);
}
/*---------------------------------------------------------------------------
blk_to_msf - Convert block numbers into CD disk block ids
---------------------------------------------------------------------------*/
static void blk_to_msf(int blk, unsigned char *msf)
{
blk=blk+150; /*2 seconds skip required to
reach ISO data*/
msf[0]=blk/4500;
blk=blk%4500;
msf[1]=blk/75;
msf[2]=blk%75;
return;
}
/*---------------------------------------------------------------------------
msf_to_blk - Convert CD disk block ids into block numbers
---------------------------------------------------------------------------*/
static int msf_to_blk(unsigned char * cd)
{
return(((cd[0]*60) /*Convert MSF to*/
+cd[1])*75 /*Blocks minus 2*/
+cd[2]-150); /*seconds*/
}
static void matcd_timeout(void *arg)
{
matcd_blockread((int)arg);
}
/*---------------------------------------------------------------------------
matcd_blockread - Performs actual background disc I/O operations
This routine is handed the block number to read, issues the
command to the drive, waits for it to complete, reads the
data or error, retries if needed, and returns the results
to the host.
---------------------------------------------------------------------------*/
static void matcd_blockread(int state)
{
struct matcd_mbx *mbx;
int ldrive,cdrive;
int port, controller;
short iftype;
struct buf *bp;
struct matcd_data *cd;
int i;
struct matcd_read2 rbuf;
int blknum;
caddr_t addr;
int status;
int errtyp;
int phase;
unsigned char cmd[MAXCMDSIZ];
mbx = &matcd_data[state & 0x0f].mbx;
ldrive=mbx->ldrive; /*ldrive is logical drive #*/
cdrive=ldrive & 0x03; /*cdrive is drive # on a controller*/
port=mbx->port; /*port is base port for i/f*/
iftype=mbx->iftype;
bp= mbx->bp;
cd=&matcd_data[ldrive];
controller = cd->mbx.controller;
#ifdef DEBUGIO
printf("matcd%d: Show state %x cdrive %d partition %d\n",
ldrive,state,cdrive,mbx->partition);
#endif /*DEBUGIO*/
loop:
#ifdef DEBUGIO
printf("matcd%d: Top dp %x\n",ldrive,(unsigned int)dp);
#endif /*DEBUGIO*/
switch (state & 0xf0) {
case MATCD_READ_1:
#ifdef DEBUGIO
printf("matcd%d: State 1 cd->flags %x\n",ldrive,cd->flags);
#endif /*DEBUGIO*/
/* to check for raw/cooked mode */
if (cd->partflags[mbx->partition] & MATCDREADRAW) {
mbx->sz = MATCDRBLK;
i=matcd_setmode(ldrive, MODE_DA);
#ifdef DEBUGIO
printf("matcd%d: Set MODE_DA result %d\n",ldrive,i);
#endif /*DEBUGIO*/
} else {
mbx->sz = cd->blksize;
i=matcd_setmode(ldrive, MODE_DATA);
#ifdef DEBUGIO
printf("matcd%d: Set MODE_DATA result %d\n",ldrive,i);
#endif /*DEBUGIO*/
}
/*for first block*/
#ifdef DEBUGIO
printf("matcd%d: A mbx %x bp %x b_bcount %x sz %x\n",
ldrive,(unsigned int)mbx,(unsigned int)bp,
(unsigned int)bp->b_bcount,mbx->sz);
#endif /*DEBUGIO*/
mbx->nblk = (bp->b_bcount + (mbx->sz-1)) / mbx->sz;
mbx->skip=0;
nextblock:
#ifdef DEBUGIO
printf("matcd%d: at Nextblock b_blkno %d\n",
ldrive,(unsigned int)bp->b_blkno);
#endif /*DEBUGIO*/
blknum=(bp->b_blkno / (mbx->sz/DEV_BSIZE))
+ mbx->p_offset + mbx->skip/mbx->sz;
blk_to_msf(blknum,rbuf.start_msf);
zero_cmd(cmd);
cmd[0]=READ; /*Get drive ID*/
cmd[1]=rbuf.start_msf[0];
cmd[2]=rbuf.start_msf[1];
cmd[3]=rbuf.start_msf[2];
cmd[6]=1; /*Xfer only one block*/
matcd_slowcmd(port,ldrive,cdrive,cmd);
/* Now that we have issued the command, check immediately to
see if data is ready. The drive has read-ahead caching, so
it is possible the data is already in the drive buffer.
If the data is not ready, schedule a wakeup and later on this
code will run again to see if the data is ready then.
*/
case MATCD_READ_2:
state=MATCD_READ_2+ldrive;
phase = (inb(port+STATUS)) & (DTEN|STEN);
#ifdef DEBUGIO
printf("matcd%d: In state 2 status %x ",ldrive,phase);
#endif /*DEBUGIO*/
switch(phase) {
case (DTEN|STEN): /*DTEN==H STEN==H*/
#ifdef DEBUGIO
printf("matcd%d: Sleeping\n",ldrive);
#endif /*DEBUGIO*/
timeout(matcd_timeout,
(caddr_t)MATCD_READ_2+ldrive,hz/100);
return;
case STEN: /*DTEN=L STEN=H*/
case 0: /*DTEN=L STEN=L*/
#ifdef DEBUGIO
printf("matcd%d: Data Phase\n",ldrive);
#endif /*DEBUGIO*/
addr=bp->b_data + mbx->skip;
#ifdef DEBUGIO
printf("matcd%d: Xfer Addr %x size %x",
ldrive,(unsigned int)addr,mbx->sz);
i=0; /*<20>Reset read count*/
#endif /*DEBUGIO*/
if (iftype==0) { /*<20>Creative host I/F*/
outb(port+PHASE,1); /*Enable data read*/
while((inb(port+STATUS) &
(DTEN|STEN))==STEN) {
*addr++=inb(port+DATA);
#ifdef DEBUGIO
i++;
#endif /*DEBUGIO*/
}
outb(port+PHASE,0); /*Disable read*/
} else { /*<20>Not Creative interface*/
while((inb(port+STATUS) &
(DTEN|STEN))==STEN) {
*addr++=inb(port+ALTDATA);
#ifdef DEBUGIO
i++;
#endif /*DEBUGIO*/
}
}
#ifdef DEBUGIO
printf("matcd%d: Read %d bytes\n",ldrive,i);
#endif /*DEBUGIO*/
/* Now, wait for the Status phase to arrive. This will also
tell us if any went wrong with the request.
*/
while((inb(port+STATUS)&(DTEN|STEN)) != DTEN);
status=get_stat(port,ldrive); /*Read status byte*/
#ifdef DEBUGIO
printf("matcd%d: Status port %x byte %x ",
ldrive,i,status);
#endif /*DEBUGIO*/
if (status & MATCD_ST_ERROR) {
i=get_error(port,ldrive,cdrive);
printf("matcd%d: %s while reading block %d [Soft]\n",
ldrive,matcderrors[i],(int)bp->b_blkno);
media_chk(cd,i,ldrive,0);/*<14>was wrong place*/
}
if (--mbx->nblk > 0) {
mbx->skip += mbx->sz;
goto nextblock; /*Oooooh, you flunk the course*/
}
bp->b_resid=0;
biodone(bp); /*Signal transfer complete*/
unlockbus(ldrive>>2, ldrive); /*Release bus lock*/
matcd_start(controller);/*See if other drives have work*/
return;
/* Here we skipped the data phase and went directly to status.
This indicates a hard error.
*/
case DTEN: /*DTEN=H STEN=L*/
status=get_stat(port,ldrive); /*Read status byte*/
#ifdef DEBUGIO
printf("matcd%d: error, status was %x\n",
ldrive,status);
#endif /*DEBUGIO*/
/* Ok, we need more details, so read error. This is needed to issue
any further commands anyway
*/
errtyp=get_error(port,ldrive,cdrive);
printf("matcd%d: %s while reading block %d\n",
ldrive,matcderrors[errtyp],(int)bp->b_blkno);
if (media_chk(cd,errtyp,ldrive,0)==0) {
errtyp=chk_error(errtyp);
if (errtyp==ERR_RETRY) {/*<14>We can retry*/
/*<14>this error but the drive*/
/*<14>probably has already*/
if (mbx->retry-- > 0 ) {
state=MATCD_READ_1+ldrive;
#ifdef DEBUGIO
printf("matcd%d: Attempting retry\n",
ldrive);
#endif /*DEBUGIO*/
goto loop;
}
}
}
/*<14> The other error types are either something very bad or the media
<14> has been removed by the user. In both cases there is no retry
<14> for this call. We will invalidate the label in both cases.
*/
bp->b_flags |= B_ERROR;
bp->b_resid = bp->b_bcount;
biodone(bp);
unlockbus(ldrive>>2, ldrive);
matcd_start(controller);
return;
}
}
}
/*---------------------------------------------------------------------------
docmd - Get the bus, do the command, wait for completion,
attempt retries, give up the bus.
For commands that do not return data.
---------------------------------------------------------------------------*/
int docmd(char * cmd, int ldrive, int cdrive, int controller, int port)
{
int retries,i,z;
lockbus(controller, ldrive); /*Request bus*/
retries=3;
while(retries-- > 0) {
matcd_slowcmd(port,ldrive,cdrive,cmd);
i=waitforit(80*TICKRES,DTEN,port,"matcmd");
z=get_stat(port,ldrive);/*Read status byte*/
if ((z & MATCD_ST_ERROR)==0) break;
i=chk_error(get_error(port,ldrive,cdrive));
if (i!=ERR_INIT) {
unlockbus(controller, ldrive); /*Release bus*/
return(EFAULT);
}
}
unlockbus(controller, ldrive); /*Release bus*/
return(i);
}
/*---------------------------------------------------------------------------
get_error - Read the error that aborted a command.
Created in Edit 6
---------------------------------------------------------------------------*/
int get_error(int port, int ldrive, int cdrive)
{
int status,errnum;
unsigned char cmd1[MAXCMDSIZ];
unsigned char data[12];
zero_cmd(cmd1);
cmd1[0]=READERROR; /*Enquire*/
matcd_fastcmd(port,ldrive,cdrive,cmd1);
matcd_pread(port, 8, data); /*Read data returned*/
errnum=data[2]; /*Caller wants it classified*/
status=get_stat(port,ldrive); /*Read status byte*/
#ifdef DEBUGCMD
printf("matcd%d: Chkerror found %x on command %x addrval %x statusdata %x statusport %x\n",
ldrive,errnum,data[1],data[0],status,inb(port+STATUS));
#endif /*DEBUGCMD*/
return(errnum);
}
/*---------------------------------------------------------------------------
chk_error - Classify the error that the drive reported
Created in Edit 6
---------------------------------------------------------------------------*/
int chk_error(int errnum)
{
switch(errnum) {
/* These are errors we can attempt a retry for, although the drive
has already done so.
*/
case UNRECV_ERROR:
case SEEK_ERROR:
case TRACK_ERROR:
case FOCUS_ERROR:
case CLV_ERROR:
case DATA_ERROR:
case MODE_ERROR: /*<16>Make this retryable*/
return(ERR_RETRY);
/* These errors usually indicate the user took the media from the
drive while the dev was open. We will invalidate the unit
until it closes when we see this.
*/
case NOT_READY:
case MEDIA_CHANGED:
case DISC_OUT:
case HARD_RESET:
return (ERR_INIT);
/* These errors indicate the system is confused about the drive
or media, and point to bugs in the driver or OS. These errors
cannot be retried since you will always get the same error.
*/
case RAM_ERROR:
case DIAG_ERROR:
case CDB_ERROR:
case END_ADDRESS:
case ILLEGAL_REQ:
case ADDRESS_ERROR:
default:
return (ERR_FATAL);
}
}
/*---------------------------------------------------------------------------
get_stat - Reads status byte
This routine should be totally unnecessary, performing the
task with a single line of in-line code. However in special
cases, the drives return blocks of data that are not associated
with the command in question. This appears to be at least one
firmware error and the rest of the driver makes an effort to avoid
triggering the fault. However, reading and throwing this
bogus data is faster and less destructive than resetting all
the drives on a given controller, plus it leaves the other drives
unaffected.
---------------------------------------------------------------------------*/
int get_stat(int port,int ldrive)
{
int status,busstat;
status=inb(port+DATA); /*Read status byte, last step of cmd*/
busstat=inb(port+STATUS); /*<16>Get bus status - should be 0xff*/
while ((busstat & (DTEN|STEN)) != (DTEN|STEN)) {
printf("matcd%d: get_stat: After reading status byte, bus didn't go idle %x %x %x\n",ldrive,status,busstat,port);
if (( busstat & (DTEN|STEN)) == STEN) {
int k;
k=0;
#ifdef DEBUGCMD
printf("matcd%d: DATA PRESENT!!!! DISCARDING\n",ldrive);
#endif /*DEBUGCMD*/
outb(port+PHASE,1); /*Enable data read*/
while ((inb(port+STATUS) & (DTEN|STEN)) == STEN) {
inb(port+DATA);
inb(port+ALTDATA);
/* printf("%2x ",inb(port+DATA));*/
k++;
}
outb(port+PHASE,0);
#ifdef DEBUGCMD
printf("\nmatcd%d: BYTES READ IN DATA was %d\n",
ldrive,k);
#endif /*DEBUGCMD*/
}
status=inb(port+DATA); /*Read the status byte again*/
#ifdef DEBUGCMD
printf("matcd%d: Next status byte is %x\n",ldrive,status);
#endif /*DEBUGCMD*/
busstat=inb(port+STATUS);
}
return(status);
}
/*---------------------------------------------------------------------------
waitforit - Waits for a command started by slowcmd to complete.
---------------------------------------------------------------------------*/
int waitforit(int timelimit, int state, int port, char * where)
{
int i,j;
j=i=0;
#ifdef DEBUGCMD
printf("matcd: waitforit port %x timelimit %x hz %x\n",
port,timelimit,hz);
#endif /*DEBUGCMD*/
while (i<timelimit) {
j=inb(port+STATUS) & (STEN|DTEN); /*Read status*/
if (j!=(STEN|DTEN)) break;
tsleep((caddr_t)&nextcontroller, PRIBIO, where, hz/100);
i++;
}
#ifdef DEBUGCMD
printf("matcd: Count was %d\n",i);
#endif /*DEBUGCMD*/
if (j==state) return(0); /*Command complete*/
#ifdef DEBUGCMD
printf("matcd: Timeout!");
#endif /*DEBUGCMD*/
return(1); /*Timeout occurred*/
}
/*---------------------------------------------------------------------------
lockbus - Wait for the bus on the requested driver interface
to go idle and acquire it.
Created in Edit 6
---------------------------------------------------------------------------*/
void lockbus(int controller, int ldrive)
{
while ((if_state[controller] & BUSBUSY)) {
#ifdef DEBUGSLEEP
printf("matcd%d: Can't do it now - going to sleep\n",
ldrive);
#endif /*DEBUGSLEEP*/
tsleep((caddr_t)&matcd_data->status, PRIBIO,
"matlck", 0);
}
if_state[controller] |= BUSBUSY; /*<18>It's ours NOW*/
#ifdef DEBUGSLEEP
printf("matcd%d: BUS locked in lockbus\n",ldrive);
#endif /*DEBUGSLEEP*/
}
/*---------------------------------------------------------------------------
unlockbus - Release the host interface bus we already have so
someone else can use it.
Created in Edit 6
---------------------------------------------------------------------------*/
void unlockbus(int controller, int ldrive)
{
if_state[controller] &= ~BUSBUSY;
#ifdef DEBUGSLEEP
printf("matcd%d: bus unlocked\n",ldrive);
#endif /*DEBUGSLEEP*/
wakeup((caddr_t)&matcd_data->status); /*Wakeup other users*/
matcd_start(controller); /*Wake up any block I/O*/
}
/*---------------------------------------------------------------------------
media_chk - Checks error for types related to media
changes.
---------------------------------------------------------------------------*/
int media_chk(struct matcd_data *cd,int errnum,int ldrive,int test)
{
if (errnum==NOT_READY ||
errnum==MEDIA_CHANGED ||
errnum==HARD_RESET ||
errnum==DISC_OUT) {
cd->flags &= ~MATCDLABEL; /*Mark label as invalid*/
if (test==0) { /*<14>Do warn by default*/
if ((cd->flags & MATCDWARN)==0) {/*<14>Msg already?*/
printf("matcd%d: Media changed - Further I/O aborted until device closed\n",ldrive);
cd->flags |= MATCDWARN;
}
}
return(1);
}
if (errnum==MODE_ERROR) /*<16>Maybe the setting is*/
cd->drivemode=MODE_UNKNOWN; /*<16>wrong so force a reset*/
return(0);
}
/*---------------------------------------------------------------------------
matcd_eject - Open drive tray
---------------------------------------------------------------------------*/
int matcd_eject(int ldrive, int cdrive, int controller)
{
int i,port;
struct matcd_data *cd;
unsigned char cmd[MAXCMDSIZ];
cd=&matcd_data[ldrive];
port=cd->iobase; /*Get I/O port base*/
#ifdef LOCKDRIVE
if (cd->flags & MATCDLOCK) { /*<15>Drive was locked via open*/
return(EINVAL); /*<15>so don't allow the eject*/
}
#endif /*LOCKDRIVE*/
zero_cmd(cmd); /*Initialize command buffer*/
cmd[0]=LOCK; /*Unlock drive*/
i=docmd(cmd,ldrive,cdrive,controller,port); /*Issue command*/
cmd[0]=DOOROPEN; /*Open Door*/
i=docmd(cmd,ldrive,cdrive,controller,port); /*Issue command*/
cd->flags &= ~(MATCDLABEL|MATCDLOCK); /*<15>Mark vol info invalid*/
return(i); /*Return result we got*/
}
/*---------------------------------------------------------------------------
matcd_doorclose - Close drive tray
<16> Added in Edit 16
---------------------------------------------------------------------------*/
int matcd_doorclose(int ldrive, int cdrive, int controller)
{
int i,port;
struct matcd_data *cd;
unsigned char cmd[MAXCMDSIZ];
cd=&matcd_data[ldrive];
port=cd->iobase; /*Get I/O port base*/
zero_cmd(cmd); /*Initialize command buffer*/
cmd[0]=DOORCLOSE; /*Open Door*/
i=docmd(cmd,ldrive,cdrive,controller,port); /*Issue command*/
cd->flags &= ~(MATCDLABEL|MATCDLOCK); /*Mark vol info invalid*/
tsleep((caddr_t)&nextcontroller, PRIBIO, "matclos", hz);
return(i); /*Return result we got*/
}
/*---------------------------------------------------------------------------
<23> matcd_dlock - Honor/Reject drive tray requests
---------------------------------------------------------------------------*/
int matcd_dlock(int ldrive, int cdrive, int controller, int action)
{
int i,port;
struct matcd_data *cd;
unsigned char cmd[MAXCMDSIZ];
cd=&matcd_data[ldrive];
port=cd->iobase; /*<23>Get I/O port base*/
zero_cmd(cmd); /*<23>Initialize command buffer*/
cmd[0]=LOCK; /*<23>Unlock drive*/
if (action) { /*<23>They want to lock the door?*/
cd->flags |= MATCDLOCK; /*<23>Remember we did this*/
cmd[1]=1; /*<23>Lock Door command*/
} else {
cd->flags &= ~MATCDLOCK;/*<23>Remember we did this*/
/*<23>Unlock Door command*/
}
i=docmd(cmd,ldrive,cdrive,controller,port); /*<23>Issue command*/
return(i); /*<23>Return result we got*/
}
/*---------------------------------------------------------------------------
matcd_toc_header - Return Table of Contents header to caller
<13> New for Edit 13
---------------------------------------------------------------------------*/
static int matcd_toc_header(int ldrive, int cdrive, int controller,
struct ioc_toc_header * toc)
{
struct matcd_data *cd;
cd=&matcd_data[ldrive];
if ((cd->flags & MATCDLABEL)==0)
return(EIO); /*Refuse after chg error*/
toc->len=msf_to_blk(cd->volinfo.vol_msf); /*In frames*/
toc->starting_track=cd->volinfo.trk_low; /*1*/
toc->ending_track=cd->volinfo.trk_high; /*Last track*/
return(0);
}
/*---------------------------------------------------------------------------
matcd_toc_entries - Read all of the TOC entries
These entries are cached by the drive, but it might be worth
the space investment to have the driver cache these as well.
For a disc with 40 tracks, it means 41 command calls to get
this information from the drive.
<13> New for Edit 13
---------------------------------------------------------------------------*/
static int matcd_toc_entries(int ldrive, int cdrive, int controller,
struct ioc_read_toc_entry * ioc_entry)
{
struct matcd_data *cd;
struct cd_toc_entry entries[MAXTRKS];
struct cd_toc_entry *from;
struct cd_toc_entry *to;
int len,trk,i,z,port;
unsigned char cmd[MAXCMDSIZ];
unsigned char data[8];
cd=&matcd_data[ldrive];
port=cd->iobase;
if ((cd->flags & MATCDLABEL)==0)
return(EIO); /*Refuse after chg error*/
zero_cmd(cmd);
cmd[0]=READTOC;
for(trk=cd->volinfo.trk_low-1; trk<cd->volinfo.trk_high; trk++) {
cmd[2]=trk+1;
lockbus(controller, ldrive); /*Request bus*/
matcd_slowcmd(port,ldrive,cdrive,cmd);
i=waitforit(10*TICKRES,DTEN,port,"mats1");
matcd_pread(port, 8, data); /*Read data returned*/
z=get_stat(port,ldrive); /*Read status byte*/
if ((z & MATCD_ST_ERROR)) { /*Something went wrong*/
i=get_error(port, ldrive, cdrive);
unlockbus(controller, ldrive); /*Release bus*/
return(EIO);
}
unlockbus(controller, ldrive); /*Release bus*/
#ifdef DEBUGIOCTL
printf("Track %d addr/ctrl %x m %x s %x f %x\n",data[2],
data[1],data[4],data[5],data[6]);
#endif /*DEBUGIOCTL*/
entries[trk].control=data[1]; /*Track type*/
entries[trk].addr_type=ioc_entry->address_format;/*Type*/
entries[trk].track=data[2]; /*Track #, can be Out of Order*/
if (ioc_entry->address_format == CD_MSF_FORMAT) {
entries[trk].addr.msf.unused=0;
entries[trk].addr.msf.minute=data[4]; /*Min*/
entries[trk].addr.msf.second=data[5]; /*Sec*/
entries[trk].addr.msf.frame=data[6]; /*Frame*/
}
}
entries[trk].control=data[2]; /*Copy from last valid track*/
entries[trk].track=0xaa; /*<23>Lead-out*/
entries[trk].addr.msf.unused=0; /*Fill*/
entries[trk].addr.msf.minute=cd->volinfo.vol_msf[0];
entries[trk].addr.msf.second=cd->volinfo.vol_msf[1];
entries[trk].addr.msf.frame=cd->volinfo.vol_msf[2];
trk++; /*Bump to include leadout track*/
/* Now that we have read all the data from the drive, copy the
array from the kernel address space into the user address space
*/
len=ioc_entry->data_len;
i=ioc_entry->starting_track; /*<23>What did they want?*/
if (i==0xaa) i=trk-1; /*<23>Give them lead-out info*/
else i=ioc_entry->starting_track - 1; /*<23>start where they asked*/
from = &entries[i];
to = ioc_entry->data;
while (i < trk && len >= sizeof(struct cd_toc_entry)) {
if (copyout(from,to,sizeof(struct cd_toc_entry))
!= 0) {
return (EFAULT);
}
i++;
len -= sizeof(struct cd_toc_entry);
from++;
to++;
}
return(0);
}
/*---------------------------------------------------------------------------
matcd_toc_entriy - Read a single TOC entry
---------------------------------------------------------------------------*/
static int matcd_toc_entry(int ldrive, int cdrive, int controller,
struct ioc_read_toc_single_entry * ioc_entry)
{
struct matcd_data *cd;
int trk,origtrk,i,z,port;
unsigned char cmd[MAXCMDSIZ];
unsigned char data[5];
cd=&matcd_data[ldrive];
port=cd->iobase;
if ((cd->flags & MATCDLABEL)==0)
return(EIO); /*Refuse after chg error*/
zero_cmd(cmd);
cmd[0]=READTOC;
origtrk=trk=ioc_entry->track;
if (trk == 0xaa)
/* leadout */
trk=cd->volinfo.trk_high-1;
cmd[2]=trk+1;
lockbus(controller, ldrive); /*Request bus*/
matcd_slowcmd(port,ldrive,cdrive,cmd);
i=waitforit(10*TICKRES,DTEN,port,"mats1");
matcd_pread(port, 8, data); /*Read data returned*/
z=get_stat(port,ldrive); /*Read status byte*/
if ((z & MATCD_ST_ERROR)) { /*Something went wrong*/
i=get_error(port, ldrive, cdrive);
unlockbus(controller, ldrive); /*Release bus*/
return(EIO);
}
unlockbus(controller, ldrive); /*Release bus*/
#ifdef DEBUGIOCTL
printf("Track %d addr/ctrl %x m %x s %x f %x\n",data[2],
data[1],data[4],data[5],data[6]);
#endif /*DEBUGIOCTL*/
ioc_entry->entry.control=data[1]; /*Track type*/
ioc_entry->entry.addr_type=ioc_entry->address_format;/*Type*/
ioc_entry->entry.track=data[2]; /*Track #, can be Out of Order*/
if (ioc_entry->address_format == CD_MSF_FORMAT) {
ioc_entry->entry.addr.msf.unused=0;
ioc_entry->entry.addr.msf.minute=data[4]; /*Min*/
ioc_entry->entry.addr.msf.second=data[5]; /*Sec*/
ioc_entry->entry.addr.msf.frame=data[6]; /*Frame*/
}
if (origtrk == 0xaa) {
/* Handle leadout */
ioc_entry->entry.control=data[2]; /*Copy from last valid track*/
ioc_entry->entry.track=0xaa; /*Lead-out*/
ioc_entry->entry.addr.msf.unused=0; /*Fill*/
ioc_entry->entry.addr.msf.minute=cd->volinfo.vol_msf[0];
ioc_entry->entry.addr.msf.second=cd->volinfo.vol_msf[1];
ioc_entry->entry.addr.msf.frame=cd->volinfo.vol_msf[2];
}
return(0);
}
/*---------------------------------------------------------------------------
matcd_subq - Read the Sub-Q packet - (where are we?)
This call gives a snapshot state of where the optical
pick-up is when the command is issued.
<14> New for Edit 14
---------------------------------------------------------------------------*/
static int matcd_read_subq(int ldrive, int cdrive, int controller,
struct ioc_read_subchannel * sqp)
{
struct matcd_data *cd;
int i,z,port;
unsigned char cmd[MAXCMDSIZ];
unsigned char data[12];
struct cd_sub_channel_info subq; /*Build result here*/
cd=&matcd_data[ldrive];
port=cd->iobase;
if ((cd->flags & MATCDLABEL)==0)
return(EIO); /*Refuse after chg error*/
/* We only support the ioctl functions we could get information
on, so test for the things we can do
*/
if (sqp->data_format!=CD_CURRENT_POSITION ||
sqp->address_format!=CD_MSF_FORMAT) {
return(EINVAL);
}
zero_cmd(cmd);
cmd[0]=READSUBQ;
lockbus(controller, ldrive); /*Request bus*/
matcd_slowcmd(port,ldrive,cdrive,cmd);
/* While we wait, fill in the hard-coded entries of the table*/
subq.what.position.data_format=CD_MSF_FORMAT;
subq.what.position.absaddr.msf.unused=0;
subq.what.position.reladdr.msf.unused=0;
i=waitforit(10*TICKRES,DTEN,port,"mats2");
matcd_pread(port, 11, data); /*Read data returned*/
z=get_stat(port,ldrive); /*Read status byte*/
if ((z & MATCD_ST_ERROR)) { /*Something went wrong*/
i=get_error(port, ldrive, cdrive);
unlockbus(controller, ldrive); /*Release bus*/
return(EIO);
}
unlockbus(controller, ldrive); /*Release bus*/
#ifdef DEBUGIOCTL
printf("Subq track %d index %d adr/ctl %x abs %d:%2d:%2d rel %d:%2d:%2d UPC %x\n",
data[2],data[3],data[1],data[4],data[5],data[6],
data[7],data[8],data[9],data[10]);
#endif /*DEBUGIOCTL*/
if (z & MATCD_ST_AUDIOBSY) { /*Drive playing or paused*/
if (cd->status==CD_AS_PLAY_PAUSED) { /*Have we issued*/
i=cd->status; /*a pause command?*/
} else {
i=CD_AS_PLAY_IN_PROGRESS;/*No, we really are playing*/
}
} else {
if (cd->status==CD_AS_PLAY_IN_PROGRESS) {/*It was playing*/
i=CD_AS_PLAY_COMPLETED; /*so it finished*/
} else { /*Any other status reported*/
i=cd->status; /*as we get it*/
}
}
subq.header.audio_status=cd->status=i; /*Store status we selected*/
subq.what.position.track_number=data[2];
subq.what.position.index_number=data[3];
subq.what.position.absaddr.msf.minute=data[4];
subq.what.position.absaddr.msf.second=data[5];
subq.what.position.absaddr.msf.frame=data[6];
subq.what.position.reladdr.msf.minute=data[7];
subq.what.position.reladdr.msf.second=data[8];
subq.what.position.reladdr.msf.frame=data[9];
/* Ok, now copy our nicely-built structure from the kernel address
space into the user address space (we hope)
*/
if (copyout(&subq, sqp->data,
min(sizeof(struct cd_sub_channel_info), sqp->data_len))!=0) {
return(EFAULT);
}
return(0);
}
/*---------------------------------------------------------------------------
matcd_igot - Like the song, report the capabilities that the
drive/driver has available.
This call returns a structure of flags indicating what
functions are available so that the application can offer
only the functions the drive is actually capable of.
<16> New for Edit 16
---------------------------------------------------------------------------*/
static int matcd_igot(struct ioc_capability * sqp)
{
#ifdef FULLDRIVER
sqp->play_function=(CDDOPLAYTRK | /*Can play trks/indx*/
CDDOPLAYMSF | /*Can play msf to msf*/
CDDOPAUSE | /*Can pause playback*/
CDDORESUME | /*Can resume playback*/
CDDOSTOP | /*Can stop playback*/
CDDOPITCH); /*Can change play pitch*/
sqp->routing_function=(CDREADVOLUME | /*Can read volume*/
CDSETVOLUME | /*Can set volume*/
CDSETSTEREO | /*Can select stereo play*/
CDSETLEFT | /*Can select left-only*/
CDSETRIGHT | /*Can select right-only*/
CDSETMUTE | /*Can mute audio*/
CDSETPATCH); /*Direct patch settings*/
#else /*FULLDRIVER*/
sqp->play_function=0; /*No audio capability*/
sqp->routing_function=0; /*No audio capability*/
#endif /*FULLDRIVER*/
sqp->special_function=(CDDOEJECT | /*Door can be opened*/
CDDOCLOSE | /*Door can be closed*/
CDDOLOCK | /*Door can be locked*/
CDREADSUBQ | /*Can read subchannel*/
CDREADENTRIES | /*Can read TOC entries*/
CDREADHEADER); /*Can read TOC*/
return(0);
}
#ifdef FULLDRIVER
#include <i386/isa/matcd/audio.c> /*<15>ioctls related to
audio are here*/
#endif /*FULLDRIVER*/
static matcd_devsw_installed = 0;
static void
matcd_drvinit(void *unused)
{
if( ! matcd_devsw_installed ) {
cdevsw_add_generic(BDEV_MAJOR,CDEV_MAJOR, &matcd_cdevsw);
matcd_devsw_installed = 1;
}
}
SYSINIT(matcddev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE+CDEV_MAJOR,matcd_drvinit,NULL)
/*End of matcd.c*/