patch-2.4.10 linux/drivers/cdrom/sjcd.c
Next file: linux/drivers/cdrom/sonycd535.c
Previous file: linux/drivers/cdrom/sbpcd.c
Back to the patch index
Back to the overall index
- Lines: 2836
- Date:
Fri Sep 7 09:28:38 2001
- Orig file:
v2.4.9/linux/drivers/cdrom/sjcd.c
- Orig date:
Thu Oct 26 23:35:48 2000
diff -u --recursive --new-file v2.4.9/linux/drivers/cdrom/sjcd.c linux/drivers/cdrom/sjcd.c
@@ -82,13 +82,13 @@
static int sjcd_present = 0;
-#define SJCD_BUF_SIZ 32 /* cdr-h94a has internal 64K buffer */
+#define SJCD_BUF_SIZ 32 /* cdr-h94a has internal 64K buffer */
/*
* buffer for block size conversion
*/
-static char sjcd_buf[ 2048 * SJCD_BUF_SIZ ];
-static volatile int sjcd_buf_bn[ SJCD_BUF_SIZ ], sjcd_next_bn;
+static char sjcd_buf[2048 * SJCD_BUF_SIZ];
+static volatile int sjcd_buf_bn[SJCD_BUF_SIZ], sjcd_next_bn;
static volatile int sjcd_buf_in, sjcd_buf_out = -1;
/*
@@ -113,9 +113,7 @@
static int sjcd_base = SJCD_BASE_ADDR;
-#ifdef MODULE
MODULE_PARM(sjcd_base, "i");
-#endif
static DECLARE_WAIT_QUEUE_HEAD(sjcd_waitq);
@@ -125,13 +123,13 @@
static volatile unsigned short sjcd_transfer_is_active = 0;
enum sjcd_transfer_state {
- SJCD_S_IDLE = 0,
- SJCD_S_START = 1,
- SJCD_S_MODE = 2,
- SJCD_S_READ = 3,
- SJCD_S_DATA = 4,
- SJCD_S_STOP = 5,
- SJCD_S_STOPPING = 6
+ SJCD_S_IDLE = 0,
+ SJCD_S_START = 1,
+ SJCD_S_MODE = 2,
+ SJCD_S_READ = 3,
+ SJCD_S_DATA = 4,
+ SJCD_S_STOP = 5,
+ SJCD_S_STOPPING = 6
};
static enum sjcd_transfer_state sjcd_transfer_state = SJCD_S_IDLE;
static long sjcd_transfer_timeout = 0;
@@ -166,14 +164,14 @@
* base address.
*/
#ifndef MODULE
-static int __init sjcd_setup( char *str)
+static int __init sjcd_setup(char *str)
{
- int ints[2];
- (void)get_options(str, ARRAY_SIZE(ints), ints);
- if (ints[0] > 0)
- sjcd_base = ints[1];
+ int ints[2];
+ (void) get_options(str, ARRAY_SIZE(ints), ints);
+ if (ints[0] > 0)
+ sjcd_base = ints[1];
- return 1;
+ return 1;
}
__setup("sjcd=", sjcd_setup);
@@ -183,168 +181,191 @@
/*
* Special converters.
*/
-static unsigned char bin2bcd( int bin ){
- int u, v;
+static unsigned char bin2bcd(int bin)
+{
+ int u, v;
- u = bin % 10; v = bin / 10;
- return( u | ( v << 4 ) );
+ u = bin % 10;
+ v = bin / 10;
+ return (u | (v << 4));
}
-static int bcd2bin( unsigned char bcd ){
- return( ( bcd >> 4 ) * 10 + ( bcd & 0x0F ) );
+static int bcd2bin(unsigned char bcd)
+{
+ return ((bcd >> 4) * 10 + (bcd & 0x0F));
}
-static long msf2hsg( struct msf *mp ){
- return( bcd2bin( mp->frame ) + bcd2bin( mp->sec ) * 75
- + bcd2bin( mp->min ) * 4500 - 150 );
+static long msf2hsg(struct msf *mp)
+{
+ return (bcd2bin(mp->frame) + bcd2bin(mp->sec) * 75
+ + bcd2bin(mp->min) * 4500 - 150);
}
-static void hsg2msf( long hsg, struct msf *msf ){
- hsg += 150; msf->min = hsg / 4500;
- hsg %= 4500; msf->sec = hsg / 75; msf->frame = hsg % 75;
- msf->min = bin2bcd( msf->min ); /* convert to BCD */
- msf->sec = bin2bcd( msf->sec );
- msf->frame = bin2bcd( msf->frame );
+static void hsg2msf(long hsg, struct msf *msf)
+{
+ hsg += 150;
+ msf->min = hsg / 4500;
+ hsg %= 4500;
+ msf->sec = hsg / 75;
+ msf->frame = hsg % 75;
+ msf->min = bin2bcd(msf->min); /* convert to BCD */
+ msf->sec = bin2bcd(msf->sec);
+ msf->frame = bin2bcd(msf->frame);
}
/*
* Send a command to cdrom. Invalidate status.
*/
-static void sjcd_send_cmd( unsigned char cmd ){
+static void sjcd_send_cmd(unsigned char cmd)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: send_cmd( 0x%x )\n", cmd );
+ printk("SJCD: send_cmd( 0x%x )\n", cmd);
#endif
- outb( cmd, SJCDPORT( 0 ) );
- sjcd_command_is_in_progress = 1;
- sjcd_status_valid = 0;
- sjcd_command_failed = 0;
+ outb(cmd, SJCDPORT(0));
+ sjcd_command_is_in_progress = 1;
+ sjcd_status_valid = 0;
+ sjcd_command_failed = 0;
}
/*
* Send a command with one arg to cdrom. Invalidate status.
*/
-static void sjcd_send_1_cmd( unsigned char cmd, unsigned char a ){
+static void sjcd_send_1_cmd(unsigned char cmd, unsigned char a)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: send_1_cmd( 0x%x, 0x%x )\n", cmd, a );
+ printk("SJCD: send_1_cmd( 0x%x, 0x%x )\n", cmd, a);
#endif
- outb( cmd, SJCDPORT( 0 ) );
- outb( a, SJCDPORT( 0 ) );
- sjcd_command_is_in_progress = 1;
- sjcd_status_valid = 0;
- sjcd_command_failed = 0;
+ outb(cmd, SJCDPORT(0));
+ outb(a, SJCDPORT(0));
+ sjcd_command_is_in_progress = 1;
+ sjcd_status_valid = 0;
+ sjcd_command_failed = 0;
}
/*
* Send a command with four args to cdrom. Invalidate status.
*/
-static void sjcd_send_4_cmd( unsigned char cmd, unsigned char a,
- unsigned char b, unsigned char c, unsigned char d ){
+static void sjcd_send_4_cmd(unsigned char cmd, unsigned char a,
+ unsigned char b, unsigned char c,
+ unsigned char d)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: send_4_cmd( 0x%x )\n", cmd );
+ printk("SJCD: send_4_cmd( 0x%x )\n", cmd);
#endif
- outb( cmd, SJCDPORT( 0 ) );
- outb( a, SJCDPORT( 0 ) );
- outb( b, SJCDPORT( 0 ) );
- outb( c, SJCDPORT( 0 ) );
- outb( d, SJCDPORT( 0 ) );
- sjcd_command_is_in_progress = 1;
- sjcd_status_valid = 0;
- sjcd_command_failed = 0;
+ outb(cmd, SJCDPORT(0));
+ outb(a, SJCDPORT(0));
+ outb(b, SJCDPORT(0));
+ outb(c, SJCDPORT(0));
+ outb(d, SJCDPORT(0));
+ sjcd_command_is_in_progress = 1;
+ sjcd_status_valid = 0;
+ sjcd_command_failed = 0;
}
/*
* Send a play or read command to cdrom. Invalidate Status.
*/
-static void sjcd_send_6_cmd( unsigned char cmd, struct sjcd_play_msf *pms ){
+static void sjcd_send_6_cmd(unsigned char cmd, struct sjcd_play_msf *pms)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: send_long_cmd( 0x%x )\n", cmd );
+ printk("SJCD: send_long_cmd( 0x%x )\n", cmd);
#endif
- outb( cmd, SJCDPORT( 0 ) );
- outb( pms->start.min, SJCDPORT( 0 ) );
- outb( pms->start.sec, SJCDPORT( 0 ) );
- outb( pms->start.frame, SJCDPORT( 0 ) );
- outb( pms->end.min, SJCDPORT( 0 ) );
- outb( pms->end.sec, SJCDPORT( 0 ) );
- outb( pms->end.frame, SJCDPORT( 0 ) );
- sjcd_command_is_in_progress = 1;
- sjcd_status_valid = 0;
- sjcd_command_failed = 0;
+ outb(cmd, SJCDPORT(0));
+ outb(pms->start.min, SJCDPORT(0));
+ outb(pms->start.sec, SJCDPORT(0));
+ outb(pms->start.frame, SJCDPORT(0));
+ outb(pms->end.min, SJCDPORT(0));
+ outb(pms->end.sec, SJCDPORT(0));
+ outb(pms->end.frame, SJCDPORT(0));
+ sjcd_command_is_in_progress = 1;
+ sjcd_status_valid = 0;
+ sjcd_command_failed = 0;
}
/*
* Get a value from the data port. Should not block, so we use a little
* wait for a while. Returns 0 if OK.
*/
-static int sjcd_load_response( void *buf, int len ){
- unsigned char *resp = ( unsigned char * )buf;
+static int sjcd_load_response(void *buf, int len)
+{
+ unsigned char *resp = (unsigned char *) buf;
- for( ; len; --len ){
- int i;
- for( i = 200; i-- && !SJCD_STATUS_AVAILABLE( inb( SJCDPORT( 1 ) ) ); );
- if( i > 0 ) *resp++ = ( unsigned char )inb( SJCDPORT( 0 ) );
- else break;
- }
- return( len );
+ for (; len; --len) {
+ int i;
+ for (i = 200;
+ i-- && !SJCD_STATUS_AVAILABLE(inb(SJCDPORT(1))););
+ if (i > 0)
+ *resp++ = (unsigned char) inb(SJCDPORT(0));
+ else
+ break;
+ }
+ return (len);
}
/*
* Load and parse command completion status (drive info byte and maybe error).
* Sorry, no error classification yet.
*/
-static void sjcd_load_status( void ){
- sjcd_media_is_changed = 0;
- sjcd_completion_error = 0;
- sjcd_completion_status = inb( SJCDPORT( 0 ) );
- if( sjcd_completion_status & SST_DOOR_OPENED ){
- sjcd_door_closed = sjcd_media_is_available = 0;
- } else {
- sjcd_door_closed = 1;
- if( sjcd_completion_status & SST_MEDIA_CHANGED )
- sjcd_media_is_available = sjcd_media_is_changed = 1;
- else if( sjcd_completion_status & 0x0F ){
- /*
- * OK, we seem to catch an error ...
- */
- while( !SJCD_STATUS_AVAILABLE( inb( SJCDPORT( 1 ) ) ) );
- sjcd_completion_error = inb( SJCDPORT( 0 ) );
- if( ( sjcd_completion_status & 0x08 ) &&
- ( sjcd_completion_error & 0x40 ) )
- sjcd_media_is_available = 0;
- else sjcd_command_failed = 1;
- } else sjcd_media_is_available = 1;
- }
- /*
- * Ok, status loaded successfully.
- */
- sjcd_status_valid = 1, sjcd_error_reported = 0;
- sjcd_command_is_in_progress = 0;
-
- /*
- * If the disk is changed, the TOC is not valid.
- */
- if( sjcd_media_is_changed ) sjcd_toc_uptodate = 0;
+static void sjcd_load_status(void)
+{
+ sjcd_media_is_changed = 0;
+ sjcd_completion_error = 0;
+ sjcd_completion_status = inb(SJCDPORT(0));
+ if (sjcd_completion_status & SST_DOOR_OPENED) {
+ sjcd_door_closed = sjcd_media_is_available = 0;
+ } else {
+ sjcd_door_closed = 1;
+ if (sjcd_completion_status & SST_MEDIA_CHANGED)
+ sjcd_media_is_available = sjcd_media_is_changed =
+ 1;
+ else if (sjcd_completion_status & 0x0F) {
+ /*
+ * OK, we seem to catch an error ...
+ */
+ while (!SJCD_STATUS_AVAILABLE(inb(SJCDPORT(1))));
+ sjcd_completion_error = inb(SJCDPORT(0));
+ if ((sjcd_completion_status & 0x08) &&
+ (sjcd_completion_error & 0x40))
+ sjcd_media_is_available = 0;
+ else
+ sjcd_command_failed = 1;
+ } else
+ sjcd_media_is_available = 1;
+ }
+ /*
+ * Ok, status loaded successfully.
+ */
+ sjcd_status_valid = 1, sjcd_error_reported = 0;
+ sjcd_command_is_in_progress = 0;
+
+ /*
+ * If the disk is changed, the TOC is not valid.
+ */
+ if (sjcd_media_is_changed)
+ sjcd_toc_uptodate = 0;
#if defined( SJCD_TRACE )
- printk( "SJCD: status %02x.%02x loaded.\n",
- ( int )sjcd_completion_status, ( int )sjcd_completion_error );
+ printk("SJCD: status %02x.%02x loaded.\n",
+ (int) sjcd_completion_status, (int) sjcd_completion_error);
#endif
}
/*
* Read status from cdrom. Check to see if the status is available.
*/
-static int sjcd_check_status( void ){
- /*
- * Try to load the response from cdrom into buffer.
- */
- if( SJCD_STATUS_AVAILABLE( inb( SJCDPORT( 1 ) ) ) ){
- sjcd_load_status();
- return( 1 );
- } else {
- /*
- * No status is available.
- */
- return( 0 );
- }
+static int sjcd_check_status(void)
+{
+ /*
+ * Try to load the response from cdrom into buffer.
+ */
+ if (SJCD_STATUS_AVAILABLE(inb(SJCDPORT(1)))) {
+ sjcd_load_status();
+ return (1);
+ } else {
+ /*
+ * No status is available.
+ */
+ return (0);
+ }
}
/*
@@ -359,575 +380,692 @@
*/
#define SJCD_WAIT_FOR_STATUS_TIMEOUT 1000
-static void sjcd_status_timer( void ){
- if( sjcd_check_status() ){
- /*
- * The command completed and status is loaded, stop waiting.
- */
- wake_up( &sjcd_waitq );
- } else if( --sjcd_status_timeout <= 0 ){
- /*
- * We are timed out.
- */
- wake_up( &sjcd_waitq );
- } else {
- /*
- * We have still some time to wait. Try again.
- */
- SJCD_SET_TIMER( sjcd_status_timer, 1 );
- }
+static void sjcd_status_timer(void)
+{
+ if (sjcd_check_status()) {
+ /*
+ * The command completed and status is loaded, stop waiting.
+ */
+ wake_up(&sjcd_waitq);
+ } else if (--sjcd_status_timeout <= 0) {
+ /*
+ * We are timed out.
+ */
+ wake_up(&sjcd_waitq);
+ } else {
+ /*
+ * We have still some time to wait. Try again.
+ */
+ SJCD_SET_TIMER(sjcd_status_timer, 1);
+ }
}
/*
* Wait for status for 10 sec approx. Returns non-positive when timed out.
* Should not be used while reading data CDs.
*/
-static int sjcd_wait_for_status( void ){
- sjcd_status_timeout = SJCD_WAIT_FOR_STATUS_TIMEOUT;
- SJCD_SET_TIMER( sjcd_status_timer, 1 );
- sleep_on( &sjcd_waitq );
+static int sjcd_wait_for_status(void)
+{
+ sjcd_status_timeout = SJCD_WAIT_FOR_STATUS_TIMEOUT;
+ SJCD_SET_TIMER(sjcd_status_timer, 1);
+ sleep_on(&sjcd_waitq);
#if defined( SJCD_DIAGNOSTIC ) || defined ( SJCD_TRACE )
- if( sjcd_status_timeout <= 0 )
- printk( "SJCD: Error Wait For Status.\n" );
+ if (sjcd_status_timeout <= 0)
+ printk("SJCD: Error Wait For Status.\n");
#endif
- return( sjcd_status_timeout );
+ return (sjcd_status_timeout);
}
-static int sjcd_receive_status( void ){
- int i;
+static int sjcd_receive_status(void)
+{
+ int i;
#if defined( SJCD_TRACE )
- printk( "SJCD: receive_status\n" );
+ printk("SJCD: receive_status\n");
#endif
- /*
- * Wait a bit for status available.
- */
- for( i = 200; i-- && ( sjcd_check_status() == 0 ); );
- if( i < 0 ){
+ /*
+ * Wait a bit for status available.
+ */
+ for (i = 200; i-- && (sjcd_check_status() == 0););
+ if (i < 0) {
#if defined( SJCD_TRACE )
- printk( "SJCD: long wait for status\n" );
+ printk("SJCD: long wait for status\n");
#endif
- if( sjcd_wait_for_status() <= 0 )
- printk( "SJCD: Timeout when read status.\n" );
- else i = 0;
- }
- return( i );
+ if (sjcd_wait_for_status() <= 0)
+ printk("SJCD: Timeout when read status.\n");
+ else
+ i = 0;
+ }
+ return (i);
}
/*
* Load the status. Issue get status command and wait for status available.
*/
-static void sjcd_get_status( void ){
+static void sjcd_get_status(void)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: get_status\n" );
+ printk("SJCD: get_status\n");
#endif
- sjcd_send_cmd( SCMD_GET_STATUS );
- sjcd_receive_status();
+ sjcd_send_cmd(SCMD_GET_STATUS);
+ sjcd_receive_status();
}
/*
* Check the drive if the disk is changed. Should be revised.
*/
-static int sjcd_disk_change( kdev_t full_dev ){
+static int sjcd_disk_change(kdev_t full_dev)
+{
#if 0
- printk( "SJCD: sjcd_disk_change( 0x%x )\n", full_dev );
+ printk("SJCD: sjcd_disk_change( 0x%x )\n", full_dev);
#endif
- if( MINOR( full_dev ) > 0 ){
- printk( "SJCD: request error: invalid device minor.\n" );
- return 0;
- }
- if( !sjcd_command_is_in_progress )
- sjcd_get_status();
- return( sjcd_status_valid ? sjcd_media_is_changed : 0 );
+ if (MINOR(full_dev) > 0) {
+ printk("SJCD: request error: invalid device minor.\n");
+ return 0;
+ }
+ if (!sjcd_command_is_in_progress)
+ sjcd_get_status();
+ return (sjcd_status_valid ? sjcd_media_is_changed : 0);
}
/*
* Read the table of contents (TOC) and TOC header if necessary.
* We assume that the drive contains no more than 99 toc entries.
*/
-static struct sjcd_hw_disk_info sjcd_table_of_contents[ SJCD_MAX_TRACKS ];
+static struct sjcd_hw_disk_info sjcd_table_of_contents[SJCD_MAX_TRACKS];
static unsigned char sjcd_first_track_no, sjcd_last_track_no;
#define sjcd_disk_length sjcd_table_of_contents[0].un.track_msf
-static int sjcd_update_toc( void ){
- struct sjcd_hw_disk_info info;
- int i;
-#if defined( SJCD_TRACE )
- printk( "SJCD: update toc:\n" );
-#endif
- /*
- * check to see if we need to do anything
- */
- if( sjcd_toc_uptodate ) return( 0 );
-
- /*
- * Get the TOC start information.
- */
- sjcd_send_1_cmd( SCMD_GET_DISK_INFO, SCMD_GET_1_TRACK );
- sjcd_receive_status();
-
- if( !sjcd_status_valid ){
- printk( "SJCD: cannot load status.\n" );
- return( -1 );
- }
-
- if( !sjcd_media_is_available ){
- printk( "SJCD: no disk in drive\n" );
- return( -1 );
- }
-
- if( !sjcd_command_failed ){
- if( sjcd_load_response( &info, sizeof( info ) ) != 0 ){
- printk( "SJCD: cannot load response about TOC start.\n" );
- return( -1 );
- }
- sjcd_first_track_no = bcd2bin( info.un.track_no );
- } else {
- printk( "SJCD: get first failed\n" );
- return( -1 );
- }
-#if defined( SJCD_TRACE )
- printk( "SJCD: TOC start 0x%02x ", sjcd_first_track_no );
-#endif
- /*
- * Get the TOC finish information.
- */
- sjcd_send_1_cmd( SCMD_GET_DISK_INFO, SCMD_GET_L_TRACK );
- sjcd_receive_status();
-
- if( !sjcd_status_valid ){
- printk( "SJCD: cannot load status.\n" );
- return( -1 );
- }
-
- if( !sjcd_media_is_available ){
- printk( "SJCD: no disk in drive\n" );
- return( -1 );
- }
-
- if( !sjcd_command_failed ){
- if( sjcd_load_response( &info, sizeof( info ) ) != 0 ){
- printk( "SJCD: cannot load response about TOC finish.\n" );
- return( -1 );
- }
- sjcd_last_track_no = bcd2bin( info.un.track_no );
- } else {
- printk( "SJCD: get last failed\n" );
- return( -1 );
- }
-#if defined( SJCD_TRACE )
- printk( "SJCD: TOC finish 0x%02x ", sjcd_last_track_no );
-#endif
- for( i = sjcd_first_track_no; i <= sjcd_last_track_no; i++ ){
- /*
- * Get the first track information.
- */
- sjcd_send_1_cmd( SCMD_GET_DISK_INFO, bin2bcd( i ) );
- sjcd_receive_status();
-
- if( !sjcd_status_valid ){
- printk( "SJCD: cannot load status.\n" );
- return( -1 );
- }
-
- if( !sjcd_media_is_available ){
- printk( "SJCD: no disk in drive\n" );
- return( -1 );
- }
-
- if( !sjcd_command_failed ){
- if( sjcd_load_response( &sjcd_table_of_contents[ i ],
- sizeof( struct sjcd_hw_disk_info ) ) != 0 ){
- printk( "SJCD: cannot load info for %d track\n", i );
- return( -1 );
- }
- } else {
- printk( "SJCD: get info %d failed\n", i );
- return( -1 );
- }
- }
-
- /*
- * Get the disk length info.
- */
- sjcd_send_1_cmd( SCMD_GET_DISK_INFO, SCMD_GET_D_SIZE );
- sjcd_receive_status();
-
- if( !sjcd_status_valid ){
- printk( "SJCD: cannot load status.\n" );
- return( -1 );
- }
-
- if( !sjcd_media_is_available ){
- printk( "SJCD: no disk in drive\n" );
- return( -1 );
- }
-
- if( !sjcd_command_failed ){
- if( sjcd_load_response( &info, sizeof( info ) ) != 0 ){
- printk( "SJCD: cannot load response about disk size.\n" );
- return( -1 );
- }
- sjcd_disk_length.min = info.un.track_msf.min;
- sjcd_disk_length.sec = info.un.track_msf.sec;
- sjcd_disk_length.frame = info.un.track_msf.frame;
- } else {
- printk( "SJCD: get size failed\n" );
- return( 1 );
- }
+static int sjcd_update_toc(void)
+{
+ struct sjcd_hw_disk_info info;
+ int i;
#if defined( SJCD_TRACE )
- printk( "SJCD: (%02x:%02x.%02x)\n", sjcd_disk_length.min,
- sjcd_disk_length.sec, sjcd_disk_length.frame );
+ printk("SJCD: update toc:\n");
#endif
- return( 0 );
+ /*
+ * check to see if we need to do anything
+ */
+ if (sjcd_toc_uptodate)
+ return (0);
+
+ /*
+ * Get the TOC start information.
+ */
+ sjcd_send_1_cmd(SCMD_GET_DISK_INFO, SCMD_GET_1_TRACK);
+ sjcd_receive_status();
+
+ if (!sjcd_status_valid) {
+ printk("SJCD: cannot load status.\n");
+ return (-1);
+ }
+
+ if (!sjcd_media_is_available) {
+ printk("SJCD: no disk in drive\n");
+ return (-1);
+ }
+
+ if (!sjcd_command_failed) {
+ if (sjcd_load_response(&info, sizeof(info)) != 0) {
+ printk
+ ("SJCD: cannot load response about TOC start.\n");
+ return (-1);
+ }
+ sjcd_first_track_no = bcd2bin(info.un.track_no);
+ } else {
+ printk("SJCD: get first failed\n");
+ return (-1);
+ }
+#if defined( SJCD_TRACE )
+ printk("SJCD: TOC start 0x%02x ", sjcd_first_track_no);
+#endif
+ /*
+ * Get the TOC finish information.
+ */
+ sjcd_send_1_cmd(SCMD_GET_DISK_INFO, SCMD_GET_L_TRACK);
+ sjcd_receive_status();
+
+ if (!sjcd_status_valid) {
+ printk("SJCD: cannot load status.\n");
+ return (-1);
+ }
+
+ if (!sjcd_media_is_available) {
+ printk("SJCD: no disk in drive\n");
+ return (-1);
+ }
+
+ if (!sjcd_command_failed) {
+ if (sjcd_load_response(&info, sizeof(info)) != 0) {
+ printk
+ ("SJCD: cannot load response about TOC finish.\n");
+ return (-1);
+ }
+ sjcd_last_track_no = bcd2bin(info.un.track_no);
+ } else {
+ printk("SJCD: get last failed\n");
+ return (-1);
+ }
+#if defined( SJCD_TRACE )
+ printk("SJCD: TOC finish 0x%02x ", sjcd_last_track_no);
+#endif
+ for (i = sjcd_first_track_no; i <= sjcd_last_track_no; i++) {
+ /*
+ * Get the first track information.
+ */
+ sjcd_send_1_cmd(SCMD_GET_DISK_INFO, bin2bcd(i));
+ sjcd_receive_status();
+
+ if (!sjcd_status_valid) {
+ printk("SJCD: cannot load status.\n");
+ return (-1);
+ }
+
+ if (!sjcd_media_is_available) {
+ printk("SJCD: no disk in drive\n");
+ return (-1);
+ }
+
+ if (!sjcd_command_failed) {
+ if (sjcd_load_response(&sjcd_table_of_contents[i],
+ sizeof(struct
+ sjcd_hw_disk_info))
+ != 0) {
+ printk
+ ("SJCD: cannot load info for %d track\n",
+ i);
+ return (-1);
+ }
+ } else {
+ printk("SJCD: get info %d failed\n", i);
+ return (-1);
+ }
+ }
+
+ /*
+ * Get the disk length info.
+ */
+ sjcd_send_1_cmd(SCMD_GET_DISK_INFO, SCMD_GET_D_SIZE);
+ sjcd_receive_status();
+
+ if (!sjcd_status_valid) {
+ printk("SJCD: cannot load status.\n");
+ return (-1);
+ }
+
+ if (!sjcd_media_is_available) {
+ printk("SJCD: no disk in drive\n");
+ return (-1);
+ }
+
+ if (!sjcd_command_failed) {
+ if (sjcd_load_response(&info, sizeof(info)) != 0) {
+ printk
+ ("SJCD: cannot load response about disk size.\n");
+ return (-1);
+ }
+ sjcd_disk_length.min = info.un.track_msf.min;
+ sjcd_disk_length.sec = info.un.track_msf.sec;
+ sjcd_disk_length.frame = info.un.track_msf.frame;
+ } else {
+ printk("SJCD: get size failed\n");
+ return (1);
+ }
+#if defined( SJCD_TRACE )
+ printk("SJCD: (%02x:%02x.%02x)\n", sjcd_disk_length.min,
+ sjcd_disk_length.sec, sjcd_disk_length.frame);
+#endif
+ return (0);
}
/*
* Load subchannel information.
*/
-static int sjcd_get_q_info( struct sjcd_hw_qinfo *qp ){
- int s;
+static int sjcd_get_q_info(struct sjcd_hw_qinfo *qp)
+{
+ int s;
#if defined( SJCD_TRACE )
- printk( "SJCD: load sub q\n" );
+ printk("SJCD: load sub q\n");
#endif
- sjcd_send_cmd( SCMD_GET_QINFO );
- s = sjcd_receive_status();
- if( s < 0 || sjcd_command_failed || !sjcd_status_valid ){
- sjcd_send_cmd( 0xF2 );
- s = sjcd_receive_status();
- if( s < 0 || sjcd_command_failed || !sjcd_status_valid ) return( -1 );
- sjcd_send_cmd( SCMD_GET_QINFO );
- s = sjcd_receive_status();
- if( s < 0 || sjcd_command_failed || !sjcd_status_valid ) return( -1 );
- }
- if( sjcd_media_is_available )
- if( sjcd_load_response( qp, sizeof( *qp ) ) == 0 ) return( 0 );
- return( -1 );
+ sjcd_send_cmd(SCMD_GET_QINFO);
+ s = sjcd_receive_status();
+ if (s < 0 || sjcd_command_failed || !sjcd_status_valid) {
+ sjcd_send_cmd(0xF2);
+ s = sjcd_receive_status();
+ if (s < 0 || sjcd_command_failed || !sjcd_status_valid)
+ return (-1);
+ sjcd_send_cmd(SCMD_GET_QINFO);
+ s = sjcd_receive_status();
+ if (s < 0 || sjcd_command_failed || !sjcd_status_valid)
+ return (-1);
+ }
+ if (sjcd_media_is_available)
+ if (sjcd_load_response(qp, sizeof(*qp)) == 0)
+ return (0);
+ return (-1);
}
/*
* Start playing from the specified position.
*/
-static int sjcd_play( struct sjcd_play_msf *mp ){
- struct sjcd_play_msf msf;
+static int sjcd_play(struct sjcd_play_msf *mp)
+{
+ struct sjcd_play_msf msf;
- /*
- * Turn the device to play mode.
- */
- sjcd_send_1_cmd( SCMD_SET_MODE, SCMD_MODE_PLAY );
- if( sjcd_receive_status() < 0 ) return( -1 );
-
- /*
- * Seek to the starting point.
- */
- msf.start = mp->start;
- msf.end.min = msf.end.sec = msf.end.frame = 0x00;
- sjcd_send_6_cmd( SCMD_SEEK, &msf );
- if( sjcd_receive_status() < 0 ) return( -1 );
-
- /*
- * Start playing.
- */
- sjcd_send_6_cmd( SCMD_PLAY, mp );
- return( sjcd_receive_status() );
+ /*
+ * Turn the device to play mode.
+ */
+ sjcd_send_1_cmd(SCMD_SET_MODE, SCMD_MODE_PLAY);
+ if (sjcd_receive_status() < 0)
+ return (-1);
+
+ /*
+ * Seek to the starting point.
+ */
+ msf.start = mp->start;
+ msf.end.min = msf.end.sec = msf.end.frame = 0x00;
+ sjcd_send_6_cmd(SCMD_SEEK, &msf);
+ if (sjcd_receive_status() < 0)
+ return (-1);
+
+ /*
+ * Start playing.
+ */
+ sjcd_send_6_cmd(SCMD_PLAY, mp);
+ return (sjcd_receive_status());
}
/*
* Tray control functions.
*/
-static int sjcd_tray_close( void ){
+static int sjcd_tray_close(void)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: tray_close\n" );
+ printk("SJCD: tray_close\n");
#endif
- sjcd_send_cmd( SCMD_CLOSE_TRAY );
- return( sjcd_receive_status() );
+ sjcd_send_cmd(SCMD_CLOSE_TRAY);
+ return (sjcd_receive_status());
}
-static int sjcd_tray_lock( void ){
+static int sjcd_tray_lock(void)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: tray_lock\n" );
+ printk("SJCD: tray_lock\n");
#endif
- sjcd_send_cmd( SCMD_LOCK_TRAY );
- return( sjcd_receive_status() );
+ sjcd_send_cmd(SCMD_LOCK_TRAY);
+ return (sjcd_receive_status());
}
-static int sjcd_tray_unlock( void ){
+static int sjcd_tray_unlock(void)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: tray_unlock\n" );
+ printk("SJCD: tray_unlock\n");
#endif
- sjcd_send_cmd( SCMD_UNLOCK_TRAY );
- return( sjcd_receive_status() );
+ sjcd_send_cmd(SCMD_UNLOCK_TRAY);
+ return (sjcd_receive_status());
}
-static int sjcd_tray_open( void ){
+static int sjcd_tray_open(void)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: tray_open\n" );
+ printk("SJCD: tray_open\n");
#endif
- sjcd_send_cmd( SCMD_EJECT_TRAY );
- return( sjcd_receive_status() );
+ sjcd_send_cmd(SCMD_EJECT_TRAY);
+ return (sjcd_receive_status());
}
/*
* Do some user commands.
*/
-static int sjcd_ioctl( struct inode *ip, struct file *fp,
- unsigned int cmd, unsigned long arg ){
-#if defined( SJCD_TRACE )
- printk( "SJCD:ioctl\n" );
-#endif
-
- if( ip == NULL ) return( -EINVAL );
-
- sjcd_get_status();
- if( !sjcd_status_valid ) return( -EIO );
- if( sjcd_update_toc() < 0 ) return( -EIO );
-
- switch( cmd ){
- case CDROMSTART:{
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: start\n" );
-#endif
- return( 0 );
- }
-
- case CDROMSTOP:{
+static int sjcd_ioctl(struct inode *ip, struct file *fp,
+ unsigned int cmd, unsigned long arg)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: stop\n" );
+ printk("SJCD:ioctl\n");
#endif
- sjcd_send_cmd( SCMD_PAUSE );
- ( void )sjcd_receive_status();
- sjcd_audio_status = CDROM_AUDIO_NO_STATUS;
- return( 0 );
- }
- case CDROMPAUSE:{
- struct sjcd_hw_qinfo q_info;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: pause\n" );
-#endif
- if( sjcd_audio_status == CDROM_AUDIO_PLAY ){
- sjcd_send_cmd( SCMD_PAUSE );
- ( void )sjcd_receive_status();
- if( sjcd_get_q_info( &q_info ) < 0 ){
- sjcd_audio_status = CDROM_AUDIO_NO_STATUS;
- } else {
- sjcd_audio_status = CDROM_AUDIO_PAUSED;
- sjcd_playing.start = q_info.abs;
- }
- return( 0 );
- } else return( -EINVAL );
- }
-
- case CDROMRESUME:{
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: resume\n" );
-#endif
- if( sjcd_audio_status == CDROM_AUDIO_PAUSED ){
- /*
- * continue play starting at saved location
- */
- if( sjcd_play( &sjcd_playing ) < 0 ){
- sjcd_audio_status = CDROM_AUDIO_ERROR;
- return( -EIO );
- } else {
- sjcd_audio_status = CDROM_AUDIO_PLAY;
- return( 0 );
- }
- } else return( -EINVAL );
- }
-
- case CDROMPLAYTRKIND:{
- struct cdrom_ti ti; int s;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: playtrkind\n" );
-#endif
- if( ( s = verify_area( VERIFY_READ, (void *)arg, sizeof( ti ) ) ) == 0 ){
- copy_from_user( &ti, (void *)arg, sizeof( ti ) );
-
- if( ti.cdti_trk0 < sjcd_first_track_no ) return( -EINVAL );
- if( ti.cdti_trk1 > sjcd_last_track_no )
- ti.cdti_trk1 = sjcd_last_track_no;
- if( ti.cdti_trk0 > ti.cdti_trk1 ) return( -EINVAL );
-
- sjcd_playing.start = sjcd_table_of_contents[ ti.cdti_trk0 ].un.track_msf;
- sjcd_playing.end = ( ti.cdti_trk1 < sjcd_last_track_no ) ?
- sjcd_table_of_contents[ ti.cdti_trk1 + 1 ].un.track_msf :
- sjcd_table_of_contents[ 0 ].un.track_msf;
-
- if( sjcd_play( &sjcd_playing ) < 0 ){
- sjcd_audio_status = CDROM_AUDIO_ERROR;
- return( -EIO );
- } else sjcd_audio_status = CDROM_AUDIO_PLAY;
- }
- return( s );
- }
-
- case CDROMPLAYMSF:{
- struct cdrom_msf sjcd_msf; int s;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: playmsf\n" );
-#endif
- if( ( s = verify_area( VERIFY_READ, (void *)arg, sizeof( sjcd_msf ) ) ) == 0 ){
- if( sjcd_audio_status == CDROM_AUDIO_PLAY ){
- sjcd_send_cmd( SCMD_PAUSE );
- ( void )sjcd_receive_status();
- sjcd_audio_status = CDROM_AUDIO_NO_STATUS;
- }
-
- copy_from_user( &sjcd_msf, (void *)arg, sizeof( sjcd_msf ) );
-
- sjcd_playing.start.min = bin2bcd( sjcd_msf.cdmsf_min0 );
- sjcd_playing.start.sec = bin2bcd( sjcd_msf.cdmsf_sec0 );
- sjcd_playing.start.frame = bin2bcd( sjcd_msf.cdmsf_frame0 );
- sjcd_playing.end.min = bin2bcd( sjcd_msf.cdmsf_min1 );
- sjcd_playing.end.sec = bin2bcd( sjcd_msf.cdmsf_sec1 );
- sjcd_playing.end.frame = bin2bcd( sjcd_msf.cdmsf_frame1 );
-
- if( sjcd_play( &sjcd_playing ) < 0 ){
- sjcd_audio_status = CDROM_AUDIO_ERROR;
- return( -EIO );
- } else sjcd_audio_status = CDROM_AUDIO_PLAY;
- }
- return( s );
- }
+ if (ip == NULL)
+ return (-EINVAL);
- case CDROMREADTOCHDR:{
- struct cdrom_tochdr toc_header; int s;
+ sjcd_get_status();
+ if (!sjcd_status_valid)
+ return (-EIO);
+ if (sjcd_update_toc() < 0)
+ return (-EIO);
+
+ switch (cmd) {
+ case CDROMSTART:{
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: start\n");
+#endif
+ return (0);
+ }
+
+ case CDROMSTOP:{
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: stop\n");
+#endif
+ sjcd_send_cmd(SCMD_PAUSE);
+ (void) sjcd_receive_status();
+ sjcd_audio_status = CDROM_AUDIO_NO_STATUS;
+ return (0);
+ }
+
+ case CDROMPAUSE:{
+ struct sjcd_hw_qinfo q_info;
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: pause\n");
+#endif
+ if (sjcd_audio_status == CDROM_AUDIO_PLAY) {
+ sjcd_send_cmd(SCMD_PAUSE);
+ (void) sjcd_receive_status();
+ if (sjcd_get_q_info(&q_info) < 0) {
+ sjcd_audio_status =
+ CDROM_AUDIO_NO_STATUS;
+ } else {
+ sjcd_audio_status =
+ CDROM_AUDIO_PAUSED;
+ sjcd_playing.start = q_info.abs;
+ }
+ return (0);
+ } else
+ return (-EINVAL);
+ }
+
+ case CDROMRESUME:{
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: resume\n");
+#endif
+ if (sjcd_audio_status == CDROM_AUDIO_PAUSED) {
+ /*
+ * continue play starting at saved location
+ */
+ if (sjcd_play(&sjcd_playing) < 0) {
+ sjcd_audio_status =
+ CDROM_AUDIO_ERROR;
+ return (-EIO);
+ } else {
+ sjcd_audio_status =
+ CDROM_AUDIO_PLAY;
+ return (0);
+ }
+ } else
+ return (-EINVAL);
+ }
+
+ case CDROMPLAYTRKIND:{
+ struct cdrom_ti ti;
+ int s;
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: playtrkind\n");
+#endif
+ if ((s =
+ verify_area(VERIFY_READ, (void *) arg,
+ sizeof(ti))) == 0) {
+ copy_from_user(&ti, (void *) arg,
+ sizeof(ti));
+
+ if (ti.cdti_trk0 < sjcd_first_track_no)
+ return (-EINVAL);
+ if (ti.cdti_trk1 > sjcd_last_track_no)
+ ti.cdti_trk1 = sjcd_last_track_no;
+ if (ti.cdti_trk0 > ti.cdti_trk1)
+ return (-EINVAL);
+
+ sjcd_playing.start =
+ sjcd_table_of_contents[ti.cdti_trk0].
+ un.track_msf;
+ sjcd_playing.end =
+ (ti.cdti_trk1 <
+ sjcd_last_track_no) ?
+ sjcd_table_of_contents[ti.cdti_trk1 +
+ 1].un.
+ track_msf : sjcd_table_of_contents[0].
+ un.track_msf;
+
+ if (sjcd_play(&sjcd_playing) < 0) {
+ sjcd_audio_status =
+ CDROM_AUDIO_ERROR;
+ return (-EIO);
+ } else
+ sjcd_audio_status =
+ CDROM_AUDIO_PLAY;
+ }
+ return (s);
+ }
+
+ case CDROMPLAYMSF:{
+ struct cdrom_msf sjcd_msf;
+ int s;
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: playmsf\n");
+#endif
+ if ((s =
+ verify_area(VERIFY_READ, (void *) arg,
+ sizeof(sjcd_msf))) == 0) {
+ if (sjcd_audio_status == CDROM_AUDIO_PLAY) {
+ sjcd_send_cmd(SCMD_PAUSE);
+ (void) sjcd_receive_status();
+ sjcd_audio_status =
+ CDROM_AUDIO_NO_STATUS;
+ }
+
+ copy_from_user(&sjcd_msf, (void *) arg,
+ sizeof(sjcd_msf));
+
+ sjcd_playing.start.min =
+ bin2bcd(sjcd_msf.cdmsf_min0);
+ sjcd_playing.start.sec =
+ bin2bcd(sjcd_msf.cdmsf_sec0);
+ sjcd_playing.start.frame =
+ bin2bcd(sjcd_msf.cdmsf_frame0);
+ sjcd_playing.end.min =
+ bin2bcd(sjcd_msf.cdmsf_min1);
+ sjcd_playing.end.sec =
+ bin2bcd(sjcd_msf.cdmsf_sec1);
+ sjcd_playing.end.frame =
+ bin2bcd(sjcd_msf.cdmsf_frame1);
+
+ if (sjcd_play(&sjcd_playing) < 0) {
+ sjcd_audio_status =
+ CDROM_AUDIO_ERROR;
+ return (-EIO);
+ } else
+ sjcd_audio_status =
+ CDROM_AUDIO_PLAY;
+ }
+ return (s);
+ }
+
+ case CDROMREADTOCHDR:{
+ struct cdrom_tochdr toc_header;
+ int s;
#if defined (SJCD_TRACE )
- printk( "SJCD: ioctl: readtocheader\n" );
+ printk("SJCD: ioctl: readtocheader\n");
#endif
- if( ( s = verify_area( VERIFY_WRITE, (void *)arg, sizeof( toc_header ) ) ) == 0 ){
- toc_header.cdth_trk0 = sjcd_first_track_no;
- toc_header.cdth_trk1 = sjcd_last_track_no;
- copy_to_user( (void *)arg, &toc_header, sizeof( toc_header ) );
- }
- return( s );
- }
-
- case CDROMREADTOCENTRY:{
- struct cdrom_tocentry toc_entry; int s;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: readtocentry\n" );
-#endif
- if( ( s = verify_area( VERIFY_WRITE, (void *)arg, sizeof( toc_entry ) ) ) == 0 ){
- struct sjcd_hw_disk_info *tp;
-
- copy_from_user( &toc_entry, (void *)arg, sizeof( toc_entry ) );
-
- if( toc_entry.cdte_track == CDROM_LEADOUT )
- tp = &sjcd_table_of_contents[ 0 ];
- else if( toc_entry.cdte_track < sjcd_first_track_no ) return( -EINVAL );
- else if( toc_entry.cdte_track > sjcd_last_track_no ) return( -EINVAL );
- else tp = &sjcd_table_of_contents[ toc_entry.cdte_track ];
-
- toc_entry.cdte_adr = tp->track_control & 0x0F;
- toc_entry.cdte_ctrl = tp->track_control >> 4;
-
- switch( toc_entry.cdte_format ){
- case CDROM_LBA:
- toc_entry.cdte_addr.lba = msf2hsg( &( tp->un.track_msf ) );
- break;
- case CDROM_MSF:
- toc_entry.cdte_addr.msf.minute = bcd2bin( tp->un.track_msf.min );
- toc_entry.cdte_addr.msf.second = bcd2bin( tp->un.track_msf.sec );
- toc_entry.cdte_addr.msf.frame = bcd2bin( tp->un.track_msf.frame );
- break;
- default: return( -EINVAL );
- }
- copy_to_user( (void *)arg, &toc_entry, sizeof( toc_entry ) );
- }
- return( s );
- }
-
- case CDROMSUBCHNL:{
- struct cdrom_subchnl subchnl; int s;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: subchnl\n" );
-#endif
- if( ( s = verify_area( VERIFY_WRITE, (void *)arg, sizeof( subchnl ) ) ) == 0 ){
- struct sjcd_hw_qinfo q_info;
-
- copy_from_user( &subchnl, (void *)arg, sizeof( subchnl ) );
- if( sjcd_get_q_info( &q_info ) < 0 ) return( -EIO );
-
- subchnl.cdsc_audiostatus = sjcd_audio_status;
- subchnl.cdsc_adr = q_info.track_control & 0x0F;
- subchnl.cdsc_ctrl = q_info.track_control >> 4;
- subchnl.cdsc_trk = bcd2bin( q_info.track_no );
- subchnl.cdsc_ind = bcd2bin( q_info.x );
-
- switch( subchnl.cdsc_format ){
- case CDROM_LBA:
- subchnl.cdsc_absaddr.lba = msf2hsg( &( q_info.abs ) );
- subchnl.cdsc_reladdr.lba = msf2hsg( &( q_info.rel ) );
- break;
- case CDROM_MSF:
- subchnl.cdsc_absaddr.msf.minute = bcd2bin( q_info.abs.min );
- subchnl.cdsc_absaddr.msf.second = bcd2bin( q_info.abs.sec );
- subchnl.cdsc_absaddr.msf.frame = bcd2bin( q_info.abs.frame );
- subchnl.cdsc_reladdr.msf.minute = bcd2bin( q_info.rel.min );
- subchnl.cdsc_reladdr.msf.second = bcd2bin( q_info.rel.sec );
- subchnl.cdsc_reladdr.msf.frame = bcd2bin( q_info.rel.frame );
- break;
- default: return( -EINVAL );
- }
- copy_to_user( (void *)arg, &subchnl, sizeof( subchnl ) );
- }
- return( s );
- }
-
- case CDROMVOLCTRL:{
- struct cdrom_volctrl vol_ctrl; int s;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: volctrl\n" );
-#endif
- if( ( s = verify_area( VERIFY_READ, (void *)arg, sizeof( vol_ctrl ) ) ) == 0 ){
- unsigned char dummy[ 4 ];
-
- copy_from_user( &vol_ctrl, (void *)arg, sizeof( vol_ctrl ) );
- sjcd_send_4_cmd( SCMD_SET_VOLUME, vol_ctrl.channel0, 0xFF,
- vol_ctrl.channel1, 0xFF );
- if( sjcd_receive_status() < 0 ) return( -EIO );
- ( void )sjcd_load_response( dummy, 4 );
- }
- return( s );
- }
-
- case CDROMEJECT:{
-#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: eject\n" );
-#endif
- if( !sjcd_command_is_in_progress ){
- sjcd_tray_unlock();
- sjcd_send_cmd( SCMD_EJECT_TRAY );
- ( void )sjcd_receive_status();
- }
- return( 0 );
- }
+ if ((s =
+ verify_area(VERIFY_WRITE, (void *) arg,
+ sizeof(toc_header))) == 0) {
+ toc_header.cdth_trk0 = sjcd_first_track_no;
+ toc_header.cdth_trk1 = sjcd_last_track_no;
+ copy_to_user((void *) arg, &toc_header,
+ sizeof(toc_header));
+ }
+ return (s);
+ }
+
+ case CDROMREADTOCENTRY:{
+ struct cdrom_tocentry toc_entry;
+ int s;
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: readtocentry\n");
+#endif
+ if ((s =
+ verify_area(VERIFY_WRITE, (void *) arg,
+ sizeof(toc_entry))) == 0) {
+ struct sjcd_hw_disk_info *tp;
+
+ copy_from_user(&toc_entry, (void *) arg,
+ sizeof(toc_entry));
+
+ if (toc_entry.cdte_track == CDROM_LEADOUT)
+ tp = &sjcd_table_of_contents[0];
+ else if (toc_entry.cdte_track <
+ sjcd_first_track_no)
+ return (-EINVAL);
+ else if (toc_entry.cdte_track >
+ sjcd_last_track_no)
+ return (-EINVAL);
+ else
+ tp = &sjcd_table_of_contents
+ [toc_entry.cdte_track];
+
+ toc_entry.cdte_adr =
+ tp->track_control & 0x0F;
+ toc_entry.cdte_ctrl =
+ tp->track_control >> 4;
+
+ switch (toc_entry.cdte_format) {
+ case CDROM_LBA:
+ toc_entry.cdte_addr.lba =
+ msf2hsg(&(tp->un.track_msf));
+ break;
+ case CDROM_MSF:
+ toc_entry.cdte_addr.msf.minute =
+ bcd2bin(tp->un.track_msf.min);
+ toc_entry.cdte_addr.msf.second =
+ bcd2bin(tp->un.track_msf.sec);
+ toc_entry.cdte_addr.msf.frame =
+ bcd2bin(tp->un.track_msf.
+ frame);
+ break;
+ default:
+ return (-EINVAL);
+ }
+ copy_to_user((void *) arg, &toc_entry,
+ sizeof(toc_entry));
+ }
+ return (s);
+ }
+
+ case CDROMSUBCHNL:{
+ struct cdrom_subchnl subchnl;
+ int s;
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: subchnl\n");
+#endif
+ if ((s =
+ verify_area(VERIFY_WRITE, (void *) arg,
+ sizeof(subchnl))) == 0) {
+ struct sjcd_hw_qinfo q_info;
+
+ copy_from_user(&subchnl, (void *) arg,
+ sizeof(subchnl));
+ if (sjcd_get_q_info(&q_info) < 0)
+ return (-EIO);
+
+ subchnl.cdsc_audiostatus =
+ sjcd_audio_status;
+ subchnl.cdsc_adr =
+ q_info.track_control & 0x0F;
+ subchnl.cdsc_ctrl =
+ q_info.track_control >> 4;
+ subchnl.cdsc_trk =
+ bcd2bin(q_info.track_no);
+ subchnl.cdsc_ind = bcd2bin(q_info.x);
+
+ switch (subchnl.cdsc_format) {
+ case CDROM_LBA:
+ subchnl.cdsc_absaddr.lba =
+ msf2hsg(&(q_info.abs));
+ subchnl.cdsc_reladdr.lba =
+ msf2hsg(&(q_info.rel));
+ break;
+ case CDROM_MSF:
+ subchnl.cdsc_absaddr.msf.minute =
+ bcd2bin(q_info.abs.min);
+ subchnl.cdsc_absaddr.msf.second =
+ bcd2bin(q_info.abs.sec);
+ subchnl.cdsc_absaddr.msf.frame =
+ bcd2bin(q_info.abs.frame);
+ subchnl.cdsc_reladdr.msf.minute =
+ bcd2bin(q_info.rel.min);
+ subchnl.cdsc_reladdr.msf.second =
+ bcd2bin(q_info.rel.sec);
+ subchnl.cdsc_reladdr.msf.frame =
+ bcd2bin(q_info.rel.frame);
+ break;
+ default:
+ return (-EINVAL);
+ }
+ copy_to_user((void *) arg, &subchnl,
+ sizeof(subchnl));
+ }
+ return (s);
+ }
+
+ case CDROMVOLCTRL:{
+ struct cdrom_volctrl vol_ctrl;
+ int s;
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: volctrl\n");
+#endif
+ if ((s =
+ verify_area(VERIFY_READ, (void *) arg,
+ sizeof(vol_ctrl))) == 0) {
+ unsigned char dummy[4];
+
+ copy_from_user(&vol_ctrl, (void *) arg,
+ sizeof(vol_ctrl));
+ sjcd_send_4_cmd(SCMD_SET_VOLUME,
+ vol_ctrl.channel0, 0xFF,
+ vol_ctrl.channel1, 0xFF);
+ if (sjcd_receive_status() < 0)
+ return (-EIO);
+ (void) sjcd_load_response(dummy, 4);
+ }
+ return (s);
+ }
+
+ case CDROMEJECT:{
+#if defined( SJCD_TRACE )
+ printk("SJCD: ioctl: eject\n");
+#endif
+ if (!sjcd_command_is_in_progress) {
+ sjcd_tray_unlock();
+ sjcd_send_cmd(SCMD_EJECT_TRAY);
+ (void) sjcd_receive_status();
+ }
+ return (0);
+ }
#if defined( SJCD_GATHER_STAT )
- case 0xABCD:{
- int s;
+ case 0xABCD:{
+ int s;
#if defined( SJCD_TRACE )
- printk( "SJCD: ioctl: statistic\n" );
+ printk("SJCD: ioctl: statistic\n");
#endif
- if( ( s = verify_area( VERIFY_WRITE, (void *)arg, sizeof( statistic ) ) ) == 0 )
- copy_to_user( (void *)arg, &statistic, sizeof( statistic ) );
- return( s );
- }
+ if ((s =
+ verify_area(VERIFY_WRITE, (void *) arg,
+ sizeof(statistic))) == 0)
+ copy_to_user((void *) arg, &statistic,
+ sizeof(statistic));
+ return (s);
+ }
#endif
- default:
- return( -EINVAL );
- }
+ default:
+ return (-EINVAL);
+ }
}
/*
* Invalidate internal buffers of the driver.
*/
-static void sjcd_invalidate_buffers( void ){
- int i;
- for( i = 0; i < SJCD_BUF_SIZ; sjcd_buf_bn[ i++ ] = -1 );
- sjcd_buf_out = -1;
+static void sjcd_invalidate_buffers(void)
+{
+ int i;
+ for (i = 0; i < SJCD_BUF_SIZ; sjcd_buf_bn[i++] = -1);
+ sjcd_buf_out = -1;
}
/*
@@ -939,508 +1077,595 @@
( !QUEUE_EMPTY && MAJOR( CURRENT->rq_dev ) == MAJOR_NR && \
CURRENT->cmd == READ && CURRENT->sector != -1 )
-static void sjcd_transfer( void ){
+static void sjcd_transfer(void)
+{
#if defined( SJCD_TRACE )
- printk( "SJCD: transfer:\n" );
+ printk("SJCD: transfer:\n");
#endif
- if( CURRENT_IS_VALID ){
- while( CURRENT->nr_sectors ){
- int i, bn = CURRENT->sector / 4;
- for( i = 0; i < SJCD_BUF_SIZ && sjcd_buf_bn[ i ] != bn; i++ );
- if( i < SJCD_BUF_SIZ ){
- int offs = ( i * 4 + ( CURRENT->sector & 3 ) ) * 512;
- int nr_sectors = 4 - ( CURRENT->sector & 3 );
- if( sjcd_buf_out != i ){
- sjcd_buf_out = i;
- if( sjcd_buf_bn[ i ] != bn ){
- sjcd_buf_out = -1;
- continue;
- }
- }
- if( nr_sectors > CURRENT->nr_sectors )
- nr_sectors = CURRENT->nr_sectors;
-#if defined( SJCD_TRACE )
- printk( "SJCD: copy out\n" );
-#endif
- memcpy( CURRENT->buffer, sjcd_buf + offs, nr_sectors * 512 );
- CURRENT->nr_sectors -= nr_sectors;
- CURRENT->sector += nr_sectors;
- CURRENT->buffer += nr_sectors * 512;
- } else {
- sjcd_buf_out = -1;
- break;
- }
- }
- }
+ if (CURRENT_IS_VALID) {
+ while (CURRENT->nr_sectors) {
+ int i, bn = CURRENT->sector / 4;
+ for (i = 0;
+ i < SJCD_BUF_SIZ && sjcd_buf_bn[i] != bn;
+ i++);
+ if (i < SJCD_BUF_SIZ) {
+ int offs =
+ (i * 4 + (CURRENT->sector & 3)) * 512;
+ int nr_sectors = 4 - (CURRENT->sector & 3);
+ if (sjcd_buf_out != i) {
+ sjcd_buf_out = i;
+ if (sjcd_buf_bn[i] != bn) {
+ sjcd_buf_out = -1;
+ continue;
+ }
+ }
+ if (nr_sectors > CURRENT->nr_sectors)
+ nr_sectors = CURRENT->nr_sectors;
+#if defined( SJCD_TRACE )
+ printk("SJCD: copy out\n");
+#endif
+ memcpy(CURRENT->buffer, sjcd_buf + offs,
+ nr_sectors * 512);
+ CURRENT->nr_sectors -= nr_sectors;
+ CURRENT->sector += nr_sectors;
+ CURRENT->buffer += nr_sectors * 512;
+ } else {
+ sjcd_buf_out = -1;
+ break;
+ }
+ }
+ }
#if defined( SJCD_TRACE )
- printk( "SJCD: transfer: done\n" );
+ printk("SJCD: transfer: done\n");
#endif
}
-static void sjcd_poll( void ){
+static void sjcd_poll(void)
+{
#if defined( SJCD_GATHER_STAT )
- /*
- * Update total number of ticks.
- */
- statistic.ticks++;
- statistic.tticks[ sjcd_transfer_state ]++;
+ /*
+ * Update total number of ticks.
+ */
+ statistic.ticks++;
+ statistic.tticks[sjcd_transfer_state]++;
#endif
- ReSwitch: switch( sjcd_transfer_state ){
-
- case SJCD_S_IDLE:{
+ ReSwitch:switch (sjcd_transfer_state) {
+
+ case SJCD_S_IDLE:{
#if defined( SJCD_GATHER_STAT )
- statistic.idle_ticks++;
+ statistic.idle_ticks++;
#endif
#if defined( SJCD_TRACE )
- printk( "SJCD_S_IDLE\n" );
+ printk("SJCD_S_IDLE\n");
#endif
- return;
- }
+ return;
+ }
- case SJCD_S_START:{
+ case SJCD_S_START:{
#if defined( SJCD_GATHER_STAT )
- statistic.start_ticks++;
+ statistic.start_ticks++;
#endif
- sjcd_send_cmd( SCMD_GET_STATUS );
- sjcd_transfer_state =
- sjcd_mode == SCMD_MODE_COOKED ? SJCD_S_READ : SJCD_S_MODE;
- sjcd_transfer_timeout = 500;
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_START: goto SJCD_S_%s mode\n",
- sjcd_transfer_state == SJCD_S_READ ? "READ" : "MODE" );
-#endif
- break;
- }
-
- case SJCD_S_MODE:{
- if( sjcd_check_status() ){
- /*
- * Previous command is completed.
- */
- if( !sjcd_status_valid || sjcd_command_failed ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_MODE: pre-cmd failed: goto to SJCD_S_STOP mode\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
-
- sjcd_mode = 0; /* unknown mode; should not be valid when failed */
- sjcd_send_1_cmd( SCMD_SET_MODE, SCMD_MODE_COOKED );
- sjcd_transfer_state = SJCD_S_READ; sjcd_transfer_timeout = 1000;
+ sjcd_send_cmd(SCMD_GET_STATUS);
+ sjcd_transfer_state =
+ sjcd_mode ==
+ SCMD_MODE_COOKED ? SJCD_S_READ : SJCD_S_MODE;
+ sjcd_transfer_timeout = 500;
+#if defined( SJCD_TRACE )
+ printk("SJCD_S_START: goto SJCD_S_%s mode\n",
+ sjcd_transfer_state ==
+ SJCD_S_READ ? "READ" : "MODE");
+#endif
+ break;
+ }
+
+ case SJCD_S_MODE:{
+ if (sjcd_check_status()) {
+ /*
+ * Previous command is completed.
+ */
+ if (!sjcd_status_valid
+ || sjcd_command_failed) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_MODE: pre-cmd failed: goto to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+
+ sjcd_mode = 0; /* unknown mode; should not be valid when failed */
+ sjcd_send_1_cmd(SCMD_SET_MODE,
+ SCMD_MODE_COOKED);
+ sjcd_transfer_state = SJCD_S_READ;
+ sjcd_transfer_timeout = 1000;
#if defined( SJCD_TRACE )
- printk( "SJCD_S_MODE: goto SJCD_S_READ mode\n" );
+ printk
+ ("SJCD_S_MODE: goto SJCD_S_READ mode\n");
#endif
- }
+ }
#if defined( SJCD_GATHER_STAT )
- else statistic.mode_ticks++;
+ else
+ statistic.mode_ticks++;
#endif
- break;
- }
+ break;
+ }
- case SJCD_S_READ:{
- if( sjcd_status_valid ? 1 : sjcd_check_status() ){
- /*
- * Previous command is completed.
- */
- if( !sjcd_status_valid || sjcd_command_failed ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_READ: pre-cmd failed: goto to SJCD_S_STOP mode\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
- if( !sjcd_media_is_available ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_READ: no disk: goto to SJCD_S_STOP mode\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
- if( sjcd_mode != SCMD_MODE_COOKED ){
- /*
- * We seem to come from set mode. So discard one byte of result.
- */
- if( sjcd_load_response( &sjcd_mode, 1 ) != 0 ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_READ: load failed: goto to SJCD_S_STOP mode\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
- if( sjcd_mode != SCMD_MODE_COOKED ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_READ: mode failed: goto to SJCD_S_STOP mode\n" );
+ case SJCD_S_READ:{
+ if (sjcd_status_valid ? 1 : sjcd_check_status()) {
+ /*
+ * Previous command is completed.
+ */
+ if (!sjcd_status_valid
+ || sjcd_command_failed) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_READ: pre-cmd failed: goto to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+ if (!sjcd_media_is_available) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_READ: no disk: goto to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+ if (sjcd_mode != SCMD_MODE_COOKED) {
+ /*
+ * We seem to come from set mode. So discard one byte of result.
+ */
+ if (sjcd_load_response
+ (&sjcd_mode, 1) != 0) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_READ: load failed: goto to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state =
+ SJCD_S_STOP;
+ goto ReSwitch;
+ }
+ if (sjcd_mode != SCMD_MODE_COOKED) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_READ: mode failed: goto to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state =
+ SJCD_S_STOP;
+ goto ReSwitch;
+ }
+ }
+
+ if (CURRENT_IS_VALID) {
+ struct sjcd_play_msf msf;
+
+ sjcd_next_bn = CURRENT->sector / 4;
+ hsg2msf(sjcd_next_bn, &msf.start);
+ msf.end.min = 0;
+ msf.end.sec = 0;
+ msf.end.frame = sjcd_read_count =
+ SJCD_BUF_SIZ;
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD: ---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
+ ("sjcd_next_bn:%x buf_in:%x buf_out:%x buf_bn:%x\n",
+ sjcd_next_bn, sjcd_buf_in,
+ sjcd_buf_out,
+ sjcd_buf_bn[sjcd_buf_in]);
+#endif
+ sjcd_send_6_cmd(SCMD_DATA_READ,
+ &msf);
+ sjcd_transfer_state = SJCD_S_DATA;
+ sjcd_transfer_timeout = 500;
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_READ: go to SJCD_S_DATA mode\n");
+#endif
+ } else {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_READ: nothing to read: go to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+ }
+#if defined( SJCD_GATHER_STAT )
+ else
+ statistic.read_ticks++;
#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
- }
+ break;
+ }
- if( CURRENT_IS_VALID ){
- struct sjcd_play_msf msf;
+ case SJCD_S_DATA:{
+ unsigned char stat;
- sjcd_next_bn = CURRENT->sector / 4;
- hsg2msf( sjcd_next_bn, &msf.start );
- msf.end.min = 0; msf.end.sec = 0;
- msf.end.frame = sjcd_read_count = SJCD_BUF_SIZ;
-#if defined( SJCD_TRACE )
- printk( "SJCD: ---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( "sjcd_next_bn:%x buf_in:%x buf_out:%x buf_bn:%x\n", \
- sjcd_next_bn, sjcd_buf_in, sjcd_buf_out,
- sjcd_buf_bn[ sjcd_buf_in ] );
-#endif
- sjcd_send_6_cmd( SCMD_DATA_READ, &msf );
- sjcd_transfer_state = SJCD_S_DATA;
- sjcd_transfer_timeout = 500;
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_READ: go to SJCD_S_DATA mode\n" );
-#endif
- } else {
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_READ: nothing to read: go to SJCD_S_STOP mode\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
- }
+ sjcd_s_data:stat =
+ inb(SJCDPORT
+ (1));
+#if defined( SJCD_TRACE )
+ printk("SJCD_S_DATA: status = 0x%02x\n", stat);
+#endif
+ if (SJCD_STATUS_AVAILABLE(stat)) {
+ /*
+ * No data is waiting for us in the drive buffer. Status of operation
+ * completion is available. Read and parse it.
+ */
+ sjcd_load_status();
+
+ if (!sjcd_status_valid
+ || sjcd_command_failed) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD: read block %d failed, maybe audio disk? Giving up\n",
+ sjcd_next_bn);
+#endif
+ if (CURRENT_IS_VALID)
+ end_request(0);
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_DATA: pre-cmd failed: go to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+
+ if (!sjcd_media_is_available) {
+ printk
+ ("SJCD_S_DATA: no disk: go to SJCD_S_STOP mode\n");
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+
+ sjcd_transfer_state = SJCD_S_READ;
+ goto ReSwitch;
+ } else if (SJCD_DATA_AVAILABLE(stat)) {
+ /*
+ * One frame is read into device buffer. We must copy it to our memory.
+ * Otherwise cdrom hangs up. Check to see if we have something to copy
+ * to.
+ */
+ if (!CURRENT_IS_VALID
+ && sjcd_buf_in == sjcd_buf_out) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_DATA: nothing to read: go to SJCD_S_STOP mode\n");
+ printk
+ (" ... all the date would be discarded\n");
+#endif
+ sjcd_transfer_state = SJCD_S_STOP;
+ goto ReSwitch;
+ }
+
+ /*
+ * Everything seems to be OK. Just read the frame and recalculate
+ * indices.
+ */
+ sjcd_buf_bn[sjcd_buf_in] = -1; /* ??? */
+ insb(SJCDPORT(2),
+ sjcd_buf + 2048 * sjcd_buf_in, 2048);
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_DATA: next_bn=%d, buf_in=%d, buf_out=%d, buf_bn=%d\n",
+ sjcd_next_bn, sjcd_buf_in,
+ sjcd_buf_out,
+ sjcd_buf_bn[sjcd_buf_in]);
+#endif
+ sjcd_buf_bn[sjcd_buf_in] = sjcd_next_bn++;
+ if (sjcd_buf_out == -1)
+ sjcd_buf_out = sjcd_buf_in;
+ if (++sjcd_buf_in == SJCD_BUF_SIZ)
+ sjcd_buf_in = 0;
+
+ /*
+ * Only one frame is ready at time. So we should turn over to wait for
+ * another frame. If we need that, of course.
+ */
+ if (--sjcd_read_count == 0) {
+ /*
+ * OK, request seems to be precessed. Continue transferring...
+ */
+ if (!sjcd_transfer_is_active) {
+ while (CURRENT_IS_VALID) {
+ /*
+ * Continue transferring.
+ */
+ sjcd_transfer();
+ if (CURRENT->
+ nr_sectors ==
+ 0)
+ end_request
+ (1);
+ else
+ break;
+ }
+ }
+ if (CURRENT_IS_VALID &&
+ (CURRENT->sector / 4 <
+ sjcd_next_bn
+ || CURRENT->sector / 4 >
+ sjcd_next_bn +
+ SJCD_BUF_SIZ)) {
+#if defined( SJCD_TRACE )
+ printk
+ ("SJCD_S_DATA: can't read: go to SJCD_S_STOP mode\n");
+#endif
+ sjcd_transfer_state =
+ SJCD_S_STOP;
+ goto ReSwitch;
+ }
+ }
+ /*
+ * Now we should turn around rather than wait for while.
+ */
+ goto sjcd_s_data;
+ }
#if defined( SJCD_GATHER_STAT )
- else statistic.read_ticks++;
+ else
+ statistic.data_ticks++;
#endif
- break;
- }
+ break;
+ }
- case SJCD_S_DATA:{
- unsigned char stat;
-
- sjcd_s_data: stat = inb( SJCDPORT( 1 ) );
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_DATA: status = 0x%02x\n", stat );
+ case SJCD_S_STOP:{
+ sjcd_read_count = 0;
+ sjcd_send_cmd(SCMD_STOP);
+ sjcd_transfer_state = SJCD_S_STOPPING;
+ sjcd_transfer_timeout = 500;
+#if defined( SJCD_GATHER_STAT )
+ statistic.stop_ticks++;
#endif
- if( SJCD_STATUS_AVAILABLE( stat ) ){
- /*
- * No data is waiting for us in the drive buffer. Status of operation
- * completion is available. Read and parse it.
- */
- sjcd_load_status();
+ break;
+ }
- if( !sjcd_status_valid || sjcd_command_failed ){
-#if defined( SJCD_TRACE )
- printk( "SJCD: read block %d failed, maybe audio disk? Giving up\n",
- sjcd_next_bn );
-#endif
- if( CURRENT_IS_VALID ) end_request( 0 );
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_DATA: pre-cmd failed: go to SJCD_S_STOP mode\n" );
+ case SJCD_S_STOPPING:{
+ unsigned char stat;
+
+ stat = inb(SJCDPORT(1));
+#if defined( SJCD_TRACE )
+ printk("SJCD_S_STOP: status = 0x%02x\n", stat);
+#endif
+ if (SJCD_DATA_AVAILABLE(stat)) {
+ int i;
+#if defined( SJCD_TRACE )
+ printk("SJCD_S_STOP: discard data\n");
+#endif
+ /*
+ * Discard all the data from the pipe. Foolish method.
+ */
+ for (i = 2048; i--;
+ (void) inb(SJCDPORT(2)));
+ sjcd_transfer_timeout = 500;
+ } else if (SJCD_STATUS_AVAILABLE(stat)) {
+ sjcd_load_status();
+ if (sjcd_status_valid
+ && sjcd_media_is_changed) {
+ sjcd_toc_uptodate = 0;
+ sjcd_invalidate_buffers();
+ }
+ if (CURRENT_IS_VALID) {
+ if (sjcd_status_valid)
+ sjcd_transfer_state =
+ SJCD_S_READ;
+ else
+ sjcd_transfer_state =
+ SJCD_S_START;
+ } else
+ sjcd_transfer_state = SJCD_S_IDLE;
+ goto ReSwitch;
+ }
+#if defined( SJCD_GATHER_STAT )
+ else
+ statistic.stopping_ticks++;
#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
+ break;
+ }
- if( !sjcd_media_is_available ){
- printk( "SJCD_S_DATA: no disk: go to SJCD_S_STOP mode\n" );
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
+ default:
+ printk("SJCD: poll: invalid state %d\n",
+ sjcd_transfer_state);
+ return;
+ }
- sjcd_transfer_state = SJCD_S_READ;
- goto ReSwitch;
- } else if( SJCD_DATA_AVAILABLE( stat ) ){
- /*
- * One frame is read into device buffer. We must copy it to our memory.
- * Otherwise cdrom hangs up. Check to see if we have something to copy
- * to.
- */
- if( !CURRENT_IS_VALID && sjcd_buf_in == sjcd_buf_out ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_DATA: nothing to read: go to SJCD_S_STOP mode\n" );
- printk( " ... all the date would be discarded\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
+ if (--sjcd_transfer_timeout == 0) {
+ printk("SJCD: timeout in state %d\n", sjcd_transfer_state);
+ while (CURRENT_IS_VALID)
+ end_request(0);
+ sjcd_send_cmd(SCMD_STOP);
+ sjcd_transfer_state = SJCD_S_IDLE;
+ goto ReSwitch;
+ }
- /*
- * Everything seems to be OK. Just read the frame and recalculate
- * indices.
- */
- sjcd_buf_bn[ sjcd_buf_in ] = -1; /* ??? */
- insb( SJCDPORT( 2 ), sjcd_buf + 2048 * sjcd_buf_in, 2048 );
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_DATA: next_bn=%d, buf_in=%d, buf_out=%d, buf_bn=%d\n",
- sjcd_next_bn, sjcd_buf_in, sjcd_buf_out,
- sjcd_buf_bn[ sjcd_buf_in ] );
-#endif
- sjcd_buf_bn[ sjcd_buf_in ] = sjcd_next_bn++;
- if( sjcd_buf_out == -1 ) sjcd_buf_out = sjcd_buf_in;
- if( ++sjcd_buf_in == SJCD_BUF_SIZ ) sjcd_buf_in = 0;
-
- /*
- * Only one frame is ready at time. So we should turn over to wait for
- * another frame. If we need that, of course.
- */
- if( --sjcd_read_count == 0 ){
/*
- * OK, request seems to be precessed. Continue transferring...
+ * Get back in some time. 1 should be replaced with count variable to
+ * avoid unnecessary testings.
*/
- if( !sjcd_transfer_is_active ){
- while( CURRENT_IS_VALID ){
- /*
- * Continue transferring.
- */
- sjcd_transfer();
- if( CURRENT->nr_sectors == 0 ) end_request( 1 );
- else break;
- }
- }
- if( CURRENT_IS_VALID &&
- ( CURRENT->sector / 4 < sjcd_next_bn ||
- CURRENT->sector / 4 > sjcd_next_bn + SJCD_BUF_SIZ ) ){
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_DATA: can't read: go to SJCD_S_STOP mode\n" );
-#endif
- sjcd_transfer_state = SJCD_S_STOP;
- goto ReSwitch;
- }
- }
- /*
- * Now we should turn around rather than wait for while.
- */
- goto sjcd_s_data;
- }
-#if defined( SJCD_GATHER_STAT )
- else statistic.data_ticks++;
-#endif
- break;
- }
-
- case SJCD_S_STOP:{
- sjcd_read_count = 0;
- sjcd_send_cmd( SCMD_STOP );
- sjcd_transfer_state = SJCD_S_STOPPING;
- sjcd_transfer_timeout = 500;
-#if defined( SJCD_GATHER_STAT )
- statistic.stop_ticks++;
-#endif
- break;
- }
+ SJCD_SET_TIMER(sjcd_poll, 1);
+}
- case SJCD_S_STOPPING:{
- unsigned char stat;
-
- stat = inb( SJCDPORT( 1 ) );
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_STOP: status = 0x%02x\n", stat );
-#endif
- if( SJCD_DATA_AVAILABLE( stat ) ){
- int i;
-#if defined( SJCD_TRACE )
- printk( "SJCD_S_STOP: discard data\n" );
-#endif
- /*
- * Discard all the data from the pipe. Foolish method.
- */
- for( i = 2048; i--; ( void )inb( SJCDPORT( 2 ) ) );
- sjcd_transfer_timeout = 500;
- } else if( SJCD_STATUS_AVAILABLE( stat ) ){
- sjcd_load_status();
- if( sjcd_status_valid && sjcd_media_is_changed ) {
- sjcd_toc_uptodate = 0;
- sjcd_invalidate_buffers();
- }
- if( CURRENT_IS_VALID ){
- if( sjcd_status_valid ) sjcd_transfer_state = SJCD_S_READ;
- else sjcd_transfer_state = SJCD_S_START;
- } else sjcd_transfer_state = SJCD_S_IDLE;
- goto ReSwitch;
- }
-#if defined( SJCD_GATHER_STAT )
- else statistic.stopping_ticks++;
+static void do_sjcd_request(request_queue_t * q)
+{
+#if defined( SJCD_TRACE )
+ printk("SJCD: do_sjcd_request(%ld+%ld)\n",
+ CURRENT->sector, CURRENT->nr_sectors);
#endif
- break;
- }
-
- default:
- printk( "SJCD: poll: invalid state %d\n", sjcd_transfer_state );
- return;
- }
-
- if( --sjcd_transfer_timeout == 0 ){
- printk( "SJCD: timeout in state %d\n", sjcd_transfer_state );
- while( CURRENT_IS_VALID ) end_request( 0 );
- sjcd_send_cmd( SCMD_STOP );
- sjcd_transfer_state = SJCD_S_IDLE;
- goto ReSwitch;
- }
-
- /*
- * Get back in some time. 1 should be replaced with count variable to
- * avoid unnecessary testings.
- */
- SJCD_SET_TIMER( sjcd_poll, 1 );
-}
-
-static void do_sjcd_request( request_queue_t * q ){
-#if defined( SJCD_TRACE )
- printk( "SJCD: do_sjcd_request(%ld+%ld)\n",
- CURRENT->sector, CURRENT->nr_sectors );
-#endif
- sjcd_transfer_is_active = 1;
- while( CURRENT_IS_VALID ){
- /*
- * Who of us are paranoiac?
- */
- if( CURRENT->bh && !buffer_locked(CURRENT->bh) )
- panic( DEVICE_NAME ": block not locked" );
-
- sjcd_transfer();
- if( CURRENT->nr_sectors == 0 ) end_request( 1 );
- else {
- sjcd_buf_out = -1; /* Want to read a block not in buffer */
- if( sjcd_transfer_state == SJCD_S_IDLE ){
- if( !sjcd_toc_uptodate ){
- if( sjcd_update_toc() < 0 ){
- printk( "SJCD: transfer: discard\n" );
- while( CURRENT_IS_VALID ) end_request( 0 );
- break;
- }
- }
- sjcd_transfer_state = SJCD_S_START;
- SJCD_SET_TIMER( sjcd_poll, HZ/100 );
- }
- break;
- }
- }
- sjcd_transfer_is_active = 0;
-#if defined( SJCD_TRACE )
- printk( "sjcd_next_bn:%x sjcd_buf_in:%x sjcd_buf_out:%x sjcd_buf_bn:%x\n",
- sjcd_next_bn, sjcd_buf_in, sjcd_buf_out, sjcd_buf_bn[ sjcd_buf_in ] );
- printk( "do_sjcd_request ends\n" );
+ sjcd_transfer_is_active = 1;
+ while (CURRENT_IS_VALID) {
+ /*
+ * Who of us are paranoiac?
+ */
+ if (CURRENT->bh && !buffer_locked(CURRENT->bh))
+ panic(DEVICE_NAME ": block not locked");
+
+ sjcd_transfer();
+ if (CURRENT->nr_sectors == 0)
+ end_request(1);
+ else {
+ sjcd_buf_out = -1; /* Want to read a block not in buffer */
+ if (sjcd_transfer_state == SJCD_S_IDLE) {
+ if (!sjcd_toc_uptodate) {
+ if (sjcd_update_toc() < 0) {
+ printk
+ ("SJCD: transfer: discard\n");
+ while (CURRENT_IS_VALID)
+ end_request(0);
+ break;
+ }
+ }
+ sjcd_transfer_state = SJCD_S_START;
+ SJCD_SET_TIMER(sjcd_poll, HZ / 100);
+ }
+ break;
+ }
+ }
+ sjcd_transfer_is_active = 0;
+#if defined( SJCD_TRACE )
+ printk
+ ("sjcd_next_bn:%x sjcd_buf_in:%x sjcd_buf_out:%x sjcd_buf_bn:%x\n",
+ sjcd_next_bn, sjcd_buf_in, sjcd_buf_out,
+ sjcd_buf_bn[sjcd_buf_in]);
+ printk("do_sjcd_request ends\n");
#endif
}
/*
* Open the device special file. Check disk is in.
*/
-int sjcd_open( struct inode *ip, struct file *fp ){
- /*
- * Check the presence of device.
- */
- if( !sjcd_present ) return( -ENXIO );
-
- /*
- * Only read operations are allowed. Really? (:-)
- */
- if( fp->f_mode & 2 ) return( -EROFS );
-
- MOD_INC_USE_COUNT;
+int sjcd_open(struct inode *ip, struct file *fp)
+{
+ /*
+ * Check the presence of device.
+ */
+ if (!sjcd_present)
+ return (-ENXIO);
- if( sjcd_open_count == 0 ){
- int s, sjcd_open_tries;
+ /*
+ * Only read operations are allowed. Really? (:-)
+ */
+ if (fp->f_mode & 2)
+ return (-EROFS);
+
+ MOD_INC_USE_COUNT;
+
+ if (sjcd_open_count == 0) {
+ int s, sjcd_open_tries;
/* We don't know that, do we? */
/*
sjcd_audio_status = CDROM_AUDIO_NO_STATUS;
*/
- sjcd_mode = 0;
- sjcd_door_was_open = 0;
- sjcd_transfer_state = SJCD_S_IDLE;
- sjcd_invalidate_buffers();
- sjcd_status_valid = 0;
-
- /*
- * Strict status checking.
- */
- for( sjcd_open_tries = 4; --sjcd_open_tries; ){
- if( !sjcd_status_valid ) sjcd_get_status();
- if( !sjcd_status_valid ){
+ sjcd_mode = 0;
+ sjcd_door_was_open = 0;
+ sjcd_transfer_state = SJCD_S_IDLE;
+ sjcd_invalidate_buffers();
+ sjcd_status_valid = 0;
+
+ /*
+ * Strict status checking.
+ */
+ for (sjcd_open_tries = 4; --sjcd_open_tries;) {
+ if (!sjcd_status_valid)
+ sjcd_get_status();
+ if (!sjcd_status_valid) {
#if defined( SJCD_DIAGNOSTIC )
- printk( "SJCD: open: timed out when check status.\n" );
+ printk
+ ("SJCD: open: timed out when check status.\n");
#endif
- goto err_out;
- } else if( !sjcd_media_is_available ){
+ goto err_out;
+ } else if (!sjcd_media_is_available) {
#if defined( SJCD_DIAGNOSTIC )
- printk("SJCD: open: no disk in drive\n");
+ printk("SJCD: open: no disk in drive\n");
#endif
- if( !sjcd_door_closed ){
- sjcd_door_was_open = 1;
+ if (!sjcd_door_closed) {
+ sjcd_door_was_open = 1;
#if defined( SJCD_TRACE )
- printk("SJCD: open: close the tray\n");
+ printk
+ ("SJCD: open: close the tray\n");
#endif
- s = sjcd_tray_close();
- if( s < 0 || !sjcd_status_valid || sjcd_command_failed ){
+ s = sjcd_tray_close();
+ if (s < 0 || !sjcd_status_valid
+ || sjcd_command_failed) {
#if defined( SJCD_DIAGNOSTIC )
- printk("SJCD: open: tray close attempt failed\n");
+ printk
+ ("SJCD: open: tray close attempt failed\n");
#endif
- goto err_out;
- }
- continue;
- } else goto err_out;
- }
- break;
- }
- s = sjcd_tray_lock();
- if( s < 0 || !sjcd_status_valid || sjcd_command_failed ){
+ goto err_out;
+ }
+ continue;
+ } else
+ goto err_out;
+ }
+ break;
+ }
+ s = sjcd_tray_lock();
+ if (s < 0 || !sjcd_status_valid || sjcd_command_failed) {
#if defined( SJCD_DIAGNOSTIC )
- printk("SJCD: open: tray lock attempt failed\n");
+ printk("SJCD: open: tray lock attempt failed\n");
#endif
- goto err_out;
- }
+ goto err_out;
+ }
#if defined( SJCD_TRACE )
- printk( "SJCD: open: done\n" );
+ printk("SJCD: open: done\n");
#endif
- }
+ }
- ++sjcd_open_count;
- return( 0 );
+ ++sjcd_open_count;
+ return (0);
-err_out:
- MOD_DEC_USE_COUNT;
- return( -EIO );
+ err_out:
+ MOD_DEC_USE_COUNT;
+ return (-EIO);
}
/*
* On close, we flush all sjcd blocks from the buffer cache.
*/
-static int sjcd_release( struct inode *inode, struct file *file ){
- int s;
+static int sjcd_release(struct inode *inode, struct file *file)
+{
+ int s;
#if defined( SJCD_TRACE )
- printk( "SJCD: release\n" );
+ printk("SJCD: release\n");
#endif
#ifdef MODULE
- MOD_DEC_USE_COUNT;
+ MOD_DEC_USE_COUNT;
#endif
- if( --sjcd_open_count == 0 ){
- sjcd_invalidate_buffers();
- s = sjcd_tray_unlock();
- if( s < 0 || !sjcd_status_valid || sjcd_command_failed ){
+ if (--sjcd_open_count == 0) {
+ sjcd_invalidate_buffers();
+ s = sjcd_tray_unlock();
+ if (s < 0 || !sjcd_status_valid || sjcd_command_failed) {
#if defined( SJCD_DIAGNOSTIC )
- printk("SJCD: release: tray unlock attempt failed.\n");
+ printk
+ ("SJCD: release: tray unlock attempt failed.\n");
#endif
- }
- if( sjcd_door_was_open ){
- s = sjcd_tray_open();
- if( s < 0 || !sjcd_status_valid || sjcd_command_failed ){
+ }
+ if (sjcd_door_was_open) {
+ s = sjcd_tray_open();
+ if (s < 0 || !sjcd_status_valid
+ || sjcd_command_failed) {
#if defined( SJCD_DIAGNOSTIC )
- printk("SJCD: release: tray unload attempt failed.\n");
+ printk
+ ("SJCD: release: tray unload attempt failed.\n");
#endif
- }
- }
- }
- return 0;
+ }
+ }
+ }
+ return 0;
}
/*
* A list of file operations allowed for this cdrom.
*/
static struct block_device_operations sjcd_fops = {
- open: sjcd_open,
- release: sjcd_release,
- ioctl: sjcd_ioctl,
- check_media_change: sjcd_disk_change,
+ open:sjcd_open,
+ release:sjcd_release,
+ ioctl:sjcd_ioctl,
+ check_media_change:sjcd_disk_change,
};
static int blksize = 2048;
@@ -1453,146 +1678,156 @@
* The version is two BCD-coded bytes.
*/
static struct {
- unsigned char major, minor;
+ unsigned char major, minor;
} sjcd_version;
/*
* Test for presence of drive and initialize it. Called at boot time.
* Probe cdrom, find out version and status.
*/
-int __init sjcd_init( void ){
- int i;
+int __init sjcd_init(void)
+{
+ int i;
- printk(KERN_INFO "SJCD: Sanyo CDR-H94A cdrom driver version %d.%d.\n", SJCD_VERSION_MAJOR,
- SJCD_VERSION_MINOR);
+ printk(KERN_INFO
+ "SJCD: Sanyo CDR-H94A cdrom driver version %d.%d.\n",
+ SJCD_VERSION_MAJOR, SJCD_VERSION_MINOR);
#if defined( SJCD_TRACE )
- printk("SJCD: sjcd=0x%x: ", sjcd_base);
-#endif
+ printk("SJCD: sjcd=0x%x: ", sjcd_base);
+#endif
hardsect_size[MAJOR_NR] = &secsize;
blksize_size[MAJOR_NR] = &blksize;
- if( devfs_register_blkdev( MAJOR_NR, "sjcd", &sjcd_fops ) != 0 ){
- printk( "SJCD: Unable to get major %d for Sanyo CD-ROM\n", MAJOR_NR );
- return( -EIO );
- }
-
- blk_init_queue(BLK_DEFAULT_QUEUE(MAJOR_NR), DEVICE_REQUEST);
- read_ahead[ MAJOR_NR ] = 4;
- register_disk(NULL, MKDEV(MAJOR_NR,0), 1, &sjcd_fops, 0);
-
- if( check_region( sjcd_base, 4 ) ){
- printk( "SJCD: Init failed, I/O port (%X) is already in use\n",
- sjcd_base );
- sjcd_cleanup();
- return( -EIO );
- }
-
- /*
- * Check for card. Since we are booting now, we can't use standard
- * wait algorithm.
- */
- printk(KERN_INFO "SJCD: Resetting: " );
- sjcd_send_cmd( SCMD_RESET );
- for( i = 1000; i > 0 && !sjcd_status_valid; --i ){
- unsigned long timer;
-
- /*
- * Wait 10ms approx.
- */
- for( timer = jiffies; time_before_eq(jiffies, timer); );
- if ( (i % 100) == 0 ) printk( "." );
- ( void )sjcd_check_status();
- }
- if( i == 0 || sjcd_command_failed ){
- printk( " reset failed, no drive found.\n" );
- sjcd_cleanup();
- return( -EIO );
- } else printk( "\n" );
-
- /*
- * Get and print out cdrom version.
- */
- printk(KERN_INFO "SJCD: Getting version: " );
- sjcd_send_cmd( SCMD_GET_VERSION );
- for( i = 1000; i > 0 && !sjcd_status_valid; --i ){
- unsigned long timer;
-
- /*
- * Wait 10ms approx.
- */
- for( timer = jiffies; time_before_eq(jiffies, timer); );
- if ( (i % 100) == 0 ) printk( "." );
- ( void )sjcd_check_status();
- }
- if( i == 0 || sjcd_command_failed ){
- printk( " get version failed, no drive found.\n" );
- sjcd_cleanup();
- return( -EIO );
- }
-
- if( sjcd_load_response( &sjcd_version, sizeof( sjcd_version ) ) == 0 ){
- printk( " %1x.%02x\n", ( int )sjcd_version.major,
- ( int )sjcd_version.minor );
- } else {
- printk( " read version failed, no drive found.\n" );
- sjcd_cleanup();
- return( -EIO );
- }
-
- /*
- * Check and print out the tray state. (if it is needed?).
- */
- if( !sjcd_status_valid ){
- printk(KERN_INFO "SJCD: Getting status: " );
- sjcd_send_cmd( SCMD_GET_STATUS );
- for( i = 1000; i > 0 && !sjcd_status_valid; --i ){
- unsigned long timer;
-
- /*
- * Wait 10ms approx.
- */
- for( timer = jiffies; time_before_eq(jiffies, timer); );
- if ( (i % 100) == 0 ) printk( "." );
- ( void )sjcd_check_status();
- }
- if( i == 0 || sjcd_command_failed ){
- printk( " get status failed, no drive found.\n" );
- sjcd_cleanup();
- return( -EIO );
- } else printk( "\n" );
- }
-
- printk(KERN_INFO "SJCD: Status: port=0x%x.\n", sjcd_base);
- devfs_register (NULL, "sjcd", DEVFS_FL_DEFAULT, MAJOR_NR, 0,
- S_IFBLK | S_IRUGO | S_IWUGO, &sjcd_fops, NULL);
-
- sjcd_present++;
- return( 0 );
-}
-
-static int
-sjcd_cleanup(void)
-{
- if( (devfs_unregister_blkdev(MAJOR_NR, "sjcd") == -EINVAL) )
- printk( "SJCD: cannot unregister device.\n" );
- else {
- release_region( sjcd_base, 4 );
- blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR));
- }
+ if (devfs_register_blkdev(MAJOR_NR, "sjcd", &sjcd_fops) != 0) {
+ printk("SJCD: Unable to get major %d for Sanyo CD-ROM\n",
+ MAJOR_NR);
+ return (-EIO);
+ }
+
+ blk_init_queue(BLK_DEFAULT_QUEUE(MAJOR_NR), DEVICE_REQUEST);
+ read_ahead[MAJOR_NR] = 4;
+ register_disk(NULL, MKDEV(MAJOR_NR, 0), 1, &sjcd_fops, 0);
+
+ if (check_region(sjcd_base, 4)) {
+ printk
+ ("SJCD: Init failed, I/O port (%X) is already in use\n",
+ sjcd_base);
+ sjcd_cleanup();
+ return (-EIO);
+ }
+
+ /*
+ * Check for card. Since we are booting now, we can't use standard
+ * wait algorithm.
+ */
+ printk(KERN_INFO "SJCD: Resetting: ");
+ sjcd_send_cmd(SCMD_RESET);
+ for (i = 1000; i > 0 && !sjcd_status_valid; --i) {
+ unsigned long timer;
+
+ /*
+ * Wait 10ms approx.
+ */
+ for (timer = jiffies; time_before_eq(jiffies, timer););
+ if ((i % 100) == 0)
+ printk(".");
+ (void) sjcd_check_status();
+ }
+ if (i == 0 || sjcd_command_failed) {
+ printk(" reset failed, no drive found.\n");
+ sjcd_cleanup();
+ return (-EIO);
+ } else
+ printk("\n");
+
+ /*
+ * Get and print out cdrom version.
+ */
+ printk(KERN_INFO "SJCD: Getting version: ");
+ sjcd_send_cmd(SCMD_GET_VERSION);
+ for (i = 1000; i > 0 && !sjcd_status_valid; --i) {
+ unsigned long timer;
+
+ /*
+ * Wait 10ms approx.
+ */
+ for (timer = jiffies; time_before_eq(jiffies, timer););
+ if ((i % 100) == 0)
+ printk(".");
+ (void) sjcd_check_status();
+ }
+ if (i == 0 || sjcd_command_failed) {
+ printk(" get version failed, no drive found.\n");
+ sjcd_cleanup();
+ return (-EIO);
+ }
+
+ if (sjcd_load_response(&sjcd_version, sizeof(sjcd_version)) == 0) {
+ printk(" %1x.%02x\n", (int) sjcd_version.major,
+ (int) sjcd_version.minor);
+ } else {
+ printk(" read version failed, no drive found.\n");
+ sjcd_cleanup();
+ return (-EIO);
+ }
+
+ /*
+ * Check and print out the tray state. (if it is needed?).
+ */
+ if (!sjcd_status_valid) {
+ printk(KERN_INFO "SJCD: Getting status: ");
+ sjcd_send_cmd(SCMD_GET_STATUS);
+ for (i = 1000; i > 0 && !sjcd_status_valid; --i) {
+ unsigned long timer;
+
+ /*
+ * Wait 10ms approx.
+ */
+ for (timer = jiffies;
+ time_before_eq(jiffies, timer););
+ if ((i % 100) == 0)
+ printk(".");
+ (void) sjcd_check_status();
+ }
+ if (i == 0 || sjcd_command_failed) {
+ printk(" get status failed, no drive found.\n");
+ sjcd_cleanup();
+ return (-EIO);
+ } else
+ printk("\n");
+ }
+
+ printk(KERN_INFO "SJCD: Status: port=0x%x.\n", sjcd_base);
+ devfs_register(NULL, "sjcd", DEVFS_FL_DEFAULT, MAJOR_NR, 0,
+ S_IFBLK | S_IRUGO | S_IWUGO, &sjcd_fops, NULL);
+
+ sjcd_present++;
+ return (0);
+}
+
+static int sjcd_cleanup(void)
+{
+ if ((devfs_unregister_blkdev(MAJOR_NR, "sjcd") == -EINVAL))
+ printk("SJCD: cannot unregister device.\n");
+ else {
+ release_region(sjcd_base, 4);
+ blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR));
+ }
- return(0);
+ return (0);
}
void __exit sjcd_exit(void)
{
- devfs_unregister(devfs_find_handle(NULL, "sjcd", 0, 0, DEVFS_SPECIAL_BLK,0));
- if ( sjcd_cleanup() )
- printk( "SJCD: module: cannot be removed.\n" );
- else
- printk(KERN_INFO "SJCD: module: removed.\n");
+ devfs_unregister(devfs_find_handle
+ (NULL, "sjcd", 0, 0, DEVFS_SPECIAL_BLK, 0));
+ if (sjcd_cleanup())
+ printk("SJCD: module: cannot be removed.\n");
+ else
+ printk(KERN_INFO "SJCD: module: removed.\n");
}
#ifdef MODULE
@@ -1601,3 +1836,4 @@
module_exit(sjcd_exit);
+MODULE_LICENSE("GPL");
FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen (who was at: slshen@lbl.gov)