OpenCores
URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [trunk/] [rc203soc/] [sw/] [uClinux/] [drivers/] [cdrom/] [aztcd.c] - Rev 1765

Compare with Previous | Blame | View Log

#define AZT_VERSION "2.50"
/*      $Id: aztcd.c,v 1.1 2005-12-20 10:16:38 jcastillo Exp $
	linux/drivers/block/aztcd.c - Aztech CD268 CDROM driver
 
	Copyright (C) 1994,95,96 Werner Zimmermann(zimmerma@rz.fht-esslingen.de)
 
	based on Mitsumi CDROM driver by  Martin Hariss and preworks by
	Eberhard Moenkeberg; contains contributions by Joe Nardone and Robby 
	Schirmer.
 
	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2, or (at your option)
	any later version.
 
	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
	GNU General Public License for more details.
 
	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the Free Software
	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 
	HISTORY
	V0.0    Adaption to Aztech CD268-01A Version 1.3
		Version is PRE_ALPHA, unresolved points:
		1. I use busy wait instead of timer wait in STEN_LOW,DTEN_LOW
		   thus driver causes CPU overhead and is very slow 
		2. could not find a way to stop the drive, when it is
		   in data read mode, therefore I had to set
		   msf.end.min/sec/frame to 0:0:1 (in azt_poll); so only one
		   frame can be read in sequence, this is also the reason for
		3. getting 'timeout in state 4' messages, but nevertheless
		   it works
		W.Zimmermann, Oct. 31, 1994
	V0.1    Version is ALPHA, problems #2 and #3 resolved.  
		W.Zimmermann, Nov. 3, 1994
	V0.2    Modification to some comments, debugging aids for partial test
		with Borland C under DOS eliminated. Timer interrupt wait 
		STEN_LOW_WAIT additionally to busy wait for STEN_LOW implemented; 
		use it only for the 'slow' commands (ACMD_GET_Q_CHANNEL, ACMD_
		SEEK_TO_LEAD_IN), all other commands are so 'fast', that busy 
		waiting seems better to me than interrupt rescheduling.
		Besides that, when used in the wrong place, STEN_LOW_WAIT causes
		kernel panic.
		In function aztPlay command ACMD_PLAY_AUDIO added, should make
		audio functions work. The Aztech drive needs different commands
		to read data tracks and play audio tracks.
		W.Zimmermann, Nov. 8, 1994
	V0.3    Recognition of missing drive during boot up improved (speeded up).
		W.Zimmermann, Nov. 13, 1994
	V0.35   Rewrote the control mechanism in azt_poll (formerly mcd_poll) 
		including removal of all 'goto' commands. :-); 
		J. Nardone, Nov. 14, 1994
	V0.4    Renamed variables and constants to 'azt' instead of 'mcd'; had
		to make some "compatibility" defines in azt.h; please note,
		that the source file was renamed to azt.c, the include file to
		azt.h                
		Speeded up drive recognition during init (will be a little bit 
		slower than before if no drive is installed!); suggested by
		Robby Schirmer.
		read_count declared volatile and set to AZT_BUF_SIZ to make
		drive faster (now 300kB/sec, was 60kB/sec before, measured
		by 'time dd if=/dev/cdrom of=/dev/null bs=2048 count=4096';
		different AZT_BUF_SIZes were test, above 16 no further im-
		provement seems to be possible; suggested by E.Moenkeberg.
		W.Zimmermann, Nov. 18, 1994
	V0.42   Included getAztStatus command in GetQChannelInfo() to allow
		reading Q-channel info on audio disks, if drive is stopped, 
		and some other bug fixes in the audio stuff, suggested by 
		Robby Schirmer.
		Added more ioctls (reading data in mode 1 and mode 2).
		Completely removed the old azt_poll() routine.
		Detection of ORCHID CDS-3110 in aztcd_init implemented.
		Additional debugging aids (see the readme file).
		W.Zimmermann, Dec. 9, 1994  
	V0.50   Autodetection of drives implemented.
		W.Zimmermann, Dec. 12, 1994
	V0.52   Prepared for including in the standard kernel, renamed most
		variables to contain 'azt', included autoconf.h
		W.Zimmermann, Dec. 16, 1994        
	V0.6    Version for being included in the standard Linux kernel.
		Renamed source and header file to aztcd.c and aztcd.h
		W.Zimmermann, Dec. 24, 1994
	V0.7    Changed VERIFY_READ to VERIFY_WRITE in aztcd_ioctl, case
		CDROMREADMODE1 and CDROMREADMODE2; bug fix in the ioctl,
		which causes kernel crashes when playing audio, changed 
		include-files (config.h instead of autoconf.h, removed
		delay.h)
		W.Zimmermann, Jan. 8, 1995
	V0.72   Some more modifications for adaption to the standard kernel.
		W.Zimmermann, Jan. 16, 1995
        V0.80   aztcd is now part of the standard kernel since version 1.1.83.
                Modified the SET_TIMER and CLEAR_TIMER macros to comply with
                the new timer scheme.
                W.Zimmermann, Jan. 21, 1995
        V0.90   Included CDROMVOLCTRL, but with my Aztech drive I can only turn
                the channels on and off. If it works better with your drive, 
                please mail me. Also implemented ACMD_CLOSE for CDROMSTART.
                W.Zimmermann, Jan. 24, 1995
        V1.00   Implemented close and lock tray commands. Patches supplied by
		Frank Racis        
                Added support for loadable MODULEs, so aztcd can now also be
                loaded by insmod and removed by rmmod during run time
                Werner Zimmermann, Mar. 24, 95
        V1.10   Implemented soundcard configuration for Orchid CDS-3110 drives
                connected to Soundwave32 cards. Release for LST 2.1.
                (still experimental)
                Werner Zimmermann, May 8, 95
        V1.20   Implemented limited support for DOSEMU0.60's cdrom.c. Now it works, but
                sometimes DOSEMU may hang for 30 seconds or so. A fully functional ver-
                sion needs an update of Dosemu0.60's cdrom.c, which will come with the 
                next revision of Dosemu.
                Also Soundwave32 support now works.
                Werner Zimmermann, May 22, 95
	V1.30   Auto-eject feature. Inspired by Franc Racis (racis@psu.edu)
	        Werner Zimmermann, July 4, 95
	V1.40   Started multisession support. Implementation copied from mcdx.c
	        by Heiko Schlittermann. Not tested yet.
	        Werner Zimmermann, July 15, 95
        V1.50   Implementation of ioctl CDROMRESET, continued multisession, began
                XA, but still untested. Heavy modifications to drive status de-
                tection.
                Werner Zimmermann, July 25, 95
        V1.60   XA support now should work. Speeded up drive recognition in cases, 
                where no drive is installed.
                Werner Zimmermann, August 8, 1995
        V1.70   Multisession support now is completed, but there is still not 
                enough testing done. If you can test it, please contact me. For
                details please read /usr/src/linux/Documentation/cdrom/aztcd
                Werner Zimmermann, August 19, 1995
        V1.80   Modification to suit the new kernel boot procedure introduced
                with kernel 1.3.33. Will definitely not work with older kernels.
                Programming done by Linus himself.
                Werner Zimmermann, October 11, 1995
	V1.90   Support for Conrad TXC drives, thank's to Jochen Kunz and Olaf Kaluza.
	        Werner Zimmermann, October 21, 1995
        V2.00   Changed #include "blk.h" to <linux/blk.h> as the directory
                structure was changed. README.aztcd is now /usr/src/docu-
                mentation/cdrom/aztcd
                Werner Zimmermann, November 10, 95
        V2.10   Started to modify azt_poll to prevent reading beyond end of
                tracks.
                Werner Zimmermann, December 3, 95
        V2.20   Changed some comments
                Werner Zimmermann, April 1, 96
        V2.30   Implemented support for CyCDROM CR520, CR940, Code for CR520 
        	delivered by H.Berger with preworks by E.Moenkeberg.
                Werner Zimmermann, April 29, 96
        V2.40   Reorganized the placement of functions in the source code file
                to reflect the layered approach; did not actually change code
                Werner Zimmermann, May 1, 96
        V2.50   Heiko Eissfeldt suggested to remove some VERIFY_READs in 
                aztcd_ioctl; check_aztcd_media_change modified 
                Werner Zimmermann, May 16, 96       
*/
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/sched.h>
#include <linux/mm.h>
#include <linux/timer.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/cdrom.h>
#include <linux/ioport.h>
#include <linux/string.h>
#include <linux/major.h>
 
#include <asm/system.h>
#include <asm/io.h>
#include <asm/segment.h>
 
#define MAJOR_NR AZTECH_CDROM_MAJOR 
 
#include <linux/blk.h>
#include <linux/aztcd.h>
 
/*###########################################################################
  Defines
  ###########################################################################
*/
#define SET_TIMER(func, jifs)   delay_timer.expires = jiffies + (jifs); \
                                delay_timer.function = (void *) (func); \
                                add_timer(&delay_timer); 
 
#define CLEAR_TIMER             del_timer(&delay_timer);
 
#define RETURNM(message,value) {printk("aztcd: Warning: %s failed\n",message);\
                                return value;}
#define RETURN(message)        {printk("aztcd: Warning: %s failed\n",message);\
                                return;}
 
/* Macros to switch the IDE-interface to the slave device and back to the master*/
#define SWITCH_IDE_SLAVE  outb_p(0xa0,azt_port+6); \
	                  outb_p(0x10,azt_port+6); \
	                  outb_p(0x00,azt_port+7); \
	                  outb_p(0x10,azt_port+6); 
#define SWITCH_IDE_MASTER outb_p(0xa0,azt_port+6);
 
 
#if 0
#define AZT_TEST
#define AZT_TEST1 /* <int-..> */
#define AZT_TEST2 /* do_aztcd_request */
#define AZT_TEST3 /* AZT_S_state */
#define AZT_TEST4 /* QUICK_LOOP-counter */
#define AZT_TEST5 /* port(1) state */
#define AZT_DEBUG
#define AZT_DEBUG_MULTISESSION
#endif
 
#define CURRENT_VALID \
  (CURRENT && MAJOR(CURRENT -> rq_dev) == MAJOR_NR && CURRENT -> cmd == READ \
   && CURRENT -> sector != -1)
 
#define AFL_STATUSorDATA (AFL_STATUS | AFL_DATA)
#define AZT_BUF_SIZ 16
 
#define READ_TIMEOUT 3000
 
#define azt_port aztcd  /*needed for the modutils*/
 
/*##########################################################################
  Type Definitions
  ##########################################################################
*/
enum azt_state_e 
{ AZT_S_IDLE,    /* 0 */
  AZT_S_START,   /* 1 */
  AZT_S_MODE,    /* 2 */
  AZT_S_READ,    /* 3 */
  AZT_S_DATA,    /* 4 */
  AZT_S_STOP,    /* 5 */
  AZT_S_STOPPING /* 6 */
};
enum azt_read_modes 
{ AZT_MODE_0,     /*read mode for audio disks, not supported by Aztech firmware*/
  AZT_MODE_1,     /*read mode for normal CD-ROMs*/
  AZT_MODE_2      /*read mode for XA CD-ROMs*/
};
 
/*##########################################################################
  Global Variables
  ##########################################################################
*/
static int aztPresent = 0;
 
static volatile int azt_transfer_is_active=0;
 
static char azt_buf[CD_FRAMESIZE_RAW*AZT_BUF_SIZ];/*buffer for block size conversion*/
#if AZT_PRIVATE_IOCTLS
static char buf[CD_FRAMESIZE_RAW];              /*separate buffer for the ioctls*/
#endif
 
static volatile int azt_buf_bn[AZT_BUF_SIZ], azt_next_bn;
static volatile int azt_buf_in, azt_buf_out = -1;
static volatile int azt_error=0;
static int azt_open_count=0;
static volatile enum azt_state_e azt_state = AZT_S_IDLE;
#ifdef AZT_TEST3
static volatile enum azt_state_e azt_state_old = AZT_S_STOP;  
static volatile int azt_st_old = 0;
#endif
static volatile enum azt_read_modes azt_read_mode = AZT_MODE_1;
 
static int azt_mode = -1;
static volatile int azt_read_count = 1;
 
static int azt_port = AZT_BASE_ADDR;
 
static char  azt_cont = 0;
static char  azt_init_end = 0;
static char  azt_auto_eject = AZT_AUTO_EJECT;
 
static int AztTimeout, AztTries;
static struct wait_queue *azt_waitq = NULL; 
static struct timer_list delay_timer = { NULL, NULL, 0, 0, NULL };
 
static struct azt_DiskInfo DiskInfo;
static struct azt_Toc Toc[MAX_TRACKS];
static struct azt_Play_msf azt_Play;
 
static int  aztAudioStatus = CDROM_AUDIO_NO_STATUS;
static char aztDiskChanged = 1;
static char aztTocUpToDate = 0;
 
static unsigned char aztIndatum;
static unsigned long aztTimeOutCount;
static int aztCmd = 0;
 
/*###########################################################################
   Function Prototypes
  ###########################################################################
*/
/* CDROM Drive Low Level I/O Functions */
void        op_ok(void);
void        pa_ok(void);
void        sten_low(void);
void        dten_low(void);
void        statusAzt(void);
static void aztStatTimer(void);
 
/* CDROM Drive Command Functions */
static int  aztSendCmd(int cmd);
static int  sendAztCmd(int cmd, struct azt_Play_msf *params);
static int  aztSeek(struct azt_Play_msf *params);
static int  aztSetDiskType(int type);
static int  aztStatus(void);
static int  getAztStatus(void);
static int  aztPlay(struct azt_Play_msf *arg);
static void aztCloseDoor(void);
static void aztLockDoor(void);
static void aztUnlockDoor(void);
static int  aztGetValue(unsigned char *result);
static int  aztGetQChannelInfo(struct azt_Toc *qp);
static int  aztUpdateToc(void);
static int  aztGetDiskInfo(void);
#if AZT_MULTISESSION 
 static int aztGetMultiDiskInfo(void);
#endif
static int  aztGetToc(int multi);
 
/* Kernel Interface Functions */
void        aztcd_setup(char *str, int *ints);
static int  check_aztcd_media_change(kdev_t full_dev);
static int  aztcd_ioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg);
static void azt_transfer(void);
static void do_aztcd_request(void);
static void azt_invalidate_buffers(void);
int         aztcd_open(struct inode *ip, struct file *fp);
static void aztcd_release(struct inode * inode, struct file * file);
int         aztcd_init(void);
#ifdef MODULE
 int        init_module(void);
 void       cleanup_module(void);
#endif MODULE
static struct file_operations azt_fops = {
	NULL,                   /* lseek - default */
	block_read,             /* read - general block-dev read */
	block_write,            /* write - general block-dev write */
	NULL,                   /* readdir - bad */
	NULL,                   /* select */
	aztcd_ioctl,            /* ioctl */
	NULL,                   /* mmap */
	aztcd_open,             /* open */
	aztcd_release,          /* release */
	NULL,                   /* fsync */
	NULL,                   /* fasync*/
	check_aztcd_media_change, /*media change*/
	NULL                    /* revalidate*/
};
 
/* Aztcd State Machine: Controls Drive Operating State */
static void azt_poll(void);
 
/* Miscellaneous support functions */
static void azt_hsg2msf(long hsg, struct msf *msf);
static long azt_msf2hsg(struct msf *mp);
static void azt_bin2bcd(unsigned char *p);
static int  azt_bcd2bin(unsigned char bcd);
 
/*##########################################################################
  CDROM Drive Low Level I/O Functions
  ##########################################################################
*/
/* Macros for the drive hardware interface handshake, these macros use
   busy waiting */
/* Wait for OP_OK = drive answers with AFL_OP_OK after receiving a command*/
# define OP_OK op_ok()
void op_ok(void)
{ aztTimeOutCount=0; 
  do { aztIndatum=inb(DATA_PORT);
       aztTimeOutCount++;
       if (aztTimeOutCount>=AZT_TIMEOUT)
	{ printk("aztcd: Error Wait OP_OK\n");
	  break;
	}
     } while (aztIndatum!=AFL_OP_OK);
}
 
/* Wait for PA_OK = drive answers with AFL_PA_OK after receiving parameters*/
# define PA_OK pa_ok()
void pa_ok(void)
{ aztTimeOutCount=0; 
  do { aztIndatum=inb(DATA_PORT);
       aztTimeOutCount++;
       if (aztTimeOutCount>=AZT_TIMEOUT)
	{ printk("aztcd: Error Wait PA_OK\n");
	  break;
	}
     } while (aztIndatum!=AFL_PA_OK);
}
 
/* Wait for STEN=Low = handshake signal 'AFL_.._OK available or command executed*/
# define STEN_LOW  sten_low()
void sten_low(void)
{ aztTimeOutCount=0; 
  do { aztIndatum=inb(STATUS_PORT);
       aztTimeOutCount++;
       if (aztTimeOutCount>=AZT_TIMEOUT)
	{ if (azt_init_end) printk("aztcd: Error Wait STEN_LOW commands:%x\n",aztCmd);
	  break;
	}
     } while (aztIndatum&AFL_STATUS);
}
 
/* Wait for DTEN=Low = handshake signal 'Data available'*/
# define DTEN_LOW dten_low()
void dten_low(void)
{ aztTimeOutCount=0; 
  do { aztIndatum=inb(STATUS_PORT);
       aztTimeOutCount++;
       if (aztTimeOutCount>=AZT_TIMEOUT)
	{ printk("aztcd: Error Wait DTEN_OK\n");
	  break;
	}
     } while (aztIndatum&AFL_DATA);
}
 
/* 
 * Macro for timer wait on STEN=Low, should only be used for 'slow' commands;
 * may cause kernel panic when used in the wrong place
*/
#define STEN_LOW_WAIT   statusAzt()
void statusAzt(void)
{ AztTimeout = AZT_STATUS_DELAY;
  SET_TIMER(aztStatTimer, HZ/100); 
  sleep_on(&azt_waitq);
  if (AztTimeout <= 0) printk("aztcd: Error Wait STEN_LOW_WAIT command:%x\n",aztCmd);
  return;
}
 
static void aztStatTimer(void)
{ if (!(inb(STATUS_PORT) & AFL_STATUS))
     { wake_up(&azt_waitq);
       return;
     }
  AztTimeout--;
  if (AztTimeout <= 0)
     { wake_up(&azt_waitq);
       printk("aztcd: Error aztStatTimer: Timeout\n");
       return;
     }
  SET_TIMER(aztStatTimer, HZ/100);
}
 
/*##########################################################################
  CDROM Drive Command Functions
  ##########################################################################
*/
/* 
 * Send a single command, return -1 on error, else 0
*/
static int aztSendCmd(int cmd)
{  unsigned char data;
   int retry;
 
#ifdef AZT_DEBUG
   printk("aztcd: Executing command %x\n",cmd);
#endif
 
   if ((azt_port==0x1f0)||(azt_port==0x170))  
      SWITCH_IDE_SLAVE; /*switch IDE interface to slave configuration*/
 
   aztCmd=cmd;
   outb(POLLED,MODE_PORT);
   do { if (inb(STATUS_PORT)&AFL_STATUS) break;
	inb(DATA_PORT);    /* if status left from last command, read and */
      } while (1);         /* discard it */
   do { if (inb(STATUS_PORT)&AFL_DATA) break;
	inb(DATA_PORT);    /* if data left from last command, read and */
      } while (1);         /* discard it */
   for (retry=0;retry<AZT_RETRY_ATTEMPTS;retry++)
     { outb((unsigned char) cmd,CMD_PORT);
       STEN_LOW;
       data=inb(DATA_PORT);
       if (data==AFL_OP_OK)
	 { return 0;}           /*OP_OK?*/
       if (data==AFL_OP_ERR)
	 { STEN_LOW;
	   data=inb(DATA_PORT);
	   printk("### Error 1 aztcd: aztSendCmd %x  Error Code %x\n",cmd,data);
	 }
     }
   if (retry>=AZT_RETRY_ATTEMPTS)
     { printk("### Error 2 aztcd: aztSendCmd %x \n",cmd);
       azt_error=0xA5;
     }
   RETURNM("aztSendCmd",-1);
}
 
/*
 * Send a play or read command to the drive, return -1 on error, else 0
*/
static int sendAztCmd(int cmd, struct azt_Play_msf *params)
{  unsigned char data;
   int retry;
 
#ifdef AZT_DEBUG
   printk("aztcd: play start=%02x:%02x:%02x  end=%02x:%02x:%02x\n", \
	   params->start.min, params->start.sec, params->start.frame, \
	   params->end.min,   params->end.sec,   params->end.frame);
#endif   
   for (retry=0;retry<AZT_RETRY_ATTEMPTS;retry++)
     { aztSendCmd(cmd);
       outb(params -> start.min,CMD_PORT);
       outb(params -> start.sec,CMD_PORT);
       outb(params -> start.frame,CMD_PORT);
       outb(params -> end.min,CMD_PORT);
       outb(params -> end.sec,CMD_PORT);
       outb(params -> end.frame,CMD_PORT);
       STEN_LOW;
       data=inb(DATA_PORT);
       if (data==AFL_PA_OK)
	 { return 0;}           /*PA_OK ?*/
       if (data==AFL_PA_ERR)
	 { STEN_LOW;
	   data=inb(DATA_PORT);
	   printk("### Error 1 aztcd: sendAztCmd %x  Error Code %x\n",cmd,data);
	 }
     }
   if (retry>=AZT_RETRY_ATTEMPTS)
     { printk("### Error 2 aztcd: sendAztCmd %x\n ",cmd);
       azt_error=0xA5;
     }
   RETURNM("sendAztCmd",-1);
}
 
/*
 * Send a seek command to the drive, return -1 on error, else 0
*/
static int aztSeek(struct azt_Play_msf *params)
{  unsigned char data;
   int retry;
 
#ifdef AZT_DEBUG
   printk("aztcd: aztSeek %02x:%02x:%02x\n", \
	   params->start.min, params->start.sec, params->start.frame);
#endif   
   for (retry=0;retry<AZT_RETRY_ATTEMPTS;retry++)
     { aztSendCmd(ACMD_SEEK);
       outb(params -> start.min,CMD_PORT);
       outb(params -> start.sec,CMD_PORT);
       outb(params -> start.frame,CMD_PORT);
       STEN_LOW;
       data=inb(DATA_PORT);
       if (data==AFL_PA_OK)
	 { return 0;}           /*PA_OK ?*/
       if (data==AFL_PA_ERR)
	 { STEN_LOW;
	   data=inb(DATA_PORT);
	   printk("### Error 1 aztcd: aztSeek\n");
	 }
     }
   if (retry>=AZT_RETRY_ATTEMPTS)
     { printk("### Error 2 aztcd: aztSeek\n ");
       azt_error=0xA5;
     }
   RETURNM("aztSeek",-1);
}
 
/* Send a Set Disk Type command
   does not seem to work with Aztech drives, behavior is completely indepen-
   dent on which mode is set ???
*/
static int aztSetDiskType(int type)
{  unsigned char data;
   int retry;
 
#ifdef AZT_DEBUG
   printk("aztcd: set disk type command: type= %i\n",type);
#endif
   for (retry=0;retry<AZT_RETRY_ATTEMPTS;retry++)
     { aztSendCmd(ACMD_SET_DISK_TYPE);
       outb(type,CMD_PORT);
       STEN_LOW;
       data=inb(DATA_PORT);
       if (data==AFL_PA_OK)     /*PA_OK ?*/
	 { azt_read_mode=type;
	   return 0;            
	 }  
       if (data==AFL_PA_ERR)
	 { STEN_LOW;
	   data=inb(DATA_PORT);
	   printk("### Error 1 aztcd: aztSetDiskType %x Error Code %x\n",type,data);
	 }
     }
   if (retry>=AZT_RETRY_ATTEMPTS)
     { printk("### Error 2 aztcd: aztSetDiskType %x\n ",type);
       azt_error=0xA5;
     }
   RETURNM("aztSetDiskType",-1);
}
 
 
/* used in azt_poll to poll the status, expects another program to issue a 
 * ACMD_GET_STATUS directly before 
 */
static int aztStatus(void)  
{       int st;
/*	int i;
 
	i = inb(STATUS_PORT) & AFL_STATUS;    is STEN=0?    ???
	if (!i)
*/      STEN_LOW;
        if (aztTimeOutCount<AZT_TIMEOUT)	
	{   	st = inb(DATA_PORT) & 0xFF;
		return st;
	}
	else
		RETURNM("aztStatus",-1);
}
 
/*
 * Get the drive status
 */
static int getAztStatus(void)
{       int st;
 
	if (aztSendCmd(ACMD_GET_STATUS)) RETURNM("getAztStatus 1",-1);
	STEN_LOW;
	st = inb(DATA_PORT) & 0xFF;
#ifdef AZT_DEBUG
	printk("aztcd: Status = %x\n",st);
#endif
	if ((st == 0xFF)||(st&AST_CMD_CHECK))
	 { printk("aztcd: AST_CMD_CHECK error or no status available\n");
	   return -1;
	 }
 
	if (((st&AST_MODE_BITS)!=AST_BUSY) && (aztAudioStatus == CDROM_AUDIO_PLAY))
	   /* XXX might be an error? look at q-channel? */
	   aztAudioStatus = CDROM_AUDIO_COMPLETED;
 
	if ((st & AST_DSK_CHG)||(st & AST_NOT_READY))
	 { aztDiskChanged = 1;
	   aztTocUpToDate = 0;
	   aztAudioStatus = CDROM_AUDIO_NO_STATUS;
	 }
	return st;
}
 
 
/*
 * Send a 'Play' command and get the status.  Use only from the top half.
 */
static int aztPlay(struct azt_Play_msf *arg)
{       if (sendAztCmd(ACMD_PLAY_AUDIO, arg) < 0) RETURNM("aztPlay",-1);
	return 0;
}
 
/*
 * Subroutines to automatically close the door (tray) and 
 * lock it closed when the cd is mounted.  Leave the tray
 * locking as an option
 */
static void aztCloseDoor(void)
{
  aztSendCmd(ACMD_CLOSE);
  STEN_LOW;
  return;
}
 
static void aztLockDoor(void)
{
#if AZT_ALLOW_TRAY_LOCK
  aztSendCmd(ACMD_LOCK);
  STEN_LOW;
#endif
  return;
}
 
static void aztUnlockDoor(void)
{
#if AZT_ALLOW_TRAY_LOCK
  aztSendCmd(ACMD_UNLOCK);
  STEN_LOW;
#endif
  return;
}
 
/*
 * Read a value from the drive.  Should return quickly, so a busy wait
 * is used to avoid excessive rescheduling. The read command itself must
 * be issued with aztSendCmd() directly before
 */
static int aztGetValue(unsigned char *result)
{       int s;
 
	STEN_LOW;
	if (aztTimeOutCount>=AZT_TIMEOUT)
	{       printk("aztcd: aztGetValue timeout\n");
		return -1;
	}
	s = inb(DATA_PORT) & 0xFF;
	*result = (unsigned char) s;
	return 0;
}
 
/*
 * Read the current Q-channel info.  Also used for reading the
 * table of contents.
 */
int aztGetQChannelInfo(struct azt_Toc *qp)
{       unsigned char notUsed;
	int st;
 
#ifdef AZT_DEBUG
	printk("aztcd: starting aztGetQChannelInfo  Time:%li\n",jiffies);
#endif
	if ((st=getAztStatus())==-1)        RETURNM("aztGetQChannelInfo 1",-1);
	if (aztSendCmd(ACMD_GET_Q_CHANNEL)) RETURNM("aztGetQChannelInfo 2",-1);
	/*STEN_LOW_WAIT; ??? Dosemu0.60's cdrom.c does not like STEN_LOW_WAIT here*/
	if (aztGetValue(&notUsed)) RETURNM("aztGetQChannelInfo 3",-1); /*??? Nullbyte einlesen*/
	if ((st&AST_MODE_BITS)==AST_INITIAL)
	 { qp->ctrl_addr=0;      /* when audio stop ACMD_GET_Q_CHANNEL returns */
	   qp->track=0;          /* only one byte with Aztech drives */
	   qp->pointIndex=0;
	   qp->trackTime.min=0;
	   qp->trackTime.sec=0;
	   qp->trackTime.frame=0;
	   qp->diskTime.min=0;
	   qp->diskTime.sec=0;
	   qp->diskTime.frame=0;
	   return 0;  
	 }
	else
	 { if (aztGetValue(&qp -> ctrl_addr) < 0)       RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> track) < 0)           RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> pointIndex) < 0)      RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> trackTime.min) < 0)   RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> trackTime.sec) < 0)   RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> trackTime.frame) < 0) RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&notUsed) < 0)               RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> diskTime.min) < 0)    RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> diskTime.sec) < 0)    RETURNM("aztGetQChannelInfo 4",-1);
	   if (aztGetValue(&qp -> diskTime.frame) < 0)  RETURNM("aztGetQChannelInfo 4",-1);
	 }
#ifdef AZT_DEBUG
	printk("aztcd: exiting aztGetQChannelInfo  Time:%li\n",jiffies);
#endif
	return 0;
}
 
/*
 * Read the table of contents (TOC) and TOC header if necessary
 */
static int aztUpdateToc()
{       int st;
 
#ifdef AZT_DEBUG
	printk("aztcd: starting aztUpdateToc  Time:%li\n",jiffies);
#endif  
	if (aztTocUpToDate)
		return 0;
 
	if (aztGetDiskInfo() < 0)
		return -EIO;
 
	if (aztGetToc(0) < 0)
		return -EIO;
 
        /*audio disk detection
          with my Aztech drive there is no audio status bit, so I use the copy
          protection bit of the first track. If this track is copy protected 
          (copy bit = 0), I assume, it's an audio  disk. Strange, but works ??? */
        if (!(Toc[DiskInfo.first].ctrl_addr & 0x40)) 
           DiskInfo.audio=1;
        else 
           DiskInfo.audio=0;
 
        /* XA detection */
	if (! DiskInfo.audio) 
	   { azt_Play.start.min   = 0;  /*XA detection only seems to work*/
             azt_Play.start.sec   = 2;  /*when we play a track*/
	     azt_Play.start.frame = 0;
	     azt_Play.end.min     = 0;
	     azt_Play.end.sec     = 0;
	     azt_Play.end.frame   = 1;
	     if (sendAztCmd(ACMD_PLAY_READ, &azt_Play)) return -1;
	     DTEN_LOW;
	     for (st=0;st<CD_FRAMESIZE;st++) inb(DATA_PORT);
           } 
        DiskInfo.xa = getAztStatus() & AST_MODE;
        if (DiskInfo.xa) 
           { printk("aztcd: XA support experimental - mail results to zimmerma@rz.fht-esslingen.de\n");
           }
 
        /*multisession detection
          support for multisession CDs is done automatically with Aztech drives,
          we don't have to take care about TOC redirection; if we want the isofs
          to take care about redirection, we have to set AZT_MULTISESSION to 1*/
        DiskInfo.multi=0;
#if AZT_MULTISESSION
  	if (DiskInfo.xa) 
  	   { aztGetMultiDiskInfo(); /*here Disk.Info.multi is set*/
  	   }
#endif
        if (DiskInfo.multi)
           { DiskInfo.lastSession.min  = Toc[DiskInfo.next].diskTime.min;
	     DiskInfo.lastSession.sec  = Toc[DiskInfo.next].diskTime.sec;
             DiskInfo.lastSession.frame= Toc[DiskInfo.next].diskTime.frame;
             printk("aztcd: Multisession support experimental\n");
           }
        else
           { DiskInfo.lastSession.min  = Toc[DiskInfo.first].diskTime.min;
	     DiskInfo.lastSession.sec  = Toc[DiskInfo.first].diskTime.sec;
             DiskInfo.lastSession.frame= Toc[DiskInfo.first].diskTime.frame;
           }
 
	aztTocUpToDate = 1;
#ifdef AZT_DEBUG
	printk("aztcd: exiting aztUpdateToc  Time:%li\n",jiffies);
#endif
	return 0;
}
 
 
/* Read the table of contents header, i.e. no. of tracks and start of first 
 * track
 */
static int aztGetDiskInfo()
{ int limit;
  unsigned char test;
  struct azt_Toc qInfo;
 
#ifdef AZT_DEBUG
  printk("aztcd: starting aztGetDiskInfo  Time:%li\n",jiffies);
#endif
  if (aztSendCmd(ACMD_SEEK_TO_LEADIN)) RETURNM("aztGetDiskInfo 1",-1);
  STEN_LOW_WAIT;
  test=0;
  for (limit=300;limit>0;limit--)
   {  if (aztGetQChannelInfo(&qInfo)<0) RETURNM("aztGetDiskInfo 2",-1);
      if (qInfo.pointIndex==0xA0)   /*Number of FirstTrack*/
	{ DiskInfo.first = qInfo.diskTime.min;
	  DiskInfo.first = azt_bcd2bin(DiskInfo.first);
	  test=test|0x01;
	}
      if (qInfo.pointIndex==0xA1)   /*Number of LastTrack*/
	{ DiskInfo.last  = qInfo.diskTime.min;
	  DiskInfo.last  = azt_bcd2bin(DiskInfo.last);
	  test=test|0x02;
	}
      if (qInfo.pointIndex==0xA2)   /*DiskLength*/
	{ DiskInfo.diskLength.min=qInfo.diskTime.min;
	  DiskInfo.diskLength.sec=qInfo.diskTime.sec;
	  DiskInfo.diskLength.frame=qInfo.diskTime.frame;
	  test=test|0x04;
	}
      if ((qInfo.pointIndex==DiskInfo.first)&&(test&0x01))   /*StartTime of First Track*/
	{ DiskInfo.firstTrack.min=qInfo.diskTime.min;
	  DiskInfo.firstTrack.sec=qInfo.diskTime.sec;
	  DiskInfo.firstTrack.frame=qInfo.diskTime.frame;
	  test=test|0x08;
	}
      if (test==0x0F) break;
   }
#ifdef AZT_DEBUG
  printk ("aztcd: exiting aztGetDiskInfo  Time:%li\n",jiffies);
  printk("Disk Info: first %d last %d length %02X:%02X.%02X dez  first %02X:%02X.%02X dez\n",
  	  DiskInfo.first,
	  DiskInfo.last,
	  DiskInfo.diskLength.min,
	  DiskInfo.diskLength.sec,
	  DiskInfo.diskLength.frame,
	  DiskInfo.firstTrack.min,
	  DiskInfo.firstTrack.sec,
	  DiskInfo.firstTrack.frame);
#endif
  if (test!=0x0F) return -1;
  return 0;
}
 
#if AZT_MULTISESSION
/*
 * Get Multisession Disk Info
 */
static int aztGetMultiDiskInfo(void)
{ int limit, k=5;
  unsigned char test;
  struct azt_Toc qInfo;
 
#ifdef AZT_DEBUG
  printk("aztcd: starting aztGetMultiDiskInfo\n");
#endif
 
  do { azt_Play.start.min   = Toc[DiskInfo.last+1].diskTime.min;
       azt_Play.start.sec   = Toc[DiskInfo.last+1].diskTime.sec;
       azt_Play.start.frame = Toc[DiskInfo.last+1].diskTime.frame;
       test=0;
 
       for (limit=30;limit>0;limit--)   /*Seek for LeadIn of next session*/
           { if (aztSeek(&azt_Play)) RETURNM("aztGetMultiDiskInfo 1",-1);
             if (aztGetQChannelInfo(&qInfo)<0) RETURNM("aztGetMultiDiskInfo 2",-1);
             if ((qInfo.track==0)&&(qInfo.pointIndex)) break;  /*LeadIn found*/
             if ((azt_Play.start.sec+=10) > 59)
                { azt_Play.start.sec=0;
                  azt_Play.start.min++;
                }
           }
       if (!limit) break;  /*Check, if a leadin track was found, if not we're
                             at the end of the disk*/
#ifdef AZT_DEBUG_MULTISESSION
       printk("leadin found track %d  pointIndex %x  limit %d\n",qInfo.track,qInfo.pointIndex,limit);
#endif
       for (limit=300;limit>0;limit--)
           { if (++azt_Play.start.frame>74)
                { azt_Play.start.frame=0;
                  if (azt_Play.start.sec > 59)
                     { azt_Play.start.sec=0;
                       azt_Play.start.min++;
                     }
                }     
             if (aztSeek(&azt_Play)) RETURNM("aztGetMultiDiskInfo 3",-1);
             if (aztGetQChannelInfo(&qInfo)<0) RETURNM("aztGetMultiDiskInfo 4",-1);
             if (qInfo.pointIndex==0xA0)   /*Number of NextTrack*/
	        { DiskInfo.next = qInfo.diskTime.min;
	          DiskInfo.next = azt_bcd2bin(DiskInfo.next);
	          test=test|0x01;
	        }
             if (qInfo.pointIndex==0xA1)   /*Number of LastTrack*/
	 	{ DiskInfo.last  = qInfo.diskTime.min;
	   	  DiskInfo.last  = azt_bcd2bin(DiskInfo.last);
	   	  test=test|0x02;
	 	}
      	     if (qInfo.pointIndex==0xA2)   /*DiskLength*/
	 	{ DiskInfo.diskLength.min  =qInfo.diskTime.min;
	   	  DiskInfo.diskLength.sec  =qInfo.diskTime.sec;
	   	  DiskInfo.diskLength.frame=qInfo.diskTime.frame;
	  	  test=test|0x04;
	 	}
      	     if ((qInfo.pointIndex==DiskInfo.next)&&(test&0x01))   /*StartTime of Next Track*/
		{ DiskInfo.nextSession.min=qInfo.diskTime.min;
	  	  DiskInfo.nextSession.sec=qInfo.diskTime.sec;
	  	  DiskInfo.nextSession.frame=qInfo.diskTime.frame;
	  	  test=test|0x08;
		}
      	     if (test==0x0F) break;
   	   }
#ifdef AZT_DEBUG_MULTISESSION
       printk ("MultiDisk Info: first %d next %d last %d length %02x:%02x.%02x dez  first %02x:%02x.%02x dez  next %02x:%02x.%02x dez\n",
     		DiskInfo.first,
		DiskInfo.next,
		DiskInfo.last,
		DiskInfo.diskLength.min,
		DiskInfo.diskLength.sec,
		DiskInfo.diskLength.frame,
		DiskInfo.firstTrack.min,
		DiskInfo.firstTrack.sec,
		DiskInfo.firstTrack.frame,
		DiskInfo.nextSession.min,
		DiskInfo.nextSession.sec,
		DiskInfo.nextSession.frame);
#endif
       if (test!=0x0F) 
           break;
       else 
           DiskInfo.multi=1;   /*found TOC of more than one session*/
       aztGetToc(1);
     } while(--k);
 
#ifdef AZT_DEBUG
  printk ("aztcd: exiting aztGetMultiDiskInfo  Time:%li\n",jiffies);
#endif
  return 0;
}
#endif
 
/*
 * Read the table of contents (TOC)
 */
static int aztGetToc(int multi)
{ int i, px;
  int limit;
  struct azt_Toc qInfo;
 
#ifdef AZT_DEBUG
  printk("aztcd: starting aztGetToc  Time:%li\n",jiffies);
#endif
  if (!multi)
     { for (i = 0; i < MAX_TRACKS; i++)
 	    Toc[i].pointIndex = 0;
       i = DiskInfo.last + 3;
     }
  else
     { for (i = DiskInfo.next; i < MAX_TRACKS; i++)
     	    Toc[i].pointIndex = 0; 
       i = DiskInfo.last + 4 - DiskInfo.next;
     }
 
/*Is there a good reason to stop motor before TOC read?
  if (aztSendCmd(ACMD_STOP)) RETURNM("aztGetToc 1",-1);
      STEN_LOW_WAIT;
*/
 
  if (!multi)
     { azt_mode = 0x05;
       if (aztSendCmd(ACMD_SEEK_TO_LEADIN)) RETURNM("aztGetToc 2",-1);
       STEN_LOW_WAIT;
     }
  for (limit = 300; limit > 0; limit--)
      { if (multi)
           { if (++azt_Play.start.sec > 59)
                { azt_Play.start.sec=0;
                  azt_Play.start.min++;
                }
             if (aztSeek(&azt_Play)) RETURNM("aztGetToc 3",-1);
           }
	if (aztGetQChannelInfo(&qInfo) < 0)
	    break;
 
	px = azt_bcd2bin(qInfo.pointIndex);
 
	if (px > 0 && px < MAX_TRACKS && qInfo.track == 0)
  	    if (Toc[px].pointIndex == 0)
	       { Toc[px] = qInfo;
		 i--;
	       }
 
	if (i <= 0)
	    break;
      }
 
  Toc[DiskInfo.last + 1].diskTime = DiskInfo.diskLength;
  Toc[DiskInfo.last].trackTime    = DiskInfo.diskLength;
 
#ifdef AZT_DEBUG_MULTISESSION 
  printk("aztcd: exiting aztGetToc\n");
  for (i = 1; i <= DiskInfo.last+1; i++)
       printk("i = %2d ctl-adr = %02X track %2d px %02X %02X:%02X.%02X dez  %02X:%02X.%02X dez\n",
               i, Toc[i].ctrl_addr, Toc[i].track, Toc[i].pointIndex,
               Toc[i].trackTime.min, Toc[i].trackTime.sec, Toc[i].trackTime.frame,
               Toc[i].diskTime.min, Toc[i].diskTime.sec, Toc[i].diskTime.frame);
  for (i = 100; i < 103; i++)
       printk("i = %2d ctl-adr = %02X track %2d px %02X %02X:%02X.%02X dez  %02X:%02X.%02X dez\n",
               i, Toc[i].ctrl_addr, Toc[i].track, Toc[i].pointIndex,
               Toc[i].trackTime.min, Toc[i].trackTime.sec, Toc[i].trackTime.frame,
               Toc[i].diskTime.min, Toc[i].diskTime.sec, Toc[i].diskTime.frame);
#endif
 
  return limit > 0 ? 0 : -1;
}
 
 
/*##########################################################################
  Kernel Interface Functions
  ##########################################################################
*/
void aztcd_setup(char *str, int *ints)
{  if (ints[0] > 0)
      azt_port = ints[1];
   if (ints[0] > 1)
      azt_cont = ints[2];
}
 
/* 
 * Checking if the media has been changed
*/
static int check_aztcd_media_change(kdev_t full_dev)
{ if (aztDiskChanged)          /* disk changed */
     { aztDiskChanged=0;
       return 1;
     }
  else
       return 0;               /* no change */
}
 
/*
 * Kernel IO-controls
*/
static int aztcd_ioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg)
{       int i, st;
	struct azt_Toc qInfo;
	struct cdrom_ti ti;
	struct cdrom_tochdr tocHdr;
	struct cdrom_msf msf;
	struct cdrom_tocentry entry;
	struct azt_Toc *tocPtr;            
	struct cdrom_subchnl subchnl;
        struct cdrom_volctrl volctrl;
 
#ifdef AZT_DEBUG
	printk("aztcd: starting aztcd_ioctl - Command:%x   Time: %li\n",cmd, jiffies);
        printk("aztcd Status %x\n", getAztStatus());
#endif
	if (!ip) RETURNM("aztcd_ioctl 1",-EINVAL);
	if (getAztStatus()<0) RETURNM("aztcd_ioctl 2", -EIO);
	if ((!aztTocUpToDate)||(aztDiskChanged))
	{ if ((i=aztUpdateToc())<0) RETURNM("aztcd_ioctl 3", i); /* error reading TOC */
	}
 
	switch (cmd)
	{
	case CDROMSTART:     /* Spin up the drive. Don't know, what to do,
	                        at least close the tray */
#if AZT_PRIVATE_IOCTLS 
	        if (aztSendCmd(ACMD_CLOSE)) RETURNM("aztcd_ioctl 4",-1);
	        STEN_LOW_WAIT;
#endif
		break;
	case CDROMSTOP:      /* Spin down the drive */
		if (aztSendCmd(ACMD_STOP)) RETURNM("aztcd_ioctl 5",-1);
		STEN_LOW_WAIT;
		/* should we do anything if it fails? */
		aztAudioStatus = CDROM_AUDIO_NO_STATUS;
		break;
	case CDROMPAUSE:     /* Pause the drive */
                if (aztAudioStatus != CDROM_AUDIO_PLAY) return -EINVAL; 
 
		if (aztGetQChannelInfo(&qInfo) < 0)
		{ /* didn't get q channel info */
		  aztAudioStatus = CDROM_AUDIO_NO_STATUS;
		  RETURNM("aztcd_ioctl 7",0);
		}
		azt_Play.start = qInfo.diskTime;        /* remember restart point */
 
		if (aztSendCmd(ACMD_PAUSE)) RETURNM("aztcd_ioctl 8",-1);
		STEN_LOW_WAIT;
		aztAudioStatus = CDROM_AUDIO_PAUSED;
		break;
	case CDROMRESUME:    /* Play it again, Sam */
		if (aztAudioStatus != CDROM_AUDIO_PAUSED) return -EINVAL;
		/* restart the drive at the saved position. */
		i = aztPlay(&azt_Play);
		if (i < 0)
		{ aztAudioStatus = CDROM_AUDIO_ERROR;
		  return -EIO;
		}
		aztAudioStatus = CDROM_AUDIO_PLAY;
		break;
	case CDROMMULTISESSION: /*multisession support -- experimental*/
	        { struct cdrom_multisession ms;
#ifdef AZT_DEBUG
   		  printk("aztcd ioctl MULTISESSION\n");
#endif
		  st = verify_area(VERIFY_WRITE, (void*) arg, sizeof(struct cdrom_multisession));
		  if (st) return st;
		  memcpy_fromfs(&ms, (void*) arg, sizeof(struct cdrom_multisession));
		  if (ms.addr_format == CDROM_MSF) 
		     { ms.addr.msf.minute = azt_bcd2bin(DiskInfo.lastSession.min);
		       ms.addr.msf.second = azt_bcd2bin(DiskInfo.lastSession.sec);
		       ms.addr.msf.frame  = azt_bcd2bin(DiskInfo.lastSession.frame);
		     } 
		  else if (ms.addr_format == CDROM_LBA)
		       ms.addr.lba = azt_msf2hsg(&DiskInfo.lastSession);
		  else
		       return -EINVAL;
		  ms.xa_flag = DiskInfo.xa;
	  	  memcpy_tofs((void*) arg, &ms, sizeof(struct cdrom_multisession));
#ifdef AZT_DEBUG 
 		  if (ms.addr_format == CDROM_MSF) 
                      printk("aztcd multisession xa:%d, msf:%02x:%02x.%02x [%02x:%02x.%02x])\n",
			      ms.xa_flag, ms.addr.msf.minute, ms.addr.msf.second, 
			      ms.addr.msf.frame, DiskInfo.lastSession.min,
			      DiskInfo.lastSession.sec, DiskInfo.lastSession.frame);
		  else
		      printk("aztcd multisession %d, lba:0x%08x [%02x:%02x.%02x])\n",
			      ms.xa_flag, ms.addr.lba, DiskInfo.lastSession.min,
			      DiskInfo.lastSession.sec, DiskInfo.lastSession.frame);
#endif
   		  return 0;
		}
	case CDROMPLAYTRKIND:     /* Play a track.  This currently ignores index. */
		st = verify_area(VERIFY_READ, (void *) arg, sizeof ti);
		if (st) return st;
		memcpy_fromfs(&ti, (void *) arg, sizeof ti);
		if (ti.cdti_trk0 < DiskInfo.first
			|| ti.cdti_trk0 > DiskInfo.last
			|| ti.cdti_trk1 < ti.cdti_trk0)
		{ return -EINVAL;
		}
		if (ti.cdti_trk1 > DiskInfo.last)
		    ti.cdti_trk1 = DiskInfo.last;
		azt_Play.start = Toc[ti.cdti_trk0].diskTime;
		azt_Play.end = Toc[ti.cdti_trk1 + 1].diskTime;
#ifdef AZT_DEBUG
printk("aztcd play: %02x:%02x.%02x to %02x:%02x.%02x\n",
	azt_Play.start.min, azt_Play.start.sec, azt_Play.start.frame,
	azt_Play.end.min, azt_Play.end.sec, azt_Play.end.frame);
#endif
		i = aztPlay(&azt_Play);
		if (i < 0)
		{ aztAudioStatus = CDROM_AUDIO_ERROR;
		  return -EIO;
		}
		aztAudioStatus = CDROM_AUDIO_PLAY;
		break;
	case CDROMPLAYMSF:   /* Play starting at the given MSF address. */
/*              if (aztAudioStatus == CDROM_AUDIO_PLAY) 
		{ if (aztSendCmd(ACMD_STOP)) RETURNM("aztcd_ioctl 9",-1);
		  STEN_LOW;
		  aztAudioStatus = CDROM_AUDIO_NO_STATUS;
		}
*/
		st = verify_area(VERIFY_READ, (void *) arg, sizeof msf);
		if (st) return st;
		memcpy_fromfs(&msf, (void *) arg, sizeof msf);
		/* convert to bcd */
		azt_bin2bcd(&msf.cdmsf_min0);
		azt_bin2bcd(&msf.cdmsf_sec0);
		azt_bin2bcd(&msf.cdmsf_frame0);
		azt_bin2bcd(&msf.cdmsf_min1);
		azt_bin2bcd(&msf.cdmsf_sec1);
		azt_bin2bcd(&msf.cdmsf_frame1);
		azt_Play.start.min = msf.cdmsf_min0;
		azt_Play.start.sec = msf.cdmsf_sec0;
		azt_Play.start.frame = msf.cdmsf_frame0;
		azt_Play.end.min = msf.cdmsf_min1;
		azt_Play.end.sec = msf.cdmsf_sec1;
		azt_Play.end.frame = msf.cdmsf_frame1;
#ifdef AZT_DEBUG
printk("aztcd play: %02x:%02x.%02x to %02x:%02x.%02x\n",
azt_Play.start.min, azt_Play.start.sec, azt_Play.start.frame,
azt_Play.end.min, azt_Play.end.sec, azt_Play.end.frame);
#endif
		i = aztPlay(&azt_Play);
		if (i < 0)
		{ aztAudioStatus = CDROM_AUDIO_ERROR;
		  return -EIO;
		}
		aztAudioStatus = CDROM_AUDIO_PLAY;
		break;
 
	case CDROMREADTOCHDR:        /* Read the table of contents header */
		st = verify_area(VERIFY_WRITE, (void *) arg, sizeof tocHdr);
		if (st) return st;
		tocHdr.cdth_trk0 = DiskInfo.first;
		tocHdr.cdth_trk1 = DiskInfo.last;
		memcpy_tofs((void *) arg, &tocHdr, sizeof tocHdr);
		break;
	case CDROMREADTOCENTRY:      /* Read an entry in the table of contents */
		st = verify_area(VERIFY_WRITE, (void *) arg, sizeof entry);
		if (st) return st;
		memcpy_fromfs(&entry, (void *) arg, sizeof entry);
		if ((!aztTocUpToDate)||aztDiskChanged) aztUpdateToc();
		if (entry.cdte_track == CDROM_LEADOUT)
		  tocPtr = &Toc[DiskInfo.last + 1];
		else if (entry.cdte_track > DiskInfo.last
				|| entry.cdte_track < DiskInfo.first)
		{ return -EINVAL;
		}
		else 
		  tocPtr = &Toc[entry.cdte_track];
		entry.cdte_adr = tocPtr -> ctrl_addr;
		entry.cdte_ctrl = tocPtr -> ctrl_addr >> 4;
		if (entry.cdte_format == CDROM_LBA)
		  entry.cdte_addr.lba = azt_msf2hsg(&tocPtr -> diskTime);
		else if (entry.cdte_format == CDROM_MSF)
		{ entry.cdte_addr.msf.minute = azt_bcd2bin(tocPtr -> diskTime.min);
		  entry.cdte_addr.msf.second = azt_bcd2bin(tocPtr -> diskTime.sec);
		  entry.cdte_addr.msf.frame  = azt_bcd2bin(tocPtr -> diskTime.frame);
		}
		else
		{ return -EINVAL;
		}
		memcpy_tofs((void *) arg, &entry, sizeof entry);
		break;
	case CDROMSUBCHNL:   /* Get subchannel info */
		st = verify_area(VERIFY_WRITE, (void *) arg, sizeof(struct cdrom_subchnl));
		if (st) { 
#ifdef AZT_DEBUG
		          printk("aztcd: exiting aztcd_ioctl - Error 1 - Command:%x\n",cmd);
#endif
		          return st;
		        }  
		memcpy_fromfs(&subchnl, (void *) arg, sizeof (struct cdrom_subchnl));
		if (aztGetQChannelInfo(&qInfo) < 0)
		if (st) { 
#ifdef AZT_DEBUG
		          printk("aztcd: exiting aztcd_ioctl - Error 3 - Command:%x\n",cmd);
#endif
     		  	  return -EIO;
     		  	}  
		subchnl.cdsc_audiostatus = aztAudioStatus;
		subchnl.cdsc_adr = qInfo.ctrl_addr;
		subchnl.cdsc_ctrl = qInfo.ctrl_addr >> 4;
		subchnl.cdsc_trk = azt_bcd2bin(qInfo.track);
		subchnl.cdsc_ind = azt_bcd2bin(qInfo.pointIndex);
		if (subchnl.cdsc_format == CDROM_LBA)
		{ subchnl.cdsc_absaddr.lba = azt_msf2hsg(&qInfo.diskTime);
		  subchnl.cdsc_reladdr.lba = azt_msf2hsg(&qInfo.trackTime);
		}
		else  /*default*/
		{ subchnl.cdsc_format = CDROM_MSF;
		  subchnl.cdsc_absaddr.msf.minute = azt_bcd2bin(qInfo.diskTime.min);
		  subchnl.cdsc_absaddr.msf.second = azt_bcd2bin(qInfo.diskTime.sec);
		  subchnl.cdsc_absaddr.msf.frame  = azt_bcd2bin(qInfo.diskTime.frame);
		  subchnl.cdsc_reladdr.msf.minute = azt_bcd2bin(qInfo.trackTime.min);
		  subchnl.cdsc_reladdr.msf.second = azt_bcd2bin(qInfo.trackTime.sec);
		  subchnl.cdsc_reladdr.msf.frame  = azt_bcd2bin(qInfo.trackTime.frame);
		}
		memcpy_tofs((void *) arg, &subchnl, sizeof (struct cdrom_subchnl));
		break;
	case CDROMVOLCTRL:   /* Volume control 
	 * With my Aztech CD268-01A volume control does not work, I can only
	   turn the channels on (any value !=0) or off (value==0). Maybe it
           works better with your drive */
                st=verify_area(VERIFY_READ,(void *) arg, sizeof(volctrl));
                if (st) return (st);
                memcpy_fromfs(&volctrl,(char *) arg,sizeof(volctrl));
		azt_Play.start.min = 0x21;
		azt_Play.start.sec = 0x84;
		azt_Play.start.frame = volctrl.channel0;
		azt_Play.end.min =     volctrl.channel1;
		azt_Play.end.sec =     volctrl.channel2;
		azt_Play.end.frame =   volctrl.channel3;
                sendAztCmd(ACMD_SET_VOLUME, &azt_Play);
                STEN_LOW_WAIT;
                break;
	case CDROMEJECT:
                aztUnlockDoor(); /* Assume user knows what they're doing */
	       /* all drives can at least stop! */
		if (aztAudioStatus == CDROM_AUDIO_PLAY) 
		{ if (aztSendCmd(ACMD_STOP)) RETURNM("azt_ioctl 10",-1);
		  STEN_LOW_WAIT;
		}
		if (aztSendCmd(ACMD_EJECT)) RETURNM("azt_ioctl 11",-1);
		STEN_LOW_WAIT;
		aztAudioStatus = CDROM_AUDIO_NO_STATUS;
		break;
	case CDROMEJECT_SW:
		azt_auto_eject = (char) arg;
		break;	
        case CDROMRESET:
        	outb(ACMD_SOFT_RESET,CMD_PORT);   /*send reset*/
	        STEN_LOW;
	        if (inb(DATA_PORT)!=AFL_OP_OK)    /*OP_OK?*/
	          { printk("aztcd: AZTECH CD-ROM drive does not respond\n");
                  }
                break;
/*Take care, the following code is not compatible with other CD-ROM drivers,
  use it at your own risk with cdplay.c. Set AZT_PRIVATE_IOCTLS to 0 in aztcd.h,
  if you do not want to use it!
*/                  
#if AZT_PRIVATE_IOCTLS 
	case CDROMREADCOOKED: /*read data in mode 1 (2048 Bytes)*/
	case CDROMREADRAW:    /*read data in mode 2 (2336 Bytes)*/
		{ st = verify_area(VERIFY_WRITE, (void *) arg, sizeof buf);
		  if (st) return st;
		  memcpy_fromfs(&msf, (void *) arg, sizeof msf);
		  /* convert to bcd */
		  azt_bin2bcd(&msf.cdmsf_min0);
		  azt_bin2bcd(&msf.cdmsf_sec0);
		  azt_bin2bcd(&msf.cdmsf_frame0);
		  msf.cdmsf_min1=0;
		  msf.cdmsf_sec1=0;
		  msf.cdmsf_frame1=1; /*read only one frame*/
		  azt_Play.start.min = msf.cdmsf_min0;
		  azt_Play.start.sec = msf.cdmsf_sec0;
		  azt_Play.start.frame = msf.cdmsf_frame0;
		  azt_Play.end.min = msf.cdmsf_min1;
		  azt_Play.end.sec = msf.cdmsf_sec1;
		  azt_Play.end.frame = msf.cdmsf_frame1;
		  if (cmd==CDROMREADRAW)
		  { if (DiskInfo.xa)
		       { return -1;         /*XA Disks can't be read raw*/
		       }
		    else   
		       { if (sendAztCmd(ACMD_PLAY_READ_RAW, &azt_Play)) return -1;
		         DTEN_LOW;
		         insb(DATA_PORT,buf,CD_FRAMESIZE_RAW);
		         memcpy_tofs((void *) arg, &buf, CD_FRAMESIZE_RAW);
		       }  
		  }
		  else /*CDROMREADCOOKED*/
		  { if (sendAztCmd(ACMD_PLAY_READ, &azt_Play)) return -1;
		    DTEN_LOW;
		    insb(DATA_PORT,buf,CD_FRAMESIZE);
		    memcpy_tofs((void *) arg, &buf, CD_FRAMESIZE);
		  }
		 } 
                break;
	case CDROMSEEK:    /*seek msf address*/
		st = verify_area(VERIFY_READ,  (void *) arg, sizeof msf);
		if (st) return st;
		memcpy_fromfs(&msf, (void *) arg, sizeof msf);
		/* convert to bcd */
		azt_bin2bcd(&msf.cdmsf_min0);
		azt_bin2bcd(&msf.cdmsf_sec0);
		azt_bin2bcd(&msf.cdmsf_frame0);
		azt_Play.start.min = msf.cdmsf_min0;
		azt_Play.start.sec = msf.cdmsf_sec0;
		azt_Play.start.frame = msf.cdmsf_frame0;
		if (aztSeek(&azt_Play)) return -1;
                break;
#endif /*end of incompatible code*/       
	case CDROMREADMODE1: /*set read data in mode 1*/
                return aztSetDiskType(AZT_MODE_1);
	case CDROMREADMODE2: /*set read data in mode 2*/
                return aztSetDiskType(AZT_MODE_2);	    
	default:
		return -EINVAL;
	}
#ifdef AZT_DEBUG
        printk("aztcd: exiting aztcd_ioctl Command:%x  Time:%li\n",cmd,jiffies);
#endif
	return 0;
}
 
/*
 * Take care of the different block sizes between cdrom and Linux.
 * When Linux gets variable block sizes this will probably go away.
 */
static void azt_transfer(void)
{ 
#ifdef AZT_TEST
  printk("aztcd: executing azt_transfer Time:%li\n",jiffies);
#endif
  if (CURRENT_VALID) {
    while (CURRENT -> nr_sectors) {
      int bn = CURRENT -> sector / 4;
      int i;
      for (i = 0; i < AZT_BUF_SIZ && azt_buf_bn[i] != bn; ++i)
	;
      if (i < AZT_BUF_SIZ) {
	int offs = (i * 4 + (CURRENT -> sector & 3)) * 512;
	int nr_sectors = 4 - (CURRENT -> sector & 3);
	if (azt_buf_out != i) {
	  azt_buf_out = i;
	  if (azt_buf_bn[i] != bn) {
	    azt_buf_out = -1;
	    continue;
	  }
	}
	if (nr_sectors > CURRENT -> nr_sectors)
	  nr_sectors = CURRENT -> nr_sectors;
	memcpy(CURRENT -> buffer, azt_buf + offs, nr_sectors * 512);
	CURRENT -> nr_sectors -= nr_sectors;
	CURRENT -> sector += nr_sectors;
	CURRENT -> buffer += nr_sectors * 512;
      } else {
	azt_buf_out = -1;
	break;
      }
    }
  }
}
 
static void do_aztcd_request(void)
{
#ifdef AZT_TEST
  printk(" do_aztcd_request(%ld+%ld) Time:%li\n", CURRENT -> sector, CURRENT -> nr_sectors,jiffies);
#endif
  if (DiskInfo.audio) 
    { printk("aztcd: Error, tried to mount an Audio CD\n");
      end_request(0);
      return;
    }
  azt_transfer_is_active = 1;
  while (CURRENT_VALID) {
    if (CURRENT->bh) {
      if (!buffer_locked(CURRENT->bh))
	panic(DEVICE_NAME ": block not locked");
    }
    azt_transfer();
    if (CURRENT -> nr_sectors == 0) {
      end_request(1);
    } else {
      azt_buf_out = -1;         /* Want to read a block not in buffer */
      if (azt_state == AZT_S_IDLE) {
	if ((!aztTocUpToDate)||aztDiskChanged) {
	  if (aztUpdateToc() < 0) {
	    while (CURRENT_VALID)
	      end_request(0);
	    break;
	  }
	}
	azt_state = AZT_S_START;
	AztTries = 5;
	SET_TIMER(azt_poll, HZ/100);
      }
      break;
    }
  }
  azt_transfer_is_active = 0;
#ifdef AZT_TEST2
  printk("azt_next_bn:%x  azt_buf_in:%x azt_buf_out:%x  azt_buf_bn:%x\n", \
	  azt_next_bn, azt_buf_in, azt_buf_out, azt_buf_bn[azt_buf_in]);
  printk(" do_aztcd_request ends  Time:%li\n",jiffies);
#endif
}
 
 
static void azt_invalidate_buffers(void)
{ int i;
 
#ifdef AZT_DEBUG
  printk("aztcd: executing azt_invalidate_buffers\n");
#endif
  for (i = 0; i < AZT_BUF_SIZ; ++i)
    azt_buf_bn[i] = -1;
  azt_buf_out = -1;
}
 
/*
 * Open the device special file.  Check that a disk is in.
 */
int aztcd_open(struct inode *ip, struct file *fp)
{       int st;
 
#ifdef AZT_DEBUG
	printk("aztcd: starting aztcd_open\n");
#endif
	if (aztPresent == 0)
		return -ENXIO;                  /* no hardware */
 
	if (!azt_open_count && azt_state == AZT_S_IDLE) 
	  { azt_invalidate_buffers();
 
	    st = getAztStatus();                    /* check drive status */
	    if (st == -1) return -EIO;              /* drive doesn't respond */
 
            if (st & AST_DOOR_OPEN)
               { /* close door, then get the status again. */
	         printk("aztcd: Door Open?\n");
                 aztCloseDoor();     
                 st = getAztStatus();
               }        
 
	    if ((st & AST_NOT_READY) || (st & AST_DSK_CHG)) /*no disk in drive or changed*/
	       { printk("aztcd: Disk Changed or No Disk in Drive?\n");
                 aztTocUpToDate=0;
               }
            if (aztUpdateToc())	return -EIO;
 
	  }
	++azt_open_count;
        MOD_INC_USE_COUNT;
	aztLockDoor();
 
 
#ifdef AZT_DEBUG
	printk("aztcd: exiting aztcd_open\n");
#endif
	return 0;
}
 
 
/*
 * On close, we flush all azt blocks from the buffer cache.
 */
static void aztcd_release(struct inode * inode, struct file * file)
{ 
#ifdef AZT_DEBUG
  printk("aztcd: executing aztcd_release\n");
  printk("inode: %p, inode->i_rdev: %x    file: %p\n",inode,inode->i_rdev,file);
#endif
  MOD_DEC_USE_COUNT;
  if (!--azt_open_count) {
	azt_invalidate_buffers();
	sync_dev(inode->i_rdev);             /*??? isn't it a read only dev?*/
	invalidate_buffers(inode -> i_rdev);
	aztUnlockDoor();
        if (azt_auto_eject)
           aztSendCmd(ACMD_EJECT);
        CLEAR_TIMER;
  }
  return;
}
 
 
 
/*
 * Test for presence of drive and initialize it.  Called at boot time.
 */
 
int aztcd_init(void)
{       long int count, max_count;
	unsigned char result[50];
	int st;
 
	if (azt_port <= 0) {
	  printk("aztcd: no Aztech CD-ROM Initialization");
          return -EIO;
	}
	printk("aztcd: AZTECH, ORCHID, OKANO, WEARNES, TXC, CyDROM CD-ROM Driver\n"); 
	printk("aztcd: (C) 1994-96 W.Zimmermann\n");
	printk("aztcd: DriverVersion=%s BaseAddress=0x%x  For IDE/ATAPI-drives use ide-cd.c\n",AZT_VERSION,azt_port);
	printk("aztcd: If you have problems, read /usr/src/linux/Documentation/cdrom/aztcd\n");
 
        if ((azt_port==0x1f0)||(azt_port==0x170))  
          st = check_region(azt_port, 8);  /*IDE-interfaces need 8 bytes*/
        else
          st = check_region(azt_port, 4);  /*proprietary interfaces need 4 bytes*/
	if (st) 
	{ printk("aztcd: conflict, I/O port (%X) already used\n",azt_port);
          return -EIO;
	}
 
#ifdef AZT_SW32   /*CDROM connected to Soundwave32 card*/
        if ((0xFF00 & inw(AZT_SW32_ID_REG)) != 0x4500)
           { printk("aztcd: no Soundwave32 card detected at base:%x init:%x config:%x id:%x\n",
		 AZT_SW32_BASE_ADDR,AZT_SW32_INIT,AZT_SW32_CONFIG_REG,AZT_SW32_ID_REG);
                 return -EIO;
	   }
        else                
           { printk(KERN_INFO "aztcd: Soundwave32 card detected at %x  Version %x\n",
	 	 AZT_SW32_BASE_ADDR, inw(AZT_SW32_ID_REG));
	     outw(AZT_SW32_INIT,AZT_SW32_CONFIG_REG);
	     for (count=0;count<10000;count++);          /*delay a bit*/    	 
           }
#endif	
 
	/* check for presence of drive */
 
        if ((azt_port==0x1f0)||(azt_port==0x170))  
            SWITCH_IDE_SLAVE;  /*switch IDE interface to slave configuration*/
 
	outb(POLLED,MODE_PORT);              
	inb(CMD_PORT);
	inb(CMD_PORT);
	outb(ACMD_GET_VERSION,CMD_PORT); /*Try to get version info*/
 
/*	STEN_LOW  - special implementation for drive recognition
*/      aztTimeOutCount=0;   
	do { aztIndatum=inb(STATUS_PORT);
	     aztTimeOutCount++; 
	     if (aztTimeOutCount>=AZT_FAST_TIMEOUT) break; 
	   } while (aztIndatum&AFL_STATUS); 
 
	if (inb(DATA_PORT)!=AFL_OP_OK) /*OP_OK? If not, reset and try again*/
           { 
#ifndef MODULE
             if (azt_cont!=0x79)   
	        { printk("aztcd: no AZTECH CD-ROM drive found-Try boot parameter aztcd=<BaseAddress>,0x79\n");
	          return -EIO;
                }
#else        
             if (0)
                {
                }
#endif	     
             else   
       	        { printk("aztcd: drive reset - please wait\n");
	          for (count=0;count<50;count++)
	            { inb(STATUS_PORT);    /*removing all data from earlier tries*/
	              inb(DATA_PORT);
	            }
	          outb(POLLED,MODE_PORT);          
	          inb(CMD_PORT);
	          inb(CMD_PORT);
		  getAztStatus(); 		    /*trap errors*/
	          outb(ACMD_SOFT_RESET,CMD_PORT);   /*send reset*/
	          STEN_LOW;
	          if (inb(DATA_PORT)!=AFL_OP_OK)    /*OP_OK?*/
	             { printk("aztcd: no AZTECH CD-ROM drive found\n");
                       return -EIO;
	             } 
	          for (count = 0; count < AZT_TIMEOUT; count++); 
	             { count=count*2;          /* delay a bit */
	               count=count/2;
	             }                        
	          if ((st=getAztStatus())==-1)
	             { printk("aztcd: Drive Status Error Status=%x\n",st);
                       return -EIO;
	             }
#ifdef AZT_DEBUG
	          printk("aztcd: Status = %x\n",st);
#endif
	          outb(POLLED,MODE_PORT);            
	          inb(CMD_PORT);
	          inb(CMD_PORT);
	          outb(ACMD_GET_VERSION,CMD_PORT); /*GetVersion*/
	          STEN_LOW;
	          OP_OK;
	        } 
           }
	azt_init_end=1;
	STEN_LOW;
	result[0]=inb(DATA_PORT);        /*reading in a null byte???*/
	for (count=1;count<50;count++)   /*Reading version string*/
	 { aztTimeOutCount=0;            /*here we must implement STEN_LOW differently*/
	   do { aztIndatum=inb(STATUS_PORT);/*because we want to exit by timeout*/
		aztTimeOutCount++; 
		if (aztTimeOutCount>=AZT_FAST_TIMEOUT) break; 
	      } while (aztIndatum&AFL_STATUS); 
	   if (aztTimeOutCount>=AZT_FAST_TIMEOUT) break;  /*all chars read?*/
	   result[count]=inb(DATA_PORT);
	 }
	if (count>30) max_count=30;  /*print max.30 chars of the version string*/
	else          max_count=count;
	printk(KERN_INFO "aztcd: FirmwareVersion=");
	for (count=1;count<max_count;count++) printk("%c",result[count]);
	printk("<<>> ");
 
	if ((result[1]=='A')&&(result[2]=='Z')&&(result[3]=='T'))
	 { printk("AZTECH drive detected\n"); /*AZTECH*/    
	 }
	else if ((result[2]=='C')&&(result[3]=='D')&&(result[4]=='D'))
	 { printk("ORCHID or WEARNES drive detected\n"); /*ORCHID or WEARNES*/
	 }
	else if ((result[1]==0x03)&&(result[2]=='5'))
	 { printk("TXC or CyCDROM drive detected\n"); /*Conrad TXC, CyCDROM*/
	 }
	else                                             /*OTHERS or none*/
	 { printk("\nunknown drive or firmware version detected\n");
	   printk("aztcd may not run stable, if you want to try anyhow,\n");
	   printk("boot with: aztcd=<BaseAddress>,0x79\n");
	   if ((azt_cont!=0x79))     
	     { printk("aztcd: FirmwareVersion=");
	       for (count=1;count<5;count++) printk("%c",result[count]);
	       printk("<<>> ");
	       printk("Aborted\n");
               return -EIO;
	     }
	 }
	if (register_blkdev(MAJOR_NR, "aztcd", &azt_fops) != 0)
	{
		printk("aztcd: Unable to get major %d for Aztech CD-ROM\n",
		       MAJOR_NR);
                return -EIO;
	}
	blk_dev[MAJOR_NR].request_fn = DEVICE_REQUEST;
	read_ahead[MAJOR_NR] = 4;
 
        if ((azt_port==0x1f0)||(azt_port==0x170))  
	   request_region(azt_port, 8, "aztcd");  /*IDE-interface*/
        else
	   request_region(azt_port, 4, "aztcd");  /*proprietary interface*/
 
	azt_invalidate_buffers();
	aztPresent = 1;
	aztCloseDoor();
/*	printk("aztcd: End Init\n");
*/      return (0);
}
 
#ifdef MODULE
 
int init_module(void)
{
	return aztcd_init();
}
 
void cleanup_module(void)
{
  if ((unregister_blkdev(MAJOR_NR, "aztcd") == -EINVAL))    
    { printk("What's that: can't unregister aztcd\n");
      return;
    }
  if ((azt_port==0x1f0)||(azt_port==0x170))  
    { SWITCH_IDE_MASTER;
      release_region(azt_port,8);  /*IDE-interface*/
    }
  else
      release_region(azt_port,4);  /*proprietary interface*/
  printk(KERN_INFO "aztcd module released.\n");
}   
#endif MODULE
 
 
/*##########################################################################
  Aztcd State Machine: Controls Drive Operating State
  ##########################################################################
*/
static void azt_poll(void)
{
    int st = 0;
    int loop_ctl = 1;
    int skip = 0;
 
    if (azt_error) {                            
	if (aztSendCmd(ACMD_GET_ERROR)) RETURN("azt_poll 1");
	STEN_LOW;
	azt_error=inb(DATA_PORT)&0xFF;
	printk("aztcd: I/O error 0x%02x\n", azt_error);
	azt_invalidate_buffers();
#ifdef WARN_IF_READ_FAILURE
	if (AztTries == 5)
	  printk("aztcd: Read of Block %d Failed - Maybe Audio Disk?\n", azt_next_bn);
#endif
	if (!AztTries--) {
	  printk("aztcd: Read of Block %d Failed, Maybe Audio Disk? Giving up\n", azt_next_bn);
	  if (azt_transfer_is_active) {
	    AztTries = 0;
	    loop_ctl = 0;
	  }
	  if (CURRENT_VALID)
	    end_request(0);
	  AztTries = 5;
	}
    azt_error = 0;
    azt_state = AZT_S_STOP;
    }
 
    while (loop_ctl)
    {
      loop_ctl = 0;   /* each case must flip this back to 1 if we want
			 to come back up here */
      switch (azt_state) {
 
	case AZT_S_IDLE:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old) {
	    azt_state_old=azt_state;
	    printk("AZT_S_IDLE\n");
	    }
#endif
	  return;
 
	case AZT_S_START:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old) {
	    azt_state_old=azt_state;
	    printk("AZT_S_START\n");
	  }
#endif
	  if(aztSendCmd(ACMD_GET_STATUS)) RETURN("azt_poll 2");  /*result will be checked by aztStatus() */
	  azt_state = azt_mode == 1 ? AZT_S_READ : AZT_S_MODE;
	  AztTimeout = 3000;
	  break;
 
	case AZT_S_MODE:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old) {
	    azt_state_old=azt_state;
	    printk("AZT_S_MODE\n");
	  }
#endif
	  if (!skip) {
	    if ((st = aztStatus()) != -1) {
	      if ((st & AST_DSK_CHG)||(st & AST_NOT_READY)) {
		aztDiskChanged = 1;
		aztTocUpToDate = 0;
		azt_invalidate_buffers();
		end_request(0);
		printk("aztcd: Disk Changed or Not Ready 1 - Unmount Disk!\n");
	      }
	    } else break;
	  }
	  skip = 0;
 
	  if ((st & AST_DOOR_OPEN)||(st & AST_NOT_READY)) {
	    aztDiskChanged = 1;
	    aztTocUpToDate = 0;
            printk("aztcd: Disk Changed or Not Ready 2 - Unmount Disk!\n");
            end_request(0);
	    printk((st & AST_DOOR_OPEN) ? "aztcd: door open\n" : "aztcd: disk removed\n");
	    if (azt_transfer_is_active) {
	      azt_state = AZT_S_START;
	      loop_ctl = 1;   /* goto immediately */
	      break;
	    }
	    azt_state = AZT_S_IDLE;
	    while (CURRENT_VALID)
	      end_request(0);
	    return;
	  }
 
/*	  if (aztSendCmd(ACMD_SET_MODE)) RETURN("azt_poll 3");
	  outb(0x01, DATA_PORT);          
	  PA_OK;
	  STEN_LOW;
*/        if (aztSendCmd(ACMD_GET_STATUS)) RETURN("azt_poll 4");
	  STEN_LOW;
	  azt_mode = 1;
	  azt_state = AZT_S_READ;
	  AztTimeout = 3000;
 
	  break;
 
 
	case AZT_S_READ:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old)  {
	    azt_state_old=azt_state;
	    printk("AZT_S_READ\n");
	  }
#endif
	  if (!skip) {
	      if ((st = aztStatus()) != -1) {
		if ((st & AST_DSK_CHG)||(st & AST_NOT_READY)) {
		aztDiskChanged = 1;
		aztTocUpToDate = 0;
		azt_invalidate_buffers();
		printk("aztcd: Disk Changed or Not Ready 3 - Unmount Disk!\n");
                end_request(0);               
		}
	      } else break;
	  } 
 
	  skip = 0;
	  if ((st & AST_DOOR_OPEN)||(st & AST_NOT_READY)) {
	    aztDiskChanged = 1;
	    aztTocUpToDate = 0;
	    printk((st & AST_DOOR_OPEN) ? "aztcd: door open\n" : "aztcd: disk removed\n");
	    if (azt_transfer_is_active) {
	      azt_state = AZT_S_START;
	      loop_ctl = 1;
	      break;
	    }
	    azt_state = AZT_S_IDLE;
	    while (CURRENT_VALID)
	    end_request(0);
	    return;
	  }
 
	  if (CURRENT_VALID) {
	    struct azt_Play_msf msf;
	    int i;
	    azt_next_bn = CURRENT -> sector / 4;
	    azt_hsg2msf(azt_next_bn, &msf.start);
	    i = 0;
	    /* find out in which track we are */
	    while (azt_msf2hsg(&msf.start)>azt_msf2hsg(&Toc[++i].trackTime)) {};
	    if (azt_msf2hsg(&msf.start)<azt_msf2hsg(&Toc[i].trackTime)-AZT_BUF_SIZ)
               { azt_read_count=AZT_BUF_SIZ;  /*fast, because we read ahead*/
               /*azt_read_count=CURRENT->nr_sectors;    slow, no read ahead*/
               }
	    else /* don't read beyond end of track */           
#if AZT_MULTISESSION 
               { azt_read_count=(azt_msf2hsg(&Toc[i].trackTime)/4)*4-azt_msf2hsg(&msf.start);  
                 if (azt_read_count < 0) azt_read_count=0;
		 if (azt_read_count > AZT_BUF_SIZ) azt_read_count=AZT_BUF_SIZ;
                 printk("aztcd: warning - trying to read beyond end of track\n");
/*               printk("%i %i %li %li\n",i,azt_read_count,azt_msf2hsg(&msf.start),azt_msf2hsg(&Toc[i].trackTime));
*/             }
#else
	       { azt_read_count=AZT_BUF_SIZ;
	       }
#endif
	    msf.end.min = 0;
	    msf.end.sec = 0;            
	    msf.end.frame = azt_read_count ;/*Mitsumi here reads 0xffffff sectors*/
#ifdef AZT_TEST3
	    printk("---reading msf-address %x:%x:%x  %x:%x:%x\n",msf.start.min,msf.start.sec,msf.start.frame,msf.end.min,msf.end.sec,msf.end.frame);
	    printk("azt_next_bn:%x  azt_buf_in:%x azt_buf_out:%x  azt_buf_bn:%x\n", \
		    azt_next_bn, azt_buf_in, azt_buf_out, azt_buf_bn[azt_buf_in]);
#endif 
            if (azt_read_mode==AZT_MODE_2)
               { sendAztCmd(ACMD_PLAY_READ_RAW, &msf); /*XA disks in raw mode*/
               }
            else
               { sendAztCmd(ACMD_PLAY_READ, &msf);     /*others in cooked mode*/
               }
	    azt_state = AZT_S_DATA;
	    AztTimeout = READ_TIMEOUT;
	  } else {
	    azt_state = AZT_S_STOP;
	    loop_ctl = 1;
	    break;
	  }
 
	  break;
 
 
	case AZT_S_DATA:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old)  {
	    azt_state_old=azt_state;
	    printk("AZT_S_DATA\n");
	  }
#endif
 
	  st = inb(STATUS_PORT) & AFL_STATUSorDATA; 
 
	  switch (st) {
 
	    case AFL_DATA:
#ifdef AZT_TEST3
	      if (st!=azt_st_old)  {
		azt_st_old=st; 
		printk("---AFL_DATA st:%x\n",st);
	      }
#endif
	      if (!AztTries--) {
		printk("aztcd: Read of Block %d Failed, Maybe Audio Disk ? Giving up\n", azt_next_bn);
		if (azt_transfer_is_active) {
		  AztTries = 0;
		  break;
		}
		if (CURRENT_VALID)
		  end_request(0);
		AztTries = 5;
	      }
	      azt_state = AZT_S_START;
	      AztTimeout = READ_TIMEOUT;
	      loop_ctl = 1;
	      break;
 
	    case AFL_STATUSorDATA:
#ifdef AZT_TEST3
	      if (st!=azt_st_old)  {
		azt_st_old=st;
		printk("---AFL_STATUSorDATA st:%x\n",st);
	      }
#endif
	      break;
 
	    default:
#ifdef AZT_TEST3
	      if (st!=azt_st_old)  {
		azt_st_old=st;
		printk("---default: st:%x\n",st);
	      }
#endif
	      AztTries = 5;
	      if (!CURRENT_VALID && azt_buf_in == azt_buf_out) {
		azt_state = AZT_S_STOP;
		loop_ctl = 1;
		break;
	      }
	      if (azt_read_count<=0)
		printk("aztcd: warning - try to read 0 frames\n");
	      while (azt_read_count)      /*??? fast read ahead loop*/
	       { azt_buf_bn[azt_buf_in] = -1;
		 DTEN_LOW;                      /*??? unsolved problem, very
						      seldom we get timeouts
						      here, don't now the real
						      reason. With my drive this
						      sometimes also happens with
						      Aztech's original driver under
						      DOS. Is it a hardware bug? 
						      I tried to recover from such
						      situations here. Zimmermann*/
		 if (aztTimeOutCount>=AZT_TIMEOUT) 
		  { printk("read_count:%d CURRENT->nr_sectors:%ld azt_buf_in:%d\n", azt_read_count,CURRENT->nr_sectors,azt_buf_in);
		    printk("azt_transfer_is_active:%x\n",azt_transfer_is_active);
		    azt_read_count=0;
		    azt_state = AZT_S_STOP;
		    loop_ctl = 1;
		    end_request(1);  /*should we have here (1) or (0)? */
		  }
		 else
		  { if (azt_read_mode==AZT_MODE_2)
		       { insb(DATA_PORT, azt_buf + CD_FRAMESIZE_RAW * azt_buf_in, CD_FRAMESIZE_RAW);
		       }
		    else
		       { insb(DATA_PORT, azt_buf + CD_FRAMESIZE * azt_buf_in, CD_FRAMESIZE);
                       }
		    azt_read_count--;
#ifdef AZT_TEST3
		    printk("AZT_S_DATA; ---I've read data- read_count: %d\n",azt_read_count);
		    printk("azt_next_bn:%d  azt_buf_in:%d azt_buf_out:%d  azt_buf_bn:%d\n", \
			 azt_next_bn, azt_buf_in, azt_buf_out, azt_buf_bn[azt_buf_in]);
#endif
		    azt_buf_bn[azt_buf_in] = azt_next_bn++;
		    if (azt_buf_out == -1)
		      azt_buf_out = azt_buf_in;
		    azt_buf_in = azt_buf_in + 1 == AZT_BUF_SIZ ? 0 : azt_buf_in + 1;
		  }
	       }
	      if (!azt_transfer_is_active) {
		while (CURRENT_VALID) {
		  azt_transfer();
		  if (CURRENT -> nr_sectors == 0)
		    end_request(1);
		  else
		    break;
		}
	      }
 
	      if (CURRENT_VALID
		&& (CURRENT -> sector / 4 < azt_next_bn ||
		CURRENT -> sector / 4 > azt_next_bn + AZT_BUF_SIZ)) {
		azt_state = AZT_S_STOP;
		loop_ctl = 1;
		break;
	      }
	      AztTimeout = READ_TIMEOUT;   
	      if (azt_read_count==0) {
		azt_state = AZT_S_STOP; 
		loop_ctl = 1;
		break;           
	      } 
	      break;
	    }
    break;
 
 
	case AZT_S_STOP:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old) {
	    azt_state_old=azt_state;
	    printk("AZT_S_STOP\n");
	  }
#endif
	  if (azt_read_count!=0) printk("aztcd: discard data=%x frames\n",azt_read_count);
	  while (azt_read_count!=0) {
	    int i;
	    if ( !(inb(STATUS_PORT) & AFL_DATA) ) {
	      if (azt_read_mode==AZT_MODE_2)
	         for (i=0; i<CD_FRAMESIZE_RAW; i++) inb(DATA_PORT);
	      else   
	         for (i=0; i<CD_FRAMESIZE; i++) inb(DATA_PORT);
	    }
	    azt_read_count--;
	  }  
	  if (aztSendCmd(ACMD_GET_STATUS)) RETURN("azt_poll 5");
	  azt_state = AZT_S_STOPPING;
	  AztTimeout = 1000;
	  break;
 
	case AZT_S_STOPPING:
#ifdef AZT_TEST3
	  if (azt_state!=azt_state_old) {
	    azt_state_old=azt_state;
	    printk("AZT_S_STOPPING\n");
	  }
#endif
 
	  if ((st = aztStatus()) == -1 && AztTimeout)
	    break;
 
	  if ((st != -1) && ((st & AST_DSK_CHG)||(st & AST_NOT_READY))) {
	    aztDiskChanged = 1;
	    aztTocUpToDate = 0;
	    azt_invalidate_buffers();
	    printk("aztcd: Disk Changed or Not Ready 4 - Unmount Disk!\n");
	    end_request(0);
	  }
 
 
#ifdef AZT_TEST3
	  printk("CURRENT_VALID %d azt_mode %d\n",
	     CURRENT_VALID, azt_mode);
#endif
 
	  if (CURRENT_VALID) {
	    if (st != -1) {
	      if (azt_mode == 1) {
		azt_state = AZT_S_READ;
		loop_ctl = 1;
		skip = 1;
		break;
	      } else {
		azt_state = AZT_S_MODE;
		loop_ctl = 1;
		skip = 1;
		break;
	      }
	    } else {
	      azt_state = AZT_S_START;
	      AztTimeout = 1;
	    }
	  } else {
	    azt_state = AZT_S_IDLE;
	    return;
	  }
	  break;
 
	default:
	  printk("aztcd: invalid state %d\n", azt_state);
	  return;
      }  /* case */
    } /* while */
 
 
   if (!AztTimeout--) 
    { printk("aztcd: timeout in state %d\n", azt_state);
      azt_state = AZT_S_STOP;
      if (aztSendCmd(ACMD_STOP)) RETURN("azt_poll 6"); 
      STEN_LOW_WAIT;     
    };
 
  SET_TIMER(azt_poll, HZ/100);
}
 
 
/*###########################################################################
 * Miscellaneous support functions
  ###########################################################################
*/
static void azt_hsg2msf(long hsg, struct msf *msf)
{       hsg += 150;
	msf -> min = hsg / 4500;
	hsg %= 4500;
	msf -> sec = hsg / 75;
	msf -> frame = hsg % 75;
#ifdef AZT_DEBUG
	if (msf->min  >=70) printk("aztcd: Error hsg2msf address Minutes\n");
	if (msf->sec  >=60) printk("aztcd: Error hsg2msf address Seconds\n");
	if (msf->frame>=75) printk("aztcd: Error hsg2msf address Frames\n");
#endif
	azt_bin2bcd(&msf -> min);           /* convert to BCD */
	azt_bin2bcd(&msf -> sec);
	azt_bin2bcd(&msf -> frame);
}
 
static long azt_msf2hsg(struct msf *mp)
{ return azt_bcd2bin(mp -> frame) + azt_bcd2bin(mp -> sec) * 75
		                  + azt_bcd2bin(mp -> min) * 4500 - CD_BLOCK_OFFSET;
}
 
static void azt_bin2bcd(unsigned char *p)
{       int u, t;
 
	u = *p % 10;
	t = *p / 10;
	*p = u | (t << 4);
}
 
static int azt_bcd2bin(unsigned char bcd)
{       return (bcd >> 4) * 10 + (bcd & 0xF);
}
 
 
 

Compare with Previous | Blame | View Log

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.