2 * sbpcd.c CD-ROM device driver for the whole family of traditional,
3 * non-ATAPI IDE-style Matsushita/Panasonic CR-5xx drives.
4 * Works with SoundBlaster compatible cards and with "no-sound"
5 * interface cards like Lasermate, Panasonic CI-101P, Teac, ...
6 * Also for the Longshine LCS-7260 drive.
7 * Also for the IBM "External ISA CD-Rom" drive.
8 * Also for the CreativeLabs CD200 drive.
9 * Also for the TEAC CD-55A drive.
10 * Also for the ECS-AT "Vertos 100" drive.
11 * Not for Sanyo drives (but for the H94A, sjcd is there...).
12 * Not for any other Funai drives than the CD200 types (sometimes
13 * labelled E2550UA or MK4015 or 2800F).
16 #define VERSION "v4.63 Andrew J. Kroll <ag784@freenet.buffalo.edu> Wed Jul 26 04:24:10 EDT 2000"
18 /* Copyright (C) 1993, 1994, 1995 Eberhard Moenkeberg <emoenke@gwdg.de>
20 * This program is free software; you can redistribute it and/or modify
21 * it under the terms of the GNU General Public License as published by
22 * the Free Software Foundation; either version 2, or (at your option)
25 * You should have received a copy of the GNU General Public License
26 * (for example /usr/src/linux/COPYING); if not, write to the Free
27 * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
29 * If you change this software, you should mail a .diff file with some
30 * description lines to emoenke@gwdg.de. I want to know about it.
32 * If you are the editor of a Linux CD, you should enable sbpcd.c within
33 * your boot floppy kernel and send me one of your CDs for free.
35 * If you would like to port the driver to an other operating system (f.e.
36 * FreeBSD or NetBSD) or use it as an information source, you shall not be
37 * restricted by the GPL under the following conditions:
38 * a) the source code of your work is freely available
39 * b) my part of the work gets mentioned at all places where your
40 * authorship gets mentioned
41 * c) I receive a copy of your code together with a full installation
42 * package of your operating system for free.
47 * 0.1 initial release, April/May 93, after mcd.c (Martin Harriss)
49 * 0.2 thek "repeat:"-loop in do_sbpcd_request did not check for
50 * end-of-request_queue (resulting in kernel panic).
51 * Flow control seems stable, but throughput is not better.
53 * 0.3 interrupt locking totally eliminated (maybe "inb" and "outb"
54 * are still locking) - 0.2 made keyboard-type-ahead losses.
55 * check_sbpcd_media_change added (to use by isofs/inode.c)
56 * - but it detects almost nothing.
58 * 0.4 use MAJOR 25 definitely.
59 * Almost total re-design to support double-speed drives and
60 * "naked" (no sound) interface cards ("LaserMate" interface type).
61 * Flow control should be exact now.
62 * Don't occupy the SbPro IRQ line (not needed either); will
63 * live together with Hannu Savolainen's sndkit now.
64 * Speeded up data transfer to 150 kB/sec, with help from Kai
65 * Makisara, the "provider" of the "mt" tape utility.
66 * Give "SpinUp" command if necessary.
67 * First steps to support up to 4 drives (but currently only one).
68 * Implemented audio capabilities - workman should work, xcdplayer
69 * gives some problems.
70 * This version is still consuming too much CPU time, and
71 * sleeping still has to be worked on.
72 * During "long" implied seeks, it seems possible that a
73 * ReadStatus command gets ignored. That gives the message
74 * "ResponseStatus timed out" (happens about 6 times here during
75 * a "ls -alR" of the YGGDRASIL LGX-Beta CD). Such a case is
76 * handled without data error, but it should get done better.
78 * 0.5 Free CPU during waits (again with help from Kai Makisara).
79 * Made it work together with the LILO/kernel setup standard.
80 * Included auto-probing code, as suggested by YGGDRASIL.
81 * Formal redesign to add DDI debugging.
82 * There are still flaws in IOCTL (workman with double speed drive).
84 * 1.0 Added support for all drive IDs (0...3, no longer only 0)
85 * and up to 4 drives on one controller.
86 * Added "#define MANY_SESSION" for "old" multi session CDs.
88 * 1.1 Do SpinUp for new drives, too.
89 * Revised for clean compile under "old" kernels (0.99pl9).
91 * 1.2 Found the "workman with double-speed drive" bug: use the driver's
92 * audio_state, not what the drive is reporting with ReadSubQ.
95 * Refinements regarding Workman.
97 * 1.4 Read XA disks (PhotoCDs) with "old" drives, too (but only the first
98 * session - no chance to fully access a "multi-session" CD).
99 * This currently still is too slow (50 kB/sec) - but possibly
100 * the old drives won't do it faster.
101 * Implemented "door (un)lock" for new drives (still does not work
102 * as wanted - no lock possible after an unlock).
103 * Added some debugging printout for the UPC/EAN code - but my drives
104 * return only zeroes. Is there no UPC/EAN code written?
106 * 1.5 Laborate with UPC/EAN code (not better yet).
107 * Adapt to kernel 1.1.8 change (have to explicitly include
108 * <linux/string.h> now).
110 * 1.6 Trying to read audio frames as data. Impossible with the current
111 * drive firmware levels, as it seems. Awaiting any hint. ;-)
112 * Changed "door unlock": repeat it until success.
113 * Changed CDROMSTOP routine (stop somewhat "softer" so that Workman
114 * won't get confused).
115 * Added a third interface type: Sequoia S-1000, as used with the SPEA
116 * Media FX sound card. This interface (usable for Sony and Mitsumi
117 * drives, too) needs a special configuration setup and behaves like a
118 * LaserMate type after that. Still experimental - I do not have such
120 * Use the "variable BLOCK_SIZE" feature (2048). But it does only work
121 * if you give the mount option "block=2048".
122 * The media_check routine is currently disabled; now that it gets
123 * called as it should I fear it must get synchronized for not to
124 * disturb the normal driver's activity.
126 * 2.0 Version number bumped - two reasons:
127 * - reading audio tracks as data works now with CR-562 and CR-563. We
128 * currently do it by an IOCTL (yet has to get standardized), one frame
129 * at a time; that is pretty slow. But it works.
130 * - we are maintaining now up to 4 interfaces (each up to 4 drives):
131 * did it the easy way - a different MAJOR (25, 26, ...) and a different
132 * copy of the driver (sbpcd.c, sbpcd2.c, sbpcd3.c, sbpcd4.c - only
133 * distinguished by the value of SBPCD_ISSUE and the driver's name),
134 * and a common sbpcd.h file.
135 * Bettered the "ReadCapacity error" problem with old CR-52x drives (the
136 * drives sometimes need a manual "eject/insert" before work): just
137 * reset the drive and do again. Needs lots of resets here and sometimes
138 * that does not cure, so this can't be the solution.
140 * 2.1 Found bug with multisession CDs (accessing frame 16).
141 * "read audio" works now with address type CDROM_MSF, too.
142 * Bigger audio frame buffer: allows reading max. 4 frames at time; this
143 * gives a significant speedup, but reading more than one frame at once
144 * gives missing chunks at each single frame boundary.
146 * 2.2 Kernel interface cleanups: timers, init, setup, media check.
148 * 2.3 Let "door lock" and "eject" live together.
149 * Implemented "close tray" (done automatically during open).
151 * 2.4 Use different names for device registering.
153 * 2.5 Added "#if EJECT" code (default: enabled) to automatically eject
154 * the tray during last call to "sbpcd_release".
155 * Added "#if JUKEBOX" code (default: disabled) to automatically eject
156 * the tray during call to "sbpcd_open" if no disk is in.
157 * Turn on the CD volume of "compatible" sound cards, too; just define
158 * SOUND_BASE (in sbpcd.h) accordingly (default: disabled).
162 * 2.7 Added CDROMEJECT_SW ioctl to set the "EJECT" behavior on the fly:
163 * 0 disables, 1 enables auto-ejecting. Useful to keep the tray in
166 * 2.8 Added first support (still BETA, I need feedback or a drive) for
167 * the Longshine LCS-7260 drives. They appear as double-speed drives
168 * using the "old" command scheme, extended by tray control and door
170 * Found (and fixed preliminary) a flaw with some multisession CDs: we
171 * have to re-direct not only the accesses to frame 16 (the isofs
172 * routines drive it up to max. 100), but also those to the continuation
173 * (repetition) frames (as far as they exist - currently set fix as
175 * Changed default of the "JUKEBOX" define. If you use this default,
176 * your tray will eject if you try to mount without a disk in. Next
177 * mount command will insert the tray - so, just fill in a disk. ;-)
179 * 2.9 Fulfilled the Longshine LCS-7260 support; with great help and
180 * experiments by Serge Robyns.
181 * First attempts to support the TEAC CD-55A drives; but still not
183 * Implemented the CDROMMULTISESSION ioctl; this is an attempt to handle
184 * multi session CDs more "transparent" (redirection handling has to be
185 * done within the isofs routines, and only for the special purpose of
186 * obtaining the "right" volume descriptor; accesses to the raw device
187 * should not get redirected).
189 * 3.0 Just a "normal" increment, with some provisions to do it better. ;-)
190 * Introduced "#define READ_AUDIO" to specify the maximum number of
191 * audio frames to grab with one request. This defines a buffer size
192 * within kernel space; a value of 0 will reserve no such space and
193 * disable the CDROMREADAUDIO ioctl. A value of 75 enables the reading
194 * of a whole second with one command, but will use a buffer of more
196 * Started CD200 support. Drive detection should work, but nothing
199 * 3.1 Working to support the CD200 and the Teac CD-55A drives.
200 * AT-BUS style device numbering no longer used: use SCSI style now.
201 * So, the first "found" device has MINOR 0, regardless of the
202 * jumpered drive ID. This implies modifications to the /dev/sbpcd*
203 * entries for some people, but will help the DAU (german TLA, english:
204 * "newbie", maybe ;-) to install his "first" system from a CD.
206 * 3.2 Still testing with CD200 and CD-55A drives.
208 * 3.3 Working with CD200 support.
210 * 3.4 Auto-probing stops if an address of 0 is seen (to be entered with
211 * the kernel command line).
212 * Made the driver "loadable". If used as a module, "audio copy" is
213 * disabled, and the internal read ahead data buffer has a reduced size
214 * of 4 kB; so, throughput may be reduced a little bit with slow CPUs.
216 * 3.5 Provisions to handle weird photoCDs which have an interrupted
217 * "formatting" immediately after the last frames of some files: simply
218 * never "read ahead" with MultiSession CDs. By this, CPU usage may be
219 * increased with those CDs, and there may be a loss in speed.
220 * Re-structured the messaging system.
221 * The "loadable" version no longer has a limited READ_AUDIO buffer
223 * Removed "MANY_SESSION" handling for "old" multi session CDs.
224 * Added "private" IOCTLs CDROMRESET and CDROMVOLREAD.
225 * Started again to support the TEAC CD-55A drives, now that I found
226 * the money for "my own" drive. ;-)
227 * The TEAC CD-55A support is fairly working now.
228 * I have measured that the drive "delivers" at 600 kB/sec (even with
229 * bigger requests than the drive's 64 kB buffer can satisfy), but
230 * the "real" rate does not exceed 520 kB/sec at the moment.
231 * Caused by the various changes to build in TEAC support, the timed
232 * loops are de-optimized at the moment (less throughput with CR-52x
233 * drives, and the TEAC will give speed only with SBP_BUFFER_FRAMES 64).
235 * 3.6 Fixed TEAC data read problems with SbPro interfaces.
236 * Initial size of the READ_AUDIO buffer is 0. Can get set to any size
239 * 3.7 Introduced MAX_DRIVES for some poor interface cards (seen with TEAC
240 * drives) which allow only one drive (ID 0); this avoids repetitive
241 * detection under IDs 1..3.
242 * Elongated cmd_out_T response waiting; necessary for photo CDs with
244 * Bettered the sbpcd_open() behavior with TEAC drives.
246 * 3.8 Elongated max_latency for CR-56x drives.
248 * 3.9 Finally fixed the long-known SoundScape/SPEA/Sequoia S-1000 interface
250 * Now Corey, Heiko, Ken, Leo, Vadim/Eric & Werner are invited to copy
251 * the config_spea() routine into their drivers. ;-)
253 * 4.0 No "big step" - normal version increment.
254 * Adapted the benefits from 1.3.33.
255 * Fiddled with CDROMREADAUDIO flaws.
256 * Avoid ReadCapacity command with CD200 drives (the MKE 1.01 version
257 * seems not to support it).
258 * Fulfilled "read audio" for CD200 drives, with help of Pete Heist
261 * 4.1 Use loglevel KERN_INFO with printk().
262 * Added support for "Vertos 100" drive ("ECS-AT") - it is very similar
263 * to the Longshine LCS-7260. Give feedback if you can - I never saw
264 * such a drive, and I have no specs.
266 * 4.2 Support for Teac 16-bit interface cards. Can't get auto-detected,
267 * so you have to jumper your card to 0x2C0. Still not 100% - come
268 * in contact if you can give qualified feedback.
269 * Use loglevel KERN_NOTICE with printk(). If you get annoyed by a
270 * flood of unwanted messages and the accompanied delay, try to read
271 * my documentation. Especially the Linux CDROM drivers have to do an
272 * important job for the newcomers, so the "distributed" version has
273 * to fit some special needs. Since generations, the flood of messages
274 * is user-configurable (even at runtime), but to get aware of this, one
275 * needs a special mental quality: the ability to read.
277 * 4.3 CD200F does not like to receive a command while the drive is
278 * reading the ToC; still trying to solve it.
279 * Removed some redundant verify_area calls (yes, Heiko Eissfeldt
280 * is visiting all the Linux CDROM drivers ;-).
282 * 4.4 Adapted one idea from tiensivu@pilot.msu.edu's "stripping-down"
283 * experiments: "KLOGD_PAUSE".
284 * Inhibited "play audio" attempts with data CDs. Provisions for a
285 * "data-safe" handling of "mixed" (data plus audio) Cds.
287 * 4.5 Meanwhile Gonzalo Tornaria <tornaria@cmat.edu.uy> (GTL) built a
288 * special end_request routine: we seem to have to take care for not
289 * to have two processes working at the request list. My understanding
290 * was and is that ll_rw_blk should not call do_sbpcd_request as long
291 * as there is still one call active (the first call will care for all
292 * outstanding I/Os, and if a second call happens, that is a bug in
294 * "Check media change" without touching any drive.
296 * 4.6 Use a semaphore to synchronize multi-activity; elaborated by Rob
297 * Riggs <rriggs@tesser.com>. At the moment, we simply block "read"
298 * against "ioctl" and vice versa. This could be refined further, but
299 * I guess with almost no performance increase.
300 * Experiments to speed up the CD-55A; again with help of Rob Riggs
301 * (to be true, he gave both, idea & code. ;-)
303 * 4.61 Ported to Uniform CD-ROM driver by
304 * Heiko Eissfeldt <heiko@colossus.escape.de> with additional
305 * changes by Erik Andersen <andersee@debian.org>
307 * 4.62 Fix a bug where playing audio left the drive in an unusable state.
308 * Heiko Eissfeldt <heiko@colossus.escape.de>
310 * November 1999 -- Make kernel-parameter implementation work with 2.3.x
311 * Removed init_module & cleanup_module in favor of
312 * module_init & module_exit.
313 * Torben Mathiasen <tmm@image.dk>
315 * 4.63 Bug fixes for audio annoyances, new legacy CDROM maintainer.
316 * Annoying things fixed:
317 * TOC reread on automated disk changes
318 * TOC reread on manual cd changes
319 * Play IOCTL tries to play CD before it's actually ready... sometimes.
320 * CD_AUDIO_COMPLETED state so workman (and other playes) can repeat play.
321 * Andrew J. Kroll <ag784@freenet.buffalo.edu> Wed Jul 26 04:24:10 EDT 2000
323 * 4.64 Fix module parameters - were being completely ignored.
324 * Can also specify max_drives=N as a setup int to get rid of
325 * "ghost" drives on crap hardware (aren't they all?) Paul Gortmaker
328 * implement "read all subchannel data" (96 bytes per frame)
329 * remove alot of the virtual status bits and deal with hardware status
330 * move the change of cd for audio to a better place
331 * add debug levels to insmod parameters (trivial)
333 * special thanks to Kai Makisara (kai.makisara@vtt.fi) for his fine
334 * elaborated speed-up experiments (and the fabulous results!), for
335 * the "push" towards load-free wait loops, and for the extensive mail
336 * thread which brought additional hints and bug fixes.
341 * Trying to merge requests breaks this driver horribly (as in it goes
342 * boom and apparently has done so since 2.3.41). As it is a legacy
343 * driver for a horribly slow double speed CD on a hideous interface
344 * designed for polled operation, I won't lose any sleep in simply
345 * disallowing merging. Paul G. 02/2001
347 * Thu May 30 14:14:47 CEST 2002:
349 * I have presumably found the reson for the above - there was a bogous
350 * end_request substitute, which was manipulating the request queues
351 * incorrectly. If someone has access to the actual hardware, and it's
352 * still operations - well please free to test it.
358 * Add bio/kdev_t changes for 2.5.x required to make it work again.
359 * Still room for improvement in the request handling here if anyone
360 * actually cares. Bring your own chainsaw. Paul G. 02/2002
364 #include <linux/module.h>
366 #include <linux/errno.h>
367 #include <linux/sched.h>
368 #include <linux/mm.h>
369 #include <linux/timer.h>
370 #include <linux/fs.h>
371 #include <linux/kernel.h>
372 #include <linux/cdrom.h>
373 #include <linux/ioport.h>
374 #include <linux/devfs_fs_kernel.h>
375 #include <linux/major.h>
376 #include <linux/string.h>
377 #include <linux/vmalloc.h>
378 #include <linux/init.h>
379 #include <linux/interrupt.h>
381 #include <asm/system.h>
383 #include <asm/uaccess.h>
385 #include <linux/config.h>
388 #define MAJOR_NR MATSUSHITA_CDROM_MAJOR
389 #include <linux/blkdev.h>
391 /*==========================================================================*/
393 # define SBPCD_CLI cli()
394 # define SBPCD_STI sti()
400 /*==========================================================================*/
402 * auto-probing address list
403 * inspired by Adam J. Richter from Yggdrasil
405 * still not good enough - can cause a hang.
406 * example: a NE 2000 ethernet card at 300 will cause a hang probing 310.
407 * if that happens, reboot and use the LILO (kernel) command line.
408 * The possibly conflicting ethernet card addresses get NOT probed
409 * by default - to minimize the hang possibilities.
411 * The SB Pro addresses get "mirrored" at 0x6xx and some more locations - to
412 * avoid a type error, the 0x2xx-addresses must get checked before 0x6xx.
414 * send mail to emoenke@gwdg.de if your interface card is not FULLY
419 CDROM_PORT
, SBPRO
, /* probe with user's setup first */
421 0x230, 1, /* Soundblaster Pro and 16 (default) */
423 0x300, 0, /* CI-101P (default), WDH-7001C (default),
424 Galaxy (default), Reveal (one default) */
425 0x250, 1, /* OmniCD default, Soundblaster Pro and 16 */
426 0x2C0, 3, /* Teac 16-bit cards */
427 0x260, 1, /* OmniCD */
428 0x320, 0, /* Lasermate, CI-101P, WDH-7001C, Galaxy, Reveal (other default),
429 Longshine LCS-6853 (default) */
430 0x338, 0, /* Reveal Sound Wave 32 card model #SC600 */
431 0x340, 0, /* Mozart sound card (default), Lasermate, CI-101P */
432 0x360, 0, /* Lasermate, CI-101P */
433 0x270, 1, /* Soundblaster 16 */
434 0x670, 0, /* "sound card #9" */
435 0x690, 0, /* "sound card #9" */
436 0x338, 2, /* SPEA Media FX, Ensonic SoundScape (default) */
437 0x328, 2, /* SPEA Media FX */
438 0x348, 2, /* SPEA Media FX */
439 0x634, 0, /* some newer sound cards */
440 0x638, 0, /* some newer sound cards */
441 0x230, 1, /* some newer sound cards */
442 /* due to incomplete address decoding of the SbPro card, these must be last */
443 0x630, 0, /* "sound card #9" (default) */
444 0x650, 0, /* "sound card #9" */
447 * some "hazardous" locations (no harm with the loadable version)
448 * (will stop the bus if a NE2000 ethernet card resides at offset -0x10)
450 0x330, 0, /* Lasermate, CI-101P, WDH-7001C */
451 0x350, 0, /* Lasermate, CI-101P */
452 0x358, 2, /* SPEA Media FX */
453 0x370, 0, /* Lasermate, CI-101P */
454 0x290, 1, /* Soundblaster 16 */
455 0x310, 0, /* Lasermate, CI-101P, WDH-7001C */
458 #endif /* DISTRIBUTION */
462 * Protects access to global structures etc.
464 static spinlock_t sbpcd_lock __cacheline_aligned
= SPIN_LOCK_UNLOCKED
;
465 static struct request_queue
*sbpcd_queue
;
467 MODULE_PARM(sbpcd
, "2i");
468 MODULE_PARM(max_drives
, "i");
470 #define NUM_PROBE (sizeof(sbpcd) / sizeof(int))
472 /*==========================================================================*/
474 #define INLINE inline
476 /*==========================================================================*/
478 * the forward references:
480 static void sbp_sleep(u_int
);
481 static void mark_timeout_delay(u_long
);
482 static void mark_timeout_data(u_long
);
484 static void mark_timeout_audio(u_long
);
486 static void sbp_read_cmd(struct request
*req
);
487 static int sbp_data(struct request
*req
);
488 static int cmd_out(void);
489 static int DiskInfo(void);
491 /*==========================================================================*/
494 * pattern for printk selection:
496 * (1<<DBG_INF) necessary information
497 * (1<<DBG_BSZ) BLOCK_SIZE trace
498 * (1<<DBG_REA) "read" status trace
499 * (1<<DBG_CHK) "media check" trace
500 * (1<<DBG_TIM) datarate timer test
501 * (1<<DBG_INI) initialization trace
502 * (1<<DBG_TOC) tell TocEntry values
503 * (1<<DBG_IOC) ioctl trace
504 * (1<<DBG_STA) "ResponseStatus" trace
505 * (1<<DBG_ERR) "cc_ReadError" trace
506 * (1<<DBG_CMD) "cmd_out" trace
507 * (1<<DBG_WRN) give explanation before auto-probing
508 * (1<<DBG_MUL) multi session code test
509 * (1<<DBG_IDX) "drive_id != 0" test code
510 * (1<<DBG_IOX) some special information
511 * (1<<DBG_DID) drive ID test
512 * (1<<DBG_RES) drive reset info
513 * (1<<DBG_SPI) SpinUp test info
514 * (1<<DBG_IOS) ioctl trace: "subchannel"
515 * (1<<DBG_IO2) ioctl trace: general
516 * (1<<DBG_UPC) show UPC info
517 * (1<<DBG_XA1) XA mode debugging
518 * (1<<DBG_LCK) door (un)lock info
519 * (1<<DBG_SQ1) dump SubQ frame
520 * (1<<DBG_AUD) "read audio" debugging
521 * (1<<DBG_SEQ) Sequoia interface configuration trace
522 * (1<<DBG_LCS) Longshine LCS-7260 debugging trace
523 * (1<<DBG_CD2) MKE/Funai CD200 debugging trace
524 * (1<<DBG_TEA) TEAC CD-55A debugging trace
525 * (1<<DBG_ECS) ECS-AT (Vertos-100) debugging trace
526 * (1<<DBG_000) unnecessary information
529 static int sbpcd_debug
= (1<<DBG_INF
);
531 static int sbpcd_debug
= 0 & ((1<<DBG_INF
) |
535 #endif /* DISTRIBUTION */
537 static int sbpcd_ioaddr
= CDROM_PORT
; /* default I/O base address */
538 static int sbpro_type
= SBPRO
;
539 static unsigned char f_16bit
;
540 static unsigned char do_16bit
;
541 static int CDo_command
, CDo_reset
;
542 static int CDo_sel_i_d
, CDo_enable
;
543 static int CDi_info
, CDi_status
, CDi_data
;
544 static struct cdrom_msf msf
;
545 static struct cdrom_ti ti
;
546 static struct cdrom_tochdr tochdr
;
547 static struct cdrom_tocentry tocentry
;
548 static struct cdrom_subchnl SC
;
549 static struct cdrom_volctrl volctrl
;
550 static struct cdrom_read_audio read_audio
;
552 static unsigned char msgnum
;
553 static char msgbuf
[80];
555 static int max_drives
= MAX_DRIVES
;
557 static unsigned char setup_done
;
558 static const char *str_sb_l
= "soundblaster";
559 static const char *str_sp_l
= "spea";
560 static const char *str_ss_l
= "soundscape";
561 static const char *str_t16_l
= "teac16bit";
562 static const char *str_ss
= "SoundScape";
564 static const char *str_sb
= "SoundBlaster";
565 static const char *str_lm
= "LaserMate";
566 static const char *str_sp
= "SPEA";
567 static const char *str_t16
= "Teac16bit";
568 static const char *type
;
569 static const char *major_name
="sbpcd";
571 /*==========================================================================*/
574 static DECLARE_WAIT_QUEUE_HEAD(sbp_waitq
);
577 static int teac
=SBP_TEAC_SPEED
;
578 static int buffers
=SBP_BUFFER_FRAMES
;
580 static u_char family0
[]="MATSHITA"; /* MKE CR-521, CR-522, CR-523 */
581 static u_char family1
[]="CR-56"; /* MKE CR-562, CR-563 */
582 static u_char family2
[]="CD200"; /* MKE CD200, Funai CD200F */
583 static u_char familyL
[]="LCS-7260"; /* Longshine LCS-7260 */
584 static u_char familyT
[]="CD-55"; /* TEAC CD-55A */
585 static u_char familyV
[]="ECS-AT"; /* ECS Vertos 100 */
587 static u_int recursion
; /* internal testing only */
588 static u_int fatal_err
; /* internal testing only */
589 static u_int response_count
;
590 static u_int flags_cmd_out
;
591 static u_char cmd_type
;
592 static u_char drvcmd
[10];
593 static u_char infobuf
[20];
594 static u_char xa_head_buf
[CD_XA_HEAD
];
595 static u_char xa_tail_buf
[CD_XA_TAIL
];
598 static volatile u_char busy_data
;
599 static volatile u_char busy_audio
; /* true semaphores would be safer */
600 #endif /* OLD_BUSY */
601 static DECLARE_MUTEX(ioctl_read_sem
);
602 static u_long timeout
;
603 static volatile u_char timed_out_delay
;
604 static volatile u_char timed_out_data
;
606 static volatile u_char timed_out_audio
;
608 static u_int datarate
= 1000000;
609 static u_int maxtim16
=16000000;
610 static u_int maxtim04
= 4000000;
611 static u_int maxtim02
= 2000000;
612 static u_int maxtim_8
= 30000;
614 static u_int maxtim_data
= 9000;
616 static u_int maxtim_data
= 3000;
617 #endif /* LONG_TIMING */
619 static int n_retries
=6;
621 static int n_retries
=6;
623 /*==========================================================================*/
626 static u_char drv_pattern
[NR_SBPCD
]={speed_auto
,speed_auto
,speed_auto
,speed_auto
};
628 /*==========================================================================*/
630 * drive space begins here (needed separate for each unit)
632 static struct sbpcd_drive
{
633 char drv_id
; /* "jumpered" drive ID or -1 */
634 char drv_sel
; /* drive select lines bits */
637 u_char firmware_version
[4];
638 char f_eject
; /* auto-eject flag: 0 or 1 */
639 u_char
*sbp_buf
; /* Pointer to internal data buffer,
640 space allocated during sbpcd_init() */
641 u_int sbp_bufsiz
; /* size of sbp_buf (# of frames) */
642 int sbp_first_frame
; /* First frame in buffer */
643 int sbp_last_frame
; /* Last frame in buffer */
644 int sbp_read_frames
; /* Number of frames being read to buffer */
645 int sbp_current
; /* Frame being currently read */
647 u_char mode
; /* read_mode: READ_M1, READ_M2, READ_SC, READ_AU */
648 u_char
*aud_buf
; /* Pointer to audio data buffer,
649 space allocated during sbpcd_init() */
650 u_int sbp_audsiz
; /* size of aud_buf (# of raw frames) */
654 u_char diskstate_flags
;
661 u_char f_multisession
;
665 int track_of_last_session
;
668 u_int pos_audio_start
;
674 #if 000 /* no supported drive has it */
680 u_char volume_control
; /* TEAC on/off bits */
687 u_char SubQ_whatisthis
;
695 u_char xa_byte
; /* 0x20: XA capabilities */
696 u_char n_first_track
; /* binary */
697 u_char n_last_track
; /* binary (not bcd), 0x01...0x63 */
698 u_int size_msf
; /* time of whole CD, position of LeadOut track */
701 u_char TocEnt_nixbyte
; /* em */
702 u_char TocEnt_ctl_adr
;
703 u_char TocEnt_number
;
704 u_char TocEnt_format
; /* em */
705 u_int TocEnt_address
;
708 #endif /* SAFE_MIXED */
709 u_char ored_ctl_adr
; /* to detect if CDROM contains data tracks */
712 u_char nixbyte
; /* em */
713 u_char ctl_adr
; /* 0x4x: data, 0x0x: audio */
715 u_char format
; /* em */ /* 0x00: lba, 0x01: msf */
717 } TocBuffer
[MAX_TRACKS
+1]; /* last entry faked */
719 int in_SpinUp
; /* CR-52x test flag */
720 int n_bytes
; /* TEAC awaited response count */
721 u_char error_state
, b3
, b4
; /* TEAC command error state */
722 u_char f_drv_error
; /* TEAC command error flag */
725 u_char f_XA
; /* 1: XA */
726 u_char type_byte
; /* 0, 1, 3 */
731 struct cdrom_device_info
*sbpcd_infop
;
732 struct gendisk
*disk
;
735 static struct sbpcd_drive
*current_drive
= D_S
;
738 * drive space ends here (needed separate for each unit)
740 /*==========================================================================*/
742 unsigned long cli_sti
; /* for saving the processor flags */
744 /*==========================================================================*/
745 static struct timer_list delay_timer
=
746 TIMER_INITIALIZER(mark_timeout_delay
, 0, 0);
747 static struct timer_list data_timer
=
748 TIMER_INITIALIZER(mark_timeout_data
, 0, 0);
750 static struct timer_list audio_timer
=
751 TIMER_INITIALIZER(mark_timeout_audio
, 0, 0);
753 /*==========================================================================*/
757 static void msg(int level
, const char *fmt
, ...)
760 #define MSG_LEVEL KERN_NOTICE
762 #define MSG_LEVEL KERN_INFO
763 #endif /* DISTRIBUTION */
768 if (!(sbpcd_debug
&(1<<level
))) return;
771 if (msgnum
>99) msgnum
=0;
772 sprintf(buf
, MSG_LEVEL
"%s-%d [%02d]: ", major_name
, current_drive
- D_S
, msgnum
);
774 vsprintf(&buf
[18], fmt
, args
);
778 sbp_sleep(KLOGD_PAUSE
); /* else messages get lost */
779 #endif /* KLOGD_PAUSE */
782 /*==========================================================================*/
784 * DDI interface: runtime trace bit pattern maintenance
786 static int sbpcd_dbg_ioctl(unsigned long arg
, int level
)
791 sbpcd_debug
= DBG_INF
;
795 if (arg
>=128) sbpcd_debug
&= ~(1<<(arg
-128));
796 else sbpcd_debug
|= (1<<arg
);
800 /*==========================================================================*/
801 static void mark_timeout_delay(u_long i
)
805 msg(DBG_TIM
,"delay timer expired.\n");
808 /*==========================================================================*/
809 static void mark_timeout_data(u_long i
)
813 msg(DBG_TIM
,"data timer expired.\n");
816 /*==========================================================================*/
818 static void mark_timeout_audio(u_long i
)
822 msg(DBG_TIM
,"audio timer expired.\n");
826 /*==========================================================================*/
828 * Wait a little while (used for polling the drive).
830 static void sbp_sleep(u_int time
)
833 current
->state
= TASK_INTERRUPTIBLE
;
834 schedule_timeout(time
);
837 /*==========================================================================*/
838 #define RETURN_UP(rc) {up(&ioctl_read_sem); return(rc);}
839 /*==========================================================================*/
841 * convert logical_block_address to m-s-f_number (3 bytes only)
843 static INLINE
void lba2msf(int lba
, u_char
*msf
)
845 lba
+= CD_MSF_OFFSET
;
846 msf
[0] = lba
/ (CD_SECS
*CD_FRAMES
);
847 lba
%= CD_SECS
*CD_FRAMES
;
848 msf
[1] = lba
/ CD_FRAMES
;
849 msf
[2] = lba
% CD_FRAMES
;
851 /*==========================================================================*/
852 /*==========================================================================*/
854 * convert msf-bin to msf-bcd
856 static INLINE
void bin2bcdx(u_char
*p
) /* must work only up to 75 or 99 */
858 *p
=((*p
/10)<<4)|(*p
%10);
860 /*==========================================================================*/
861 static INLINE u_int
blk2msf(u_int blk
)
867 msf
.c
[2] = (blk
+ CD_MSF_OFFSET
) / (CD_SECS
* CD_FRAMES
);
868 mm
= (blk
+ CD_MSF_OFFSET
) % (CD_SECS
* CD_FRAMES
);
869 msf
.c
[1] = mm
/ CD_FRAMES
;
870 msf
.c
[0] = mm
% CD_FRAMES
;
873 /*==========================================================================*/
874 static INLINE u_int
make16(u_char rh
, u_char rl
)
878 /*==========================================================================*/
879 static INLINE u_int
make32(u_int rh
, u_int rl
)
881 return ((rh
<<16)|rl
);
883 /*==========================================================================*/
884 static INLINE u_char
swap_nibbles(u_char i
)
886 return ((i
<<4)|(i
>>4));
888 /*==========================================================================*/
889 static INLINE u_char
byt2bcd(u_char i
)
891 return (((i
/10)<<4)+i
%10);
893 /*==========================================================================*/
894 static INLINE u_char
bcd2bin(u_char bcd
)
896 return ((bcd
>>4)*10+(bcd
&0x0F));
898 /*==========================================================================*/
899 static INLINE
int msf2blk(int msfx
)
905 i
=(msf
.c
[2] * CD_SECS
+ msf
.c
[1]) * CD_FRAMES
+ msf
.c
[0] - CD_MSF_OFFSET
;
909 /*==========================================================================*/
911 * convert m-s-f_number (3 bytes only) to logical_block_address
913 static INLINE
int msf2lba(u_char
*msf
)
917 i
=(msf
[0] * CD_SECS
+ msf
[1]) * CD_FRAMES
+ msf
[2] - CD_MSF_OFFSET
;
921 /*==========================================================================*/
922 /* evaluate cc_ReadError code */
923 static int sta2err(int sta
)
927 if (sta
==0x00) return (0);
928 if (sta
==0x01) return (-604); /* CRC error */
929 if (sta
==0x02) return (-602); /* drive not ready */
930 if (sta
==0x03) return (-607); /* unknown media */
931 if (sta
==0x04) return (-612); /* general failure */
932 if (sta
==0x05) return (0);
933 if (sta
==0x06) return (-ERR_DISKCHANGE
); /* disk change */
934 if (sta
==0x0b) return (-612); /* general failure */
935 if (sta
==0xff) return (-612); /* general failure */
940 if (sta
<=2) return (sta
);
941 if (sta
==0x05) return (-604); /* CRC error */
942 if (sta
==0x06) return (-606); /* seek error */
943 if (sta
==0x0d) return (-606); /* seek error */
944 if (sta
==0x0e) return (-603); /* unknown command */
945 if (sta
==0x14) return (-603); /* unknown command */
946 if (sta
==0x0c) return (-611); /* read fault */
947 if (sta
==0x0f) return (-611); /* read fault */
948 if (sta
==0x10) return (-611); /* read fault */
949 if (sta
>=0x16) return (-612); /* general failure */
950 if (sta
==0x11) return (-ERR_DISKCHANGE
); /* disk change (LCS: removed) */
952 if (sta
==0x12) return (-ERR_DISKCHANGE
); /* disk change (inserted) */
953 return (-602); /* drive not ready */
956 /*==========================================================================*/
957 static INLINE
void clr_cmdbuf(void)
961 for (i
=0;i
<10;i
++) drvcmd
[i
]=0;
964 /*==========================================================================*/
965 static void flush_status(void)
970 for (i
=maxtim_data
;i
!=0;i
--) inb(CDi_status
);
972 /*====================================================================*/
974 * CDi status loop for Teac CD-55A (Rob Riggs)
976 * This is needed because for some strange reason
977 * the CD-55A can take a real long time to give a
978 * status response. This seems to happen after we
979 * issue a READ command where a long seek is involved.
981 * I tried to ensure that we get max throughput with
982 * minimal busy waiting. We busy wait at first, then
983 * "switch gears" and start sleeping. We sleep for
984 * longer periods of time the longer we wait.
987 static int CDi_stat_loop_T(void)
990 u_long timeout_1
, timeout_2
, timeout_3
, timeout_4
;
992 timeout_1
= jiffies
+ HZ
/ 50; /* sbp_sleep(0) for a short period */
993 timeout_2
= jiffies
+ HZ
/ 5; /* nap for no more than 200ms */
994 timeout_3
= jiffies
+ 5 * HZ
; /* sleep for up to 5s */
995 timeout_4
= jiffies
+ 45 * HZ
; /* long sleep for up to 45s. */
999 if (!(i
&s_not_data_ready
)) return (i
);
1000 if (!(i
&s_not_result_ready
)) return (i
);
1005 if (time_after(jiffies
, timeout_4
)) gear
++;
1006 msg(DBG_TEA
, "CDi_stat_loop_T: long sleep active.\n");
1010 if (time_after(jiffies
, timeout_3
)) gear
++;
1014 if (time_after(jiffies
, timeout_2
)) gear
++;
1018 if (time_after(jiffies
, timeout_1
)) gear
++;
1023 /*==========================================================================*/
1024 static int CDi_stat_loop(void)
1028 for(timeout
= jiffies
+ 10*HZ
, i
=maxtim_data
; time_before(jiffies
, timeout
); )
1033 if (!(j
&s_not_data_ready
)) return (j
);
1034 if (!(j
&s_not_result_ready
)) return (j
);
1035 if (fam0L_drive
) if (j
&s_attention
) return (j
);
1040 msg(DBG_LCS
,"CDi_stat_loop failed in line %d\n", __LINE__
);
1043 /*==========================================================================*/
1045 /*==========================================================================*/
1046 static int tst_DataReady(void)
1051 if (i
&s_not_data_ready
) return (0);
1054 /*==========================================================================*/
1055 static int tst_ResultReady(void)
1060 if (i
&s_not_result_ready
) return (0);
1063 /*==========================================================================*/
1064 static int tst_Attention(void)
1069 if (i
&s_attention
) return (1);
1072 /*==========================================================================*/
1074 /*==========================================================================*/
1075 static int ResponseInfo(void)
1080 for (i
=0,timeout
=jiffies
+HZ
;i
<response_count
;i
++)
1082 for (j
=maxtim_data
; ; )
1087 if (!(st
&s_not_result_ready
)) break;
1089 if ((j
!=0)||time_after_eq(jiffies
, timeout
)) break;
1093 if (time_after_eq(jiffies
, timeout
)) break;
1094 infobuf
[i
]=inb(CDi_info
);
1097 while (!(inb(CDi_status
)&s_not_result_ready
))
1099 infobuf
[i
++]=inb(CDi_info
);
1102 if (j
>0) msg(DBG_INF
,"ResponseInfo: got %d trailing bytes.\n",j
);
1105 sprintf(&msgbuf
[j
*3]," %02X",infobuf
[j
]);
1107 msg(DBG_CMD
,"ResponseInfo:%s (%d,%d)\n",msgbuf
,response_count
,i
);
1109 if (j
>0) return (-j
);
1112 /*==========================================================================*/
1113 static void EvaluateStatus(int st
)
1115 current_drive
->status_bits
=0;
1116 if (fam1_drive
) current_drive
->status_bits
=st
|p_success
;
1117 else if (fam0_drive
)
1119 if (st
&p_caddin_old
) current_drive
->status_bits
|= p_door_closed
|p_caddy_in
;
1120 if (st
&p_spinning
) current_drive
->status_bits
|= p_spinning
;
1121 if (st
&p_check
) current_drive
->status_bits
|= p_check
;
1122 if (st
&p_success_old
) current_drive
->status_bits
|= p_success
;
1123 if (st
&p_busy_old
) current_drive
->status_bits
|= p_busy_new
;
1124 if (st
&p_disk_ok
) current_drive
->status_bits
|= p_disk_ok
;
1126 else if (famLV_drive
)
1128 current_drive
->status_bits
|= p_success
;
1129 if (st
&p_caddin_old
) current_drive
->status_bits
|= p_disk_ok
|p_caddy_in
;
1130 if (st
&p_spinning
) current_drive
->status_bits
|= p_spinning
;
1131 if (st
&p_check
) current_drive
->status_bits
|= p_check
;
1132 if (st
&p_busy_old
) current_drive
->status_bits
|= p_busy_new
;
1133 if (st
&p_lcs_door_closed
) current_drive
->status_bits
|= p_door_closed
;
1134 if (st
&p_lcs_door_locked
) current_drive
->status_bits
|= p_door_locked
;
1136 else if (fam2_drive
)
1138 current_drive
->status_bits
|= p_success
;
1139 if (st
&p2_check
) current_drive
->status_bits
|= p1_check
;
1140 if (st
&p2_door_closed
) current_drive
->status_bits
|= p1_door_closed
;
1141 if (st
&p2_disk_in
) current_drive
->status_bits
|= p1_disk_in
;
1142 if (st
&p2_busy1
) current_drive
->status_bits
|= p1_busy
;
1143 if (st
&p2_busy2
) current_drive
->status_bits
|= p1_busy
;
1144 if (st
&p2_spinning
) current_drive
->status_bits
|= p1_spinning
;
1145 if (st
&p2_door_locked
) current_drive
->status_bits
|= p1_door_locked
;
1146 if (st
&p2_disk_ok
) current_drive
->status_bits
|= p1_disk_ok
;
1148 else if (famT_drive
)
1150 return; /* still needs to get coded */
1151 current_drive
->status_bits
|= p_success
;
1152 if (st
&p2_check
) current_drive
->status_bits
|= p1_check
;
1153 if (st
&p2_door_closed
) current_drive
->status_bits
|= p1_door_closed
;
1154 if (st
&p2_disk_in
) current_drive
->status_bits
|= p1_disk_in
;
1155 if (st
&p2_busy1
) current_drive
->status_bits
|= p1_busy
;
1156 if (st
&p2_busy2
) current_drive
->status_bits
|= p1_busy
;
1157 if (st
&p2_spinning
) current_drive
->status_bits
|= p1_spinning
;
1158 if (st
&p2_door_locked
) current_drive
->status_bits
|= p1_door_locked
;
1159 if (st
&p2_disk_ok
) current_drive
->status_bits
|= p1_disk_ok
;
1163 /*==========================================================================*/
1164 static int get_state_T(void)
1168 static int cmd_out_T(void);
1171 current_drive
->n_bytes
=1;
1172 drvcmd
[0]=CMDT_STATUS
;
1174 if (i
>=0) i
=infobuf
[0];
1177 msg(DBG_TEA
,"get_state_T error %d\n", i
);
1181 /* 2: closed, disk in */
1182 current_drive
->status_bits
=p1_door_closed
|p1_disk_in
|p1_spinning
|p1_disk_ok
;
1183 else if (current_drive
->error_state
==6)
1185 /* 3: closed, disk in, changed ("06 xx xx") */
1186 current_drive
->status_bits
=p1_door_closed
|p1_disk_in
;
1187 current_drive
->CD_changed
=0xFF;
1188 current_drive
->diskstate_flags
&= ~toc_bit
;
1190 else if ((current_drive
->error_state
!=2)||(current_drive
->b3
!=0x3A)||(current_drive
->b4
==0x00))
1192 /* 1: closed, no disk ("xx yy zz"or "02 3A 00") */
1193 current_drive
->status_bits
=p1_door_closed
;
1194 current_drive
->open_count
=0;
1196 else if (current_drive
->b4
==0x01)
1198 /* 0: open ("02 3A 01") */
1199 current_drive
->status_bits
=0;
1200 current_drive
->open_count
=0;
1204 /* 1: closed, no disk ("02 3A xx") */
1205 current_drive
->status_bits
=p1_door_closed
;
1206 current_drive
->open_count
=0;
1208 return (current_drive
->status_bits
);
1210 /*==========================================================================*/
1211 static int ResponseStatus(void)
1216 msg(DBG_STA
,"doing ResponseStatus...\n");
1217 if (famT_drive
) return (get_state_T());
1218 if (flags_cmd_out
& f_respo3
) timeout
= jiffies
;
1219 else if (flags_cmd_out
& f_respo2
) timeout
= jiffies
+ 16*HZ
;
1220 else timeout
= jiffies
+ 4*HZ
;
1227 if (!(i
&s_not_result_ready
)) break;
1229 if ((j
!=0)||time_after(jiffies
, timeout
)) break;
1236 if ((flags_cmd_out
& f_respo3
) == 0)
1237 msg(DBG_STA
,"ResponseStatus: timeout.\n");
1238 current_drive
->status_bits
=0;
1242 msg(DBG_STA
,"ResponseStatus: response %02X.\n", i
);
1244 msg(DBG_STA
,"status_bits=%02X, i=%02X\n",current_drive
->status_bits
,i
);
1245 return (current_drive
->status_bits
);
1247 /*==========================================================================*/
1248 static void cc_ReadStatus(void)
1252 msg(DBG_STA
,"giving cc_ReadStatus command\n");
1253 if (famT_drive
) return;
1255 if (fam0LV_drive
) OUT(CDo_command
,CMD0_STATUS
);
1256 else if (fam1_drive
) OUT(CDo_command
,CMD1_STATUS
);
1257 else if (fam2_drive
) OUT(CDo_command
,CMD2_STATUS
);
1258 if (!fam0LV_drive
) for (i
=0;i
<6;i
++) OUT(CDo_command
,0);
1261 /*==========================================================================*/
1262 static int cc_ReadError(void)
1267 msg(DBG_ERR
,"giving cc_ReadError command.\n");
1270 drvcmd
[0]=CMD1_READ_ERR
;
1272 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
1274 else if (fam0LV_drive
)
1276 drvcmd
[0]=CMD0_READ_ERR
;
1279 flags_cmd_out
=f_putcmd
;
1281 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
;
1283 else if (fam2_drive
)
1285 drvcmd
[0]=CMD2_READ_ERR
;
1287 flags_cmd_out
=f_putcmd
;
1289 else if (famT_drive
)
1292 drvcmd
[0]=CMDT_READ_ERR
;
1295 current_drive
->error_byte
=0;
1296 msg(DBG_ERR
,"cc_ReadError: cmd_out(CMDx_READ_ERR) returns %d (%02X)\n",i
,i
);
1297 if (i
<0) return (i
);
1298 if (fam0V_drive
) i
=1;
1300 current_drive
->error_byte
=infobuf
[i
];
1301 msg(DBG_ERR
,"cc_ReadError: infobuf[%d] is %d (%02X)\n",i
,current_drive
->error_byte
,current_drive
->error_byte
);
1302 i
=sta2err(infobuf
[i
]);
1303 if (i
==-ERR_DISKCHANGE
)
1305 current_drive
->CD_changed
=0xFF;
1306 current_drive
->diskstate_flags
&= ~toc_bit
;
1310 /*==========================================================================*/
1311 static int cmd_out_T(void)
1314 #define CMDT_TRIES 1000
1315 #define TEST_FALSE_FF 1
1317 static int cc_DriveReset(void);
1318 int i
, j
, l
=0, m
, ntries
;
1319 unsigned long flags
;
1321 current_drive
->error_state
=0;
1322 current_drive
->b3
=0;
1323 current_drive
->b4
=0;
1324 current_drive
->f_drv_error
=0;
1325 for (i
=0;i
<10;i
++) sprintf(&msgbuf
[i
*3]," %02X",drvcmd
[i
]);
1327 msg(DBG_CMD
,"cmd_out_T:%s\n",msgbuf
);
1330 OUT(CDo_enable
,current_drive
->drv_sel
);
1333 if ((f_16bit
)&&(!(i
&0x80)))
1336 msg(DBG_TEA
,"cmd_out_T: do_16bit set.\n");
1338 if (!(i
&s_not_result_ready
))
1344 msg(DBG_TEA
,"cmd_out_T: spurious !s_not_result_ready. (%02X)\n", j
);
1346 while (!(i
&s_not_result_ready
));
1347 save_flags(flags
); cli();
1348 for (i
=0;i
<10;i
++) OUT(CDo_command
,drvcmd
[i
]);
1349 restore_flags(flags
);
1350 for (ntries
=CMDT_TRIES
;ntries
>0;ntries
--)
1352 if (drvcmd
[0]==CMDT_READ_VER
) sbp_sleep(HZ
); /* fixme */
1358 if ((i
=CDi_stat_loop_T()) == -1) break;
1367 if (!(i
&s_not_data_ready
)) /* f.e. CMDT_DISKINFO */
1370 if (drvcmd
[0]==CMDT_READ
) return (0); /* handled elsewhere */
1371 if (drvcmd
[0]==CMDT_DISKINFO
)
1379 infobuf
[l
++]=i
&0x0ff;
1382 if ((l
==2)&&(infobuf
[0]==0x0ff))
1384 infobuf
[0]=infobuf
[1];
1386 msg(DBG_TEA
,"cmd_out_T: do_16bit: false first byte!\n");
1388 #endif /* TEST_FALSE_FF */
1390 else infobuf
[l
++]=inb(CDi_data
);
1393 while (!(i
&s_not_data_ready
));
1394 for (j
=0;j
<l
;j
++) sprintf(&msgbuf
[j
*3]," %02X",infobuf
[j
]);
1396 msg(DBG_CMD
,"cmd_out_T data response:%s\n", msgbuf
);
1400 msg(DBG_TEA
,"cmd_out_T: data response with cmd_%02X!\n",
1405 if (do_16bit
) i
=inw(CDi_data
);
1406 else i
=inb(CDi_data
);
1410 while (!(i
&s_not_data_ready
));
1411 msg(DBG_TEA
,"cmd_out_T: data response: discarded %d bytes/words.\n", j
);
1416 if (!(i
&s_not_result_ready
))
1419 if (drvcmd
[0]==CMDT_DISKINFO
) m
=l
;
1423 infobuf
[m
++]=inb(CDi_info
);
1426 while (!(i
&s_not_result_ready
));
1427 for (j
=0;j
<m
;j
++) sprintf(&msgbuf
[j
*3]," %02X",infobuf
[j
]);
1429 msg(DBG_CMD
,"cmd_out_T info response:%s\n", msgbuf
);
1430 if (drvcmd
[0]==CMDT_DISKINFO
)
1432 infobuf
[0]=infobuf
[l
];
1433 if (infobuf
[0]!=0x02) return (l
); /* data length */
1435 else if (infobuf
[0]!=0x02) return (m
); /* info length */
1439 if (recursion
>1) msg(DBG_TEA
,"cmd_out_T READ_ERR recursion (%02X): %d !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!\n", drvcmd
[0], recursion
);
1441 drvcmd
[0]=CMDT_READ_ERR
;
1442 j
=cmd_out_T(); /* !!! recursive here !!! */
1447 current_drive
->error_state
=infobuf
[2];
1448 current_drive
->b3
=infobuf
[3];
1449 current_drive
->b4
=infobuf
[4];
1450 if (current_drive
->f_drv_error
)
1452 current_drive
->f_drv_error
=0;
1454 current_drive
->error_state
=2;
1456 return (-current_drive
->error_state
-400);
1458 if (drvcmd
[0]==CMDT_READ
) return (0); /* handled elsewhere */
1459 if ((teac
==0)||(ntries
<(CMDT_TRIES
-5))) sbp_sleep(HZ
/10);
1460 else sbp_sleep(HZ
/100);
1461 if (ntries
>(CMDT_TRIES
-50)) continue;
1462 msg(DBG_TEA
,"cmd_out_T: next CMDT_TRIES (%02X): %d.\n", drvcmd
[0], ntries
-1);
1464 current_drive
->f_drv_error
=1;
1466 current_drive
->error_state
=2;
1469 /*==========================================================================*/
1470 static int cmd_out(void)
1474 if (famT_drive
) return(cmd_out_T());
1476 if (flags_cmd_out
&f_putcmd
)
1478 unsigned long flags
;
1480 sprintf(&msgbuf
[i
*3], " %02X", drvcmd
[i
]);
1482 msg(DBG_CMD
,"cmd_out:%s\n", msgbuf
);
1483 save_flags(flags
); cli();
1484 for (i
=0;i
<7;i
++) OUT(CDo_command
,drvcmd
[i
]);
1485 restore_flags(flags
);
1487 if (response_count
!=0)
1491 if (sbpro_type
==1) OUT(CDo_sel_i_d
,1);
1492 msg(DBG_INF
,"misleaded to try ResponseData.\n");
1493 if (sbpro_type
==1) OUT(CDo_sel_i_d
,0);
1496 else i
=ResponseInfo();
1497 if (i
<0) return (i
);
1499 if (current_drive
->in_SpinUp
) msg(DBG_SPI
,"in_SpinUp: to CDi_stat_loop.\n");
1500 if (flags_cmd_out
&f_lopsta
)
1503 if ((i
<0)||!(i
&s_attention
)) return (-8);
1505 if (!(flags_cmd_out
&f_getsta
)) goto LOC_229
;
1508 if (current_drive
->in_SpinUp
) msg(DBG_SPI
,"in_SpinUp: to cc_ReadStatus.\n");
1512 if (flags_cmd_out
&f_ResponseStatus
)
1514 if (current_drive
->in_SpinUp
) msg(DBG_SPI
,"in_SpinUp: to ResponseStatus.\n");
1516 /* builds status_bits, returns orig. status or p_busy_new */
1517 if (i
<0) return (i
);
1518 if (flags_cmd_out
&(f_bit1
|f_wait_if_busy
))
1522 if ((flags_cmd_out
&f_bit1
)&&(i
&p_success
)) goto LOC_232
;
1523 if ((!(flags_cmd_out
&f_wait_if_busy
))||(!st_busy
)) goto LOC_228
;
1528 if (!(flags_cmd_out
&f_obey_p_check
)) return (0);
1529 if (!st_check
) return (0);
1530 if (current_drive
->in_SpinUp
) msg(DBG_SPI
,"in_SpinUp: to cc_ReadError.\n");
1532 if (current_drive
->in_SpinUp
) msg(DBG_SPI
,"in_SpinUp: to cmd_out OK.\n");
1533 msg(DBG_000
,"cmd_out: cc_ReadError=%d\n", i
);
1536 /*==========================================================================*/
1537 static int cc_Seek(u_int pos
, char f_blk_msf
)
1542 if (f_blk_msf
>1) return (-3);
1545 drvcmd
[0]=CMD0_SEEK
;
1546 if (f_blk_msf
==1) pos
=msf2blk(pos
);
1547 drvcmd
[2]=(pos
>>16)&0x00FF;
1548 drvcmd
[3]=(pos
>>8)&0x00FF;
1549 drvcmd
[4]=pos
&0x00FF;
1551 flags_cmd_out
= f_putcmd
| f_respo2
| f_lopsta
| f_getsta
|
1552 f_ResponseStatus
| f_obey_p_check
| f_bit1
;
1554 flags_cmd_out
= f_putcmd
;
1556 else if (fam1L_drive
)
1558 drvcmd
[0]=CMD1_SEEK
; /* same as CMD1_ and CMDL_ */
1559 if (f_blk_msf
==0) pos
=blk2msf(pos
);
1560 drvcmd
[1]=(pos
>>16)&0x00FF;
1561 drvcmd
[2]=(pos
>>8)&0x00FF;
1562 drvcmd
[3]=pos
&0x00FF;
1564 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
|f_bit1
;
1566 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
1568 else if (fam2_drive
)
1570 drvcmd
[0]=CMD2_SEEK
;
1571 if (f_blk_msf
==0) pos
=blk2msf(pos
);
1572 drvcmd
[2]=(pos
>>24)&0x00FF;
1573 drvcmd
[3]=(pos
>>16)&0x00FF;
1574 drvcmd
[4]=(pos
>>8)&0x00FF;
1575 drvcmd
[5]=pos
&0x00FF;
1576 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
1578 else if (famT_drive
)
1580 drvcmd
[0]=CMDT_SEEK
;
1581 if (f_blk_msf
==1) pos
=msf2blk(pos
);
1582 drvcmd
[2]=(pos
>>24)&0x00FF;
1583 drvcmd
[3]=(pos
>>16)&0x00FF;
1584 drvcmd
[4]=(pos
>>8)&0x00FF;
1585 drvcmd
[5]=pos
&0x00FF;
1586 current_drive
->n_bytes
=1;
1592 /*==========================================================================*/
1593 static int cc_SpinUp(void)
1597 msg(DBG_SPI
,"SpinUp.\n");
1598 current_drive
->in_SpinUp
= 1;
1602 drvcmd
[0]=CMD0_SPINUP
;
1604 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|
1605 f_ResponseStatus
|f_obey_p_check
|f_bit1
;
1607 flags_cmd_out
=f_putcmd
;
1609 else if (fam1_drive
)
1611 drvcmd
[0]=CMD1_SPINUP
;
1612 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
1614 else if (fam2_drive
)
1616 drvcmd
[0]=CMD2_TRAY_CTL
;
1617 drvcmd
[4]=0x01; /* "spinup" */
1618 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
1620 else if (famT_drive
)
1622 drvcmd
[0]=CMDT_TRAY_CTL
;
1623 drvcmd
[4]=0x03; /* "insert", it hopefully spins the drive up */
1627 current_drive
->in_SpinUp
= 0;
1630 /*==========================================================================*/
1631 static int cc_SpinDown(void)
1635 if (fam0_drive
) return (0);
1640 drvcmd
[0]=CMD1_SPINDOWN
;
1641 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
1643 else if (fam2_drive
)
1645 drvcmd
[0]=CMD2_TRAY_CTL
;
1646 drvcmd
[4]=0x02; /* "eject" */
1647 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
1649 else if (famL_drive
)
1651 drvcmd
[0]=CMDL_SPINDOWN
;
1653 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
|f_bit1
;
1655 else if (famV_drive
)
1657 drvcmd
[0]=CMDV_SPINDOWN
;
1658 flags_cmd_out
=f_putcmd
;
1660 else if (famT_drive
)
1662 drvcmd
[0]=CMDT_TRAY_CTL
;
1663 drvcmd
[4]=0x02; /* "eject" */
1668 /*==========================================================================*/
1669 static int cc_get_mode_T(void)
1675 drvcmd
[0]=CMDT_GETMODE
;
1676 drvcmd
[4]=response_count
;
1680 /*==========================================================================*/
1681 static int cc_set_mode_T(void)
1687 drvcmd
[0]=CMDT_SETMODE
;
1688 drvcmd
[1]=current_drive
->speed_byte
;
1689 drvcmd
[2]=current_drive
->frmsiz
>>8;
1690 drvcmd
[3]=current_drive
->frmsiz
&0x0FF;
1691 drvcmd
[4]=current_drive
->f_XA
; /* 1: XA */
1692 drvcmd
[5]=current_drive
->type_byte
; /* 0, 1, 3 */
1693 drvcmd
[6]=current_drive
->mode_xb_6
;
1694 drvcmd
[7]=current_drive
->mode_yb_7
|current_drive
->volume_control
;
1695 drvcmd
[8]=current_drive
->mode_xb_8
;
1696 drvcmd
[9]=current_drive
->delay
;
1700 /*==========================================================================*/
1701 static int cc_prep_mode_T(void)
1706 if (i
<0) return (i
);
1708 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
1710 msg(DBG_TEA
,"CMDT_GETMODE:%s\n", msgbuf
);
1711 current_drive
->speed_byte
=0x02; /* 0x02: auto quad, 0x82: quad, 0x81: double, 0x80: single */
1712 current_drive
->frmsiz
=make16(infobuf
[2],infobuf
[3]);
1713 current_drive
->f_XA
=infobuf
[4];
1714 if (current_drive
->f_XA
==0) current_drive
->type_byte
=0;
1715 else current_drive
->type_byte
=1;
1716 current_drive
->mode_xb_6
=infobuf
[6];
1717 current_drive
->mode_yb_7
=1;
1718 current_drive
->mode_xb_8
=infobuf
[8];
1719 current_drive
->delay
=0; /* 0, 1, 2, 3 */
1723 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
1725 msg(DBG_TEA
,"CMDT_GETMODE:%s\n", msgbuf
);
1728 /*==========================================================================*/
1729 static int cc_SetSpeed(u_char speed
, u_char x1
, u_char x2
)
1733 if (fam0LV_drive
) return (0);
1738 drvcmd
[0]=CMD1_SETMODE
;
1743 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
1745 else if (fam2_drive
)
1747 drvcmd
[0]=CMD2_SETSPEED
;
1748 if (speed
&speed_auto
)
1758 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
1760 else if (famT_drive
)
1767 /*==========================================================================*/
1768 static int cc_SetVolume(void)
1771 u_char channel0
,channel1
,volume0
,volume1
;
1772 u_char control0
,value0
,control1
,value1
;
1774 current_drive
->diskstate_flags
&= ~volume_bit
;
1776 channel0
=current_drive
->vol_chan0
;
1777 volume0
=current_drive
->vol_ctrl0
;
1778 channel1
=control1
=current_drive
->vol_chan1
;
1779 volume1
=value1
=current_drive
->vol_ctrl1
;
1782 if (famV_drive
) return (0);
1784 if (((current_drive
->drv_options
&audio_mono
)!=0)&&(current_drive
->drv_type
>=drv_211
))
1786 if ((volume0
!=0)&&(volume1
==0))
1791 else if ((volume0
==0)&&(volume1
!=0))
1810 control0
=channel0
+1;
1811 control1
=channel1
+1;
1812 value0
=(volume0
>volume1
)?volume0
:volume1
;
1814 if (volume0
==0) control0
=0;
1815 if (volume1
==0) control1
=0;
1816 drvcmd
[0]=CMD1_SETMODE
;
1822 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
1824 else if (fam2_drive
)
1826 control0
=channel0
+1;
1827 control1
=channel1
+1;
1828 value0
=(volume0
>volume1
)?volume0
:volume1
;
1830 if (volume0
==0) control0
=0;
1831 if (volume1
==0) control1
=0;
1832 drvcmd
[0]=CMD2_SETMODE
;
1838 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
1840 else if (famL_drive
)
1842 if ((volume0
==0)||(channel0
!=0)) control0
|= 0x80;
1843 if ((volume1
==0)||(channel1
!=1)) control0
|= 0x40;
1844 if (volume0
|volume1
) value0
=0x80;
1845 drvcmd
[0]=CMDL_SETMODE
;
1849 flags_cmd_out
=f_putcmd
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
|f_bit1
;
1851 else if (fam0_drive
) /* different firmware levels */
1853 if (current_drive
->drv_type
>=drv_300
)
1855 control0
=volume0
&0xFC;
1856 value0
=volume1
&0xFC;
1857 if ((volume0
!=0)&&(volume0
<4)) control0
|= 0x04;
1858 if ((volume1
!=0)&&(volume1
<4)) value0
|= 0x04;
1859 if (channel0
!=0) control0
|= 0x01;
1860 if (channel1
==1) value0
|= 0x01;
1864 value0
=(volume0
>volume1
)?volume0
:volume1
;
1865 if (current_drive
->drv_type
<drv_211
)
1876 if (channel0
==channel1
)
1893 if ((volume0
!=0)&&(volume1
!=0))
1895 if (volume0
==0xFF) volume1
=0xFF;
1896 else if (volume1
==0xFF) volume0
=0xFF;
1898 else if (current_drive
->drv_type
<drv_201
) volume0
=volume1
=value0
;
1900 if (current_drive
->drv_type
>=drv_201
)
1902 if (volume0
==0) control0
|= 0x80;
1903 if (volume1
==0) control0
|= 0x40;
1905 if (current_drive
->drv_type
>=drv_211
)
1907 if (channel0
!=0) control0
|= 0x20;
1908 if (channel1
!=1) control0
|= 0x10;
1911 drvcmd
[0]=CMD0_SETMODE
;
1915 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
1917 else if (famT_drive
)
1919 current_drive
->volume_control
=0;
1920 if (!volume0
) current_drive
->volume_control
|=0x10;
1921 if (!volume1
) current_drive
->volume_control
|=0x20;
1923 if (i
<0) return (i
);
1929 if (i
<0) return (i
);
1931 current_drive
->diskstate_flags
|= volume_bit
;
1934 /*==========================================================================*/
1935 static int GetStatus(void)
1939 if (famT_drive
) return (0);
1940 flags_cmd_out
=f_getsta
|f_ResponseStatus
|f_obey_p_check
;
1946 /*==========================================================================*/
1947 static int cc_DriveReset(void)
1951 msg(DBG_RES
,"cc_DriveReset called.\n");
1954 if (fam0LV_drive
) OUT(CDo_reset
,0x00);
1955 else if (fam1_drive
)
1957 drvcmd
[0]=CMD1_RESET
;
1958 flags_cmd_out
=f_putcmd
;
1961 else if (fam2_drive
)
1963 drvcmd
[0]=CMD2_RESET
;
1964 flags_cmd_out
=f_putcmd
;
1966 OUT(CDo_reset
,0x00);
1968 else if (famT_drive
)
1971 OUT(CDo_enable
,current_drive
->drv_sel
);
1972 OUT(CDo_command
,CMDT_RESET
);
1973 for (i
=1;i
<10;i
++) OUT(CDo_command
,0);
1975 if (fam0LV_drive
) sbp_sleep(5*HZ
); /* wait 5 seconds */
1976 else sbp_sleep(1*HZ
); /* wait a second */
1980 msg(DBG_TEA
, "================CMDT_RESET given=================.\n");
1988 if (current_drive
->error_byte
!=aud_12
) return -501;
1992 /*==========================================================================*/
1993 static int SetSpeed(void)
1997 if (!(current_drive
->drv_options
&(speed_auto
|speed_300
|speed_150
))) return (0);
1999 if (!(current_drive
->drv_options
&speed_auto
))
2002 if (!(current_drive
->drv_options
&speed_300
)) speed
=0;
2004 i
=cc_SetSpeed(speed
,0,0);
2008 static void switch_drive(struct sbpcd_drive
*);
2010 static int sbpcd_select_speed(struct cdrom_device_info
*cdi
, int speed
)
2012 struct sbpcd_drive
*p
= cdi
->handle
;
2013 if (p
!= current_drive
)
2016 return cc_SetSpeed(speed
== 2 ? speed_300
: speed_150
, 0, 0);
2019 /*==========================================================================*/
2020 static int DriveReset(void)
2025 if (i
<0) return (-22);
2029 if ((i
<0)&&(i
!=-ERR_DISKCHANGE
)) {
2030 return (-2); /* from sta2err */
2032 if (!st_caddy_in
) break;
2037 current_drive
->CD_changed
=1;
2039 if ((st_door_closed
) && (st_caddy_in
))
2042 if (i
<0) return (-23);
2047 static int sbpcd_reset(struct cdrom_device_info
*cdi
)
2049 struct sbpcd_drive
*p
= cdi
->handle
;
2050 if (p
!= current_drive
)
2052 return DriveReset();
2055 /*==========================================================================*/
2056 static int cc_PlayAudio(int pos_audio_start
,int pos_audio_end
)
2060 if (current_drive
->audio_state
==audio_playing
) return (-EINVAL
);
2065 drvcmd
[0]=CMDL_PLAY
;
2066 i
=msf2blk(pos_audio_start
);
2067 n
=msf2blk(pos_audio_end
)+1-i
;
2068 drvcmd
[1]=(i
>>16)&0x00FF;
2069 drvcmd
[2]=(i
>>8)&0x00FF;
2071 drvcmd
[4]=(n
>>16)&0x00FF;
2072 drvcmd
[5]=(n
>>8)&0x00FF;
2075 flags_cmd_out
= f_putcmd
| f_respo2
| f_lopsta
| f_getsta
|
2076 f_ResponseStatus
| f_obey_p_check
| f_wait_if_busy
;
2078 flags_cmd_out
= f_putcmd
;
2085 drvcmd
[0]=CMD1_PLAY_MSF
;
2086 flags_cmd_out
= f_putcmd
| f_respo2
| f_ResponseStatus
|
2087 f_obey_p_check
| f_wait_if_busy
;
2089 else if (fam2_drive
)
2091 drvcmd
[0]=CMD2_PLAY_MSF
;
2092 flags_cmd_out
= f_putcmd
| f_ResponseStatus
| f_obey_p_check
;
2094 else if (famT_drive
)
2096 drvcmd
[0]=CMDT_PLAY_MSF
;
2100 else if (fam0_drive
)
2102 drvcmd
[0]=CMD0_PLAY_MSF
;
2103 flags_cmd_out
= f_putcmd
| f_respo2
| f_lopsta
| f_getsta
|
2104 f_ResponseStatus
| f_obey_p_check
| f_wait_if_busy
;
2106 drvcmd
[j
]=(pos_audio_start
>>16)&0x00FF;
2107 drvcmd
[j
+1]=(pos_audio_start
>>8)&0x00FF;
2108 drvcmd
[j
+2]=pos_audio_start
&0x00FF;
2109 drvcmd
[j
+3]=(pos_audio_end
>>16)&0x00FF;
2110 drvcmd
[j
+4]=(pos_audio_end
>>8)&0x00FF;
2111 drvcmd
[j
+5]=pos_audio_end
&0x00FF;
2116 /*==========================================================================*/
2117 static int cc_Pause_Resume(int pau_res
)
2125 drvcmd
[0]=CMD1_PAU_RES
;
2126 if (pau_res
!=1) drvcmd
[1]=0x80;
2127 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
2129 else if (fam2_drive
)
2131 drvcmd
[0]=CMD2_PAU_RES
;
2132 if (pau_res
!=1) drvcmd
[2]=0x01;
2133 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
2135 else if (fam0LV_drive
)
2137 drvcmd
[0]=CMD0_PAU_RES
;
2138 if (pau_res
!=1) drvcmd
[1]=0x80;
2140 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|f_ResponseStatus
|
2141 f_obey_p_check
|f_bit1
;
2142 else if (famV_drive
)
2143 flags_cmd_out
=f_putcmd
;
2145 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|f_ResponseStatus
|
2148 else if (famT_drive
)
2150 if (pau_res
==3) return (cc_PlayAudio(current_drive
->pos_audio_start
,current_drive
->pos_audio_end
));
2151 else if (pau_res
==1) drvcmd
[0]=CMDT_PAUSE
;
2157 /*==========================================================================*/
2158 static int cc_LockDoor(char lock
)
2162 if (fam0_drive
) return (0);
2163 msg(DBG_LCK
,"cc_LockDoor: %d (drive %d)\n", lock
, current_drive
- D_S
);
2164 msg(DBG_LCS
,"p_door_locked bit %d before\n", st_door_locked
);
2169 drvcmd
[0]=CMD1_LOCK_CTL
;
2170 if (lock
==1) drvcmd
[1]=0x01;
2171 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2173 else if (fam2_drive
)
2175 drvcmd
[0]=CMD2_LOCK_CTL
;
2176 if (lock
==1) drvcmd
[4]=0x01;
2177 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
2179 else if (famLV_drive
)
2181 drvcmd
[0]=CMDL_LOCK_CTL
;
2182 if (lock
==1) drvcmd
[1]=0x01;
2184 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
|f_bit1
;
2186 flags_cmd_out
=f_putcmd
;
2188 else if (famT_drive
)
2190 drvcmd
[0]=CMDT_LOCK_CTL
;
2191 if (lock
==1) drvcmd
[4]=0x01;
2194 msg(DBG_LCS
,"p_door_locked bit %d after\n", st_door_locked
);
2197 /*==========================================================================*/
2198 /*==========================================================================*/
2199 static int UnLockDoor(void)
2218 /*==========================================================================*/
2219 static int LockDoor(void)
2246 static int sbpcd_lock_door(struct cdrom_device_info
*cdi
, int lock
)
2248 return lock
? LockDoor() : UnLockDoor();
2251 /*==========================================================================*/
2252 static int cc_CloseTray(void)
2256 if (fam0_drive
) return (0);
2257 msg(DBG_LCK
,"cc_CloseTray (drive %d)\n", current_drive
- D_S
);
2258 msg(DBG_LCS
,"p_door_closed bit %d before\n", st_door_closed
);
2264 drvcmd
[0]=CMD1_TRAY_CTL
;
2265 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
2267 else if (fam2_drive
)
2269 drvcmd
[0]=CMD2_TRAY_CTL
;
2271 drvcmd
[4]=0x03; /* "insert" */
2272 flags_cmd_out
=f_putcmd
|f_ResponseStatus
;
2274 else if (famLV_drive
)
2276 drvcmd
[0]=CMDL_TRAY_CTL
;
2278 flags_cmd_out
=f_putcmd
|f_respo2
|f_lopsta
|f_getsta
|
2279 f_ResponseStatus
|f_obey_p_check
|f_bit1
;
2281 flags_cmd_out
=f_putcmd
;
2283 else if (famT_drive
)
2285 drvcmd
[0]=CMDT_TRAY_CTL
;
2286 drvcmd
[4]=0x03; /* "insert" */
2289 msg(DBG_LCS
,"p_door_closed bit %d after\n", st_door_closed
);
2292 flags_cmd_out
|= f_respo2
;
2293 cc_ReadStatus(); /* command: give 1-byte status */
2295 if (famT_drive
&&(i
<0))
2306 msg(DBG_INF
,"sbpcd cc_CloseTray: ResponseStatus timed out (%d).\n",i
);
2313 if (st_check
) i
=cc_ReadError();
2314 flags_cmd_out
|= f_respo2
;
2324 static int sbpcd_tray_move(struct cdrom_device_info
*cdi
, int position
)
2327 switch_drive(cdi
->handle
);
2329 if(current_drive
->CD_changed
!= 0xFF) {
2330 current_drive
->CD_changed
=0xFF;
2331 current_drive
->diskstate_flags
&= ~cd_size_bit
;
2333 if (position
== 1) {
2336 retval
=cc_CloseTray();
2341 /*==========================================================================*/
2342 static int cc_ReadSubQ(void)
2346 current_drive
->diskstate_flags
&= ~subq_bit
;
2352 drvcmd
[0]=CMD1_READSUBQ
;
2353 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2356 else if (fam2_drive
)
2358 drvcmd
[0]=CMD2_READSUBQ
;
2361 flags_cmd_out
=f_putcmd
;
2364 else if (fam0LV_drive
)
2366 drvcmd
[0]=CMD0_READSUBQ
;
2369 flags_cmd_out
=f_putcmd
;
2371 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2374 else if (famT_drive
)
2377 drvcmd
[0]=CMDT_READSUBQ
;
2381 drvcmd
[8]=response_count
;
2384 if (i
<0) return (i
);
2385 for (i
=0;i
<response_count
;i
++)
2387 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
2389 msg(DBG_SQ1
,"cc_ReadSubQ:%s\n", msgbuf
);
2391 if (famT_drive
) break;
2392 if (infobuf
[0]!=0) break;
2393 if ((!st_spinning
) || (j
==1))
2395 current_drive
->SubQ_ctl_adr
=current_drive
->SubQ_trk
=current_drive
->SubQ_pnt_idx
=current_drive
->SubQ_whatisthis
=0;
2396 current_drive
->SubQ_run_tot
=current_drive
->SubQ_run_trk
=0;
2400 if (famT_drive
) current_drive
->SubQ_ctl_adr
=infobuf
[1];
2401 else current_drive
->SubQ_ctl_adr
=swap_nibbles(infobuf
[1]);
2402 current_drive
->SubQ_trk
=byt2bcd(infobuf
[2]);
2403 current_drive
->SubQ_pnt_idx
=byt2bcd(infobuf
[3]);
2404 if (fam0LV_drive
) i
=5;
2405 else if (fam12_drive
) i
=4;
2406 else if (famT_drive
) i
=8;
2407 current_drive
->SubQ_run_tot
=make32(make16(0,infobuf
[i
]),make16(infobuf
[i
+1],infobuf
[i
+2])); /* msf-bin */
2409 if (fam0LV_drive
) i
=9;
2410 else if (fam12_drive
) i
=7;
2411 else if (famT_drive
) i
=4;
2412 current_drive
->SubQ_run_trk
=make32(make16(0,infobuf
[i
]),make16(infobuf
[i
+1],infobuf
[i
+2])); /* msf-bin */
2413 current_drive
->SubQ_whatisthis
=infobuf
[i
+3];
2414 current_drive
->diskstate_flags
|= subq_bit
;
2417 /*==========================================================================*/
2418 static int cc_ModeSense(void)
2422 if (fam2_drive
) return (0);
2423 if (famV_drive
) return (0);
2424 current_drive
->diskstate_flags
&= ~frame_size_bit
;
2429 drvcmd
[0]=CMD1_GETMODE
;
2430 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2432 else if (fam0L_drive
)
2435 drvcmd
[0]=CMD0_GETMODE
;
2436 if (famL_drive
) flags_cmd_out
=f_putcmd
;
2437 else flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2439 else if (famT_drive
)
2442 drvcmd
[0]=CMDT_GETMODE
;
2443 drvcmd
[4]=response_count
;
2446 if (i
<0) return (i
);
2448 current_drive
->sense_byte
=0;
2449 if (fam1_drive
) current_drive
->sense_byte
=infobuf
[i
++];
2450 else if (famT_drive
)
2452 if (infobuf
[4]==0x01) current_drive
->xa_byte
=0x20;
2453 else current_drive
->xa_byte
=0;
2456 current_drive
->frame_size
=make16(infobuf
[i
],infobuf
[i
+1]);
2457 for (i
=0;i
<response_count
;i
++)
2458 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
2460 msg(DBG_XA1
,"cc_ModeSense:%s\n", msgbuf
);
2462 current_drive
->diskstate_flags
|= frame_size_bit
;
2465 /*==========================================================================*/
2466 /*==========================================================================*/
2467 static int cc_ModeSelect(int framesize
)
2471 if (fam2_drive
) return (0);
2472 if (famV_drive
) return (0);
2473 current_drive
->diskstate_flags
&= ~frame_size_bit
;
2475 current_drive
->frame_size
=framesize
;
2476 if (framesize
==CD_FRAMESIZE_RAW
) current_drive
->sense_byte
=0x82;
2477 else current_drive
->sense_byte
=0x00;
2479 msg(DBG_XA1
,"cc_ModeSelect: %02X %04X\n",
2480 current_drive
->sense_byte
, current_drive
->frame_size
);
2484 drvcmd
[0]=CMD1_SETMODE
;
2486 drvcmd
[2]=current_drive
->sense_byte
;
2487 drvcmd
[3]=(current_drive
->frame_size
>>8)&0xFF;
2488 drvcmd
[4]=current_drive
->frame_size
&0xFF;
2489 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2491 else if (fam0L_drive
)
2493 drvcmd
[0]=CMD0_SETMODE
;
2495 drvcmd
[2]=(current_drive
->frame_size
>>8)&0xFF;
2496 drvcmd
[3]=current_drive
->frame_size
&0xFF;
2499 flags_cmd_out
=f_putcmd
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2501 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2503 else if (famT_drive
)
2509 if (i
<0) return (i
);
2510 current_drive
->diskstate_flags
|= frame_size_bit
;
2513 /*==========================================================================*/
2514 static int cc_GetVolume(void)
2523 if (famV_drive
) return (0);
2524 current_drive
->diskstate_flags
&= ~volume_bit
;
2528 drvcmd
[0]=CMD1_GETMODE
;
2531 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2533 else if (fam2_drive
)
2535 drvcmd
[0]=CMD2_GETMODE
;
2538 flags_cmd_out
=f_putcmd
;
2540 else if (fam0L_drive
)
2542 drvcmd
[0]=CMD0_GETMODE
;
2546 flags_cmd_out
=f_putcmd
;
2548 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2550 else if (famT_drive
)
2553 if (i
<0) return (i
);
2558 if (i
<0) return (i
);
2562 chan0
=infobuf
[1]&0x0F;
2564 chan1
=infobuf
[3]&0x0F;
2579 else if (fam2_drive
)
2586 else if (famL_drive
)
2590 vol0
=vol1
=infobuf
[1];
2591 switches
=infobuf
[0];
2592 if ((switches
&0x80)!=0) chan0
=1;
2593 if ((switches
&0x40)!=0) chan1
=0;
2595 else if (fam0_drive
) /* different firmware levels */
2599 vol0
=vol1
=infobuf
[1];
2600 if (current_drive
->drv_type
>=drv_201
)
2602 if (current_drive
->drv_type
<drv_300
)
2604 switches
=infobuf
[0];
2605 if ((switches
&0x80)!=0) vol0
=0;
2606 if ((switches
&0x40)!=0) vol1
=0;
2607 if (current_drive
->drv_type
>=drv_211
)
2609 if ((switches
&0x20)!=0) chan0
=1;
2610 if ((switches
&0x10)!=0) chan1
=0;
2616 if ((vol0
&0x01)!=0) chan0
=1;
2617 if ((vol1
&0x01)==0) chan1
=0;
2620 if (vol0
!=0) vol0
+= 3;
2621 if (vol1
!=0) vol1
+= 3;
2625 else if (famT_drive
)
2627 current_drive
->volume_control
=infobuf
[7];
2630 if (current_drive
->volume_control
&0x10) vol0
=0;
2632 if (current_drive
->volume_control
&0x20) vol1
=0;
2635 current_drive
->vol_chan0
=chan0
;
2636 current_drive
->vol_ctrl0
=vol0
;
2637 current_drive
->vol_chan1
=chan1
;
2638 current_drive
->vol_ctrl1
=vol1
;
2640 current_drive
->vol_chan2
=2;
2641 current_drive
->vol_ctrl2
=0xFF;
2642 current_drive
->vol_chan3
=3;
2643 current_drive
->vol_ctrl3
=0xFF;
2645 current_drive
->diskstate_flags
|= volume_bit
;
2648 /*==========================================================================*/
2649 static int cc_ReadCapacity(void)
2653 if (fam2_drive
) return (0); /* some firmware lacks this command */
2654 if (famLV_drive
) return (0); /* some firmware lacks this command */
2655 if (famT_drive
) return (0); /* done with cc_ReadTocDescr() */
2656 current_drive
->diskstate_flags
&= ~cd_size_bit
;
2662 drvcmd
[0]=CMD1_CAPACITY
;
2664 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2667 else if (fam2_drive
)
2669 drvcmd
[0]=CMD2_CAPACITY
;
2671 flags_cmd_out
=f_putcmd
;
2674 else if (fam0_drive
)
2676 drvcmd
[0]=CMD0_CAPACITY
;
2678 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2682 msg(DBG_000
,"cc_ReadCapacity: cmd_out: err %d\n", i
);
2685 if (j
==0) return (i
);
2686 if (fam1_drive
) current_drive
->CDsize_frm
=msf2blk(make32(make16(0,infobuf
[0]),make16(infobuf
[1],infobuf
[2])))+CD_MSF_OFFSET
;
2687 else if (fam0_drive
) current_drive
->CDsize_frm
=make32(make16(0,infobuf
[0]),make16(infobuf
[1],infobuf
[2]));
2689 else if (fam2_drive
) current_drive
->CDsize_frm
=make32(make16(infobuf
[0],infobuf
[1]),make16(infobuf
[2],infobuf
[3]));
2691 current_drive
->diskstate_flags
|= cd_size_bit
;
2692 msg(DBG_000
,"cc_ReadCapacity: %d frames.\n", current_drive
->CDsize_frm
);
2695 /*==========================================================================*/
2696 static int cc_ReadTocDescr(void)
2700 current_drive
->diskstate_flags
&= ~toc_bit
;
2704 drvcmd
[0]=CMD1_DISKINFO
;
2706 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2708 else if (fam0LV_drive
)
2710 drvcmd
[0]=CMD0_DISKINFO
;
2713 flags_cmd_out
=f_putcmd
;
2715 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2717 else if (fam2_drive
)
2719 /* possibly longer timeout periods necessary */
2720 current_drive
->f_multisession
=0;
2721 drvcmd
[0]=CMD2_DISKINFO
;
2724 drvcmd
[3]=0xFF; /* session */
2726 flags_cmd_out
=f_putcmd
;
2728 else if (famT_drive
)
2730 current_drive
->f_multisession
=0;
2732 drvcmd
[0]=CMDT_DISKINFO
;
2734 drvcmd
[6]=CDROM_LEADOUT
;
2735 drvcmd
[8]=response_count
;
2739 if (i
<0) return (i
);
2740 if ((famT_drive
)&&(i
<response_count
)) return (-100-i
);
2741 if ((fam1_drive
)||(fam2_drive
)||(fam0LV_drive
))
2742 current_drive
->xa_byte
=infobuf
[0];
2745 current_drive
->first_session
=infobuf
[1];
2746 current_drive
->last_session
=infobuf
[2];
2747 current_drive
->n_first_track
=infobuf
[3];
2748 current_drive
->n_last_track
=infobuf
[4];
2749 if (current_drive
->first_session
!=current_drive
->last_session
)
2751 current_drive
->f_multisession
=1;
2752 current_drive
->lba_multi
=msf2blk(make32(make16(0,infobuf
[5]),make16(infobuf
[6],infobuf
[7])));
2755 if (current_drive
->first_session
!=current_drive
->last_session
)
2757 if (current_drive
->last_session
<=20)
2758 zwanzig
=current_drive
->last_session
+1;
2760 for (count
=current_drive
->first_session
;count
<zwanzig
;count
++)
2762 drvcmd
[0]=CMD2_DISKINFO
;
2767 flags_cmd_out
=f_putcmd
;
2769 if (i
<0) return (i
);
2770 current_drive
->msf_multi_n
[count
]=make32(make16(0,infobuf
[5]),make16(infobuf
[6],infobuf
[7]));
2772 current_drive
->diskstate_flags
|= multisession_bit
;
2775 drvcmd
[0]=CMD2_DISKINFO
;
2780 flags_cmd_out
=f_putcmd
;
2782 if (i
<0) return (i
);
2783 current_drive
->size_msf
=make32(make16(0,infobuf
[2]),make16(infobuf
[3],infobuf
[4]));
2784 current_drive
->size_blk
=msf2blk(current_drive
->size_msf
);
2785 current_drive
->CDsize_frm
=current_drive
->size_blk
+1;
2787 else if (famT_drive
)
2789 current_drive
->size_msf
=make32(make16(infobuf
[8],infobuf
[9]),make16(infobuf
[10],infobuf
[11]));
2790 current_drive
->size_blk
=msf2blk(current_drive
->size_msf
);
2791 current_drive
->CDsize_frm
=current_drive
->size_blk
+1;
2792 current_drive
->n_first_track
=infobuf
[2];
2793 current_drive
->n_last_track
=infobuf
[3];
2797 current_drive
->n_first_track
=infobuf
[1];
2798 current_drive
->n_last_track
=infobuf
[2];
2799 current_drive
->size_msf
=make32(make16(0,infobuf
[3]),make16(infobuf
[4],infobuf
[5]));
2800 current_drive
->size_blk
=msf2blk(current_drive
->size_msf
);
2801 if (famLV_drive
) current_drive
->CDsize_frm
=current_drive
->size_blk
+1;
2803 current_drive
->diskstate_flags
|= toc_bit
;
2804 msg(DBG_TOC
,"TocDesc: xa %02X firstt %02X lastt %02X size %08X firstses %02X lastsess %02X\n",
2805 current_drive
->xa_byte
,
2806 current_drive
->n_first_track
,
2807 current_drive
->n_last_track
,
2808 current_drive
->size_msf
,
2809 current_drive
->first_session
,
2810 current_drive
->last_session
);
2813 /*==========================================================================*/
2814 static int cc_ReadTocEntry(int num
)
2821 drvcmd
[0]=CMD1_READTOC
;
2824 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2826 else if (fam2_drive
)
2828 /* possibly longer timeout periods necessary */
2829 drvcmd
[0]=CMD2_DISKINFO
;
2833 flags_cmd_out
=f_putcmd
;
2835 else if (fam0LV_drive
)
2837 drvcmd
[0]=CMD0_READTOC
;
2842 flags_cmd_out
=f_putcmd
;
2844 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2846 else if (famT_drive
)
2849 drvcmd
[0]=CMDT_DISKINFO
;
2852 drvcmd
[8]=response_count
;
2856 if (i
<0) return (i
);
2857 if ((famT_drive
)&&(i
<response_count
)) return (-100-i
);
2858 if ((fam1_drive
)||(fam0LV_drive
))
2860 current_drive
->TocEnt_nixbyte
=infobuf
[0];
2863 else if (fam2_drive
) i
=0;
2864 else if (famT_drive
) i
=5;
2865 current_drive
->TocEnt_ctl_adr
=swap_nibbles(infobuf
[i
++]);
2866 if ((fam1_drive
)||(fam0L_drive
))
2868 current_drive
->TocEnt_number
=infobuf
[i
++];
2869 current_drive
->TocEnt_format
=infobuf
[i
];
2873 current_drive
->TocEnt_number
=num
;
2874 current_drive
->TocEnt_format
=0;
2876 if (fam1_drive
) i
=4;
2877 else if (fam0LV_drive
) i
=5;
2878 else if (fam2_drive
) i
=2;
2879 else if (famT_drive
) i
=9;
2880 current_drive
->TocEnt_address
=make32(make16(0,infobuf
[i
]),
2881 make16(infobuf
[i
+1],infobuf
[i
+2]));
2882 for (i
=0;i
<response_count
;i
++)
2883 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
2885 msg(DBG_ECS
,"TocEntry:%s\n", msgbuf
);
2886 msg(DBG_TOC
,"TocEntry: %02X %02X %02X %02X %08X\n",
2887 current_drive
->TocEnt_nixbyte
, current_drive
->TocEnt_ctl_adr
,
2888 current_drive
->TocEnt_number
, current_drive
->TocEnt_format
,
2889 current_drive
->TocEnt_address
);
2892 /*==========================================================================*/
2893 static int cc_ReadPacket(void)
2898 drvcmd
[0]=CMD0_PACKET
;
2899 drvcmd
[1]=response_count
;
2900 if(famL_drive
) flags_cmd_out
=f_putcmd
;
2901 else if (fam01_drive
)
2902 flags_cmd_out
=f_putcmd
|f_getsta
|f_ResponseStatus
|f_obey_p_check
;
2903 else if (fam2_drive
) return (-1); /* not implemented yet */
2904 else if (famT_drive
)
2911 /*==========================================================================*/
2912 static int convert_UPC(u_char
*p
)
2917 if (fam0L_drive
) p
[13]=0;
2920 if (fam1_drive
) current_drive
->UPC_buf
[i
]=swap_nibbles(*p
++);
2921 else if (fam0L_drive
)
2923 current_drive
->UPC_buf
[i
]=((*p
++)<<4)&0xFF;
2924 current_drive
->UPC_buf
[i
] |= *p
++;
2926 else if (famT_drive
)
2935 current_drive
->UPC_buf
[6] &= 0xF0;
2938 /*==========================================================================*/
2939 static int cc_ReadUPC(void)
2943 int block
, checksum
;
2944 #endif /* TEST_UPC */
2946 if (fam2_drive
) return (0); /* not implemented yet */
2947 if (famT_drive
) return (0); /* not implemented yet */
2948 if (famV_drive
) return (0); /* not implemented yet */
2950 if (fam0_drive
) return (0); /* but it should work */
2953 current_drive
->diskstate_flags
&= ~upc_bit
;
2955 for (block
=CD_MSF_OFFSET
+1;block
<CD_MSF_OFFSET
+200;block
++)
2957 #endif /* TEST_UPC */
2961 drvcmd
[0]=CMD1_READ_UPC
;
2963 drvcmd
[1]=(block
>>16)&0xFF;
2964 drvcmd
[2]=(block
>>8)&0xFF;
2965 drvcmd
[3]=block
&0xFF;
2966 #endif /* TEST_UPC */
2968 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
2970 else if (fam0L_drive
)
2972 drvcmd
[0]=CMD0_READ_UPC
;
2974 drvcmd
[2]=(block
>>16)&0xFF;
2975 drvcmd
[3]=(block
>>8)&0xFF;
2976 drvcmd
[4]=block
&0xFF;
2977 #endif /* TEST_UPC */
2979 flags_cmd_out
=f_putcmd
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
|f_bit1
;
2981 else if (fam2_drive
)
2985 else if (famT_drive
)
2992 msg(DBG_000
,"cc_ReadUPC cmd_out: err %d\n", i
);
2998 if (famL_drive
) flags_cmd_out
=f_putcmd
;
3002 msg(DBG_000
,"cc_ReadUPC ReadPacket: err %d\n", i
);
3008 #endif /* TEST_UPC */
3009 for (i
=0;i
<(fam1_drive
?8:16);i
++)
3012 checksum
|= infobuf
[i
];
3013 #endif /* TEST_UPC */
3014 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
3017 msg(DBG_UPC
,"UPC info:%s\n", msgbuf
);
3019 if ((checksum
&0x7F)!=0) break;
3021 #endif /* TEST_UPC */
3022 current_drive
->UPC_ctl_adr
=0;
3023 if (fam1_drive
) i
=0;
3025 if ((infobuf
[i
]&0x80)!=0)
3027 convert_UPC(&infobuf
[i
]);
3028 current_drive
->UPC_ctl_adr
= (current_drive
->TocEnt_ctl_adr
& 0xF0) | 0x02;
3031 sprintf(&msgbuf
[i
*3], " %02X", current_drive
->UPC_buf
[i
]);
3032 sprintf(&msgbuf
[i
*3], " (%02X)", current_drive
->UPC_ctl_adr
);
3034 msg(DBG_UPC
,"UPC code:%s\n", msgbuf
);
3035 current_drive
->diskstate_flags
|= upc_bit
;
3039 static int sbpcd_get_mcn(struct cdrom_device_info
*cdi
, struct cdrom_mcn
*mcn
)
3042 unsigned char *mcnp
= mcn
->medium_catalog_number
;
3043 unsigned char *resp
;
3045 current_drive
->diskstate_flags
&= ~upc_bit
;
3049 drvcmd
[0]=CMD1_READ_UPC
;
3051 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
3053 else if (fam0L_drive
)
3055 drvcmd
[0]=CMD0_READ_UPC
;
3057 flags_cmd_out
=f_putcmd
|f_lopsta
|f_getsta
|f_ResponseStatus
|f_obey_p_check
|f_bit1
;
3059 else if (fam2_drive
)
3063 else if (famT_drive
)
3070 msg(DBG_000
,"cc_ReadUPC cmd_out: err %d\n", i
);
3076 if (famL_drive
) flags_cmd_out
=f_putcmd
;
3080 msg(DBG_000
,"cc_ReadUPC ReadPacket: err %d\n", i
);
3084 current_drive
->UPC_ctl_adr
=0;
3085 if (fam1_drive
) i
=0;
3089 if (*resp
++ == 0x80) {
3090 /* packed bcd to single ASCII digits */
3091 *mcnp
++ = (*resp
>> 4) + '0';
3092 *mcnp
++ = (*resp
++ & 0x0f) + '0';
3093 *mcnp
++ = (*resp
>> 4) + '0';
3094 *mcnp
++ = (*resp
++ & 0x0f) + '0';
3095 *mcnp
++ = (*resp
>> 4) + '0';
3096 *mcnp
++ = (*resp
++ & 0x0f) + '0';
3097 *mcnp
++ = (*resp
>> 4) + '0';
3098 *mcnp
++ = (*resp
++ & 0x0f) + '0';
3099 *mcnp
++ = (*resp
>> 4) + '0';
3100 *mcnp
++ = (*resp
++ & 0x0f) + '0';
3101 *mcnp
++ = (*resp
>> 4) + '0';
3102 *mcnp
++ = (*resp
++ & 0x0f) + '0';
3103 *mcnp
++ = (*resp
>> 4) + '0';
3107 current_drive
->diskstate_flags
|= upc_bit
;
3111 /*==========================================================================*/
3112 static int cc_CheckMultiSession(void)
3116 if (fam2_drive
) return (0);
3117 current_drive
->f_multisession
=0;
3118 current_drive
->lba_multi
=0;
3119 if (fam0_drive
) return (0);
3123 drvcmd
[0]=CMD1_MULTISESS
;
3125 flags_cmd_out
=f_putcmd
|f_ResponseStatus
|f_obey_p_check
;
3127 if (i
<0) return (i
);
3128 if ((infobuf
[0]&0x80)!=0)
3130 current_drive
->f_multisession
=1;
3131 current_drive
->lba_multi
=msf2blk(make32(make16(0,infobuf
[1]),
3132 make16(infobuf
[2],infobuf
[3])));
3135 else if (famLV_drive
)
3137 drvcmd
[0]=CMDL_MULTISESS
;
3141 flags_cmd_out
=f_putcmd
;
3143 if (i
<0) return (i
);
3144 current_drive
->lba_multi
=msf2blk(make32(make16(0,infobuf
[5]),
3145 make16(infobuf
[6],infobuf
[7])));
3147 else if (famT_drive
)
3150 drvcmd
[0]=CMDT_DISKINFO
;
3153 drvcmd
[8]=response_count
;
3156 if (i
<0) return (i
);
3157 if (i
<response_count
) return (-100-i
);
3158 current_drive
->first_session
=infobuf
[2];
3159 current_drive
->last_session
=infobuf
[3];
3160 current_drive
->track_of_last_session
=infobuf
[6];
3161 if (current_drive
->first_session
!=current_drive
->last_session
)
3163 current_drive
->f_multisession
=1;
3164 current_drive
->lba_multi
=msf2blk(make32(make16(0,infobuf
[9]),make16(infobuf
[10],infobuf
[11])));
3167 for (i
=0;i
<response_count
;i
++)
3168 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
3170 msg(DBG_MUL
,"MultiSession Info:%s (%d)\n", msgbuf
, current_drive
->lba_multi
);
3171 if (current_drive
->lba_multi
>200)
3173 current_drive
->f_multisession
=1;
3174 msg(DBG_MUL
,"MultiSession base: %06X\n", current_drive
->lba_multi
);
3178 /*==========================================================================*/
3180 static int cc_SubChanInfo(int frame
, int count
, u_char
*buffer
)
3181 /* "frame" is a RED BOOK (msf-bin) address */
3185 if (fam0LV_drive
) return (-ENOSYS
); /* drive firmware lacks it */
3191 if (current_drive
->audio_state
!=audio_playing
) return (-ENODATA
);
3194 drvcmd
[0]=CMD1_SUBCHANINF
;
3195 drvcmd
[1]=(frame
>>16)&0xFF;
3196 drvcmd
[2]=(frame
>>8)&0xFF;
3197 drvcmd
[3]=frame
&0xFF;
3198 drvcmd
[5]=(count
>>8)&0xFF;
3199 drvcmd
[6]=count
&0xFF;
3200 flags_cmd_out
=f_putcmd
|f_respo2
|f_ResponseStatus
|f_obey_p_check
;
3202 current_drive
->frame_size
=CD_FRAMESIZE_SUB
;
3203 i
=cmd_out(); /* which buffer to use? */
3207 /*==========================================================================*/
3208 static void __init
check_datarate(void)
3212 msg(DBG_IOX
,"check_datarate entered.\n");
3215 for (i
=0;i
<=1000;i
++) printk(".");
3217 /* set a timer to make (timed_out_delay!=0) after 1.1 seconds */
3219 del_timer(&delay_timer
);
3221 delay_timer
.expires
=jiffies
+11*HZ
/10;
3223 add_timer(&delay_timer
);
3225 msg(DBG_TIM
,"delay timer started (11*HZ/10).\n");
3232 if (datarate
>0x6FFFFFFF) break;
3235 while (!timed_out_delay
);
3236 del_timer(&delay_timer
);
3238 msg(DBG_TIM
,"datarate: %04X\n", datarate
);
3240 if (datarate
<65536) datarate
=65536;
3241 maxtim16
=datarate
*16;
3242 maxtim04
=datarate
*4;
3243 maxtim02
=datarate
*2;
3244 maxtim_8
=datarate
/32;
3246 maxtim_data
=datarate
/100;
3248 maxtim_data
=datarate
/300;
3249 #endif /* LONG_TIMING */
3251 msg(DBG_TIM
,"maxtim_8 %d, maxtim_data %d.\n", maxtim_8
, maxtim_data
);
3254 /*==========================================================================*/
3256 static int c2_ReadError(int fam
)
3265 drvcmd
[0]=CMD0_READ_ERR
; /* same as CMD1_ and CMDL_ */
3266 i
=do_cmd(f_putcmd
|f_lopsta
|f_getsta
|f_ResponseStatus
);
3270 drvcmd
[0]=CMD2_READ_ERR
;
3277 /*==========================================================================*/
3278 static void __init
ask_mail(void)
3282 msg(DBG_INF
, "please mail the following lines to emoenke@gwdg.de\n");
3283 msg(DBG_INF
, "(don't mail if you are not using the actual kernel):\n");
3284 msg(DBG_INF
, "%s\n", VERSION
);
3285 msg(DBG_INF
, "address %03X, type %s, drive %s (ID %d)\n",
3286 CDo_command
, type
, current_drive
->drive_model
, current_drive
->drv_id
);
3288 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
3290 msg(DBG_INF
,"infobuf =%s\n", msgbuf
);
3292 sprintf(&msgbuf
[i
*3], " %c ", infobuf
[i
]);
3294 msg(DBG_INF
,"infobuf =%s\n", msgbuf
);
3296 /*==========================================================================*/
3297 static int __init
check_version(void)
3300 int teac_possible
=0;
3302 msg(DBG_INI
,"check_version: id=%d, d=%d.\n", current_drive
->drv_id
, current_drive
- D_S
);
3303 current_drive
->drv_type
=0;
3305 /* check for CR-52x, CR-56x, LCS-7260 and ECS-AT */
3306 /* clear any pending error state */
3308 drvcmd
[0]=CMD0_READ_ERR
; /* same as CMD1_ and CMDL_ */
3310 flags_cmd_out
=f_putcmd
;
3312 if (i
<0) msg(DBG_INI
,"CMD0_READ_ERR returns %d (ok anyway).\n",i
);
3313 /* read drive version */
3315 for (i
=0;i
<12;i
++) infobuf
[i
]=0;
3316 drvcmd
[0]=CMD0_READ_VER
; /* same as CMD1_ and CMDL_ */
3317 response_count
=12; /* fam1: only 11 */
3318 flags_cmd_out
=f_putcmd
;
3320 if (i
<-1) msg(DBG_INI
,"CMD0_READ_VER returns %d\n",i
);
3321 if (i
==-11) teac_possible
++;
3323 for (i
=0;i
<12;i
++) j
+=infobuf
[i
];
3327 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
3329 msg(DBG_ECS
,"infobuf =%s\n", msgbuf
);
3331 sprintf(&msgbuf
[i
*3], " %c ", infobuf
[i
]);
3333 msg(DBG_ECS
,"infobuf =%s\n", msgbuf
);
3335 for (i
=0;i
<4;i
++) if (infobuf
[i
]!=family1
[i
]) break;
3338 current_drive
->drive_model
[0]='C';
3339 current_drive
->drive_model
[1]='R';
3340 current_drive
->drive_model
[2]='-';
3341 current_drive
->drive_model
[3]='5';
3342 current_drive
->drive_model
[4]=infobuf
[i
++];
3343 current_drive
->drive_model
[5]=infobuf
[i
++];
3344 current_drive
->drive_model
[6]=0;
3345 current_drive
->drv_type
=drv_fam1
;
3347 if (!current_drive
->drv_type
)
3349 for (i
=0;i
<8;i
++) if (infobuf
[i
]!=family0
[i
]) break;
3352 current_drive
->drive_model
[0]='C';
3353 current_drive
->drive_model
[1]='R';
3354 current_drive
->drive_model
[2]='-';
3355 current_drive
->drive_model
[3]='5';
3356 current_drive
->drive_model
[4]='2';
3357 current_drive
->drive_model
[5]='x';
3358 current_drive
->drive_model
[6]=0;
3359 current_drive
->drv_type
=drv_fam0
;
3362 if (!current_drive
->drv_type
)
3364 for (i
=0;i
<8;i
++) if (infobuf
[i
]!=familyL
[i
]) break;
3368 current_drive
->drive_model
[j
]=infobuf
[j
];
3369 current_drive
->drive_model
[8]=0;
3370 current_drive
->drv_type
=drv_famL
;
3373 if (!current_drive
->drv_type
)
3375 for (i
=0;i
<6;i
++) if (infobuf
[i
]!=familyV
[i
]) break;
3379 current_drive
->drive_model
[j
]=infobuf
[j
];
3380 current_drive
->drive_model
[6]=0;
3381 current_drive
->drv_type
=drv_famV
;
3382 i
+=2; /* 2 blanks before version */
3385 if (!current_drive
->drv_type
)
3387 /* check for CD200 */
3389 drvcmd
[0]=CMD2_READ_ERR
;
3391 flags_cmd_out
=f_putcmd
;
3393 if (i
<0) msg(DBG_INI
,"CMD2_READERR returns %d (ok anyway).\n",i
);
3394 if (i
<0) msg(DBG_000
,"CMD2_READERR returns %d (ok anyway).\n",i
);
3395 /* read drive version */
3397 for (i
=0;i
<12;i
++) infobuf
[i
]=0;
3398 if (sbpro_type
==1) OUT(CDo_sel_i_d
,0);
3402 OUT(CDo_enable
,current_drive
->drv_sel
);
3404 drvcmd
[0]=CMD2_READ_VER
;
3406 flags_cmd_out
=f_putcmd
;
3408 if (i
<0) msg(DBG_INI
,"CMD2_READ_VER returns %d\n",i
);
3409 if (i
==-7) teac_possible
++;
3411 for (i
=0;i
<12;i
++) j
+=infobuf
[i
];
3415 sprintf(&msgbuf
[i
*3], " %02X", infobuf
[i
]);
3417 msg(DBG_IDX
,"infobuf =%s\n", msgbuf
);
3419 sprintf(&msgbuf
[i
*3], " %c ", infobuf
[i
]);
3421 msg(DBG_IDX
,"infobuf =%s\n", msgbuf
);
3425 for (i
=0;i
<5;i
++) if (infobuf
[i
]!=family2
[i
]) break;
3428 current_drive
->drive_model
[0]='C';
3429 current_drive
->drive_model
[1]='D';
3430 current_drive
->drive_model
[2]='2';
3431 current_drive
->drive_model
[3]='0';
3432 current_drive
->drive_model
[4]='0';
3433 current_drive
->drive_model
[5]=infobuf
[i
++];
3434 current_drive
->drive_model
[6]=infobuf
[i
++];
3435 current_drive
->drive_model
[7]=0;
3436 current_drive
->drv_type
=drv_fam2
;
3440 if (!current_drive
->drv_type
)
3442 /* check for TEAC CD-55A */
3443 msg(DBG_TEA
,"teac_possible: %d\n",teac_possible
);
3444 for (j
=1;j
<=((current_drive
->drv_id
==0)?3:1);j
++)
3446 for (l
=1;l
<=((current_drive
->drv_id
==0)?10:1);l
++)
3448 msg(DBG_TEA
,"TEAC reset #%d-%d.\n", j
, l
);
3449 if (sbpro_type
==1) OUT(CDo_reset
,0);
3452 OUT(CDo_enable
,current_drive
->drv_sel
);
3454 OUT(CDo_command
,CMDT_RESET
);
3455 for (i
=0;i
<9;i
++) OUT(CDo_command
,0);
3458 OUT(CDo_enable
,current_drive
->drv_sel
);
3461 msg(DBG_TEA
,"TEAC CDi_status: %02X.\n",i
);
3463 if (i
&s_not_result_ready
) continue; /* drive not present or ready */
3466 msg(DBG_TEA
,"TEAC CDi_info: %02X.\n",i
);
3467 if (i
==0x55) break; /* drive found */
3469 if (i
==0x55) break; /* drive found */
3471 if (i
==0x55) /* drive found */
3473 msg(DBG_TEA
,"TEAC drive found.\n");
3475 flags_cmd_out
=f_putcmd
;
3477 drvcmd
[0]=CMDT_READ_VER
;
3478 drvcmd
[4]=response_count
;
3479 for (i
=0;i
<12;i
++) infobuf
[i
]=0;
3481 if (i
!=0) msg(DBG_TEA
,"cmd_out_T(CMDT_READ_VER) returns %d.\n",i
);
3482 for (i
=1;i
<6;i
++) if (infobuf
[i
]!=familyT
[i
-1]) break;
3485 current_drive
->drive_model
[0]='C';
3486 current_drive
->drive_model
[1]='D';
3487 current_drive
->drive_model
[2]='-';
3488 current_drive
->drive_model
[3]='5';
3489 current_drive
->drive_model
[4]='5';
3490 current_drive
->drive_model
[5]=0;
3491 current_drive
->drv_type
=drv_famT
;
3495 if (!current_drive
->drv_type
)
3497 msg(DBG_TEA
,"no drive found at address %03X under ID %d.\n",CDo_command
,current_drive
->drv_id
);
3500 for (j
=0;j
<4;j
++) current_drive
->firmware_version
[j
]=infobuf
[i
+j
];
3503 u_char lcs_firm_e1
[]="A E1";
3504 u_char lcs_firm_f4
[]="A4F4";
3507 if (current_drive
->firmware_version
[j
]!=lcs_firm_e1
[j
]) break;
3508 if (j
==4) current_drive
->drv_type
=drv_e1
;
3511 if (current_drive
->firmware_version
[j
]!=lcs_firm_f4
[j
]) break;
3512 if (j
==4) current_drive
->drv_type
=drv_f4
;
3514 if (current_drive
->drv_type
==drv_famL
) ask_mail();
3516 else if (famT_drive
)
3518 j
=infobuf
[4]; /* one-byte version??? - here: 0x15 */
3521 current_drive
->firmware_version
[0]=infobuf
[7];
3522 current_drive
->firmware_version
[1]=infobuf
[8];
3523 current_drive
->firmware_version
[2]=infobuf
[10];
3524 current_drive
->firmware_version
[3]=infobuf
[11];
3528 if (j
!=0x15) ask_mail();
3529 current_drive
->firmware_version
[0]='0';
3530 current_drive
->firmware_version
[1]='.';
3531 current_drive
->firmware_version
[2]='0'+(j
>>4);
3532 current_drive
->firmware_version
[3]='0'+(j
&0x0f);
3535 else /* CR-52x, CR-56x, CD200, ECS-AT */
3537 j
= (current_drive
->firmware_version
[0] & 0x0F) * 100 +
3538 (current_drive
->firmware_version
[2] & 0x0F) *10 +
3539 (current_drive
->firmware_version
[3] & 0x0F);
3542 if (j
<200) current_drive
->drv_type
=drv_199
;
3543 else if (j
<201) current_drive
->drv_type
=drv_200
;
3544 else if (j
<210) current_drive
->drv_type
=drv_201
;
3545 else if (j
<211) current_drive
->drv_type
=drv_210
;
3546 else if (j
<300) current_drive
->drv_type
=drv_211
;
3547 else if (j
>=300) current_drive
->drv_type
=drv_300
;
3549 else if (fam1_drive
)
3551 if (j
<100) current_drive
->drv_type
=drv_099
;
3554 current_drive
->drv_type
=drv_100
;
3555 if ((j
!=500)&&(j
!=102)) ask_mail();
3558 else if (fam2_drive
)
3560 if (current_drive
->drive_model
[5]=='F')
3562 if ((j
!=1)&&(j
!=35)&&(j
!=200)&&(j
!=210))
3563 ask_mail(); /* unknown version at time */
3567 msg(DBG_INF
,"this CD200 drive is not fully supported yet - only audio will work.\n");
3568 if ((j
!=101)&&(j
!=35))
3569 ask_mail(); /* unknown version at time */
3572 else if (famV_drive
)
3574 if ((j
==100)||(j
==150)) current_drive
->drv_type
=drv_at
;
3575 ask_mail(); /* hopefully we get some feedback by this */
3578 msg(DBG_LCS
,"drive type %02X\n",current_drive
->drv_type
);
3579 msg(DBG_INI
,"check_version done.\n");
3582 /*==========================================================================*/
3583 static void switch_drive(struct sbpcd_drive
*p
)
3586 OUT(CDo_enable
,current_drive
->drv_sel
);
3587 msg(DBG_DID
,"drive %d (ID=%d) activated.\n",
3588 current_drive
- D_S
, current_drive
->drv_id
);
3591 /*==========================================================================*/
3594 * probe for the presence of an interface card
3596 static int __init
check_card(int port
)
3601 u_char response
[N_RESPO
];
3605 msg(DBG_INI
,"check_card entered.\n");
3606 save_port0
=inb(port
+0);
3607 save_port3
=inb(port
+3);
3609 for (j
=0;j
<NR_SBPCD
;j
++)
3611 OUT(port
+3,j
) ; /* enable drive #j */
3612 OUT(port
+0,CMD0_PATH_CHECK
);
3613 for (i
=10;i
>0;i
--) OUT(port
+0,0);
3614 for (k
=0;k
<N_RESPO
;k
++) response
[k
]=0;
3615 for (k
=0;k
<N_RESPO
;k
++)
3617 for (i
=10000;i
>0;i
--)
3619 if (inb(port
+1)&s_not_result_ready
) continue;
3620 response
[k
]=inb(port
+0);
3624 for (i
=0;i
<N_RESPO
;i
++)
3625 sprintf(&msgbuf
[i
*3], " %02X", response
[i
]);
3627 msg(DBG_TEA
,"path check 00 (%d): %s\n", j
, msgbuf
);
3628 OUT(port
+0,CMD0_PATH_CHECK
);
3629 for (i
=10;i
>0;i
--) OUT(port
+0,0);
3630 for (k
=0;k
<N_RESPO
;k
++) response
[k
]=0xFF;
3631 for (k
=0;k
<N_RESPO
;k
++)
3633 for (i
=10000;i
>0;i
--)
3635 if (inb(port
+1)&s_not_result_ready
) continue;
3636 response
[k
]=inb(port
+0);
3640 for (i
=0;i
<N_RESPO
;i
++)
3641 sprintf(&msgbuf
[i
*3], " %02X", response
[i
]);
3643 msg(DBG_TEA
,"path check 00 (%d): %s\n", j
, msgbuf
);
3645 if (response
[0]==0xAA)
3646 if (response
[1]==0x55)
3649 for (j
=0;j
<NR_SBPCD
;j
++)
3651 OUT(port
+3,j
) ; /* enable drive #j */
3652 OUT(port
+0,CMD2_READ_VER
);
3653 for (i
=10;i
>0;i
--) OUT(port
+0,0);
3654 for (k
=0;k
<N_RESPO
;k
++) response
[k
]=0;
3655 for (k
=0;k
<N_RESPO
;k
++)
3657 for (i
=1000000;i
>0;i
--)
3659 if (inb(port
+1)&s_not_result_ready
) continue;
3660 response
[k
]=inb(port
+0);
3664 for (i
=0;i
<N_RESPO
;i
++)
3665 sprintf(&msgbuf
[i
*3], " %02X", response
[i
]);
3667 msg(DBG_TEA
,"path check 12 (%d): %s\n", j
, msgbuf
);
3669 OUT(port
+0,CMD2_READ_VER
);
3670 for (i
=10;i
>0;i
--) OUT(port
+0,0);
3671 for (k
=0;k
<N_RESPO
;k
++) response
[k
]=0xFF;
3672 for (k
=0;k
<N_RESPO
;k
++)
3674 for (i
=1000000;i
>0;i
--)
3676 if (inb(port
+1)&s_not_result_ready
) continue;
3677 response
[k
]=inb(port
+0);
3681 for (i
=0;i
<N_RESPO
;i
++)
3682 sprintf(&msgbuf
[i
*3], " %02X", response
[i
]);
3684 msg(DBG_TEA
,"path check 12 (%d): %s\n", j
, msgbuf
);
3686 if (response
[0]==0xAA)
3687 if (response
[1]==0x55)
3690 OUT(port
+0,save_port0
);
3691 OUT(port
+3,save_port3
);
3692 return (0); /* in any case - no real "function" at time */
3694 #endif /* PATH_CHECK */
3695 /*==========================================================================*/
3696 /*==========================================================================*/
3698 * probe for the presence of drives on the selected controller
3700 static int __init
check_drives(void)
3704 msg(DBG_INI
,"check_drives entered.\n");
3706 for (j
=0;j
<max_drives
;j
++)
3708 struct sbpcd_drive
*p
= D_S
+ ndrives
;
3710 if (sbpro_type
==1) p
->drv_sel
=(j
&0x01)<<1|(j
&0x02)>>1;
3713 msg(DBG_INI
,"check_drives: drive %d (ID=%d) activated.\n",ndrives
,j
);
3714 msg(DBG_000
,"check_drives: drive %d (ID=%d) activated.\n",ndrives
,j
);
3716 if (i
<0) msg(DBG_INI
,"check_version returns %d.\n",i
);
3719 current_drive
->drv_options
=drv_pattern
[j
];
3720 if (fam0L_drive
) current_drive
->drv_options
&=~(speed_auto
|speed_300
|speed_150
);
3721 msg(DBG_INF
, "Drive %d (ID=%d): %.9s (%.4s) at 0x%03X (type %d)\n",
3722 current_drive
- D_S
,
3723 current_drive
->drv_id
,
3724 current_drive
->drive_model
,
3725 current_drive
->firmware_version
,
3731 for (j
=ndrives
;j
<NR_SBPCD
;j
++) D_S
[j
].drv_id
=-1;
3732 if (ndrives
==0) return (-1);
3735 /*==========================================================================*/
3738 * obtain if requested service disturbs current audio state
3740 static int obey_audio_state(u_char audio_state
, u_char func
,u_char subfunc
)
3742 switch (audio_state
) /* audio status from controller */
3744 case aud_11
: /* "audio play in progress" */
3746 switch (func
) /* DOS command code */
3748 case cmd_07
: /* input flush */
3749 case cmd_0d
: /* open device */
3750 case cmd_0e
: /* close device */
3751 case cmd_0c
: /* ioctl output */
3753 case cmd_03
: /* ioctl input */
3755 /* DOS ioctl input subfunction */
3769 case aud_12
: /* "audio play paused" */
3776 /*==========================================================================*/
3778 * ioctl_o, flush_input, open_device, close_device,
3779 * tell_address, tell_volume, tell_capabiliti,
3780 * tell_framesize, tell_CD_changed, tell_audio_posi
3782 static int check_allowed1(u_char func1
, u_char func2
)
3785 if (func1
==ioctl_o
) return (0);
3786 if (func1
==read_long
) return (-1);
3787 if (func1
==read_long_prefetch
) return (-1);
3788 if (func1
==seek
) return (-1);
3789 if (func1
==audio_play
) return (-1);
3790 if (func1
==audio_pause
) return (-1);
3791 if (func1
==audio_resume
) return (-1);
3792 if (func1
!=ioctl_i
) return (0);
3793 if (func2
==tell_SubQ_run_tot
) return (-1);
3794 if (func2
==tell_cdsize
) return (-1);
3795 if (func2
==tell_TocDescrip
) return (-1);
3796 if (func2
==tell_TocEntry
) return (-1);
3797 if (func2
==tell_subQ_info
) return (-1);
3798 if (fam1_drive
) if (func2
==tell_SubChanInfo
) return (-1);
3799 if (func2
==tell_UPC
) return (-1);
3804 /*==========================================================================*/
3805 static int check_allowed2(u_char func1
, u_char func2
)
3808 if (func1
==read_long
) return (-1);
3809 if (func1
==read_long_prefetch
) return (-1);
3810 if (func1
==seek
) return (-1);
3811 if (func1
==audio_play
) return (-1);
3812 if (func1
!=ioctl_o
) return (0);
3815 if (func2
==EjectDisk
) return (-1);
3816 if (func2
==CloseTray
) return (-1);
3822 /*==========================================================================*/
3823 static int check_allowed3(u_char func1
, u_char func2
)
3828 if (func2
==tell_address
) return (0);
3829 if (func2
==tell_capabiliti
) return (0);
3830 if (func2
==tell_CD_changed
) return (0);
3831 if (fam0L_drive
) if (func2
==tell_SubChanInfo
) return (0);
3836 if (func2
==DriveReset
) return (0);
3839 if (func2
==EjectDisk
) return (0);
3840 if (func2
==LockDoor
) return (0);
3841 if (func2
==CloseTray
) return (0);
3845 if (func1
==flush_input
) return (-1);
3846 if (func1
==read_long
) return (-1);
3847 if (func1
==read_long_prefetch
) return (-1);
3848 if (func1
==seek
) return (-1);
3849 if (func1
==audio_play
) return (-1);
3850 if (func1
==audio_pause
) return (-1);
3851 if (func1
==audio_resume
) return (-1);
3856 /*==========================================================================*/
3857 static int seek_pos_audio_end(void)
3861 i
=msf2blk(current_drive
->pos_audio_end
)-1;
3862 if (i
<0) return (-1);
3867 /*==========================================================================*/
3868 static int ReadToC(void)
3871 current_drive
->diskstate_flags
&= ~toc_bit
;
3872 current_drive
->ored_ctl_adr
=0;
3873 /* special handling of CD-I HE */
3874 if ((current_drive
->n_first_track
== 2 && current_drive
->n_last_track
== 2) ||
3875 current_drive
->xa_byte
== 0x10)
3877 current_drive
->TocBuffer
[1].nixbyte
=0;
3878 current_drive
->TocBuffer
[1].ctl_adr
=0x40;
3879 current_drive
->TocBuffer
[1].number
=1;
3880 current_drive
->TocBuffer
[1].format
=0;
3881 current_drive
->TocBuffer
[1].address
=blk2msf(0);
3882 current_drive
->ored_ctl_adr
|= 0x40;
3883 current_drive
->n_first_track
= 1;
3884 current_drive
->n_last_track
= 1;
3885 current_drive
->xa_byte
= 0x10;
3888 for (j
=current_drive
->n_first_track
;j
<=current_drive
->n_last_track
;j
++)
3890 i
=cc_ReadTocEntry(j
);
3893 msg(DBG_INF
,"cc_ReadTocEntry(%d) returns %d.\n",j
,i
);
3896 current_drive
->TocBuffer
[j
].nixbyte
=current_drive
->TocEnt_nixbyte
;
3897 current_drive
->TocBuffer
[j
].ctl_adr
=current_drive
->TocEnt_ctl_adr
;
3898 current_drive
->TocBuffer
[j
].number
=current_drive
->TocEnt_number
;
3899 current_drive
->TocBuffer
[j
].format
=current_drive
->TocEnt_format
;
3900 current_drive
->TocBuffer
[j
].address
=current_drive
->TocEnt_address
;
3901 current_drive
->ored_ctl_adr
|= current_drive
->TocEnt_ctl_adr
;
3903 /* fake entry for LeadOut Track */
3904 current_drive
->TocBuffer
[j
].nixbyte
=0;
3905 current_drive
->TocBuffer
[j
].ctl_adr
=0;
3906 current_drive
->TocBuffer
[j
].number
=CDROM_LEADOUT
;
3907 current_drive
->TocBuffer
[j
].format
=0;
3908 current_drive
->TocBuffer
[j
].address
=current_drive
->size_msf
;
3910 current_drive
->diskstate_flags
|= toc_bit
;
3913 /*==========================================================================*/
3914 static int DiskInfo(void)
3918 current_drive
->mode
=READ_M1
;
3921 #define LOOP_COUNT 10 /* needed for some "old" drives */
3923 msg(DBG_000
,"DiskInfo entered.\n");
3924 for (j
=1;j
<LOOP_COUNT
;j
++)
3930 msg(DBG_INF
,"DiskInfo: SetSpeed returns %d\n", i
);
3936 msg(DBG_INF
,"DiskInfo: cc_ModeSense returns %d\n", i
);
3940 i
=cc_ReadCapacity();
3942 msg(DBG_INF
,"DiskInfo: ReadCapacity #%d returns %d\n", j
, i
);
3946 if (!fam0_drive
&& j
== 2) break;
3948 if (j
==LOOP_COUNT
) return (-33); /* give up */
3950 i
=cc_ReadTocDescr();
3953 msg(DBG_INF
,"DiskInfo: ReadTocDescr returns %d\n", i
);
3959 msg(DBG_INF
,"DiskInfo: ReadToC returns %d\n", i
);
3962 i
=cc_CheckMultiSession();
3965 msg(DBG_INF
,"DiskInfo: cc_CheckMultiSession returns %d\n", i
);
3968 if (current_drive
->f_multisession
) current_drive
->sbp_bufsiz
=1; /* possibly a weird PhotoCD */
3969 else current_drive
->sbp_bufsiz
=buffers
;
3970 i
=cc_ReadTocEntry(current_drive
->n_first_track
);
3973 msg(DBG_INF
,"DiskInfo: cc_ReadTocEntry(1) returns %d\n", i
);
3977 if (i
<0) msg(DBG_INF
,"DiskInfo: cc_ReadUPC returns %d\n", i
);
3978 if ((fam0L_drive
) && (current_drive
->xa_byte
==0x20 || current_drive
->xa_byte
== 0x10))
3980 /* XA disk with old drive */
3981 cc_ModeSelect(CD_FRAMESIZE_RAW1
);
3984 if (famT_drive
) cc_prep_mode_T();
3985 msg(DBG_000
,"DiskInfo done.\n");
3989 static int sbpcd_drive_status(struct cdrom_device_info
*cdi
, int slot_nr
)
3991 struct sbpcd_drive
*p
= cdi
->handle
;
3994 if (CDSL_CURRENT
!= slot_nr
) {
3995 /* we have no changer support */
4000 st
=ResponseStatus();
4003 msg(DBG_INF
,"sbpcd_drive_status: timeout.\n");
4006 msg(DBG_000
,"Drive Status: door_locked =%d.\n", st_door_locked
);
4007 msg(DBG_000
,"Drive Status: door_closed =%d.\n", st_door_closed
);
4008 msg(DBG_000
,"Drive Status: caddy_in =%d.\n", st_caddy_in
);
4009 msg(DBG_000
,"Drive Status: disk_ok =%d.\n", st_diskok
);
4010 msg(DBG_000
,"Drive Status: spinning =%d.\n", st_spinning
);
4011 msg(DBG_000
,"Drive Status: busy =%d.\n", st_busy
);
4014 if (!(p
->status_bits
& p_door_closed
)) return CDS_TRAY_OPEN
;
4015 if (p
->status_bits
& p_disk_ok
) return CDS_DISC_OK
;
4016 if (p
->status_bits
& p_disk_in
) return CDS_DRIVE_NOT_READY
;
4020 if (p
->status_bits
& p_spinning
) return CDS_DISC_OK
;
4021 /* return CDS_TRAY_OPEN; */
4029 /*==========================================================================*/
4032 * called always if driver gets entered
4033 * returns 0 or ERROR2 or ERROR15
4035 static int prepare(u_char func
, u_char subfunc
)
4042 if (i
&s_attention
) GetStatus();
4044 else if (fam1_drive
) GetStatus();
4045 else if (fam2_drive
) GetStatus();
4046 else if (famT_drive
) GetStatus();
4047 if (current_drive
->CD_changed
==0xFF)
4049 current_drive
->diskstate_flags
=0;
4050 current_drive
->audio_state
=0;
4053 i
=check_allowed1(func
,subfunc
);
4054 if (i
<0) return (-2);
4058 i
=check_allowed3(func
,subfunc
);
4061 current_drive
->CD_changed
=1;
4070 current_drive
->diskstate_flags
=0;
4071 current_drive
->audio_state
=0;
4072 i
=check_allowed1(func
,subfunc
);
4073 if (i
<0) return (-2);
4079 if (current_drive
->audio_state
!=audio_pausing
)
4081 i
=check_allowed2(func
,subfunc
);
4082 if (i
<0) return (-2);
4087 if (current_drive
->audio_state
==audio_playing
) seek_pos_audio_end();
4088 current_drive
->audio_state
=0;
4090 if (!frame_size_valid
)
4095 current_drive
->diskstate_flags
=0;
4096 current_drive
->audio_state
=0;
4097 i
=check_allowed1(func
,subfunc
);
4098 if (i
<0) return (-2);
4106 /*==========================================================================*/
4107 /*==========================================================================*/
4109 * Check the results of the "get status" command.
4111 static int sbp_status(void)
4115 st
=ResponseStatus();
4118 msg(DBG_INF
,"sbp_status: timeout.\n");
4122 if (!st_spinning
) msg(DBG_SPI
,"motor got off - ignoring.\n");
4126 msg(DBG_INF
,"st_check detected - retrying.\n");
4129 if (!st_door_closed
)
4131 msg(DBG_INF
,"door is open - retrying.\n");
4136 msg(DBG_INF
,"disk removed - retrying.\n");
4141 msg(DBG_INF
,"!st_diskok detected - retrying.\n");
4146 msg(DBG_INF
,"st_busy detected - retrying.\n");
4151 /*==========================================================================*/
4153 static int sbpcd_get_last_session(struct cdrom_device_info
*cdi
, struct cdrom_multisession
*ms_infp
)
4155 struct sbpcd_drive
*p
= cdi
->handle
;
4156 ms_infp
->addr_format
= CDROM_LBA
;
4157 ms_infp
->addr
.lba
= p
->lba_multi
;
4158 if (p
->f_multisession
)
4159 ms_infp
->xa_flag
=1; /* valid redirection address */
4161 ms_infp
->xa_flag
=0; /* invalid redirection address */
4166 /*==========================================================================*/
4167 /*==========================================================================*/
4171 static int sbpcd_dev_ioctl(struct cdrom_device_info
*cdi
, u_int cmd
,
4174 struct sbpcd_drive
*p
= cdi
->handle
;
4177 msg(DBG_IO2
,"ioctl(%s, 0x%08lX, 0x%08lX)\n", cdi
->name
, cmd
, arg
);
4178 if (p
->drv_id
==-1) {
4179 msg(DBG_INF
, "ioctl: bad device: %s\n", cdi
->name
);
4180 return (-ENXIO
); /* no such drive */
4182 down(&ioctl_read_sem
);
4183 if (p
!= current_drive
)
4186 msg(DBG_IO2
,"ioctl: device %s, request %04X\n",cdi
->name
,cmd
);
4187 switch (cmd
) /* Sun-compatible */
4189 case DDIOCSDBG
: /* DDI Debug */
4190 if (!capable(CAP_SYS_ADMIN
)) RETURN_UP(-EPERM
);
4191 i
=sbpcd_dbg_ioctl(arg
,1);
4193 case CDROMRESET
: /* hard reset the drive */
4194 msg(DBG_IOC
,"ioctl: CDROMRESET entered.\n");
4196 current_drive
->audio_state
=0;
4199 case CDROMREADMODE1
:
4200 msg(DBG_IOC
,"ioctl: CDROMREADMODE1 requested.\n");
4202 if (current_drive
->has_data
>1) RETURN_UP(-EBUSY
);
4203 #endif /* SAFE_MIXED */
4204 cc_ModeSelect(CD_FRAMESIZE
);
4206 current_drive
->mode
=READ_M1
;
4209 case CDROMREADMODE2
: /* not usable at the moment */
4210 msg(DBG_IOC
,"ioctl: CDROMREADMODE2 requested.\n");
4212 if (current_drive
->has_data
>1) RETURN_UP(-EBUSY
);
4213 #endif /* SAFE_MIXED */
4214 cc_ModeSelect(CD_FRAMESIZE_RAW1
);
4216 current_drive
->mode
=READ_M2
;
4219 case CDROMAUDIOBUFSIZ
: /* configure the audio buffer size */
4220 msg(DBG_IOC
,"ioctl: CDROMAUDIOBUFSIZ entered.\n");
4221 if (current_drive
->sbp_audsiz
>0) vfree(current_drive
->aud_buf
);
4222 current_drive
->aud_buf
=NULL
;
4223 current_drive
->sbp_audsiz
=arg
;
4225 if (current_drive
->sbp_audsiz
>16)
4227 current_drive
->sbp_audsiz
= 0;
4228 RETURN_UP(current_drive
->sbp_audsiz
);
4231 if (current_drive
->sbp_audsiz
>0)
4233 current_drive
->aud_buf
=(u_char
*) vmalloc(current_drive
->sbp_audsiz
*CD_FRAMESIZE_RAW
);
4234 if (current_drive
->aud_buf
==NULL
)
4236 msg(DBG_INF
,"audio buffer (%d frames) not available.\n",current_drive
->sbp_audsiz
);
4237 current_drive
->sbp_audsiz
=0;
4239 else msg(DBG_INF
,"audio buffer size: %d frames.\n",current_drive
->sbp_audsiz
);
4241 RETURN_UP(current_drive
->sbp_audsiz
);
4243 case CDROMREADAUDIO
:
4244 { /* start of CDROMREADAUDIO */
4245 int i
=0, j
=0, frame
, block
=0;
4249 u_int data_tries
= 0;
4250 u_int data_waits
= 0;
4251 u_int data_retrying
= 0;
4255 msg(DBG_IOC
,"ioctl: CDROMREADAUDIO entered.\n");
4256 if (fam0_drive
) RETURN_UP(-EINVAL
);
4257 if (famL_drive
) RETURN_UP(-EINVAL
);
4258 if (famV_drive
) RETURN_UP(-EINVAL
);
4259 if (famT_drive
) RETURN_UP(-EINVAL
);
4261 if (current_drive
->has_data
>1) RETURN_UP(-EBUSY
);
4262 #endif /* SAFE_MIXED */
4263 if (current_drive
->aud_buf
==NULL
) RETURN_UP(-EINVAL
);
4264 if (copy_from_user(&read_audio
, (void __user
*)arg
,
4265 sizeof(struct cdrom_read_audio
)))
4267 if (read_audio
.nframes
< 0 || read_audio
.nframes
>current_drive
->sbp_audsiz
) RETURN_UP(-EINVAL
);
4268 i
=verify_area(VERIFY_WRITE
, read_audio
.buf
,
4269 read_audio
.nframes
*CD_FRAMESIZE_RAW
);
4270 if (i
) RETURN_UP(i
);
4272 if (read_audio
.addr_format
==CDROM_MSF
) /* MSF-bin specification of where to start */
4273 block
=msf2lba(&read_audio
.addr
.msf
.minute
);
4274 else if (read_audio
.addr_format
==CDROM_LBA
) /* lba specification of where to start */
4275 block
=read_audio
.addr
.lba
;
4276 else RETURN_UP(-EINVAL
);
4278 i
=cc_SetSpeed(speed_150
,0,0);
4279 if (i
) msg(DBG_AUD
,"read_audio: SetSpeed error %d\n", i
);
4281 msg(DBG_AUD
,"read_audio: lba: %d, msf: %06X\n",
4282 block
, blk2msf(block
));
4283 msg(DBG_AUD
,"read_audio: before cc_ReadStatus.\n");
4285 while (busy_data
) sbp_sleep(HZ
/10); /* wait a bit */
4287 #endif /* OLD_BUSY */
4289 for (data_tries
=5; data_tries
>0; data_tries
--)
4291 msg(DBG_AUD
,"data_tries=%d ...\n", data_tries
);
4292 current_drive
->mode
=READ_AU
;
4293 cc_ModeSelect(CD_FRAMESIZE_RAW
);
4295 for (status_tries
=3; status_tries
> 0; status_tries
--)
4297 flags_cmd_out
|= f_respo3
;
4299 if (sbp_status() != 0) break;
4300 if (st_check
) cc_ReadError();
4301 sbp_sleep(1); /* wait a bit, try again */
4303 if (status_tries
== 0)
4305 msg(DBG_AUD
,"read_audio: sbp_status: failed after 3 tries in line %d.\n", __LINE__
);
4308 msg(DBG_AUD
,"read_audio: sbp_status: ok.\n");
4310 flags_cmd_out
= f_putcmd
| f_respo2
| f_ResponseStatus
| f_obey_p_check
;
4313 flags_cmd_out
|= f_lopsta
| f_getsta
| f_bit1
;
4315 drvcmd
[0]=CMD0_READ_XA
; /* "read XA frames", old drives */
4316 drvcmd
[1]=(block
>>16)&0x000000ff;
4317 drvcmd
[2]=(block
>>8)&0x000000ff;
4318 drvcmd
[3]=block
&0x000000ff;
4320 drvcmd
[5]=read_audio
.nframes
; /* # of frames */
4323 else if (fam1_drive
)
4325 drvcmd
[0]=CMD1_READ
; /* "read frames", new drives */
4326 lba2msf(block
,&drvcmd
[1]); /* msf-bin format required */
4329 drvcmd
[6]=read_audio
.nframes
; /* # of frames */
4331 else if (fam2_drive
)
4333 drvcmd
[0]=CMD2_READ_XA2
;
4334 lba2msf(block
,&drvcmd
[1]); /* msf-bin format required */
4336 drvcmd
[5]=read_audio
.nframes
; /* # of frames */
4337 drvcmd
[6]=0x11; /* raw mode */
4339 else if (famT_drive
) /* CD-55A: not tested yet */
4342 msg(DBG_AUD
,"read_audio: before giving \"read\" command.\n");
4343 flags_cmd_out
=f_putcmd
;
4346 if (i
<0) msg(DBG_INF
,"error giving READ AUDIO command: %0d\n", i
);
4348 msg(DBG_AUD
,"read_audio: after giving \"read\" command.\n");
4349 for (frame
=1;frame
<2 && !error_flag
; frame
++)
4352 for (timeout
=jiffies
+9*HZ
; ; )
4354 for ( ; try!=0;try--)
4357 if (!(j
&s_not_data_ready
)) break;
4358 if (!(j
&s_not_result_ready
)) break;
4359 if (fam0L_drive
) if (j
&s_attention
) break;
4361 if (try != 0 || time_after_eq(jiffies
, timeout
)) break;
4362 if (data_retrying
== 0) data_waits
++;
4369 msg(DBG_INF
,"read_audio: sbp_data: CDi_status timeout.\n");
4373 msg(DBG_AUD
,"read_audio: sbp_data: CDi_status ok.\n");
4374 if (j
&s_not_data_ready
)
4376 msg(DBG_INF
, "read_audio: sbp_data: DATA_READY timeout.\n");
4380 msg(DBG_AUD
,"read_audio: before reading data.\n");
4382 p
= current_drive
->aud_buf
;
4383 if (sbpro_type
==1) OUT(CDo_sel_i_d
,1);
4386 u_short
*p2
= (u_short
*) p
;
4388 for (; (u_char
*) p2
< current_drive
->aud_buf
+ read_audio
.nframes
*CD_FRAMESIZE_RAW
;)
4390 if ((inb_p(CDi_status
)&s_not_data_ready
)) continue;
4392 /* get one sample */
4393 *p2
++ = inw_p(CDi_data
);
4394 *p2
++ = inw_p(CDi_data
);
4397 for (; p
< current_drive
->aud_buf
+ read_audio
.nframes
*CD_FRAMESIZE_RAW
;)
4399 if ((inb_p(CDi_status
)&s_not_data_ready
)) continue;
4401 /* get one sample */
4402 *p
++ = inb_p(CDi_data
);
4403 *p
++ = inb_p(CDi_data
);
4404 *p
++ = inb_p(CDi_data
);
4405 *p
++ = inb_p(CDi_data
);
4408 if (sbpro_type
==1) OUT(CDo_sel_i_d
,0);
4411 msg(DBG_AUD
,"read_audio: after reading data.\n");
4412 if (error_flag
) /* must have been spurious D_RDY or (ATTN&&!D_RDY) */
4414 msg(DBG_AUD
,"read_audio: read aborted by drive\n");
4416 i
=cc_DriveReset(); /* ugly fix to prevent a hang */
4425 for (timeout
=jiffies
+9*HZ
; time_before(jiffies
, timeout
); timeout
--)
4430 if (!(j
&s_not_data_ready
)) break;
4431 if (!(j
&s_not_result_ready
)) break;
4432 if (j
&s_attention
) break;
4434 if (i
!= 0 || time_after_eq(jiffies
, timeout
)) break;
4438 if (i
==0) msg(DBG_AUD
,"read_audio: STATUS TIMEOUT AFTER READ");
4439 if (!(j
&s_attention
))
4441 msg(DBG_AUD
,"read_audio: sbp_data: timeout waiting DRV_ATTN - retrying\n");
4442 i
=cc_DriveReset(); /* ugly fix to prevent a hang */
4448 if (fam0L_drive
) cc_ReadStatus();
4449 i
=ResponseStatus(); /* builds status_bits, returns orig. status (old) or faked p_success (new) */
4450 if (i
<0) { msg(DBG_AUD
,
4451 "read_audio: cc_ReadStatus error after read: %02X\n",
4452 current_drive
->status_bits
);
4453 continue; /* FIXME */
4456 while ((fam0L_drive
)&&(!st_check
)&&(!(i
&p_success
)));
4460 msg(DBG_AUD
,"read_audio: cc_ReadError was necessary after read: %02X\n",i
);
4463 if (copy_to_user(read_audio
.buf
,
4464 current_drive
->aud_buf
,
4465 read_audio
.nframes
* CD_FRAMESIZE_RAW
))
4467 msg(DBG_AUD
,"read_audio: copy_to_user done.\n");
4470 cc_ModeSelect(CD_FRAMESIZE
);
4472 current_drive
->mode
=READ_M1
;
4475 #endif /* OLD_BUSY */
4476 if (data_tries
== 0)
4478 msg(DBG_AUD
,"read_audio: failed after 5 tries in line %d.\n", __LINE__
);
4481 msg(DBG_AUD
,"read_audio: successful return.\n");
4483 } /* end of CDROMREADAUDIO */
4486 msg(DBG_IOC
,"ioctl: unknown function request %04X\n", cmd
);
4488 } /* end switch(cmd) */
4491 static int sbpcd_audio_ioctl(struct cdrom_device_info
*cdi
, u_int cmd
,
4494 struct sbpcd_drive
*p
= cdi
->handle
;
4497 msg(DBG_IO2
,"ioctl(%s, 0x%08lX, 0x%08p)\n", cdi
->name
, cmd
, arg
);
4498 if (p
->drv_id
==-1) {
4499 msg(DBG_INF
, "ioctl: bad device: %s\n", cdi
->name
);
4500 return (-ENXIO
); /* no such drive */
4502 down(&ioctl_read_sem
);
4503 if (p
!= current_drive
)
4506 msg(DBG_IO2
,"ioctl: device %s, request %04X\n",cdi
->name
,cmd
);
4507 switch (cmd
) /* Sun-compatible */
4510 case CDROMPAUSE
: /* Pause the drive */
4511 msg(DBG_IOC
,"ioctl: CDROMPAUSE entered.\n");
4512 /* pause the drive unit when it is currently in PLAY mode, */
4513 /* or reset the starting and ending locations when in PAUSED mode. */
4514 /* If applicable, at the next stopping point it reaches */
4515 /* the drive will discontinue playing. */
4516 switch (current_drive
->audio_state
)
4519 if (famL_drive
) i
=cc_ReadSubQ();
4520 else i
=cc_Pause_Resume(1);
4521 if (i
<0) RETURN_UP(-EIO
);
4522 if (famL_drive
) i
=cc_Pause_Resume(1);
4523 else i
=cc_ReadSubQ();
4524 if (i
<0) RETURN_UP(-EIO
);
4525 current_drive
->pos_audio_start
=current_drive
->SubQ_run_tot
;
4526 current_drive
->audio_state
=audio_pausing
;
4529 i
=cc_Seek(current_drive
->pos_audio_start
,1);
4530 if (i
<0) RETURN_UP(-EIO
);
4536 case CDROMRESUME
: /* resume paused audio play */
4537 msg(DBG_IOC
,"ioctl: CDROMRESUME entered.\n");
4538 /* resume playing audio tracks when a previous PLAY AUDIO call has */
4539 /* been paused with a PAUSE command. */
4540 /* It will resume playing from the location saved in SubQ_run_tot. */
4541 if (current_drive
->audio_state
!=audio_pausing
) RETURN_UP(-EINVAL
);
4543 i
=cc_PlayAudio(current_drive
->pos_audio_start
,
4544 current_drive
->pos_audio_end
);
4545 else i
=cc_Pause_Resume(3);
4546 if (i
<0) RETURN_UP(-EIO
);
4547 current_drive
->audio_state
=audio_playing
;
4551 msg(DBG_IOC
,"ioctl: CDROMPLAYMSF entered.\n");
4553 if (current_drive
->has_data
>1) RETURN_UP(-EBUSY
);
4554 #endif /* SAFE_MIXED */
4555 if (current_drive
->audio_state
==audio_playing
)
4557 i
=cc_Pause_Resume(1);
4558 if (i
<0) RETURN_UP(-EIO
);
4560 if (i
<0) RETURN_UP(-EIO
);
4561 current_drive
->pos_audio_start
=current_drive
->SubQ_run_tot
;
4562 i
=cc_Seek(current_drive
->pos_audio_start
,1);
4564 memcpy(&msf
, (void *) arg
, sizeof(struct cdrom_msf
));
4565 /* values come as msf-bin */
4566 current_drive
->pos_audio_start
= (msf
.cdmsf_min0
<<16) |
4567 (msf
.cdmsf_sec0
<<8) |
4569 current_drive
->pos_audio_end
= (msf
.cdmsf_min1
<<16) |
4570 (msf
.cdmsf_sec1
<<8) |
4572 msg(DBG_IOX
,"ioctl: CDROMPLAYMSF %08X %08X\n",
4573 current_drive
->pos_audio_start
,current_drive
->pos_audio_end
);
4574 i
=cc_PlayAudio(current_drive
->pos_audio_start
,current_drive
->pos_audio_end
);
4577 msg(DBG_INF
,"ioctl: cc_PlayAudio returns %d\n",i
);
4579 current_drive
->audio_state
=0;
4582 current_drive
->audio_state
=audio_playing
;
4585 case CDROMPLAYTRKIND
: /* Play a track. This currently ignores index. */
4586 msg(DBG_IOC
,"ioctl: CDROMPLAYTRKIND entered.\n");
4588 if (current_drive
->has_data
>1) RETURN_UP(-EBUSY
);
4589 #endif /* SAFE_MIXED */
4590 if (current_drive
->audio_state
==audio_playing
)
4592 msg(DBG_IOX
,"CDROMPLAYTRKIND: already audio_playing.\n");
4594 RETURN_UP(0); /* just let us play on */
4596 RETURN_UP(-EINVAL
); /* play on, but say "error" */
4599 memcpy(&ti
,(void *) arg
,sizeof(struct cdrom_ti
));
4600 msg(DBG_IOX
,"ioctl: trk0: %d, ind0: %d, trk1:%d, ind1:%d\n",
4601 ti
.cdti_trk0
,ti
.cdti_ind0
,ti
.cdti_trk1
,ti
.cdti_ind1
);
4602 if (ti
.cdti_trk0
<current_drive
->n_first_track
) RETURN_UP(-EINVAL
);
4603 if (ti
.cdti_trk0
>current_drive
->n_last_track
) RETURN_UP(-EINVAL
);
4604 if (ti
.cdti_trk1
<ti
.cdti_trk0
) ti
.cdti_trk1
=ti
.cdti_trk0
;
4605 if (ti
.cdti_trk1
>current_drive
->n_last_track
) ti
.cdti_trk1
=current_drive
->n_last_track
;
4606 current_drive
->pos_audio_start
=current_drive
->TocBuffer
[ti
.cdti_trk0
].address
;
4607 current_drive
->pos_audio_end
=current_drive
->TocBuffer
[ti
.cdti_trk1
+1].address
;
4608 i
=cc_PlayAudio(current_drive
->pos_audio_start
,current_drive
->pos_audio_end
);
4611 msg(DBG_INF
,"ioctl: cc_PlayAudio returns %d\n",i
);
4613 current_drive
->audio_state
=0;
4616 current_drive
->audio_state
=audio_playing
;
4619 case CDROMREADTOCHDR
: /* Read the table of contents header */
4620 msg(DBG_IOC
,"ioctl: CDROMREADTOCHDR entered.\n");
4621 tochdr
.cdth_trk0
=current_drive
->n_first_track
;
4622 tochdr
.cdth_trk1
=current_drive
->n_last_track
;
4623 memcpy((void *) arg
, &tochdr
, sizeof(struct cdrom_tochdr
));
4626 case CDROMREADTOCENTRY
: /* Read an entry in the table of contents */
4627 msg(DBG_IOC
,"ioctl: CDROMREADTOCENTRY entered.\n");
4628 memcpy(&tocentry
, (void *) arg
, sizeof(struct cdrom_tocentry
));
4629 i
=tocentry
.cdte_track
;
4630 if (i
==CDROM_LEADOUT
) i
=current_drive
->n_last_track
+1;
4631 else if (i
<current_drive
->n_first_track
||i
>current_drive
->n_last_track
)
4633 tocentry
.cdte_adr
=current_drive
->TocBuffer
[i
].ctl_adr
&0x0F;
4634 tocentry
.cdte_ctrl
=(current_drive
->TocBuffer
[i
].ctl_adr
>>4)&0x0F;
4635 tocentry
.cdte_datamode
=current_drive
->TocBuffer
[i
].format
;
4636 if (tocentry
.cdte_format
==CDROM_MSF
) /* MSF-bin required */
4638 tocentry
.cdte_addr
.msf
.minute
=(current_drive
->TocBuffer
[i
].address
>>16)&0x00FF;
4639 tocentry
.cdte_addr
.msf
.second
=(current_drive
->TocBuffer
[i
].address
>>8)&0x00FF;
4640 tocentry
.cdte_addr
.msf
.frame
=current_drive
->TocBuffer
[i
].address
&0x00FF;
4642 else if (tocentry
.cdte_format
==CDROM_LBA
) /* blk required */
4643 tocentry
.cdte_addr
.lba
=msf2blk(current_drive
->TocBuffer
[i
].address
);
4644 else RETURN_UP(-EINVAL
);
4645 memcpy((void *) arg
, &tocentry
, sizeof(struct cdrom_tocentry
));
4648 case CDROMSTOP
: /* Spin down the drive */
4649 msg(DBG_IOC
,"ioctl: CDROMSTOP entered.\n");
4651 if (current_drive
->has_data
>1) RETURN_UP(-EBUSY
);
4652 #endif /* SAFE_MIXED */
4653 i
=cc_Pause_Resume(1);
4654 current_drive
->audio_state
=0;
4660 case CDROMSTART
: /* Spin up the drive */
4661 msg(DBG_IOC
,"ioctl: CDROMSTART entered.\n");
4663 current_drive
->audio_state
=0;
4666 case CDROMVOLCTRL
: /* Volume control */
4667 msg(DBG_IOC
,"ioctl: CDROMVOLCTRL entered.\n");
4668 memcpy(&volctrl
,(char *) arg
,sizeof(volctrl
));
4669 current_drive
->vol_chan0
=0;
4670 current_drive
->vol_ctrl0
=volctrl
.channel0
;
4671 current_drive
->vol_chan1
=1;
4672 current_drive
->vol_ctrl1
=volctrl
.channel1
;
4676 case CDROMVOLREAD
: /* read Volume settings from drive */
4677 msg(DBG_IOC
,"ioctl: CDROMVOLREAD entered.\n");
4679 if (st
<0) RETURN_UP(st
);
4680 volctrl
.channel0
=current_drive
->vol_ctrl0
;
4681 volctrl
.channel1
=current_drive
->vol_ctrl1
;
4684 memcpy((void *)arg
,&volctrl
,sizeof(volctrl
));
4687 case CDROMSUBCHNL
: /* Get subchannel info */
4688 msg(DBG_IOS
,"ioctl: CDROMSUBCHNL entered.\n");
4689 /* Bogus, I can do better than this! --AJK
4690 if ((st_spinning)||(!subq_valid)) {
4692 if (i<0) RETURN_UP(-EIO);
4697 j
=cc_ReadError(); /* clear out error status from drive */
4698 current_drive
->audio_state
=CDROM_AUDIO_NO_STATUS
;
4699 /* get and set the disk state here,
4700 probably not the right place, but who cares!
4701 It makes it work properly! --AJK */
4702 if (current_drive
->CD_changed
==0xFF) {
4703 msg(DBG_000
,"Disk changed detect\n");
4704 current_drive
->diskstate_flags
&= ~cd_size_bit
;
4708 if (current_drive
->CD_changed
==0xFF) {
4709 /* reread the TOC because the disk has changed! --AJK */
4710 msg(DBG_000
,"Disk changed STILL detected, rereading TOC!\n");
4713 current_drive
->CD_changed
=0x00; /* cd has changed, procede, */
4714 RETURN_UP(-EIO
); /* and get TOC, etc on next try! --AJK */
4716 RETURN_UP(-EIO
); /* we weren't ready yet! --AJK */
4719 memcpy(&SC
, (void *) arg
, sizeof(struct cdrom_subchnl
));
4721 This virtual crap is very bogus!
4722 It doesn't detect when the cd is done playing audio!
4723 Lets do this right with proper hardware register reading!
4727 msg(DBG_000
,"Drive Status: door_locked =%d.\n", st_door_locked
);
4728 msg(DBG_000
,"Drive Status: door_closed =%d.\n", st_door_closed
);
4729 msg(DBG_000
,"Drive Status: caddy_in =%d.\n", st_caddy_in
);
4730 msg(DBG_000
,"Drive Status: disk_ok =%d.\n", st_diskok
);
4731 msg(DBG_000
,"Drive Status: spinning =%d.\n", st_spinning
);
4732 msg(DBG_000
,"Drive Status: busy =%d.\n", st_busy
);
4733 /* st_busy indicates if it's _ACTUALLY_ playing audio */
4734 switch (current_drive
->audio_state
)
4738 /* CD has stopped playing audio --AJK */
4739 current_drive
->audio_state
=audio_completed
;
4740 SC
.cdsc_audiostatus
=CDROM_AUDIO_COMPLETED
;
4742 SC
.cdsc_audiostatus
=CDROM_AUDIO_PLAY
;
4746 SC
.cdsc_audiostatus
=CDROM_AUDIO_PAUSED
;
4748 case audio_completed
:
4749 SC
.cdsc_audiostatus
=CDROM_AUDIO_COMPLETED
;
4752 SC
.cdsc_audiostatus
=CDROM_AUDIO_NO_STATUS
;
4755 SC
.cdsc_adr
=current_drive
->SubQ_ctl_adr
;
4756 SC
.cdsc_ctrl
=current_drive
->SubQ_ctl_adr
>>4;
4757 SC
.cdsc_trk
=bcd2bin(current_drive
->SubQ_trk
);
4758 SC
.cdsc_ind
=bcd2bin(current_drive
->SubQ_pnt_idx
);
4759 if (SC
.cdsc_format
==CDROM_LBA
)
4761 SC
.cdsc_absaddr
.lba
=msf2blk(current_drive
->SubQ_run_tot
);
4762 SC
.cdsc_reladdr
.lba
=msf2blk(current_drive
->SubQ_run_trk
);
4764 else /* not only if (SC.cdsc_format==CDROM_MSF) */
4766 SC
.cdsc_absaddr
.msf
.minute
=(current_drive
->SubQ_run_tot
>>16)&0x00FF;
4767 SC
.cdsc_absaddr
.msf
.second
=(current_drive
->SubQ_run_tot
>>8)&0x00FF;
4768 SC
.cdsc_absaddr
.msf
.frame
=current_drive
->SubQ_run_tot
&0x00FF;
4769 SC
.cdsc_reladdr
.msf
.minute
=(current_drive
->SubQ_run_trk
>>16)&0x00FF;
4770 SC
.cdsc_reladdr
.msf
.second
=(current_drive
->SubQ_run_trk
>>8)&0x00FF;
4771 SC
.cdsc_reladdr
.msf
.frame
=current_drive
->SubQ_run_trk
&0x00FF;
4773 memcpy((void *) arg
, &SC
, sizeof(struct cdrom_subchnl
));
4774 msg(DBG_IOS
,"CDROMSUBCHNL: %1X %02X %08X %08X %02X %02X %06X %06X\n",
4775 SC
.cdsc_format
,SC
.cdsc_audiostatus
,
4776 SC
.cdsc_adr
,SC
.cdsc_ctrl
,
4777 SC
.cdsc_trk
,SC
.cdsc_ind
,
4778 SC
.cdsc_absaddr
,SC
.cdsc_reladdr
);
4782 msg(DBG_IOC
,"ioctl: unknown function request %04X\n", cmd
);
4784 } /* end switch(cmd) */
4786 /*==========================================================================*/
4788 * Take care of the different block sizes between cdrom and Linux.
4790 static void sbp_transfer(struct request
*req
)
4794 while ( (req
->nr_sectors
> 0) &&
4795 (req
->sector
/4 >= current_drive
->sbp_first_frame
) &&
4796 (req
->sector
/4 <= current_drive
->sbp_last_frame
) )
4798 offs
= (req
->sector
- current_drive
->sbp_first_frame
* 4) * 512;
4799 memcpy(req
->buffer
, current_drive
->sbp_buf
+ offs
, 512);
4805 /*==========================================================================*/
4807 * special end_request for sbpcd to solve CURRENT==NULL bug. (GTL)
4808 * GTL = Gonzalo Tornaria <tornaria@cmat.edu.uy>
4810 * This is a kludge so we don't need to modify end_request.
4811 * We put the req we take out after INIT_REQUEST in the requests list,
4812 * so that end_request will discard it.
4814 * The bug could be present in other block devices, perhaps we
4815 * should modify INIT_REQUEST and end_request instead, and
4816 * change every block device..
4818 * Could be a race here?? Could e.g. a timer interrupt schedule() us?
4819 * If so, we should copy end_request here, and do it right.. (or
4820 * modify end_request and the block devices).
4822 * In any case, the race here would be much small than it was, and
4823 * I couldn't reproduce..
4825 * The race could be: suppose CURRENT==NULL. We put our req in the list,
4826 * and we are scheduled. Other process takes over, and gets into
4827 * do_sbpcd_request. It sees CURRENT!=NULL (it is == to our req), so
4828 * proceeds. It ends, so CURRENT is now NULL.. Now we awake somewhere in
4829 * end_request, but now CURRENT==NULL... oops!
4834 /*==========================================================================*/
4836 * I/O request routine, called from Linux kernel.
4838 static void do_sbpcd_request(request_queue_t
* q
)
4842 int status_tries
, data_tries
;
4843 struct request
*req
;
4844 struct sbpcd_drive
*p
;
4854 req
= elv_next_request(q
);
4858 printk( "do_sbpcd_request[%di](NULL), Pid:%d, Time:%li\n",
4859 xnr
, current
->pid
, jiffies
);
4860 printk( "do_sbpcd_request[%do](NULL) end 0 (null), Time:%li\n",
4865 printk(" do_sbpcd_request[%di](%p:%ld+%ld), Pid:%d, Time:%li\n",
4866 xnr
, req
, req
->sector
, req
->nr_sectors
, current
->pid
, jiffies
);
4869 req
= elv_next_request(q
); /* take out our request so no other */
4873 if (req
-> sector
== -1)
4874 end_request(req
, 0);
4875 spin_unlock_irq(q
->queue_lock
);
4877 down(&ioctl_read_sem
);
4878 if (rq_data_dir(elv_next_request(q
)) != READ
)
4880 msg(DBG_INF
, "bad cmd %d\n", req
->cmd
[0]);
4883 p
= req
->rq_disk
->private_data
;
4885 while (busy_audio
) sbp_sleep(HZ
); /* wait a bit */
4887 #endif /* OLD_BUSY */
4889 if (p
->audio_state
==audio_playing
) goto err_done
;
4890 if (p
!= current_drive
)
4893 block
= req
->sector
; /* always numbered as 512-byte-pieces */
4894 nsect
= req
->nr_sectors
; /* always counted as 512-byte-pieces */
4896 msg(DBG_BSZ
,"read sector %d (%d sectors)\n", block
, nsect
);
4898 msg(DBG_MUL
,"read LBA %d\n", block
/4);
4902 /* if we satisfied the request from the buffer, we're done. */
4903 if (req
->nr_sectors
== 0)
4906 printk(" do_sbpcd_request[%do](%p:%ld+%ld) end 2, Time:%li\n",
4907 xnr
, req
, req
->sector
, req
->nr_sectors
, jiffies
);
4909 up(&ioctl_read_sem
);
4910 spin_lock_irq(q
->queue_lock
);
4911 end_request(req
, 1);
4916 i
=prepare(0,0); /* at moment not really a hassle check, but ... */
4918 msg(DBG_INF
,"\"prepare\" tells error %d -- ignored\n", i
);
4921 if (!st_spinning
) cc_SpinUp();
4923 for (data_tries
=n_retries
; data_tries
> 0; data_tries
--)
4925 for (status_tries
=3; status_tries
> 0; status_tries
--)
4927 flags_cmd_out
|= f_respo3
;
4929 if (sbp_status() != 0) break;
4930 if (st_check
) cc_ReadError();
4931 sbp_sleep(1); /* wait a bit, try again */
4933 if (status_tries
== 0)
4935 msg(DBG_INF
,"sbp_status: failed after 3 tries in line %d\n", __LINE__
);
4941 if (sbp_data(req
) != 0)
4944 current_drive
->has_data
=2; /* is really a data disk */
4945 #endif /* SAFE_MIXED */
4947 printk(" do_sbpcd_request[%do](%p:%ld+%ld) end 3, Time:%li\n",
4948 xnr
, req
, req
->sector
, req
->nr_sectors
, jiffies
);
4950 up(&ioctl_read_sem
);
4951 spin_lock_irq(q
->queue_lock
);
4952 end_request(req
, 1);
4960 #endif /* OLD_BUSY */
4962 printk(" do_sbpcd_request[%do](%p:%ld+%ld) end 4 (error), Time:%li\n",
4963 xnr
, req
, req
->sector
, req
->nr_sectors
, jiffies
);
4965 up(&ioctl_read_sem
);
4966 sbp_sleep(0); /* wait a bit, try again */
4967 spin_lock_irq(q
->queue_lock
);
4968 end_request(req
, 0);
4971 /*==========================================================================*/
4973 * build and send the READ command.
4975 static void sbp_read_cmd(struct request
*req
)
4982 current_drive
->sbp_first_frame
=current_drive
->sbp_last_frame
=-1; /* purge buffer */
4983 current_drive
->sbp_current
= 0;
4984 block
=req
->sector
/4;
4985 if (block
+current_drive
->sbp_bufsiz
<= current_drive
->CDsize_frm
)
4986 current_drive
->sbp_read_frames
= current_drive
->sbp_bufsiz
;
4989 current_drive
->sbp_read_frames
=current_drive
->CDsize_frm
-block
;
4990 /* avoid reading past end of data */
4991 if (current_drive
->sbp_read_frames
< 1)
4993 msg(DBG_INF
,"requested frame %d, CD size %d ???\n",
4994 block
, current_drive
->CDsize_frm
);
4995 current_drive
->sbp_read_frames
=1;
4999 flags_cmd_out
= f_putcmd
| f_respo2
| f_ResponseStatus
| f_obey_p_check
;
5003 drvcmd
[0]=CMDV_READ
;
5004 lba2msf(block
,&drvcmd
[1]); /* msf-bcd format required */
5005 bin2bcdx(&drvcmd
[1]);
5006 bin2bcdx(&drvcmd
[2]);
5007 bin2bcdx(&drvcmd
[3]);
5008 drvcmd
[4]=current_drive
->sbp_read_frames
>>8;
5009 drvcmd
[5]=current_drive
->sbp_read_frames
&0xff;
5010 drvcmd
[6]=0x02; /* flag "msf-bcd" */
5012 else if (fam0L_drive
)
5014 flags_cmd_out
|= f_lopsta
| f_getsta
| f_bit1
;
5015 if (current_drive
->xa_byte
==0x20)
5018 drvcmd
[0]=CMD0_READ_XA
; /* "read XA frames", old drives */
5019 drvcmd
[1]=(block
>>16)&0x0ff;
5020 drvcmd
[2]=(block
>>8)&0x0ff;
5021 drvcmd
[3]=block
&0x0ff;
5022 drvcmd
[4]=(current_drive
->sbp_read_frames
>>8)&0x0ff;
5023 drvcmd
[5]=current_drive
->sbp_read_frames
&0x0ff;
5027 drvcmd
[0]=CMD0_READ
; /* "read frames", old drives */
5028 if (current_drive
->drv_type
>=drv_201
)
5030 lba2msf(block
,&drvcmd
[1]); /* msf-bcd format required */
5031 bin2bcdx(&drvcmd
[1]);
5032 bin2bcdx(&drvcmd
[2]);
5033 bin2bcdx(&drvcmd
[3]);
5037 drvcmd
[1]=(block
>>16)&0x0ff;
5038 drvcmd
[2]=(block
>>8)&0x0ff;
5039 drvcmd
[3]=block
&0x0ff;
5041 drvcmd
[4]=(current_drive
->sbp_read_frames
>>8)&0x0ff;
5042 drvcmd
[5]=current_drive
->sbp_read_frames
&0x0ff;
5043 drvcmd
[6]=(current_drive
->drv_type
<drv_201
)?0:2; /* flag "lba or msf-bcd format" */
5046 else if (fam1_drive
)
5048 drvcmd
[0]=CMD1_READ
;
5049 lba2msf(block
,&drvcmd
[1]); /* msf-bin format required */
5050 drvcmd
[5]=(current_drive
->sbp_read_frames
>>8)&0x0ff;
5051 drvcmd
[6]=current_drive
->sbp_read_frames
&0x0ff;
5053 else if (fam2_drive
)
5055 drvcmd
[0]=CMD2_READ
;
5056 lba2msf(block
,&drvcmd
[1]); /* msf-bin format required */
5057 drvcmd
[4]=(current_drive
->sbp_read_frames
>>8)&0x0ff;
5058 drvcmd
[5]=current_drive
->sbp_read_frames
&0x0ff;
5061 else if (famT_drive
)
5063 drvcmd
[0]=CMDT_READ
;
5064 drvcmd
[2]=(block
>>24)&0x0ff;
5065 drvcmd
[3]=(block
>>16)&0x0ff;
5066 drvcmd
[4]=(block
>>8)&0x0ff;
5067 drvcmd
[5]=block
&0x0ff;
5068 drvcmd
[7]=(current_drive
->sbp_read_frames
>>8)&0x0ff;
5069 drvcmd
[8]=current_drive
->sbp_read_frames
&0x0ff;
5071 flags_cmd_out
=f_putcmd
;
5074 if (i
<0) msg(DBG_INF
,"error giving READ command: %0d\n", i
);
5077 /*==========================================================================*/
5079 * Check the completion of the read-data command. On success, read
5080 * the current_drive->sbp_bufsiz * 2048 bytes of data from the disk into buffer.
5082 static int sbp_data(struct request
*req
)
5084 int i
=0, j
=0, l
, frame
;
5088 u_int data_tries
= 0;
5089 u_int data_waits
= 0;
5090 u_int data_retrying
= 0;
5103 if (current_drive
->f_multisession
) max_latency
=15*HZ
;
5104 else max_latency
=5*HZ
;
5107 for (frame
=0;frame
<current_drive
->sbp_read_frames
&&!error_flag
; frame
++)
5111 del_timer(&data_timer
);
5112 data_timer
.expires
=jiffies
+max_latency
;
5114 add_timer(&data_timer
);
5115 while (!timed_out_data
)
5117 if (current_drive
->f_multisession
) try=maxtim_data
*4;
5118 else try=maxtim_data
;
5119 msg(DBG_000
,"sbp_data: CDi_status loop: try=%d.\n",try);
5120 for ( ; try!=0;try--)
5123 if (!(j
&s_not_data_ready
)) break;
5124 if (!(j
&s_not_result_ready
)) break;
5125 if (fam0LV_drive
) if (j
&s_attention
) break;
5127 if (!(j
&s_not_data_ready
)) goto data_ready
;
5130 if (data_retrying
== 0) data_waits
++;
5132 msg(DBG_000
,"sbp_data: CDi_status loop: sleeping.\n");
5137 msg(DBG_INF
,"sbp_data: CDi_status loop expired.\n");
5139 del_timer(&data_timer
);
5143 msg(DBG_INF
,"sbp_data: CDi_status timeout (timed_out_data) (%02X).\n", j
);
5148 msg(DBG_INF
,"sbp_data: CDi_status timeout (try=0) (%02X).\n", j
);
5151 if (!(j
&s_not_result_ready
))
5153 msg(DBG_INF
, "sbp_data: RESULT_READY where DATA_READY awaited (%02X).\n", j
);
5158 if (j
&s_not_data_ready
)
5160 if ((current_drive
->ored_ctl_adr
&0x40)==0)
5161 msg(DBG_INF
, "CD contains no data tracks.\n");
5162 else msg(DBG_INF
, "sbp_data: DATA_READY timeout (%02X).\n", j
);
5166 if (error_flag
) break;
5168 msg(DBG_000
, "sbp_data: beginning to read.\n");
5169 p
= current_drive
->sbp_buf
+ frame
* CD_FRAMESIZE
;
5170 if (sbpro_type
==1) OUT(CDo_sel_i_d
,1);
5171 if (cmd_type
==READ_M2
) {
5172 if (do_16bit
) insw(CDi_data
, xa_head_buf
, CD_XA_HEAD
>>1);
5173 else insb(CDi_data
, xa_head_buf
, CD_XA_HEAD
);
5175 if (do_16bit
) insw(CDi_data
, p
, CD_FRAMESIZE
>>1);
5176 else insb(CDi_data
, p
, CD_FRAMESIZE
);
5177 if (cmd_type
==READ_M2
) {
5178 if (do_16bit
) insw(CDi_data
, xa_tail_buf
, CD_XA_TAIL
>>1);
5179 else insb(CDi_data
, xa_tail_buf
, CD_XA_TAIL
);
5181 current_drive
->sbp_current
++;
5182 if (sbpro_type
==1) OUT(CDo_sel_i_d
,0);
5183 if (cmd_type
==READ_M2
)
5185 for (xa_count
=0;xa_count
<CD_XA_HEAD
;xa_count
++)
5186 sprintf(&msgbuf
[xa_count
*3], " %02X", xa_head_buf
[xa_count
]);
5187 msgbuf
[xa_count
*3]=0;
5188 msg(DBG_XA1
,"xa head:%s\n", msgbuf
);
5192 if (data_tries
>= 1000)
5194 msg(DBG_INF
,"sbp_data() statistics: %d waits in %d frames.\n", data_waits
, data_tries
);
5195 data_waits
= data_tries
= 0;
5198 duration
=jiffies
-duration
;
5199 msg(DBG_TEA
,"time to read %d frames: %d jiffies .\n",frame
,duration
);
5207 if ((i
=CDi_stat_loop_T()) == -1) break;
5215 if (!(i
&s_not_data_ready
))
5221 if (do_16bit
) i
=inw(CDi_data
);
5222 else i
=inb(CDi_data
);
5226 while (!(i
&s_not_data_ready
));
5227 msg(DBG_TEA
, "==========too much data (%d bytes/words)==============.\n", j
);
5229 if (!(i
&s_not_result_ready
))
5235 infobuf
[l
++]=inb(CDi_info
);
5238 while (!(i
&s_not_result_ready
));
5239 if (infobuf
[0]==0x00) success
=1;
5241 for (j
=0;j
<l
;j
++) sprintf(&msgbuf
[j
*3], " %02X", infobuf
[j
]);
5243 msg(DBG_TEA
,"sbp_data info response:%s\n", msgbuf
);
5245 if (infobuf
[0]==0x02)
5251 if (recursion
>1) msg(DBG_TEA
,"cmd_out_T READ_ERR recursion (sbp_data): %d !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!\n",recursion
);
5252 else msg(DBG_TEA
,"sbp_data: CMDT_READ_ERR necessary.\n");
5254 drvcmd
[0]=CMDT_READ_ERR
;
5255 j
=cmd_out_T(); /* !!! recursive here !!! */
5260 current_drive
->error_state
=infobuf
[2];
5261 current_drive
->b3
=infobuf
[3];
5262 current_drive
->b4
=infobuf
[4];
5269 msg(DBG_TEA
, "============= waiting for result=================.\n");
5277 if (error_flag
) /* must have been spurious D_RDY or (ATTN&&!D_RDY) */
5279 msg(DBG_TEA
, "================error flag: %d=================.\n", error_flag
);
5280 msg(DBG_INF
,"sbp_data: read aborted by drive.\n");
5282 i
=cc_DriveReset(); /* ugly fix to prevent a hang */
5293 for (timeout
=jiffies
+HZ
; time_before(jiffies
, timeout
); timeout
--)
5298 if (!(j
&s_not_data_ready
)) break;
5299 if (!(j
&s_not_result_ready
)) break;
5300 if (j
&s_attention
) break;
5302 if (i
!= 0 || time_after_eq(jiffies
, timeout
)) break;
5306 if (i
==0) msg(DBG_INF
,"status timeout after READ.\n");
5307 if (!(j
&s_attention
))
5309 msg(DBG_INF
,"sbp_data: timeout waiting DRV_ATTN - retrying.\n");
5310 i
=cc_DriveReset(); /* ugly fix to prevent a hang */
5322 if (fam0LV_drive
) cc_ReadStatus();
5324 if (famT_drive
) msg(DBG_TEA
, "================before ResponseStatus=================.\n", i
);
5326 i
=ResponseStatus(); /* builds status_bits, returns orig. status (old) or faked p_success (new) */
5328 if (famT_drive
) msg(DBG_TEA
, "================ResponseStatus: %d=================.\n", i
);
5332 msg(DBG_INF
,"bad cc_ReadStatus after read: %02X\n", current_drive
->status_bits
);
5336 while ((fam0LV_drive
)&&(!st_check
)&&(!(i
&p_success
)));
5340 msg(DBG_INF
,"cc_ReadError was necessary after read: %d\n",i
);
5346 current_drive
->sbp_first_frame
=current_drive
->sbp_last_frame
=-1; /* purge buffer */
5347 current_drive
->sbp_current
= 0;
5348 msg(DBG_INF
,"sbp_data: fatal_err - retrying.\n");
5352 current_drive
->sbp_first_frame
= req
-> sector
/ 4;
5353 current_drive
->sbp_last_frame
= current_drive
->sbp_first_frame
+ current_drive
->sbp_read_frames
- 1;
5357 /*==========================================================================*/
5359 static int sbpcd_block_open(struct inode
*inode
, struct file
*file
)
5361 struct sbpcd_drive
*p
= inode
->i_bdev
->bd_disk
->private_data
;
5362 return cdrom_open(p
->sbpcd_infop
, inode
, file
);
5365 static int sbpcd_block_release(struct inode
*inode
, struct file
*file
)
5367 struct sbpcd_drive
*p
= inode
->i_bdev
->bd_disk
->private_data
;
5368 return cdrom_release(p
->sbpcd_infop
, file
);
5371 static int sbpcd_block_ioctl(struct inode
*inode
, struct file
*file
,
5372 unsigned cmd
, unsigned long arg
)
5374 struct sbpcd_drive
*p
= inode
->i_bdev
->bd_disk
->private_data
;
5375 return cdrom_ioctl(file
, p
->sbpcd_infop
, inode
, cmd
, arg
);
5378 static int sbpcd_block_media_changed(struct gendisk
*disk
)
5380 struct sbpcd_drive
*p
= disk
->private_data
;
5381 return cdrom_media_changed(p
->sbpcd_infop
);
5384 static struct block_device_operations sbpcd_bdops
=
5386 .owner
= THIS_MODULE
,
5387 .open
= sbpcd_block_open
,
5388 .release
= sbpcd_block_release
,
5389 .ioctl
= sbpcd_block_ioctl
,
5390 .media_changed
= sbpcd_block_media_changed
,
5392 /*==========================================================================*/
5394 * Open the device special file. Check that a disk is in. Read TOC.
5396 static int sbpcd_open(struct cdrom_device_info
*cdi
, int purpose
)
5398 struct sbpcd_drive
*p
= cdi
->handle
;
5400 down(&ioctl_read_sem
);
5404 * try to keep an "open" counter here and lock the door if 0->1.
5406 msg(DBG_LCK
,"open_count: %d -> %d\n",
5407 current_drive
->open_count
,current_drive
->open_count
+1);
5408 if (++current_drive
->open_count
<=1)
5412 current_drive
->open_count
=1;
5413 if (famT_drive
) msg(DBG_TEA
,"sbpcd_open: before i=DiskInfo();.\n");
5415 if (famT_drive
) msg(DBG_TEA
,"sbpcd_open: after i=DiskInfo();.\n");
5416 if ((current_drive
->ored_ctl_adr
&0x40)==0)
5418 msg(DBG_INF
,"CD contains no data tracks.\n");
5420 current_drive
->has_data
=0;
5421 #endif /* SAFE_MIXED */
5424 else if (current_drive
->has_data
<1) current_drive
->has_data
=1;
5425 #endif /* SAFE_MIXED */
5427 if (!st_spinning
) cc_SpinUp();
5430 /*==========================================================================*/
5432 * On close, we flush all sbp blocks from the buffer cache.
5434 static void sbpcd_release(struct cdrom_device_info
* cdi
)
5436 struct sbpcd_drive
*p
= cdi
->handle
;
5438 if (p
->drv_id
==-1) {
5439 msg(DBG_INF
, "release: bad device: %s\n", cdi
->name
);
5442 down(&ioctl_read_sem
);
5445 * try to keep an "open" counter here and unlock the door if 1->0.
5447 msg(DBG_LCK
,"open_count: %d -> %d\n",
5448 p
->open_count
,p
->open_count
-1);
5449 if (p
->open_count
>-2) /* CDROMEJECT may have been done */
5451 if (--p
->open_count
<=0)
5453 p
->sbp_first_frame
=p
->sbp_last_frame
=-1;
5454 if (p
->audio_state
!=audio_playing
)
5455 if (p
->f_eject
) cc_SpinDown();
5456 p
->diskstate_flags
&= ~cd_size_bit
;
5460 #endif /* SAFE_MIXED */
5463 up(&ioctl_read_sem
);
5466 /*==========================================================================*/
5470 static int sbpcd_media_changed( struct cdrom_device_info
*cdi
, int disc_nr
);
5471 static struct cdrom_device_ops sbpcd_dops
= {
5473 .release
= sbpcd_release
,
5474 .drive_status
= sbpcd_drive_status
,
5475 .media_changed
= sbpcd_media_changed
,
5476 .tray_move
= sbpcd_tray_move
,
5477 .lock_door
= sbpcd_lock_door
,
5478 .select_speed
= sbpcd_select_speed
,
5479 .get_last_session
= sbpcd_get_last_session
,
5480 .get_mcn
= sbpcd_get_mcn
,
5481 .reset
= sbpcd_reset
,
5482 .audio_ioctl
= sbpcd_audio_ioctl
,
5483 .dev_ioctl
= sbpcd_dev_ioctl
,
5484 .capability
= CDC_CLOSE_TRAY
| CDC_OPEN_TRAY
| CDC_LOCK
|
5485 CDC_MULTI_SESSION
| CDC_MEDIA_CHANGED
|
5486 CDC_MCN
| CDC_PLAY_AUDIO
| CDC_IOCTLS
,
5490 /*==========================================================================*/
5492 * accept "kernel command line" parameters
5493 * (suggested by Peter MacDonald with SLS 1.03)
5495 * This is only implemented for the first controller. Should be enough to
5496 * allow installing with a "strange" distribution kernel.
5499 * sbpcd=0x230,SoundBlaster
5501 * sbpcd=0x300,LaserMate
5503 * sbpcd=0x338,SoundScape
5505 * sbpcd=0x2C0,Teac16bit
5507 * (upper/lower case sensitive here - but all-lowercase is ok!!!).
5509 * the address value has to be the CDROM PORT ADDRESS -
5510 * not the soundcard base address.
5511 * For the SPEA/SoundScape setup, DO NOT specify the "configuration port"
5512 * address, but the address which is really used for the CDROM (usually 8
5517 int sbpcd_setup(char *s
)
5521 (void)get_options(s
, ARRAY_SIZE(p
), p
);
5523 msg(DBG_INI
,"sbpcd_setup called with %04X,%s\n",p
[1], s
);
5524 sbpro_type
=0; /* default: "LaserMate" */
5525 if (p
[0]>1) sbpro_type
=p
[2];
5526 else if (!strcmp(s
,str_sb
)) sbpro_type
=1;
5527 else if (!strcmp(s
,str_sb_l
)) sbpro_type
=1;
5528 else if (!strcmp(s
,str_sp
)) sbpro_type
=2;
5529 else if (!strcmp(s
,str_sp_l
)) sbpro_type
=2;
5530 else if (!strcmp(s
,str_ss
)) sbpro_type
=2;
5531 else if (!strcmp(s
,str_ss_l
)) sbpro_type
=2;
5532 else if (!strcmp(s
,str_t16
)) sbpro_type
=3;
5533 else if (!strcmp(s
,str_t16_l
)) sbpro_type
=3;
5534 if (p
[0]>0) sbpcd_ioaddr
=p
[1];
5535 if (p
[0]>2) max_drives
=p
[3];
5537 sbpcd_ioaddr
= sbpcd
[0];
5538 sbpro_type
= sbpcd
[1];
5541 CDo_command
=sbpcd_ioaddr
;
5542 CDi_info
=sbpcd_ioaddr
;
5543 CDi_status
=sbpcd_ioaddr
+1;
5544 CDo_sel_i_d
=sbpcd_ioaddr
+1;
5545 CDo_reset
=sbpcd_ioaddr
+2;
5546 CDo_enable
=sbpcd_ioaddr
+3;
5548 if ((sbpro_type
==1)||(sbpro_type
==3))
5550 CDi_data
=sbpcd_ioaddr
;
5557 else CDi_data
=sbpcd_ioaddr
+2;
5562 __setup("sbpcd=", sbpcd_setup
);
5565 /*==========================================================================*/
5567 * Sequoia S-1000 CD-ROM Interface Configuration
5568 * as used within SPEA Media FX, Ensonic SoundScape and some Reveal cards
5569 * The soundcard has to get jumpered for the interface type "Panasonic"
5570 * (not Sony or Mitsumi) and to get soft-configured for
5571 * -> configuration port address
5572 * -> CDROM port offset (num_ports): has to be 8 here. Possibly this
5573 * offset value determines the interface type (none, Panasonic,
5575 * The interface uses a configuration port (0x320, 0x330, 0x340, 0x350)
5576 * some bytes below the real CDROM address.
5578 * For the Panasonic style (LaserMate) interface and the configuration
5579 * port 0x330, we have to use an offset of 8; so, the real CDROM port
5582 static int __init
config_spea(void)
5585 * base address offset between configuration port and CDROM port,
5586 * this probably defines the interface type
5588 * 8 (type=LaserMate):0x10
5594 int irq_number
=0; /* off:0x00, 2/9:0x01, 7:0x03, 12:0x05, 15:0x07 */
5595 int dma_channel
=0; /* off: 0x00, 0:0x08, 1:0x18, 3:0x38, 5:0x58, 6:0x68 */
5596 int dack_polarity
=0; /* L:0x00, H:0x80 */
5597 int drq_polarity
=0x40; /* L:0x00, H:0x40 */
5600 #define SPEA_REG_1 sbpcd_ioaddr-0x08+4
5601 #define SPEA_REG_2 sbpcd_ioaddr-0x08+5
5603 OUT(SPEA_REG_1
,0xFF);
5607 msg(DBG_SEQ
,"no SPEA interface at %04X present.\n", sbpcd_ioaddr
);
5608 return (-1); /* no interface found */
5610 OUT(SPEA_REG_1
,0x04);
5611 OUT(SPEA_REG_2
,0xC0);
5613 OUT(SPEA_REG_1
,0x05);
5614 OUT(SPEA_REG_2
,0x10|drq_polarity
|dack_polarity
);
5617 #define SPEA_PATTERN 0x80
5619 #define SPEA_PATTERN 0x00
5621 OUT(SPEA_REG_1
,0x06);
5622 OUT(SPEA_REG_2
,dma_channel
|irq_number
|SPEA_PATTERN
);
5623 OUT(SPEA_REG_2
,dma_channel
|irq_number
|SPEA_PATTERN
);
5625 OUT(SPEA_REG_1
,0x09);
5626 i
=(inb(SPEA_REG_2
)&0xCF)|n_ports
;
5629 sbpro_type
= 0; /* acts like a LaserMate interface now */
5630 msg(DBG_SEQ
,"found SoundScape interface at %04X.\n", sbpcd_ioaddr
);
5634 /*==========================================================================*/
5636 * Test for presence of drive and initialize it.
5637 * Called once at boot or load time.
5640 /* FIXME: cleanups after failed allocations are too ugly for words */
5642 int __init
__sbpcd_init(void)
5644 int __init
sbpcd_init(void)
5648 int addr
[2]={1, CDROM_PORT
};
5653 msg(DBG_INF
,"sbpcd.c %s\n", VERSION
);
5658 msg(DBG_INF
,"Looking for Matsushita/Panasonic, CreativeLabs, Longshine, TEAC CD-ROM drives\n");
5659 msg(DBG_INF
,"= = = = = = = = = = W A R N I N G = = = = = = = = = =\n");
5660 msg(DBG_INF
,"Auto-Probing can cause a hang (f.e. touching an NE2000 card).\n");
5661 msg(DBG_INF
,"If that happens, you have to reboot and use the\n");
5662 msg(DBG_INF
,"LILO (kernel) command line feature like:\n");
5663 msg(DBG_INF
," LILO boot: ... sbpcd=0x230,SoundBlaster\n");
5664 msg(DBG_INF
,"or like:\n");
5665 msg(DBG_INF
," LILO boot: ... sbpcd=0x300,LaserMate\n");
5666 msg(DBG_INF
,"or like:\n");
5667 msg(DBG_INF
," LILO boot: ... sbpcd=0x338,SoundScape\n");
5668 msg(DBG_INF
,"with your REAL address.\n");
5669 msg(DBG_INF
,"= = = = = = = = = = END of WARNING = = = = = == = = =\n");
5671 #endif /* DISTRIBUTION */
5672 sbpcd
[0]=sbpcd_ioaddr
; /* possibly changed by kernel command line */
5673 sbpcd
[1]=sbpro_type
; /* possibly changed by kernel command line */
5676 for (port_index
=0;port_index
<NUM_PROBE
;port_index
+=2)
5678 addr
[1]=sbpcd
[port_index
];
5679 if (addr
[1]==0) break;
5680 if (check_region(addr
[1],4))
5682 msg(DBG_INF
,"check_region: %03X is not free.\n",addr
[1]);
5685 if (sbpcd
[port_index
+1]==2) type
=str_sp
;
5686 else if (sbpcd
[port_index
+1]==1) type
=str_sb
;
5687 else if (sbpcd
[port_index
+1]==3) type
=str_t16
;
5689 sbpcd_setup((char *)type
);
5691 msg(DBG_INF
,"Scanning 0x%X (%s)...\n", CDo_command
, type
);
5692 #endif /* DISTRIBUTION */
5693 if (sbpcd
[port_index
+1]==2)
5699 if (check_card(addr
[1])) continue;
5700 #endif /* PATH_CHECK */
5702 msg(DBG_INI
,"check_drives done.\n");
5703 if (i
>=0) break; /* drive found */
5704 } /* end of cycling through the set of possible I/O port addresses */
5708 msg(DBG_INF
, "No drive found.\n");
5718 msg(DBG_INF
, "You should read Documentation/cdrom/sbpcd\n");
5719 msg(DBG_INF
, "and then configure sbpcd.h for your hardware.\n");
5722 msg(DBG_INI
,"check_datarate done.\n");
5724 for (j
=0;j
<NR_SBPCD
;j
++)
5726 struct sbpcd_drive
*p
= D_S
+ j
;
5731 if (!famL_drive
) cc_DriveReset();
5733 if (!st_spinning
) cc_SpinUp();
5734 p
->sbp_first_frame
= -1; /* First frame in buffer */
5735 p
->sbp_last_frame
= -1; /* Last frame in buffer */
5736 p
->sbp_read_frames
= 0; /* Number of frames being read to buffer */
5737 p
->sbp_current
= 0; /* Frame being currently read */
5739 p
->frame_size
=CD_FRAMESIZE
;
5742 if (!fam0_drive
) p
->f_eject
=1;
5745 i
=ResponseStatus(); /* returns orig. status or p_busy_new */
5746 if (famT_drive
) i
=ResponseStatus(); /* returns orig. status or p_busy_new */
5750 msg(DBG_INF
,"init: ResponseStatus returns %d.\n",i
);
5757 msg(DBG_INI
,"init: cc_ReadError returns %d\n",i
);
5760 msg(DBG_INI
,"init: first GetStatus: %d\n",i
);
5761 msg(DBG_LCS
,"init: first GetStatus: error_byte=%d\n",
5763 if (p
->error_byte
==aud_12
)
5765 timeout
=jiffies
+2*HZ
;
5769 msg(DBG_INI
,"init: second GetStatus: %02X\n",i
);
5771 "init: second GetStatus: error_byte=%d\n",
5774 if (!st_caddy_in
) break;
5776 while ((!st_diskok
)||time_after(jiffies
, timeout
));
5779 if (i
>=0) p
->CD_changed
=1;
5782 if (!request_region(CDo_command
,4,major_name
))
5784 printk(KERN_WARNING
"sbpcd: Unable to request region 0x%x\n", CDo_command
);
5789 * Turn on the CD audio channels.
5790 * The addresses are obtained from SOUND_BASE (see sbpcd.h).
5793 OUT(MIXER_addr
,MIXER_CD_Volume
); /* select SB Pro mixer register */
5794 OUT(MIXER_data
,0xCC); /* one nibble per channel, max. value: 0xFF */
5795 #endif /* SOUND_BASE */
5797 if (register_blkdev(MAJOR_NR
, major_name
)) {
5806 * init error handling is broken beyond belief in this driver...
5808 sbpcd_queue
= blk_init_queue(do_sbpcd_request
, &sbpcd_lock
);
5810 release_region(CDo_command
,4);
5811 unregister_blkdev(MAJOR_NR
, major_name
);
5815 devfs_mk_dir("sbp");
5817 for (j
=0;j
<NR_SBPCD
;j
++)
5819 struct cdrom_device_info
* sbpcd_infop
;
5820 struct gendisk
*disk
;
5821 struct sbpcd_drive
*p
= D_S
+ j
;
5823 if (p
->drv_id
==-1) continue;
5827 #endif /* SAFE_MIXED */
5829 * allocate memory for the frame buffers
5833 p
->sbp_bufsiz
=buffers
;
5834 if (p
->drv_type
&drv_fam1
)
5836 p
->sbp_audsiz
= READ_AUDIO
;
5837 p
->sbp_buf
=(u_char
*) vmalloc(buffers
*CD_FRAMESIZE
);
5839 msg(DBG_INF
,"data buffer (%d frames) not available.\n",
5841 if ((unregister_blkdev(MAJOR_NR
, major_name
) == -EINVAL
))
5843 printk("Can't unregister %s\n", major_name
);
5845 release_region(CDo_command
,4);
5846 blk_cleanup_queue(sbpcd_queue
);
5850 msg(DBG_INF
,"data buffer size: %d frames.\n",buffers
);
5852 if (p
->sbp_audsiz
>0)
5854 p
->aud_buf
=(u_char
*) vmalloc(p
->sbp_audsiz
*CD_FRAMESIZE_RAW
);
5855 if (p
->aud_buf
==NULL
) msg(DBG_INF
,"audio buffer (%d frames) not available.\n",p
->sbp_audsiz
);
5856 else msg(DBG_INF
,"audio buffer size: %d frames.\n",p
->sbp_audsiz
);
5858 sbpcd_infop
= vmalloc(sizeof (struct cdrom_device_info
));
5859 if (sbpcd_infop
== NULL
)
5861 release_region(CDo_command
,4);
5862 blk_cleanup_queue(sbpcd_queue
);
5865 memset(sbpcd_infop
, 0, sizeof(struct cdrom_device_info
));
5866 sbpcd_infop
->ops
= &sbpcd_dops
;
5867 sbpcd_infop
->speed
= 2;
5868 sbpcd_infop
->capacity
= 1;
5869 sprintf(sbpcd_infop
->name
, "sbpcd%d", j
);
5870 sbpcd_infop
->handle
= p
;
5871 p
->sbpcd_infop
= sbpcd_infop
;
5872 disk
= alloc_disk(1);
5873 disk
->major
= MAJOR_NR
;
5874 disk
->first_minor
= j
;
5875 disk
->fops
= &sbpcd_bdops
;
5876 strcpy(disk
->disk_name
, sbpcd_infop
->name
);
5877 disk
->flags
= GENHD_FL_CD
;
5878 sprintf(disk
->devfs_name
, "sbp/c0t%d", p
->drv_id
);
5880 if (register_cdrom(sbpcd_infop
))
5882 printk(" sbpcd: Unable to register with Uniform CD-ROm driver\n");
5884 disk
->private_data
= p
;
5885 disk
->queue
= sbpcd_queue
;
5888 blk_queue_hardsect_size(sbpcd_queue
, CD_FRAMESIZE
);
5895 /*==========================================================================*/
5897 void sbpcd_exit(void)
5901 if ((unregister_blkdev(MAJOR_NR
, major_name
) == -EINVAL
))
5903 msg(DBG_INF
, "What's that: can't unregister %s.\n", major_name
);
5906 release_region(CDo_command
,4);
5907 blk_cleanup_queue(sbpcd_queue
);
5908 for (j
=0;j
<NR_SBPCD
;j
++)
5910 if (D_S
[j
].drv_id
==-1) continue;
5911 del_gendisk(D_S
[j
].disk
);
5912 put_disk(D_S
[j
].disk
);
5913 devfs_remove("sbp/c0t%d", j
);
5914 vfree(D_S
[j
].sbp_buf
);
5915 if (D_S
[j
].sbp_audsiz
>0) vfree(D_S
[j
].aud_buf
);
5916 if ((unregister_cdrom(D_S
[j
].sbpcd_infop
) == -EINVAL
))
5918 msg(DBG_INF
, "What's that: can't unregister info %s.\n", major_name
);
5921 vfree(D_S
[j
].sbpcd_infop
);
5923 devfs_remove("sbp");
5924 msg(DBG_INF
, "%s module released.\n", major_name
);
5928 module_init(__sbpcd_init
) /*HACK!*/;
5929 module_exit(sbpcd_exit
);
5933 static int sbpcd_media_changed(struct cdrom_device_info
*cdi
, int disc_nr
)
5935 struct sbpcd_drive
*p
= cdi
->handle
;
5936 msg(DBG_CHK
,"media_check (%s) called\n", cdi
->name
);
5938 if (p
->CD_changed
==0xFF)
5941 msg(DBG_CHK
,"medium changed (drive %s)\n", cdi
->name
);
5942 current_drive
->diskstate_flags
&= ~toc_bit
;
5943 /* we *don't* need invalidate here, it's done by caller */
5944 current_drive
->diskstate_flags
&= ~cd_size_bit
;
5946 current_drive
->has_data
=0;
5947 #endif /* SAFE_MIXED */
5955 MODULE_LICENSE("GPL");
5956 /* FIXME: Old modules.conf claims MATSUSHITA_CDROM2_MAJOR and CDROM3, but
5957 AFAICT this doesn't support those majors, so why? --RR 30 Jul 2003 */
5958 MODULE_ALIAS_BLOCKDEV_MAJOR(MATSUSHITA_CDROM_MAJOR
);
5960 /*==========================================================================*/
5962 * Overrides for Emacs so that we follow Linus's tabbing style.
5963 * Emacs will notice this stuff at the end of the file and automatically
5964 * adjust the settings for this buffer only. This must remain at the end
5966 * ---------------------------------------------------------------------------
5969 * c-brace-imaginary-offset: 0
5970 * c-brace-offset: -8
5971 * c-argdecl-indent: 8
5972 * c-label-offset: -8
5973 * c-continued-statement-offset: 8
5974 * c-continued-brace-offset: 0