/* -- sjcd.c * * Sanyo CD-ROM device driver implementation, Version 1.6 * Copyright (C) 1995 Vadim V. Model * * model@cecmow.enet.dec.com * vadim@rbrf.ru * vadim@ipsun.ras.ru * * * This driver is based on pre-works by Eberhard Moenkeberg (emoenke@gwdg.de); * it was developed under use of mcd.c from Martin Harriss, with help of * Eric van der Maarel (H.T.M.v.d.Maarel@marin.nl). * * It is planned to include these routines into sbpcd.c later - to make * a "mixed use" on one cable possible for all kinds of drives which use * the SoundBlaster/Panasonic style CDROM interface. But today, the * ability to install directly from CDROM is more important than flexibility. * * 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 of the License, 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: * 1.1 First public release with kernel version 1.3.7. * Written by Vadim Model. * 1.2 Added detection and configuration of cdrom interface * on ISP16 soundcard. * Allow for command line options: sjcd=,, * 1.3 Some minor changes to README.sjcd. * 1.4 MSS Sound support!! Listen to a CD through the speakers. * 1.5 Module support and bugfixes. * Tray locking. * 1.6 Removed ISP16 code from this driver. * Allow only to set io base address on command line: sjcd= * Changes to Documentation/cdrom/sjcd * Added cleanup after any error in the initialisation. * 1.7 Added code to set the sector size tables to prevent the bug present in * the previous version of this driver. Coded added by Anthony Barbachan * from bugfix tip originally suggested by Alan Cox. * * November 1999 -- Make kernel-parameter implementation work with 2.3.x * Removed init_module & cleanup_module in favor of * module_init & module_exit. * Torben Mathiasen */ #define SJCD_VERSION_MAJOR 1 #define SJCD_VERSION_MINOR 7 #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "sjcd.h" static int sjcd_present = 0; static struct request_queue *sjcd_queue; #define MAJOR_NR SANYO_CDROM_MAJOR #define QUEUE (sjcd_queue) #define CURRENT elv_next_request(sjcd_queue) #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 volatile int sjcd_buf_in, sjcd_buf_out = -1; /* * Status. */ static unsigned short sjcd_status_valid = 0; static unsigned short sjcd_door_closed; static unsigned short sjcd_door_was_open; static unsigned short sjcd_media_is_available; static unsigned short sjcd_media_is_changed; static unsigned short sjcd_toc_uptodate = 0; static unsigned short sjcd_command_failed; static volatile unsigned char sjcd_completion_status = 0; static volatile unsigned char sjcd_completion_error = 0; static unsigned short sjcd_command_is_in_progress = 0; static unsigned short sjcd_error_reported = 0; static DEFINE_SPINLOCK(sjcd_lock); static int sjcd_open_count; static int sjcd_audio_status; static struct sjcd_play_msf sjcd_playing; static int sjcd_base = SJCD_BASE_ADDR; module_param(sjcd_base, int, 0); static DECLARE_WAIT_QUEUE_HEAD(sjcd_waitq); /* * Data transfer. */ 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 }; static enum sjcd_transfer_state sjcd_transfer_state = SJCD_S_IDLE; static long sjcd_transfer_timeout = 0; static int sjcd_read_count = 0; static unsigned char sjcd_mode = 0; #define SJCD_READ_TIMEOUT 5000 #if defined( SJCD_GATHER_STAT ) /* * Statistic. */ static struct sjcd_stat statistic; #endif /* * Timer. */ static DEFINE_TIMER(sjcd_delay_timer, NULL, 0, 0); #define SJCD_SET_TIMER( func, tmout ) \ ( sjcd_delay_timer.expires = jiffies+tmout, \ sjcd_delay_timer.function = ( void * )func, \ add_timer( &sjcd_delay_timer ) ) #define CLEAR_TIMER del_timer( &sjcd_delay_timer ) /* * Set up device, i.e., use command line data to set * base address. */ #ifndef MODULE 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]; return 1; } __setup("sjcd=", sjcd_setup); #endif /* * Special converters. */ static unsigned char bin2bcd(int bin) { int u, v; u = bin % 10; v = bin / 10; return (u | (v << 4)); } 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 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) { #if defined( SJCD_TRACE ) 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; } /* * Send a command with one arg to cdrom. Invalidate status. */ 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); #endif 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) { #if defined( SJCD_TRACE ) 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; } /* * Send a play or read command to cdrom. Invalidate Status. */ 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); #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; } /* * 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; 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; #if defined( SJCD_TRACE ) 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); } } /* * This is just timeout counter, and nothing more. Surprised ? :-) */ static volatile long sjcd_status_timeout; /* * We need about 10 seconds to wait. The longest command takes about 5 seconds * to probe the disk (usually after tray closed or drive reset). Other values * should be thought of for other commands. */ #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); } } /* * 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); #if defined( SJCD_DIAGNOSTIC ) || defined ( SJCD_TRACE ) if (sjcd_status_timeout <= 0) printk("SJCD: Error Wait For Status.\n"); #endif return (sjcd_status_timeout); } static int sjcd_receive_status(void) { int i; #if defined( SJCD_TRACE ) printk("SJCD: receive_status\n"); #endif /* * 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"); #endif 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) { #if defined( SJCD_TRACE ) printk("SJCD: get_status\n"); #endif 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(struct gendisk *disk) { #if 0 printk("SJCD: sjcd_disk_change(%s)\n", disk->disk_name); #endif 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 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); } #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; #if defined( SJCD_TRACE ) 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); } /* * Start playing from the specified position. */ 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()); } /* * Tray control functions. */ static int sjcd_tray_close(void) { #if defined( SJCD_TRACE ) printk("SJCD: tray_close\n"); #endif sjcd_send_cmd(SCMD_CLOSE_TRAY); return (sjcd_receive_status()); } static int sjcd_tray_lock(void) { #if defined( SJCD_TRACE ) printk("SJCD: tray_lock\n"); #endif sjcd_send_cmd(SCMD_LOCK_TRAY); return (sjcd_receive_status()); } static int sjcd_tray_unlock(void) { #if defined( SJCD_TRACE ) printk("SJCD: tray_unlock\n"); #endif sjcd_send_cmd(SCMD_UNLOCK_TRAY); return (sjcd_receive_status()); } static int sjcd_tray_open(void) { #if defined( SJCD_TRACE ) printk("SJCD: tray_open\n"); #endif 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) { void __user *argp = (void __user *)arg; #if defined( SJCD_TRACE ) printk("SJCD:ioctl\n"); #endif 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 = -EFAULT; #if defined( SJCD_TRACE ) printk("SJCD: ioctl: playtrkind\n"); #endif if (!copy_from_user(&ti, argp, sizeof(ti))) { s = 0; 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 = access_ok(VERIFY_READ, argp, sizeof(sjcd_msf)) ? 0 : -EFAULT) == 0) { if (sjcd_audio_status == CDROM_AUDIO_PLAY) { sjcd_send_cmd(SCMD_PAUSE); (void) sjcd_receive_status(); sjcd_audio_status = CDROM_AUDIO_NO_STATUS; } if (copy_from_user(&sjcd_msf, argp, sizeof(sjcd_msf))) return (-EFAULT); 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; #if defined (SJCD_TRACE ) printk("SJCD: ioctl: readtocheader\n"); #endif toc_header.cdth_trk0 = sjcd_first_track_no; toc_header.cdth_trk1 = sjcd_last_track_no; if (copy_to_user(argp, &toc_header, sizeof(toc_header))) return -EFAULT; return 0; } case CDROMREADTOCENTRY:{ struct cdrom_tocentry toc_entry; int s; #if defined( SJCD_TRACE ) printk("SJCD: ioctl: readtocentry\n"); #endif if ((s = access_ok(VERIFY_WRITE, argp, sizeof(toc_entry)) ? 0 : -EFAULT) == 0) { struct sjcd_hw_disk_info *tp; if (copy_from_user(&toc_entry, argp, sizeof(toc_entry))) return (-EFAULT); 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); } if (copy_to_user(argp, &toc_entry, sizeof(toc_entry))) s = -EFAULT; } return (s); } case CDROMSUBCHNL:{ struct cdrom_subchnl subchnl; int s; #if defined( SJCD_TRACE ) printk("SJCD: ioctl: subchnl\n"); #endif if ((s = access_ok(VERIFY_WRITE, argp, sizeof(subchnl)) ? 0 : -EFAULT) == 0) { struct sjcd_hw_qinfo q_info; if (copy_from_user(&subchnl, argp, sizeof(subchnl))) return (-EFAULT); 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); } if (copy_to_user(argp, &subchnl, sizeof(subchnl))) s = -EFAULT; } return (s); } case CDROMVOLCTRL:{ struct cdrom_volctrl vol_ctrl; int s; #if defined( SJCD_TRACE ) printk("SJCD: ioctl: volctrl\n"); #endif if ((s = access_ok(VERIFY_READ, argp, sizeof(vol_ctrl)) ? 0 : -EFAULT) == 0) { unsigned char dummy[4]; if (copy_from_user(&vol_ctrl, argp, sizeof(vol_ctrl))) return (-EFAULT); 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:{ #if defined( SJCD_TRACE ) printk("SJCD: ioctl: statistic\n"); #endif if (copy_to_user(argp, &statistic, sizeof(statistic))) return -EFAULT; return 0; } #endif 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; } /* * Take care of the different block sizes between cdrom and Linux. * When Linux gets variable block sizes this will probably go away. */ static int current_valid(void) { return CURRENT && CURRENT->cmd == READ && CURRENT->sector != -1; } static void sjcd_transfer(void) { #if defined( SJCD_TRACE ) printk("SJCD: transfer:\n"); #endif if (current_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"); #endif } static void sjcd_poll(void) { #if defined( SJCD_GATHER_STAT ) /* * Update total number of ticks. */ statistic.ticks++; statistic.tticks[sjcd_transfer_state]++; #endif ReSwitch:switch (sjcd_transfer_state) { case SJCD_S_IDLE:{ #if defined( SJCD_GATHER_STAT ) statistic.idle_ticks++; #endif #if defined( SJCD_TRACE ) printk("SJCD_S_IDLE\n"); #endif return; } case SJCD_S_START:{ #if defined( SJCD_GATHER_STAT ) 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; #if defined( SJCD_TRACE ) printk ("SJCD_S_MODE: goto SJCD_S_READ mode\n"); #endif } #if defined( SJCD_GATHER_STAT ) else statistic.mode_ticks++; #endif 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"); #endif sjcd_transfer_state = SJCD_S_STOP; goto ReSwitch; } } if (current_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 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); #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_valid()) end_request(CURRENT, 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_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_valid()) { /* * Continue transferring. */ sjcd_transfer(); if (CURRENT-> nr_sectors == 0) end_request (CURRENT, 1); else break; } } if (current_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; } 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_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 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_valid()) end_request(CURRENT, 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_valid()) { sjcd_transfer(); if (CURRENT->nr_sectors == 0) end_request(CURRENT, 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_valid()) end_request(CURRENT, 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. */ static 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); 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) { #if defined( SJCD_DIAGNOSTIC ) printk ("SJCD: open: timed out when check status.\n"); #endif goto err_out; } else if (!sjcd_media_is_available) { #if defined( SJCD_DIAGNOSTIC ) printk("SJCD: open: no disk in drive\n"); #endif if (!sjcd_door_closed) { sjcd_door_was_open = 1; #if defined( SJCD_TRACE ) printk ("SJCD: open: close the tray\n"); #endif 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"); #endif 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"); #endif goto err_out; } #if defined( SJCD_TRACE ) printk("SJCD: open: done\n"); #endif } ++sjcd_open_count; return (0); err_out: 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; #if defined( SJCD_TRACE ) printk("SJCD: release\n"); #endif 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"); #endif } 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"); #endif } } } return 0; } /* * A list of file operations allowed for this cdrom. */ static struct block_device_operations sjcd_fops = { .owner = THIS_MODULE, .open = sjcd_open, .release = sjcd_release, .ioctl = sjcd_ioctl, .media_changed = sjcd_disk_change, }; /* * Following stuff is intended for initialization of the cdrom. It * first looks for presence of device. If the device is present, it * will be reset. Then read the version of the drive and load status. * The version is two BCD-coded bytes. */ static struct { unsigned char major, minor; } sjcd_version; static struct gendisk *sjcd_disk; /* * Test for presence of drive and initialize it. Called at boot time. * Probe cdrom, find out version and status. */ static 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); #if defined( SJCD_TRACE ) printk("SJCD: sjcd=0x%x: ", sjcd_base); #endif if (register_blkdev(MAJOR_NR, "sjcd")) return -EIO; sjcd_queue = blk_init_queue(do_sjcd_request, &sjcd_lock); if (!sjcd_queue) goto out0; blk_queue_hardsect_size(sjcd_queue, 2048); sjcd_disk = alloc_disk(1); if (!sjcd_disk) { printk(KERN_ERR "SJCD: can't allocate disk"); goto out1; } sjcd_disk->major = MAJOR_NR, sjcd_disk->first_minor = 0, sjcd_disk->fops = &sjcd_fops, sprintf(sjcd_disk->disk_name, "sjcd"); if (!request_region(sjcd_base, 4,"sjcd")) { printk ("SJCD: Init failed, I/O port (%X) is already in use\n", sjcd_base); goto out2; } /* * 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"); goto out3; } 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"); goto out3; } 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"); goto out3; } /* * 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"); goto out3; } else printk("\n"); } printk(KERN_INFO "SJCD: Status: port=0x%x.\n", sjcd_base); sjcd_disk->queue = sjcd_queue; add_disk(sjcd_disk); sjcd_present++; return (0); out3: release_region(sjcd_base, 4); out2: put_disk(sjcd_disk); out1: blk_cleanup_queue(sjcd_queue); out0: if ((unregister_blkdev(MAJOR_NR, "sjcd") == -EINVAL)) printk("SJCD: cannot unregister device.\n"); return (-EIO); } static void __exit sjcd_exit(void) { del_gendisk(sjcd_disk); put_disk(sjcd_disk); release_region(sjcd_base, 4); blk_cleanup_queue(sjcd_queue); if ((unregister_blkdev(MAJOR_NR, "sjcd") == -EINVAL)) printk("SJCD: cannot unregister device.\n"); printk(KERN_INFO "SJCD: module: removed.\n"); } module_init(sjcd_init); module_exit(sjcd_exit); MODULE_LICENSE("GPL"); MODULE_ALIAS_BLOCKDEV_MAJOR(SANYO_CDROM_MAJOR);