12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031 |
- #define GSCD_VERSION "0.4a Oliver Raupach <raupach@nwfs1.rz.fh-hannover.de>"
- /*
- linux/drivers/block/gscd.c - GoldStar R420 CDROM driver
- Copyright (C) 1995 Oliver Raupach <raupach@nwfs1.rz.fh-hannover.de>
- based upon pre-works by Eberhard Moenkeberg <emoenke@gwdg.de>
-
- For all kind of other information about the GoldStar CDROM
- and this Linux device driver I installed a WWW-URL:
- http://linux.rz.fh-hannover.de/~raupach
- If you are the editor of a Linux CD, you should
- enable gscd.c within your boot floppy kernel and
- send me one of your CDs for free.
- --------------------------------------------------------------------
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; either version 2, or (at your option)
- any later version.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
-
- --------------------------------------------------------------------
-
- 9 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 <tmm@image.dk>
- */
- /* These settings are for various debug-level. Leave they untouched ... */
- #define NO_GSCD_DEBUG
- #define NO_IOCTL_DEBUG
- #define NO_MODULE_DEBUG
- #define NO_FUTURE_WORK
- /*------------------------*/
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/errno.h>
- #include <linux/signal.h>
- #include <linux/sched.h>
- #include <linux/timer.h>
- #include <linux/fs.h>
- #include <linux/mm.h>
- #include <linux/kernel.h>
- #include <linux/cdrom.h>
- #include <linux/ioport.h>
- #include <linux/major.h>
- #include <linux/string.h>
- #include <linux/init.h>
- #include <asm/system.h>
- #include <asm/io.h>
- #include <asm/uaccess.h>
- #define MAJOR_NR GOLDSTAR_CDROM_MAJOR
- #include <linux/blkdev.h>
- #include "gscd.h"
- static int gscdPresent = 0;
- static unsigned char gscd_buf[2048]; /* buffer for block size conversion */
- static int gscd_bn = -1;
- static short gscd_port = GSCD_BASE_ADDR;
- module_param_named(gscd, gscd_port, short, 0);
- /* Kommt spaeter vielleicht noch mal dran ...
- * static DECLARE_WAIT_QUEUE_HEAD(gscd_waitq);
- */
- static void gscd_read_cmd(struct request *req);
- static void gscd_hsg2msf(long hsg, struct msf *msf);
- static void gscd_bin2bcd(unsigned char *p);
- /* Schnittstellen zum Kern/FS */
- static void __do_gscd_request(unsigned long dummy);
- static int gscd_ioctl(struct inode *, struct file *, unsigned int,
- unsigned long);
- static int gscd_open(struct inode *, struct file *);
- static int gscd_release(struct inode *, struct file *);
- static int check_gscd_med_chg(struct gendisk *disk);
- /* GoldStar Funktionen */
- static void cmd_out(int, char *, char *, int);
- static void cmd_status(void);
- static void init_cd_drive(int);
- static int get_status(void);
- static void clear_Audio(void);
- static void cc_invalidate(void);
- /* some things for the next version */
- #ifdef FUTURE_WORK
- static void update_state(void);
- static long gscd_msf2hsg(struct msf *mp);
- static int gscd_bcd2bin(unsigned char bcd);
- #endif
- /* lo-level cmd-Funktionen */
- static void cmd_info_in(char *, int);
- static void cmd_end(void);
- static void cmd_read_b(char *, int, int);
- static void cmd_read_w(char *, int, int);
- static int cmd_unit_alive(void);
- static void cmd_write_cmd(char *);
- /* GoldStar Variablen */
- static int curr_drv_state;
- static int drv_states[] = { 0, 0, 0, 0, 0, 0, 0, 0 };
- static int drv_mode;
- static int disk_state;
- static int speed;
- static int ndrives;
- static unsigned char drv_num_read;
- static unsigned char f_dsk_valid;
- static unsigned char current_drive;
- static unsigned char f_drv_ok;
- static char f_AudioPlay;
- static char f_AudioPause;
- static int AudioStart_m;
- static int AudioStart_f;
- static int AudioEnd_m;
- static int AudioEnd_f;
- static DEFINE_TIMER(gscd_timer, NULL, 0, 0);
- static DEFINE_SPINLOCK(gscd_lock);
- static struct request_queue *gscd_queue;
- static struct block_device_operations gscd_fops = {
- .owner = THIS_MODULE,
- .open = gscd_open,
- .release = gscd_release,
- .ioctl = gscd_ioctl,
- .media_changed = check_gscd_med_chg,
- };
- /*
- * Checking if the media has been changed
- * (not yet implemented)
- */
- static int check_gscd_med_chg(struct gendisk *disk)
- {
- #ifdef GSCD_DEBUG
- printk("gscd: check_med_change\n");
- #endif
- return 0;
- }
- #ifndef MODULE
- /* Using new interface for kernel-parameters */
- static int __init gscd_setup(char *str)
- {
- int ints[2];
- (void) get_options(str, ARRAY_SIZE(ints), ints);
- if (ints[0] > 0) {
- gscd_port = ints[1];
- }
- return 1;
- }
- __setup("gscd=", gscd_setup);
- #endif
- static int gscd_ioctl(struct inode *ip, struct file *fp, unsigned int cmd,
- unsigned long arg)
- {
- unsigned char to_do[10];
- unsigned char dummy;
- switch (cmd) {
- case CDROMSTART: /* Spin up the drive */
- /* Don't think we can do this. Even if we could,
- * I think the drive times out and stops after a while
- * anyway. For now, ignore it.
- */
- return 0;
- case CDROMRESUME: /* keine Ahnung was das ist */
- return 0;
- case CDROMEJECT:
- cmd_status();
- to_do[0] = CMD_TRAY_CTL;
- cmd_out(TYPE_INFO, (char *) &to_do, (char *) &dummy, 0);
- return 0;
- default:
- return -EINVAL;
- }
- }
- /*
- * Take care of the different block sizes between cdrom and Linux.
- * When Linux gets variable block sizes this will probably go away.
- */
- static void gscd_transfer(struct request *req)
- {
- while (req->nr_sectors > 0 && gscd_bn == req->sector / 4) {
- long offs = (req->sector & 3) * 512;
- memcpy(req->buffer, gscd_buf + offs, 512);
- req->nr_sectors--;
- req->sector++;
- req->buffer += 512;
- }
- }
- /*
- * I/O request routine called from Linux kernel.
- */
- static void do_gscd_request(request_queue_t * q)
- {
- __do_gscd_request(0);
- }
- static void __do_gscd_request(unsigned long dummy)
- {
- struct request *req;
- unsigned int block;
- unsigned int nsect;
- repeat:
- req = elv_next_request(gscd_queue);
- if (!req)
- return;
- block = req->sector;
- nsect = req->nr_sectors;
- if (req->sector == -1)
- goto out;
- if (req->cmd != READ) {
- printk("GSCD: bad cmd %lu\n", rq_data_dir(req));
- end_request(req, 0);
- goto repeat;
- }
- gscd_transfer(req);
- /* if we satisfied the request from the buffer, we're done. */
- if (req->nr_sectors == 0) {
- end_request(req, 1);
- goto repeat;
- }
- #ifdef GSCD_DEBUG
- printk("GSCD: block %d, nsect %d\n", block, nsect);
- #endif
- gscd_read_cmd(req);
- out:
- return;
- }
- /*
- * Check the result of the set-mode command. On success, send the
- * read-data command.
- */
- static void gscd_read_cmd(struct request *req)
- {
- long block;
- struct gscd_Play_msf gscdcmd;
- char cmd[] = { CMD_READ, 0x80, 0, 0, 0, 0, 1 }; /* cmd mode M-S-F secth sectl */
- cmd_status();
- if (disk_state & (ST_NO_DISK | ST_DOOR_OPEN)) {
- printk("GSCD: no disk or door open\n");
- end_request(req, 0);
- } else {
- if (disk_state & ST_INVALID) {
- printk("GSCD: disk invalid\n");
- end_request(req, 0);
- } else {
- gscd_bn = -1; /* purge our buffer */
- block = req->sector / 4;
- gscd_hsg2msf(block, &gscdcmd.start); /* cvt to msf format */
- cmd[2] = gscdcmd.start.min;
- cmd[3] = gscdcmd.start.sec;
- cmd[4] = gscdcmd.start.frame;
- #ifdef GSCD_DEBUG
- printk("GSCD: read msf %d:%d:%d\n", cmd[2], cmd[3],
- cmd[4]);
- #endif
- cmd_out(TYPE_DATA, (char *) &cmd,
- (char *) &gscd_buf[0], 1);
- gscd_bn = req->sector / 4;
- gscd_transfer(req);
- end_request(req, 1);
- }
- }
- SET_TIMER(__do_gscd_request, 1);
- }
- /*
- * Open the device special file. Check that a disk is in.
- */
- static int gscd_open(struct inode *ip, struct file *fp)
- {
- int st;
- #ifdef GSCD_DEBUG
- printk("GSCD: open\n");
- #endif
- if (gscdPresent == 0)
- return -ENXIO; /* no hardware */
- get_status();
- st = disk_state & (ST_NO_DISK | ST_DOOR_OPEN);
- if (st) {
- printk("GSCD: no disk or door open\n");
- return -ENXIO;
- }
- /* if (updateToc() < 0)
- return -EIO;
- */
- return 0;
- }
- /*
- * On close, we flush all gscd blocks from the buffer cache.
- */
- static int gscd_release(struct inode *inode, struct file *file)
- {
- #ifdef GSCD_DEBUG
- printk("GSCD: release\n");
- #endif
- gscd_bn = -1;
- return 0;
- }
- static int get_status(void)
- {
- int status;
- cmd_status();
- status = disk_state & (ST_x08 | ST_x04 | ST_INVALID | ST_x01);
- if (status == (ST_x08 | ST_x04 | ST_INVALID | ST_x01)) {
- cc_invalidate();
- return 1;
- } else {
- return 0;
- }
- }
- static void cc_invalidate(void)
- {
- drv_num_read = 0xFF;
- f_dsk_valid = 0xFF;
- current_drive = 0xFF;
- f_drv_ok = 0xFF;
- clear_Audio();
- }
- static void clear_Audio(void)
- {
- f_AudioPlay = 0;
- f_AudioPause = 0;
- AudioStart_m = 0;
- AudioStart_f = 0;
- AudioEnd_m = 0;
- AudioEnd_f = 0;
- }
- /*
- * waiting ?
- */
- static int wait_drv_ready(void)
- {
- int found, read;
- do {
- found = inb(GSCDPORT(0));
- found &= 0x0f;
- read = inb(GSCDPORT(0));
- read &= 0x0f;
- } while (read != found);
- #ifdef GSCD_DEBUG
- printk("Wait for: %d\n", read);
- #endif
- return read;
- }
- static void cc_Ident(char *respons)
- {
- char to_do[] = { CMD_IDENT, 0, 0 };
- cmd_out(TYPE_INFO, (char *) &to_do, (char *) respons, (int) 0x1E);
- }
- static void cc_SetSpeed(void)
- {
- char to_do[] = { CMD_SETSPEED, 0, 0 };
- char dummy;
- if (speed > 0) {
- to_do[1] = speed & 0x0F;
- cmd_out(TYPE_INFO, (char *) &to_do, (char *) &dummy, 0);
- }
- }
- static void cc_Reset(void)
- {
- char to_do[] = { CMD_RESET, 0 };
- char dummy;
- cmd_out(TYPE_INFO, (char *) &to_do, (char *) &dummy, 0);
- }
- static void cmd_status(void)
- {
- char to_do[] = { CMD_STATUS, 0 };
- char dummy;
- cmd_out(TYPE_INFO, (char *) &to_do, (char *) &dummy, 0);
- #ifdef GSCD_DEBUG
- printk("GSCD: Status: %d\n", disk_state);
- #endif
- }
- static void cmd_out(int cmd_type, char *cmd, char *respo_buf, int respo_count)
- {
- int result;
- result = wait_drv_ready();
- if (result != drv_mode) {
- unsigned long test_loops = 0xFFFF;
- int i, dummy;
- outb(curr_drv_state, GSCDPORT(0));
- /* LOCLOOP_170 */
- do {
- result = wait_drv_ready();
- test_loops--;
- } while ((result != drv_mode) && (test_loops > 0));
- if (result != drv_mode) {
- disk_state = ST_x08 | ST_x04 | ST_INVALID;
- return;
- }
- /* ...and waiting */
- for (i = 1, dummy = 1; i < 0xFFFF; i++) {
- dummy *= i;
- }
- }
- /* LOC_172 */
- /* check the unit */
- /* and wake it up */
- if (cmd_unit_alive() != 0x08) {
- /* LOC_174 */
- /* game over for this unit */
- disk_state = ST_x08 | ST_x04 | ST_INVALID;
- return;
- }
- /* LOC_176 */
- #ifdef GSCD_DEBUG
- printk("LOC_176 ");
- #endif
- if (drv_mode == 0x09) {
- /* magic... */
- printk("GSCD: magic ...\n");
- outb(result, GSCDPORT(2));
- }
- /* write the command to the drive */
- cmd_write_cmd(cmd);
- /* LOC_178 */
- for (;;) {
- result = wait_drv_ready();
- if (result != drv_mode) {
- /* LOC_179 */
- if (result == 0x04) { /* Mode 4 */
- /* LOC_205 */
- #ifdef GSCD_DEBUG
- printk("LOC_205 ");
- #endif
- disk_state = inb(GSCDPORT(2));
- do {
- result = wait_drv_ready();
- } while (result != drv_mode);
- return;
- } else {
- if (result == 0x06) { /* Mode 6 */
- /* LOC_181 */
- #ifdef GSCD_DEBUG
- printk("LOC_181 ");
- #endif
- if (cmd_type == TYPE_DATA) {
- /* read data */
- /* LOC_184 */
- if (drv_mode == 9) {
- /* read the data to the buffer (word) */
- /* (*(cmd+1))?(CD_FRAMESIZE/2):(CD_FRAMESIZE_RAW/2) */
- cmd_read_w
- (respo_buf,
- respo_count,
- CD_FRAMESIZE /
- 2);
- return;
- } else {
- /* read the data to the buffer (byte) */
- /* (*(cmd+1))?(CD_FRAMESIZE):(CD_FRAMESIZE_RAW) */
- cmd_read_b
- (respo_buf,
- respo_count,
- CD_FRAMESIZE);
- return;
- }
- } else {
- /* read the info to the buffer */
- cmd_info_in(respo_buf,
- respo_count);
- return;
- }
- return;
- }
- }
- } else {
- disk_state = ST_x08 | ST_x04 | ST_INVALID;
- return;
- }
- } /* for (;;) */
- #ifdef GSCD_DEBUG
- printk("\n");
- #endif
- }
- static void cmd_write_cmd(char *pstr)
- {
- int i, j;
- /* LOC_177 */
- #ifdef GSCD_DEBUG
- printk("LOC_177 ");
- #endif
- /* calculate the number of parameter */
- j = *pstr & 0x0F;
- /* shift it out */
- for (i = 0; i < j; i++) {
- outb(*pstr, GSCDPORT(2));
- pstr++;
- }
- }
- static int cmd_unit_alive(void)
- {
- int result;
- unsigned long max_test_loops;
- /* LOC_172 */
- #ifdef GSCD_DEBUG
- printk("LOC_172 ");
- #endif
- outb(curr_drv_state, GSCDPORT(0));
- max_test_loops = 0xFFFF;
- do {
- result = wait_drv_ready();
- max_test_loops--;
- } while ((result != 0x08) && (max_test_loops > 0));
- return result;
- }
- static void cmd_info_in(char *pb, int count)
- {
- int result;
- char read;
- /* read info */
- /* LOC_182 */
- #ifdef GSCD_DEBUG
- printk("LOC_182 ");
- #endif
- do {
- read = inb(GSCDPORT(2));
- if (count > 0) {
- *pb = read;
- pb++;
- count--;
- }
- /* LOC_183 */
- do {
- result = wait_drv_ready();
- } while (result == 0x0E);
- } while (result == 6);
- cmd_end();
- return;
- }
- static void cmd_read_b(char *pb, int count, int size)
- {
- int result;
- int i;
- /* LOC_188 */
- /* LOC_189 */
- #ifdef GSCD_DEBUG
- printk("LOC_189 ");
- #endif
- do {
- do {
- result = wait_drv_ready();
- } while (result != 6 || result == 0x0E);
- if (result != 6) {
- cmd_end();
- return;
- }
- #ifdef GSCD_DEBUG
- printk("LOC_191 ");
- #endif
- for (i = 0; i < size; i++) {
- *pb = inb(GSCDPORT(2));
- pb++;
- }
- count--;
- } while (count > 0);
- cmd_end();
- return;
- }
- static void cmd_end(void)
- {
- int result;
- /* LOC_204 */
- #ifdef GSCD_DEBUG
- printk("LOC_204 ");
- #endif
- do {
- result = wait_drv_ready();
- if (result == drv_mode) {
- return;
- }
- } while (result != 4);
- /* LOC_205 */
- #ifdef GSCD_DEBUG
- printk("LOC_205 ");
- #endif
- disk_state = inb(GSCDPORT(2));
- do {
- result = wait_drv_ready();
- } while (result != drv_mode);
- return;
- }
- static void cmd_read_w(char *pb, int count, int size)
- {
- int result;
- int i;
- #ifdef GSCD_DEBUG
- printk("LOC_185 ");
- #endif
- do {
- /* LOC_185 */
- do {
- result = wait_drv_ready();
- } while (result != 6 || result == 0x0E);
- if (result != 6) {
- cmd_end();
- return;
- }
- for (i = 0; i < size; i++) {
- /* na, hier muss ich noch mal drueber nachdenken */
- *pb = inw(GSCDPORT(2));
- pb++;
- }
- count--;
- } while (count > 0);
- cmd_end();
- return;
- }
- static int __init find_drives(void)
- {
- int *pdrv;
- int drvnum;
- int subdrv;
- int i;
- speed = 0;
- pdrv = (int *) &drv_states;
- curr_drv_state = 0xFE;
- subdrv = 0;
- drvnum = 0;
- for (i = 0; i < 8; i++) {
- subdrv++;
- cmd_status();
- disk_state &= ST_x08 | ST_x04 | ST_INVALID | ST_x01;
- if (disk_state != (ST_x08 | ST_x04 | ST_INVALID)) {
- /* LOC_240 */
- *pdrv = curr_drv_state;
- init_cd_drive(drvnum);
- pdrv++;
- drvnum++;
- } else {
- if (subdrv < 2) {
- continue;
- } else {
- subdrv = 0;
- }
- }
- /* curr_drv_state<<1; <-- das geht irgendwie nicht */
- /* muss heissen: curr_drv_state <<= 1; (ist ja Wert-Zuweisung) */
- curr_drv_state *= 2;
- curr_drv_state |= 1;
- #ifdef GSCD_DEBUG
- printk("DriveState: %d\n", curr_drv_state);
- #endif
- }
- ndrives = drvnum;
- return drvnum;
- }
- static void __init init_cd_drive(int num)
- {
- char resp[50];
- int i;
- printk("GSCD: init unit %d\n", num);
- cc_Ident((char *) &resp);
- printk("GSCD: identification: ");
- for (i = 0; i < 0x1E; i++) {
- printk("%c", resp[i]);
- }
- printk("\n");
- cc_SetSpeed();
- }
- #ifdef FUTURE_WORK
- /* return_done */
- static void update_state(void)
- {
- unsigned int AX;
- if ((disk_state & (ST_x08 | ST_x04 | ST_INVALID | ST_x01)) == 0) {
- if (disk_state == (ST_x08 | ST_x04 | ST_INVALID)) {
- AX = ST_INVALID;
- }
- if ((disk_state & (ST_x08 | ST_x04 | ST_INVALID | ST_x01))
- == 0) {
- invalidate();
- f_drv_ok = 0;
- }
- AX |= 0x8000;
- }
- if (disk_state & ST_PLAYING) {
- AX |= 0x200;
- }
- AX |= 0x100;
- /* pkt_esbx = AX; */
- disk_state = 0;
- }
- #endif
- static struct gendisk *gscd_disk;
- static void __exit gscd_exit(void)
- {
- CLEAR_TIMER;
- del_gendisk(gscd_disk);
- put_disk(gscd_disk);
- if ((unregister_blkdev(MAJOR_NR, "gscd") == -EINVAL)) {
- printk("What's that: can't unregister GoldStar-module\n");
- return;
- }
- blk_cleanup_queue(gscd_queue);
- release_region(gscd_port, GSCD_IO_EXTENT);
- printk(KERN_INFO "GoldStar-module released.\n");
- }
- /* This is the common initialisation for the GoldStar drive. */
- /* It is called at boot time AND for module init. */
- static int __init gscd_init(void)
- {
- int i;
- int result;
- int ret=0;
- printk(KERN_INFO "GSCD: version %s\n", GSCD_VERSION);
- printk(KERN_INFO
- "GSCD: Trying to detect a Goldstar R420 CD-ROM drive at 0x%X.\n",
- gscd_port);
- if (!request_region(gscd_port, GSCD_IO_EXTENT, "gscd")) {
- printk(KERN_WARNING "GSCD: Init failed, I/O port (%X) already"
- " in use.\n", gscd_port);
- return -EIO;
- }
- /* check for card */
- result = wait_drv_ready();
- if (result == 0x09) {
- printk(KERN_WARNING "GSCD: DMA kann ich noch nicht!\n");
- ret = -EIO;
- goto err_out1;
- }
- if (result == 0x0b) {
- drv_mode = result;
- i = find_drives();
- if (i == 0) {
- printk(KERN_WARNING "GSCD: GoldStar CD-ROM Drive is"
- " not found.\n");
- ret = -EIO;
- goto err_out1;
- }
- }
- if ((result != 0x0b) && (result != 0x09)) {
- printk(KERN_WARNING "GSCD: GoldStar Interface Adapter does not "
- "exist or H/W error\n");
- ret = -EIO;
- goto err_out1;
- }
- /* reset all drives */
- i = 0;
- while (drv_states[i] != 0) {
- curr_drv_state = drv_states[i];
- printk(KERN_INFO "GSCD: Reset unit %d ... ", i);
- cc_Reset();
- printk("done\n");
- i++;
- }
- gscd_disk = alloc_disk(1);
- if (!gscd_disk)
- goto err_out1;
- gscd_disk->major = MAJOR_NR;
- gscd_disk->first_minor = 0;
- gscd_disk->fops = &gscd_fops;
- sprintf(gscd_disk->disk_name, "gscd");
- sprintf(gscd_disk->devfs_name, "gscd");
- if (register_blkdev(MAJOR_NR, "gscd")) {
- ret = -EIO;
- goto err_out2;
- }
- gscd_queue = blk_init_queue(do_gscd_request, &gscd_lock);
- if (!gscd_queue) {
- ret = -ENOMEM;
- goto err_out3;
- }
- disk_state = 0;
- gscdPresent = 1;
- gscd_disk->queue = gscd_queue;
- add_disk(gscd_disk);
- printk(KERN_INFO "GSCD: GoldStar CD-ROM Drive found.\n");
- return 0;
- err_out3:
- unregister_blkdev(MAJOR_NR, "gscd");
- err_out2:
- put_disk(gscd_disk);
- err_out1:
- release_region(gscd_port, GSCD_IO_EXTENT);
- return ret;
- }
- static void gscd_hsg2msf(long hsg, struct msf *msf)
- {
- hsg += CD_MSF_OFFSET;
- msf->min = hsg / (CD_FRAMES * CD_SECS);
- hsg %= CD_FRAMES * CD_SECS;
- msf->sec = hsg / CD_FRAMES;
- msf->frame = hsg % CD_FRAMES;
- gscd_bin2bcd(&msf->min); /* convert to BCD */
- gscd_bin2bcd(&msf->sec);
- gscd_bin2bcd(&msf->frame);
- }
- static void gscd_bin2bcd(unsigned char *p)
- {
- int u, t;
- u = *p % 10;
- t = *p / 10;
- *p = u | (t << 4);
- }
- #ifdef FUTURE_WORK
- static long gscd_msf2hsg(struct msf *mp)
- {
- return gscd_bcd2bin(mp->frame)
- + gscd_bcd2bin(mp->sec) * CD_FRAMES
- + gscd_bcd2bin(mp->min) * CD_FRAMES * CD_SECS - CD_MSF_OFFSET;
- }
- static int gscd_bcd2bin(unsigned char bcd)
- {
- return (bcd >> 4) * 10 + (bcd & 0xF);
- }
- #endif
- MODULE_AUTHOR("Oliver Raupach <raupach@nwfs1.rz.fh-hannover.de>");
- MODULE_LICENSE("GPL");
- module_init(gscd_init);
- module_exit(gscd_exit);
- MODULE_ALIAS_BLOCKDEV_MAJOR(GOLDSTAR_CDROM_MAJOR);
|