Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 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 | */ |
| 417 | static 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 | */ |
| 464 | static __cacheline_aligned DEFINE_SPINLOCK(sbpcd_lock); |
| 465 | static struct request_queue *sbpcd_queue; |
| 466 | |
Rusty Russell | 8d3b33f | 2006-03-25 03:07:05 -0800 | [diff] [blame] | 467 | /* You can only set the first pair, from old MODULE_PARM code. */ |
| 468 | static int sbpcd_set(const char *val, struct kernel_param *kp) |
| 469 | { |
| 470 | get_options((char *)val, 2, (int *)sbpcd); |
| 471 | return 0; |
| 472 | } |
| 473 | module_param_call(sbpcd, sbpcd_set, NULL, NULL, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 474 | |
| 475 | #define NUM_PROBE (sizeof(sbpcd) / sizeof(int)) |
| 476 | |
| 477 | /*==========================================================================*/ |
| 478 | |
| 479 | #define INLINE inline |
| 480 | |
| 481 | /*==========================================================================*/ |
| 482 | /* |
| 483 | * the forward references: |
| 484 | */ |
| 485 | static void sbp_sleep(u_int); |
| 486 | static void mark_timeout_delay(u_long); |
| 487 | static void mark_timeout_data(u_long); |
| 488 | #if 0 |
| 489 | static void mark_timeout_audio(u_long); |
| 490 | #endif |
| 491 | static void sbp_read_cmd(struct request *req); |
| 492 | static int sbp_data(struct request *req); |
| 493 | static int cmd_out(void); |
| 494 | static 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 |
| 534 | static int sbpcd_debug = (1<<DBG_INF); |
| 535 | #else |
| 536 | static int sbpcd_debug = 0 & ((1<<DBG_INF) | |
| 537 | (1<<DBG_TOC) | |
| 538 | (1<<DBG_MUL) | |
| 539 | (1<<DBG_UPC)); |
| 540 | #endif /* DISTRIBUTION */ |
| 541 | |
| 542 | static int sbpcd_ioaddr = CDROM_PORT; /* default I/O base address */ |
| 543 | static int sbpro_type = SBPRO; |
| 544 | static unsigned char f_16bit; |
| 545 | static unsigned char do_16bit; |
| 546 | static int CDo_command, CDo_reset; |
| 547 | static int CDo_sel_i_d, CDo_enable; |
| 548 | static int CDi_info, CDi_status, CDi_data; |
| 549 | static struct cdrom_msf msf; |
| 550 | static struct cdrom_ti ti; |
| 551 | static struct cdrom_tochdr tochdr; |
| 552 | static struct cdrom_tocentry tocentry; |
| 553 | static struct cdrom_subchnl SC; |
| 554 | static struct cdrom_volctrl volctrl; |
| 555 | static struct cdrom_read_audio read_audio; |
| 556 | |
| 557 | static unsigned char msgnum; |
| 558 | static char msgbuf[80]; |
| 559 | |
| 560 | static int max_drives = MAX_DRIVES; |
Rusty Russell | 8d3b33f | 2006-03-25 03:07:05 -0800 | [diff] [blame] | 561 | module_param(max_drives, int, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 562 | #ifndef MODULE |
| 563 | static unsigned char setup_done; |
| 564 | static const char *str_sb_l = "soundblaster"; |
| 565 | static const char *str_sp_l = "spea"; |
| 566 | static const char *str_ss_l = "soundscape"; |
| 567 | static const char *str_t16_l = "teac16bit"; |
| 568 | static const char *str_ss = "SoundScape"; |
| 569 | #endif |
| 570 | static const char *str_sb = "SoundBlaster"; |
| 571 | static const char *str_lm = "LaserMate"; |
| 572 | static const char *str_sp = "SPEA"; |
| 573 | static const char *str_t16 = "Teac16bit"; |
| 574 | static const char *type; |
| 575 | static const char *major_name="sbpcd"; |
| 576 | |
| 577 | /*==========================================================================*/ |
| 578 | |
| 579 | #ifdef FUTURE |
| 580 | static DECLARE_WAIT_QUEUE_HEAD(sbp_waitq); |
| 581 | #endif /* FUTURE */ |
| 582 | |
| 583 | static int teac=SBP_TEAC_SPEED; |
| 584 | static int buffers=SBP_BUFFER_FRAMES; |
| 585 | |
| 586 | static u_char family0[]="MATSHITA"; /* MKE CR-521, CR-522, CR-523 */ |
| 587 | static u_char family1[]="CR-56"; /* MKE CR-562, CR-563 */ |
| 588 | static u_char family2[]="CD200"; /* MKE CD200, Funai CD200F */ |
| 589 | static u_char familyL[]="LCS-7260"; /* Longshine LCS-7260 */ |
| 590 | static u_char familyT[]="CD-55"; /* TEAC CD-55A */ |
| 591 | static u_char familyV[]="ECS-AT"; /* ECS Vertos 100 */ |
| 592 | |
| 593 | static u_int recursion; /* internal testing only */ |
| 594 | static u_int fatal_err; /* internal testing only */ |
| 595 | static u_int response_count; |
| 596 | static u_int flags_cmd_out; |
| 597 | static u_char cmd_type; |
| 598 | static u_char drvcmd[10]; |
| 599 | static u_char infobuf[20]; |
| 600 | static u_char xa_head_buf[CD_XA_HEAD]; |
| 601 | static u_char xa_tail_buf[CD_XA_TAIL]; |
| 602 | |
| 603 | #if OLD_BUSY |
| 604 | static volatile u_char busy_data; |
| 605 | static volatile u_char busy_audio; /* true semaphores would be safer */ |
| 606 | #endif /* OLD_BUSY */ |
| 607 | static DECLARE_MUTEX(ioctl_read_sem); |
| 608 | static u_long timeout; |
| 609 | static volatile u_char timed_out_delay; |
| 610 | static volatile u_char timed_out_data; |
| 611 | #if 0 |
| 612 | static volatile u_char timed_out_audio; |
| 613 | #endif |
| 614 | static u_int datarate= 1000000; |
| 615 | static u_int maxtim16=16000000; |
| 616 | static u_int maxtim04= 4000000; |
| 617 | static u_int maxtim02= 2000000; |
| 618 | static u_int maxtim_8= 30000; |
| 619 | #if LONG_TIMING |
| 620 | static u_int maxtim_data= 9000; |
| 621 | #else |
| 622 | static u_int maxtim_data= 3000; |
| 623 | #endif /* LONG_TIMING */ |
| 624 | #if DISTRIBUTION |
| 625 | static int n_retries=6; |
| 626 | #else |
| 627 | static int n_retries=6; |
| 628 | #endif |
| 629 | /*==========================================================================*/ |
| 630 | |
| 631 | static int ndrives; |
| 632 | static 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 | */ |
| 638 | static 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 | |
| 741 | static struct sbpcd_drive *current_drive = D_S; |
| 742 | |
| 743 | /* |
| 744 | * drive space ends here (needed separate for each unit) |
| 745 | */ |
| 746 | /*==========================================================================*/ |
| 747 | #if 0 |
| 748 | unsigned long cli_sti; /* for saving the processor flags */ |
| 749 | #endif |
| 750 | /*==========================================================================*/ |
Ingo Molnar | 8d06afa | 2005-09-09 13:10:40 -0700 | [diff] [blame] | 751 | static DEFINE_TIMER(delay_timer, mark_timeout_delay, 0, 0); |
| 752 | static DEFINE_TIMER(data_timer, mark_timeout_data, 0, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 753 | #if 0 |
Ingo Molnar | 8d06afa | 2005-09-09 13:10:40 -0700 | [diff] [blame] | 754 | static DEFINE_TIMER(audio_timer, mark_timeout_audio, 0, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 755 | #endif |
| 756 | /*==========================================================================*/ |
| 757 | /* |
| 758 | * DDI interface |
| 759 | */ |
| 760 | static 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 | */ |
| 789 | static 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 | /*==========================================================================*/ |
| 804 | static 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 | /*==========================================================================*/ |
| 812 | static 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 |
| 821 | static 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 | */ |
| 833 | static void sbp_sleep(u_int time) |
| 834 | { |
| 835 | sti(); |
Nishanth Aravamudan | 2ddee1b7 | 2005-09-10 00:27:29 -0700 | [diff] [blame] | 836 | schedule_timeout_interruptible(time); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 | 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 | */ |
| 845 | static 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 | */ |
| 858 | static INLINE void bin2bcdx(u_char *p) /* must work only up to 75 or 99 */ |
| 859 | { |
| 860 | *p=((*p/10)<<4)|(*p%10); |
| 861 | } |
| 862 | /*==========================================================================*/ |
| 863 | static 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 | /*==========================================================================*/ |
| 876 | static INLINE u_int make16(u_char rh, u_char rl) |
| 877 | { |
| 878 | return ((rh<<8)|rl); |
| 879 | } |
| 880 | /*==========================================================================*/ |
| 881 | static INLINE u_int make32(u_int rh, u_int rl) |
| 882 | { |
| 883 | return ((rh<<16)|rl); |
| 884 | } |
| 885 | /*==========================================================================*/ |
| 886 | static INLINE u_char swap_nibbles(u_char i) |
| 887 | { |
| 888 | return ((i<<4)|(i>>4)); |
| 889 | } |
| 890 | /*==========================================================================*/ |
| 891 | static INLINE u_char byt2bcd(u_char i) |
| 892 | { |
| 893 | return (((i/10)<<4)+i%10); |
| 894 | } |
| 895 | /*==========================================================================*/ |
| 896 | static INLINE u_char bcd2bin(u_char bcd) |
| 897 | { |
| 898 | return ((bcd>>4)*10+(bcd&0x0F)); |
| 899 | } |
| 900 | /*==========================================================================*/ |
| 901 | static 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 | */ |
| 915 | static 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 */ |
| 925 | static 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 | /*==========================================================================*/ |
| 959 | static 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 | /*==========================================================================*/ |
| 967 | static 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 | */ |
| 989 | static 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 | /*==========================================================================*/ |
| 1026 | static 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 | /*==========================================================================*/ |
| 1048 | static 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 | /*==========================================================================*/ |
| 1057 | static 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 | /*==========================================================================*/ |
| 1066 | static 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 | /*==========================================================================*/ |
| 1077 | static 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 | /*==========================================================================*/ |
| 1115 | static 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 | /*==========================================================================*/ |
| 1166 | static int cmd_out_T(void); |
| 1167 | |
| 1168 | static 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 | /*==========================================================================*/ |
| 1213 | static 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 | /*==========================================================================*/ |
| 1250 | static 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 | /*==========================================================================*/ |
| 1264 | static 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 | /*==========================================================================*/ |
| 1313 | static int cc_DriveReset(void); |
| 1314 | |
| 1315 | static 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 | /*==========================================================================*/ |
| 1473 | static 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 | /*==========================================================================*/ |
| 1540 | static 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 | /*==========================================================================*/ |
| 1596 | static 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 | /*==========================================================================*/ |
| 1634 | static 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 | /*==========================================================================*/ |
| 1672 | static 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 | /*==========================================================================*/ |
| 1684 | static 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 | /*==========================================================================*/ |
| 1704 | static 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 | /*==========================================================================*/ |
| 1732 | static 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 | /*==========================================================================*/ |
| 1771 | static 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 | /*==========================================================================*/ |
| 1938 | static 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 | /*==========================================================================*/ |
| 1950 | static 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 | /*==========================================================================*/ |
| 1996 | static 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 | |
| 2011 | static void switch_drive(struct sbpcd_drive *); |
| 2012 | |
| 2013 | static 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 | /*==========================================================================*/ |
| 2023 | static 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 | |
| 2050 | static 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 | /*==========================================================================*/ |
| 2059 | static 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 | /*==========================================================================*/ |
| 2120 | static 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 | /*==========================================================================*/ |
| 2161 | static 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 | /*==========================================================================*/ |
| 2202 | static 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 | /*==========================================================================*/ |
| 2222 | static 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 | |
| 2249 | static int sbpcd_lock_door(struct cdrom_device_info *cdi, int lock) |
| 2250 | { |
| 2251 | return lock ? LockDoor() : UnLockDoor(); |
| 2252 | } |
| 2253 | |
| 2254 | /*==========================================================================*/ |
| 2255 | static 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 | |
| 2327 | static 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 | /*==========================================================================*/ |
| 2345 | static 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 | /*==========================================================================*/ |
| 2421 | static 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 | /*==========================================================================*/ |
| 2470 | static 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 | /*==========================================================================*/ |
| 2517 | static 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 | /*==========================================================================*/ |
| 2652 | static 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 | /*==========================================================================*/ |
| 2699 | static 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 | /*==========================================================================*/ |
| 2817 | static 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 | /*==========================================================================*/ |
| 2896 | static 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 | /*==========================================================================*/ |
| 2915 | static 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 | /*==========================================================================*/ |
| 2942 | static 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 | |
| 3042 | static 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 | /*==========================================================================*/ |
| 3115 | static 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 |
| 3183 | static 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 | /*==========================================================================*/ |
| 3211 | static 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 |
| 3259 | static 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 | /*==========================================================================*/ |
| 3281 | static 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 | /*==========================================================================*/ |
| 3300 | static 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 | /*==========================================================================*/ |
| 3586 | static 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 | */ |
| 3599 | static 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 | */ |
| 3703 | static 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 | */ |
| 3743 | static 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 | */ |
| 3785 | static 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 | /*==========================================================================*/ |
| 3808 | static 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 | /*==========================================================================*/ |
| 3826 | static 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 | /*==========================================================================*/ |
| 3860 | static 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 | /*==========================================================================*/ |
| 3871 | static 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 | /*==========================================================================*/ |
| 3917 | static 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 | |
| 3992 | static 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 | */ |
| 4038 | static 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 | */ |
| 4114 | static 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 | |
| 4156 | static 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 4169 | static int sbpcd_audio_ioctl(struct cdrom_device_info *cdi, u_int cmd, |
| 4170 | void * arg) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4171 | { |
| 4172 | struct sbpcd_drive *p = cdi->handle; |
Christoph Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 4173 | int i, st, j; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4174 | |
Christoph Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 4175 | 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 | */ |
| 4468 | static 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 | */ |
| 4516 | static 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 | */ |
| 4653 | static 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 | */ |
| 4760 | static 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 | |
| 5037 | static 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 | |
| 5043 | static 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 | |
| 5049 | static 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 Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5060 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5081 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5082 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5091 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5092 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5101 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5102 | case CDROMAUDIOBUFSIZ: /* configure the audio buffer size */ |
| 5103 | msg(DBG_IOC,"ioctl: CDROMAUDIOBUFSIZ entered.\n"); |
Jesper Juhl | f9101210 | 2005-09-10 00:26:54 -0700 | [diff] [blame] | 5104 | if (current_drive->sbp_audsiz>0) |
| 5105 | vfree(current_drive->aud_buf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5106 | current_drive->aud_buf=NULL; |
| 5107 | current_drive->sbp_audsiz=arg; |
Christoph Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5108 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5109 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5138 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5139 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5146 | #endif /* SAFE_MIXED */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5147 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5155 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5156 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5171 | #endif /* OLD_BUSY */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5172 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5193 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5194 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5359 | #endif /* OLD_BUSY */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5360 | 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 Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5368 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5369 | default: |
| 5370 | msg(DBG_IOC,"ioctl: unknown function request %04X\n", cmd); |
| 5371 | RETURN_UP(-EINVAL); |
| 5372 | } /* end switch(cmd) */ |
| 5373 | } |
| 5374 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5375 | static 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 | |
| 5381 | static 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 | */ |
| 5393 | static 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 | */ |
| 5431 | static 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 | */ |
| 5467 | static int sbpcd_media_changed( struct cdrom_device_info *cdi, int disc_nr); |
| 5468 | static 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 Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5480 | .capability = CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | |
| 5481 | CDC_MULTI_SESSION | CDC_MEDIA_CHANGED | |
Christoph Hellwig | 6a2900b | 2006-03-23 03:00:15 -0800 | [diff] [blame] | 5482 | CDC_MCN | CDC_PLAY_AUDIO, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5483 | .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 | |
| 5513 | int 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 | */ |
| 5578 | static 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 |
| 5638 | int __init __sbpcd_init(void) |
| 5639 | #else |
| 5640 | int __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 Bunk | 75c96f8 | 2005-05-05 16:16:09 -0700 | [diff] [blame] | 5893 | static void sbpcd_exit(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5894 | { |
| 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 Juhl | f9101210 | 2005-09-10 00:26:54 -0700 | [diff] [blame] | 5911 | if (D_S[j].sbp_audsiz>0) |
| 5912 | vfree(D_S[j].aud_buf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5913 | 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 | |
| 5925 | module_init(__sbpcd_init) /*HACK!*/; |
| 5926 | module_exit(sbpcd_exit); |
| 5927 | |
| 5928 | |
| 5929 | #endif /* MODULE */ |
| 5930 | static 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 | |
| 5952 | MODULE_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 */ |
| 5955 | MODULE_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 | |