blob: 05c9e865ecaf85a33eafa3be2cfe0bb837a71148 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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).
14 */
15
16#define VERSION "v4.63 Andrew J. Kroll <ag784@freenet.buffalo.edu> Wed Jul 26 04:24:10 EDT 2000"
17
18/* Copyright (C) 1993, 1994, 1995 Eberhard Moenkeberg <emoenke@gwdg.de>
19 *
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)
23 * any later version.
24 *
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.
28 *
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.
31 *
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.
34 *
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.
43 *
44 *
45 * VERSION HISTORY
46 *
47 * 0.1 initial release, April/May 93, after mcd.c (Martin Harriss)
48 *
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.
52 *
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.
57 *
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.
77 *
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).
83 *
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.
87 *
88 * 1.1 Do SpinUp for new drives, too.
89 * Revised for clean compile under "old" kernels (0.99pl9).
90 *
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.
93 *
94 * 1.3 Minor cleanups.
95 * Refinements regarding Workman.
96 *
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?
105 *
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).
109 *
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
119 * an interface.
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.
125 *
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.
139 *
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.
145 *
146 * 2.2 Kernel interface cleanups: timers, init, setup, media check.
147 *
148 * 2.3 Let "door lock" and "eject" live together.
149 * Implemented "close tray" (done automatically during open).
150 *
151 * 2.4 Use different names for device registering.
152 *
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).
159 *
160 * 2.6 Nothing new.
161 *
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
164 * during shutdown.
165 *
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
169 * lock functions.
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
174 * 16..20).
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. ;-)
178 *
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
182 * usable yet.
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).
188 *
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
195 * than 172 kB.
196 * Started CD200 support. Drive detection should work, but nothing
197 * more.
198 *
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.
205 *
206 * 3.2 Still testing with CD200 and CD-55A drives.
207 *
208 * 3.3 Working with CD200 support.
209 *
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.
215 *
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
222 * size.
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).
234 *
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
237 * during runtime.
238 *
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
243 * a lot of sessions.
244 * Bettered the sbpcd_open() behavior with TEAC drives.
245 *
246 * 3.8 Elongated max_latency for CR-56x drives.
247 *
248 * 3.9 Finally fixed the long-known SoundScape/SPEA/Sequoia S-1000 interface
249 * configuration bug.
250 * Now Corey, Heiko, Ken, Leo, Vadim/Eric & Werner are invited to copy
251 * the config_spea() routine into their drivers. ;-)
252 *
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
259 * (heistp@rpi.edu).
260 *
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.
265 *
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.
276 *
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 ;-).
281 *
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.
286 *
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
293 * ll_rw_blk.c).
294 * "Check media change" without touching any drive.
295 *
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. ;-)
302 *
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>
306 *
307 * 4.62 Fix a bug where playing audio left the drive in an unusable state.
308 * Heiko Eissfeldt <heiko@colossus.escape.de>
309 *
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>
314 *
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
322 *
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
326 *
327 * TODO
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)
332 *
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.
337 *
338 */
339
340/*
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
346 *
347 * Thu May 30 14:14:47 CEST 2002:
348 *
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.
353 *
354 * Marcin Dalecki
355 */
356
357/*
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
361 */
362
363
364#include <linux/module.h>
365
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>
380
381#include <asm/system.h>
382#include <asm/io.h>
383#include <asm/uaccess.h>
384#include <stdarg.h>
385#include <linux/config.h>
386#include "sbpcd.h"
387
388#define MAJOR_NR MATSUSHITA_CDROM_MAJOR
389#include <linux/blkdev.h>
390
391/*==========================================================================*/
392#if SBPCD_DIS_IRQ
393# define SBPCD_CLI cli()
394# define SBPCD_STI sti()
395#else
396# define SBPCD_CLI
397# define SBPCD_STI
398#endif
399
400/*==========================================================================*/
401/*
402 * auto-probing address list
403 * inspired by Adam J. Richter from Yggdrasil
404 *
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.
410 *
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.
413 *
414 * send mail to emoenke@gwdg.de if your interface card is not FULLY
415 * represented here.
416 */
417static int sbpcd[] =
418{
419 CDROM_PORT, SBPRO, /* probe with user's setup first */
420#if DISTRIBUTION
421 0x230, 1, /* Soundblaster Pro and 16 (default) */
422#if 0
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" */
445#ifdef MODULE
446 /*
447 * some "hazardous" locations (no harm with the loadable version)
448 * (will stop the bus if a NE2000 ethernet card resides at offset -0x10)
449 */
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 */
456#endif /* MODULE */
457#endif
458#endif /* DISTRIBUTION */
459};
460
461/*
462 * Protects access to global structures etc.
463 */
464static __cacheline_aligned DEFINE_SPINLOCK(sbpcd_lock);
465static struct request_queue *sbpcd_queue;
466
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800467/* You can only set the first pair, from old MODULE_PARM code. */
468static int sbpcd_set(const char *val, struct kernel_param *kp)
469{
470 get_options((char *)val, 2, (int *)sbpcd);
471 return 0;
472}
473module_param_call(sbpcd, sbpcd_set, NULL, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474
475#define NUM_PROBE (sizeof(sbpcd) / sizeof(int))
476
477/*==========================================================================*/
478
479#define INLINE inline
480
481/*==========================================================================*/
482/*
483 * the forward references:
484 */
485static void sbp_sleep(u_int);
486static void mark_timeout_delay(u_long);
487static void mark_timeout_data(u_long);
488#if 0
489static void mark_timeout_audio(u_long);
490#endif
491static void sbp_read_cmd(struct request *req);
492static int sbp_data(struct request *req);
493static int cmd_out(void);
494static int DiskInfo(void);
495
496/*==========================================================================*/
497
498/*
499 * pattern for printk selection:
500 *
501 * (1<<DBG_INF) necessary information
502 * (1<<DBG_BSZ) BLOCK_SIZE trace
503 * (1<<DBG_REA) "read" status trace
504 * (1<<DBG_CHK) "media check" trace
505 * (1<<DBG_TIM) datarate timer test
506 * (1<<DBG_INI) initialization trace
507 * (1<<DBG_TOC) tell TocEntry values
508 * (1<<DBG_IOC) ioctl trace
509 * (1<<DBG_STA) "ResponseStatus" trace
510 * (1<<DBG_ERR) "cc_ReadError" trace
511 * (1<<DBG_CMD) "cmd_out" trace
512 * (1<<DBG_WRN) give explanation before auto-probing
513 * (1<<DBG_MUL) multi session code test
514 * (1<<DBG_IDX) "drive_id != 0" test code
515 * (1<<DBG_IOX) some special information
516 * (1<<DBG_DID) drive ID test
517 * (1<<DBG_RES) drive reset info
518 * (1<<DBG_SPI) SpinUp test info
519 * (1<<DBG_IOS) ioctl trace: "subchannel"
520 * (1<<DBG_IO2) ioctl trace: general
521 * (1<<DBG_UPC) show UPC info
522 * (1<<DBG_XA1) XA mode debugging
523 * (1<<DBG_LCK) door (un)lock info
524 * (1<<DBG_SQ1) dump SubQ frame
525 * (1<<DBG_AUD) "read audio" debugging
526 * (1<<DBG_SEQ) Sequoia interface configuration trace
527 * (1<<DBG_LCS) Longshine LCS-7260 debugging trace
528 * (1<<DBG_CD2) MKE/Funai CD200 debugging trace
529 * (1<<DBG_TEA) TEAC CD-55A debugging trace
530 * (1<<DBG_ECS) ECS-AT (Vertos-100) debugging trace
531 * (1<<DBG_000) unnecessary information
532 */
533#if DISTRIBUTION
534static int sbpcd_debug = (1<<DBG_INF);
535#else
536static int sbpcd_debug = 0 & ((1<<DBG_INF) |
537 (1<<DBG_TOC) |
538 (1<<DBG_MUL) |
539 (1<<DBG_UPC));
540#endif /* DISTRIBUTION */
541
542static int sbpcd_ioaddr = CDROM_PORT; /* default I/O base address */
543static int sbpro_type = SBPRO;
544static unsigned char f_16bit;
545static unsigned char do_16bit;
546static int CDo_command, CDo_reset;
547static int CDo_sel_i_d, CDo_enable;
548static int CDi_info, CDi_status, CDi_data;
549static struct cdrom_msf msf;
550static struct cdrom_ti ti;
551static struct cdrom_tochdr tochdr;
552static struct cdrom_tocentry tocentry;
553static struct cdrom_subchnl SC;
554static struct cdrom_volctrl volctrl;
555static struct cdrom_read_audio read_audio;
556
557static unsigned char msgnum;
558static char msgbuf[80];
559
560static int max_drives = MAX_DRIVES;
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800561module_param(max_drives, int, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562#ifndef MODULE
563static unsigned char setup_done;
564static const char *str_sb_l = "soundblaster";
565static const char *str_sp_l = "spea";
566static const char *str_ss_l = "soundscape";
567static const char *str_t16_l = "teac16bit";
568static const char *str_ss = "SoundScape";
569#endif
570static const char *str_sb = "SoundBlaster";
571static const char *str_lm = "LaserMate";
572static const char *str_sp = "SPEA";
573static const char *str_t16 = "Teac16bit";
574static const char *type;
575static const char *major_name="sbpcd";
576
577/*==========================================================================*/
578
579#ifdef FUTURE
580static DECLARE_WAIT_QUEUE_HEAD(sbp_waitq);
581#endif /* FUTURE */
582
583static int teac=SBP_TEAC_SPEED;
584static int buffers=SBP_BUFFER_FRAMES;
585
586static u_char family0[]="MATSHITA"; /* MKE CR-521, CR-522, CR-523 */
587static u_char family1[]="CR-56"; /* MKE CR-562, CR-563 */
588static u_char family2[]="CD200"; /* MKE CD200, Funai CD200F */
589static u_char familyL[]="LCS-7260"; /* Longshine LCS-7260 */
590static u_char familyT[]="CD-55"; /* TEAC CD-55A */
591static u_char familyV[]="ECS-AT"; /* ECS Vertos 100 */
592
593static u_int recursion; /* internal testing only */
594static u_int fatal_err; /* internal testing only */
595static u_int response_count;
596static u_int flags_cmd_out;
597static u_char cmd_type;
598static u_char drvcmd[10];
599static u_char infobuf[20];
600static u_char xa_head_buf[CD_XA_HEAD];
601static u_char xa_tail_buf[CD_XA_TAIL];
602
603#if OLD_BUSY
604static volatile u_char busy_data;
605static volatile u_char busy_audio; /* true semaphores would be safer */
606#endif /* OLD_BUSY */
607static DECLARE_MUTEX(ioctl_read_sem);
608static u_long timeout;
609static volatile u_char timed_out_delay;
610static volatile u_char timed_out_data;
611#if 0
612static volatile u_char timed_out_audio;
613#endif
614static u_int datarate= 1000000;
615static u_int maxtim16=16000000;
616static u_int maxtim04= 4000000;
617static u_int maxtim02= 2000000;
618static u_int maxtim_8= 30000;
619#if LONG_TIMING
620static u_int maxtim_data= 9000;
621#else
622static u_int maxtim_data= 3000;
623#endif /* LONG_TIMING */
624#if DISTRIBUTION
625static int n_retries=6;
626#else
627static int n_retries=6;
628#endif
629/*==========================================================================*/
630
631static int ndrives;
632static u_char drv_pattern[NR_SBPCD]={speed_auto,speed_auto,speed_auto,speed_auto};
633
634/*==========================================================================*/
635/*
636 * drive space begins here (needed separate for each unit)
637 */
638static struct sbpcd_drive {
639 char drv_id; /* "jumpered" drive ID or -1 */
640 char drv_sel; /* drive select lines bits */
641
642 char drive_model[9];
643 u_char firmware_version[4];
644 char f_eject; /* auto-eject flag: 0 or 1 */
645 u_char *sbp_buf; /* Pointer to internal data buffer,
646 space allocated during sbpcd_init() */
647 u_int sbp_bufsiz; /* size of sbp_buf (# of frames) */
648 int sbp_first_frame; /* First frame in buffer */
649 int sbp_last_frame; /* Last frame in buffer */
650 int sbp_read_frames; /* Number of frames being read to buffer */
651 int sbp_current; /* Frame being currently read */
652
653 u_char mode; /* read_mode: READ_M1, READ_M2, READ_SC, READ_AU */
654 u_char *aud_buf; /* Pointer to audio data buffer,
655 space allocated during sbpcd_init() */
656 u_int sbp_audsiz; /* size of aud_buf (# of raw frames) */
657 u_int drv_type;
658 u_char drv_options;
659 int status_bits;
660 u_char diskstate_flags;
661 u_char sense_byte;
662
663 u_char CD_changed;
664 char open_count;
665 u_char error_byte;
666
667 u_char f_multisession;
668 u_int lba_multi;
669 int first_session;
670 int last_session;
671 int track_of_last_session;
672
673 u_char audio_state;
674 u_int pos_audio_start;
675 u_int pos_audio_end;
676 char vol_chan0;
677 u_char vol_ctrl0;
678 char vol_chan1;
679 u_char vol_ctrl1;
680#if 000 /* no supported drive has it */
681 char vol_chan2;
682 u_char vol_ctrl2;
683 char vol_chan3;
684 u_char vol_ctrl3;
685#endif /*000 */
686 u_char volume_control; /* TEAC on/off bits */
687
688 u_char SubQ_ctl_adr;
689 u_char SubQ_trk;
690 u_char SubQ_pnt_idx;
691 u_int SubQ_run_tot;
692 u_int SubQ_run_trk;
693 u_char SubQ_whatisthis;
694
695 u_char UPC_ctl_adr;
696 u_char UPC_buf[7];
697
698 int frame_size;
699 int CDsize_frm;
700
701 u_char xa_byte; /* 0x20: XA capabilities */
702 u_char n_first_track; /* binary */
703 u_char n_last_track; /* binary (not bcd), 0x01...0x63 */
704 u_int size_msf; /* time of whole CD, position of LeadOut track */
705 u_int size_blk;
706
707 u_char TocEnt_nixbyte; /* em */
708 u_char TocEnt_ctl_adr;
709 u_char TocEnt_number;
710 u_char TocEnt_format; /* em */
711 u_int TocEnt_address;
712#ifdef SAFE_MIXED
713 char has_data;
714#endif /* SAFE_MIXED */
715 u_char ored_ctl_adr; /* to detect if CDROM contains data tracks */
716
717 struct {
718 u_char nixbyte; /* em */
719 u_char ctl_adr; /* 0x4x: data, 0x0x: audio */
720 u_char number;
721 u_char format; /* em */ /* 0x00: lba, 0x01: msf */
722 u_int address;
723 } TocBuffer[MAX_TRACKS+1]; /* last entry faked */
724
725 int in_SpinUp; /* CR-52x test flag */
726 int n_bytes; /* TEAC awaited response count */
727 u_char error_state, b3, b4; /* TEAC command error state */
728 u_char f_drv_error; /* TEAC command error flag */
729 u_char speed_byte;
730 int frmsiz;
731 u_char f_XA; /* 1: XA */
732 u_char type_byte; /* 0, 1, 3 */
733 u_char mode_xb_6;
734 u_char mode_yb_7;
735 u_char mode_xb_8;
736 u_char delay;
737 struct cdrom_device_info *sbpcd_infop;
738 struct gendisk *disk;
739} D_S[NR_SBPCD];
740
741static struct sbpcd_drive *current_drive = D_S;
742
743/*
744 * drive space ends here (needed separate for each unit)
745 */
746/*==========================================================================*/
747#if 0
748unsigned long cli_sti; /* for saving the processor flags */
749#endif
750/*==========================================================================*/
Ingo Molnar8d06afa2005-09-09 13:10:40 -0700751static DEFINE_TIMER(delay_timer, mark_timeout_delay, 0, 0);
752static DEFINE_TIMER(data_timer, mark_timeout_data, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753#if 0
Ingo Molnar8d06afa2005-09-09 13:10:40 -0700754static DEFINE_TIMER(audio_timer, mark_timeout_audio, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755#endif
756/*==========================================================================*/
757/*
758 * DDI interface
759 */
760static void msg(int level, const char *fmt, ...)
761{
762#if DISTRIBUTION
763#define MSG_LEVEL KERN_NOTICE
764#else
765#define MSG_LEVEL KERN_INFO
766#endif /* DISTRIBUTION */
767
768 char buf[256];
769 va_list args;
770
771 if (!(sbpcd_debug&(1<<level))) return;
772
773 msgnum++;
774 if (msgnum>99) msgnum=0;
775 sprintf(buf, MSG_LEVEL "%s-%d [%02d]: ", major_name, current_drive - D_S, msgnum);
776 va_start(args, fmt);
777 vsprintf(&buf[18], fmt, args);
778 va_end(args);
779 printk(buf);
780#if KLOGD_PAUSE
781 sbp_sleep(KLOGD_PAUSE); /* else messages get lost */
782#endif /* KLOGD_PAUSE */
783 return;
784}
785/*==========================================================================*/
786/*
787 * DDI interface: runtime trace bit pattern maintenance
788 */
789static int sbpcd_dbg_ioctl(unsigned long arg, int level)
790{
791 switch(arg)
792 {
793 case 0: /* OFF */
794 sbpcd_debug = DBG_INF;
795 break;
796
797 default:
798 if (arg>=128) sbpcd_debug &= ~(1<<(arg-128));
799 else sbpcd_debug |= (1<<arg);
800 }
801 return (arg);
802}
803/*==========================================================================*/
804static void mark_timeout_delay(u_long i)
805{
806 timed_out_delay=1;
807#if 0
808 msg(DBG_TIM,"delay timer expired.\n");
809#endif
810}
811/*==========================================================================*/
812static void mark_timeout_data(u_long i)
813{
814 timed_out_data=1;
815#if 0
816 msg(DBG_TIM,"data timer expired.\n");
817#endif
818}
819/*==========================================================================*/
820#if 0
821static void mark_timeout_audio(u_long i)
822{
823 timed_out_audio=1;
824#if 0
825 msg(DBG_TIM,"audio timer expired.\n");
826#endif
827}
828#endif
829/*==========================================================================*/
830/*
831 * Wait a little while (used for polling the drive).
832 */
833static void sbp_sleep(u_int time)
834{
835 sti();
Nishanth Aravamudan2ddee1b72005-09-10 00:27:29 -0700836 schedule_timeout_interruptible(time);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 sti();
838}
839/*==========================================================================*/
840#define RETURN_UP(rc) {up(&ioctl_read_sem); return(rc);}
841/*==========================================================================*/
842/*
843 * convert logical_block_address to m-s-f_number (3 bytes only)
844 */
845static INLINE void lba2msf(int lba, u_char *msf)
846{
847 lba += CD_MSF_OFFSET;
848 msf[0] = lba / (CD_SECS*CD_FRAMES);
849 lba %= CD_SECS*CD_FRAMES;
850 msf[1] = lba / CD_FRAMES;
851 msf[2] = lba % CD_FRAMES;
852}
853/*==========================================================================*/
854/*==========================================================================*/
855/*
856 * convert msf-bin to msf-bcd
857 */
858static INLINE void bin2bcdx(u_char *p) /* must work only up to 75 or 99 */
859{
860 *p=((*p/10)<<4)|(*p%10);
861}
862/*==========================================================================*/
863static INLINE u_int blk2msf(u_int blk)
864{
865 MSF msf;
866 u_int mm;
867
868 msf.c[3] = 0;
869 msf.c[2] = (blk + CD_MSF_OFFSET) / (CD_SECS * CD_FRAMES);
870 mm = (blk + CD_MSF_OFFSET) % (CD_SECS * CD_FRAMES);
871 msf.c[1] = mm / CD_FRAMES;
872 msf.c[0] = mm % CD_FRAMES;
873 return (msf.n);
874}
875/*==========================================================================*/
876static INLINE u_int make16(u_char rh, u_char rl)
877{
878 return ((rh<<8)|rl);
879}
880/*==========================================================================*/
881static INLINE u_int make32(u_int rh, u_int rl)
882{
883 return ((rh<<16)|rl);
884}
885/*==========================================================================*/
886static INLINE u_char swap_nibbles(u_char i)
887{
888 return ((i<<4)|(i>>4));
889}
890/*==========================================================================*/
891static INLINE u_char byt2bcd(u_char i)
892{
893 return (((i/10)<<4)+i%10);
894}
895/*==========================================================================*/
896static INLINE u_char bcd2bin(u_char bcd)
897{
898 return ((bcd>>4)*10+(bcd&0x0F));
899}
900/*==========================================================================*/
901static INLINE int msf2blk(int msfx)
902{
903 MSF msf;
904 int i;
905
906 msf.n=msfx;
907 i=(msf.c[2] * CD_SECS + msf.c[1]) * CD_FRAMES + msf.c[0] - CD_MSF_OFFSET;
908 if (i<0) return (0);
909 return (i);
910}
911/*==========================================================================*/
912/*
913 * convert m-s-f_number (3 bytes only) to logical_block_address
914 */
915static INLINE int msf2lba(u_char *msf)
916{
917 int i;
918
919 i=(msf[0] * CD_SECS + msf[1]) * CD_FRAMES + msf[2] - CD_MSF_OFFSET;
920 if (i<0) return (0);
921 return (i);
922}
923/*==========================================================================*/
924/* evaluate cc_ReadError code */
925static int sta2err(int sta)
926{
927 if (famT_drive)
928 {
929 if (sta==0x00) return (0);
930 if (sta==0x01) return (-604); /* CRC error */
931 if (sta==0x02) return (-602); /* drive not ready */
932 if (sta==0x03) return (-607); /* unknown media */
933 if (sta==0x04) return (-612); /* general failure */
934 if (sta==0x05) return (0);
935 if (sta==0x06) return (-ERR_DISKCHANGE); /* disk change */
936 if (sta==0x0b) return (-612); /* general failure */
937 if (sta==0xff) return (-612); /* general failure */
938 return (0);
939 }
940 else
941 {
942 if (sta<=2) return (sta);
943 if (sta==0x05) return (-604); /* CRC error */
944 if (sta==0x06) return (-606); /* seek error */
945 if (sta==0x0d) return (-606); /* seek error */
946 if (sta==0x0e) return (-603); /* unknown command */
947 if (sta==0x14) return (-603); /* unknown command */
948 if (sta==0x0c) return (-611); /* read fault */
949 if (sta==0x0f) return (-611); /* read fault */
950 if (sta==0x10) return (-611); /* read fault */
951 if (sta>=0x16) return (-612); /* general failure */
952 if (sta==0x11) return (-ERR_DISKCHANGE); /* disk change (LCS: removed) */
953 if (famL_drive)
954 if (sta==0x12) return (-ERR_DISKCHANGE); /* disk change (inserted) */
955 return (-602); /* drive not ready */
956 }
957}
958/*==========================================================================*/
959static INLINE void clr_cmdbuf(void)
960{
961 int i;
962
963 for (i=0;i<10;i++) drvcmd[i]=0;
964 cmd_type=0;
965}
966/*==========================================================================*/
967static void flush_status(void)
968{
969 int i;
970
971 sbp_sleep(15*HZ/10);
972 for (i=maxtim_data;i!=0;i--) inb(CDi_status);
973}
974/*====================================================================*/
975/*
976 * CDi status loop for Teac CD-55A (Rob Riggs)
977 *
978 * This is needed because for some strange reason
979 * the CD-55A can take a real long time to give a
980 * status response. This seems to happen after we
981 * issue a READ command where a long seek is involved.
982 *
983 * I tried to ensure that we get max throughput with
984 * minimal busy waiting. We busy wait at first, then
985 * "switch gears" and start sleeping. We sleep for
986 * longer periods of time the longer we wait.
987 *
988 */
989static int CDi_stat_loop_T(void)
990{
991 int i, gear=1;
992 u_long timeout_1, timeout_2, timeout_3, timeout_4;
993
994 timeout_1 = jiffies + HZ / 50; /* sbp_sleep(0) for a short period */
995 timeout_2 = jiffies + HZ / 5; /* nap for no more than 200ms */
996 timeout_3 = jiffies + 5 * HZ; /* sleep for up to 5s */
997 timeout_4 = jiffies + 45 * HZ; /* long sleep for up to 45s. */
998 do
999 {
1000 i = inb(CDi_status);
1001 if (!(i&s_not_data_ready)) return (i);
1002 if (!(i&s_not_result_ready)) return (i);
1003 switch(gear)
1004 {
1005 case 4:
1006 sbp_sleep(HZ);
1007 if (time_after(jiffies, timeout_4)) gear++;
1008 msg(DBG_TEA, "CDi_stat_loop_T: long sleep active.\n");
1009 break;
1010 case 3:
1011 sbp_sleep(HZ/10);
1012 if (time_after(jiffies, timeout_3)) gear++;
1013 break;
1014 case 2:
1015 sbp_sleep(HZ/100);
1016 if (time_after(jiffies, timeout_2)) gear++;
1017 break;
1018 case 1:
1019 sbp_sleep(0);
1020 if (time_after(jiffies, timeout_1)) gear++;
1021 }
1022 } while (gear < 5);
1023 return -1;
1024}
1025/*==========================================================================*/
1026static int CDi_stat_loop(void)
1027{
1028 int i,j;
1029
1030 for(timeout = jiffies + 10*HZ, i=maxtim_data; time_before(jiffies, timeout); )
1031 {
1032 for ( ;i!=0;i--)
1033 {
1034 j=inb(CDi_status);
1035 if (!(j&s_not_data_ready)) return (j);
1036 if (!(j&s_not_result_ready)) return (j);
1037 if (fam0L_drive) if (j&s_attention) return (j);
1038 }
1039 sbp_sleep(1);
1040 i = 1;
1041 }
1042 msg(DBG_LCS,"CDi_stat_loop failed in line %d\n", __LINE__);
1043 return (-1);
1044}
1045/*==========================================================================*/
1046#if 00000
1047/*==========================================================================*/
1048static int tst_DataReady(void)
1049{
1050 int i;
1051
1052 i=inb(CDi_status);
1053 if (i&s_not_data_ready) return (0);
1054 return (1);
1055}
1056/*==========================================================================*/
1057static int tst_ResultReady(void)
1058{
1059 int i;
1060
1061 i=inb(CDi_status);
1062 if (i&s_not_result_ready) return (0);
1063 return (1);
1064}
1065/*==========================================================================*/
1066static int tst_Attention(void)
1067{
1068 int i;
1069
1070 i=inb(CDi_status);
1071 if (i&s_attention) return (1);
1072 return (0);
1073}
1074/*==========================================================================*/
1075#endif
1076/*==========================================================================*/
1077static int ResponseInfo(void)
1078{
1079 int i,j,st=0;
1080 u_long timeout;
1081
1082 for (i=0,timeout=jiffies+HZ;i<response_count;i++)
1083 {
1084 for (j=maxtim_data; ; )
1085 {
1086 for ( ;j!=0;j-- )
1087 {
1088 st=inb(CDi_status);
1089 if (!(st&s_not_result_ready)) break;
1090 }
1091 if ((j!=0)||time_after_eq(jiffies, timeout)) break;
1092 sbp_sleep(1);
1093 j = 1;
1094 }
1095 if (time_after_eq(jiffies, timeout)) break;
1096 infobuf[i]=inb(CDi_info);
1097 }
1098#if 000
1099 while (!(inb(CDi_status)&s_not_result_ready))
1100 {
1101 infobuf[i++]=inb(CDi_info);
1102 }
1103 j=i-response_count;
1104 if (j>0) msg(DBG_INF,"ResponseInfo: got %d trailing bytes.\n",j);
1105#endif /* 000 */
1106 for (j=0;j<i;j++)
1107 sprintf(&msgbuf[j*3]," %02X",infobuf[j]);
1108 msgbuf[j*3]=0;
1109 msg(DBG_CMD,"ResponseInfo:%s (%d,%d)\n",msgbuf,response_count,i);
1110 j=response_count-i;
1111 if (j>0) return (-j);
1112 else return (i);
1113}
1114/*==========================================================================*/
1115static void EvaluateStatus(int st)
1116{
1117 current_drive->status_bits=0;
1118 if (fam1_drive) current_drive->status_bits=st|p_success;
1119 else if (fam0_drive)
1120 {
1121 if (st&p_caddin_old) current_drive->status_bits |= p_door_closed|p_caddy_in;
1122 if (st&p_spinning) current_drive->status_bits |= p_spinning;
1123 if (st&p_check) current_drive->status_bits |= p_check;
1124 if (st&p_success_old) current_drive->status_bits |= p_success;
1125 if (st&p_busy_old) current_drive->status_bits |= p_busy_new;
1126 if (st&p_disk_ok) current_drive->status_bits |= p_disk_ok;
1127 }
1128 else if (famLV_drive)
1129 {
1130 current_drive->status_bits |= p_success;
1131 if (st&p_caddin_old) current_drive->status_bits |= p_disk_ok|p_caddy_in;
1132 if (st&p_spinning) current_drive->status_bits |= p_spinning;
1133 if (st&p_check) current_drive->status_bits |= p_check;
1134 if (st&p_busy_old) current_drive->status_bits |= p_busy_new;
1135 if (st&p_lcs_door_closed) current_drive->status_bits |= p_door_closed;
1136 if (st&p_lcs_door_locked) current_drive->status_bits |= p_door_locked;
1137 }
1138 else if (fam2_drive)
1139 {
1140 current_drive->status_bits |= p_success;
1141 if (st&p2_check) current_drive->status_bits |= p1_check;
1142 if (st&p2_door_closed) current_drive->status_bits |= p1_door_closed;
1143 if (st&p2_disk_in) current_drive->status_bits |= p1_disk_in;
1144 if (st&p2_busy1) current_drive->status_bits |= p1_busy;
1145 if (st&p2_busy2) current_drive->status_bits |= p1_busy;
1146 if (st&p2_spinning) current_drive->status_bits |= p1_spinning;
1147 if (st&p2_door_locked) current_drive->status_bits |= p1_door_locked;
1148 if (st&p2_disk_ok) current_drive->status_bits |= p1_disk_ok;
1149 }
1150 else if (famT_drive)
1151 {
1152 return; /* still needs to get coded */
1153 current_drive->status_bits |= p_success;
1154 if (st&p2_check) current_drive->status_bits |= p1_check;
1155 if (st&p2_door_closed) current_drive->status_bits |= p1_door_closed;
1156 if (st&p2_disk_in) current_drive->status_bits |= p1_disk_in;
1157 if (st&p2_busy1) current_drive->status_bits |= p1_busy;
1158 if (st&p2_busy2) current_drive->status_bits |= p1_busy;
1159 if (st&p2_spinning) current_drive->status_bits |= p1_spinning;
1160 if (st&p2_door_locked) current_drive->status_bits |= p1_door_locked;
1161 if (st&p2_disk_ok) current_drive->status_bits |= p1_disk_ok;
1162 }
1163 return;
1164}
1165/*==========================================================================*/
1166static int cmd_out_T(void);
1167
1168static int get_state_T(void)
1169{
1170 int i;
1171
1172 clr_cmdbuf();
1173 current_drive->n_bytes=1;
1174 drvcmd[0]=CMDT_STATUS;
1175 i=cmd_out_T();
1176 if (i>=0) i=infobuf[0];
1177 else
1178 {
1179 msg(DBG_TEA,"get_state_T error %d\n", i);
1180 return (i);
1181 }
1182 if (i>=0)
1183 /* 2: closed, disk in */
1184 current_drive->status_bits=p1_door_closed|p1_disk_in|p1_spinning|p1_disk_ok;
1185 else if (current_drive->error_state==6)
1186 {
1187 /* 3: closed, disk in, changed ("06 xx xx") */
1188 current_drive->status_bits=p1_door_closed|p1_disk_in;
1189 current_drive->CD_changed=0xFF;
1190 current_drive->diskstate_flags &= ~toc_bit;
1191 }
1192 else if ((current_drive->error_state!=2)||(current_drive->b3!=0x3A)||(current_drive->b4==0x00))
1193 {
1194 /* 1: closed, no disk ("xx yy zz"or "02 3A 00") */
1195 current_drive->status_bits=p1_door_closed;
1196 current_drive->open_count=0;
1197 }
1198 else if (current_drive->b4==0x01)
1199 {
1200 /* 0: open ("02 3A 01") */
1201 current_drive->status_bits=0;
1202 current_drive->open_count=0;
1203 }
1204 else
1205 {
1206 /* 1: closed, no disk ("02 3A xx") */
1207 current_drive->status_bits=p1_door_closed;
1208 current_drive->open_count=0;
1209 }
1210 return (current_drive->status_bits);
1211}
1212/*==========================================================================*/
1213static int ResponseStatus(void)
1214{
1215 int i,j;
1216 u_long timeout;
1217
1218 msg(DBG_STA,"doing ResponseStatus...\n");
1219 if (famT_drive) return (get_state_T());
1220 if (flags_cmd_out & f_respo3) timeout = jiffies;
1221 else if (flags_cmd_out & f_respo2) timeout = jiffies + 16*HZ;
1222 else timeout = jiffies + 4*HZ;
1223 j=maxtim_8;
1224 do
1225 {
1226 for ( ;j!=0;j--)
1227 {
1228 i=inb(CDi_status);
1229 if (!(i&s_not_result_ready)) break;
1230 }
1231 if ((j!=0)||time_after(jiffies, timeout)) break;
1232 sbp_sleep(1);
1233 j = 1;
1234 }
1235 while (1);
1236 if (j==0)
1237 {
1238 if ((flags_cmd_out & f_respo3) == 0)
1239 msg(DBG_STA,"ResponseStatus: timeout.\n");
1240 current_drive->status_bits=0;
1241 return (-401);
1242 }
1243 i=inb(CDi_info);
1244 msg(DBG_STA,"ResponseStatus: response %02X.\n", i);
1245 EvaluateStatus(i);
1246 msg(DBG_STA,"status_bits=%02X, i=%02X\n",current_drive->status_bits,i);
1247 return (current_drive->status_bits);
1248}
1249/*==========================================================================*/
1250static void cc_ReadStatus(void)
1251{
1252 int i;
1253
1254 msg(DBG_STA,"giving cc_ReadStatus command\n");
1255 if (famT_drive) return;
1256 SBPCD_CLI;
1257 if (fam0LV_drive) OUT(CDo_command,CMD0_STATUS);
1258 else if (fam1_drive) OUT(CDo_command,CMD1_STATUS);
1259 else if (fam2_drive) OUT(CDo_command,CMD2_STATUS);
1260 if (!fam0LV_drive) for (i=0;i<6;i++) OUT(CDo_command,0);
1261 SBPCD_STI;
1262}
1263/*==========================================================================*/
1264static int cc_ReadError(void)
1265{
1266 int i;
1267
1268 clr_cmdbuf();
1269 msg(DBG_ERR,"giving cc_ReadError command.\n");
1270 if (fam1_drive)
1271 {
1272 drvcmd[0]=CMD1_READ_ERR;
1273 response_count=8;
1274 flags_cmd_out=f_putcmd|f_ResponseStatus;
1275 }
1276 else if (fam0LV_drive)
1277 {
1278 drvcmd[0]=CMD0_READ_ERR;
1279 response_count=6;
1280 if (famLV_drive)
1281 flags_cmd_out=f_putcmd;
1282 else
1283 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus;
1284 }
1285 else if (fam2_drive)
1286 {
1287 drvcmd[0]=CMD2_READ_ERR;
1288 response_count=6;
1289 flags_cmd_out=f_putcmd;
1290 }
1291 else if (famT_drive)
1292 {
1293 response_count=5;
1294 drvcmd[0]=CMDT_READ_ERR;
1295 }
1296 i=cmd_out();
1297 current_drive->error_byte=0;
1298 msg(DBG_ERR,"cc_ReadError: cmd_out(CMDx_READ_ERR) returns %d (%02X)\n",i,i);
1299 if (i<0) return (i);
1300 if (fam0V_drive) i=1;
1301 else i=2;
1302 current_drive->error_byte=infobuf[i];
1303 msg(DBG_ERR,"cc_ReadError: infobuf[%d] is %d (%02X)\n",i,current_drive->error_byte,current_drive->error_byte);
1304 i=sta2err(infobuf[i]);
1305 if (i==-ERR_DISKCHANGE)
1306 {
1307 current_drive->CD_changed=0xFF;
1308 current_drive->diskstate_flags &= ~toc_bit;
1309 }
1310 return (i);
1311}
1312/*==========================================================================*/
1313static int cc_DriveReset(void);
1314
1315static int cmd_out_T(void)
1316{
1317#undef CMDT_TRIES
1318#define CMDT_TRIES 1000
1319#define TEST_FALSE_FF 1
1320
1321 int i, j, l=0, m, ntries;
1322 unsigned long flags;
1323
1324 current_drive->error_state=0;
1325 current_drive->b3=0;
1326 current_drive->b4=0;
1327 current_drive->f_drv_error=0;
1328 for (i=0;i<10;i++) sprintf(&msgbuf[i*3]," %02X",drvcmd[i]);
1329 msgbuf[i*3]=0;
1330 msg(DBG_CMD,"cmd_out_T:%s\n",msgbuf);
1331
1332 OUT(CDo_sel_i_d,0);
1333 OUT(CDo_enable,current_drive->drv_sel);
1334 i=inb(CDi_status);
1335 do_16bit=0;
1336 if ((f_16bit)&&(!(i&0x80)))
1337 {
1338 do_16bit=1;
1339 msg(DBG_TEA,"cmd_out_T: do_16bit set.\n");
1340 }
1341 if (!(i&s_not_result_ready))
1342 do
1343 {
1344 j=inb(CDi_info);
1345 i=inb(CDi_status);
1346 sbp_sleep(0);
1347 msg(DBG_TEA,"cmd_out_T: spurious !s_not_result_ready. (%02X)\n", j);
1348 }
1349 while (!(i&s_not_result_ready));
1350 save_flags(flags); cli();
1351 for (i=0;i<10;i++) OUT(CDo_command,drvcmd[i]);
1352 restore_flags(flags);
1353 for (ntries=CMDT_TRIES;ntries>0;ntries--)
1354 {
1355 if (drvcmd[0]==CMDT_READ_VER) sbp_sleep(HZ); /* fixme */
1356#if 01
1357 OUT(CDo_sel_i_d,1);
1358#endif /* 01 */
1359 if (teac==2)
1360 {
1361 if ((i=CDi_stat_loop_T()) == -1) break;
1362 }
1363 else
1364 {
1365#if 0
1366 OUT(CDo_sel_i_d,1);
1367#endif /* 0 */
1368 i=inb(CDi_status);
1369 }
1370 if (!(i&s_not_data_ready)) /* f.e. CMDT_DISKINFO */
1371 {
1372 OUT(CDo_sel_i_d,1);
1373 if (drvcmd[0]==CMDT_READ) return (0); /* handled elsewhere */
1374 if (drvcmd[0]==CMDT_DISKINFO)
1375 {
1376 l=0;
1377 do
1378 {
1379 if (do_16bit)
1380 {
1381 i=inw(CDi_data);
1382 infobuf[l++]=i&0x0ff;
1383 infobuf[l++]=i>>8;
1384#if TEST_FALSE_FF
1385 if ((l==2)&&(infobuf[0]==0x0ff))
1386 {
1387 infobuf[0]=infobuf[1];
1388 l=1;
1389 msg(DBG_TEA,"cmd_out_T: do_16bit: false first byte!\n");
1390 }
1391#endif /* TEST_FALSE_FF */
1392 }
1393 else infobuf[l++]=inb(CDi_data);
1394 i=inb(CDi_status);
1395 }
1396 while (!(i&s_not_data_ready));
1397 for (j=0;j<l;j++) sprintf(&msgbuf[j*3]," %02X",infobuf[j]);
1398 msgbuf[j*3]=0;
1399 msg(DBG_CMD,"cmd_out_T data response:%s\n", msgbuf);
1400 }
1401 else
1402 {
1403 msg(DBG_TEA,"cmd_out_T: data response with cmd_%02X!\n",
1404 drvcmd[0]);
1405 j=0;
1406 do
1407 {
1408 if (do_16bit) i=inw(CDi_data);
1409 else i=inb(CDi_data);
1410 j++;
1411 i=inb(CDi_status);
1412 }
1413 while (!(i&s_not_data_ready));
1414 msg(DBG_TEA,"cmd_out_T: data response: discarded %d bytes/words.\n", j);
1415 fatal_err++;
1416 }
1417 }
1418 i=inb(CDi_status);
1419 if (!(i&s_not_result_ready))
1420 {
1421 OUT(CDo_sel_i_d,0);
1422 if (drvcmd[0]==CMDT_DISKINFO) m=l;
1423 else m=0;
1424 do
1425 {
1426 infobuf[m++]=inb(CDi_info);
1427 i=inb(CDi_status);
1428 }
1429 while (!(i&s_not_result_ready));
1430 for (j=0;j<m;j++) sprintf(&msgbuf[j*3]," %02X",infobuf[j]);
1431 msgbuf[j*3]=0;
1432 msg(DBG_CMD,"cmd_out_T info response:%s\n", msgbuf);
1433 if (drvcmd[0]==CMDT_DISKINFO)
1434 {
1435 infobuf[0]=infobuf[l];
1436 if (infobuf[0]!=0x02) return (l); /* data length */
1437 }
1438 else if (infobuf[0]!=0x02) return (m); /* info length */
1439 do
1440 {
1441 ++recursion;
1442 if (recursion>1) msg(DBG_TEA,"cmd_out_T READ_ERR recursion (%02X): %d !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!\n", drvcmd[0], recursion);
1443 clr_cmdbuf();
1444 drvcmd[0]=CMDT_READ_ERR;
1445 j=cmd_out_T(); /* !!! recursive here !!! */
1446 --recursion;
1447 sbp_sleep(1);
1448 }
1449 while (j<0);
1450 current_drive->error_state=infobuf[2];
1451 current_drive->b3=infobuf[3];
1452 current_drive->b4=infobuf[4];
1453 if (current_drive->f_drv_error)
1454 {
1455 current_drive->f_drv_error=0;
1456 cc_DriveReset();
1457 current_drive->error_state=2;
1458 }
1459 return (-current_drive->error_state-400);
1460 }
1461 if (drvcmd[0]==CMDT_READ) return (0); /* handled elsewhere */
1462 if ((teac==0)||(ntries<(CMDT_TRIES-5))) sbp_sleep(HZ/10);
1463 else sbp_sleep(HZ/100);
1464 if (ntries>(CMDT_TRIES-50)) continue;
1465 msg(DBG_TEA,"cmd_out_T: next CMDT_TRIES (%02X): %d.\n", drvcmd[0], ntries-1);
1466 }
1467 current_drive->f_drv_error=1;
1468 cc_DriveReset();
1469 current_drive->error_state=2;
1470 return (-99);
1471}
1472/*==========================================================================*/
1473static int cmd_out(void)
1474{
1475 int i=0;
1476
1477 if (famT_drive) return(cmd_out_T());
1478
1479 if (flags_cmd_out&f_putcmd)
1480 {
1481 unsigned long flags;
1482 for (i=0;i<7;i++)
1483 sprintf(&msgbuf[i*3], " %02X", drvcmd[i]);
1484 msgbuf[i*3]=0;
1485 msg(DBG_CMD,"cmd_out:%s\n", msgbuf);
1486 save_flags(flags); cli();
1487 for (i=0;i<7;i++) OUT(CDo_command,drvcmd[i]);
1488 restore_flags(flags);
1489 }
1490 if (response_count!=0)
1491 {
1492 if (cmd_type!=0)
1493 {
1494 if (sbpro_type==1) OUT(CDo_sel_i_d,1);
1495 msg(DBG_INF,"misleaded to try ResponseData.\n");
1496 if (sbpro_type==1) OUT(CDo_sel_i_d,0);
1497 return (-22);
1498 }
1499 else i=ResponseInfo();
1500 if (i<0) return (i);
1501 }
1502 if (current_drive->in_SpinUp) msg(DBG_SPI,"in_SpinUp: to CDi_stat_loop.\n");
1503 if (flags_cmd_out&f_lopsta)
1504 {
1505 i=CDi_stat_loop();
1506 if ((i<0)||!(i&s_attention)) return (-8);
1507 }
1508 if (!(flags_cmd_out&f_getsta)) goto LOC_229;
1509
1510 LOC_228:
1511 if (current_drive->in_SpinUp) msg(DBG_SPI,"in_SpinUp: to cc_ReadStatus.\n");
1512 cc_ReadStatus();
1513
1514 LOC_229:
1515 if (flags_cmd_out&f_ResponseStatus)
1516 {
1517 if (current_drive->in_SpinUp) msg(DBG_SPI,"in_SpinUp: to ResponseStatus.\n");
1518 i=ResponseStatus();
1519 /* builds status_bits, returns orig. status or p_busy_new */
1520 if (i<0) return (i);
1521 if (flags_cmd_out&(f_bit1|f_wait_if_busy))
1522 {
1523 if (!st_check)
1524 {
1525 if ((flags_cmd_out&f_bit1)&&(i&p_success)) goto LOC_232;
1526 if ((!(flags_cmd_out&f_wait_if_busy))||(!st_busy)) goto LOC_228;
1527 }
1528 }
1529 }
1530 LOC_232:
1531 if (!(flags_cmd_out&f_obey_p_check)) return (0);
1532 if (!st_check) return (0);
1533 if (current_drive->in_SpinUp) msg(DBG_SPI,"in_SpinUp: to cc_ReadError.\n");
1534 i=cc_ReadError();
1535 if (current_drive->in_SpinUp) msg(DBG_SPI,"in_SpinUp: to cmd_out OK.\n");
1536 msg(DBG_000,"cmd_out: cc_ReadError=%d\n", i);
1537 return (i);
1538}
1539/*==========================================================================*/
1540static int cc_Seek(u_int pos, char f_blk_msf)
1541{
1542 int i;
1543
1544 clr_cmdbuf();
1545 if (f_blk_msf>1) return (-3);
1546 if (fam0V_drive)
1547 {
1548 drvcmd[0]=CMD0_SEEK;
1549 if (f_blk_msf==1) pos=msf2blk(pos);
1550 drvcmd[2]=(pos>>16)&0x00FF;
1551 drvcmd[3]=(pos>>8)&0x00FF;
1552 drvcmd[4]=pos&0x00FF;
1553 if (fam0_drive)
1554 flags_cmd_out = f_putcmd | f_respo2 | f_lopsta | f_getsta |
1555 f_ResponseStatus | f_obey_p_check | f_bit1;
1556 else
1557 flags_cmd_out = f_putcmd;
1558 }
1559 else if (fam1L_drive)
1560 {
1561 drvcmd[0]=CMD1_SEEK; /* same as CMD1_ and CMDL_ */
1562 if (f_blk_msf==0) pos=blk2msf(pos);
1563 drvcmd[1]=(pos>>16)&0x00FF;
1564 drvcmd[2]=(pos>>8)&0x00FF;
1565 drvcmd[3]=pos&0x00FF;
1566 if (famL_drive)
1567 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check|f_bit1;
1568 else
1569 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
1570 }
1571 else if (fam2_drive)
1572 {
1573 drvcmd[0]=CMD2_SEEK;
1574 if (f_blk_msf==0) pos=blk2msf(pos);
1575 drvcmd[2]=(pos>>24)&0x00FF;
1576 drvcmd[3]=(pos>>16)&0x00FF;
1577 drvcmd[4]=(pos>>8)&0x00FF;
1578 drvcmd[5]=pos&0x00FF;
1579 flags_cmd_out=f_putcmd|f_ResponseStatus;
1580 }
1581 else if (famT_drive)
1582 {
1583 drvcmd[0]=CMDT_SEEK;
1584 if (f_blk_msf==1) pos=msf2blk(pos);
1585 drvcmd[2]=(pos>>24)&0x00FF;
1586 drvcmd[3]=(pos>>16)&0x00FF;
1587 drvcmd[4]=(pos>>8)&0x00FF;
1588 drvcmd[5]=pos&0x00FF;
1589 current_drive->n_bytes=1;
1590 }
1591 response_count=0;
1592 i=cmd_out();
1593 return (i);
1594}
1595/*==========================================================================*/
1596static int cc_SpinUp(void)
1597{
1598 int i;
1599
1600 msg(DBG_SPI,"SpinUp.\n");
1601 current_drive->in_SpinUp = 1;
1602 clr_cmdbuf();
1603 if (fam0LV_drive)
1604 {
1605 drvcmd[0]=CMD0_SPINUP;
1606 if (fam0L_drive)
1607 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|
1608 f_ResponseStatus|f_obey_p_check|f_bit1;
1609 else
1610 flags_cmd_out=f_putcmd;
1611 }
1612 else if (fam1_drive)
1613 {
1614 drvcmd[0]=CMD1_SPINUP;
1615 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
1616 }
1617 else if (fam2_drive)
1618 {
1619 drvcmd[0]=CMD2_TRAY_CTL;
1620 drvcmd[4]=0x01; /* "spinup" */
1621 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
1622 }
1623 else if (famT_drive)
1624 {
1625 drvcmd[0]=CMDT_TRAY_CTL;
1626 drvcmd[4]=0x03; /* "insert", it hopefully spins the drive up */
1627 }
1628 response_count=0;
1629 i=cmd_out();
1630 current_drive->in_SpinUp = 0;
1631 return (i);
1632}
1633/*==========================================================================*/
1634static int cc_SpinDown(void)
1635{
1636 int i;
1637
1638 if (fam0_drive) return (0);
1639 clr_cmdbuf();
1640 response_count=0;
1641 if (fam1_drive)
1642 {
1643 drvcmd[0]=CMD1_SPINDOWN;
1644 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
1645 }
1646 else if (fam2_drive)
1647 {
1648 drvcmd[0]=CMD2_TRAY_CTL;
1649 drvcmd[4]=0x02; /* "eject" */
1650 flags_cmd_out=f_putcmd|f_ResponseStatus;
1651 }
1652 else if (famL_drive)
1653 {
1654 drvcmd[0]=CMDL_SPINDOWN;
1655 drvcmd[1]=1;
1656 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check|f_bit1;
1657 }
1658 else if (famV_drive)
1659 {
1660 drvcmd[0]=CMDV_SPINDOWN;
1661 flags_cmd_out=f_putcmd;
1662 }
1663 else if (famT_drive)
1664 {
1665 drvcmd[0]=CMDT_TRAY_CTL;
1666 drvcmd[4]=0x02; /* "eject" */
1667 }
1668 i=cmd_out();
1669 return (i);
1670}
1671/*==========================================================================*/
1672static int cc_get_mode_T(void)
1673{
1674 int i;
1675
1676 clr_cmdbuf();
1677 response_count=10;
1678 drvcmd[0]=CMDT_GETMODE;
1679 drvcmd[4]=response_count;
1680 i=cmd_out_T();
1681 return (i);
1682}
1683/*==========================================================================*/
1684static int cc_set_mode_T(void)
1685{
1686 int i;
1687
1688 clr_cmdbuf();
1689 response_count=1;
1690 drvcmd[0]=CMDT_SETMODE;
1691 drvcmd[1]=current_drive->speed_byte;
1692 drvcmd[2]=current_drive->frmsiz>>8;
1693 drvcmd[3]=current_drive->frmsiz&0x0FF;
1694 drvcmd[4]=current_drive->f_XA; /* 1: XA */
1695 drvcmd[5]=current_drive->type_byte; /* 0, 1, 3 */
1696 drvcmd[6]=current_drive->mode_xb_6;
1697 drvcmd[7]=current_drive->mode_yb_7|current_drive->volume_control;
1698 drvcmd[8]=current_drive->mode_xb_8;
1699 drvcmd[9]=current_drive->delay;
1700 i=cmd_out_T();
1701 return (i);
1702}
1703/*==========================================================================*/
1704static int cc_prep_mode_T(void)
1705{
1706 int i, j;
1707
1708 i=cc_get_mode_T();
1709 if (i<0) return (i);
1710 for (i=0;i<10;i++)
1711 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
1712 msgbuf[i*3]=0;
1713 msg(DBG_TEA,"CMDT_GETMODE:%s\n", msgbuf);
1714 current_drive->speed_byte=0x02; /* 0x02: auto quad, 0x82: quad, 0x81: double, 0x80: single */
1715 current_drive->frmsiz=make16(infobuf[2],infobuf[3]);
1716 current_drive->f_XA=infobuf[4];
1717 if (current_drive->f_XA==0) current_drive->type_byte=0;
1718 else current_drive->type_byte=1;
1719 current_drive->mode_xb_6=infobuf[6];
1720 current_drive->mode_yb_7=1;
1721 current_drive->mode_xb_8=infobuf[8];
1722 current_drive->delay=0; /* 0, 1, 2, 3 */
1723 j=cc_set_mode_T();
1724 i=cc_get_mode_T();
1725 for (i=0;i<10;i++)
1726 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
1727 msgbuf[i*3]=0;
1728 msg(DBG_TEA,"CMDT_GETMODE:%s\n", msgbuf);
1729 return (j);
1730}
1731/*==========================================================================*/
1732static int cc_SetSpeed(u_char speed, u_char x1, u_char x2)
1733{
1734 int i;
1735
1736 if (fam0LV_drive) return (0);
1737 clr_cmdbuf();
1738 response_count=0;
1739 if (fam1_drive)
1740 {
1741 drvcmd[0]=CMD1_SETMODE;
1742 drvcmd[1]=0x03;
1743 drvcmd[2]=speed;
1744 drvcmd[3]=x1;
1745 drvcmd[4]=x2;
1746 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
1747 }
1748 else if (fam2_drive)
1749 {
1750 drvcmd[0]=CMD2_SETSPEED;
1751 if (speed&speed_auto)
1752 {
1753 drvcmd[2]=0xFF;
1754 drvcmd[3]=0xFF;
1755 }
1756 else
1757 {
1758 drvcmd[2]=0;
1759 drvcmd[3]=150;
1760 }
1761 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
1762 }
1763 else if (famT_drive)
1764 {
1765 return (0);
1766 }
1767 i=cmd_out();
1768 return (i);
1769}
1770/*==========================================================================*/
1771static int cc_SetVolume(void)
1772{
1773 int i;
1774 u_char channel0,channel1,volume0,volume1;
1775 u_char control0,value0,control1,value1;
1776
1777 current_drive->diskstate_flags &= ~volume_bit;
1778 clr_cmdbuf();
1779 channel0=current_drive->vol_chan0;
1780 volume0=current_drive->vol_ctrl0;
1781 channel1=control1=current_drive->vol_chan1;
1782 volume1=value1=current_drive->vol_ctrl1;
1783 control0=value0=0;
1784
1785 if (famV_drive) return (0);
1786
1787 if (((current_drive->drv_options&audio_mono)!=0)&&(current_drive->drv_type>=drv_211))
1788 {
1789 if ((volume0!=0)&&(volume1==0))
1790 {
1791 volume1=volume0;
1792 channel1=channel0;
1793 }
1794 else if ((volume0==0)&&(volume1!=0))
1795 {
1796 volume0=volume1;
1797 channel0=channel1;
1798 }
1799 }
1800 if (channel0>1)
1801 {
1802 channel0=0;
1803 volume0=0;
1804 }
1805 if (channel1>1)
1806 {
1807 channel1=1;
1808 volume1=0;
1809 }
1810
1811 if (fam1_drive)
1812 {
1813 control0=channel0+1;
1814 control1=channel1+1;
1815 value0=(volume0>volume1)?volume0:volume1;
1816 value1=value0;
1817 if (volume0==0) control0=0;
1818 if (volume1==0) control1=0;
1819 drvcmd[0]=CMD1_SETMODE;
1820 drvcmd[1]=0x05;
1821 drvcmd[3]=control0;
1822 drvcmd[4]=value0;
1823 drvcmd[5]=control1;
1824 drvcmd[6]=value1;
1825 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
1826 }
1827 else if (fam2_drive)
1828 {
1829 control0=channel0+1;
1830 control1=channel1+1;
1831 value0=(volume0>volume1)?volume0:volume1;
1832 value1=value0;
1833 if (volume0==0) control0=0;
1834 if (volume1==0) control1=0;
1835 drvcmd[0]=CMD2_SETMODE;
1836 drvcmd[1]=0x0E;
1837 drvcmd[3]=control0;
1838 drvcmd[4]=value0;
1839 drvcmd[5]=control1;
1840 drvcmd[6]=value1;
1841 flags_cmd_out=f_putcmd|f_ResponseStatus;
1842 }
1843 else if (famL_drive)
1844 {
1845 if ((volume0==0)||(channel0!=0)) control0 |= 0x80;
1846 if ((volume1==0)||(channel1!=1)) control0 |= 0x40;
1847 if (volume0|volume1) value0=0x80;
1848 drvcmd[0]=CMDL_SETMODE;
1849 drvcmd[1]=0x03;
1850 drvcmd[4]=control0;
1851 drvcmd[5]=value0;
1852 flags_cmd_out=f_putcmd|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check|f_bit1;
1853 }
1854 else if (fam0_drive) /* different firmware levels */
1855 {
1856 if (current_drive->drv_type>=drv_300)
1857 {
1858 control0=volume0&0xFC;
1859 value0=volume1&0xFC;
1860 if ((volume0!=0)&&(volume0<4)) control0 |= 0x04;
1861 if ((volume1!=0)&&(volume1<4)) value0 |= 0x04;
1862 if (channel0!=0) control0 |= 0x01;
1863 if (channel1==1) value0 |= 0x01;
1864 }
1865 else
1866 {
1867 value0=(volume0>volume1)?volume0:volume1;
1868 if (current_drive->drv_type<drv_211)
1869 {
1870 if (channel0!=0)
1871 {
1872 i=channel1;
1873 channel1=channel0;
1874 channel0=i;
1875 i=volume1;
1876 volume1=volume0;
1877 volume0=i;
1878 }
1879 if (channel0==channel1)
1880 {
1881 if (channel0==0)
1882 {
1883 channel1=1;
1884 volume1=0;
1885 volume0=value0;
1886 }
1887 else
1888 {
1889 channel0=0;
1890 volume0=0;
1891 volume1=value0;
1892 }
1893 }
1894 }
1895
1896 if ((volume0!=0)&&(volume1!=0))
1897 {
1898 if (volume0==0xFF) volume1=0xFF;
1899 else if (volume1==0xFF) volume0=0xFF;
1900 }
1901 else if (current_drive->drv_type<drv_201) volume0=volume1=value0;
1902
1903 if (current_drive->drv_type>=drv_201)
1904 {
1905 if (volume0==0) control0 |= 0x80;
1906 if (volume1==0) control0 |= 0x40;
1907 }
1908 if (current_drive->drv_type>=drv_211)
1909 {
1910 if (channel0!=0) control0 |= 0x20;
1911 if (channel1!=1) control0 |= 0x10;
1912 }
1913 }
1914 drvcmd[0]=CMD0_SETMODE;
1915 drvcmd[1]=0x83;
1916 drvcmd[4]=control0;
1917 drvcmd[5]=value0;
1918 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
1919 }
1920 else if (famT_drive)
1921 {
1922 current_drive->volume_control=0;
1923 if (!volume0) current_drive->volume_control|=0x10;
1924 if (!volume1) current_drive->volume_control|=0x20;
1925 i=cc_prep_mode_T();
1926 if (i<0) return (i);
1927 }
1928 if (!famT_drive)
1929 {
1930 response_count=0;
1931 i=cmd_out();
1932 if (i<0) return (i);
1933 }
1934 current_drive->diskstate_flags |= volume_bit;
1935 return (0);
1936}
1937/*==========================================================================*/
1938static int GetStatus(void)
1939{
1940 int i;
1941
1942 if (famT_drive) return (0);
1943 flags_cmd_out=f_getsta|f_ResponseStatus|f_obey_p_check;
1944 response_count=0;
1945 cmd_type=0;
1946 i=cmd_out();
1947 return (i);
1948}
1949/*==========================================================================*/
1950static int cc_DriveReset(void)
1951{
1952 int i;
1953
1954 msg(DBG_RES,"cc_DriveReset called.\n");
1955 clr_cmdbuf();
1956 response_count=0;
1957 if (fam0LV_drive) OUT(CDo_reset,0x00);
1958 else if (fam1_drive)
1959 {
1960 drvcmd[0]=CMD1_RESET;
1961 flags_cmd_out=f_putcmd;
1962 i=cmd_out();
1963 }
1964 else if (fam2_drive)
1965 {
1966 drvcmd[0]=CMD2_RESET;
1967 flags_cmd_out=f_putcmd;
1968 i=cmd_out();
1969 OUT(CDo_reset,0x00);
1970 }
1971 else if (famT_drive)
1972 {
1973 OUT(CDo_sel_i_d,0);
1974 OUT(CDo_enable,current_drive->drv_sel);
1975 OUT(CDo_command,CMDT_RESET);
1976 for (i=1;i<10;i++) OUT(CDo_command,0);
1977 }
1978 if (fam0LV_drive) sbp_sleep(5*HZ); /* wait 5 seconds */
1979 else sbp_sleep(1*HZ); /* wait a second */
1980#if 1
1981 if (famT_drive)
1982 {
1983 msg(DBG_TEA, "================CMDT_RESET given=================.\n");
1984 sbp_sleep(3*HZ);
1985 }
1986#endif /* 1 */
1987 flush_status();
1988 i=GetStatus();
1989 if (i<0) return i;
1990 if (!famT_drive)
1991 if (current_drive->error_byte!=aud_12) return -501;
1992 return (0);
1993}
1994
1995/*==========================================================================*/
1996static int SetSpeed(void)
1997{
1998 int i, speed;
1999
2000 if (!(current_drive->drv_options&(speed_auto|speed_300|speed_150))) return (0);
2001 speed=speed_auto;
2002 if (!(current_drive->drv_options&speed_auto))
2003 {
2004 speed |= speed_300;
2005 if (!(current_drive->drv_options&speed_300)) speed=0;
2006 }
2007 i=cc_SetSpeed(speed,0,0);
2008 return (i);
2009}
2010
2011static void switch_drive(struct sbpcd_drive *);
2012
2013static int sbpcd_select_speed(struct cdrom_device_info *cdi, int speed)
2014{
2015 struct sbpcd_drive *p = cdi->handle;
2016 if (p != current_drive)
2017 switch_drive(p);
2018
2019 return cc_SetSpeed(speed == 2 ? speed_300 : speed_150, 0, 0);
2020}
2021
2022/*==========================================================================*/
2023static int DriveReset(void)
2024{
2025 int i;
2026
2027 i=cc_DriveReset();
2028 if (i<0) return (-22);
2029 do
2030 {
2031 i=GetStatus();
2032 if ((i<0)&&(i!=-ERR_DISKCHANGE)) {
2033 return (-2); /* from sta2err */
2034 }
2035 if (!st_caddy_in) break;
2036 sbp_sleep(1);
2037 }
2038 while (!st_diskok);
2039#if 000
2040 current_drive->CD_changed=1;
2041#endif
2042 if ((st_door_closed) && (st_caddy_in))
2043 {
2044 i=DiskInfo();
2045 if (i<0) return (-23);
2046 }
2047 return (0);
2048}
2049
2050static int sbpcd_reset(struct cdrom_device_info *cdi)
2051{
2052 struct sbpcd_drive *p = cdi->handle;
2053 if (p != current_drive)
2054 switch_drive(p);
2055 return DriveReset();
2056}
2057
2058/*==========================================================================*/
2059static int cc_PlayAudio(int pos_audio_start,int pos_audio_end)
2060{
2061 int i, j, n;
2062
2063 if (current_drive->audio_state==audio_playing) return (-EINVAL);
2064 clr_cmdbuf();
2065 response_count=0;
2066 if (famLV_drive)
2067 {
2068 drvcmd[0]=CMDL_PLAY;
2069 i=msf2blk(pos_audio_start);
2070 n=msf2blk(pos_audio_end)+1-i;
2071 drvcmd[1]=(i>>16)&0x00FF;
2072 drvcmd[2]=(i>>8)&0x00FF;
2073 drvcmd[3]=i&0x00FF;
2074 drvcmd[4]=(n>>16)&0x00FF;
2075 drvcmd[5]=(n>>8)&0x00FF;
2076 drvcmd[6]=n&0x00FF;
2077 if (famL_drive)
2078 flags_cmd_out = f_putcmd | f_respo2 | f_lopsta | f_getsta |
2079 f_ResponseStatus | f_obey_p_check | f_wait_if_busy;
2080 else
2081 flags_cmd_out = f_putcmd;
2082 }
2083 else
2084 {
2085 j=1;
2086 if (fam1_drive)
2087 {
2088 drvcmd[0]=CMD1_PLAY_MSF;
2089 flags_cmd_out = f_putcmd | f_respo2 | f_ResponseStatus |
2090 f_obey_p_check | f_wait_if_busy;
2091 }
2092 else if (fam2_drive)
2093 {
2094 drvcmd[0]=CMD2_PLAY_MSF;
2095 flags_cmd_out = f_putcmd | f_ResponseStatus | f_obey_p_check;
2096 }
2097 else if (famT_drive)
2098 {
2099 drvcmd[0]=CMDT_PLAY_MSF;
2100 j=3;
2101 response_count=1;
2102 }
2103 else if (fam0_drive)
2104 {
2105 drvcmd[0]=CMD0_PLAY_MSF;
2106 flags_cmd_out = f_putcmd | f_respo2 | f_lopsta | f_getsta |
2107 f_ResponseStatus | f_obey_p_check | f_wait_if_busy;
2108 }
2109 drvcmd[j]=(pos_audio_start>>16)&0x00FF;
2110 drvcmd[j+1]=(pos_audio_start>>8)&0x00FF;
2111 drvcmd[j+2]=pos_audio_start&0x00FF;
2112 drvcmd[j+3]=(pos_audio_end>>16)&0x00FF;
2113 drvcmd[j+4]=(pos_audio_end>>8)&0x00FF;
2114 drvcmd[j+5]=pos_audio_end&0x00FF;
2115 }
2116 i=cmd_out();
2117 return (i);
2118}
2119/*==========================================================================*/
2120static int cc_Pause_Resume(int pau_res)
2121{
2122 int i;
2123
2124 clr_cmdbuf();
2125 response_count=0;
2126 if (fam1_drive)
2127 {
2128 drvcmd[0]=CMD1_PAU_RES;
2129 if (pau_res!=1) drvcmd[1]=0x80;
2130 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
2131 }
2132 else if (fam2_drive)
2133 {
2134 drvcmd[0]=CMD2_PAU_RES;
2135 if (pau_res!=1) drvcmd[2]=0x01;
2136 flags_cmd_out=f_putcmd|f_ResponseStatus;
2137 }
2138 else if (fam0LV_drive)
2139 {
2140 drvcmd[0]=CMD0_PAU_RES;
2141 if (pau_res!=1) drvcmd[1]=0x80;
2142 if (famL_drive)
2143 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|f_ResponseStatus|
2144 f_obey_p_check|f_bit1;
2145 else if (famV_drive)
2146 flags_cmd_out=f_putcmd;
2147 else
2148 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|f_ResponseStatus|
2149 f_obey_p_check;
2150 }
2151 else if (famT_drive)
2152 {
2153 if (pau_res==3) return (cc_PlayAudio(current_drive->pos_audio_start,current_drive->pos_audio_end));
2154 else if (pau_res==1) drvcmd[0]=CMDT_PAUSE;
2155 else return (-56);
2156 }
2157 i=cmd_out();
2158 return (i);
2159}
2160/*==========================================================================*/
2161static int cc_LockDoor(char lock)
2162{
2163 int i;
2164
2165 if (fam0_drive) return (0);
2166 msg(DBG_LCK,"cc_LockDoor: %d (drive %d)\n", lock, current_drive - D_S);
2167 msg(DBG_LCS,"p_door_locked bit %d before\n", st_door_locked);
2168 clr_cmdbuf();
2169 response_count=0;
2170 if (fam1_drive)
2171 {
2172 drvcmd[0]=CMD1_LOCK_CTL;
2173 if (lock==1) drvcmd[1]=0x01;
2174 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2175 }
2176 else if (fam2_drive)
2177 {
2178 drvcmd[0]=CMD2_LOCK_CTL;
2179 if (lock==1) drvcmd[4]=0x01;
2180 flags_cmd_out=f_putcmd|f_ResponseStatus;
2181 }
2182 else if (famLV_drive)
2183 {
2184 drvcmd[0]=CMDL_LOCK_CTL;
2185 if (lock==1) drvcmd[1]=0x01;
2186 if (famL_drive)
2187 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check|f_bit1;
2188 else
2189 flags_cmd_out=f_putcmd;
2190 }
2191 else if (famT_drive)
2192 {
2193 drvcmd[0]=CMDT_LOCK_CTL;
2194 if (lock==1) drvcmd[4]=0x01;
2195 }
2196 i=cmd_out();
2197 msg(DBG_LCS,"p_door_locked bit %d after\n", st_door_locked);
2198 return (i);
2199}
2200/*==========================================================================*/
2201/*==========================================================================*/
2202static int UnLockDoor(void)
2203{
2204 int i,j;
2205
2206 j=20;
2207 do
2208 {
2209 i=cc_LockDoor(0);
2210 --j;
2211 sbp_sleep(1);
2212 }
2213 while ((i<0)&&(j));
2214 if (i<0)
2215 {
2216 cc_DriveReset();
2217 return -84;
2218 }
2219 return (0);
2220}
2221/*==========================================================================*/
2222static int LockDoor(void)
2223{
2224 int i,j;
2225
2226 j=20;
2227 do
2228 {
2229 i=cc_LockDoor(1);
2230 --j;
2231 sbp_sleep(1);
2232 }
2233 while ((i<0)&&(j));
2234 if (j==0)
2235 {
2236 cc_DriveReset();
2237 j=20;
2238 do
2239 {
2240 i=cc_LockDoor(1);
2241 --j;
2242 sbp_sleep(1);
2243 }
2244 while ((i<0)&&(j));
2245 }
2246 return (i);
2247}
2248
2249static int sbpcd_lock_door(struct cdrom_device_info *cdi, int lock)
2250{
2251 return lock ? LockDoor() : UnLockDoor();
2252}
2253
2254/*==========================================================================*/
2255static int cc_CloseTray(void)
2256{
2257 int i;
2258
2259 if (fam0_drive) return (0);
2260 msg(DBG_LCK,"cc_CloseTray (drive %d)\n", current_drive - D_S);
2261 msg(DBG_LCS,"p_door_closed bit %d before\n", st_door_closed);
2262
2263 clr_cmdbuf();
2264 response_count=0;
2265 if (fam1_drive)
2266 {
2267 drvcmd[0]=CMD1_TRAY_CTL;
2268 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
2269 }
2270 else if (fam2_drive)
2271 {
2272 drvcmd[0]=CMD2_TRAY_CTL;
2273 drvcmd[1]=0x01;
2274 drvcmd[4]=0x03; /* "insert" */
2275 flags_cmd_out=f_putcmd|f_ResponseStatus;
2276 }
2277 else if (famLV_drive)
2278 {
2279 drvcmd[0]=CMDL_TRAY_CTL;
2280 if (famLV_drive)
2281 flags_cmd_out=f_putcmd|f_respo2|f_lopsta|f_getsta|
2282 f_ResponseStatus|f_obey_p_check|f_bit1;
2283 else
2284 flags_cmd_out=f_putcmd;
2285 }
2286 else if (famT_drive)
2287 {
2288 drvcmd[0]=CMDT_TRAY_CTL;
2289 drvcmd[4]=0x03; /* "insert" */
2290 }
2291 i=cmd_out();
2292 msg(DBG_LCS,"p_door_closed bit %d after\n", st_door_closed);
2293
2294 i=cc_ReadError();
2295 flags_cmd_out |= f_respo2;
2296 cc_ReadStatus(); /* command: give 1-byte status */
2297 i=ResponseStatus();
2298 if (famT_drive&&(i<0))
2299 {
2300 cc_DriveReset();
2301 i=ResponseStatus();
2302#if 0
2303 sbp_sleep(HZ);
2304#endif /* 0 */
2305 i=ResponseStatus();
2306 }
2307 if (i<0)
2308 {
2309 msg(DBG_INF,"sbpcd cc_CloseTray: ResponseStatus timed out (%d).\n",i);
2310 }
2311 if (!(famT_drive))
2312 {
2313 if (!st_spinning)
2314 {
2315 cc_SpinUp();
2316 if (st_check) i=cc_ReadError();
2317 flags_cmd_out |= f_respo2;
2318 cc_ReadStatus();
2319 i=ResponseStatus();
2320 } else {
2321 }
2322 }
2323 i=DiskInfo();
2324 return (i);
2325}
2326
2327static int sbpcd_tray_move(struct cdrom_device_info *cdi, int position)
2328{
2329 int retval=0;
2330 switch_drive(cdi->handle);
2331 /* DUH! --AJK */
2332 if(current_drive->CD_changed != 0xFF) {
2333 current_drive->CD_changed=0xFF;
2334 current_drive->diskstate_flags &= ~cd_size_bit;
2335 }
2336 if (position == 1) {
2337 cc_SpinDown();
2338 } else {
2339 retval=cc_CloseTray();
2340 }
2341 return retval;
2342}
2343
2344/*==========================================================================*/
2345static int cc_ReadSubQ(void)
2346{
2347 int i,j;
2348
2349 current_drive->diskstate_flags &= ~subq_bit;
2350 for (j=255;j>0;j--)
2351 {
2352 clr_cmdbuf();
2353 if (fam1_drive)
2354 {
2355 drvcmd[0]=CMD1_READSUBQ;
2356 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2357 response_count=11;
2358 }
2359 else if (fam2_drive)
2360 {
2361 drvcmd[0]=CMD2_READSUBQ;
2362 drvcmd[1]=0x02;
2363 drvcmd[3]=0x01;
2364 flags_cmd_out=f_putcmd;
2365 response_count=10;
2366 }
2367 else if (fam0LV_drive)
2368 {
2369 drvcmd[0]=CMD0_READSUBQ;
2370 drvcmd[1]=0x02;
2371 if (famLV_drive)
2372 flags_cmd_out=f_putcmd;
2373 else
2374 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2375 response_count=13;
2376 }
2377 else if (famT_drive)
2378 {
2379 response_count=12;
2380 drvcmd[0]=CMDT_READSUBQ;
2381 drvcmd[1]=0x02;
2382 drvcmd[2]=0x40;
2383 drvcmd[3]=0x01;
2384 drvcmd[8]=response_count;
2385 }
2386 i=cmd_out();
2387 if (i<0) return (i);
2388 for (i=0;i<response_count;i++)
2389 {
2390 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
2391 msgbuf[i*3]=0;
2392 msg(DBG_SQ1,"cc_ReadSubQ:%s\n", msgbuf);
2393 }
2394 if (famT_drive) break;
2395 if (infobuf[0]!=0) break;
2396 if ((!st_spinning) || (j==1))
2397 {
2398 current_drive->SubQ_ctl_adr=current_drive->SubQ_trk=current_drive->SubQ_pnt_idx=current_drive->SubQ_whatisthis=0;
2399 current_drive->SubQ_run_tot=current_drive->SubQ_run_trk=0;
2400 return (0);
2401 }
2402 }
2403 if (famT_drive) current_drive->SubQ_ctl_adr=infobuf[1];
2404 else current_drive->SubQ_ctl_adr=swap_nibbles(infobuf[1]);
2405 current_drive->SubQ_trk=byt2bcd(infobuf[2]);
2406 current_drive->SubQ_pnt_idx=byt2bcd(infobuf[3]);
2407 if (fam0LV_drive) i=5;
2408 else if (fam12_drive) i=4;
2409 else if (famT_drive) i=8;
2410 current_drive->SubQ_run_tot=make32(make16(0,infobuf[i]),make16(infobuf[i+1],infobuf[i+2])); /* msf-bin */
2411 i=7;
2412 if (fam0LV_drive) i=9;
2413 else if (fam12_drive) i=7;
2414 else if (famT_drive) i=4;
2415 current_drive->SubQ_run_trk=make32(make16(0,infobuf[i]),make16(infobuf[i+1],infobuf[i+2])); /* msf-bin */
2416 current_drive->SubQ_whatisthis=infobuf[i+3];
2417 current_drive->diskstate_flags |= subq_bit;
2418 return (0);
2419}
2420/*==========================================================================*/
2421static int cc_ModeSense(void)
2422{
2423 int i;
2424
2425 if (fam2_drive) return (0);
2426 if (famV_drive) return (0);
2427 current_drive->diskstate_flags &= ~frame_size_bit;
2428 clr_cmdbuf();
2429 if (fam1_drive)
2430 {
2431 response_count=5;
2432 drvcmd[0]=CMD1_GETMODE;
2433 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2434 }
2435 else if (fam0L_drive)
2436 {
2437 response_count=2;
2438 drvcmd[0]=CMD0_GETMODE;
2439 if (famL_drive) flags_cmd_out=f_putcmd;
2440 else flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2441 }
2442 else if (famT_drive)
2443 {
2444 response_count=10;
2445 drvcmd[0]=CMDT_GETMODE;
2446 drvcmd[4]=response_count;
2447 }
2448 i=cmd_out();
2449 if (i<0) return (i);
2450 i=0;
2451 current_drive->sense_byte=0;
2452 if (fam1_drive) current_drive->sense_byte=infobuf[i++];
2453 else if (famT_drive)
2454 {
2455 if (infobuf[4]==0x01) current_drive->xa_byte=0x20;
2456 else current_drive->xa_byte=0;
2457 i=2;
2458 }
2459 current_drive->frame_size=make16(infobuf[i],infobuf[i+1]);
2460 for (i=0;i<response_count;i++)
2461 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
2462 msgbuf[i*3]=0;
2463 msg(DBG_XA1,"cc_ModeSense:%s\n", msgbuf);
2464
2465 current_drive->diskstate_flags |= frame_size_bit;
2466 return (0);
2467}
2468/*==========================================================================*/
2469/*==========================================================================*/
2470static int cc_ModeSelect(int framesize)
2471{
2472 int i;
2473
2474 if (fam2_drive) return (0);
2475 if (famV_drive) return (0);
2476 current_drive->diskstate_flags &= ~frame_size_bit;
2477 clr_cmdbuf();
2478 current_drive->frame_size=framesize;
2479 if (framesize==CD_FRAMESIZE_RAW) current_drive->sense_byte=0x82;
2480 else current_drive->sense_byte=0x00;
2481
2482 msg(DBG_XA1,"cc_ModeSelect: %02X %04X\n",
2483 current_drive->sense_byte, current_drive->frame_size);
2484
2485 if (fam1_drive)
2486 {
2487 drvcmd[0]=CMD1_SETMODE;
2488 drvcmd[1]=0x00;
2489 drvcmd[2]=current_drive->sense_byte;
2490 drvcmd[3]=(current_drive->frame_size>>8)&0xFF;
2491 drvcmd[4]=current_drive->frame_size&0xFF;
2492 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2493 }
2494 else if (fam0L_drive)
2495 {
2496 drvcmd[0]=CMD0_SETMODE;
2497 drvcmd[1]=0x00;
2498 drvcmd[2]=(current_drive->frame_size>>8)&0xFF;
2499 drvcmd[3]=current_drive->frame_size&0xFF;
2500 drvcmd[4]=0x00;
2501 if(famL_drive)
2502 flags_cmd_out=f_putcmd|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check;
2503 else
2504 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2505 }
2506 else if (famT_drive)
2507 {
2508 return (-1);
2509 }
2510 response_count=0;
2511 i=cmd_out();
2512 if (i<0) return (i);
2513 current_drive->diskstate_flags |= frame_size_bit;
2514 return (0);
2515}
2516/*==========================================================================*/
2517static int cc_GetVolume(void)
2518{
2519 int i;
2520 u_char switches;
2521 u_char chan0=0;
2522 u_char vol0=0;
2523 u_char chan1=1;
2524 u_char vol1=0;
2525
2526 if (famV_drive) return (0);
2527 current_drive->diskstate_flags &= ~volume_bit;
2528 clr_cmdbuf();
2529 if (fam1_drive)
2530 {
2531 drvcmd[0]=CMD1_GETMODE;
2532 drvcmd[1]=0x05;
2533 response_count=5;
2534 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2535 }
2536 else if (fam2_drive)
2537 {
2538 drvcmd[0]=CMD2_GETMODE;
2539 drvcmd[1]=0x0E;
2540 response_count=5;
2541 flags_cmd_out=f_putcmd;
2542 }
2543 else if (fam0L_drive)
2544 {
2545 drvcmd[0]=CMD0_GETMODE;
2546 drvcmd[1]=0x03;
2547 response_count=2;
2548 if(famL_drive)
2549 flags_cmd_out=f_putcmd;
2550 else
2551 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2552 }
2553 else if (famT_drive)
2554 {
2555 i=cc_get_mode_T();
2556 if (i<0) return (i);
2557 }
2558 if (!famT_drive)
2559 {
2560 i=cmd_out();
2561 if (i<0) return (i);
2562 }
2563 if (fam1_drive)
2564 {
2565 chan0=infobuf[1]&0x0F;
2566 vol0=infobuf[2];
2567 chan1=infobuf[3]&0x0F;
2568 vol1=infobuf[4];
2569 if (chan0==0)
2570 {
2571 chan0=1;
2572 vol0=0;
2573 }
2574 if (chan1==0)
2575 {
2576 chan1=2;
2577 vol1=0;
2578 }
2579 chan0 >>= 1;
2580 chan1 >>= 1;
2581 }
2582 else if (fam2_drive)
2583 {
2584 chan0=infobuf[1];
2585 vol0=infobuf[2];
2586 chan1=infobuf[3];
2587 vol1=infobuf[4];
2588 }
2589 else if (famL_drive)
2590 {
2591 chan0=0;
2592 chan1=1;
2593 vol0=vol1=infobuf[1];
2594 switches=infobuf[0];
2595 if ((switches&0x80)!=0) chan0=1;
2596 if ((switches&0x40)!=0) chan1=0;
2597 }
2598 else if (fam0_drive) /* different firmware levels */
2599 {
2600 chan0=0;
2601 chan1=1;
2602 vol0=vol1=infobuf[1];
2603 if (current_drive->drv_type>=drv_201)
2604 {
2605 if (current_drive->drv_type<drv_300)
2606 {
2607 switches=infobuf[0];
2608 if ((switches&0x80)!=0) vol0=0;
2609 if ((switches&0x40)!=0) vol1=0;
2610 if (current_drive->drv_type>=drv_211)
2611 {
2612 if ((switches&0x20)!=0) chan0=1;
2613 if ((switches&0x10)!=0) chan1=0;
2614 }
2615 }
2616 else
2617 {
2618 vol0=infobuf[0];
2619 if ((vol0&0x01)!=0) chan0=1;
2620 if ((vol1&0x01)==0) chan1=0;
2621 vol0 &= 0xFC;
2622 vol1 &= 0xFC;
2623 if (vol0!=0) vol0 += 3;
2624 if (vol1!=0) vol1 += 3;
2625 }
2626 }
2627 }
2628 else if (famT_drive)
2629 {
2630 current_drive->volume_control=infobuf[7];
2631 chan0=0;
2632 chan1=1;
2633 if (current_drive->volume_control&0x10) vol0=0;
2634 else vol0=0xff;
2635 if (current_drive->volume_control&0x20) vol1=0;
2636 else vol1=0xff;
2637 }
2638 current_drive->vol_chan0=chan0;
2639 current_drive->vol_ctrl0=vol0;
2640 current_drive->vol_chan1=chan1;
2641 current_drive->vol_ctrl1=vol1;
2642#if 000
2643 current_drive->vol_chan2=2;
2644 current_drive->vol_ctrl2=0xFF;
2645 current_drive->vol_chan3=3;
2646 current_drive->vol_ctrl3=0xFF;
2647#endif /* 000 */
2648 current_drive->diskstate_flags |= volume_bit;
2649 return (0);
2650}
2651/*==========================================================================*/
2652static int cc_ReadCapacity(void)
2653{
2654 int i, j;
2655
2656 if (fam2_drive) return (0); /* some firmware lacks this command */
2657 if (famLV_drive) return (0); /* some firmware lacks this command */
2658 if (famT_drive) return (0); /* done with cc_ReadTocDescr() */
2659 current_drive->diskstate_flags &= ~cd_size_bit;
2660 for (j=3;j>0;j--)
2661 {
2662 clr_cmdbuf();
2663 if (fam1_drive)
2664 {
2665 drvcmd[0]=CMD1_CAPACITY;
2666 response_count=5;
2667 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2668 }
2669#if 00
2670 else if (fam2_drive)
2671 {
2672 drvcmd[0]=CMD2_CAPACITY;
2673 response_count=8;
2674 flags_cmd_out=f_putcmd;
2675 }
2676#endif
2677 else if (fam0_drive)
2678 {
2679 drvcmd[0]=CMD0_CAPACITY;
2680 response_count=5;
2681 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2682 }
2683 i=cmd_out();
2684 if (i>=0) break;
2685 msg(DBG_000,"cc_ReadCapacity: cmd_out: err %d\n", i);
2686 cc_ReadError();
2687 }
2688 if (j==0) return (i);
2689 if (fam1_drive) current_drive->CDsize_frm=msf2blk(make32(make16(0,infobuf[0]),make16(infobuf[1],infobuf[2])))+CD_MSF_OFFSET;
2690 else if (fam0_drive) current_drive->CDsize_frm=make32(make16(0,infobuf[0]),make16(infobuf[1],infobuf[2]));
2691#if 00
2692 else if (fam2_drive) current_drive->CDsize_frm=make32(make16(infobuf[0],infobuf[1]),make16(infobuf[2],infobuf[3]));
2693#endif
2694 current_drive->diskstate_flags |= cd_size_bit;
2695 msg(DBG_000,"cc_ReadCapacity: %d frames.\n", current_drive->CDsize_frm);
2696 return (0);
2697}
2698/*==========================================================================*/
2699static int cc_ReadTocDescr(void)
2700{
2701 int i;
2702
2703 current_drive->diskstate_flags &= ~toc_bit;
2704 clr_cmdbuf();
2705 if (fam1_drive)
2706 {
2707 drvcmd[0]=CMD1_DISKINFO;
2708 response_count=6;
2709 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2710 }
2711 else if (fam0LV_drive)
2712 {
2713 drvcmd[0]=CMD0_DISKINFO;
2714 response_count=6;
2715 if(famLV_drive)
2716 flags_cmd_out=f_putcmd;
2717 else
2718 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2719 }
2720 else if (fam2_drive)
2721 {
2722 /* possibly longer timeout periods necessary */
2723 current_drive->f_multisession=0;
2724 drvcmd[0]=CMD2_DISKINFO;
2725 drvcmd[1]=0x02;
2726 drvcmd[2]=0xAB;
2727 drvcmd[3]=0xFF; /* session */
2728 response_count=8;
2729 flags_cmd_out=f_putcmd;
2730 }
2731 else if (famT_drive)
2732 {
2733 current_drive->f_multisession=0;
2734 response_count=12;
2735 drvcmd[0]=CMDT_DISKINFO;
2736 drvcmd[1]=0x02;
2737 drvcmd[6]=CDROM_LEADOUT;
2738 drvcmd[8]=response_count;
2739 drvcmd[9]=0x00;
2740 }
2741 i=cmd_out();
2742 if (i<0) return (i);
2743 if ((famT_drive)&&(i<response_count)) return (-100-i);
2744 if ((fam1_drive)||(fam2_drive)||(fam0LV_drive))
2745 current_drive->xa_byte=infobuf[0];
2746 if (fam2_drive)
2747 {
2748 current_drive->first_session=infobuf[1];
2749 current_drive->last_session=infobuf[2];
2750 current_drive->n_first_track=infobuf[3];
2751 current_drive->n_last_track=infobuf[4];
2752 if (current_drive->first_session!=current_drive->last_session)
2753 {
2754 current_drive->f_multisession=1;
2755 current_drive->lba_multi=msf2blk(make32(make16(0,infobuf[5]),make16(infobuf[6],infobuf[7])));
2756 }
2757#if 0
2758 if (current_drive->first_session!=current_drive->last_session)
2759 {
2760 if (current_drive->last_session<=20)
2761 zwanzig=current_drive->last_session+1;
2762 else zwanzig=20;
2763 for (count=current_drive->first_session;count<zwanzig;count++)
2764 {
2765 drvcmd[0]=CMD2_DISKINFO;
2766 drvcmd[1]=0x02;
2767 drvcmd[2]=0xAB;
2768 drvcmd[3]=count;
2769 response_count=8;
2770 flags_cmd_out=f_putcmd;
2771 i=cmd_out();
2772 if (i<0) return (i);
2773 current_drive->msf_multi_n[count]=make32(make16(0,infobuf[5]),make16(infobuf[6],infobuf[7]));
2774 }
2775 current_drive->diskstate_flags |= multisession_bit;
2776 }
2777#endif
2778 drvcmd[0]=CMD2_DISKINFO;
2779 drvcmd[1]=0x02;
2780 drvcmd[2]=0xAA;
2781 drvcmd[3]=0xFF;
2782 response_count=5;
2783 flags_cmd_out=f_putcmd;
2784 i=cmd_out();
2785 if (i<0) return (i);
2786 current_drive->size_msf=make32(make16(0,infobuf[2]),make16(infobuf[3],infobuf[4]));
2787 current_drive->size_blk=msf2blk(current_drive->size_msf);
2788 current_drive->CDsize_frm=current_drive->size_blk+1;
2789 }
2790 else if (famT_drive)
2791 {
2792 current_drive->size_msf=make32(make16(infobuf[8],infobuf[9]),make16(infobuf[10],infobuf[11]));
2793 current_drive->size_blk=msf2blk(current_drive->size_msf);
2794 current_drive->CDsize_frm=current_drive->size_blk+1;
2795 current_drive->n_first_track=infobuf[2];
2796 current_drive->n_last_track=infobuf[3];
2797 }
2798 else
2799 {
2800 current_drive->n_first_track=infobuf[1];
2801 current_drive->n_last_track=infobuf[2];
2802 current_drive->size_msf=make32(make16(0,infobuf[3]),make16(infobuf[4],infobuf[5]));
2803 current_drive->size_blk=msf2blk(current_drive->size_msf);
2804 if (famLV_drive) current_drive->CDsize_frm=current_drive->size_blk+1;
2805 }
2806 current_drive->diskstate_flags |= toc_bit;
2807 msg(DBG_TOC,"TocDesc: xa %02X firstt %02X lastt %02X size %08X firstses %02X lastsess %02X\n",
2808 current_drive->xa_byte,
2809 current_drive->n_first_track,
2810 current_drive->n_last_track,
2811 current_drive->size_msf,
2812 current_drive->first_session,
2813 current_drive->last_session);
2814 return (0);
2815}
2816/*==========================================================================*/
2817static int cc_ReadTocEntry(int num)
2818{
2819 int i;
2820
2821 clr_cmdbuf();
2822 if (fam1_drive)
2823 {
2824 drvcmd[0]=CMD1_READTOC;
2825 drvcmd[2]=num;
2826 response_count=8;
2827 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2828 }
2829 else if (fam2_drive)
2830 {
2831 /* possibly longer timeout periods necessary */
2832 drvcmd[0]=CMD2_DISKINFO;
2833 drvcmd[1]=0x02;
2834 drvcmd[2]=num;
2835 response_count=5;
2836 flags_cmd_out=f_putcmd;
2837 }
2838 else if (fam0LV_drive)
2839 {
2840 drvcmd[0]=CMD0_READTOC;
2841 drvcmd[1]=0x02;
2842 drvcmd[2]=num;
2843 response_count=8;
2844 if (famLV_drive)
2845 flags_cmd_out=f_putcmd;
2846 else
2847 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2848 }
2849 else if (famT_drive)
2850 {
2851 response_count=12;
2852 drvcmd[0]=CMDT_DISKINFO;
2853 drvcmd[1]=0x02;
2854 drvcmd[6]=num;
2855 drvcmd[8]=response_count;
2856 drvcmd[9]=0x00;
2857 }
2858 i=cmd_out();
2859 if (i<0) return (i);
2860 if ((famT_drive)&&(i<response_count)) return (-100-i);
2861 if ((fam1_drive)||(fam0LV_drive))
2862 {
2863 current_drive->TocEnt_nixbyte=infobuf[0];
2864 i=1;
2865 }
2866 else if (fam2_drive) i=0;
2867 else if (famT_drive) i=5;
2868 current_drive->TocEnt_ctl_adr=swap_nibbles(infobuf[i++]);
2869 if ((fam1_drive)||(fam0L_drive))
2870 {
2871 current_drive->TocEnt_number=infobuf[i++];
2872 current_drive->TocEnt_format=infobuf[i];
2873 }
2874 else
2875 {
2876 current_drive->TocEnt_number=num;
2877 current_drive->TocEnt_format=0;
2878 }
2879 if (fam1_drive) i=4;
2880 else if (fam0LV_drive) i=5;
2881 else if (fam2_drive) i=2;
2882 else if (famT_drive) i=9;
2883 current_drive->TocEnt_address=make32(make16(0,infobuf[i]),
2884 make16(infobuf[i+1],infobuf[i+2]));
2885 for (i=0;i<response_count;i++)
2886 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
2887 msgbuf[i*3]=0;
2888 msg(DBG_ECS,"TocEntry:%s\n", msgbuf);
2889 msg(DBG_TOC,"TocEntry: %02X %02X %02X %02X %08X\n",
2890 current_drive->TocEnt_nixbyte, current_drive->TocEnt_ctl_adr,
2891 current_drive->TocEnt_number, current_drive->TocEnt_format,
2892 current_drive->TocEnt_address);
2893 return (0);
2894}
2895/*==========================================================================*/
2896static int cc_ReadPacket(void)
2897{
2898 int i;
2899
2900 clr_cmdbuf();
2901 drvcmd[0]=CMD0_PACKET;
2902 drvcmd[1]=response_count;
2903 if(famL_drive) flags_cmd_out=f_putcmd;
2904 else if (fam01_drive)
2905 flags_cmd_out=f_putcmd|f_getsta|f_ResponseStatus|f_obey_p_check;
2906 else if (fam2_drive) return (-1); /* not implemented yet */
2907 else if (famT_drive)
2908 {
2909 return (-1);
2910 }
2911 i=cmd_out();
2912 return (i);
2913}
2914/*==========================================================================*/
2915static int convert_UPC(u_char *p)
2916{
2917 int i;
2918
2919 p++;
2920 if (fam0L_drive) p[13]=0;
2921 for (i=0;i<7;i++)
2922 {
2923 if (fam1_drive) current_drive->UPC_buf[i]=swap_nibbles(*p++);
2924 else if (fam0L_drive)
2925 {
2926 current_drive->UPC_buf[i]=((*p++)<<4)&0xFF;
2927 current_drive->UPC_buf[i] |= *p++;
2928 }
2929 else if (famT_drive)
2930 {
2931 return (-1);
2932 }
2933 else /* CD200 */
2934 {
2935 return (-1);
2936 }
2937 }
2938 current_drive->UPC_buf[6] &= 0xF0;
2939 return (0);
2940}
2941/*==========================================================================*/
2942static int cc_ReadUPC(void)
2943{
2944 int i;
2945#if TEST_UPC
2946 int block, checksum;
2947#endif /* TEST_UPC */
2948
2949 if (fam2_drive) return (0); /* not implemented yet */
2950 if (famT_drive) return (0); /* not implemented yet */
2951 if (famV_drive) return (0); /* not implemented yet */
2952#if 1
2953 if (fam0_drive) return (0); /* but it should work */
2954#endif
2955
2956 current_drive->diskstate_flags &= ~upc_bit;
2957#if TEST_UPC
2958 for (block=CD_MSF_OFFSET+1;block<CD_MSF_OFFSET+200;block++)
2959 {
2960#endif /* TEST_UPC */
2961 clr_cmdbuf();
2962 if (fam1_drive)
2963 {
2964 drvcmd[0]=CMD1_READ_UPC;
2965#if TEST_UPC
2966 drvcmd[1]=(block>>16)&0xFF;
2967 drvcmd[2]=(block>>8)&0xFF;
2968 drvcmd[3]=block&0xFF;
2969#endif /* TEST_UPC */
2970 response_count=8;
2971 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
2972 }
2973 else if (fam0L_drive)
2974 {
2975 drvcmd[0]=CMD0_READ_UPC;
2976#if TEST_UPC
2977 drvcmd[2]=(block>>16)&0xFF;
2978 drvcmd[3]=(block>>8)&0xFF;
2979 drvcmd[4]=block&0xFF;
2980#endif /* TEST_UPC */
2981 response_count=0;
2982 flags_cmd_out=f_putcmd|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check|f_bit1;
2983 }
2984 else if (fam2_drive)
2985 {
2986 return (-1);
2987 }
2988 else if (famT_drive)
2989 {
2990 return (-1);
2991 }
2992 i=cmd_out();
2993 if (i<0)
2994 {
2995 msg(DBG_000,"cc_ReadUPC cmd_out: err %d\n", i);
2996 return (i);
2997 }
2998 if (fam0L_drive)
2999 {
3000 response_count=16;
3001 if (famL_drive) flags_cmd_out=f_putcmd;
3002 i=cc_ReadPacket();
3003 if (i<0)
3004 {
3005 msg(DBG_000,"cc_ReadUPC ReadPacket: err %d\n", i);
3006 return (i);
3007 }
3008 }
3009#if TEST_UPC
3010 checksum=0;
3011#endif /* TEST_UPC */
3012 for (i=0;i<(fam1_drive?8:16);i++)
3013 {
3014#if TEST_UPC
3015 checksum |= infobuf[i];
3016#endif /* TEST_UPC */
3017 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
3018 }
3019 msgbuf[i*3]=0;
3020 msg(DBG_UPC,"UPC info:%s\n", msgbuf);
3021#if TEST_UPC
3022 if ((checksum&0x7F)!=0) break;
3023 }
3024#endif /* TEST_UPC */
3025 current_drive->UPC_ctl_adr=0;
3026 if (fam1_drive) i=0;
3027 else i=2;
3028 if ((infobuf[i]&0x80)!=0)
3029 {
3030 convert_UPC(&infobuf[i]);
3031 current_drive->UPC_ctl_adr = (current_drive->TocEnt_ctl_adr & 0xF0) | 0x02;
3032 }
3033 for (i=0;i<7;i++)
3034 sprintf(&msgbuf[i*3], " %02X", current_drive->UPC_buf[i]);
3035 sprintf(&msgbuf[i*3], " (%02X)", current_drive->UPC_ctl_adr);
3036 msgbuf[i*3+5]=0;
3037 msg(DBG_UPC,"UPC code:%s\n", msgbuf);
3038 current_drive->diskstate_flags |= upc_bit;
3039 return (0);
3040}
3041
3042static int sbpcd_get_mcn(struct cdrom_device_info *cdi, struct cdrom_mcn *mcn)
3043{
3044 int i;
3045 unsigned char *mcnp = mcn->medium_catalog_number;
3046 unsigned char *resp;
3047
3048 current_drive->diskstate_flags &= ~upc_bit;
3049 clr_cmdbuf();
3050 if (fam1_drive)
3051 {
3052 drvcmd[0]=CMD1_READ_UPC;
3053 response_count=8;
3054 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
3055 }
3056 else if (fam0L_drive)
3057 {
3058 drvcmd[0]=CMD0_READ_UPC;
3059 response_count=0;
3060 flags_cmd_out=f_putcmd|f_lopsta|f_getsta|f_ResponseStatus|f_obey_p_check|f_bit1;
3061 }
3062 else if (fam2_drive)
3063 {
3064 return (-1);
3065 }
3066 else if (famT_drive)
3067 {
3068 return (-1);
3069 }
3070 i=cmd_out();
3071 if (i<0)
3072 {
3073 msg(DBG_000,"cc_ReadUPC cmd_out: err %d\n", i);
3074 return (i);
3075 }
3076 if (fam0L_drive)
3077 {
3078 response_count=16;
3079 if (famL_drive) flags_cmd_out=f_putcmd;
3080 i=cc_ReadPacket();
3081 if (i<0)
3082 {
3083 msg(DBG_000,"cc_ReadUPC ReadPacket: err %d\n", i);
3084 return (i);
3085 }
3086 }
3087 current_drive->UPC_ctl_adr=0;
3088 if (fam1_drive) i=0;
3089 else i=2;
3090
3091 resp = infobuf + i;
3092 if (*resp++ == 0x80) {
3093 /* packed bcd to single ASCII digits */
3094 *mcnp++ = (*resp >> 4) + '0';
3095 *mcnp++ = (*resp++ & 0x0f) + '0';
3096 *mcnp++ = (*resp >> 4) + '0';
3097 *mcnp++ = (*resp++ & 0x0f) + '0';
3098 *mcnp++ = (*resp >> 4) + '0';
3099 *mcnp++ = (*resp++ & 0x0f) + '0';
3100 *mcnp++ = (*resp >> 4) + '0';
3101 *mcnp++ = (*resp++ & 0x0f) + '0';
3102 *mcnp++ = (*resp >> 4) + '0';
3103 *mcnp++ = (*resp++ & 0x0f) + '0';
3104 *mcnp++ = (*resp >> 4) + '0';
3105 *mcnp++ = (*resp++ & 0x0f) + '0';
3106 *mcnp++ = (*resp >> 4) + '0';
3107 }
3108 *mcnp = '\0';
3109
3110 current_drive->diskstate_flags |= upc_bit;
3111 return (0);
3112}
3113
3114/*==========================================================================*/
3115static int cc_CheckMultiSession(void)
3116{
3117 int i;
3118
3119 if (fam2_drive) return (0);
3120 current_drive->f_multisession=0;
3121 current_drive->lba_multi=0;
3122 if (fam0_drive) return (0);
3123 clr_cmdbuf();
3124 if (fam1_drive)
3125 {
3126 drvcmd[0]=CMD1_MULTISESS;
3127 response_count=6;
3128 flags_cmd_out=f_putcmd|f_ResponseStatus|f_obey_p_check;
3129 i=cmd_out();
3130 if (i<0) return (i);
3131 if ((infobuf[0]&0x80)!=0)
3132 {
3133 current_drive->f_multisession=1;
3134 current_drive->lba_multi=msf2blk(make32(make16(0,infobuf[1]),
3135 make16(infobuf[2],infobuf[3])));
3136 }
3137 }
3138 else if (famLV_drive)
3139 {
3140 drvcmd[0]=CMDL_MULTISESS;
3141 drvcmd[1]=3;
3142 drvcmd[2]=1;
3143 response_count=8;
3144 flags_cmd_out=f_putcmd;
3145 i=cmd_out();
3146 if (i<0) return (i);
3147 current_drive->lba_multi=msf2blk(make32(make16(0,infobuf[5]),
3148 make16(infobuf[6],infobuf[7])));
3149 }
3150 else if (famT_drive)
3151 {
3152 response_count=12;
3153 drvcmd[0]=CMDT_DISKINFO;
3154 drvcmd[1]=0x02;
3155 drvcmd[6]=0;
3156 drvcmd[8]=response_count;
3157 drvcmd[9]=0x40;
3158 i=cmd_out();
3159 if (i<0) return (i);
3160 if (i<response_count) return (-100-i);
3161 current_drive->first_session=infobuf[2];
3162 current_drive->last_session=infobuf[3];
3163 current_drive->track_of_last_session=infobuf[6];
3164 if (current_drive->first_session!=current_drive->last_session)
3165 {
3166 current_drive->f_multisession=1;
3167 current_drive->lba_multi=msf2blk(make32(make16(0,infobuf[9]),make16(infobuf[10],infobuf[11])));
3168 }
3169 }
3170 for (i=0;i<response_count;i++)
3171 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
3172 msgbuf[i*3]=0;
3173 msg(DBG_MUL,"MultiSession Info:%s (%d)\n", msgbuf, current_drive->lba_multi);
3174 if (current_drive->lba_multi>200)
3175 {
3176 current_drive->f_multisession=1;
3177 msg(DBG_MUL,"MultiSession base: %06X\n", current_drive->lba_multi);
3178 }
3179 return (0);
3180}
3181/*==========================================================================*/
3182#ifdef FUTURE
3183static int cc_SubChanInfo(int frame, int count, u_char *buffer)
3184 /* "frame" is a RED BOOK (msf-bin) address */
3185{
3186 int i;
3187
3188 if (fam0LV_drive) return (-ENOSYS); /* drive firmware lacks it */
3189 if (famT_drive)
3190 {
3191 return (-1);
3192 }
3193#if 0
3194 if (current_drive->audio_state!=audio_playing) return (-ENODATA);
3195#endif
3196 clr_cmdbuf();
3197 drvcmd[0]=CMD1_SUBCHANINF;
3198 drvcmd[1]=(frame>>16)&0xFF;
3199 drvcmd[2]=(frame>>8)&0xFF;
3200 drvcmd[3]=frame&0xFF;
3201 drvcmd[5]=(count>>8)&0xFF;
3202 drvcmd[6]=count&0xFF;
3203 flags_cmd_out=f_putcmd|f_respo2|f_ResponseStatus|f_obey_p_check;
3204 cmd_type=READ_SC;
3205 current_drive->frame_size=CD_FRAMESIZE_SUB;
3206 i=cmd_out(); /* which buffer to use? */
3207 return (i);
3208}
3209#endif /* FUTURE */
3210/*==========================================================================*/
3211static void __init check_datarate(void)
3212{
3213 int i=0;
3214
3215 msg(DBG_IOX,"check_datarate entered.\n");
3216 datarate=0;
3217#if TEST_STI
3218 for (i=0;i<=1000;i++) printk(".");
3219#endif
3220 /* set a timer to make (timed_out_delay!=0) after 1.1 seconds */
3221#if 1
3222 del_timer(&delay_timer);
3223#endif
3224 delay_timer.expires=jiffies+11*HZ/10;
3225 timed_out_delay=0;
3226 add_timer(&delay_timer);
3227#if 0
3228 msg(DBG_TIM,"delay timer started (11*HZ/10).\n");
3229#endif
3230 do
3231 {
3232 i=inb(CDi_status);
3233 datarate++;
3234#if 1
3235 if (datarate>0x6FFFFFFF) break;
3236#endif
3237 }
3238 while (!timed_out_delay);
3239 del_timer(&delay_timer);
3240#if 0
3241 msg(DBG_TIM,"datarate: %04X\n", datarate);
3242#endif
3243 if (datarate<65536) datarate=65536;
3244 maxtim16=datarate*16;
3245 maxtim04=datarate*4;
3246 maxtim02=datarate*2;
3247 maxtim_8=datarate/32;
3248#if LONG_TIMING
3249 maxtim_data=datarate/100;
3250#else
3251 maxtim_data=datarate/300;
3252#endif /* LONG_TIMING */
3253#if 0
3254 msg(DBG_TIM,"maxtim_8 %d, maxtim_data %d.\n", maxtim_8, maxtim_data);
3255#endif
3256}
3257/*==========================================================================*/
3258#if 0
3259static int c2_ReadError(int fam)
3260{
3261 int i;
3262
3263 clr_cmdbuf();
3264 response_count=9;
3265 clr_respo_buf(9);
3266 if (fam==1)
3267 {
3268 drvcmd[0]=CMD0_READ_ERR; /* same as CMD1_ and CMDL_ */
3269 i=do_cmd(f_putcmd|f_lopsta|f_getsta|f_ResponseStatus);
3270 }
3271 else if (fam==2)
3272 {
3273 drvcmd[0]=CMD2_READ_ERR;
3274 i=do_cmd(f_putcmd);
3275 }
3276 else return (-1);
3277 return (i);
3278}
3279#endif
3280/*==========================================================================*/
3281static void __init ask_mail(void)
3282{
3283 int i;
3284
3285 msg(DBG_INF, "please mail the following lines to emoenke@gwdg.de\n");
3286 msg(DBG_INF, "(don't mail if you are not using the actual kernel):\n");
3287 msg(DBG_INF, "%s\n", VERSION);
3288 msg(DBG_INF, "address %03X, type %s, drive %s (ID %d)\n",
3289 CDo_command, type, current_drive->drive_model, current_drive->drv_id);
3290 for (i=0;i<12;i++)
3291 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
3292 msgbuf[i*3]=0;
3293 msg(DBG_INF,"infobuf =%s\n", msgbuf);
3294 for (i=0;i<12;i++)
3295 sprintf(&msgbuf[i*3], " %c ", infobuf[i]);
3296 msgbuf[i*3]=0;
3297 msg(DBG_INF,"infobuf =%s\n", msgbuf);
3298}
3299/*==========================================================================*/
3300static int __init check_version(void)
3301{
3302 int i, j, l;
3303 int teac_possible=0;
3304
3305 msg(DBG_INI,"check_version: id=%d, d=%d.\n", current_drive->drv_id, current_drive - D_S);
3306 current_drive->drv_type=0;
3307
3308 /* check for CR-52x, CR-56x, LCS-7260 and ECS-AT */
3309 /* clear any pending error state */
3310 clr_cmdbuf();
3311 drvcmd[0]=CMD0_READ_ERR; /* same as CMD1_ and CMDL_ */
3312 response_count=9;
3313 flags_cmd_out=f_putcmd;
3314 i=cmd_out();
3315 if (i<0) msg(DBG_INI,"CMD0_READ_ERR returns %d (ok anyway).\n",i);
3316 /* read drive version */
3317 clr_cmdbuf();
3318 for (i=0;i<12;i++) infobuf[i]=0;
3319 drvcmd[0]=CMD0_READ_VER; /* same as CMD1_ and CMDL_ */
3320 response_count=12; /* fam1: only 11 */
3321 flags_cmd_out=f_putcmd;
3322 i=cmd_out();
3323 if (i<-1) msg(DBG_INI,"CMD0_READ_VER returns %d\n",i);
3324 if (i==-11) teac_possible++;
3325 j=0;
3326 for (i=0;i<12;i++) j+=infobuf[i];
3327 if (j)
3328 {
3329 for (i=0;i<12;i++)
3330 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
3331 msgbuf[i*3]=0;
3332 msg(DBG_ECS,"infobuf =%s\n", msgbuf);
3333 for (i=0;i<12;i++)
3334 sprintf(&msgbuf[i*3], " %c ", infobuf[i]);
3335 msgbuf[i*3]=0;
3336 msg(DBG_ECS,"infobuf =%s\n", msgbuf);
3337 }
3338 for (i=0;i<4;i++) if (infobuf[i]!=family1[i]) break;
3339 if (i==4)
3340 {
3341 current_drive->drive_model[0]='C';
3342 current_drive->drive_model[1]='R';
3343 current_drive->drive_model[2]='-';
3344 current_drive->drive_model[3]='5';
3345 current_drive->drive_model[4]=infobuf[i++];
3346 current_drive->drive_model[5]=infobuf[i++];
3347 current_drive->drive_model[6]=0;
3348 current_drive->drv_type=drv_fam1;
3349 }
3350 if (!current_drive->drv_type)
3351 {
3352 for (i=0;i<8;i++) if (infobuf[i]!=family0[i]) break;
3353 if (i==8)
3354 {
3355 current_drive->drive_model[0]='C';
3356 current_drive->drive_model[1]='R';
3357 current_drive->drive_model[2]='-';
3358 current_drive->drive_model[3]='5';
3359 current_drive->drive_model[4]='2';
3360 current_drive->drive_model[5]='x';
3361 current_drive->drive_model[6]=0;
3362 current_drive->drv_type=drv_fam0;
3363 }
3364 }
3365 if (!current_drive->drv_type)
3366 {
3367 for (i=0;i<8;i++) if (infobuf[i]!=familyL[i]) break;
3368 if (i==8)
3369 {
3370 for (j=0;j<8;j++)
3371 current_drive->drive_model[j]=infobuf[j];
3372 current_drive->drive_model[8]=0;
3373 current_drive->drv_type=drv_famL;
3374 }
3375 }
3376 if (!current_drive->drv_type)
3377 {
3378 for (i=0;i<6;i++) if (infobuf[i]!=familyV[i]) break;
3379 if (i==6)
3380 {
3381 for (j=0;j<6;j++)
3382 current_drive->drive_model[j]=infobuf[j];
3383 current_drive->drive_model[6]=0;
3384 current_drive->drv_type=drv_famV;
3385 i+=2; /* 2 blanks before version */
3386 }
3387 }
3388 if (!current_drive->drv_type)
3389 {
3390 /* check for CD200 */
3391 clr_cmdbuf();
3392 drvcmd[0]=CMD2_READ_ERR;
3393 response_count=9;
3394 flags_cmd_out=f_putcmd;
3395 i=cmd_out();
3396 if (i<0) msg(DBG_INI,"CMD2_READERR returns %d (ok anyway).\n",i);
3397 if (i<0) msg(DBG_000,"CMD2_READERR returns %d (ok anyway).\n",i);
3398 /* read drive version */
3399 clr_cmdbuf();
3400 for (i=0;i<12;i++) infobuf[i]=0;
3401 if (sbpro_type==1) OUT(CDo_sel_i_d,0);
3402#if 0
3403 OUT(CDo_reset,0);
3404 sbp_sleep(6*HZ);
3405 OUT(CDo_enable,current_drive->drv_sel);
3406#endif
3407 drvcmd[0]=CMD2_READ_VER;
3408 response_count=12;
3409 flags_cmd_out=f_putcmd;
3410 i=cmd_out();
3411 if (i<0) msg(DBG_INI,"CMD2_READ_VER returns %d\n",i);
3412 if (i==-7) teac_possible++;
3413 j=0;
3414 for (i=0;i<12;i++) j+=infobuf[i];
3415 if (j)
3416 {
3417 for (i=0;i<12;i++)
3418 sprintf(&msgbuf[i*3], " %02X", infobuf[i]);
3419 msgbuf[i*3]=0;
3420 msg(DBG_IDX,"infobuf =%s\n", msgbuf);
3421 for (i=0;i<12;i++)
3422 sprintf(&msgbuf[i*3], " %c ", infobuf[i]);
3423 msgbuf[i*3]=0;
3424 msg(DBG_IDX,"infobuf =%s\n", msgbuf);
3425 }
3426 if (i>=0)
3427 {
3428 for (i=0;i<5;i++) if (infobuf[i]!=family2[i]) break;
3429 if (i==5)
3430 {
3431 current_drive->drive_model[0]='C';
3432 current_drive->drive_model[1]='D';
3433 current_drive->drive_model[2]='2';
3434 current_drive->drive_model[3]='0';
3435 current_drive->drive_model[4]='0';
3436 current_drive->drive_model[5]=infobuf[i++];
3437 current_drive->drive_model[6]=infobuf[i++];
3438 current_drive->drive_model[7]=0;
3439 current_drive->drv_type=drv_fam2;
3440 }
3441 }
3442 }
3443 if (!current_drive->drv_type)
3444 {
3445 /* check for TEAC CD-55A */
3446 msg(DBG_TEA,"teac_possible: %d\n",teac_possible);
3447 for (j=1;j<=((current_drive->drv_id==0)?3:1);j++)
3448 {
3449 for (l=1;l<=((current_drive->drv_id==0)?10:1);l++)
3450 {
3451 msg(DBG_TEA,"TEAC reset #%d-%d.\n", j, l);
3452 if (sbpro_type==1) OUT(CDo_reset,0);
3453 else
3454 {
3455 OUT(CDo_enable,current_drive->drv_sel);
3456 OUT(CDo_sel_i_d,0);
3457 OUT(CDo_command,CMDT_RESET);
3458 for (i=0;i<9;i++) OUT(CDo_command,0);
3459 }
3460 sbp_sleep(5*HZ/10);
3461 OUT(CDo_enable,current_drive->drv_sel);
3462 OUT(CDo_sel_i_d,0);
3463 i=inb(CDi_status);
3464 msg(DBG_TEA,"TEAC CDi_status: %02X.\n",i);
3465#if 0
3466 if (i&s_not_result_ready) continue; /* drive not present or ready */
3467#endif
3468 i=inb(CDi_info);
3469 msg(DBG_TEA,"TEAC CDi_info: %02X.\n",i);
3470 if (i==0x55) break; /* drive found */
3471 }
3472 if (i==0x55) break; /* drive found */
3473 }
3474 if (i==0x55) /* drive found */
3475 {
3476 msg(DBG_TEA,"TEAC drive found.\n");
3477 clr_cmdbuf();
3478 flags_cmd_out=f_putcmd;
3479 response_count=12;
3480 drvcmd[0]=CMDT_READ_VER;
3481 drvcmd[4]=response_count;
3482 for (i=0;i<12;i++) infobuf[i]=0;
3483 i=cmd_out_T();
3484 if (i!=0) msg(DBG_TEA,"cmd_out_T(CMDT_READ_VER) returns %d.\n",i);
3485 for (i=1;i<6;i++) if (infobuf[i]!=familyT[i-1]) break;
3486 if (i==6)
3487 {
3488 current_drive->drive_model[0]='C';
3489 current_drive->drive_model[1]='D';
3490 current_drive->drive_model[2]='-';
3491 current_drive->drive_model[3]='5';
3492 current_drive->drive_model[4]='5';
3493 current_drive->drive_model[5]=0;
3494 current_drive->drv_type=drv_famT;
3495 }
3496 }
3497 }
3498 if (!current_drive->drv_type)
3499 {
3500 msg(DBG_TEA,"no drive found at address %03X under ID %d.\n",CDo_command,current_drive->drv_id);
3501 return (-522);
3502 }
3503 for (j=0;j<4;j++) current_drive->firmware_version[j]=infobuf[i+j];
3504 if (famL_drive)
3505 {
3506 u_char lcs_firm_e1[]="A E1";
3507 u_char lcs_firm_f4[]="A4F4";
3508
3509 for (j=0;j<4;j++)
3510 if (current_drive->firmware_version[j]!=lcs_firm_e1[j]) break;
3511 if (j==4) current_drive->drv_type=drv_e1;
3512
3513 for (j=0;j<4;j++)
3514 if (current_drive->firmware_version[j]!=lcs_firm_f4[j]) break;
3515 if (j==4) current_drive->drv_type=drv_f4;
3516
3517 if (current_drive->drv_type==drv_famL) ask_mail();
3518 }
3519 else if (famT_drive)
3520 {
3521 j=infobuf[4]; /* one-byte version??? - here: 0x15 */
3522 if (j=='5')
3523 {
3524 current_drive->firmware_version[0]=infobuf[7];
3525 current_drive->firmware_version[1]=infobuf[8];
3526 current_drive->firmware_version[2]=infobuf[10];
3527 current_drive->firmware_version[3]=infobuf[11];
3528 }
3529 else
3530 {
3531 if (j!=0x15) ask_mail();
3532 current_drive->firmware_version[0]='0';
3533 current_drive->firmware_version[1]='.';
3534 current_drive->firmware_version[2]='0'+(j>>4);
3535 current_drive->firmware_version[3]='0'+(j&0x0f);
3536 }
3537 }
3538 else /* CR-52x, CR-56x, CD200, ECS-AT */
3539 {
3540 j = (current_drive->firmware_version[0] & 0x0F) * 100 +
3541 (current_drive->firmware_version[2] & 0x0F) *10 +
3542 (current_drive->firmware_version[3] & 0x0F);
3543 if (fam0_drive)
3544 {
3545 if (j<200) current_drive->drv_type=drv_199;
3546 else if (j<201) current_drive->drv_type=drv_200;
3547 else if (j<210) current_drive->drv_type=drv_201;
3548 else if (j<211) current_drive->drv_type=drv_210;
3549 else if (j<300) current_drive->drv_type=drv_211;
3550 else if (j>=300) current_drive->drv_type=drv_300;
3551 }
3552 else if (fam1_drive)
3553 {
3554 if (j<100) current_drive->drv_type=drv_099;
3555 else
3556 {
3557 current_drive->drv_type=drv_100;
3558 if ((j!=500)&&(j!=102)) ask_mail();
3559 }
3560 }
3561 else if (fam2_drive)
3562 {
3563 if (current_drive->drive_model[5]=='F')
3564 {
3565 if ((j!=1)&&(j!=35)&&(j!=200)&&(j!=210))
3566 ask_mail(); /* unknown version at time */
3567 }
3568 else
3569 {
3570 msg(DBG_INF,"this CD200 drive is not fully supported yet - only audio will work.\n");
3571 if ((j!=101)&&(j!=35))
3572 ask_mail(); /* unknown version at time */
3573 }
3574 }
3575 else if (famV_drive)
3576 {
3577 if ((j==100)||(j==150)) current_drive->drv_type=drv_at;
3578 ask_mail(); /* hopefully we get some feedback by this */
3579 }
3580 }
3581 msg(DBG_LCS,"drive type %02X\n",current_drive->drv_type);
3582 msg(DBG_INI,"check_version done.\n");
3583 return (0);
3584}
3585/*==========================================================================*/
3586static void switch_drive(struct sbpcd_drive *p)
3587{
3588 current_drive = p;
3589 OUT(CDo_enable,current_drive->drv_sel);
3590 msg(DBG_DID,"drive %d (ID=%d) activated.\n",
3591 current_drive - D_S, current_drive->drv_id);
3592 return;
3593}
3594/*==========================================================================*/
3595#ifdef PATH_CHECK
3596/*
3597 * probe for the presence of an interface card
3598 */
3599static int __init check_card(int port)
3600{
3601#undef N_RESPO
3602#define N_RESPO 20
3603 int i, j, k;
3604 u_char response[N_RESPO];
3605 u_char save_port0;
3606 u_char save_port3;
3607
3608 msg(DBG_INI,"check_card entered.\n");
3609 save_port0=inb(port+0);
3610 save_port3=inb(port+3);
3611
3612 for (j=0;j<NR_SBPCD;j++)
3613 {
3614 OUT(port+3,j) ; /* enable drive #j */
3615 OUT(port+0,CMD0_PATH_CHECK);
3616 for (i=10;i>0;i--) OUT(port+0,0);
3617 for (k=0;k<N_RESPO;k++) response[k]=0;
3618 for (k=0;k<N_RESPO;k++)
3619 {
3620 for (i=10000;i>0;i--)
3621 {
3622 if (inb(port+1)&s_not_result_ready) continue;
3623 response[k]=inb(port+0);
3624 break;
3625 }
3626 }
3627 for (i=0;i<N_RESPO;i++)
3628 sprintf(&msgbuf[i*3], " %02X", response[i]);
3629 msgbuf[i*3]=0;
3630 msg(DBG_TEA,"path check 00 (%d): %s\n", j, msgbuf);
3631 OUT(port+0,CMD0_PATH_CHECK);
3632 for (i=10;i>0;i--) OUT(port+0,0);
3633 for (k=0;k<N_RESPO;k++) response[k]=0xFF;
3634 for (k=0;k<N_RESPO;k++)
3635 {
3636 for (i=10000;i>0;i--)
3637 {
3638 if (inb(port+1)&s_not_result_ready) continue;
3639 response[k]=inb(port+0);
3640 break;
3641 }
3642 }
3643 for (i=0;i<N_RESPO;i++)
3644 sprintf(&msgbuf[i*3], " %02X", response[i]);
3645 msgbuf[i*3]=0;
3646 msg(DBG_TEA,"path check 00 (%d): %s\n", j, msgbuf);
3647
3648 if (response[0]==0xAA)
3649 if (response[1]==0x55)
3650 return (0);
3651 }
3652 for (j=0;j<NR_SBPCD;j++)
3653 {
3654 OUT(port+3,j) ; /* enable drive #j */
3655 OUT(port+0,CMD2_READ_VER);
3656 for (i=10;i>0;i--) OUT(port+0,0);
3657 for (k=0;k<N_RESPO;k++) response[k]=0;
3658 for (k=0;k<N_RESPO;k++)
3659 {
3660 for (i=1000000;i>0;i--)
3661 {
3662 if (inb(port+1)&s_not_result_ready) continue;
3663 response[k]=inb(port+0);
3664 break;
3665 }
3666 }
3667 for (i=0;i<N_RESPO;i++)
3668 sprintf(&msgbuf[i*3], " %02X", response[i]);
3669 msgbuf[i*3]=0;
3670 msg(DBG_TEA,"path check 12 (%d): %s\n", j, msgbuf);
3671
3672 OUT(port+0,CMD2_READ_VER);
3673 for (i=10;i>0;i--) OUT(port+0,0);
3674 for (k=0;k<N_RESPO;k++) response[k]=0xFF;
3675 for (k=0;k<N_RESPO;k++)
3676 {
3677 for (i=1000000;i>0;i--)
3678 {
3679 if (inb(port+1)&s_not_result_ready) continue;
3680 response[k]=inb(port+0);
3681 break;
3682 }
3683 }
3684 for (i=0;i<N_RESPO;i++)
3685 sprintf(&msgbuf[i*3], " %02X", response[i]);
3686 msgbuf[i*3]=0;
3687 msg(DBG_TEA,"path check 12 (%d): %s\n", j, msgbuf);
3688
3689 if (response[0]==0xAA)
3690 if (response[1]==0x55)
3691 return (0);
3692 }
3693 OUT(port+0,save_port0);
3694 OUT(port+3,save_port3);
3695 return (0); /* in any case - no real "function" at time */
3696}
3697#endif /* PATH_CHECK */
3698/*==========================================================================*/
3699/*==========================================================================*/
3700/*
3701 * probe for the presence of drives on the selected controller
3702 */
3703static int __init check_drives(void)
3704{
3705 int i, j;
3706
3707 msg(DBG_INI,"check_drives entered.\n");
3708 ndrives=0;
3709 for (j=0;j<max_drives;j++)
3710 {
3711 struct sbpcd_drive *p = D_S + ndrives;
3712 p->drv_id=j;
3713 if (sbpro_type==1) p->drv_sel=(j&0x01)<<1|(j&0x02)>>1;
3714 else p->drv_sel=j;
3715 switch_drive(p);
3716 msg(DBG_INI,"check_drives: drive %d (ID=%d) activated.\n",ndrives,j);
3717 msg(DBG_000,"check_drives: drive %d (ID=%d) activated.\n",ndrives,j);
3718 i=check_version();
3719 if (i<0) msg(DBG_INI,"check_version returns %d.\n",i);
3720 else
3721 {
3722 current_drive->drv_options=drv_pattern[j];
3723 if (fam0L_drive) current_drive->drv_options&=~(speed_auto|speed_300|speed_150);
3724 msg(DBG_INF, "Drive %d (ID=%d): %.9s (%.4s) at 0x%03X (type %d)\n",
3725 current_drive - D_S,
3726 current_drive->drv_id,
3727 current_drive->drive_model,
3728 current_drive->firmware_version,
3729 CDo_command,
3730 sbpro_type);
3731 ndrives++;
3732 }
3733 }
3734 for (j=ndrives;j<NR_SBPCD;j++) D_S[j].drv_id=-1;
3735 if (ndrives==0) return (-1);
3736 return (0);
3737}
3738/*==========================================================================*/
3739#ifdef FUTURE
3740/*
3741 * obtain if requested service disturbs current audio state
3742 */
3743static int obey_audio_state(u_char audio_state, u_char func,u_char subfunc)
3744{
3745 switch (audio_state) /* audio status from controller */
3746 {
3747 case aud_11: /* "audio play in progress" */
3748 case audx11:
3749 switch (func) /* DOS command code */
3750 {
3751 case cmd_07: /* input flush */
3752 case cmd_0d: /* open device */
3753 case cmd_0e: /* close device */
3754 case cmd_0c: /* ioctl output */
3755 return (1);
3756 case cmd_03: /* ioctl input */
3757 switch (subfunc)
3758 /* DOS ioctl input subfunction */
3759 {
3760 case cxi_00:
3761 case cxi_06:
3762 case cxi_09:
3763 return (1);
3764 default:
3765 return (ERROR15);
3766 }
3767 return (1);
3768 default:
3769 return (ERROR15);
3770 }
3771 return (1);
3772 case aud_12: /* "audio play paused" */
3773 case audx12:
3774 return (1);
3775 default:
3776 return (2);
3777 }
3778}
3779/*==========================================================================*/
3780/* allowed is only
3781 * ioctl_o, flush_input, open_device, close_device,
3782 * tell_address, tell_volume, tell_capabiliti,
3783 * tell_framesize, tell_CD_changed, tell_audio_posi
3784 */
3785static int check_allowed1(u_char func1, u_char func2)
3786{
3787#if 000
3788 if (func1==ioctl_o) return (0);
3789 if (func1==read_long) return (-1);
3790 if (func1==read_long_prefetch) return (-1);
3791 if (func1==seek) return (-1);
3792 if (func1==audio_play) return (-1);
3793 if (func1==audio_pause) return (-1);
3794 if (func1==audio_resume) return (-1);
3795 if (func1!=ioctl_i) return (0);
3796 if (func2==tell_SubQ_run_tot) return (-1);
3797 if (func2==tell_cdsize) return (-1);
3798 if (func2==tell_TocDescrip) return (-1);
3799 if (func2==tell_TocEntry) return (-1);
3800 if (func2==tell_subQ_info) return (-1);
3801 if (fam1_drive) if (func2==tell_SubChanInfo) return (-1);
3802 if (func2==tell_UPC) return (-1);
3803#else
3804 return (0);
3805#endif
3806}
3807/*==========================================================================*/
3808static int check_allowed2(u_char func1, u_char func2)
3809{
3810#if 000
3811 if (func1==read_long) return (-1);
3812 if (func1==read_long_prefetch) return (-1);
3813 if (func1==seek) return (-1);
3814 if (func1==audio_play) return (-1);
3815 if (func1!=ioctl_o) return (0);
3816 if (fam1_drive)
3817 {
3818 if (func2==EjectDisk) return (-1);
3819 if (func2==CloseTray) return (-1);
3820 }
3821#else
3822 return (0);
3823#endif
3824}
3825/*==========================================================================*/
3826static int check_allowed3(u_char func1, u_char func2)
3827{
3828#if 000
3829 if (func1==ioctl_i)
3830 {
3831 if (func2==tell_address) return (0);
3832 if (func2==tell_capabiliti) return (0);
3833 if (func2==tell_CD_changed) return (0);
3834 if (fam0L_drive) if (func2==tell_SubChanInfo) return (0);
3835 return (-1);
3836 }
3837 if (func1==ioctl_o)
3838 {
3839 if (func2==DriveReset) return (0);
3840 if (fam0L_drive)
3841 {
3842 if (func2==EjectDisk) return (0);
3843 if (func2==LockDoor) return (0);
3844 if (func2==CloseTray) return (0);
3845 }
3846 return (-1);
3847 }
3848 if (func1==flush_input) return (-1);
3849 if (func1==read_long) return (-1);
3850 if (func1==read_long_prefetch) return (-1);
3851 if (func1==seek) return (-1);
3852 if (func1==audio_play) return (-1);
3853 if (func1==audio_pause) return (-1);
3854 if (func1==audio_resume) return (-1);
3855#else
3856 return (0);
3857#endif
3858}
3859/*==========================================================================*/
3860static int seek_pos_audio_end(void)
3861{
3862 int i;
3863
3864 i=msf2blk(current_drive->pos_audio_end)-1;
3865 if (i<0) return (-1);
3866 i=cc_Seek(i,0);
3867 return (i);
3868}
3869#endif /* FUTURE */
3870/*==========================================================================*/
3871static int ReadToC(void)
3872{
3873 int i, j;
3874 current_drive->diskstate_flags &= ~toc_bit;
3875 current_drive->ored_ctl_adr=0;
3876 /* special handling of CD-I HE */
3877 if ((current_drive->n_first_track == 2 && current_drive->n_last_track == 2) ||
3878 current_drive->xa_byte == 0x10)
3879 {
3880 current_drive->TocBuffer[1].nixbyte=0;
3881 current_drive->TocBuffer[1].ctl_adr=0x40;
3882 current_drive->TocBuffer[1].number=1;
3883 current_drive->TocBuffer[1].format=0;
3884 current_drive->TocBuffer[1].address=blk2msf(0);
3885 current_drive->ored_ctl_adr |= 0x40;
3886 current_drive->n_first_track = 1;
3887 current_drive->n_last_track = 1;
3888 current_drive->xa_byte = 0x10;
3889 j = 2;
3890 } else
3891 for (j=current_drive->n_first_track;j<=current_drive->n_last_track;j++)
3892 {
3893 i=cc_ReadTocEntry(j);
3894 if (i<0)
3895 {
3896 msg(DBG_INF,"cc_ReadTocEntry(%d) returns %d.\n",j,i);
3897 return (i);
3898 }
3899 current_drive->TocBuffer[j].nixbyte=current_drive->TocEnt_nixbyte;
3900 current_drive->TocBuffer[j].ctl_adr=current_drive->TocEnt_ctl_adr;
3901 current_drive->TocBuffer[j].number=current_drive->TocEnt_number;
3902 current_drive->TocBuffer[j].format=current_drive->TocEnt_format;
3903 current_drive->TocBuffer[j].address=current_drive->TocEnt_address;
3904 current_drive->ored_ctl_adr |= current_drive->TocEnt_ctl_adr;
3905 }
3906 /* fake entry for LeadOut Track */
3907 current_drive->TocBuffer[j].nixbyte=0;
3908 current_drive->TocBuffer[j].ctl_adr=0;
3909 current_drive->TocBuffer[j].number=CDROM_LEADOUT;
3910 current_drive->TocBuffer[j].format=0;
3911 current_drive->TocBuffer[j].address=current_drive->size_msf;
3912
3913 current_drive->diskstate_flags |= toc_bit;
3914 return (0);
3915}
3916/*==========================================================================*/
3917static int DiskInfo(void)
3918{
3919 int i, j;
3920
3921 current_drive->mode=READ_M1;
3922
3923#undef LOOP_COUNT
3924#define LOOP_COUNT 10 /* needed for some "old" drives */
3925
3926 msg(DBG_000,"DiskInfo entered.\n");
3927 for (j=1;j<LOOP_COUNT;j++)
3928 {
3929#if 0
3930 i=SetSpeed();
3931 if (i<0)
3932 {
3933 msg(DBG_INF,"DiskInfo: SetSpeed returns %d\n", i);
3934 continue;
3935 }
3936 i=cc_ModeSense();
3937 if (i<0)
3938 {
3939 msg(DBG_INF,"DiskInfo: cc_ModeSense returns %d\n", i);
3940 continue;
3941 }
3942#endif
3943 i=cc_ReadCapacity();
3944 if (i>=0) break;
3945 msg(DBG_INF,"DiskInfo: ReadCapacity #%d returns %d\n", j, i);
3946#if 0
3947 i=cc_DriveReset();
3948#endif
3949 if (!fam0_drive && j == 2) break;
3950 }
3951 if (j==LOOP_COUNT) return (-33); /* give up */
3952
3953 i=cc_ReadTocDescr();
3954 if (i<0)
3955 {
3956 msg(DBG_INF,"DiskInfo: ReadTocDescr returns %d\n", i);
3957 return (i);
3958 }
3959 i=ReadToC();
3960 if (i<0)
3961 {
3962 msg(DBG_INF,"DiskInfo: ReadToC returns %d\n", i);
3963 return (i);
3964 }
3965 i=cc_CheckMultiSession();
3966 if (i<0)
3967 {
3968 msg(DBG_INF,"DiskInfo: cc_CheckMultiSession returns %d\n", i);
3969 return (i);
3970 }
3971 if (current_drive->f_multisession) current_drive->sbp_bufsiz=1; /* possibly a weird PhotoCD */
3972 else current_drive->sbp_bufsiz=buffers;
3973 i=cc_ReadTocEntry(current_drive->n_first_track);
3974 if (i<0)
3975 {
3976 msg(DBG_INF,"DiskInfo: cc_ReadTocEntry(1) returns %d\n", i);
3977 return (i);
3978 }
3979 i=cc_ReadUPC();
3980 if (i<0) msg(DBG_INF,"DiskInfo: cc_ReadUPC returns %d\n", i);
3981 if ((fam0L_drive) && (current_drive->xa_byte==0x20 || current_drive->xa_byte == 0x10))
3982 {
3983 /* XA disk with old drive */
3984 cc_ModeSelect(CD_FRAMESIZE_RAW1);
3985 cc_ModeSense();
3986 }
3987 if (famT_drive) cc_prep_mode_T();
3988 msg(DBG_000,"DiskInfo done.\n");
3989 return (0);
3990}
3991
3992static int sbpcd_drive_status(struct cdrom_device_info *cdi, int slot_nr)
3993{
3994 struct sbpcd_drive *p = cdi->handle;
3995 int st;
3996
3997 if (CDSL_CURRENT != slot_nr) {
3998 /* we have no changer support */
3999 return -EINVAL;
4000 }
4001
4002 cc_ReadStatus();
4003 st=ResponseStatus();
4004 if (st<0)
4005 {
4006 msg(DBG_INF,"sbpcd_drive_status: timeout.\n");
4007 return (0);
4008 }
4009 msg(DBG_000,"Drive Status: door_locked =%d.\n", st_door_locked);
4010 msg(DBG_000,"Drive Status: door_closed =%d.\n", st_door_closed);
4011 msg(DBG_000,"Drive Status: caddy_in =%d.\n", st_caddy_in);
4012 msg(DBG_000,"Drive Status: disk_ok =%d.\n", st_diskok);
4013 msg(DBG_000,"Drive Status: spinning =%d.\n", st_spinning);
4014 msg(DBG_000,"Drive Status: busy =%d.\n", st_busy);
4015
4016#if 0
4017 if (!(p->status_bits & p_door_closed)) return CDS_TRAY_OPEN;
4018 if (p->status_bits & p_disk_ok) return CDS_DISC_OK;
4019 if (p->status_bits & p_disk_in) return CDS_DRIVE_NOT_READY;
4020
4021 return CDS_NO_DISC;
4022#else
4023 if (p->status_bits & p_spinning) return CDS_DISC_OK;
4024/* return CDS_TRAY_OPEN; */
4025 return CDS_NO_DISC;
4026
4027#endif
4028
4029}
4030
4031
4032/*==========================================================================*/
4033#ifdef FUTURE
4034/*
4035 * called always if driver gets entered
4036 * returns 0 or ERROR2 or ERROR15
4037 */
4038static int prepare(u_char func, u_char subfunc)
4039{
4040 int i;
4041
4042 if (fam0L_drive)
4043 {
4044 i=inb(CDi_status);
4045 if (i&s_attention) GetStatus();
4046 }
4047 else if (fam1_drive) GetStatus();
4048 else if (fam2_drive) GetStatus();
4049 else if (famT_drive) GetStatus();
4050 if (current_drive->CD_changed==0xFF)
4051 {
4052 current_drive->diskstate_flags=0;
4053 current_drive->audio_state=0;
4054 if (!st_diskok)
4055 {
4056 i=check_allowed1(func,subfunc);
4057 if (i<0) return (-2);
4058 }
4059 else
4060 {
4061 i=check_allowed3(func,subfunc);
4062 if (i<0)
4063 {
4064 current_drive->CD_changed=1;
4065 return (-15);
4066 }
4067 }
4068 }
4069 else
4070 {
4071 if (!st_diskok)
4072 {
4073 current_drive->diskstate_flags=0;
4074 current_drive->audio_state=0;
4075 i=check_allowed1(func,subfunc);
4076 if (i<0) return (-2);
4077 }
4078 else
4079 {
4080 if (st_busy)
4081 {
4082 if (current_drive->audio_state!=audio_pausing)
4083 {
4084 i=check_allowed2(func,subfunc);
4085 if (i<0) return (-2);
4086 }
4087 }
4088 else
4089 {
4090 if (current_drive->audio_state==audio_playing) seek_pos_audio_end();
4091 current_drive->audio_state=0;
4092 }
4093 if (!frame_size_valid)
4094 {
4095 i=DiskInfo();
4096 if (i<0)
4097 {
4098 current_drive->diskstate_flags=0;
4099 current_drive->audio_state=0;
4100 i=check_allowed1(func,subfunc);
4101 if (i<0) return (-2);
4102 }
4103 }
4104 }
4105 }
4106 return (0);
4107}
4108#endif /* FUTURE */
4109/*==========================================================================*/
4110/*==========================================================================*/
4111/*
4112 * Check the results of the "get status" command.
4113 */
4114static int sbp_status(void)
4115{
4116 int st;
4117
4118 st=ResponseStatus();
4119 if (st<0)
4120 {
4121 msg(DBG_INF,"sbp_status: timeout.\n");
4122 return (0);
4123 }
4124
4125 if (!st_spinning) msg(DBG_SPI,"motor got off - ignoring.\n");
4126
4127 if (st_check)
4128 {
4129 msg(DBG_INF,"st_check detected - retrying.\n");
4130 return (0);
4131 }
4132 if (!st_door_closed)
4133 {
4134 msg(DBG_INF,"door is open - retrying.\n");
4135 return (0);
4136 }
4137 if (!st_caddy_in)
4138 {
4139 msg(DBG_INF,"disk removed - retrying.\n");
4140 return (0);
4141 }
4142 if (!st_diskok)
4143 {
4144 msg(DBG_INF,"!st_diskok detected - retrying.\n");
4145 return (0);
4146 }
4147 if (st_busy)
4148 {
4149 msg(DBG_INF,"st_busy detected - retrying.\n");
4150 return (0);
4151 }
4152 return (1);
4153}
4154/*==========================================================================*/
4155
4156static int sbpcd_get_last_session(struct cdrom_device_info *cdi, struct cdrom_multisession *ms_infp)
4157{
4158 struct sbpcd_drive *p = cdi->handle;
4159 ms_infp->addr_format = CDROM_LBA;
4160 ms_infp->addr.lba = p->lba_multi;
4161 if (p->f_multisession)
4162 ms_infp->xa_flag=1; /* valid redirection address */
4163 else
4164 ms_infp->xa_flag=0; /* invalid redirection address */
4165
4166 return 0;
4167}
4168
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08004169static int sbpcd_audio_ioctl(struct cdrom_device_info *cdi, u_int cmd,
4170 void * arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004171{
4172 struct sbpcd_drive *p = cdi->handle;
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08004173 int i, st, j;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004174
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08004175 msg(DBG_IO2,"ioctl(%s, 0x%08lX, 0x%08p)\n", cdi->name, cmd, arg);
4176 if (p->drv_id==-1) {
4177 msg(DBG_INF, "ioctl: bad device: %s\n", cdi->name);
4178 return (-ENXIO); /* no such drive */
4179 }
4180 down(&ioctl_read_sem);
4181 if (p != current_drive)
4182 switch_drive(p);
4183
4184 msg(DBG_IO2,"ioctl: device %s, request %04X\n",cdi->name,cmd);
4185 switch (cmd) /* Sun-compatible */
4186 {
4187
4188 case CDROMPAUSE: /* Pause the drive */
4189 msg(DBG_IOC,"ioctl: CDROMPAUSE entered.\n");
4190 /* pause the drive unit when it is currently in PLAY mode, */
4191 /* or reset the starting and ending locations when in PAUSED mode. */
4192 /* If applicable, at the next stopping point it reaches */
4193 /* the drive will discontinue playing. */
4194 switch (current_drive->audio_state)
4195 {
4196 case audio_playing:
4197 if (famL_drive) i=cc_ReadSubQ();
4198 else i=cc_Pause_Resume(1);
4199 if (i<0) RETURN_UP(-EIO);
4200 if (famL_drive) i=cc_Pause_Resume(1);
4201 else i=cc_ReadSubQ();
4202 if (i<0) RETURN_UP(-EIO);
4203 current_drive->pos_audio_start=current_drive->SubQ_run_tot;
4204 current_drive->audio_state=audio_pausing;
4205 RETURN_UP(0);
4206 case audio_pausing:
4207 i=cc_Seek(current_drive->pos_audio_start,1);
4208 if (i<0) RETURN_UP(-EIO);
4209 RETURN_UP(0);
4210 default:
4211 RETURN_UP(-EINVAL);
4212 }
4213
4214 case CDROMRESUME: /* resume paused audio play */
4215 msg(DBG_IOC,"ioctl: CDROMRESUME entered.\n");
4216 /* resume playing audio tracks when a previous PLAY AUDIO call has */
4217 /* been paused with a PAUSE command. */
4218 /* It will resume playing from the location saved in SubQ_run_tot. */
4219 if (current_drive->audio_state!=audio_pausing) RETURN_UP(-EINVAL);
4220 if (famL_drive)
4221 i=cc_PlayAudio(current_drive->pos_audio_start,
4222 current_drive->pos_audio_end);
4223 else i=cc_Pause_Resume(3);
4224 if (i<0) RETURN_UP(-EIO);
4225 current_drive->audio_state=audio_playing;
4226 RETURN_UP(0);
4227
4228 case CDROMPLAYMSF:
4229 msg(DBG_IOC,"ioctl: CDROMPLAYMSF entered.\n");
4230#ifdef SAFE_MIXED
4231 if (current_drive->has_data>1) RETURN_UP(-EBUSY);
4232#endif /* SAFE_MIXED */
4233 if (current_drive->audio_state==audio_playing)
4234 {
4235 i=cc_Pause_Resume(1);
4236 if (i<0) RETURN_UP(-EIO);
4237 i=cc_ReadSubQ();
4238 if (i<0) RETURN_UP(-EIO);
4239 current_drive->pos_audio_start=current_drive->SubQ_run_tot;
4240 i=cc_Seek(current_drive->pos_audio_start,1);
4241 }
4242 memcpy(&msf, (void *) arg, sizeof(struct cdrom_msf));
4243 /* values come as msf-bin */
4244 current_drive->pos_audio_start = (msf.cdmsf_min0<<16) |
4245 (msf.cdmsf_sec0<<8) |
4246 msf.cdmsf_frame0;
4247 current_drive->pos_audio_end = (msf.cdmsf_min1<<16) |
4248 (msf.cdmsf_sec1<<8) |
4249 msf.cdmsf_frame1;
4250 msg(DBG_IOX,"ioctl: CDROMPLAYMSF %08X %08X\n",
4251 current_drive->pos_audio_start,current_drive->pos_audio_end);
4252 i=cc_PlayAudio(current_drive->pos_audio_start,current_drive->pos_audio_end);
4253 if (i<0)
4254 {
4255 msg(DBG_INF,"ioctl: cc_PlayAudio returns %d\n",i);
4256 DriveReset();
4257 current_drive->audio_state=0;
4258 RETURN_UP(-EIO);
4259 }
4260 current_drive->audio_state=audio_playing;
4261 RETURN_UP(0);
4262
4263 case CDROMPLAYTRKIND: /* Play a track. This currently ignores index. */
4264 msg(DBG_IOC,"ioctl: CDROMPLAYTRKIND entered.\n");
4265#ifdef SAFE_MIXED
4266 if (current_drive->has_data>1) RETURN_UP(-EBUSY);
4267#endif /* SAFE_MIXED */
4268 if (current_drive->audio_state==audio_playing)
4269 {
4270 msg(DBG_IOX,"CDROMPLAYTRKIND: already audio_playing.\n");
4271#if 1
4272 RETURN_UP(0); /* just let us play on */
4273#else
4274 RETURN_UP(-EINVAL); /* play on, but say "error" */
4275#endif
4276 }
4277 memcpy(&ti,(void *) arg,sizeof(struct cdrom_ti));
4278 msg(DBG_IOX,"ioctl: trk0: %d, ind0: %d, trk1:%d, ind1:%d\n",
4279 ti.cdti_trk0,ti.cdti_ind0,ti.cdti_trk1,ti.cdti_ind1);
4280 if (ti.cdti_trk0<current_drive->n_first_track) RETURN_UP(-EINVAL);
4281 if (ti.cdti_trk0>current_drive->n_last_track) RETURN_UP(-EINVAL);
4282 if (ti.cdti_trk1<ti.cdti_trk0) ti.cdti_trk1=ti.cdti_trk0;
4283 if (ti.cdti_trk1>current_drive->n_last_track) ti.cdti_trk1=current_drive->n_last_track;
4284 current_drive->pos_audio_start=current_drive->TocBuffer[ti.cdti_trk0].address;
4285 current_drive->pos_audio_end=current_drive->TocBuffer[ti.cdti_trk1+1].address;
4286 i=cc_PlayAudio(current_drive->pos_audio_start,current_drive->pos_audio_end);
4287 if (i<0)
4288 {
4289 msg(DBG_INF,"ioctl: cc_PlayAudio returns %d\n",i);
4290 DriveReset();
4291 current_drive->audio_state=0;
4292 RETURN_UP(-EIO);
4293 }
4294 current_drive->audio_state=audio_playing;
4295 RETURN_UP(0);
4296
4297 case CDROMREADTOCHDR: /* Read the table of contents header */
4298 msg(DBG_IOC,"ioctl: CDROMREADTOCHDR entered.\n");
4299 tochdr.cdth_trk0=current_drive->n_first_track;
4300 tochdr.cdth_trk1=current_drive->n_last_track;
4301 memcpy((void *) arg, &tochdr, sizeof(struct cdrom_tochdr));
4302 RETURN_UP(0);
4303
4304 case CDROMREADTOCENTRY: /* Read an entry in the table of contents */
4305 msg(DBG_IOC,"ioctl: CDROMREADTOCENTRY entered.\n");
4306 memcpy(&tocentry, (void *) arg, sizeof(struct cdrom_tocentry));
4307 i=tocentry.cdte_track;
4308 if (i==CDROM_LEADOUT) i=current_drive->n_last_track+1;
4309 else if (i<current_drive->n_first_track||i>current_drive->n_last_track)
4310 RETURN_UP(-EINVAL);
4311 tocentry.cdte_adr=current_drive->TocBuffer[i].ctl_adr&0x0F;
4312 tocentry.cdte_ctrl=(current_drive->TocBuffer[i].ctl_adr>>4)&0x0F;
4313 tocentry.cdte_datamode=current_drive->TocBuffer[i].format;
4314 if (tocentry.cdte_format==CDROM_MSF) /* MSF-bin required */
4315 {
4316 tocentry.cdte_addr.msf.minute=(current_drive->TocBuffer[i].address>>16)&0x00FF;
4317 tocentry.cdte_addr.msf.second=(current_drive->TocBuffer[i].address>>8)&0x00FF;
4318 tocentry.cdte_addr.msf.frame=current_drive->TocBuffer[i].address&0x00FF;
4319 }
4320 else if (tocentry.cdte_format==CDROM_LBA) /* blk required */
4321 tocentry.cdte_addr.lba=msf2blk(current_drive->TocBuffer[i].address);
4322 else RETURN_UP(-EINVAL);
4323 memcpy((void *) arg, &tocentry, sizeof(struct cdrom_tocentry));
4324 RETURN_UP(0);
4325
4326 case CDROMSTOP: /* Spin down the drive */
4327 msg(DBG_IOC,"ioctl: CDROMSTOP entered.\n");
4328#ifdef SAFE_MIXED
4329 if (current_drive->has_data>1) RETURN_UP(-EBUSY);
4330#endif /* SAFE_MIXED */
4331 i=cc_Pause_Resume(1);
4332 current_drive->audio_state=0;
4333#if 0
4334 cc_DriveReset();
4335#endif
4336 RETURN_UP(i);
4337
4338 case CDROMSTART: /* Spin up the drive */
4339 msg(DBG_IOC,"ioctl: CDROMSTART entered.\n");
4340 cc_SpinUp();
4341 current_drive->audio_state=0;
4342 RETURN_UP(0);
4343
4344 case CDROMVOLCTRL: /* Volume control */
4345 msg(DBG_IOC,"ioctl: CDROMVOLCTRL entered.\n");
4346 memcpy(&volctrl,(char *) arg,sizeof(volctrl));
4347 current_drive->vol_chan0=0;
4348 current_drive->vol_ctrl0=volctrl.channel0;
4349 current_drive->vol_chan1=1;
4350 current_drive->vol_ctrl1=volctrl.channel1;
4351 i=cc_SetVolume();
4352 RETURN_UP(0);
4353
4354 case CDROMVOLREAD: /* read Volume settings from drive */
4355 msg(DBG_IOC,"ioctl: CDROMVOLREAD entered.\n");
4356 st=cc_GetVolume();
4357 if (st<0) RETURN_UP(st);
4358 volctrl.channel0=current_drive->vol_ctrl0;
4359 volctrl.channel1=current_drive->vol_ctrl1;
4360 volctrl.channel2=0;
4361 volctrl.channel2=0;
4362 memcpy((void *)arg,&volctrl,sizeof(volctrl));
4363 RETURN_UP(0);
4364
4365 case CDROMSUBCHNL: /* Get subchannel info */
4366 msg(DBG_IOS,"ioctl: CDROMSUBCHNL entered.\n");
4367 /* Bogus, I can do better than this! --AJK
4368 if ((st_spinning)||(!subq_valid)) {
4369 i=cc_ReadSubQ();
4370 if (i<0) RETURN_UP(-EIO);
4371 }
4372 */
4373 i=cc_ReadSubQ();
4374 if (i<0) {
4375 j=cc_ReadError(); /* clear out error status from drive */
4376 current_drive->audio_state=CDROM_AUDIO_NO_STATUS;
4377 /* get and set the disk state here,
4378 probably not the right place, but who cares!
4379 It makes it work properly! --AJK */
4380 if (current_drive->CD_changed==0xFF) {
4381 msg(DBG_000,"Disk changed detect\n");
4382 current_drive->diskstate_flags &= ~cd_size_bit;
4383 }
4384 RETURN_UP(-EIO);
4385 }
4386 if (current_drive->CD_changed==0xFF) {
4387 /* reread the TOC because the disk has changed! --AJK */
4388 msg(DBG_000,"Disk changed STILL detected, rereading TOC!\n");
4389 i=DiskInfo();
4390 if(i==0) {
4391 current_drive->CD_changed=0x00; /* cd has changed, procede, */
4392 RETURN_UP(-EIO); /* and get TOC, etc on next try! --AJK */
4393 } else {
4394 RETURN_UP(-EIO); /* we weren't ready yet! --AJK */
4395 }
4396 }
4397 memcpy(&SC, (void *) arg, sizeof(struct cdrom_subchnl));
4398 /*
4399 This virtual crap is very bogus!
4400 It doesn't detect when the cd is done playing audio!
4401 Lets do this right with proper hardware register reading!
4402 */
4403 cc_ReadStatus();
4404 i=ResponseStatus();
4405 msg(DBG_000,"Drive Status: door_locked =%d.\n", st_door_locked);
4406 msg(DBG_000,"Drive Status: door_closed =%d.\n", st_door_closed);
4407 msg(DBG_000,"Drive Status: caddy_in =%d.\n", st_caddy_in);
4408 msg(DBG_000,"Drive Status: disk_ok =%d.\n", st_diskok);
4409 msg(DBG_000,"Drive Status: spinning =%d.\n", st_spinning);
4410 msg(DBG_000,"Drive Status: busy =%d.\n", st_busy);
4411 /* st_busy indicates if it's _ACTUALLY_ playing audio */
4412 switch (current_drive->audio_state)
4413 {
4414 case audio_playing:
4415 if(st_busy==0) {
4416 /* CD has stopped playing audio --AJK */
4417 current_drive->audio_state=audio_completed;
4418 SC.cdsc_audiostatus=CDROM_AUDIO_COMPLETED;
4419 } else {
4420 SC.cdsc_audiostatus=CDROM_AUDIO_PLAY;
4421 }
4422 break;
4423 case audio_pausing:
4424 SC.cdsc_audiostatus=CDROM_AUDIO_PAUSED;
4425 break;
4426 case audio_completed:
4427 SC.cdsc_audiostatus=CDROM_AUDIO_COMPLETED;
4428 break;
4429 default:
4430 SC.cdsc_audiostatus=CDROM_AUDIO_NO_STATUS;
4431 break;
4432 }
4433 SC.cdsc_adr=current_drive->SubQ_ctl_adr;
4434 SC.cdsc_ctrl=current_drive->SubQ_ctl_adr>>4;
4435 SC.cdsc_trk=bcd2bin(current_drive->SubQ_trk);
4436 SC.cdsc_ind=bcd2bin(current_drive->SubQ_pnt_idx);
4437 if (SC.cdsc_format==CDROM_LBA)
4438 {
4439 SC.cdsc_absaddr.lba=msf2blk(current_drive->SubQ_run_tot);
4440 SC.cdsc_reladdr.lba=msf2blk(current_drive->SubQ_run_trk);
4441 }
4442 else /* not only if (SC.cdsc_format==CDROM_MSF) */
4443 {
4444 SC.cdsc_absaddr.msf.minute=(current_drive->SubQ_run_tot>>16)&0x00FF;
4445 SC.cdsc_absaddr.msf.second=(current_drive->SubQ_run_tot>>8)&0x00FF;
4446 SC.cdsc_absaddr.msf.frame=current_drive->SubQ_run_tot&0x00FF;
4447 SC.cdsc_reladdr.msf.minute=(current_drive->SubQ_run_trk>>16)&0x00FF;
4448 SC.cdsc_reladdr.msf.second=(current_drive->SubQ_run_trk>>8)&0x00FF;
4449 SC.cdsc_reladdr.msf.frame=current_drive->SubQ_run_trk&0x00FF;
4450 }
4451 memcpy((void *) arg, &SC, sizeof(struct cdrom_subchnl));
4452 msg(DBG_IOS,"CDROMSUBCHNL: %1X %02X %08X %08X %02X %02X %06X %06X\n",
4453 SC.cdsc_format,SC.cdsc_audiostatus,
4454 SC.cdsc_adr,SC.cdsc_ctrl,
4455 SC.cdsc_trk,SC.cdsc_ind,
4456 SC.cdsc_absaddr,SC.cdsc_reladdr);
4457 RETURN_UP(0);
4458
4459 default:
4460 msg(DBG_IOC,"ioctl: unknown function request %04X\n", cmd);
4461 RETURN_UP(-EINVAL);
4462 } /* end switch(cmd) */
4463}
4464/*==========================================================================*/
4465/*
4466 * Take care of the different block sizes between cdrom and Linux.
4467 */
4468static void sbp_transfer(struct request *req)
4469{
4470 long offs;
4471
4472 while ( (req->nr_sectors > 0) &&
4473 (req->sector/4 >= current_drive->sbp_first_frame) &&
4474 (req->sector/4 <= current_drive->sbp_last_frame) )
4475 {
4476 offs = (req->sector - current_drive->sbp_first_frame * 4) * 512;
4477 memcpy(req->buffer, current_drive->sbp_buf + offs, 512);
4478 req->nr_sectors--;
4479 req->sector++;
4480 req->buffer += 512;
4481 }
4482}
4483/*==========================================================================*/
4484/*
4485 * special end_request for sbpcd to solve CURRENT==NULL bug. (GTL)
4486 * GTL = Gonzalo Tornaria <tornaria@cmat.edu.uy>
4487 *
4488 * This is a kludge so we don't need to modify end_request.
4489 * We put the req we take out after INIT_REQUEST in the requests list,
4490 * so that end_request will discard it.
4491 *
4492 * The bug could be present in other block devices, perhaps we
4493 * should modify INIT_REQUEST and end_request instead, and
4494 * change every block device..
4495 *
4496 * Could be a race here?? Could e.g. a timer interrupt schedule() us?
4497 * If so, we should copy end_request here, and do it right.. (or
4498 * modify end_request and the block devices).
4499 *
4500 * In any case, the race here would be much small than it was, and
4501 * I couldn't reproduce..
4502 *
4503 * The race could be: suppose CURRENT==NULL. We put our req in the list,
4504 * and we are scheduled. Other process takes over, and gets into
4505 * do_sbpcd_request. It sees CURRENT!=NULL (it is == to our req), so
4506 * proceeds. It ends, so CURRENT is now NULL.. Now we awake somewhere in
4507 * end_request, but now CURRENT==NULL... oops!
4508 *
4509 */
4510#undef DEBUG_GTL
4511
4512/*==========================================================================*/
4513/*
4514 * I/O request routine, called from Linux kernel.
4515 */
4516static void do_sbpcd_request(request_queue_t * q)
4517{
4518 u_int block;
4519 u_int nsect;
4520 int status_tries, data_tries;
4521 struct request *req;
4522 struct sbpcd_drive *p;
4523#ifdef DEBUG_GTL
4524 static int xx_nr=0;
4525 int xnr;
4526#endif
4527
4528 request_loop:
4529#ifdef DEBUG_GTL
4530 xnr=++xx_nr;
4531
4532 req = elv_next_request(q);
4533
4534 if (!req)
4535 {
4536 printk( "do_sbpcd_request[%di](NULL), Pid:%d, Time:%li\n",
4537 xnr, current->pid, jiffies);
4538 printk( "do_sbpcd_request[%do](NULL) end 0 (null), Time:%li\n",
4539 xnr, jiffies);
4540 return;
4541 }
4542
4543 printk(" do_sbpcd_request[%di](%p:%ld+%ld), Pid:%d, Time:%li\n",
4544 xnr, req, req->sector, req->nr_sectors, current->pid, jiffies);
4545#endif
4546
4547 req = elv_next_request(q); /* take out our request so no other */
4548 if (!req)
4549 return;
4550
4551 if (req -> sector == -1)
4552 end_request(req, 0);
4553 spin_unlock_irq(q->queue_lock);
4554
4555 down(&ioctl_read_sem);
4556 if (rq_data_dir(elv_next_request(q)) != READ)
4557 {
4558 msg(DBG_INF, "bad cmd %d\n", req->cmd[0]);
4559 goto err_done;
4560 }
4561 p = req->rq_disk->private_data;
4562#if OLD_BUSY
4563 while (busy_audio) sbp_sleep(HZ); /* wait a bit */
4564 busy_data=1;
4565#endif /* OLD_BUSY */
4566
4567 if (p->audio_state==audio_playing) goto err_done;
4568 if (p != current_drive)
4569 switch_drive(p);
4570
4571 block = req->sector; /* always numbered as 512-byte-pieces */
4572 nsect = req->nr_sectors; /* always counted as 512-byte-pieces */
4573
4574 msg(DBG_BSZ,"read sector %d (%d sectors)\n", block, nsect);
4575#if 0
4576 msg(DBG_MUL,"read LBA %d\n", block/4);
4577#endif
4578
4579 sbp_transfer(req);
4580 /* if we satisfied the request from the buffer, we're done. */
4581 if (req->nr_sectors == 0)
4582 {
4583#ifdef DEBUG_GTL
4584 printk(" do_sbpcd_request[%do](%p:%ld+%ld) end 2, Time:%li\n",
4585 xnr, req, req->sector, req->nr_sectors, jiffies);
4586#endif
4587 up(&ioctl_read_sem);
4588 spin_lock_irq(q->queue_lock);
4589 end_request(req, 1);
4590 goto request_loop;
4591 }
4592
4593#ifdef FUTURE
4594 i=prepare(0,0); /* at moment not really a hassle check, but ... */
4595 if (i!=0)
4596 msg(DBG_INF,"\"prepare\" tells error %d -- ignored\n", i);
4597#endif /* FUTURE */
4598
4599 if (!st_spinning) cc_SpinUp();
4600
4601 for (data_tries=n_retries; data_tries > 0; data_tries--)
4602 {
4603 for (status_tries=3; status_tries > 0; status_tries--)
4604 {
4605 flags_cmd_out |= f_respo3;
4606 cc_ReadStatus();
4607 if (sbp_status() != 0) break;
4608 if (st_check) cc_ReadError();
4609 sbp_sleep(1); /* wait a bit, try again */
4610 }
4611 if (status_tries == 0)
4612 {
4613 msg(DBG_INF,"sbp_status: failed after 3 tries in line %d\n", __LINE__);
4614 break;
4615 }
4616
4617 sbp_read_cmd(req);
4618 sbp_sleep(0);
4619 if (sbp_data(req) != 0)
4620 {
4621#ifdef SAFE_MIXED
4622 current_drive->has_data=2; /* is really a data disk */
4623#endif /* SAFE_MIXED */
4624#ifdef DEBUG_GTL
4625 printk(" do_sbpcd_request[%do](%p:%ld+%ld) end 3, Time:%li\n",
4626 xnr, req, req->sector, req->nr_sectors, jiffies);
4627#endif
4628 up(&ioctl_read_sem);
4629 spin_lock_irq(q->queue_lock);
4630 end_request(req, 1);
4631 goto request_loop;
4632 }
4633 }
4634
4635 err_done:
4636#if OLD_BUSY
4637 busy_data=0;
4638#endif /* OLD_BUSY */
4639#ifdef DEBUG_GTL
4640 printk(" do_sbpcd_request[%do](%p:%ld+%ld) end 4 (error), Time:%li\n",
4641 xnr, req, req->sector, req->nr_sectors, jiffies);
4642#endif
4643 up(&ioctl_read_sem);
4644 sbp_sleep(0); /* wait a bit, try again */
4645 spin_lock_irq(q->queue_lock);
4646 end_request(req, 0);
4647 goto request_loop;
4648}
4649/*==========================================================================*/
4650/*
4651 * build and send the READ command.
4652 */
4653static void sbp_read_cmd(struct request *req)
4654{
4655#undef OLD
4656
4657 int i;
4658 int block;
4659
4660 current_drive->sbp_first_frame=current_drive->sbp_last_frame=-1; /* purge buffer */
4661 current_drive->sbp_current = 0;
4662 block=req->sector/4;
4663 if (block+current_drive->sbp_bufsiz <= current_drive->CDsize_frm)
4664 current_drive->sbp_read_frames = current_drive->sbp_bufsiz;
4665 else
4666 {
4667 current_drive->sbp_read_frames=current_drive->CDsize_frm-block;
4668 /* avoid reading past end of data */
4669 if (current_drive->sbp_read_frames < 1)
4670 {
4671 msg(DBG_INF,"requested frame %d, CD size %d ???\n",
4672 block, current_drive->CDsize_frm);
4673 current_drive->sbp_read_frames=1;
4674 }
4675 }
4676
4677 flags_cmd_out = f_putcmd | f_respo2 | f_ResponseStatus | f_obey_p_check;
4678 clr_cmdbuf();
4679 if (famV_drive)
4680 {
4681 drvcmd[0]=CMDV_READ;
4682 lba2msf(block,&drvcmd[1]); /* msf-bcd format required */
4683 bin2bcdx(&drvcmd[1]);
4684 bin2bcdx(&drvcmd[2]);
4685 bin2bcdx(&drvcmd[3]);
4686 drvcmd[4]=current_drive->sbp_read_frames>>8;
4687 drvcmd[5]=current_drive->sbp_read_frames&0xff;
4688 drvcmd[6]=0x02; /* flag "msf-bcd" */
4689 }
4690 else if (fam0L_drive)
4691 {
4692 flags_cmd_out |= f_lopsta | f_getsta | f_bit1;
4693 if (current_drive->xa_byte==0x20)
4694 {
4695 cmd_type=READ_M2;
4696 drvcmd[0]=CMD0_READ_XA; /* "read XA frames", old drives */
4697 drvcmd[1]=(block>>16)&0x0ff;
4698 drvcmd[2]=(block>>8)&0x0ff;
4699 drvcmd[3]=block&0x0ff;
4700 drvcmd[4]=(current_drive->sbp_read_frames>>8)&0x0ff;
4701 drvcmd[5]=current_drive->sbp_read_frames&0x0ff;
4702 }
4703 else
4704 {
4705 drvcmd[0]=CMD0_READ; /* "read frames", old drives */
4706 if (current_drive->drv_type>=drv_201)
4707 {
4708 lba2msf(block,&drvcmd[1]); /* msf-bcd format required */
4709 bin2bcdx(&drvcmd[1]);
4710 bin2bcdx(&drvcmd[2]);
4711 bin2bcdx(&drvcmd[3]);
4712 }
4713 else
4714 {
4715 drvcmd[1]=(block>>16)&0x0ff;
4716 drvcmd[2]=(block>>8)&0x0ff;
4717 drvcmd[3]=block&0x0ff;
4718 }
4719 drvcmd[4]=(current_drive->sbp_read_frames>>8)&0x0ff;
4720 drvcmd[5]=current_drive->sbp_read_frames&0x0ff;
4721 drvcmd[6]=(current_drive->drv_type<drv_201)?0:2; /* flag "lba or msf-bcd format" */
4722 }
4723 }
4724 else if (fam1_drive)
4725 {
4726 drvcmd[0]=CMD1_READ;
4727 lba2msf(block,&drvcmd[1]); /* msf-bin format required */
4728 drvcmd[5]=(current_drive->sbp_read_frames>>8)&0x0ff;
4729 drvcmd[6]=current_drive->sbp_read_frames&0x0ff;
4730 }
4731 else if (fam2_drive)
4732 {
4733 drvcmd[0]=CMD2_READ;
4734 lba2msf(block,&drvcmd[1]); /* msf-bin format required */
4735 drvcmd[4]=(current_drive->sbp_read_frames>>8)&0x0ff;
4736 drvcmd[5]=current_drive->sbp_read_frames&0x0ff;
4737 drvcmd[6]=0x02;
4738 }
4739 else if (famT_drive)
4740 {
4741 drvcmd[0]=CMDT_READ;
4742 drvcmd[2]=(block>>24)&0x0ff;
4743 drvcmd[3]=(block>>16)&0x0ff;
4744 drvcmd[4]=(block>>8)&0x0ff;
4745 drvcmd[5]=block&0x0ff;
4746 drvcmd[7]=(current_drive->sbp_read_frames>>8)&0x0ff;
4747 drvcmd[8]=current_drive->sbp_read_frames&0x0ff;
4748 }
4749 flags_cmd_out=f_putcmd;
4750 response_count=0;
4751 i=cmd_out();
4752 if (i<0) msg(DBG_INF,"error giving READ command: %0d\n", i);
4753 return;
4754}
4755/*==========================================================================*/
4756/*
4757 * Check the completion of the read-data command. On success, read
4758 * the current_drive->sbp_bufsiz * 2048 bytes of data from the disk into buffer.
4759 */
4760static int sbp_data(struct request *req)
4761{
4762 int i=0, j=0, l, frame;
4763 u_int try=0;
4764 u_long timeout;
4765 u_char *p;
4766 u_int data_tries = 0;
4767 u_int data_waits = 0;
4768 u_int data_retrying = 0;
4769 int error_flag;
4770 int xa_count;
4771 int max_latency;
4772 int success;
4773 int wait;
4774 int duration;
4775
4776 error_flag=0;
4777 success=0;
4778#if LONG_TIMING
4779 max_latency=9*HZ;
4780#else
4781 if (current_drive->f_multisession) max_latency=15*HZ;
4782 else max_latency=5*HZ;
4783#endif
4784 duration=jiffies;
4785 for (frame=0;frame<current_drive->sbp_read_frames&&!error_flag; frame++)
4786 {
4787 SBPCD_CLI;
4788
4789 del_timer(&data_timer);
4790 data_timer.expires=jiffies+max_latency;
4791 timed_out_data=0;
4792 add_timer(&data_timer);
4793 while (!timed_out_data)
4794 {
4795 if (current_drive->f_multisession) try=maxtim_data*4;
4796 else try=maxtim_data;
4797 msg(DBG_000,"sbp_data: CDi_status loop: try=%d.\n",try);
4798 for ( ; try!=0;try--)
4799 {
4800 j=inb(CDi_status);
4801 if (!(j&s_not_data_ready)) break;
4802 if (!(j&s_not_result_ready)) break;
4803 if (fam0LV_drive) if (j&s_attention) break;
4804 }
4805 if (!(j&s_not_data_ready)) goto data_ready;
4806 if (try==0)
4807 {
4808 if (data_retrying == 0) data_waits++;
4809 data_retrying = 1;
4810 msg(DBG_000,"sbp_data: CDi_status loop: sleeping.\n");
4811 sbp_sleep(1);
4812 try = 1;
4813 }
4814 }
4815 msg(DBG_INF,"sbp_data: CDi_status loop expired.\n");
4816 data_ready:
4817 del_timer(&data_timer);
4818
4819 if (timed_out_data)
4820 {
4821 msg(DBG_INF,"sbp_data: CDi_status timeout (timed_out_data) (%02X).\n", j);
4822 error_flag++;
4823 }
4824 if (try==0)
4825 {
4826 msg(DBG_INF,"sbp_data: CDi_status timeout (try=0) (%02X).\n", j);
4827 error_flag++;
4828 }
4829 if (!(j&s_not_result_ready))
4830 {
4831 msg(DBG_INF, "sbp_data: RESULT_READY where DATA_READY awaited (%02X).\n", j);
4832 response_count=20;
4833 j=ResponseInfo();
4834 j=inb(CDi_status);
4835 }
4836 if (j&s_not_data_ready)
4837 {
4838 if ((current_drive->ored_ctl_adr&0x40)==0)
4839 msg(DBG_INF, "CD contains no data tracks.\n");
4840 else msg(DBG_INF, "sbp_data: DATA_READY timeout (%02X).\n", j);
4841 error_flag++;
4842 }
4843 SBPCD_STI;
4844 if (error_flag) break;
4845
4846 msg(DBG_000, "sbp_data: beginning to read.\n");
4847 p = current_drive->sbp_buf + frame * CD_FRAMESIZE;
4848 if (sbpro_type==1) OUT(CDo_sel_i_d,1);
4849 if (cmd_type==READ_M2) {
4850 if (do_16bit) insw(CDi_data, xa_head_buf, CD_XA_HEAD>>1);
4851 else insb(CDi_data, xa_head_buf, CD_XA_HEAD);
4852 }
4853 if (do_16bit) insw(CDi_data, p, CD_FRAMESIZE>>1);
4854 else insb(CDi_data, p, CD_FRAMESIZE);
4855 if (cmd_type==READ_M2) {
4856 if (do_16bit) insw(CDi_data, xa_tail_buf, CD_XA_TAIL>>1);
4857 else insb(CDi_data, xa_tail_buf, CD_XA_TAIL);
4858 }
4859 current_drive->sbp_current++;
4860 if (sbpro_type==1) OUT(CDo_sel_i_d,0);
4861 if (cmd_type==READ_M2)
4862 {
4863 for (xa_count=0;xa_count<CD_XA_HEAD;xa_count++)
4864 sprintf(&msgbuf[xa_count*3], " %02X", xa_head_buf[xa_count]);
4865 msgbuf[xa_count*3]=0;
4866 msg(DBG_XA1,"xa head:%s\n", msgbuf);
4867 }
4868 data_retrying = 0;
4869 data_tries++;
4870 if (data_tries >= 1000)
4871 {
4872 msg(DBG_INF,"sbp_data() statistics: %d waits in %d frames.\n", data_waits, data_tries);
4873 data_waits = data_tries = 0;
4874 }
4875 }
4876 duration=jiffies-duration;
4877 msg(DBG_TEA,"time to read %d frames: %d jiffies .\n",frame,duration);
4878 if (famT_drive)
4879 {
4880 wait=8;
4881 do
4882 {
4883 if (teac==2)
4884 {
4885 if ((i=CDi_stat_loop_T()) == -1) break;
4886 }
4887 else
4888 {
4889 sbp_sleep(1);
4890 OUT(CDo_sel_i_d,0);
4891 i=inb(CDi_status);
4892 }
4893 if (!(i&s_not_data_ready))
4894 {
4895 OUT(CDo_sel_i_d,1);
4896 j=0;
4897 do
4898 {
4899 if (do_16bit) i=inw(CDi_data);
4900 else i=inb(CDi_data);
4901 j++;
4902 i=inb(CDi_status);
4903 }
4904 while (!(i&s_not_data_ready));
4905 msg(DBG_TEA, "==========too much data (%d bytes/words)==============.\n", j);
4906 }
4907 if (!(i&s_not_result_ready))
4908 {
4909 OUT(CDo_sel_i_d,0);
4910 l=0;
4911 do
4912 {
4913 infobuf[l++]=inb(CDi_info);
4914 i=inb(CDi_status);
4915 }
4916 while (!(i&s_not_result_ready));
4917 if (infobuf[0]==0x00) success=1;
4918#if 1
4919 for (j=0;j<l;j++) sprintf(&msgbuf[j*3], " %02X", infobuf[j]);
4920 msgbuf[j*3]=0;
4921 msg(DBG_TEA,"sbp_data info response:%s\n", msgbuf);
4922#endif
4923 if (infobuf[0]==0x02)
4924 {
4925 error_flag++;
4926 do
4927 {
4928 ++recursion;
4929 if (recursion>1) msg(DBG_TEA,"cmd_out_T READ_ERR recursion (sbp_data): %d !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!\n",recursion);
4930 else msg(DBG_TEA,"sbp_data: CMDT_READ_ERR necessary.\n");
4931 clr_cmdbuf();
4932 drvcmd[0]=CMDT_READ_ERR;
4933 j=cmd_out_T(); /* !!! recursive here !!! */
4934 --recursion;
4935 sbp_sleep(1);
4936 }
4937 while (j<0);
4938 current_drive->error_state=infobuf[2];
4939 current_drive->b3=infobuf[3];
4940 current_drive->b4=infobuf[4];
4941 }
4942 break;
4943 }
4944 else
4945 {
4946#if 0
4947 msg(DBG_TEA, "============= waiting for result=================.\n");
4948 sbp_sleep(1);
4949#endif
4950 }
4951 }
4952 while (wait--);
4953 }
4954
4955 if (error_flag) /* must have been spurious D_RDY or (ATTN&&!D_RDY) */
4956 {
4957 msg(DBG_TEA, "================error flag: %d=================.\n", error_flag);
4958 msg(DBG_INF,"sbp_data: read aborted by drive.\n");
4959#if 1
4960 i=cc_DriveReset(); /* ugly fix to prevent a hang */
4961#else
4962 i=cc_ReadError();
4963#endif
4964 return (0);
4965 }
4966
4967 if (fam0LV_drive)
4968 {
4969 SBPCD_CLI;
4970 i=maxtim_data;
4971 for (timeout=jiffies+HZ; time_before(jiffies, timeout); timeout--)
4972 {
4973 for ( ;i!=0;i--)
4974 {
4975 j=inb(CDi_status);
4976 if (!(j&s_not_data_ready)) break;
4977 if (!(j&s_not_result_ready)) break;
4978 if (j&s_attention) break;
4979 }
4980 if (i != 0 || time_after_eq(jiffies, timeout)) break;
4981 sbp_sleep(0);
4982 i = 1;
4983 }
4984 if (i==0) msg(DBG_INF,"status timeout after READ.\n");
4985 if (!(j&s_attention))
4986 {
4987 msg(DBG_INF,"sbp_data: timeout waiting DRV_ATTN - retrying.\n");
4988 i=cc_DriveReset(); /* ugly fix to prevent a hang */
4989 SBPCD_STI;
4990 return (0);
4991 }
4992 SBPCD_STI;
4993 }
4994
4995#if 0
4996 if (!success)
4997#endif
4998 do
4999 {
5000 if (fam0LV_drive) cc_ReadStatus();
5001#if 1
5002 if (famT_drive) msg(DBG_TEA, "================before ResponseStatus=================.\n", i);
5003#endif
5004 i=ResponseStatus(); /* builds status_bits, returns orig. status (old) or faked p_success (new) */
5005#if 1
5006 if (famT_drive) msg(DBG_TEA, "================ResponseStatus: %d=================.\n", i);
5007#endif
5008 if (i<0)
5009 {
5010 msg(DBG_INF,"bad cc_ReadStatus after read: %02X\n", current_drive->status_bits);
5011 return (0);
5012 }
5013 }
5014 while ((fam0LV_drive)&&(!st_check)&&(!(i&p_success)));
5015 if (st_check)
5016 {
5017 i=cc_ReadError();
5018 msg(DBG_INF,"cc_ReadError was necessary after read: %d\n",i);
5019 return (0);
5020 }
5021 if (fatal_err)
5022 {
5023 fatal_err=0;
5024 current_drive->sbp_first_frame=current_drive->sbp_last_frame=-1; /* purge buffer */
5025 current_drive->sbp_current = 0;
5026 msg(DBG_INF,"sbp_data: fatal_err - retrying.\n");
5027 return (0);
5028 }
5029
5030 current_drive->sbp_first_frame = req -> sector / 4;
5031 current_drive->sbp_last_frame = current_drive->sbp_first_frame + current_drive->sbp_read_frames - 1;
5032 sbp_transfer(req);
5033 return (1);
5034}
5035/*==========================================================================*/
5036
5037static int sbpcd_block_open(struct inode *inode, struct file *file)
5038{
5039 struct sbpcd_drive *p = inode->i_bdev->bd_disk->private_data;
5040 return cdrom_open(p->sbpcd_infop, inode, file);
5041}
5042
5043static int sbpcd_block_release(struct inode *inode, struct file *file)
5044{
5045 struct sbpcd_drive *p = inode->i_bdev->bd_disk->private_data;
5046 return cdrom_release(p->sbpcd_infop, file);
5047}
5048
5049static int sbpcd_block_ioctl(struct inode *inode, struct file *file,
5050 unsigned cmd, unsigned long arg)
5051{
5052 struct sbpcd_drive *p = inode->i_bdev->bd_disk->private_data;
5053 struct cdrom_device_info *cdi = p->sbpcd_infop;
5054 int ret, i;
5055
5056 ret = cdrom_ioctl(file, p->sbpcd_infop, inode, cmd, arg);
5057 if (ret != -ENOSYS)
5058 return ret;
5059
Linus Torvalds1da177e2005-04-16 15:20:36 -07005060 msg(DBG_IO2,"ioctl(%s, 0x%08lX, 0x%08lX)\n", cdi->name, cmd, arg);
5061 if (p->drv_id==-1) {
5062 msg(DBG_INF, "ioctl: bad device: %s\n", cdi->name);
5063 return (-ENXIO); /* no such drive */
5064 }
5065 down(&ioctl_read_sem);
5066 if (p != current_drive)
5067 switch_drive(p);
5068
5069 msg(DBG_IO2,"ioctl: device %s, request %04X\n",cdi->name,cmd);
5070 switch (cmd) /* Sun-compatible */
5071 {
5072 case DDIOCSDBG: /* DDI Debug */
5073 if (!capable(CAP_SYS_ADMIN)) RETURN_UP(-EPERM);
5074 i=sbpcd_dbg_ioctl(arg,1);
5075 RETURN_UP(i);
5076 case CDROMRESET: /* hard reset the drive */
5077 msg(DBG_IOC,"ioctl: CDROMRESET entered.\n");
5078 i=DriveReset();
5079 current_drive->audio_state=0;
5080 RETURN_UP(i);
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005081
Linus Torvalds1da177e2005-04-16 15:20:36 -07005082 case CDROMREADMODE1:
5083 msg(DBG_IOC,"ioctl: CDROMREADMODE1 requested.\n");
5084#ifdef SAFE_MIXED
5085 if (current_drive->has_data>1) RETURN_UP(-EBUSY);
5086#endif /* SAFE_MIXED */
5087 cc_ModeSelect(CD_FRAMESIZE);
5088 cc_ModeSense();
5089 current_drive->mode=READ_M1;
5090 RETURN_UP(0);
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005091
Linus Torvalds1da177e2005-04-16 15:20:36 -07005092 case CDROMREADMODE2: /* not usable at the moment */
5093 msg(DBG_IOC,"ioctl: CDROMREADMODE2 requested.\n");
5094#ifdef SAFE_MIXED
5095 if (current_drive->has_data>1) RETURN_UP(-EBUSY);
5096#endif /* SAFE_MIXED */
5097 cc_ModeSelect(CD_FRAMESIZE_RAW1);
5098 cc_ModeSense();
5099 current_drive->mode=READ_M2;
5100 RETURN_UP(0);
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005101
Linus Torvalds1da177e2005-04-16 15:20:36 -07005102 case CDROMAUDIOBUFSIZ: /* configure the audio buffer size */
5103 msg(DBG_IOC,"ioctl: CDROMAUDIOBUFSIZ entered.\n");
Jesper Juhlf91012102005-09-10 00:26:54 -07005104 if (current_drive->sbp_audsiz>0)
5105 vfree(current_drive->aud_buf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005106 current_drive->aud_buf=NULL;
5107 current_drive->sbp_audsiz=arg;
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005108
Linus Torvalds1da177e2005-04-16 15:20:36 -07005109 if (current_drive->sbp_audsiz>16)
5110 {
5111 current_drive->sbp_audsiz = 0;
5112 RETURN_UP(current_drive->sbp_audsiz);
5113 }
5114
5115 if (current_drive->sbp_audsiz>0)
5116 {
5117 current_drive->aud_buf=(u_char *) vmalloc(current_drive->sbp_audsiz*CD_FRAMESIZE_RAW);
5118 if (current_drive->aud_buf==NULL)
5119 {
5120 msg(DBG_INF,"audio buffer (%d frames) not available.\n",current_drive->sbp_audsiz);
5121 current_drive->sbp_audsiz=0;
5122 }
5123 else msg(DBG_INF,"audio buffer size: %d frames.\n",current_drive->sbp_audsiz);
5124 }
5125 RETURN_UP(current_drive->sbp_audsiz);
5126
5127 case CDROMREADAUDIO:
5128 { /* start of CDROMREADAUDIO */
5129 int i=0, j=0, frame, block=0;
5130 u_int try=0;
5131 u_long timeout;
5132 u_char *p;
5133 u_int data_tries = 0;
5134 u_int data_waits = 0;
5135 u_int data_retrying = 0;
5136 int status_tries;
5137 int error_flag;
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005138
Linus Torvalds1da177e2005-04-16 15:20:36 -07005139 msg(DBG_IOC,"ioctl: CDROMREADAUDIO entered.\n");
5140 if (fam0_drive) RETURN_UP(-EINVAL);
5141 if (famL_drive) RETURN_UP(-EINVAL);
5142 if (famV_drive) RETURN_UP(-EINVAL);
5143 if (famT_drive) RETURN_UP(-EINVAL);
5144#ifdef SAFE_MIXED
5145 if (current_drive->has_data>1) RETURN_UP(-EBUSY);
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005146#endif /* SAFE_MIXED */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005147 if (current_drive->aud_buf==NULL) RETURN_UP(-EINVAL);
5148 if (copy_from_user(&read_audio, (void __user *)arg,
5149 sizeof(struct cdrom_read_audio)))
5150 RETURN_UP(-EFAULT);
5151 if (read_audio.nframes < 0 || read_audio.nframes>current_drive->sbp_audsiz) RETURN_UP(-EINVAL);
5152 if (!access_ok(VERIFY_WRITE, read_audio.buf,
5153 read_audio.nframes*CD_FRAMESIZE_RAW))
5154 RETURN_UP(-EFAULT);
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005155
Linus Torvalds1da177e2005-04-16 15:20:36 -07005156 if (read_audio.addr_format==CDROM_MSF) /* MSF-bin specification of where to start */
5157 block=msf2lba(&read_audio.addr.msf.minute);
5158 else if (read_audio.addr_format==CDROM_LBA) /* lba specification of where to start */
5159 block=read_audio.addr.lba;
5160 else RETURN_UP(-EINVAL);
5161#if 000
5162 i=cc_SetSpeed(speed_150,0,0);
5163 if (i) msg(DBG_AUD,"read_audio: SetSpeed error %d\n", i);
5164#endif
5165 msg(DBG_AUD,"read_audio: lba: %d, msf: %06X\n",
5166 block, blk2msf(block));
5167 msg(DBG_AUD,"read_audio: before cc_ReadStatus.\n");
5168#if OLD_BUSY
5169 while (busy_data) sbp_sleep(HZ/10); /* wait a bit */
5170 busy_audio=1;
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005171#endif /* OLD_BUSY */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005172 error_flag=0;
5173 for (data_tries=5; data_tries>0; data_tries--)
5174 {
5175 msg(DBG_AUD,"data_tries=%d ...\n", data_tries);
5176 current_drive->mode=READ_AU;
5177 cc_ModeSelect(CD_FRAMESIZE_RAW);
5178 cc_ModeSense();
5179 for (status_tries=3; status_tries > 0; status_tries--)
5180 {
5181 flags_cmd_out |= f_respo3;
5182 cc_ReadStatus();
5183 if (sbp_status() != 0) break;
5184 if (st_check) cc_ReadError();
5185 sbp_sleep(1); /* wait a bit, try again */
5186 }
5187 if (status_tries == 0)
5188 {
5189 msg(DBG_AUD,"read_audio: sbp_status: failed after 3 tries in line %d.\n", __LINE__);
5190 continue;
5191 }
5192 msg(DBG_AUD,"read_audio: sbp_status: ok.\n");
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005193
Linus Torvalds1da177e2005-04-16 15:20:36 -07005194 flags_cmd_out = f_putcmd | f_respo2 | f_ResponseStatus | f_obey_p_check;
5195 if (fam0L_drive)
5196 {
5197 flags_cmd_out |= f_lopsta | f_getsta | f_bit1;
5198 cmd_type=READ_M2;
5199 drvcmd[0]=CMD0_READ_XA; /* "read XA frames", old drives */
5200 drvcmd[1]=(block>>16)&0x000000ff;
5201 drvcmd[2]=(block>>8)&0x000000ff;
5202 drvcmd[3]=block&0x000000ff;
5203 drvcmd[4]=0;
5204 drvcmd[5]=read_audio.nframes; /* # of frames */
5205 drvcmd[6]=0;
5206 }
5207 else if (fam1_drive)
5208 {
5209 drvcmd[0]=CMD1_READ; /* "read frames", new drives */
5210 lba2msf(block,&drvcmd[1]); /* msf-bin format required */
5211 drvcmd[4]=0;
5212 drvcmd[5]=0;
5213 drvcmd[6]=read_audio.nframes; /* # of frames */
5214 }
5215 else if (fam2_drive)
5216 {
5217 drvcmd[0]=CMD2_READ_XA2;
5218 lba2msf(block,&drvcmd[1]); /* msf-bin format required */
5219 drvcmd[4]=0;
5220 drvcmd[5]=read_audio.nframes; /* # of frames */
5221 drvcmd[6]=0x11; /* raw mode */
5222 }
5223 else if (famT_drive) /* CD-55A: not tested yet */
5224 {
5225 }
5226 msg(DBG_AUD,"read_audio: before giving \"read\" command.\n");
5227 flags_cmd_out=f_putcmd;
5228 response_count=0;
5229 i=cmd_out();
5230 if (i<0) msg(DBG_INF,"error giving READ AUDIO command: %0d\n", i);
5231 sbp_sleep(0);
5232 msg(DBG_AUD,"read_audio: after giving \"read\" command.\n");
5233 for (frame=1;frame<2 && !error_flag; frame++)
5234 {
5235 try=maxtim_data;
5236 for (timeout=jiffies+9*HZ; ; )
5237 {
5238 for ( ; try!=0;try--)
5239 {
5240 j=inb(CDi_status);
5241 if (!(j&s_not_data_ready)) break;
5242 if (!(j&s_not_result_ready)) break;
5243 if (fam0L_drive) if (j&s_attention) break;
5244 }
5245 if (try != 0 || time_after_eq(jiffies, timeout)) break;
5246 if (data_retrying == 0) data_waits++;
5247 data_retrying = 1;
5248 sbp_sleep(1);
5249 try = 1;
5250 }
5251 if (try==0)
5252 {
5253 msg(DBG_INF,"read_audio: sbp_data: CDi_status timeout.\n");
5254 error_flag++;
5255 break;
5256 }
5257 msg(DBG_AUD,"read_audio: sbp_data: CDi_status ok.\n");
5258 if (j&s_not_data_ready)
5259 {
5260 msg(DBG_INF, "read_audio: sbp_data: DATA_READY timeout.\n");
5261 error_flag++;
5262 break;
5263 }
5264 msg(DBG_AUD,"read_audio: before reading data.\n");
5265 error_flag=0;
5266 p = current_drive->aud_buf;
5267 if (sbpro_type==1) OUT(CDo_sel_i_d,1);
5268 if (do_16bit)
5269 {
5270 u_short *p2 = (u_short *) p;
5271
5272 for (; (u_char *) p2 < current_drive->aud_buf + read_audio.nframes*CD_FRAMESIZE_RAW;)
5273 {
5274 if ((inb_p(CDi_status)&s_not_data_ready)) continue;
5275
5276 /* get one sample */
5277 *p2++ = inw_p(CDi_data);
5278 *p2++ = inw_p(CDi_data);
5279 }
5280 } else {
5281 for (; p < current_drive->aud_buf + read_audio.nframes*CD_FRAMESIZE_RAW;)
5282 {
5283 if ((inb_p(CDi_status)&s_not_data_ready)) continue;
5284
5285 /* get one sample */
5286 *p++ = inb_p(CDi_data);
5287 *p++ = inb_p(CDi_data);
5288 *p++ = inb_p(CDi_data);
5289 *p++ = inb_p(CDi_data);
5290 }
5291 }
5292 if (sbpro_type==1) OUT(CDo_sel_i_d,0);
5293 data_retrying = 0;
5294 }
5295 msg(DBG_AUD,"read_audio: after reading data.\n");
5296 if (error_flag) /* must have been spurious D_RDY or (ATTN&&!D_RDY) */
5297 {
5298 msg(DBG_AUD,"read_audio: read aborted by drive\n");
5299#if 0000
5300 i=cc_DriveReset(); /* ugly fix to prevent a hang */
5301#else
5302 i=cc_ReadError();
5303#endif
5304 continue;
5305 }
5306 if (fam0L_drive)
5307 {
5308 i=maxtim_data;
5309 for (timeout=jiffies+9*HZ; time_before(jiffies, timeout); timeout--)
5310 {
5311 for ( ;i!=0;i--)
5312 {
5313 j=inb(CDi_status);
5314 if (!(j&s_not_data_ready)) break;
5315 if (!(j&s_not_result_ready)) break;
5316 if (j&s_attention) break;
5317 }
5318 if (i != 0 || time_after_eq(jiffies, timeout)) break;
5319 sbp_sleep(0);
5320 i = 1;
5321 }
5322 if (i==0) msg(DBG_AUD,"read_audio: STATUS TIMEOUT AFTER READ");
5323 if (!(j&s_attention))
5324 {
5325 msg(DBG_AUD,"read_audio: sbp_data: timeout waiting DRV_ATTN - retrying\n");
5326 i=cc_DriveReset(); /* ugly fix to prevent a hang */
5327 continue;
5328 }
5329 }
5330 do
5331 {
5332 if (fam0L_drive) cc_ReadStatus();
5333 i=ResponseStatus(); /* builds status_bits, returns orig. status (old) or faked p_success (new) */
5334 if (i<0) { msg(DBG_AUD,
5335 "read_audio: cc_ReadStatus error after read: %02X\n",
5336 current_drive->status_bits);
5337 continue; /* FIXME */
5338 }
5339 }
5340 while ((fam0L_drive)&&(!st_check)&&(!(i&p_success)));
5341 if (st_check)
5342 {
5343 i=cc_ReadError();
5344 msg(DBG_AUD,"read_audio: cc_ReadError was necessary after read: %02X\n",i);
5345 continue;
5346 }
5347 if (copy_to_user(read_audio.buf,
5348 current_drive->aud_buf,
5349 read_audio.nframes * CD_FRAMESIZE_RAW))
5350 RETURN_UP(-EFAULT);
5351 msg(DBG_AUD,"read_audio: copy_to_user done.\n");
5352 break;
5353 }
5354 cc_ModeSelect(CD_FRAMESIZE);
5355 cc_ModeSense();
5356 current_drive->mode=READ_M1;
5357#if OLD_BUSY
5358 busy_audio=0;
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005359#endif /* OLD_BUSY */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005360 if (data_tries == 0)
5361 {
5362 msg(DBG_AUD,"read_audio: failed after 5 tries in line %d.\n", __LINE__);
5363 RETURN_UP(-EIO);
5364 }
5365 msg(DBG_AUD,"read_audio: successful return.\n");
5366 RETURN_UP(0);
5367 } /* end of CDROMREADAUDIO */
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005368
Linus Torvalds1da177e2005-04-16 15:20:36 -07005369 default:
5370 msg(DBG_IOC,"ioctl: unknown function request %04X\n", cmd);
5371 RETURN_UP(-EINVAL);
5372 } /* end switch(cmd) */
5373}
5374
Linus Torvalds1da177e2005-04-16 15:20:36 -07005375static int sbpcd_block_media_changed(struct gendisk *disk)
5376{
5377 struct sbpcd_drive *p = disk->private_data;
5378 return cdrom_media_changed(p->sbpcd_infop);
5379}
5380
5381static struct block_device_operations sbpcd_bdops =
5382{
5383 .owner = THIS_MODULE,
5384 .open = sbpcd_block_open,
5385 .release = sbpcd_block_release,
5386 .ioctl = sbpcd_block_ioctl,
5387 .media_changed = sbpcd_block_media_changed,
5388};
5389/*==========================================================================*/
5390/*
5391 * Open the device special file. Check that a disk is in. Read TOC.
5392 */
5393static int sbpcd_open(struct cdrom_device_info *cdi, int purpose)
5394{
5395 struct sbpcd_drive *p = cdi->handle;
5396
5397 down(&ioctl_read_sem);
5398 switch_drive(p);
5399
5400 /*
5401 * try to keep an "open" counter here and lock the door if 0->1.
5402 */
5403 msg(DBG_LCK,"open_count: %d -> %d\n",
5404 current_drive->open_count,current_drive->open_count+1);
5405 if (++current_drive->open_count<=1)
5406 {
5407 int i;
5408 i=LockDoor();
5409 current_drive->open_count=1;
5410 if (famT_drive) msg(DBG_TEA,"sbpcd_open: before i=DiskInfo();.\n");
5411 i=DiskInfo();
5412 if (famT_drive) msg(DBG_TEA,"sbpcd_open: after i=DiskInfo();.\n");
5413 if ((current_drive->ored_ctl_adr&0x40)==0)
5414 {
5415 msg(DBG_INF,"CD contains no data tracks.\n");
5416#ifdef SAFE_MIXED
5417 current_drive->has_data=0;
5418#endif /* SAFE_MIXED */
5419 }
5420#ifdef SAFE_MIXED
5421 else if (current_drive->has_data<1) current_drive->has_data=1;
5422#endif /* SAFE_MIXED */
5423 }
5424 if (!st_spinning) cc_SpinUp();
5425 RETURN_UP(0);
5426}
5427/*==========================================================================*/
5428/*
5429 * On close, we flush all sbp blocks from the buffer cache.
5430 */
5431static void sbpcd_release(struct cdrom_device_info * cdi)
5432{
5433 struct sbpcd_drive *p = cdi->handle;
5434
5435 if (p->drv_id==-1) {
5436 msg(DBG_INF, "release: bad device: %s\n", cdi->name);
5437 return;
5438 }
5439 down(&ioctl_read_sem);
5440 switch_drive(p);
5441 /*
5442 * try to keep an "open" counter here and unlock the door if 1->0.
5443 */
5444 msg(DBG_LCK,"open_count: %d -> %d\n",
5445 p->open_count,p->open_count-1);
5446 if (p->open_count>-2) /* CDROMEJECT may have been done */
5447 {
5448 if (--p->open_count<=0)
5449 {
5450 p->sbp_first_frame=p->sbp_last_frame=-1;
5451 if (p->audio_state!=audio_playing)
5452 if (p->f_eject) cc_SpinDown();
5453 p->diskstate_flags &= ~cd_size_bit;
5454 p->open_count=0;
5455#ifdef SAFE_MIXED
5456 p->has_data=0;
5457#endif /* SAFE_MIXED */
5458 }
5459 }
5460 up(&ioctl_read_sem);
5461 return ;
5462}
5463/*==========================================================================*/
5464/*
5465 *
5466 */
5467static int sbpcd_media_changed( struct cdrom_device_info *cdi, int disc_nr);
5468static struct cdrom_device_ops sbpcd_dops = {
5469 .open = sbpcd_open,
5470 .release = sbpcd_release,
5471 .drive_status = sbpcd_drive_status,
5472 .media_changed = sbpcd_media_changed,
5473 .tray_move = sbpcd_tray_move,
5474 .lock_door = sbpcd_lock_door,
5475 .select_speed = sbpcd_select_speed,
5476 .get_last_session = sbpcd_get_last_session,
5477 .get_mcn = sbpcd_get_mcn,
5478 .reset = sbpcd_reset,
5479 .audio_ioctl = sbpcd_audio_ioctl,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005480 .capability = CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK |
5481 CDC_MULTI_SESSION | CDC_MEDIA_CHANGED |
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08005482 CDC_MCN | CDC_PLAY_AUDIO,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005483 .n_minors = 1,
5484};
5485
5486/*==========================================================================*/
5487/*
5488 * accept "kernel command line" parameters
5489 * (suggested by Peter MacDonald with SLS 1.03)
5490 *
5491 * This is only implemented for the first controller. Should be enough to
5492 * allow installing with a "strange" distribution kernel.
5493 *
5494 * use: tell LILO:
5495 * sbpcd=0x230,SoundBlaster
5496 * or
5497 * sbpcd=0x300,LaserMate
5498 * or
5499 * sbpcd=0x338,SoundScape
5500 * or
5501 * sbpcd=0x2C0,Teac16bit
5502 *
5503 * (upper/lower case sensitive here - but all-lowercase is ok!!!).
5504 *
5505 * the address value has to be the CDROM PORT ADDRESS -
5506 * not the soundcard base address.
5507 * For the SPEA/SoundScape setup, DO NOT specify the "configuration port"
5508 * address, but the address which is really used for the CDROM (usually 8
5509 * bytes above).
5510 *
5511 */
5512
5513int sbpcd_setup(char *s)
5514{
5515#ifndef MODULE
5516 int p[4];
5517 (void)get_options(s, ARRAY_SIZE(p), p);
5518 setup_done++;
5519 msg(DBG_INI,"sbpcd_setup called with %04X,%s\n",p[1], s);
5520 sbpro_type=0; /* default: "LaserMate" */
5521 if (p[0]>1) sbpro_type=p[2];
5522 else if (!strcmp(s,str_sb)) sbpro_type=1;
5523 else if (!strcmp(s,str_sb_l)) sbpro_type=1;
5524 else if (!strcmp(s,str_sp)) sbpro_type=2;
5525 else if (!strcmp(s,str_sp_l)) sbpro_type=2;
5526 else if (!strcmp(s,str_ss)) sbpro_type=2;
5527 else if (!strcmp(s,str_ss_l)) sbpro_type=2;
5528 else if (!strcmp(s,str_t16)) sbpro_type=3;
5529 else if (!strcmp(s,str_t16_l)) sbpro_type=3;
5530 if (p[0]>0) sbpcd_ioaddr=p[1];
5531 if (p[0]>2) max_drives=p[3];
5532#else
5533 sbpcd_ioaddr = sbpcd[0];
5534 sbpro_type = sbpcd[1];
5535#endif
5536
5537 CDo_command=sbpcd_ioaddr;
5538 CDi_info=sbpcd_ioaddr;
5539 CDi_status=sbpcd_ioaddr+1;
5540 CDo_sel_i_d=sbpcd_ioaddr+1;
5541 CDo_reset=sbpcd_ioaddr+2;
5542 CDo_enable=sbpcd_ioaddr+3;
5543 f_16bit=0;
5544 if ((sbpro_type==1)||(sbpro_type==3))
5545 {
5546 CDi_data=sbpcd_ioaddr;
5547 if (sbpro_type==3)
5548 {
5549 f_16bit=1;
5550 sbpro_type=1;
5551 }
5552 }
5553 else CDi_data=sbpcd_ioaddr+2;
5554
5555 return 1;
5556}
5557
5558__setup("sbpcd=", sbpcd_setup);
5559
5560
5561/*==========================================================================*/
5562/*
5563 * Sequoia S-1000 CD-ROM Interface Configuration
5564 * as used within SPEA Media FX, Ensonic SoundScape and some Reveal cards
5565 * The soundcard has to get jumpered for the interface type "Panasonic"
5566 * (not Sony or Mitsumi) and to get soft-configured for
5567 * -> configuration port address
5568 * -> CDROM port offset (num_ports): has to be 8 here. Possibly this
5569 * offset value determines the interface type (none, Panasonic,
5570 * Mitsumi, Sony).
5571 * The interface uses a configuration port (0x320, 0x330, 0x340, 0x350)
5572 * some bytes below the real CDROM address.
5573 *
5574 * For the Panasonic style (LaserMate) interface and the configuration
5575 * port 0x330, we have to use an offset of 8; so, the real CDROM port
5576 * address is 0x338.
5577 */
5578static int __init config_spea(void)
5579{
5580 /*
5581 * base address offset between configuration port and CDROM port,
5582 * this probably defines the interface type
5583 * 2 (type=??): 0x00
5584 * 8 (type=LaserMate):0x10
5585 * 16 (type=??):0x20
5586 * 32 (type=??):0x30
5587 */
5588 int n_ports=0x10;
5589
5590 int irq_number=0; /* off:0x00, 2/9:0x01, 7:0x03, 12:0x05, 15:0x07 */
5591 int dma_channel=0; /* off: 0x00, 0:0x08, 1:0x18, 3:0x38, 5:0x58, 6:0x68 */
5592 int dack_polarity=0; /* L:0x00, H:0x80 */
5593 int drq_polarity=0x40; /* L:0x00, H:0x40 */
5594 int i;
5595
5596#define SPEA_REG_1 sbpcd_ioaddr-0x08+4
5597#define SPEA_REG_2 sbpcd_ioaddr-0x08+5
5598
5599 OUT(SPEA_REG_1,0xFF);
5600 i=inb(SPEA_REG_1);
5601 if (i!=0x0F)
5602 {
5603 msg(DBG_SEQ,"no SPEA interface at %04X present.\n", sbpcd_ioaddr);
5604 return (-1); /* no interface found */
5605 }
5606 OUT(SPEA_REG_1,0x04);
5607 OUT(SPEA_REG_2,0xC0);
5608
5609 OUT(SPEA_REG_1,0x05);
5610 OUT(SPEA_REG_2,0x10|drq_polarity|dack_polarity);
5611
5612#if 1
5613#define SPEA_PATTERN 0x80
5614#else
5615#define SPEA_PATTERN 0x00
5616#endif
5617 OUT(SPEA_REG_1,0x06);
5618 OUT(SPEA_REG_2,dma_channel|irq_number|SPEA_PATTERN);
5619 OUT(SPEA_REG_2,dma_channel|irq_number|SPEA_PATTERN);
5620
5621 OUT(SPEA_REG_1,0x09);
5622 i=(inb(SPEA_REG_2)&0xCF)|n_ports;
5623 OUT(SPEA_REG_2,i);
5624
5625 sbpro_type = 0; /* acts like a LaserMate interface now */
5626 msg(DBG_SEQ,"found SoundScape interface at %04X.\n", sbpcd_ioaddr);
5627 return (0);
5628}
5629
5630/*==========================================================================*/
5631/*
5632 * Test for presence of drive and initialize it.
5633 * Called once at boot or load time.
5634 */
5635
5636/* FIXME: cleanups after failed allocations are too ugly for words */
5637#ifdef MODULE
5638int __init __sbpcd_init(void)
5639#else
5640int __init sbpcd_init(void)
5641#endif
5642{
5643 int i=0, j=0;
5644 int addr[2]={1, CDROM_PORT};
5645 int port_index;
5646
5647 sti();
5648
5649 msg(DBG_INF,"sbpcd.c %s\n", VERSION);
5650#ifndef MODULE
5651#if DISTRIBUTION
5652 if (!setup_done)
5653 {
5654 msg(DBG_INF,"Looking for Matsushita/Panasonic, CreativeLabs, Longshine, TEAC CD-ROM drives\n");
5655 msg(DBG_INF,"= = = = = = = = = = W A R N I N G = = = = = = = = = =\n");
5656 msg(DBG_INF,"Auto-Probing can cause a hang (f.e. touching an NE2000 card).\n");
5657 msg(DBG_INF,"If that happens, you have to reboot and use the\n");
5658 msg(DBG_INF,"LILO (kernel) command line feature like:\n");
5659 msg(DBG_INF," LILO boot: ... sbpcd=0x230,SoundBlaster\n");
5660 msg(DBG_INF,"or like:\n");
5661 msg(DBG_INF," LILO boot: ... sbpcd=0x300,LaserMate\n");
5662 msg(DBG_INF,"or like:\n");
5663 msg(DBG_INF," LILO boot: ... sbpcd=0x338,SoundScape\n");
5664 msg(DBG_INF,"with your REAL address.\n");
5665 msg(DBG_INF,"= = = = = = = = = = END of WARNING = = = = = == = = =\n");
5666 }
5667#endif /* DISTRIBUTION */
5668 sbpcd[0]=sbpcd_ioaddr; /* possibly changed by kernel command line */
5669 sbpcd[1]=sbpro_type; /* possibly changed by kernel command line */
5670#endif /* MODULE */
5671
5672 for (port_index=0;port_index<NUM_PROBE;port_index+=2)
5673 {
5674 addr[1]=sbpcd[port_index];
5675 if (addr[1]==0) break;
5676 if (check_region(addr[1],4))
5677 {
5678 msg(DBG_INF,"check_region: %03X is not free.\n",addr[1]);
5679 continue;
5680 }
5681 if (sbpcd[port_index+1]==2) type=str_sp;
5682 else if (sbpcd[port_index+1]==1) type=str_sb;
5683 else if (sbpcd[port_index+1]==3) type=str_t16;
5684 else type=str_lm;
5685 sbpcd_setup((char *)type);
5686#if DISTRIBUTION
5687 msg(DBG_INF,"Scanning 0x%X (%s)...\n", CDo_command, type);
5688#endif /* DISTRIBUTION */
5689 if (sbpcd[port_index+1]==2)
5690 {
5691 i=config_spea();
5692 if (i<0) continue;
5693 }
5694#ifdef PATH_CHECK
5695 if (check_card(addr[1])) continue;
5696#endif /* PATH_CHECK */
5697 i=check_drives();
5698 msg(DBG_INI,"check_drives done.\n");
5699 if (i>=0) break; /* drive found */
5700 } /* end of cycling through the set of possible I/O port addresses */
5701
5702 if (ndrives==0)
5703 {
5704 msg(DBG_INF, "No drive found.\n");
5705#ifdef MODULE
5706 return -EIO;
5707#else
5708 goto init_done;
5709#endif /* MODULE */
5710 }
5711
5712 if (port_index>0)
5713 {
5714 msg(DBG_INF, "You should read Documentation/cdrom/sbpcd\n");
5715 msg(DBG_INF, "and then configure sbpcd.h for your hardware.\n");
5716 }
5717 check_datarate();
5718 msg(DBG_INI,"check_datarate done.\n");
5719
5720 for (j=0;j<NR_SBPCD;j++)
5721 {
5722 struct sbpcd_drive *p = D_S + j;
5723 if (p->drv_id==-1)
5724 continue;
5725 switch_drive(p);
5726#if 1
5727 if (!famL_drive) cc_DriveReset();
5728#endif
5729 if (!st_spinning) cc_SpinUp();
5730 p->sbp_first_frame = -1; /* First frame in buffer */
5731 p->sbp_last_frame = -1; /* Last frame in buffer */
5732 p->sbp_read_frames = 0; /* Number of frames being read to buffer */
5733 p->sbp_current = 0; /* Frame being currently read */
5734 p->CD_changed=1;
5735 p->frame_size=CD_FRAMESIZE;
5736 p->f_eject=0;
5737#if EJECT
5738 if (!fam0_drive) p->f_eject=1;
5739#endif /* EJECT */
5740 cc_ReadStatus();
5741 i=ResponseStatus(); /* returns orig. status or p_busy_new */
5742 if (famT_drive) i=ResponseStatus(); /* returns orig. status or p_busy_new */
5743 if (i<0)
5744 {
5745 if (i!=-402)
5746 msg(DBG_INF,"init: ResponseStatus returns %d.\n",i);
5747 }
5748 else
5749 {
5750 if (st_check)
5751 {
5752 i=cc_ReadError();
5753 msg(DBG_INI,"init: cc_ReadError returns %d\n",i);
5754 }
5755 }
5756 msg(DBG_INI,"init: first GetStatus: %d\n",i);
5757 msg(DBG_LCS,"init: first GetStatus: error_byte=%d\n",
5758 p->error_byte);
5759 if (p->error_byte==aud_12)
5760 {
5761 timeout=jiffies+2*HZ;
5762 do
5763 {
5764 i=GetStatus();
5765 msg(DBG_INI,"init: second GetStatus: %02X\n",i);
5766 msg(DBG_LCS,
5767 "init: second GetStatus: error_byte=%d\n",
5768 p->error_byte);
5769 if (i<0) break;
5770 if (!st_caddy_in) break;
5771 }
5772 while ((!st_diskok)||time_after(jiffies, timeout));
5773 }
5774 i=SetSpeed();
5775 if (i>=0) p->CD_changed=1;
5776 }
5777
5778 if (!request_region(CDo_command,4,major_name))
5779 {
5780 printk(KERN_WARNING "sbpcd: Unable to request region 0x%x\n", CDo_command);
5781 return -EIO;
5782 }
5783
5784 /*
5785 * Turn on the CD audio channels.
5786 * The addresses are obtained from SOUND_BASE (see sbpcd.h).
5787 */
5788#if SOUND_BASE
5789 OUT(MIXER_addr,MIXER_CD_Volume); /* select SB Pro mixer register */
5790 OUT(MIXER_data,0xCC); /* one nibble per channel, max. value: 0xFF */
5791#endif /* SOUND_BASE */
5792
5793 if (register_blkdev(MAJOR_NR, major_name)) {
5794#ifdef MODULE
5795 return -EIO;
5796#else
5797 goto init_done;
5798#endif /* MODULE */
5799 }
5800
5801 /*
5802 * init error handling is broken beyond belief in this driver...
5803 */
5804 sbpcd_queue = blk_init_queue(do_sbpcd_request, &sbpcd_lock);
5805 if (!sbpcd_queue) {
5806 release_region(CDo_command,4);
5807 unregister_blkdev(MAJOR_NR, major_name);
5808 return -ENOMEM;
5809 }
5810
5811 devfs_mk_dir("sbp");
5812
5813 for (j=0;j<NR_SBPCD;j++)
5814 {
5815 struct cdrom_device_info * sbpcd_infop;
5816 struct gendisk *disk;
5817 struct sbpcd_drive *p = D_S + j;
5818
5819 if (p->drv_id==-1) continue;
5820 switch_drive(p);
5821#ifdef SAFE_MIXED
5822 p->has_data=0;
5823#endif /* SAFE_MIXED */
5824 /*
5825 * allocate memory for the frame buffers
5826 */
5827 p->aud_buf=NULL;
5828 p->sbp_audsiz=0;
5829 p->sbp_bufsiz=buffers;
5830 if (p->drv_type&drv_fam1)
5831 if (READ_AUDIO>0)
5832 p->sbp_audsiz = READ_AUDIO;
5833 p->sbp_buf=(u_char *) vmalloc(buffers*CD_FRAMESIZE);
5834 if (!p->sbp_buf) {
5835 msg(DBG_INF,"data buffer (%d frames) not available.\n",
5836 buffers);
5837 if ((unregister_blkdev(MAJOR_NR, major_name) == -EINVAL))
5838 {
5839 printk("Can't unregister %s\n", major_name);
5840 }
5841 release_region(CDo_command,4);
5842 blk_cleanup_queue(sbpcd_queue);
5843 return -EIO;
5844 }
5845#ifdef MODULE
5846 msg(DBG_INF,"data buffer size: %d frames.\n",buffers);
5847#endif /* MODULE */
5848 if (p->sbp_audsiz>0)
5849 {
5850 p->aud_buf=(u_char *) vmalloc(p->sbp_audsiz*CD_FRAMESIZE_RAW);
5851 if (p->aud_buf==NULL) msg(DBG_INF,"audio buffer (%d frames) not available.\n",p->sbp_audsiz);
5852 else msg(DBG_INF,"audio buffer size: %d frames.\n",p->sbp_audsiz);
5853 }
5854 sbpcd_infop = vmalloc(sizeof (struct cdrom_device_info));
5855 if (sbpcd_infop == NULL)
5856 {
5857 release_region(CDo_command,4);
5858 blk_cleanup_queue(sbpcd_queue);
5859 return -ENOMEM;
5860 }
5861 memset(sbpcd_infop, 0, sizeof(struct cdrom_device_info));
5862 sbpcd_infop->ops = &sbpcd_dops;
5863 sbpcd_infop->speed = 2;
5864 sbpcd_infop->capacity = 1;
5865 sprintf(sbpcd_infop->name, "sbpcd%d", j);
5866 sbpcd_infop->handle = p;
5867 p->sbpcd_infop = sbpcd_infop;
5868 disk = alloc_disk(1);
5869 disk->major = MAJOR_NR;
5870 disk->first_minor = j;
5871 disk->fops = &sbpcd_bdops;
5872 strcpy(disk->disk_name, sbpcd_infop->name);
5873 disk->flags = GENHD_FL_CD;
5874 sprintf(disk->devfs_name, "sbp/c0t%d", p->drv_id);
5875 p->disk = disk;
5876 if (register_cdrom(sbpcd_infop))
5877 {
5878 printk(" sbpcd: Unable to register with Uniform CD-ROm driver\n");
5879 }
5880 disk->private_data = p;
5881 disk->queue = sbpcd_queue;
5882 add_disk(disk);
5883 }
5884 blk_queue_hardsect_size(sbpcd_queue, CD_FRAMESIZE);
5885
5886#ifndef MODULE
5887 init_done:
5888#endif
5889 return 0;
5890}
5891/*==========================================================================*/
5892#ifdef MODULE
Adrian Bunk75c96f82005-05-05 16:16:09 -07005893static void sbpcd_exit(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005894{
5895 int j;
5896
5897 if ((unregister_blkdev(MAJOR_NR, major_name) == -EINVAL))
5898 {
5899 msg(DBG_INF, "What's that: can't unregister %s.\n", major_name);
5900 return;
5901 }
5902 release_region(CDo_command,4);
5903 blk_cleanup_queue(sbpcd_queue);
5904 for (j=0;j<NR_SBPCD;j++)
5905 {
5906 if (D_S[j].drv_id==-1) continue;
5907 del_gendisk(D_S[j].disk);
5908 put_disk(D_S[j].disk);
5909 devfs_remove("sbp/c0t%d", j);
5910 vfree(D_S[j].sbp_buf);
Jesper Juhlf91012102005-09-10 00:26:54 -07005911 if (D_S[j].sbp_audsiz>0)
5912 vfree(D_S[j].aud_buf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005913 if ((unregister_cdrom(D_S[j].sbpcd_infop) == -EINVAL))
5914 {
5915 msg(DBG_INF, "What's that: can't unregister info %s.\n", major_name);
5916 return;
5917 }
5918 vfree(D_S[j].sbpcd_infop);
5919 }
5920 devfs_remove("sbp");
5921 msg(DBG_INF, "%s module released.\n", major_name);
5922}
5923
5924
5925module_init(__sbpcd_init) /*HACK!*/;
5926module_exit(sbpcd_exit);
5927
5928
5929#endif /* MODULE */
5930static int sbpcd_media_changed(struct cdrom_device_info *cdi, int disc_nr)
5931{
5932 struct sbpcd_drive *p = cdi->handle;
5933 msg(DBG_CHK,"media_check (%s) called\n", cdi->name);
5934
5935 if (p->CD_changed==0xFF)
5936 {
5937 p->CD_changed=0;
5938 msg(DBG_CHK,"medium changed (drive %s)\n", cdi->name);
5939 current_drive->diskstate_flags &= ~toc_bit;
5940 /* we *don't* need invalidate here, it's done by caller */
5941 current_drive->diskstate_flags &= ~cd_size_bit;
5942#ifdef SAFE_MIXED
5943 current_drive->has_data=0;
5944#endif /* SAFE_MIXED */
5945
5946 return (1);
5947 }
5948 else
5949 return (0);
5950}
5951
5952MODULE_LICENSE("GPL");
5953/* FIXME: Old modules.conf claims MATSUSHITA_CDROM2_MAJOR and CDROM3, but
5954 AFAICT this doesn't support those majors, so why? --RR 30 Jul 2003 */
5955MODULE_ALIAS_BLOCKDEV_MAJOR(MATSUSHITA_CDROM_MAJOR);
5956
5957/*==========================================================================*/
5958/*
5959 * Overrides for Emacs so that we follow Linus's tabbing style.
5960 * Emacs will notice this stuff at the end of the file and automatically
5961 * adjust the settings for this buffer only. This must remain at the end
5962 * of the file.
5963 * ---------------------------------------------------------------------------
5964 * Local variables:
5965 * c-indent-level: 8
5966 * c-brace-imaginary-offset: 0
5967 * c-brace-offset: -8
5968 * c-argdecl-indent: 8
5969 * c-label-offset: -8
5970 * c-continued-statement-offset: 8
5971 * c-continued-brace-offset: 0
5972 * End:
5973 */
5974