[PATCH] remove redundant NULL checks before kfree() in sound/ and avoid casting point...
[linux-2.6] / sound / oss / maestro.c
1 /*****************************************************************************
2  *
3  *      ESS Maestro/Maestro-2/Maestro-2E driver for Linux 2.[23].x
4  *
5  *      This program is free software; you can redistribute it and/or modify
6  *      it under the terms of the GNU General Public License as published by
7  *      the Free Software Foundation; either version 2 of the License, or
8  *      (at your option) any later version.
9  *
10  *      This program is distributed in the hope that it will be useful,
11  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
12  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  *      GNU General Public License for more details.
14  *
15  *      You should have received a copy of the GNU General Public License
16  *      along with this program; if not, write to the Free Software
17  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
18  *
19  *      (c) Copyright 1999       Alan Cox <alan.cox@linux.org>
20  *
21  *      Based heavily on SonicVibes.c:
22  *      Copyright (C) 1998-1999  Thomas Sailer (sailer@ife.ee.ethz.ch)
23  *
24  *      Heavily modified by Zach Brown <zab@zabbo.net> based on lunch
25  *      with ESS engineers.  Many thanks to Howard Kim for providing 
26  *      contacts and hardware.  Honorable mention goes to Eric 
27  *      Brombaugh for all sorts of things.  Best regards to the 
28  *      proprietors of Hack Central for fine lodging.
29  *
30  *  Supported devices:
31  *  /dev/dsp0-3    standard /dev/dsp device, (mostly) OSS compatible
32  *  /dev/mixer  standard /dev/mixer device, (mostly) OSS compatible
33  *
34  *  Hardware Description
35  *
36  *      A working Maestro setup contains the Maestro chip wired to a 
37  *      codec or 2.  In the Maestro we have the APUs, the ASSP, and the
38  *      Wavecache.  The APUs can be though of as virtual audio routing
39  *      channels.  They can take data from a number of sources and perform
40  *      basic encodings of the data.  The wavecache is a storehouse for
41  *      PCM data.  Typically it deals with PCI and interracts with the
42  *      APUs.  The ASSP is a wacky DSP like device that ESS is loth
43  *      to release docs on.  Thankfully it isn't required on the Maestro
44  *      until you start doing insane things like FM emulation and surround
45  *      encoding.  The codecs are almost always AC-97 compliant codecs, 
46  *      but it appears that early Maestros may have had PT101 (an ESS
47  *      part?) wired to them.  The only real difference in the Maestro
48  *      families is external goop like docking capability, memory for
49  *      the ASSP, and initialization differences.
50  *
51  *  Driver Operation
52  *
53  *      We only drive the APU/Wavecache as typical DACs and drive the
54  *      mixers in the codecs.  There are 64 APUs.  We assign 6 to each
55  *      /dev/dsp? device.  2 channels for output, and 4 channels for
56  *      input.
57  *
58  *      Each APU can do a number of things, but we only really use
59  *      3 basic functions.  For playback we use them to convert PCM
60  *      data fetched over PCI by the wavecahche into analog data that
61  *      is handed to the codec.  One APU for mono, and a pair for stereo.
62  *      When in stereo, the combination of smarts in the APU and Wavecache
63  *      decide which wavecache gets the left or right channel.
64  *
65  *      For record we still use the old overly mono system.  For each in
66  *      coming channel the data comes in from the codec, through a 'input'
67  *      APU, through another rate converter APU, and then into memory via
68  *      the wavecache and PCI.  If its stereo, we mash it back into LRLR in
69  *      software.  The pass between the 2 APUs is supposedly what requires us
70  *      to have a 512 byte buffer sitting around in wavecache/memory.
71  *
72  *      The wavecache makes our life even more fun.  First off, it can
73  *      only address the first 28 bits of PCI address space, making it
74  *      useless on quite a few architectures.  Secondly, its insane.
75  *      It claims to fetch from 4 regions of PCI space, each 4 meg in length.
76  *      But that doesn't really work.  You can only use 1 region.  So all our
77  *      allocations have to be in 4meg of each other.  Booo.  Hiss.
78  *      So we have a module parameter, dsps_order, that is the order of
79  *      the number of dsps to provide.  All their buffer space is allocated
80  *      on open time.  The sonicvibes OSS routines we inherited really want
81  *      power of 2 buffers, so we have all those next to each other, then
82  *      512 byte regions for the recording wavecaches.  This ends up
83  *      wasting quite a bit of memory.  The only fixes I can see would be 
84  *      getting a kernel allocator that could work in zones, or figuring out
85  *      just how to coerce the WP into doing what we want.
86  *
87  *      The indirection of the various registers means we have to spinlock
88  *      nearly all register accesses.  We have the main register indirection
89  *      like the wave cache, maestro registers, etc.  Then we have beasts
90  *      like the APU interface that is indirect registers gotten at through
91  *      the main maestro indirection.  Ouch.  We spinlock around the actual
92  *      ports on a per card basis.  This means spinlock activity at each IO
93  *      operation, but the only IO operation clusters are in non critical 
94  *      paths and it makes the code far easier to follow.  Interrupts are
95  *      blocked while holding the locks because the int handler has to
96  *      get at some of them :(.  The mixer interface doesn't, however.
97  *      We also have an OSS state lock that is thrown around in a few
98  *      places.
99  *
100  *      This driver has brute force APM suspend support.  We catch suspend
101  *      notifications and stop all work being done on the chip.  Any people
102  *      that try between this shutdown and the real suspend operation will
103  *      be put to sleep.  When we resume we restore our software state on
104  *      the chip and wake up the people that were using it.  The code thats
105  *      being used now is quite dirty and assumes we're on a uni-processor
106  *      machine.  Much of it will need to be cleaned up for SMP ACPI or 
107  *      similar.
108  *
109  *      We also pay attention to PCI power management now.  The driver
110  *      will power down units of the chip that it knows aren't needed.
111  *      The WaveProcessor and company are only powered on when people
112  *      have /dev/dsp*s open.  On removal the driver will
113  *      power down the maestro entirely.  There could still be
114  *      trouble with BIOSen that magically change power states 
115  *      themselves, but we'll see.  
116  *      
117  * History
118  *  v0.15 - May 21 2001 - Marcus Meissner <mm@caldera.de>
119  *      Ported to Linux 2.4 PCI API. Some clean ups, global devs list
120  *      removed (now using pci device driver data).
121  *      PM needs to be polished still. Bumped version.
122  *  (still kind of v0.14) May 13 2001 - Ben Pfaff <pfaffben@msu.edu>
123  *      Add support for 978 docking and basic hardware volume control
124  *  (still kind of v0.14) Nov 23 - Alan Cox <alan@redhat.com>
125  *      Add clocking= for people with seriously warped hardware
126  *  (still v0.14) Nov 10 2000 - Bartlomiej Zolnierkiewicz <bkz@linux-ide.org>
127  *      add __init to maestro_ac97_init() and maestro_install()
128  *  (still based on v0.14) Mar 29 2000 - Zach Brown <zab@redhat.com>
129  *      move to 2.3 power management interface, which
130  *              required hacking some suspend/resume/check paths 
131  *      make static compilation work
132  *  v0.14 - Jan 28 2000 - Zach Brown <zab@redhat.com>
133  *      add PCI power management through ACPI regs.
134  *      we now shut down on machine reboot/halt
135  *      leave scary PCI config items alone (isa stuff, mostly)
136  *      enable 1921s, it seems only mine was broke.
137  *      fix swapped left/right pcm dac.  har har.
138  *      up bob freq, increase buffers, fix pointers at underflow
139  *      silly compilation problems
140  *  v0.13 - Nov 18 1999 - Zach Brown <zab@redhat.com>
141  *      fix nec Versas?  man would that be cool.
142  *  v0.12 - Nov 12 1999 - Zach Brown <zab@redhat.com>
143  *      brown bag volume max fix..
144  *  v0.11 - Nov 11 1999 - Zach Brown <zab@redhat.com>
145  *      use proper stereo apu decoding, mmap/write should work.
146  *      make volume sliders more useful, tweak rate calculation.
147  *      fix lame 8bit format reporting bug.  duh. apm apu saving buglet also
148  *      fix maestro 1 clock freq "bug", remove pt101 support
149  *  v0.10 - Oct 28 1999 - Zach Brown <zab@redhat.com>
150  *      aha, so, sometimes the WP writes a status word to offset 0
151  *        from one of the PCMBARs.  rearrange allocation accordingly..
152  *        cheers again to Eric for being a good hacker in investigating this.
153  *      Jeroen Hoogervorst submits 7500 fix out of nowhere.  yay.  :)
154  *  v0.09 - Oct 23 1999 - Zach Brown <zab@redhat.com>
155  *      added APM support.
156  *      re-order something such that some 2Es now work.  Magic!
157  *      new codec reset routine.  made some codecs come to life.
158  *      fix clear_advance, sync some control with ESS.
159  *      now write to all base regs to be paranoid.
160  *  v0.08 - Oct 20 1999 - Zach Brown <zab@redhat.com>
161  *      Fix initial buflen bug.  I am so smart.  also smp compiling..
162  *      I owe Eric yet another beer: fixed recmask, igain, 
163  *        muting, and adc sync consistency.  Go Team.
164  *  v0.07 - Oct 4 1999 - Zach Brown <zab@redhat.com>
165  *      tweak adc/dac, formating, and stuff to allow full duplex
166  *      allocate dsps memory at open() so we can fit in the wavecache window
167  *      fix wavecache braindamage.  again.  no more scribbling?
168  *      fix ess 1921 codec bug on some laptops.
169  *      fix dumb pci scanning bug
170  *      started 2.3 cleanup, redid spinlocks, little cleanups
171  *  v0.06 - Sep 20 1999 - Zach Brown <zab@redhat.com>
172  *      fix wavecache thinkos.  limit to 1 /dev/dsp.
173  *      eric is wearing his thinking toque this week.
174  *              spotted apu mode bugs and gain ramping problem
175  *      don't touch weird mixer regs, make recmask optional
176  *      fixed igain inversion, defaults for mixers, clean up rec_start
177  *      make mono recording work.
178  *      report subsystem stuff, please send reports.
179  *      littles: parallel out, amp now
180  *  v0.05 - Sep 17 1999 - Zach Brown <zab@redhat.com>
181  *      merged and fixed up Eric's initial recording code
182  *      munged format handling to catch misuse, needs rewrite.
183  *      revert ring bus init, fixup shared int, add pci busmaster setting
184  *      fix mixer oss interface, fix mic mute and recmask
185  *      mask off unsupported mixers, reset with all 1s, modularize defaults
186  *      make sure bob is running while we need it
187  *      got rid of device limit, initial minimal apm hooks
188  *      pull out dead code/includes, only allow multimedia/audio maestros
189  *  v0.04 - Sep 01 1999 - Zach Brown <zab@redhat.com>
190  *      copied memory leak fix from sonicvibes driver
191  *      different ac97 reset, play with 2.0 ac97, simplify ring bus setup
192  *      bob freq code, region sanity, jitter sync fix; all from Eric 
193  *
194  * TODO
195  *      fix bob frequency
196  *      endianness
197  *      do smart things with ac97 2.0 bits.
198  *      dual codecs
199  *      leave 54->61 open
200  *
201  *      it also would be fun to have a mode that would not use pci dma at all
202  *      but would copy into the wavecache on board memory and use that 
203  *      on architectures that don't like the maestro's pci dma ickiness.
204  */
205
206 /*****************************************************************************/
207
208 #include <linux/module.h>
209 #include <linux/sched.h>
210 #include <linux/smp_lock.h>
211 #include <linux/string.h>
212 #include <linux/ctype.h>
213 #include <linux/ioport.h>
214 #include <linux/delay.h>
215 #include <linux/sound.h>
216 #include <linux/slab.h>
217 #include <linux/soundcard.h>
218 #include <linux/pci.h>
219 #include <linux/spinlock.h>
220 #include <linux/init.h>
221 #include <linux/interrupt.h>
222 #include <linux/poll.h>
223 #include <linux/reboot.h>
224 #include <linux/bitops.h>
225 #include <linux/wait.h>
226
227 #include <asm/current.h>
228 #include <asm/dma.h>
229 #include <asm/io.h>
230 #include <asm/page.h>
231 #include <asm/uaccess.h>
232
233 #include <linux/pm.h>
234 static int maestro_pm_callback(struct pm_dev *dev, pm_request_t rqst, void *d);
235
236 #include "maestro.h"
237
238 static struct pci_driver maestro_pci_driver;
239
240 /* --------------------------------------------------------------------- */
241
242 #define M_DEBUG 1
243
244 #ifdef M_DEBUG
245 static int debug;
246 #define M_printk(args...) {if (debug) printk(args);}
247 #else
248 #define M_printk(x)
249 #endif
250
251 /* we try to setup 2^(dsps_order) /dev/dsp devices */
252 static int dsps_order;
253 /* whether or not we mess around with power management */
254 static int use_pm=2; /* set to 1 for force */
255 /* clocking for broken hardware - a few laptops seem to use a 50Khz clock
256         ie insmod with clocking=50000 or so */
257         
258 static int clocking=48000;
259
260 MODULE_AUTHOR("Zach Brown <zab@zabbo.net>, Alan Cox <alan@redhat.com>");
261 MODULE_DESCRIPTION("ESS Maestro Driver");
262 MODULE_LICENSE("GPL");
263
264 #ifdef M_DEBUG
265 module_param(debug, bool, 0644);
266 #endif
267 module_param(dsps_order, int, 0);
268 module_param(use_pm, int, 0);
269 module_param(clocking, int, 0);
270
271 /* --------------------------------------------------------------------- */
272 #define DRIVER_VERSION "0.15"
273
274 #ifndef PCI_VENDOR_ESS
275 #define PCI_VENDOR_ESS                  0x125D
276 #define PCI_DEVICE_ID_ESS_ESS1968       0x1968          /* Maestro 2    */
277 #define PCI_DEVICE_ID_ESS_ESS1978       0x1978          /* Maestro 2E   */
278
279 #define PCI_VENDOR_ESS_OLD              0x1285          /* Platform Tech, 
280                                                 the people the maestro 
281                                                 was bought from */
282 #define PCI_DEVICE_ID_ESS_ESS0100       0x0100          /* maestro 1 */
283 #endif /* PCI_VENDOR_ESS */
284
285 #define ESS_CHAN_HARD           0x100
286
287 /* NEC Versas ? */
288 #define NEC_VERSA_SUBID1        0x80581033
289 #define NEC_VERSA_SUBID2        0x803c1033
290
291
292 /* changed so that I could actually find all the
293         references and fix them up.  it's a little more readable now. */
294 #define ESS_FMT_STEREO  0x01
295 #define ESS_FMT_16BIT   0x02
296 #define ESS_FMT_MASK    0x03
297 #define ESS_DAC_SHIFT   0   
298 #define ESS_ADC_SHIFT   4
299
300 #define ESS_STATE_MAGIC         0x125D1968
301 #define ESS_CARD_MAGIC          0x19283746
302
303 #define DAC_RUNNING             1
304 #define ADC_RUNNING             2
305
306 #define MAX_DSP_ORDER   2
307 #define MAX_DSPS        (1<<MAX_DSP_ORDER)
308 #define NR_DSPS         (1<<dsps_order)
309 #define NR_IDRS         32
310
311 #define NR_APUS         64
312 #define NR_APU_REGS     16
313
314 /* acpi states */
315 enum {
316         ACPI_D0=0,
317         ACPI_D1,
318         ACPI_D2,
319         ACPI_D3
320 };
321
322 /* bits in the acpi masks */
323 #define ACPI_12MHZ      ( 1 << 15)
324 #define ACPI_24MHZ      ( 1 << 14)
325 #define ACPI_978        ( 1 << 13)
326 #define ACPI_SPDIF      ( 1 << 12)
327 #define ACPI_GLUE       ( 1 << 11)
328 #define ACPI__10        ( 1 << 10) /* reserved */
329 #define ACPI_PCIINT     ( 1 << 9)
330 #define ACPI_HV         ( 1 << 8) /* hardware volume */
331 #define ACPI_GPIO       ( 1 << 7)
332 #define ACPI_ASSP       ( 1 << 6)
333 #define ACPI_SB         ( 1 << 5) /* sb emul */
334 #define ACPI_FM         ( 1 << 4) /* fm emul */
335 #define ACPI_RB         ( 1 << 3) /* ringbus / aclink */
336 #define ACPI_MIDI       ( 1 << 2) 
337 #define ACPI_GP         ( 1 << 1) /* game port */
338 #define ACPI_WP         ( 1 << 0) /* wave processor */
339
340 #define ACPI_ALL        (0xffff)
341 #define ACPI_SLEEP      (~(ACPI_SPDIF|ACPI_ASSP|ACPI_SB|ACPI_FM| \
342                         ACPI_MIDI|ACPI_GP|ACPI_WP))
343 #define ACPI_NONE       (ACPI__10)
344
345 /* these masks indicate which units we care about at
346         which states */
347 static u16 acpi_state_mask[] = {
348         [ACPI_D0] = ACPI_ALL,
349         [ACPI_D1] = ACPI_SLEEP,
350         [ACPI_D2] = ACPI_SLEEP,
351         [ACPI_D3] = ACPI_NONE
352 };
353
354 static char version[] __devinitdata =
355 KERN_INFO "maestro: version " DRIVER_VERSION " time " __TIME__ " " __DATE__ "\n";
356
357
358
359 static const unsigned sample_size[] = { 1, 2, 2, 4 };
360 static const unsigned sample_shift[] = { 0, 1, 1, 2 };
361
362 enum card_types_t {
363         TYPE_MAESTRO,
364         TYPE_MAESTRO2,
365         TYPE_MAESTRO2E
366 };
367
368 static const char *card_names[]={
369         [TYPE_MAESTRO] = "ESS Maestro",
370         [TYPE_MAESTRO2] = "ESS Maestro 2",
371         [TYPE_MAESTRO2E] = "ESS Maestro 2E"
372 };
373
374 static int clock_freq[]={
375         [TYPE_MAESTRO] = (49152000L / 1024L),
376         [TYPE_MAESTRO2] = (50000000L / 1024L),
377         [TYPE_MAESTRO2E] = (50000000L / 1024L)
378 };
379
380 static int maestro_notifier(struct notifier_block *nb, unsigned long event, void *buf);
381
382 static struct notifier_block maestro_nb = {maestro_notifier, NULL, 0};
383
384 /* --------------------------------------------------------------------- */
385
386 struct ess_state {
387         unsigned int magic;
388         /* FIXME: we probably want submixers in here, but only one record pair */
389         u8 apu[6];              /* l/r output, l/r intput converters, l/r input apus */
390         u8 apu_mode[6];         /* Running mode for this APU */
391         u8 apu_pan[6];          /* Panning setup for this APU */
392         u32 apu_base[6];        /* base address for this apu */
393         struct ess_card *card;  /* Card info */
394         /* wave stuff */
395         unsigned int rateadc, ratedac;
396         unsigned char fmt, enable;
397
398         int index;
399
400         /* this locks around the oss state in the driver */
401         spinlock_t lock;
402         /* only let 1 be opening at a time */
403         struct semaphore open_sem;
404         wait_queue_head_t open_wait;
405         mode_t open_mode;
406
407         /* soundcore stuff */
408         int dev_audio;
409
410         struct dmabuf {
411                 void *rawbuf;
412                 unsigned buforder;
413                 unsigned numfrag;
414                 unsigned fragshift;
415                 /* XXX zab - swptr only in here so that it can be referenced by
416                         clear_advance, as far as I can tell :( */
417                 unsigned hwptr, swptr;
418                 unsigned total_bytes;
419                 int count;
420                 unsigned error; /* over/underrun */
421                 wait_queue_head_t wait;
422                 /* redundant, but makes calculations easier */
423                 unsigned fragsize;
424                 unsigned dmasize;
425                 unsigned fragsamples;
426                 /* OSS stuff */
427                 unsigned mapped:1;
428                 unsigned ready:1;       /* our oss buffers are ready to go */
429                 unsigned endcleared:1;
430                 unsigned ossfragshift;
431                 int ossmaxfrags;
432                 unsigned subdivision;
433                 u16 base;               /* Offset for ptr */
434         } dma_dac, dma_adc;
435
436         /* pointer to each dsp?s piece of the apu->src buffer page */
437         void *mixbuf;
438
439 };
440         
441 struct ess_card {
442         unsigned int magic;
443
444         /* We keep maestro cards in a linked list */
445         struct ess_card *next;
446
447         int dev_mixer;
448
449         int card_type;
450
451         /* as most of this is static,
452                 perhaps it should be a pointer to a global struct */
453         struct mixer_goo {
454                 int modcnt;
455                 int supported_mixers;
456                 int stereo_mixers;
457                 int record_sources;
458                 /* the caller must guarantee arg sanity before calling these */
459 /*              int (*read_mixer)(struct ess_card *card, int index);*/
460                 void (*write_mixer)(struct ess_card *card,int mixer, unsigned int left,unsigned int right);
461                 int (*recmask_io)(struct ess_card *card,int rw,int mask);
462                 unsigned int mixer_state[SOUND_MIXER_NRDEVICES];
463         } mix;
464         
465         int power_regs;
466                 
467         int in_suspend;
468         wait_queue_head_t suspend_queue;
469
470         struct ess_state channels[MAX_DSPS];
471         u16 maestro_map[NR_IDRS];       /* Register map */
472         /* we have to store this junk so that we can come back from a
473                 suspend */
474         u16 apu_map[NR_APUS][NR_APU_REGS];      /* contents of apu regs */
475
476         /* this locks around the physical registers on the card */
477         spinlock_t lock;
478
479         /* memory for this card.. wavecache limited :(*/
480         void *dmapages;
481         int dmaorder;
482
483         /* hardware resources */
484         struct pci_dev *pcidev;
485         u32 iobase;
486         u32 irq;
487
488         int bob_freq;
489         char dsps_open;
490
491         int dock_mute_vol;
492 };
493
494 static void set_mixer(struct ess_card *card,unsigned int mixer, unsigned int val );
495
496 static unsigned 
497 ld2(unsigned int x)
498 {
499         unsigned r = 0;
500         
501         if (x >= 0x10000) {
502                 x >>= 16;
503                 r += 16;
504         }
505         if (x >= 0x100) {
506                 x >>= 8;
507                 r += 8;
508         }
509         if (x >= 0x10) {
510                 x >>= 4;
511                 r += 4;
512         }
513         if (x >= 4) {
514                 x >>= 2;
515                 r += 2;
516         }
517         if (x >= 2)
518                 r++;
519         return r;
520 }
521
522
523 /* --------------------------------------------------------------------- */
524
525 static void check_suspend(struct ess_card *card);
526
527 /* --------------------------------------------------------------------- */
528
529
530 /*
531  *      ESS Maestro AC97 codec programming interface.
532  */
533          
534 static void maestro_ac97_set(struct ess_card *card, u8 cmd, u16 val)
535 {
536         int io = card->iobase;
537         int i;
538         /*
539          *      Wait for the codec bus to be free 
540          */
541
542         check_suspend(card);
543          
544         for(i=0;i<10000;i++)
545         {
546                 if(!(inb(io+ESS_AC97_INDEX)&1)) 
547                         break;
548         }
549         /*
550          *      Write the bus
551          */ 
552         outw(val, io+ESS_AC97_DATA);
553         mdelay(1);
554         outb(cmd, io+ESS_AC97_INDEX);
555         mdelay(1);
556 }
557
558 static u16 maestro_ac97_get(struct ess_card *card, u8 cmd)
559 {
560         int io = card->iobase;
561         int sanity=10000;
562         u16 data;
563         int i;
564         
565         check_suspend(card);
566         /*
567          *      Wait for the codec bus to be free 
568          */
569          
570         for(i=0;i<10000;i++)
571         {
572                 if(!(inb(io+ESS_AC97_INDEX)&1))
573                         break;
574         }
575
576         outb(cmd|0x80, io+ESS_AC97_INDEX);
577         mdelay(1);
578         
579         while(inb(io+ESS_AC97_INDEX)&1)
580         {
581                 sanity--;
582                 if(!sanity)
583                 {
584                         printk(KERN_ERR "maestro: ac97 codec timeout reading 0x%x.\n",cmd);
585                         return 0;
586                 }
587         }
588         data=inw(io+ESS_AC97_DATA);
589         mdelay(1);
590         return data;
591 }
592
593 /* OSS interface to the ac97s.. */
594
595 #define AC97_STEREO_MASK (SOUND_MASK_VOLUME|\
596         SOUND_MASK_PCM|SOUND_MASK_LINE|SOUND_MASK_CD|\
597         SOUND_MASK_VIDEO|SOUND_MASK_LINE1|SOUND_MASK_IGAIN)
598
599 #define AC97_SUPPORTED_MASK (AC97_STEREO_MASK | \
600         SOUND_MASK_BASS|SOUND_MASK_TREBLE|SOUND_MASK_MIC|\
601         SOUND_MASK_SPEAKER)
602
603 #define AC97_RECORD_MASK (SOUND_MASK_MIC|\
604         SOUND_MASK_CD| SOUND_MASK_VIDEO| SOUND_MASK_LINE1| SOUND_MASK_LINE|\
605         SOUND_MASK_PHONEIN)
606
607 #define supported_mixer(CARD,FOO) ( CARD->mix.supported_mixers & (1<<FOO) )
608
609 /* this table has default mixer values for all OSS mixers.
610         be sure to fill it in if you add oss mixers
611         to anyone's supported mixer defines */
612
613 static unsigned int mixer_defaults[SOUND_MIXER_NRDEVICES] = {
614         [SOUND_MIXER_VOLUME] =          0x3232,
615         [SOUND_MIXER_BASS] =            0x3232,
616         [SOUND_MIXER_TREBLE] =          0x3232,
617         [SOUND_MIXER_SPEAKER] =         0x3232,
618         [SOUND_MIXER_MIC] =     0x8000, /* annoying */
619         [SOUND_MIXER_LINE] =    0x3232,
620         [SOUND_MIXER_CD] =      0x3232,
621         [SOUND_MIXER_VIDEO] =   0x3232,
622         [SOUND_MIXER_LINE1] =   0x3232,
623         [SOUND_MIXER_PCM] =             0x3232,
624         [SOUND_MIXER_IGAIN] =           0x3232
625 };
626         
627 static struct ac97_mixer_hw {
628         unsigned char offset;
629         int scale;
630 } ac97_hw[SOUND_MIXER_NRDEVICES]= {
631         [SOUND_MIXER_VOLUME]    =       {0x02,63},
632         [SOUND_MIXER_BASS]      =       {0x08,15},
633         [SOUND_MIXER_TREBLE]    =       {0x08,15},
634         [SOUND_MIXER_SPEAKER]   =       {0x0a,15},
635         [SOUND_MIXER_MIC]       =       {0x0e,31},
636         [SOUND_MIXER_LINE]      =       {0x10,31},
637         [SOUND_MIXER_CD]        =       {0x12,31},
638         [SOUND_MIXER_VIDEO]     =       {0x14,31},
639         [SOUND_MIXER_LINE1]     =       {0x16,31},
640         [SOUND_MIXER_PCM]       =       {0x18,31},
641         [SOUND_MIXER_IGAIN]     =       {0x1c,15}
642 };
643
644 #if 0 /* *shrug* removed simply because we never used it.
645                 feel free to implement again if needed */
646
647 /* reads the given OSS mixer from the ac97
648         the caller must have insured that the ac97 knows
649         about that given mixer, and should be holding a
650         spinlock for the card */
651 static int ac97_read_mixer(struct ess_card *card, int mixer) 
652 {
653         u16 val;
654         int ret=0;
655         struct ac97_mixer_hw *mh = &ac97_hw[mixer];
656
657         val = maestro_ac97_get(card, mh->offset);
658
659         if(AC97_STEREO_MASK & (1<<mixer)) {
660                 /* nice stereo mixers .. */
661                 int left,right;
662
663                 left = (val >> 8)  & 0x7f;
664                 right = val  & 0x7f;
665
666                 if (mixer == SOUND_MIXER_IGAIN) {
667                         right = (right * 100) / mh->scale;
668                         left = (left * 100) / mh->scale;
669                 } else {
670                         right = 100 - ((right * 100) / mh->scale);
671                         left = 100 - ((left * 100) / mh->scale);
672                 }
673
674                 ret = left | (right << 8);
675         } else if (mixer == SOUND_MIXER_SPEAKER) {
676                 ret = 100 - ((((val & 0x1e)>>1) * 100) / mh->scale);
677         } else if (mixer == SOUND_MIXER_MIC) {
678                 ret = 100 - (((val & 0x1f) * 100) / mh->scale);
679         /*  the low bit is optional in the tone sliders and masking
680                 it lets is avoid the 0xf 'bypass'.. */
681         } else if (mixer == SOUND_MIXER_BASS) {
682                 ret = 100 - ((((val >> 8) & 0xe) * 100) / mh->scale);
683         } else if (mixer == SOUND_MIXER_TREBLE) {
684                 ret = 100 - (((val & 0xe) * 100) / mh->scale);
685         }
686
687         M_printk("read mixer %d (0x%x) %x -> %x\n",mixer,mh->offset,val,ret);
688
689         return ret;
690 }
691 #endif
692
693 /* write the OSS encoded volume to the given OSS encoded mixer,
694         again caller's job to make sure all is well in arg land,
695         call with spinlock held */
696         
697 /* linear scale -> log */
698 static unsigned char lin2log[101] = 
699 {
700 0, 0 , 15 , 23 , 30 , 34 , 38 , 42 , 45 , 47 ,
701 50 , 52 , 53 , 55 , 57 , 58 , 60 , 61 , 62 ,
702 63 , 65 , 66 , 67 , 68 , 69 , 69 , 70 , 71 ,
703 72 , 73 , 73 , 74 , 75 , 75 , 76 , 77 , 77 ,
704 78 , 78 , 79 , 80 , 80 , 81 , 81 , 82 , 82 ,
705 83 , 83 , 84 , 84 , 84 , 85 , 85 , 86 , 86 ,
706 87 , 87 , 87 , 88 , 88 , 88 , 89 , 89 , 89 ,
707 90 , 90 , 90 , 91 , 91 , 91 , 92 , 92 , 92 ,
708 93 , 93 , 93 , 94 , 94 , 94 , 94 , 95 , 95 ,
709 95 , 95 , 96 , 96 , 96 , 96 , 97 , 97 , 97 ,
710 97 , 98 , 98 , 98 , 98 , 99 , 99 , 99 , 99 , 99 
711 };
712
713 static void ac97_write_mixer(struct ess_card *card,int mixer, unsigned int left, unsigned int right)
714 {
715         u16 val=0;
716         struct ac97_mixer_hw *mh = &ac97_hw[mixer];
717
718         M_printk("wrote mixer %d (0x%x) %d,%d",mixer,mh->offset,left,right);
719
720         if(AC97_STEREO_MASK & (1<<mixer)) {
721                 /* stereo mixers, mute them if we can */
722
723                 if (mixer == SOUND_MIXER_IGAIN) {
724                         /* igain's slider is reversed.. */
725                         right = (right * mh->scale) / 100;
726                         left = (left * mh->scale) / 100;
727                         if ((left == 0) && (right == 0))
728                                 val |= 0x8000;
729                 } else if (mixer == SOUND_MIXER_PCM || mixer == SOUND_MIXER_CD) {
730                         /* log conversion seems bad for them */
731                         if ((left == 0) && (right == 0))
732                                 val = 0x8000;
733                         right = ((100 - right) * mh->scale) / 100;
734                         left = ((100 - left) * mh->scale) / 100;
735                 } else {
736                         /* log conversion for the stereo controls */
737                         if((left == 0) && (right == 0))
738                                 val = 0x8000;
739                         right = ((100 - lin2log[right]) * mh->scale) / 100;
740                         left = ((100 - lin2log[left]) * mh->scale) / 100;
741                 }
742
743                 val |= (left << 8) | right;
744
745         } else if (mixer == SOUND_MIXER_SPEAKER) {
746                 val = (((100 - left) * mh->scale) / 100) << 1;
747         } else if (mixer == SOUND_MIXER_MIC) {
748                 val = maestro_ac97_get(card, mh->offset) & ~0x801f;
749                 val |= (((100 - left) * mh->scale) / 100);
750         /*  the low bit is optional in the tone sliders and masking
751                 it lets is avoid the 0xf 'bypass'.. */
752         } else if (mixer == SOUND_MIXER_BASS) {
753                 val = maestro_ac97_get(card , mh->offset) & ~0x0f00;
754                 val |= ((((100 - left) * mh->scale) / 100) << 8) & 0x0e00;
755         } else if (mixer == SOUND_MIXER_TREBLE)  {
756                 val = maestro_ac97_get(card , mh->offset) & ~0x000f;
757                 val |= (((100 - left) * mh->scale) / 100) & 0x000e;
758         }
759
760         maestro_ac97_set(card , mh->offset, val);
761         
762         M_printk(" -> %x\n",val);
763 }
764
765 /* the following tables allow us to go from 
766         OSS <-> ac97 quickly. */
767
768 enum ac97_recsettings {
769         AC97_REC_MIC=0,
770         AC97_REC_CD,
771         AC97_REC_VIDEO,
772         AC97_REC_AUX,
773         AC97_REC_LINE,
774         AC97_REC_STEREO, /* combination of all enabled outputs..  */
775         AC97_REC_MONO,        /*.. or the mono equivalent */
776         AC97_REC_PHONE        
777 };
778
779 static unsigned int ac97_oss_mask[] = {
780         [AC97_REC_MIC] = SOUND_MASK_MIC, 
781         [AC97_REC_CD] = SOUND_MASK_CD, 
782         [AC97_REC_VIDEO] = SOUND_MASK_VIDEO, 
783         [AC97_REC_AUX] = SOUND_MASK_LINE1, 
784         [AC97_REC_LINE] = SOUND_MASK_LINE, 
785         [AC97_REC_PHONE] = SOUND_MASK_PHONEIN
786 };
787
788 /* indexed by bit position */
789 static unsigned int ac97_oss_rm[] = {
790         [SOUND_MIXER_MIC] = AC97_REC_MIC,
791         [SOUND_MIXER_CD] = AC97_REC_CD,
792         [SOUND_MIXER_VIDEO] = AC97_REC_VIDEO,
793         [SOUND_MIXER_LINE1] = AC97_REC_AUX,
794         [SOUND_MIXER_LINE] = AC97_REC_LINE,
795         [SOUND_MIXER_PHONEIN] = AC97_REC_PHONE
796 };
797         
798 /* read or write the recmask 
799         the ac97 can really have left and right recording
800         inputs independently set, but OSS doesn't seem to 
801         want us to express that to the user. 
802         the caller guarantees that we have a supported bit set,
803         and they must be holding the card's spinlock */
804 static int 
805 ac97_recmask_io(struct ess_card *card, int read, int mask) 
806 {
807         unsigned int val = ac97_oss_mask[ maestro_ac97_get(card, 0x1a) & 0x7 ];
808
809         if (read) return val;
810
811         /* oss can have many inputs, maestro can't.  try
812                 to pick the 'new' one */
813
814         if (mask != val) mask &= ~val;
815
816         val = ffs(mask) - 1; 
817         val = ac97_oss_rm[val];
818         val |= val << 8;  /* set both channels */
819
820         M_printk("maestro: setting ac97 recmask to 0x%x\n",val);
821
822         maestro_ac97_set(card,0x1a,val);
823
824         return 0;
825 };
826
827 /*
828  *      The Maestro can be wired to a standard AC97 compliant codec
829  *      (see www.intel.com for the pdf's on this), or to a PT101 codec
830  *      which appears to be the ES1918 (data sheet on the esstech.com.tw site)
831  *
832  *      The PT101 setup is untested.
833  */
834  
835 static u16 __init maestro_ac97_init(struct ess_card *card)
836 {
837         u16 vend1, vend2, caps;
838
839         card->mix.supported_mixers = AC97_SUPPORTED_MASK;
840         card->mix.stereo_mixers = AC97_STEREO_MASK;
841         card->mix.record_sources = AC97_RECORD_MASK;
842 /*      card->mix.read_mixer = ac97_read_mixer;*/
843         card->mix.write_mixer = ac97_write_mixer;
844         card->mix.recmask_io = ac97_recmask_io;
845
846         vend1 = maestro_ac97_get(card, 0x7c);
847         vend2 = maestro_ac97_get(card, 0x7e);
848
849         caps = maestro_ac97_get(card, 0x00);
850
851         printk(KERN_INFO "maestro: AC97 Codec detected: v: 0x%2x%2x caps: 0x%x pwr: 0x%x\n",
852                 vend1,vend2,caps,maestro_ac97_get(card,0x26) & 0xf);
853
854         if (! (caps & 0x4) ) {
855                 /* no bass/treble nobs */
856                 card->mix.supported_mixers &= ~(SOUND_MASK_BASS|SOUND_MASK_TREBLE);
857         }
858
859         /* XXX endianness, dork head. */
860         /* vendor specifc bits.. */
861         switch ((long)(vend1 << 16) | vend2) {
862         case 0x545200ff:        /* TriTech */
863                 /* no idea what this does */
864                 maestro_ac97_set(card,0x2a,0x0001);
865                 maestro_ac97_set(card,0x2c,0x0000);
866                 maestro_ac97_set(card,0x2c,0xffff);
867                 break;
868 #if 0   /* i thought the problems I was seeing were with
869         the 1921, but apparently they were with the pci board
870         it was on, so this code is commented out.
871          lets see if this holds true. */
872         case 0x83847609:        /* ESS 1921 */
873                 /* writing to 0xe (mic) or 0x1a (recmask) seems
874                         to hang this codec */
875                 card->mix.supported_mixers &= ~(SOUND_MASK_MIC);
876                 card->mix.record_sources = 0;
877                 card->mix.recmask_io = NULL;
878 #if 0   /* don't ask.  I have yet to see what these actually do. */
879                 maestro_ac97_set(card,0x76,0xABBA); /* o/~ Take a chance on me o/~ */
880                 udelay(20);
881                 maestro_ac97_set(card,0x78,0x3002);
882                 udelay(20);
883                 maestro_ac97_set(card,0x78,0x3802);
884                 udelay(20);
885 #endif
886                 break;
887 #endif
888         default: break;
889         }
890
891         maestro_ac97_set(card, 0x1E, 0x0404);
892         /* null misc stuff */
893         maestro_ac97_set(card, 0x20, 0x0000);
894
895         return 0;
896 }
897
898 #if 0  /* there has been 1 person on the planet with a pt101 that we
899         know of.  If they care, they can put this back in :) */
900 static u16 maestro_pt101_init(struct ess_card *card,int iobase)
901 {
902         printk(KERN_INFO "maestro: PT101 Codec detected, initializing but _not_ installing mixer device.\n");
903         /* who knows.. */
904         maestro_ac97_set(iobase, 0x2A, 0x0001);
905         maestro_ac97_set(iobase, 0x2C, 0x0000);
906         maestro_ac97_set(iobase, 0x2C, 0xFFFF);
907         maestro_ac97_set(iobase, 0x10, 0x9F1F);
908         maestro_ac97_set(iobase, 0x12, 0x0808);
909         maestro_ac97_set(iobase, 0x14, 0x9F1F);
910         maestro_ac97_set(iobase, 0x16, 0x9F1F);
911         maestro_ac97_set(iobase, 0x18, 0x0404);
912         maestro_ac97_set(iobase, 0x1A, 0x0000);
913         maestro_ac97_set(iobase, 0x1C, 0x0000);
914         maestro_ac97_set(iobase, 0x02, 0x0404);
915         maestro_ac97_set(iobase, 0x04, 0x0808);
916         maestro_ac97_set(iobase, 0x0C, 0x801F);
917         maestro_ac97_set(iobase, 0x0E, 0x801F);
918         return 0;
919 }
920 #endif
921
922 /* this is very magic, and very slow.. */
923 static void 
924 maestro_ac97_reset(int ioaddr, struct pci_dev *pcidev)
925 {
926         u16 save_68;
927         u16 w;
928         u32 vend;
929
930         outw( inw(ioaddr + 0x38) & 0xfffc, ioaddr + 0x38);
931         outw( inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
932         outw( inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
933
934         /* reset the first codec */
935         outw(0x0000,  ioaddr+0x36);
936         save_68 = inw(ioaddr+0x68);
937         pci_read_config_word(pcidev, 0x58, &w); /* something magical with gpio and bus arb. */
938         pci_read_config_dword(pcidev, PCI_SUBSYSTEM_VENDOR_ID, &vend);
939         if( w & 0x1)
940                 save_68 |= 0x10;
941         outw(0xfffe, ioaddr + 0x64);    /* tickly gpio 0.. */
942         outw(0x0001, ioaddr + 0x68);
943         outw(0x0000, ioaddr + 0x60);
944         udelay(20);
945         outw(0x0001, ioaddr + 0x60);
946         mdelay(20);
947
948         outw(save_68 | 0x1, ioaddr + 0x68);     /* now restore .. */
949         outw( (inw(ioaddr + 0x38) & 0xfffc)|0x1, ioaddr + 0x38);
950         outw( (inw(ioaddr + 0x3a) & 0xfffc)|0x1, ioaddr + 0x3a);
951         outw( (inw(ioaddr + 0x3c) & 0xfffc)|0x1, ioaddr + 0x3c);
952
953         /* now the second codec */
954         outw(0x0000,  ioaddr+0x36);
955         outw(0xfff7, ioaddr + 0x64);
956         save_68 = inw(ioaddr+0x68);
957         outw(0x0009, ioaddr + 0x68);
958         outw(0x0001, ioaddr + 0x60);
959         udelay(20);
960         outw(0x0009, ioaddr + 0x60);
961         mdelay(500);    /* .. ouch.. */
962         outw( inw(ioaddr + 0x38) & 0xfffc, ioaddr + 0x38);
963         outw( inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
964         outw( inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
965
966 #if 0 /* the loop here needs to be much better if we want it.. */
967         M_printk("trying software reset\n");
968         /* try and do a software reset */
969         outb(0x80|0x7c, ioaddr + 0x30);
970         for (w=0; ; w++) {
971                 if ((inw(ioaddr+ 0x30) & 1) == 0) {
972                         if(inb(ioaddr + 0x32) !=0) break;
973
974                         outb(0x80|0x7d, ioaddr + 0x30);
975                         if (((inw(ioaddr+ 0x30) & 1) == 0) && (inb(ioaddr + 0x32) !=0)) break;
976                         outb(0x80|0x7f, ioaddr + 0x30);
977                         if (((inw(ioaddr+ 0x30) & 1) == 0) && (inb(ioaddr + 0x32) !=0)) break;
978                 }
979
980                 if( w > 10000) {
981                         outb( inb(ioaddr + 0x37) | 0x08, ioaddr + 0x37);  /* do a software reset */
982                         mdelay(500); /* oh my.. */
983                         outb( inb(ioaddr + 0x37) & ~0x08, ioaddr + 0x37);  
984                         udelay(1);
985                         outw( 0x80, ioaddr+0x30);
986                         for(w = 0 ; w < 10000; w++) {
987                                 if((inw(ioaddr + 0x30) & 1) ==0) break;
988                         }
989                 }
990         }
991 #endif
992         if ( vend == NEC_VERSA_SUBID1 || vend == NEC_VERSA_SUBID2) {
993                 /* turn on external amp? */
994                 outw(0xf9ff, ioaddr + 0x64);
995                 outw(inw(ioaddr+0x68) | 0x600, ioaddr + 0x68);
996                 outw(0x0209, ioaddr + 0x60);
997         }
998
999         /* Turn on the 978 docking chip.
1000            First frob the "master output enable" bit,
1001            then set most of the playback volume control registers to max. */
1002         outb(inb(ioaddr+0xc0)|(1<<5), ioaddr+0xc0);
1003         outb(0xff, ioaddr+0xc3);
1004         outb(0xff, ioaddr+0xc4);
1005         outb(0xff, ioaddr+0xc6);
1006         outb(0xff, ioaddr+0xc8);
1007         outb(0x3f, ioaddr+0xcf);
1008         outb(0x3f, ioaddr+0xd0);
1009 }
1010 /*
1011  *      Indirect register access. Not all registers are readable so we
1012  *      need to keep register state ourselves
1013  */
1014  
1015 #define WRITEABLE_MAP   0xEFFFFF
1016 #define READABLE_MAP    0x64003F
1017
1018 /*
1019  *      The Maestro engineers were a little indirection happy. These indirected
1020  *      registers themselves include indirect registers at another layer
1021  */
1022
1023 static void __maestro_write(struct ess_card *card, u16 reg, u16 data)
1024 {
1025         long ioaddr = card->iobase;
1026
1027         outw(reg, ioaddr+0x02);
1028         outw(data, ioaddr+0x00);
1029         if( reg >= NR_IDRS) printk("maestro: IDR %d out of bounds!\n",reg);
1030         else card->maestro_map[reg]=data;
1031
1032 }
1033  
1034 static void maestro_write(struct ess_state *s, u16 reg, u16 data)
1035 {
1036         unsigned long flags;
1037
1038         check_suspend(s->card);
1039         spin_lock_irqsave(&s->card->lock,flags);
1040
1041         __maestro_write(s->card,reg,data);
1042
1043         spin_unlock_irqrestore(&s->card->lock,flags);
1044 }
1045
1046 static u16 __maestro_read(struct ess_card *card, u16 reg)
1047 {
1048         long ioaddr = card->iobase;
1049
1050         outw(reg, ioaddr+0x02);
1051         return card->maestro_map[reg]=inw(ioaddr+0x00);
1052 }
1053
1054 static u16 maestro_read(struct ess_state *s, u16 reg)
1055 {
1056         if(READABLE_MAP & (1<<reg))
1057         {
1058                 unsigned long flags;
1059                 check_suspend(s->card);
1060                 spin_lock_irqsave(&s->card->lock,flags);
1061
1062                 __maestro_read(s->card,reg);
1063
1064                 spin_unlock_irqrestore(&s->card->lock,flags);
1065         }
1066         return s->card->maestro_map[reg];
1067 }
1068
1069 /*
1070  *      These routines handle accessing the second level indirections to the
1071  *      wave ram.
1072  */
1073
1074 /*
1075  *      The register names are the ones ESS uses (see 104T31.ZIP)
1076  */
1077  
1078 #define IDR0_DATA_PORT          0x00
1079 #define IDR1_CRAM_POINTER       0x01
1080 #define IDR2_CRAM_DATA          0x02
1081 #define IDR3_WAVE_DATA          0x03
1082 #define IDR4_WAVE_PTR_LOW       0x04
1083 #define IDR5_WAVE_PTR_HI        0x05
1084 #define IDR6_TIMER_CTRL         0x06
1085 #define IDR7_WAVE_ROMRAM        0x07
1086
1087 static void apu_index_set(struct ess_card *card, u16 index)
1088 {
1089         int i;
1090         __maestro_write(card, IDR1_CRAM_POINTER, index);
1091         for(i=0;i<1000;i++)
1092                 if(__maestro_read(card, IDR1_CRAM_POINTER)==index)
1093                         return;
1094         printk(KERN_WARNING "maestro: APU register select failed.\n");
1095 }
1096
1097 static void apu_data_set(struct ess_card *card, u16 data)
1098 {
1099         int i;
1100         for(i=0;i<1000;i++)
1101         {
1102                 if(__maestro_read(card, IDR0_DATA_PORT)==data)
1103                         return;
1104                 __maestro_write(card, IDR0_DATA_PORT, data);
1105         }
1106 }
1107
1108 /*
1109  *      This is the public interface for APU manipulation. It handles the
1110  *      interlock to avoid two APU writes in parallel etc. Don't diddle
1111  *      directly with the stuff above.
1112  */
1113
1114 static void apu_set_register(struct ess_state *s, u16 channel, u8 reg, u16 data)
1115 {
1116         unsigned long flags;
1117         
1118         check_suspend(s->card);
1119
1120         if(channel&ESS_CHAN_HARD)
1121                 channel&=~ESS_CHAN_HARD;
1122         else
1123         {
1124                 if(channel>5)
1125                         printk("BAD CHANNEL %d.\n",channel);
1126                 else
1127                         channel = s->apu[channel];
1128                 /* store based on real hardware apu/reg */
1129                 s->card->apu_map[channel][reg]=data;
1130         }
1131         reg|=(channel<<4);
1132         
1133         /* hooray for double indirection!! */
1134         spin_lock_irqsave(&s->card->lock,flags);
1135
1136         apu_index_set(s->card, reg);
1137         apu_data_set(s->card, data);
1138
1139         spin_unlock_irqrestore(&s->card->lock,flags);
1140 }
1141
1142 static u16 apu_get_register(struct ess_state *s, u16 channel, u8 reg)
1143 {
1144         unsigned long flags;
1145         u16 v;
1146         
1147         check_suspend(s->card);
1148
1149         if(channel&ESS_CHAN_HARD)
1150                 channel&=~ESS_CHAN_HARD;
1151         else
1152                 channel = s->apu[channel];
1153
1154         reg|=(channel<<4);
1155         
1156         spin_lock_irqsave(&s->card->lock,flags);
1157
1158         apu_index_set(s->card, reg);
1159         v=__maestro_read(s->card, IDR0_DATA_PORT);
1160
1161         spin_unlock_irqrestore(&s->card->lock,flags);
1162         return v;
1163 }
1164
1165
1166 /*
1167  *      The wavecache buffers between the APUs and
1168  *      pci bus mastering
1169  */
1170  
1171 static void wave_set_register(struct ess_state *s, u16 reg, u16 value)
1172 {
1173         long ioaddr = s->card->iobase;
1174         unsigned long flags;
1175         check_suspend(s->card);
1176         
1177         spin_lock_irqsave(&s->card->lock,flags);
1178
1179         outw(reg, ioaddr+0x10);
1180         outw(value, ioaddr+0x12);
1181
1182         spin_unlock_irqrestore(&s->card->lock,flags);
1183 }
1184
1185 static u16 wave_get_register(struct ess_state *s, u16 reg)
1186 {
1187         long ioaddr = s->card->iobase;
1188         unsigned long flags;
1189         u16 value;
1190         check_suspend(s->card);
1191         
1192         spin_lock_irqsave(&s->card->lock,flags);
1193         outw(reg, ioaddr+0x10);
1194         value=inw(ioaddr+0x12);
1195         spin_unlock_irqrestore(&s->card->lock,flags);
1196         
1197         return value;
1198 }
1199
1200 static void sound_reset(int ioaddr)
1201 {
1202         outw(0x2000, 0x18+ioaddr);
1203         udelay(1);
1204         outw(0x0000, 0x18+ioaddr);
1205         udelay(1);
1206 }
1207
1208 /* sets the play formats of these apus, should be passed the already shifted format */
1209 static void set_apu_fmt(struct ess_state *s, int apu, int mode)
1210 {
1211         int apu_fmt = 0x10;
1212
1213         if(!(mode&ESS_FMT_16BIT)) apu_fmt+=0x20; 
1214         if((mode&ESS_FMT_STEREO)) apu_fmt+=0x10; 
1215         s->apu_mode[apu]   = apu_fmt;
1216         s->apu_mode[apu+1] = apu_fmt;
1217 }
1218
1219 /* this only fixes the output apu mode to be later set by start_dac and
1220         company.  output apu modes are set in ess_rec_setup */
1221 static void set_fmt(struct ess_state *s, unsigned char mask, unsigned char data)
1222 {
1223         s->fmt = (s->fmt & mask) | data;
1224         set_apu_fmt(s, 0, (s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK);
1225 }
1226
1227 /* this is off by a little bit.. */
1228 static u32 compute_rate(struct ess_state *s, u32 freq)
1229 {
1230         u32 clock = clock_freq[s->card->card_type];     
1231
1232         freq = (freq * clocking)/48000;
1233         
1234         if (freq == 48000) 
1235                 return 0x10000;
1236
1237         return ((freq / clock) <<16 )+  
1238                 (((freq % clock) << 16) / clock);
1239 }
1240
1241 static void set_dac_rate(struct ess_state *s, unsigned int rate)
1242 {
1243         u32 freq;
1244         int fmt = (s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK;
1245
1246         if (rate > 48000)
1247                 rate = 48000;
1248         if (rate < 4000)
1249                 rate = 4000;
1250
1251         s->ratedac = rate;
1252
1253         if(! (fmt & ESS_FMT_16BIT) && !(fmt & ESS_FMT_STEREO))
1254                 rate >>= 1;
1255
1256 /*      M_printk("computing dac rate %d with mode %d\n",rate,s->fmt);*/
1257
1258         freq = compute_rate(s, rate);
1259         
1260         /* Load the frequency, turn on 6dB */
1261         apu_set_register(s, 0, 2,(apu_get_register(s, 0, 2)&0x00FF)|
1262                 ( ((freq&0xFF)<<8)|0x10 ));
1263         apu_set_register(s, 0, 3, freq>>8);
1264         apu_set_register(s, 1, 2,(apu_get_register(s, 1, 2)&0x00FF)|
1265                 ( ((freq&0xFF)<<8)|0x10 ));
1266         apu_set_register(s, 1, 3, freq>>8);
1267 }
1268
1269 static void set_adc_rate(struct ess_state *s, unsigned rate)
1270 {
1271         u32 freq;
1272
1273         /* Sample Rate conversion APUs don't like 0x10000 for their rate */
1274         if (rate > 47999)
1275                 rate = 47999;
1276         if (rate < 4000)
1277                 rate = 4000;
1278
1279         s->rateadc = rate;
1280
1281         freq = compute_rate(s, rate);
1282         
1283         /* Load the frequency, turn on 6dB */
1284         apu_set_register(s, 2, 2,(apu_get_register(s, 2, 2)&0x00FF)|
1285                 ( ((freq&0xFF)<<8)|0x10 ));
1286         apu_set_register(s, 2, 3, freq>>8);
1287         apu_set_register(s, 3, 2,(apu_get_register(s, 3, 2)&0x00FF)|
1288                 ( ((freq&0xFF)<<8)|0x10 ));
1289         apu_set_register(s, 3, 3, freq>>8);
1290
1291         /* fix mixer rate at 48khz.  and its _must_ be 0x10000. */
1292         freq = 0x10000;
1293
1294         apu_set_register(s, 4, 2,(apu_get_register(s, 4, 2)&0x00FF)|
1295                 ( ((freq&0xFF)<<8)|0x10 ));
1296         apu_set_register(s, 4, 3, freq>>8);
1297         apu_set_register(s, 5, 2,(apu_get_register(s, 5, 2)&0x00FF)|
1298                 ( ((freq&0xFF)<<8)|0x10 ));
1299         apu_set_register(s, 5, 3, freq>>8);
1300 }
1301
1302 /* Stop our host of recording apus */
1303 static inline void stop_adc(struct ess_state *s)
1304 {
1305         /* XXX lets hope we don't have to lock around this */
1306         if (! (s->enable & ADC_RUNNING)) return;
1307
1308         s->enable &= ~ADC_RUNNING;
1309         apu_set_register(s, 2, 0, apu_get_register(s, 2, 0)&0xFF0F);
1310         apu_set_register(s, 3, 0, apu_get_register(s, 3, 0)&0xFF0F);
1311         apu_set_register(s, 4, 0, apu_get_register(s, 2, 0)&0xFF0F);
1312         apu_set_register(s, 5, 0, apu_get_register(s, 3, 0)&0xFF0F);
1313 }       
1314
1315 /* stop output apus */
1316 static void stop_dac(struct ess_state *s)
1317 {
1318         /* XXX have to lock around this? */
1319         if (! (s->enable & DAC_RUNNING)) return;
1320
1321         s->enable &= ~DAC_RUNNING;
1322         apu_set_register(s, 0, 0, apu_get_register(s, 0, 0)&0xFF0F);
1323         apu_set_register(s, 1, 0, apu_get_register(s, 1, 0)&0xFF0F);
1324 }       
1325
1326 static void start_dac(struct ess_state *s)
1327 {
1328         /* XXX locks? */
1329         if (    (s->dma_dac.mapped || s->dma_dac.count > 0) && 
1330                 s->dma_dac.ready &&
1331                 (! (s->enable & DAC_RUNNING)) ) {
1332
1333                 s->enable |= DAC_RUNNING;
1334
1335                 apu_set_register(s, 0, 0, 
1336                         (apu_get_register(s, 0, 0)&0xFF0F)|s->apu_mode[0]);
1337
1338                 if((s->fmt >> ESS_DAC_SHIFT)  & ESS_FMT_STEREO) 
1339                         apu_set_register(s, 1, 0, 
1340                                 (apu_get_register(s, 1, 0)&0xFF0F)|s->apu_mode[1]);
1341         }
1342 }       
1343
1344 static void start_adc(struct ess_state *s)
1345 {
1346         /* XXX locks? */
1347         if ((s->dma_adc.mapped || s->dma_adc.count < (signed)(s->dma_adc.dmasize - 2*s->dma_adc.fragsize)) 
1348             && s->dma_adc.ready && (! (s->enable & ADC_RUNNING)) ) {
1349
1350                 s->enable |= ADC_RUNNING;
1351                 apu_set_register(s, 2, 0, 
1352                         (apu_get_register(s, 2, 0)&0xFF0F)|s->apu_mode[2]);
1353                 apu_set_register(s, 4, 0, 
1354                         (apu_get_register(s, 4, 0)&0xFF0F)|s->apu_mode[4]);
1355
1356                 if( s->fmt & (ESS_FMT_STEREO << ESS_ADC_SHIFT)) {
1357                         apu_set_register(s, 3, 0, 
1358                                 (apu_get_register(s, 3, 0)&0xFF0F)|s->apu_mode[3]);
1359                         apu_set_register(s, 5, 0, 
1360                                 (apu_get_register(s, 5, 0)&0xFF0F)|s->apu_mode[5]);
1361                 }
1362                         
1363         }
1364 }       
1365
1366
1367 /*
1368  *      Native play back driver 
1369  */
1370
1371 /* the mode passed should be already shifted and masked */
1372 static void 
1373 ess_play_setup(struct ess_state *ess, int mode, u32 rate, void *buffer, int size)
1374 {
1375         u32 pa;
1376         u32 tmpval;
1377         int high_apu = 0;
1378         int channel;
1379
1380         M_printk("mode=%d rate=%d buf=%p len=%d.\n",
1381                 mode, rate, buffer, size);
1382                 
1383         /* all maestro sizes are in 16bit words */
1384         size >>=1;
1385
1386         if(mode&ESS_FMT_STEREO) {
1387                 high_apu++;
1388                 /* only 16/stereo gets size divided */
1389                 if(mode&ESS_FMT_16BIT)
1390                         size>>=1;
1391         }
1392         
1393         for(channel=0; channel <= high_apu; channel++)
1394         {
1395                 pa = virt_to_bus(buffer);
1396
1397                 /* set the wavecache control reg */
1398                 tmpval = (pa - 0x10) & 0xFFF8;
1399                 if(!(mode & ESS_FMT_16BIT)) tmpval |= 4;
1400                 if(mode & ESS_FMT_STEREO) tmpval |= 2;
1401                 ess->apu_base[channel]=tmpval;
1402                 wave_set_register(ess, ess->apu[channel]<<3, tmpval);
1403                 
1404                 pa -= virt_to_bus(ess->card->dmapages);
1405                 pa>>=1; /* words */
1406                 
1407                 /* base offset of dma calcs when reading the pointer
1408                         on the left one */
1409                 if(!channel) ess->dma_dac.base = pa&0xFFFF;
1410                 
1411                 pa|=0x00400000;                 /* System RAM */
1412
1413                 /* XXX the 16bit here might not be needed.. */
1414                 if((mode & ESS_FMT_STEREO) && (mode & ESS_FMT_16BIT)) {
1415                         if(channel) 
1416                                 pa|=0x00800000;                 /* Stereo */
1417                         pa>>=1;
1418                 }
1419                         
1420 /* XXX think about endianess when writing these registers */
1421                 M_printk("maestro: ess_play_setup: APU[%d] pa = 0x%x\n", ess->apu[channel], pa);
1422                 /* start of sample */
1423                 apu_set_register(ess, channel, 4, ((pa>>16)&0xFF)<<8);
1424                 apu_set_register(ess, channel, 5, pa&0xFFFF);
1425                 /* sample end */
1426                 apu_set_register(ess, channel, 6, (pa+size)&0xFFFF);
1427                 /* setting loop len == sample len */
1428                 apu_set_register(ess, channel, 7, size);
1429                 
1430                 /* clear effects/env.. */
1431                 apu_set_register(ess, channel, 8, 0x0000);
1432                 /* set amp now to 0xd0 (?), low byte is 'amplitude dest'? */
1433                 apu_set_register(ess, channel, 9, 0xD000);
1434
1435                 /* clear routing stuff */
1436                 apu_set_register(ess, channel, 11, 0x0000);
1437                 /* dma on, no envelopes, filter to all 1s) */
1438                 apu_set_register(ess, channel, 0, 0x400F);
1439                 
1440                 if(mode&ESS_FMT_16BIT)
1441                         ess->apu_mode[channel]=0x10;
1442                 else
1443                         ess->apu_mode[channel]=0x30;
1444
1445                 if(mode&ESS_FMT_STEREO) {
1446                         /* set panning: left or right */
1447                         apu_set_register(ess, channel, 10, 0x8F00 | (channel ? 0 : 0x10));
1448                         ess->apu_mode[channel] += 0x10;
1449                 } else
1450                         apu_set_register(ess, channel, 10, 0x8F08);
1451         }
1452         
1453         /* clear WP interrupts */
1454         outw(1, ess->card->iobase+0x04);
1455         /* enable WP ints */
1456         outw(inw(ess->card->iobase+0x18)|4, ess->card->iobase+0x18);
1457
1458         /* go team! */
1459         set_dac_rate(ess,rate);
1460         start_dac(ess);
1461 }
1462
1463 /*
1464  *      Native record driver 
1465  */
1466
1467 /* again, passed mode is alrady shifted/masked */
1468 static void 
1469 ess_rec_setup(struct ess_state *ess, int mode, u32 rate, void *buffer, int size)
1470 {
1471         int apu_step = 2;
1472         int channel;
1473
1474         M_printk("maestro: ess_rec_setup: mode=%d rate=%d buf=0x%p len=%d.\n",
1475                 mode, rate, buffer, size);
1476                 
1477         /* all maestro sizes are in 16bit words */
1478         size >>=1;
1479
1480         /* we're given the full size of the buffer, but
1481         in stereo each channel will only use its half */
1482         if(mode&ESS_FMT_STEREO) {
1483                 size >>=1; 
1484                 apu_step = 1;
1485         }
1486         
1487         /* APU assignments: 2 = mono/left SRC
1488                             3 = right SRC
1489                             4 = mono/left Input Mixer
1490                             5 = right Input Mixer */
1491         for(channel=2;channel<6;channel+=apu_step)
1492         {
1493                 int i;
1494                 int bsize, route;
1495                 u32 pa;
1496                 u32 tmpval;
1497
1498                 /* data seems to flow from the codec, through an apu into
1499                         the 'mixbuf' bit of page, then through the SRC apu
1500                         and out to the real 'buffer'.  ok.  sure.  */
1501                 
1502                 if(channel & 0x04) {
1503                         /* ok, we're an input mixer going from adc
1504                                 through the mixbuf to the other apus */
1505
1506                         if(!(channel & 0x01)) { 
1507                                 pa = virt_to_bus(ess->mixbuf);
1508                         } else {
1509                                 pa = virt_to_bus(ess->mixbuf + (PAGE_SIZE >> 4));
1510                         }
1511
1512                         /* we source from a 'magic' apu */
1513                         bsize = PAGE_SIZE >> 5; /* half of this channels alloc, in words */
1514                         route = 0x14 + (channel - 4); /* parallel in crap, see maestro reg 0xC [8-11] */
1515                         ess->apu_mode[channel] = 0x90;  /* Input Mixer */
1516
1517                 } else {  
1518                         /* we're a rate converter taking
1519                                 input from the input apus and outputing it to
1520                                 system memory */
1521                         if(!(channel & 0x01))  {
1522                                 pa = virt_to_bus(buffer);
1523                         } else {
1524                                 /* right channel records its split half.
1525                                 *2 accommodates for rampant shifting earlier */
1526                                 pa = virt_to_bus(buffer + size*2);
1527                         }
1528
1529                         ess->apu_mode[channel] = 0xB0;  /* Sample Rate Converter */
1530
1531                         bsize = size; 
1532                         /* get input from inputing apu */
1533                         route = channel + 2;
1534                 }
1535
1536                 M_printk("maestro: ess_rec_setup: getting pa 0x%x from %d\n",pa,channel);
1537                 
1538                 /* set the wavecache control reg */
1539                 tmpval = (pa - 0x10) & 0xFFF8;
1540                 ess->apu_base[channel]=tmpval;
1541                 wave_set_register(ess, ess->apu[channel]<<3, tmpval);
1542                 
1543                 pa -= virt_to_bus(ess->card->dmapages);
1544                 pa>>=1; /* words */
1545                 
1546                 /* base offset of dma calcs when reading the pointer
1547                         on this left one */
1548                 if(channel==2) ess->dma_adc.base = pa&0xFFFF;
1549
1550                 pa|=0x00400000;                 /* bit 22 -> System RAM */
1551
1552                 M_printk("maestro: ess_rec_setup: APU[%d] pa = 0x%x size = 0x%x route = 0x%x\n", 
1553                         ess->apu[channel], pa, bsize, route);
1554                 
1555                 /* Begin loading the APU */             
1556                 for(i=0;i<15;i++)               /* clear all PBRs */
1557                         apu_set_register(ess, channel, i, 0x0000);
1558                         
1559                 apu_set_register(ess, channel, 0, 0x400F);
1560
1561                 /* need to enable subgroups.. and we should probably
1562                         have different groups for different /dev/dsps..  */
1563                 apu_set_register(ess, channel, 2, 0x8);
1564                                 
1565                 /* Load the buffer into the wave engine */
1566                 apu_set_register(ess, channel, 4, ((pa>>16)&0xFF)<<8);
1567                 /* XXX reg is little endian.. */
1568                 apu_set_register(ess, channel, 5, pa&0xFFFF);
1569                 apu_set_register(ess, channel, 6, (pa+bsize)&0xFFFF);
1570                 apu_set_register(ess, channel, 7, bsize);
1571                                 
1572                 /* clear effects/env.. */
1573                 apu_set_register(ess, channel, 8, 0x00F0);
1574                 
1575                 /* amplitude now?  sure.  why not.  */
1576                 apu_set_register(ess, channel, 9, 0x0000);
1577
1578                 /* set filter tune, radius, polar pan */
1579                 apu_set_register(ess, channel, 10, 0x8F08);
1580
1581                 /* route input */
1582                 apu_set_register(ess, channel, 11, route);
1583         }
1584         
1585         /* clear WP interrupts */
1586         outw(1, ess->card->iobase+0x04);
1587         /* enable WP ints */
1588         outw(inw(ess->card->iobase+0x18)|4, ess->card->iobase+0x18);
1589
1590         /* let 'er rip */
1591         set_adc_rate(ess,rate);
1592         start_adc(ess);
1593 }
1594 /* --------------------------------------------------------------------- */
1595
1596 static void set_dmaa(struct ess_state *s, unsigned int addr, unsigned int count)
1597 {
1598         M_printk("set_dmaa??\n");
1599 }
1600
1601 static void set_dmac(struct ess_state *s, unsigned int addr, unsigned int count)
1602 {
1603         M_printk("set_dmac??\n");
1604 }
1605
1606 /* Playback pointer */
1607 static inline unsigned get_dmaa(struct ess_state *s)
1608 {
1609         int offset;
1610
1611         offset = apu_get_register(s,0,5);
1612
1613 /*      M_printk("dmaa: offset: %d, base: %d\n",offset,s->dma_dac.base); */
1614         
1615         offset-=s->dma_dac.base;
1616
1617         return (offset&0xFFFE)<<1; /* hardware is in words */
1618 }
1619
1620 /* Record pointer */
1621 static inline unsigned get_dmac(struct ess_state *s)
1622 {
1623         int offset;
1624
1625         offset = apu_get_register(s,2,5);
1626
1627 /*      M_printk("dmac: offset: %d, base: %d\n",offset,s->dma_adc.base); */
1628         
1629         /* The offset is an address not a position relative to base */
1630         offset-=s->dma_adc.base;
1631         
1632         return (offset&0xFFFE)<<1; /* hardware is in words */
1633 }
1634
1635 /*
1636  *      Meet Bob, the timer...
1637  */
1638
1639 static irqreturn_t ess_interrupt(int irq, void *dev_id, struct pt_regs *regs);
1640
1641 static void stop_bob(struct ess_state *s)
1642 {
1643         /* Mask IDR 11,17 */
1644         maestro_write(s,  0x11, maestro_read(s, 0x11)&~1);
1645         maestro_write(s,  0x17, maestro_read(s, 0x17)&~1);
1646 }
1647
1648 /* eventually we could be clever and limit bob ints
1649         to the frequency at which our smallest duration
1650         chunks may expire */
1651 #define ESS_SYSCLK      50000000
1652 static void start_bob(struct ess_state *s)
1653 {
1654         int prescale;
1655         int divide;
1656         
1657         /* XXX make freq selector much smarter, see calc_bob_rate */
1658         int freq = 200; 
1659         
1660         /* compute ideal interrupt frequency for buffer size & play rate */
1661         /* first, find best prescaler value to match freq */
1662         for(prescale=5;prescale<12;prescale++)
1663                 if(freq > (ESS_SYSCLK>>(prescale+9)))
1664                         break;
1665                         
1666         /* next, back off prescaler whilst getting divider into optimum range */
1667         divide=1;
1668         while((prescale > 5) && (divide<32))
1669         {
1670                 prescale--;
1671                 divide <<=1;
1672         }
1673         divide>>=1;
1674         
1675         /* now fine-tune the divider for best match */
1676         for(;divide<31;divide++)
1677                 if(freq >= ((ESS_SYSCLK>>(prescale+9))/(divide+1)))
1678                         break;
1679         
1680         /* divide = 0 is illegal, but don't let prescale = 4! */
1681         if(divide == 0)
1682         {
1683                 divide++;
1684                 if(prescale>5)
1685                         prescale--;
1686         }
1687
1688         maestro_write(s, 6, 0x9000 | (prescale<<5) | divide); /* set reg */
1689         
1690         /* Now set IDR 11/17 */
1691         maestro_write(s, 0x11, maestro_read(s, 0x11)|1);
1692         maestro_write(s, 0x17, maestro_read(s, 0x17)|1);
1693 }
1694 /* --------------------------------------------------------------------- */
1695
1696 /* this quickly calculates the frequency needed for bob
1697         and sets it if its different than what bob is
1698         currently running at.  its called often so 
1699         needs to be fairly quick. */
1700 #define BOB_MIN 50
1701 #define BOB_MAX 400
1702 static void calc_bob_rate(struct ess_state *s) {
1703 #if 0 /* this thing tries to set the frequency of bob such that
1704         there are 2 interrupts / buffer walked by the dac/adc.  That
1705         is probably very wrong for people who actually care about 
1706         mid buffer positioning.  it should be calculated as bytes/interrupt
1707         and that needs to be decided :)  so for now just use the static 150
1708         in start_bob.*/
1709
1710         unsigned int dac_rate=2,adc_rate=1,newrate;
1711         static int israte=-1;
1712
1713         if (s->dma_dac.fragsize == 0) dac_rate = BOB_MIN;
1714         else  {
1715                 dac_rate =      (2 * s->ratedac * sample_size[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK]) /
1716                                 (s->dma_dac.fragsize) ;
1717         }
1718                 
1719         if (s->dma_adc.fragsize == 0) adc_rate = BOB_MIN;
1720         else {
1721                 adc_rate =      (2 * s->rateadc * sample_size[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK]) /
1722                                 (s->dma_adc.fragsize) ;
1723         }
1724
1725         if(dac_rate > adc_rate) newrate = adc_rate;
1726         else newrate=dac_rate;
1727
1728         if(newrate > BOB_MAX) newrate = BOB_MAX;
1729         else {
1730                 if(newrate < BOB_MIN) 
1731                         newrate = BOB_MIN;
1732         }
1733
1734         if( israte != newrate) {
1735                 printk("dac: %d  adc: %d rate: %d\n",dac_rate,adc_rate,israte);
1736                 israte=newrate;
1737         }
1738 #endif
1739
1740 }
1741
1742 static int 
1743 prog_dmabuf(struct ess_state *s, unsigned rec)
1744 {
1745         struct dmabuf *db = rec ? &s->dma_adc : &s->dma_dac;
1746         unsigned rate = rec ? s->rateadc : s->ratedac;
1747         unsigned bytepersec;
1748         unsigned bufs;
1749         unsigned char fmt;
1750         unsigned long flags;
1751
1752         spin_lock_irqsave(&s->lock, flags);
1753         fmt = s->fmt;
1754         if (rec) {
1755                 stop_adc(s);
1756                 fmt >>= ESS_ADC_SHIFT;
1757         } else {
1758                 stop_dac(s);
1759                 fmt >>= ESS_DAC_SHIFT;
1760         }
1761         spin_unlock_irqrestore(&s->lock, flags);
1762         fmt &= ESS_FMT_MASK;
1763
1764         db->hwptr = db->swptr = db->total_bytes = db->count = db->error = db->endcleared = 0;
1765
1766         /* this algorithm is a little nuts.. where did /1000 come from? */
1767         bytepersec = rate << sample_shift[fmt];
1768         bufs = PAGE_SIZE << db->buforder;
1769         if (db->ossfragshift) {
1770                 if ((1000 << db->ossfragshift) < bytepersec)
1771                         db->fragshift = ld2(bytepersec/1000);
1772                 else
1773                         db->fragshift = db->ossfragshift;
1774         } else {
1775                 db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1));
1776                 if (db->fragshift < 3)
1777                         db->fragshift = 3; 
1778         }
1779         db->numfrag = bufs >> db->fragshift;
1780         while (db->numfrag < 4 && db->fragshift > 3) {
1781                 db->fragshift--;
1782                 db->numfrag = bufs >> db->fragshift;
1783         }
1784         db->fragsize = 1 << db->fragshift;
1785         if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag)
1786                 db->numfrag = db->ossmaxfrags;
1787         db->fragsamples = db->fragsize >> sample_shift[fmt];
1788         db->dmasize = db->numfrag << db->fragshift;
1789
1790         M_printk("maestro: setup oss: numfrag: %d fragsize: %d dmasize: %d\n",db->numfrag,db->fragsize,db->dmasize);
1791
1792         memset(db->rawbuf, (fmt & ESS_FMT_16BIT) ? 0 : 0x80, db->dmasize);
1793
1794         spin_lock_irqsave(&s->lock, flags);
1795         if (rec) 
1796                 ess_rec_setup(s, fmt, s->rateadc, db->rawbuf, db->dmasize);
1797         else 
1798                 ess_play_setup(s, fmt, s->ratedac, db->rawbuf, db->dmasize);
1799
1800         spin_unlock_irqrestore(&s->lock, flags);
1801         db->ready = 1;
1802
1803         return 0;
1804 }
1805
1806 static __inline__ void 
1807 clear_advance(struct ess_state *s)
1808 {
1809         unsigned char c = ((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_16BIT) ? 0 : 0x80;
1810         
1811         unsigned char *buf = s->dma_dac.rawbuf;
1812         unsigned bsize = s->dma_dac.dmasize;
1813         unsigned bptr = s->dma_dac.swptr;
1814         unsigned len = s->dma_dac.fragsize;
1815         
1816         if (bptr + len > bsize) {
1817                 unsigned x = bsize - bptr;
1818                 memset(buf + bptr, c, x);
1819                 /* account for wrapping? */
1820                 bptr = 0;
1821                 len -= x;
1822         }
1823         memset(buf + bptr, c, len);
1824 }
1825
1826 /* call with spinlock held! */
1827 static void 
1828 ess_update_ptr(struct ess_state *s)
1829 {
1830         unsigned hwptr;
1831         int diff;
1832
1833         /* update ADC pointer */
1834         if (s->dma_adc.ready) {
1835                 /* oh boy should this all be re-written.  everything in the current code paths think
1836                 that the various counters/pointers are expressed in bytes to the user but we have
1837                 two apus doing stereo stuff so we fix it up here.. it propagates to all the various
1838                 counters from here.  */
1839                 if ( s->fmt & (ESS_FMT_STEREO << ESS_ADC_SHIFT)) {
1840                         hwptr = (get_dmac(s)*2) % s->dma_adc.dmasize;
1841                 } else {
1842                         hwptr = get_dmac(s) % s->dma_adc.dmasize;
1843                 }
1844                 diff = (s->dma_adc.dmasize + hwptr - s->dma_adc.hwptr) % s->dma_adc.dmasize;
1845                 s->dma_adc.hwptr = hwptr;
1846                 s->dma_adc.total_bytes += diff;
1847                 s->dma_adc.count += diff;
1848                 if (s->dma_adc.count >= (signed)s->dma_adc.fragsize) 
1849                         wake_up(&s->dma_adc.wait);
1850                 if (!s->dma_adc.mapped) {
1851                         if (s->dma_adc.count > (signed)(s->dma_adc.dmasize - ((3 * s->dma_adc.fragsize) >> 1))) {
1852                                 /* FILL ME 
1853                                 wrindir(s, SV_CIENABLE, s->enable); */
1854                                 stop_adc(s); 
1855                                 /* brute force everyone back in sync, sigh */
1856                                 s->dma_adc.count = 0;
1857                                 s->dma_adc.swptr = 0;
1858                                 s->dma_adc.hwptr = 0;
1859                                 s->dma_adc.error++;
1860                         }
1861                 }
1862         }
1863         /* update DAC pointer */
1864         if (s->dma_dac.ready) {
1865                 hwptr = get_dmaa(s) % s->dma_dac.dmasize; 
1866                 /* the apu only reports the length it has seen, not the
1867                         length of the memory that has been used (the WP
1868                         knows that) */
1869                 if ( ((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK) == (ESS_FMT_STEREO|ESS_FMT_16BIT))
1870                         hwptr<<=1;
1871
1872                 diff = (s->dma_dac.dmasize + hwptr - s->dma_dac.hwptr) % s->dma_dac.dmasize;
1873 /*              M_printk("updating dac: hwptr: %d diff: %d\n",hwptr,diff);*/
1874                 s->dma_dac.hwptr = hwptr;
1875                 s->dma_dac.total_bytes += diff;
1876                 if (s->dma_dac.mapped) {
1877                         s->dma_dac.count += diff;
1878                         if (s->dma_dac.count >= (signed)s->dma_dac.fragsize) {
1879                                 wake_up(&s->dma_dac.wait);
1880                         }
1881                 } else {
1882                         s->dma_dac.count -= diff;
1883 /*                      M_printk("maestro: ess_update_ptr: diff: %d, count: %d\n", diff, s->dma_dac.count); */
1884                         if (s->dma_dac.count <= 0) {
1885                                 M_printk("underflow! diff: %d count: %d hw: %d sw: %d\n", diff, s->dma_dac.count, 
1886                                         hwptr, s->dma_dac.swptr);
1887                                 /* FILL ME 
1888                                 wrindir(s, SV_CIENABLE, s->enable); */
1889                                 /* XXX how on earth can calling this with the lock held work.. */
1890                                 stop_dac(s);
1891                                 /* brute force everyone back in sync, sigh */
1892                                 s->dma_dac.count = 0; 
1893                                 s->dma_dac.swptr = hwptr; 
1894                                 s->dma_dac.error++;
1895                         } else if (s->dma_dac.count <= (signed)s->dma_dac.fragsize && !s->dma_dac.endcleared) {
1896                                 clear_advance(s);
1897                                 s->dma_dac.endcleared = 1;
1898                         }
1899                         if (s->dma_dac.count + (signed)s->dma_dac.fragsize <= (signed)s->dma_dac.dmasize) {
1900                                 wake_up(&s->dma_dac.wait);
1901 /*                              printk("waking up DAC count: %d sw: %d hw: %d\n",s->dma_dac.count, s->dma_dac.swptr, 
1902                                         hwptr);*/
1903                         }
1904                 }
1905         }
1906 }
1907
1908 static irqreturn_t
1909 ess_interrupt(int irq, void *dev_id, struct pt_regs *regs)
1910 {
1911         struct ess_state *s;
1912         struct ess_card *c = (struct ess_card *)dev_id;
1913         int i;
1914         u32 event;
1915
1916         if ( ! (event = inb(c->iobase+0x1A)) )
1917                 return IRQ_NONE;
1918
1919         outw(inw(c->iobase+4)&1, c->iobase+4);
1920
1921 /*      M_printk("maestro int: %x\n",event);*/
1922         if(event&(1<<6))
1923         {
1924                 int x;
1925                 enum {UP_EVT, DOWN_EVT, MUTE_EVT} vol_evt;
1926                 int volume;
1927
1928                 /* Figure out which volume control button was pushed,
1929                    based on differences from the default register
1930                    values. */
1931                 x = inb(c->iobase+0x1c);
1932                 if (x&1) vol_evt = MUTE_EVT;
1933                 else if (((x>>1)&7) > 4) vol_evt = UP_EVT;
1934                 else vol_evt = DOWN_EVT;
1935
1936                 /* Reset the volume control registers. */
1937                 outb(0x88, c->iobase+0x1c);
1938                 outb(0x88, c->iobase+0x1d);
1939                 outb(0x88, c->iobase+0x1e);
1940                 outb(0x88, c->iobase+0x1f);
1941
1942                 /* Deal with the button press in a hammer-handed
1943                    manner by adjusting the master mixer volume. */
1944                 volume = c->mix.mixer_state[0] & 0xff;
1945                 if (vol_evt == UP_EVT) {
1946                         volume += 5;
1947                         if (volume > 100)
1948                                 volume = 100;
1949                 }
1950                 else if (vol_evt == DOWN_EVT) {
1951                         volume -= 5;
1952                         if (volume < 0)
1953                                 volume = 0;
1954                 } else {
1955                         /* vol_evt == MUTE_EVT */
1956                         if (volume == 0)
1957                                 volume = c->dock_mute_vol;
1958                         else {
1959                                 c->dock_mute_vol = volume;
1960                                 volume = 0;
1961                         }
1962                 }
1963                 set_mixer (c, 0, (volume << 8) | volume);
1964         }
1965
1966         /* Ack all the interrupts. */
1967         outb(0xFF, c->iobase+0x1A);
1968                 
1969         /*
1970          *      Update the pointers for all APU's we are running.
1971          */
1972         for(i=0;i<NR_DSPS;i++)
1973         {
1974                 s=&c->channels[i];
1975                 if(s->dev_audio == -1)
1976                         break;
1977                 spin_lock(&s->lock);
1978                 ess_update_ptr(s);
1979                 spin_unlock(&s->lock);
1980         }
1981         return IRQ_HANDLED;
1982 }
1983
1984
1985 /* --------------------------------------------------------------------- */
1986
1987 static const char invalid_magic[] = KERN_CRIT "maestro: invalid magic value in %s\n";
1988
1989 #define VALIDATE_MAGIC(FOO,MAG)                         \
1990 ({                                                \
1991         if (!(FOO) || (FOO)->magic != MAG) { \
1992                 printk(invalid_magic,__FUNCTION__);            \
1993                 return -ENXIO;                    \
1994         }                                         \
1995 })
1996
1997 #define VALIDATE_STATE(a) VALIDATE_MAGIC(a,ESS_STATE_MAGIC)
1998 #define VALIDATE_CARD(a) VALIDATE_MAGIC(a,ESS_CARD_MAGIC)
1999
2000 static void set_mixer(struct ess_card *card,unsigned int mixer, unsigned int val ) 
2001 {
2002         unsigned int left,right;
2003         /* cleanse input a little */
2004         right = ((val >> 8)  & 0xff) ;
2005         left = (val  & 0xff) ;
2006
2007         if(right > 100) right = 100;
2008         if(left > 100) left = 100;
2009
2010         card->mix.mixer_state[mixer]=(right << 8) | left;
2011         card->mix.write_mixer(card,mixer,left,right);
2012 }
2013
2014 static void
2015 mixer_push_state(struct ess_card *card)
2016 {
2017         int i;
2018         for(i = 0 ; i < SOUND_MIXER_NRDEVICES ; i++) {
2019                 if( ! supported_mixer(card,i)) continue;
2020
2021                 set_mixer(card,i,card->mix.mixer_state[i]);
2022         }
2023 }
2024
2025 static int mixer_ioctl(struct ess_card *card, unsigned int cmd, unsigned long arg)
2026 {
2027         int i, val=0;
2028         unsigned long flags;
2029         void __user *argp = (void __user *)arg;
2030         int __user *p = argp;
2031
2032         VALIDATE_CARD(card);
2033         if (cmd == SOUND_MIXER_INFO) {
2034                 mixer_info info;
2035                 memset(&info, 0, sizeof(info));
2036                 strlcpy(info.id, card_names[card->card_type], sizeof(info.id));
2037                 strlcpy(info.name, card_names[card->card_type], sizeof(info.name));
2038                 info.modify_counter = card->mix.modcnt;
2039                 if (copy_to_user(argp, &info, sizeof(info)))
2040                         return -EFAULT;
2041                 return 0;
2042         }
2043         if (cmd == SOUND_OLD_MIXER_INFO) {
2044                 _old_mixer_info info;
2045                 memset(&info, 0, sizeof(info));
2046                 strlcpy(info.id, card_names[card->card_type], sizeof(info.id));
2047                 strlcpy(info.name, card_names[card->card_type], sizeof(info.name));
2048                 if (copy_to_user(argp, &info, sizeof(info)))
2049                         return -EFAULT;
2050                 return 0;
2051         }
2052         if (cmd == OSS_GETVERSION)
2053                 return put_user(SOUND_VERSION, p);
2054
2055         if (_IOC_TYPE(cmd) != 'M' || _IOC_SIZE(cmd) != sizeof(int))
2056                 return -EINVAL;
2057
2058         if (_IOC_DIR(cmd) == _IOC_READ) {
2059                 switch (_IOC_NR(cmd)) {
2060                 case SOUND_MIXER_RECSRC: /* give them the current record source */
2061
2062                         if(!card->mix.recmask_io) {
2063                                 val = 0;
2064                         } else {
2065                                spin_lock_irqsave(&card->lock, flags);
2066                                 val = card->mix.recmask_io(card,1,0);
2067                                spin_unlock_irqrestore(&card->lock, flags);
2068                         }
2069                         break;
2070                         
2071                 case SOUND_MIXER_DEVMASK: /* give them the supported mixers */
2072                         val = card->mix.supported_mixers;
2073                         break;
2074
2075                 case SOUND_MIXER_RECMASK: /* Arg contains a bit for each supported recording source */
2076                         val = card->mix.record_sources;
2077                         break;
2078                         
2079                 case SOUND_MIXER_STEREODEVS: /* Mixer channels supporting stereo */
2080                         val = card->mix.stereo_mixers;
2081                         break;
2082                         
2083                 case SOUND_MIXER_CAPS:
2084                         val = SOUND_CAP_EXCL_INPUT;
2085                         break;
2086
2087                 default: /* read a specific mixer */
2088                         i = _IOC_NR(cmd);
2089
2090                         if ( ! supported_mixer(card,i)) 
2091                                 return -EINVAL;
2092
2093                         /* do we ever want to touch the hardware? */
2094 /*                     spin_lock_irqsave(&card->lock, flags);
2095                         val = card->mix.read_mixer(card,i);
2096                        spin_unlock_irqrestore(&card->lock, flags);*/
2097
2098                         val = card->mix.mixer_state[i];
2099 /*                      M_printk("returned 0x%x for mixer %d\n",val,i);*/
2100
2101                         break;
2102                 }
2103                 return put_user(val, p);
2104         }
2105         
2106         if (_IOC_DIR(cmd) != (_IOC_WRITE|_IOC_READ))
2107                 return -EINVAL;
2108         
2109         card->mix.modcnt++;
2110
2111         if (get_user(val, p))
2112                 return -EFAULT;
2113
2114         switch (_IOC_NR(cmd)) {
2115         case SOUND_MIXER_RECSRC: /* Arg contains a bit for each recording source */
2116
2117                 if (!card->mix.recmask_io) return -EINVAL;
2118                 if(!val) return 0;
2119                 if(! (val &= card->mix.record_sources)) return -EINVAL;
2120
2121                spin_lock_irqsave(&card->lock, flags);
2122                 card->mix.recmask_io(card,0,val);
2123                spin_unlock_irqrestore(&card->lock, flags);
2124                 return 0;
2125
2126         default:
2127                 i = _IOC_NR(cmd);
2128
2129                 if ( ! supported_mixer(card,i)) 
2130                         return -EINVAL;
2131
2132                spin_lock_irqsave(&card->lock, flags);
2133                 set_mixer(card,i,val);
2134                spin_unlock_irqrestore(&card->lock, flags);
2135
2136                 return 0;
2137         }
2138 }
2139
2140 /* --------------------------------------------------------------------- */
2141 static int ess_open_mixdev(struct inode *inode, struct file *file)
2142 {
2143         unsigned int minor = iminor(inode);
2144         struct ess_card *card = NULL;
2145         struct pci_dev *pdev = NULL;
2146         struct pci_driver *drvr;
2147
2148         while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) {
2149                 drvr = pci_dev_driver (pdev);
2150                 if (drvr == &maestro_pci_driver) {
2151                         card = (struct ess_card*)pci_get_drvdata (pdev);
2152                         if (!card)
2153                                 continue;
2154                         if (card->dev_mixer == minor)
2155                                 break;
2156                 }
2157         }
2158         if (!card)
2159                 return -ENODEV;
2160         file->private_data = card;
2161         return nonseekable_open(inode, file);
2162 }
2163
2164 static int ess_release_mixdev(struct inode *inode, struct file *file)
2165 {
2166         struct ess_card *card = (struct ess_card *)file->private_data;
2167
2168         VALIDATE_CARD(card);
2169         
2170         return 0;
2171 }
2172
2173 static int ess_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
2174 {
2175         struct ess_card *card = (struct ess_card *)file->private_data;
2176
2177         VALIDATE_CARD(card);
2178
2179         return mixer_ioctl(card, cmd, arg);
2180 }
2181
2182 static /*const*/ struct file_operations ess_mixer_fops = {
2183         .owner          = THIS_MODULE,
2184         .llseek         = no_llseek,
2185         .ioctl          = ess_ioctl_mixdev,
2186         .open           = ess_open_mixdev,
2187         .release        = ess_release_mixdev,
2188 };
2189
2190 /* --------------------------------------------------------------------- */
2191
2192 static int drain_dac(struct ess_state *s, int nonblock)
2193 {
2194         DECLARE_WAITQUEUE(wait,current);
2195         unsigned long flags;
2196         int count;
2197         signed long tmo;
2198
2199         if (s->dma_dac.mapped || !s->dma_dac.ready)
2200                 return 0;
2201         current->state = TASK_INTERRUPTIBLE;
2202         add_wait_queue(&s->dma_dac.wait, &wait);
2203         for (;;) {
2204                 /* XXX uhm.. questionable locking*/
2205                 spin_lock_irqsave(&s->lock, flags);
2206                 count = s->dma_dac.count;
2207                 spin_unlock_irqrestore(&s->lock, flags);
2208                 if (count <= 0)
2209                         break;
2210                 if (signal_pending(current))
2211                         break;
2212                 if (nonblock) {
2213                         remove_wait_queue(&s->dma_dac.wait, &wait);
2214                         current->state = TASK_RUNNING;
2215                         return -EBUSY;
2216                 }
2217                 tmo = (count * HZ) / s->ratedac;
2218                 tmo >>= sample_shift[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK];
2219                 /* XXX this is just broken.  someone is waking us up alot, or schedule_timeout is broken.
2220                         or something.  who cares. - zach */
2221                 if (!schedule_timeout(tmo ? tmo : 1) && tmo)
2222                         M_printk(KERN_DEBUG "maestro: dma timed out?? %ld\n",jiffies);
2223         }
2224         remove_wait_queue(&s->dma_dac.wait, &wait);
2225         current->state = TASK_RUNNING;
2226         if (signal_pending(current))
2227                 return -ERESTARTSYS;
2228         return 0;
2229 }
2230
2231 /* --------------------------------------------------------------------- */
2232 /* Zach sez: "god this is gross.." */
2233 static int 
2234 comb_stereo(unsigned char *real_buffer,unsigned char  *tmp_buffer, int offset, 
2235         int count, int bufsize)
2236 {  
2237         /* No such thing as stereo recording, so we
2238         use dual input mixers.  which means we have to 
2239         combine mono to stereo buffer.  yuck. 
2240
2241         but we don't have to be able to work a byte at a time..*/
2242
2243         unsigned char *so,*left,*right;
2244         int i;
2245
2246         so = tmp_buffer;
2247         left = real_buffer + offset;
2248         right = real_buffer + bufsize/2 + offset;
2249
2250 /*      M_printk("comb_stereo writing %d to %p from %p and %p, offset: %d size: %d\n",count/2, tmp_buffer,left,right,offset,bufsize);*/
2251
2252         for(i=count/4; i ; i--) {
2253                 (*(so+2)) = *(right++);
2254                 (*(so+3)) = *(right++);
2255                 (*so) = *(left++);
2256                 (*(so+1)) = *(left++);
2257                 so+=4;
2258         }
2259
2260         return 0;
2261 }
2262
2263 /* in this loop, dma_adc.count signifies the amount of data thats waiting
2264         to be copied to the user's buffer.  it is filled by the interrupt
2265         handler and drained by this loop. */
2266 static ssize_t 
2267 ess_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
2268 {
2269         struct ess_state *s = (struct ess_state *)file->private_data;
2270         ssize_t ret;
2271         unsigned long flags;
2272         unsigned swptr;
2273         int cnt;
2274         unsigned char *combbuf = NULL;
2275         
2276         VALIDATE_STATE(s);
2277         if (s->dma_adc.mapped)
2278                 return -ENXIO;
2279         if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
2280                 return ret;
2281         if (!access_ok(VERIFY_WRITE, buffer, count))
2282                 return -EFAULT;
2283         if(!(combbuf = kmalloc(count,GFP_KERNEL)))
2284                 return -ENOMEM;
2285         ret = 0;
2286
2287         calc_bob_rate(s);
2288
2289         while (count > 0) {
2290                 spin_lock_irqsave(&s->lock, flags);
2291                 /* remember, all these things are expressed in bytes to be
2292                         sent to the user.. hence the evil / 2 down below */
2293                 swptr = s->dma_adc.swptr;
2294                 cnt = s->dma_adc.dmasize-swptr;
2295                 if (s->dma_adc.count < cnt)
2296                         cnt = s->dma_adc.count;
2297                 spin_unlock_irqrestore(&s->lock, flags);
2298
2299                 if (cnt > count)
2300                         cnt = count;
2301
2302                 if ( cnt > 0 ) cnt &= ~3;
2303
2304                 if (cnt <= 0) {
2305                         start_adc(s);
2306                         if (file->f_flags & O_NONBLOCK) 
2307                         {
2308                                 ret = ret ? ret : -EAGAIN;
2309                                 goto rec_return_free;
2310                         }
2311                         if (!interruptible_sleep_on_timeout(&s->dma_adc.wait, HZ)) {
2312                                 if(! s->card->in_suspend) printk(KERN_DEBUG "maestro: read: chip lockup? dmasz %u fragsz %u count %i hwptr %u swptr %u\n",
2313                                        s->dma_adc.dmasize, s->dma_adc.fragsize, s->dma_adc.count, 
2314                                        s->dma_adc.hwptr, s->dma_adc.swptr);
2315                                 stop_adc(s);
2316                                 spin_lock_irqsave(&s->lock, flags);
2317                                 set_dmac(s, virt_to_bus(s->dma_adc.rawbuf), s->dma_adc.numfrag << s->dma_adc.fragshift);
2318                                 /* program enhanced mode registers */
2319                                 /* FILL ME */
2320 /*                              wrindir(s, SV_CIDMACBASECOUNT1, (s->dma_adc.fragsamples-1) >> 8);
2321                                 wrindir(s, SV_CIDMACBASECOUNT0, s->dma_adc.fragsamples-1); */
2322                                 s->dma_adc.count = s->dma_adc.hwptr = s->dma_adc.swptr = 0;
2323                                 spin_unlock_irqrestore(&s->lock, flags);
2324                         }
2325                         if (signal_pending(current)) 
2326                         {
2327                                 ret = ret ? ret : -ERESTARTSYS;
2328                                 goto rec_return_free;
2329                         }
2330                         continue;
2331                 }
2332         
2333                 if(s->fmt & (ESS_FMT_STEREO << ESS_ADC_SHIFT)) {
2334                         /* swptr/2 so that we know the real offset in each apu's buffer */
2335                         comb_stereo(s->dma_adc.rawbuf,combbuf,swptr/2,cnt,s->dma_adc.dmasize);
2336                         if (copy_to_user(buffer, combbuf, cnt)) {
2337                                 ret = ret ? ret : -EFAULT;
2338                                 goto rec_return_free;
2339                         }
2340                 } else  {
2341                         if (copy_to_user(buffer, s->dma_adc.rawbuf + swptr, cnt)) {
2342                                 ret = ret ? ret : -EFAULT;
2343                                 goto rec_return_free;
2344                         }
2345                 }
2346
2347                 swptr = (swptr + cnt) % s->dma_adc.dmasize;
2348                 spin_lock_irqsave(&s->lock, flags);
2349                 s->dma_adc.swptr = swptr;
2350                 s->dma_adc.count -= cnt;
2351                 spin_unlock_irqrestore(&s->lock, flags);
2352                 count -= cnt;
2353                 buffer += cnt;
2354                 ret += cnt;
2355                 start_adc(s);
2356         }
2357
2358 rec_return_free:
2359         kfree(combbuf);
2360         return ret;
2361 }
2362
2363 static ssize_t 
2364 ess_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
2365 {
2366         struct ess_state *s = (struct ess_state *)file->private_data;
2367         ssize_t ret;
2368         unsigned long flags;
2369         unsigned swptr;
2370         int cnt;
2371         
2372         VALIDATE_STATE(s);
2373         if (s->dma_dac.mapped)
2374                 return -ENXIO;
2375         if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
2376                 return ret;
2377         if (!access_ok(VERIFY_READ, buffer, count))
2378                 return -EFAULT;
2379         ret = 0;
2380
2381         calc_bob_rate(s);
2382
2383         while (count > 0) {
2384                 spin_lock_irqsave(&s->lock, flags);
2385
2386                 if (s->dma_dac.count < 0) {
2387                         s->dma_dac.count = 0;
2388                         s->dma_dac.swptr = s->dma_dac.hwptr;
2389                 }
2390                 swptr = s->dma_dac.swptr;
2391
2392                 cnt = s->dma_dac.dmasize-swptr;
2393
2394                 if (s->dma_dac.count + cnt > s->dma_dac.dmasize)
2395                         cnt = s->dma_dac.dmasize - s->dma_dac.count;
2396
2397                 spin_unlock_irqrestore(&s->lock, flags);
2398
2399                 if (cnt > count)
2400                         cnt = count;
2401
2402                 if (cnt <= 0) {
2403                         start_dac(s);
2404                         if (file->f_flags & O_NONBLOCK) {
2405                                 if(!ret) ret = -EAGAIN;
2406                                 goto return_free;
2407                         }
2408                         if (!interruptible_sleep_on_timeout(&s->dma_dac.wait, HZ)) {
2409                                 if(! s->card->in_suspend) printk(KERN_DEBUG "maestro: write: chip lockup? dmasz %u fragsz %u count %i hwptr %u swptr %u\n",
2410                                        s->dma_dac.dmasize, s->dma_dac.fragsize, s->dma_dac.count, 
2411                                        s->dma_dac.hwptr, s->dma_dac.swptr);
2412                                 stop_dac(s);
2413                                 spin_lock_irqsave(&s->lock, flags);
2414                                 set_dmaa(s, virt_to_bus(s->dma_dac.rawbuf), s->dma_dac.numfrag << s->dma_dac.fragshift);
2415                                 /* program enhanced mode registers */
2416 /*                              wrindir(s, SV_CIDMAABASECOUNT1, (s->dma_dac.fragsamples-1) >> 8);
2417                                 wrindir(s, SV_CIDMAABASECOUNT0, s->dma_dac.fragsamples-1); */
2418                                 /* FILL ME */
2419                                 s->dma_dac.count = s->dma_dac.hwptr = s->dma_dac.swptr = 0;
2420                                 spin_unlock_irqrestore(&s->lock, flags);
2421                         }
2422                         if (signal_pending(current)) {
2423                                 if (!ret) ret = -ERESTARTSYS;
2424                                 goto return_free;
2425                         }
2426                         continue;
2427                 }
2428                 if (copy_from_user(s->dma_dac.rawbuf + swptr, buffer, cnt)) {
2429                         if (!ret) ret = -EFAULT;
2430                         goto return_free;
2431                 }
2432 /*              printk("wrote %d bytes at sw: %d cnt: %d while hw: %d\n",cnt, swptr, s->dma_dac.count, s->dma_dac.hwptr);*/
2433
2434                 swptr = (swptr + cnt) % s->dma_dac.dmasize;
2435
2436                 spin_lock_irqsave(&s->lock, flags);
2437                 s->dma_dac.swptr = swptr;
2438                 s->dma_dac.count += cnt;
2439                 s->dma_dac.endcleared = 0;
2440                 spin_unlock_irqrestore(&s->lock, flags);
2441                 count -= cnt;
2442                 buffer += cnt;
2443                 ret += cnt;
2444                 start_dac(s);
2445         }
2446 return_free:
2447         return ret;
2448 }
2449
2450 /* No kernel lock - we have our own spinlock */
2451 static unsigned int ess_poll(struct file *file, struct poll_table_struct *wait)
2452 {
2453         struct ess_state *s = (struct ess_state *)file->private_data;
2454         unsigned long flags;
2455         unsigned int mask = 0;
2456
2457         VALIDATE_STATE(s);
2458
2459 /* In 0.14 prog_dmabuf always returns success anyway ... */
2460         if (file->f_mode & FMODE_WRITE) {
2461                 if (!s->dma_dac.ready && prog_dmabuf(s, 0)) 
2462                         return 0;
2463         }
2464         if (file->f_mode & FMODE_READ) {
2465                 if (!s->dma_adc.ready && prog_dmabuf(s, 1))
2466                         return 0;
2467         }
2468
2469         if (file->f_mode & FMODE_WRITE)
2470                 poll_wait(file, &s->dma_dac.wait, wait);
2471         if (file->f_mode & FMODE_READ)
2472                 poll_wait(file, &s->dma_adc.wait, wait);
2473         spin_lock_irqsave(&s->lock, flags);
2474         ess_update_ptr(s);
2475         if (file->f_mode & FMODE_READ) {
2476                 if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
2477                         mask |= POLLIN | POLLRDNORM;
2478         }
2479         if (file->f_mode & FMODE_WRITE) {
2480                 if (s->dma_dac.mapped) {
2481                         if (s->dma_dac.count >= (signed)s->dma_dac.fragsize) 
2482                                 mask |= POLLOUT | POLLWRNORM;
2483                 } else {
2484                         if ((signed)s->dma_dac.dmasize >= s->dma_dac.count + (signed)s->dma_dac.fragsize)
2485                                 mask |= POLLOUT | POLLWRNORM;
2486                 }
2487         }
2488         spin_unlock_irqrestore(&s->lock, flags);
2489         return mask;
2490 }
2491
2492 static int ess_mmap(struct file *file, struct vm_area_struct *vma)
2493 {
2494         struct ess_state *s = (struct ess_state *)file->private_data;
2495         struct dmabuf *db;
2496         int ret = -EINVAL;
2497         unsigned long size;
2498
2499         VALIDATE_STATE(s);
2500         lock_kernel();
2501         if (vma->vm_flags & VM_WRITE) {
2502                 if ((ret = prog_dmabuf(s, 1)) != 0)
2503                         goto out;
2504                 db = &s->dma_dac;
2505         } else 
2506 #if 0
2507         /* if we can have the wp/wc do the combining
2508                 we can turn this back on.  */
2509               if (vma->vm_flags & VM_READ) {
2510                 if ((ret = prog_dmabuf(s, 0)) != 0)
2511                         goto out;
2512                 db = &s->dma_adc;
2513         } else  
2514 #endif
2515                 goto out;
2516         ret = -EINVAL;
2517         if (vma->vm_pgoff != 0)
2518                 goto out;
2519         size = vma->vm_end - vma->vm_start;
2520         if (size > (PAGE_SIZE << db->buforder))
2521                 goto out;
2522         ret = -EAGAIN;
2523         if (remap_pfn_range(vma, vma->vm_start,
2524                         virt_to_phys(db->rawbuf) >> PAGE_SHIFT,
2525                         size, vma->vm_page_prot))
2526                 goto out;
2527         db->mapped = 1;
2528         ret = 0;
2529 out:
2530         unlock_kernel();
2531         return ret;
2532 }
2533
2534 static int ess_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
2535 {
2536         struct ess_state *s = (struct ess_state *)file->private_data;
2537         unsigned long flags;
2538         audio_buf_info abinfo;
2539         count_info cinfo;
2540         int val, mapped, ret;
2541         unsigned char fmtm, fmtd;
2542         void __user *argp = (void __user *)arg;
2543         int __user *p = argp;
2544
2545 /*      printk("maestro: ess_ioctl: cmd %d\n", cmd);*/
2546         
2547         VALIDATE_STATE(s);
2548         mapped = ((file->f_mode & FMODE_WRITE) && s->dma_dac.mapped) ||
2549                 ((file->f_mode & FMODE_READ) && s->dma_adc.mapped);
2550         switch (cmd) {
2551         case OSS_GETVERSION:
2552                 return put_user(SOUND_VERSION, p);
2553
2554         case SNDCTL_DSP_SYNC:
2555                 if (file->f_mode & FMODE_WRITE)
2556                         return drain_dac(s, file->f_flags & O_NONBLOCK);
2557                 return 0;
2558                 
2559         case SNDCTL_DSP_SETDUPLEX:
2560                 /* XXX fix */
2561                 return 0;
2562
2563         case SNDCTL_DSP_GETCAPS:
2564                 return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, p);
2565                 
2566         case SNDCTL_DSP_RESET:
2567                 if (file->f_mode & FMODE_WRITE) {
2568                         stop_dac(s);
2569                         synchronize_irq(s->card->pcidev->irq);
2570                         s->dma_dac.swptr = s->dma_dac.hwptr = s->dma_dac.count = s->dma_dac.total_bytes = 0;
2571                 }
2572                 if (file->f_mode & FMODE_READ) {
2573                         stop_adc(s);
2574                         synchronize_irq(s->card->pcidev->irq);
2575                         s->dma_adc.swptr = s->dma_adc.hwptr = s->dma_adc.count = s->dma_adc.total_bytes = 0;
2576                 }
2577                 return 0;
2578
2579         case SNDCTL_DSP_SPEED:
2580                 if (get_user(val, p))
2581                         return -EFAULT;
2582                 if (val >= 0) {
2583                         if (file->f_mode & FMODE_READ) {
2584                                 stop_adc(s);
2585                                 s->dma_adc.ready = 0;
2586                                 set_adc_rate(s, val);
2587                         }
2588                         if (file->f_mode & FMODE_WRITE) {
2589                                 stop_dac(s);
2590                                 s->dma_dac.ready = 0;
2591                                 set_dac_rate(s, val);
2592                         }
2593                 }
2594                 return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, p);
2595                 
2596         case SNDCTL_DSP_STEREO:
2597                 if (get_user(val, p))
2598                         return -EFAULT;
2599                 fmtd = 0;
2600                 fmtm = ~0;
2601                 if (file->f_mode & FMODE_READ) {
2602                         stop_adc(s);
2603                         s->dma_adc.ready = 0;
2604                         if (val)
2605                                 fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
2606                         else
2607                                 fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
2608                 }
2609                 if (file->f_mode & FMODE_WRITE) {
2610                         stop_dac(s);
2611                         s->dma_dac.ready = 0;
2612                         if (val)
2613                                 fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
2614                         else
2615                                 fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
2616                 }
2617                 set_fmt(s, fmtm, fmtd);
2618                 return 0;
2619
2620         case SNDCTL_DSP_CHANNELS:
2621                 if (get_user(val, p))
2622                         return -EFAULT;
2623                 if (val != 0) {
2624                         fmtd = 0;
2625                         fmtm = ~0;
2626                         if (file->f_mode & FMODE_READ) {
2627                                 stop_adc(s);
2628                                 s->dma_adc.ready = 0;
2629                                 if (val >= 2)
2630                                         fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
2631                                 else
2632                                         fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
2633                         }
2634                         if (file->f_mode & FMODE_WRITE) {
2635                                 stop_dac(s);
2636                                 s->dma_dac.ready = 0;
2637                                 if (val >= 2)
2638                                         fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
2639                                 else
2640                                         fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
2641                         }
2642                         set_fmt(s, fmtm, fmtd);
2643                 }
2644                 return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT) 
2645                                            : (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, p);
2646                 
2647         case SNDCTL_DSP_GETFMTS: /* Returns a mask */
2648                 return put_user(AFMT_U8|AFMT_S16_LE, p);
2649                 
2650         case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
2651                 if (get_user(val, p))
2652                         return -EFAULT;
2653                 if (val != AFMT_QUERY) {
2654                         fmtd = 0;
2655                         fmtm = ~0;
2656                         if (file->f_mode & FMODE_READ) {
2657                                 stop_adc(s);
2658                                 s->dma_adc.ready = 0;
2659         /* fixed at 16bit for now */
2660                                 fmtd |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
2661 #if 0
2662                                 if (val == AFMT_S16_LE)
2663                                         fmtd |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
2664                                 else
2665                                         fmtm &= ~(ESS_FMT_16BIT << ESS_ADC_SHIFT);
2666 #endif
2667                         }
2668                         if (file->f_mode & FMODE_WRITE) {
2669                                 stop_dac(s);
2670                                 s->dma_dac.ready = 0;
2671                                 if (val == AFMT_S16_LE)
2672                                         fmtd |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
2673                                 else
2674                                         fmtm &= ~(ESS_FMT_16BIT << ESS_DAC_SHIFT);
2675                         }
2676                         set_fmt(s, fmtm, fmtd);
2677                 }
2678                 return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? 
2679                         (ESS_FMT_16BIT << ESS_ADC_SHIFT) 
2680                         : (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ? 
2681                                 AFMT_S16_LE : 
2682                                 AFMT_U8, 
2683                         p);
2684                 
2685         case SNDCTL_DSP_POST:
2686                 return 0;
2687
2688         case SNDCTL_DSP_GETTRIGGER:
2689                 val = 0;
2690                 if ((file->f_mode & FMODE_READ) && (s->enable & ADC_RUNNING))
2691                         val |= PCM_ENABLE_INPUT;
2692                 if ((file->f_mode & FMODE_WRITE) && (s->enable & DAC_RUNNING)) 
2693                         val |= PCM_ENABLE_OUTPUT;
2694                 return put_user(val, p);
2695                 
2696         case SNDCTL_DSP_SETTRIGGER:
2697                 if (get_user(val, p))
2698                         return -EFAULT;
2699                 if (file->f_mode & FMODE_READ) {
2700                         if (val & PCM_ENABLE_INPUT) {
2701                                 if (!s->dma_adc.ready && (ret =  prog_dmabuf(s, 1)))
2702                                         return ret;
2703                                 start_adc(s);
2704                         } else
2705                                 stop_adc(s);
2706                 }
2707                 if (file->f_mode & FMODE_WRITE) {
2708                         if (val & PCM_ENABLE_OUTPUT) {
2709                                 if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
2710                                         return ret;
2711                                 start_dac(s);
2712                         } else
2713                                 stop_dac(s);
2714                 }
2715                 return 0;
2716
2717         case SNDCTL_DSP_GETOSPACE:
2718                 if (!(file->f_mode & FMODE_WRITE))
2719                         return -EINVAL;
2720                 if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
2721                         return ret;
2722                 spin_lock_irqsave(&s->lock, flags);
2723                 ess_update_ptr(s);
2724                 abinfo.fragsize = s->dma_dac.fragsize;
2725                 abinfo.bytes = s->dma_dac.dmasize - s->dma_dac.count;
2726                 abinfo.fragstotal = s->dma_dac.numfrag;
2727                 abinfo.fragments = abinfo.bytes >> s->dma_dac.fragshift;      
2728                 spin_unlock_irqrestore(&s->lock, flags);
2729                 return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
2730
2731         case SNDCTL_DSP_GETISPACE:
2732                 if (!(file->f_mode & FMODE_READ))
2733                         return -EINVAL;
2734                 if (!s->dma_adc.ready && (ret =  prog_dmabuf(s, 1)))
2735                         return ret;
2736                 spin_lock_irqsave(&s->lock, flags);
2737                 ess_update_ptr(s);
2738                 abinfo.fragsize = s->dma_adc.fragsize;
2739                 abinfo.bytes = s->dma_adc.count;
2740                 abinfo.fragstotal = s->dma_adc.numfrag;
2741                 abinfo.fragments = abinfo.bytes >> s->dma_adc.fragshift;      
2742                 spin_unlock_irqrestore(&s->lock, flags);
2743                 return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
2744                 
2745         case SNDCTL_DSP_NONBLOCK:
2746                 file->f_flags |= O_NONBLOCK;
2747                 return 0;
2748
2749         case SNDCTL_DSP_GETODELAY:
2750                 if (!(file->f_mode & FMODE_WRITE))
2751                         return -EINVAL;
2752                 if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
2753                         return ret;
2754                 spin_lock_irqsave(&s->lock, flags);
2755                 ess_update_ptr(s);
2756                 val = s->dma_dac.count;
2757                 spin_unlock_irqrestore(&s->lock, flags);
2758                 return put_user(val, p);
2759
2760         case SNDCTL_DSP_GETIPTR:
2761                 if (!(file->f_mode & FMODE_READ))
2762                         return -EINVAL;
2763                 if (!s->dma_adc.ready && (ret =  prog_dmabuf(s, 1)))
2764                         return ret;
2765                 spin_lock_irqsave(&s->lock, flags);
2766                 ess_update_ptr(s);
2767                 cinfo.bytes = s->dma_adc.total_bytes;
2768                 cinfo.blocks = s->dma_adc.count >> s->dma_adc.fragshift;
2769                 cinfo.ptr = s->dma_adc.hwptr;
2770                 if (s->dma_adc.mapped)
2771                         s->dma_adc.count &= s->dma_adc.fragsize-1;
2772                 spin_unlock_irqrestore(&s->lock, flags);
2773                 if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
2774                         return -EFAULT;
2775                 return 0;
2776
2777         case SNDCTL_DSP_GETOPTR:
2778                 if (!(file->f_mode & FMODE_WRITE))
2779                         return -EINVAL;
2780                 if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
2781                         return ret;
2782                 spin_lock_irqsave(&s->lock, flags);
2783                 ess_update_ptr(s);
2784                 cinfo.bytes = s->dma_dac.total_bytes;
2785                 cinfo.blocks = s->dma_dac.count >> s->dma_dac.fragshift;
2786                 cinfo.ptr = s->dma_dac.hwptr;
2787                 if (s->dma_dac.mapped)
2788                         s->dma_dac.count &= s->dma_dac.fragsize-1;
2789                 spin_unlock_irqrestore(&s->lock, flags);
2790                 if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
2791                         return -EFAULT;
2792                 return 0;
2793
2794         case SNDCTL_DSP_GETBLKSIZE:
2795                 if (file->f_mode & FMODE_WRITE) {
2796                         if ((val = prog_dmabuf(s, 0)))
2797                                 return val;
2798                         return put_user(s->dma_dac.fragsize, p);
2799                 }
2800                 if ((val = prog_dmabuf(s, 1)))
2801                         return val;
2802                 return put_user(s->dma_adc.fragsize, p);
2803
2804         case SNDCTL_DSP_SETFRAGMENT:
2805                 if (get_user(val, p))
2806                         return -EFAULT;
2807                 M_printk("maestro: SETFRAGMENT: %0x\n",val);
2808                 if (file->f_mode & FMODE_READ) {
2809                         s->dma_adc.ossfragshift = val & 0xffff;
2810                         s->dma_adc.ossmaxfrags = (val >> 16) & 0xffff;
2811                         if (s->dma_adc.ossfragshift < 4)
2812                                 s->dma_adc.ossfragshift = 4;
2813                         if (s->dma_adc.ossfragshift > 15)
2814                                 s->dma_adc.ossfragshift = 15;
2815                         if (s->dma_adc.ossmaxfrags < 4)
2816                                 s->dma_adc.ossmaxfrags = 4;
2817                 }
2818                 if (file->f_mode & FMODE_WRITE) {
2819                         s->dma_dac.ossfragshift = val & 0xffff;
2820                         s->dma_dac.ossmaxfrags = (val >> 16) & 0xffff;
2821                         if (s->dma_dac.ossfragshift < 4)
2822                                 s->dma_dac.ossfragshift = 4;
2823                         if (s->dma_dac.ossfragshift > 15)
2824                                 s->dma_dac.ossfragshift = 15;
2825                         if (s->dma_dac.ossmaxfrags < 4)
2826                                 s->dma_dac.ossmaxfrags = 4;
2827                 }
2828                 return 0;
2829
2830         case SNDCTL_DSP_SUBDIVIDE:
2831                 if ((file->f_mode & FMODE_READ && s->dma_adc.subdivision) ||
2832                     (file->f_mode & FMODE_WRITE && s->dma_dac.subdivision))
2833                         return -EINVAL;
2834                 if (get_user(val, p))
2835                         return -EFAULT;
2836                 if (val != 1 && val != 2 && val != 4)
2837                         return -EINVAL;
2838                 if (file->f_mode & FMODE_READ)
2839                         s->dma_adc.subdivision = val;
2840                 if (file->f_mode & FMODE_WRITE)
2841                         s->dma_dac.subdivision = val;
2842                 return 0;
2843
2844         case SOUND_PCM_READ_RATE:
2845                 return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, p);
2846
2847         case SOUND_PCM_READ_CHANNELS:
2848                 return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT) 
2849                                            : (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, p);
2850
2851         case SOUND_PCM_READ_BITS:
2852                 return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_16BIT << ESS_ADC_SHIFT) 
2853                                            : (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ? 16 : 8, p);
2854
2855         case SOUND_PCM_WRITE_FILTER:
2856         case SNDCTL_DSP_SETSYNCRO:
2857         case SOUND_PCM_READ_FILTER:
2858                 return -EINVAL;
2859                 
2860         }
2861         return -EINVAL;
2862 }
2863
2864 static void
2865 set_base_registers(struct ess_state *s,void *vaddr)
2866 {
2867         unsigned long packed_phys = virt_to_bus(vaddr)>>12;
2868         wave_set_register(s, 0x01FC , packed_phys);
2869         wave_set_register(s, 0x01FD , packed_phys);
2870         wave_set_register(s, 0x01FE , packed_phys);
2871         wave_set_register(s, 0x01FF , packed_phys);
2872 }
2873
2874 /* 
2875  * this guy makes sure we're in the right power
2876  * state for what we want to be doing 
2877  */
2878 static void maestro_power(struct ess_card *card, int tostate)
2879 {
2880         u16 active_mask = acpi_state_mask[tostate];
2881         u8 state;
2882
2883         if(!use_pm) return;
2884
2885         pci_read_config_byte(card->pcidev, card->power_regs+0x4, &state);
2886         state&=3;
2887
2888         /* make sure we're in the right state */
2889         if(state != tostate) {
2890                 M_printk(KERN_WARNING "maestro: dev %02x:%02x.%x switching from D%d to D%d\n",
2891                         card->pcidev->bus->number, 
2892                         PCI_SLOT(card->pcidev->devfn),
2893                         PCI_FUNC(card->pcidev->devfn),
2894                         state,tostate);
2895                 pci_write_config_byte(card->pcidev, card->power_regs+0x4, tostate);
2896         }
2897
2898         /* and make sure the units we care about are on 
2899                 XXX we might want to do this before state flipping? */
2900         pci_write_config_word(card->pcidev, 0x54, ~ active_mask);
2901         pci_write_config_word(card->pcidev, 0x56, ~ active_mask);
2902 }
2903
2904 /* we allocate a large power of two for all our memory.
2905         this is cut up into (not to scale :):
2906         |silly fifo word        | 512byte mixbuf per adc        | dac/adc * channels |
2907 */
2908 static int
2909 allocate_buffers(struct ess_state *s)
2910 {
2911         void *rawbuf=NULL;
2912         int order,i;
2913         struct page *page, *pend;
2914
2915         /* alloc as big a chunk as we can */
2916         for (order = (dsps_order + (16-PAGE_SHIFT) + 1); order >= (dsps_order + 2 + 1); order--)
2917                 if((rawbuf = (void *)__get_free_pages(GFP_KERNEL|GFP_DMA, order)))
2918                         break;
2919
2920         if (!rawbuf)
2921                 return 1;
2922
2923         M_printk("maestro: allocated %ld (%d) bytes at %p\n",PAGE_SIZE<<order,order, rawbuf);
2924
2925         if ((virt_to_bus(rawbuf) + (PAGE_SIZE << order) - 1) & ~((1<<28)-1))  {
2926                 printk(KERN_ERR "maestro: DMA buffer beyond 256MB! busaddr 0x%lx  size %ld\n",
2927                         virt_to_bus(rawbuf), PAGE_SIZE << order);
2928                 kfree(rawbuf);
2929                 return 1;
2930         }
2931
2932         s->card->dmapages = rawbuf;
2933         s->card->dmaorder = order;
2934
2935         for(i=0;i<NR_DSPS;i++) {
2936                 struct ess_state *ess = &s->card->channels[i];
2937
2938                 if(ess->dev_audio == -1)
2939                         continue;
2940
2941                 ess->dma_dac.ready = s->dma_dac.mapped = 0;
2942                 ess->dma_adc.ready = s->dma_adc.mapped = 0;
2943                 ess->dma_adc.buforder = ess->dma_dac.buforder = order - 1 - dsps_order - 1;
2944
2945                 /* offset dac and adc buffers starting half way through and then at each [da][ad]c's
2946                         order's intervals.. */
2947                 ess->dma_dac.rawbuf = rawbuf + (PAGE_SIZE<<(order-1)) + (i * ( PAGE_SIZE << (ess->dma_dac.buforder + 1 )));
2948                 ess->dma_adc.rawbuf = ess->dma_dac.rawbuf + ( PAGE_SIZE << ess->dma_dac.buforder);
2949                 /* offset mixbuf by a mixbuf so that the lame status fifo can
2950                         happily scribble away.. */ 
2951                 ess->mixbuf = rawbuf + (512 * (i+1));
2952
2953                 M_printk("maestro: setup apu %d: dac: %p adc: %p mix: %p\n",i,ess->dma_dac.rawbuf,
2954                         ess->dma_adc.rawbuf, ess->mixbuf);
2955
2956         }
2957
2958         /* now mark the pages as reserved; otherwise remap_pfn_range doesn't do what we want */
2959         pend = virt_to_page(rawbuf + (PAGE_SIZE << order) - 1);
2960         for (page = virt_to_page(rawbuf); page <= pend; page++)
2961                 SetPageReserved(page);
2962
2963         return 0;
2964
2965 static void
2966 free_buffers(struct ess_state *s)
2967 {
2968         struct page *page, *pend;
2969
2970         s->dma_dac.rawbuf = s->dma_adc.rawbuf = NULL;
2971         s->dma_dac.mapped = s->dma_adc.mapped = 0;
2972         s->dma_dac.ready = s->dma_adc.ready = 0;
2973
2974         M_printk("maestro: freeing %p\n",s->card->dmapages);
2975         /* undo marking the pages as reserved */
2976
2977         pend = virt_to_page(s->card->dmapages + (PAGE_SIZE << s->card->dmaorder) - 1);
2978         for (page = virt_to_page(s->card->dmapages); page <= pend; page++)
2979                 ClearPageReserved(page);
2980
2981         free_pages((unsigned long)s->card->dmapages,s->card->dmaorder);
2982         s->card->dmapages = NULL;
2983 }
2984
2985 static int 
2986 ess_open(struct inode *inode, struct file *file)
2987 {
2988         unsigned int minor = iminor(inode);
2989         struct ess_state *s = NULL;
2990         unsigned char fmtm = ~0, fmts = 0;
2991         struct pci_dev *pdev = NULL;
2992         /*
2993          *      Scan the cards and find the channel. We only
2994          *      do this at open time so it is ok
2995          */
2996
2997         while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) {
2998                 struct ess_card *c;
2999                 struct pci_driver *drvr;
3000
3001                 drvr = pci_dev_driver (pdev);
3002                 if (drvr == &maestro_pci_driver) {
3003                         int i;
3004                         struct ess_state *sp;
3005
3006                         c = (struct ess_card*)pci_get_drvdata (pdev);
3007                         if (!c)
3008                                 continue;
3009                         for(i=0;i<NR_DSPS;i++)
3010                         {
3011                                 sp=&c->channels[i];
3012                                 if(sp->dev_audio < 0)
3013                                         continue;
3014                                 if((sp->dev_audio ^ minor) & ~0xf)
3015                                         continue;
3016                                 s=sp;
3017                         }
3018                 }
3019         }
3020         if (!s)
3021                 return -ENODEV;
3022
3023         VALIDATE_STATE(s);
3024         file->private_data = s;
3025         /* wait for device to become free */
3026         down(&s->open_sem);
3027         while (s->open_mode & file->f_mode) {
3028                 if (file->f_flags & O_NONBLOCK) {
3029                         up(&s->open_sem);
3030                         return -EWOULDBLOCK;
3031                 }
3032                 up(&s->open_sem);
3033                 interruptible_sleep_on(&s->open_wait);
3034                 if (signal_pending(current))
3035                         return -ERESTARTSYS;
3036                 down(&s->open_sem);
3037         }
3038
3039         /* under semaphore.. */
3040         if ((s->card->dmapages==NULL) && allocate_buffers(s)) {
3041                 up(&s->open_sem);
3042                 return -ENOMEM;
3043         }
3044
3045         /* we're covered by the open_sem */
3046         if( ! s->card->dsps_open )  {
3047                 maestro_power(s->card,ACPI_D0);
3048                 start_bob(s);
3049         }
3050         s->card->dsps_open++;
3051         M_printk("maestro: open, %d bobs now\n",s->card->dsps_open);
3052
3053         /* ok, lets write WC base regs now that we've 
3054                 powered up the chip */
3055         M_printk("maestro: writing 0x%lx (bus 0x%lx) to the wp\n",virt_to_bus(s->card->dmapages),
3056                 ((virt_to_bus(s->card->dmapages))&0xFFE00000)>>12);
3057         set_base_registers(s,s->card->dmapages);
3058
3059         if (file->f_mode & FMODE_READ) {
3060 /*
3061                 fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_ADC_SHIFT);
3062                 if ((minor & 0xf) == SND_DEV_DSP16)
3063                         fmts |= ESS_FMT_16BIT << ESS_ADC_SHIFT; */
3064
3065                 fmtm &= ~((ESS_FMT_STEREO|ESS_FMT_16BIT) << ESS_ADC_SHIFT);
3066                 fmts = (ESS_FMT_STEREO|ESS_FMT_16BIT) << ESS_ADC_SHIFT;
3067
3068                 s->dma_adc.ossfragshift = s->dma_adc.ossmaxfrags = s->dma_adc.subdivision = 0;
3069                 set_adc_rate(s, 8000);
3070         }
3071         if (file->f_mode & FMODE_WRITE) {
3072                 fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_DAC_SHIFT);
3073                 if ((minor & 0xf) == SND_DEV_DSP16)
3074                         fmts |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
3075
3076                 s->dma_dac.ossfragshift = s->dma_dac.ossmaxfrags = s->dma_dac.subdivision = 0;
3077                 set_dac_rate(s, 8000);
3078         }
3079         set_fmt(s, fmtm, fmts);
3080         s->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
3081
3082         up(&s->open_sem);
3083         return nonseekable_open(inode, file);
3084 }
3085
3086 static int 
3087 ess_release(struct inode *inode, struct file *file)
3088 {
3089         struct ess_state *s = (struct ess_state *)file->private_data;
3090
3091         VALIDATE_STATE(s);
3092         lock_kernel();
3093         if (file->f_mode & FMODE_WRITE)
3094                 drain_dac(s, file->f_flags & O_NONBLOCK);
3095         down(&s->open_sem);
3096         if (file->f_mode & FMODE_WRITE) {
3097                 stop_dac(s);
3098         }
3099         if (file->f_mode & FMODE_READ) {
3100                 stop_adc(s);
3101         }
3102                 
3103         s->open_mode &= (~file->f_mode) & (FMODE_READ|FMODE_WRITE);
3104         /* we're covered by the open_sem */
3105         M_printk("maestro: %d dsps now alive\n",s->card->dsps_open-1);
3106         if( --s->card->dsps_open <= 0) {
3107                 s->card->dsps_open = 0;
3108                 stop_bob(s);
3109                 free_buffers(s);
3110                 maestro_power(s->card,ACPI_D2);
3111         }
3112         up(&s->open_sem);
3113         wake_up(&s->open_wait);
3114         unlock_kernel();
3115         return 0;
3116 }
3117
3118 static struct file_operations ess_audio_fops = {
3119         .owner          = THIS_MODULE,
3120         .llseek         = no_llseek,
3121         .read           = ess_read,
3122         .write          = ess_write,
3123         .poll           = ess_poll,
3124         .ioctl          = ess_ioctl,
3125         .mmap           = ess_mmap,
3126         .open           = ess_open,
3127         .release        = ess_release,
3128 };
3129
3130 static int
3131 maestro_config(struct ess_card *card) 
3132 {
3133         struct pci_dev *pcidev = card->pcidev;
3134         struct ess_state *ess = &card->channels[0];
3135         int apu,iobase  = card->iobase;
3136         u16 w;
3137         u32 n;
3138
3139         /* We used to muck around with pci config space that
3140          * we had no business messing with.  We don't know enough
3141          * about the machine to know which DMA mode is appropriate, 
3142          * etc.  We were guessing wrong on some machines and making
3143          * them unhappy.  We now trust in the BIOS to do things right,
3144          * which almost certainly means a new host of problems will
3145          * arise with broken BIOS implementations.  screw 'em. 
3146          * We're already intolerant of machines that don't assign
3147          * IRQs.
3148          */
3149         
3150         /* do config work at full power */
3151         maestro_power(card,ACPI_D0);
3152          
3153         pci_read_config_word(pcidev, 0x50, &w);
3154
3155         w&=~(1<<5);                     /* Don't swap left/right (undoc)*/
3156         
3157         pci_write_config_word(pcidev, 0x50, w);
3158         
3159         pci_read_config_word(pcidev, 0x52, &w);
3160         w&=~(1<<15);            /* Turn off internal clock multiplier */
3161         /* XXX how do we know which to use? */
3162         w&=~(1<<14);            /* External clock */
3163         
3164         w|= (1<<7);             /* Hardware volume control on */
3165         w|= (1<<6);             /* Debounce off: easier to push the HWV buttons. */
3166         w&=~(1<<5);             /* GPIO 4:5 */
3167         w|= (1<<4);             /* Disconnect from the CHI.  Enabling this made a dell 7500 work. */
3168         w&=~(1<<2);             /* MIDI fix off (undoc) */
3169         w&=~(1<<1);             /* reserved, always write 0 */
3170         pci_write_config_word(pcidev, 0x52, w);
3171         
3172         /*
3173          *      Legacy mode
3174          */
3175
3176         pci_read_config_word(pcidev, 0x40, &w);
3177         w|=(1<<15);     /* legacy decode off */
3178         w&=~(1<<14);    /* Disable SIRQ */
3179         w&=~(0x1f);     /* disable mpu irq/io, game port, fm, SB */
3180          
3181         pci_write_config_word(pcidev, 0x40, w);
3182
3183         /* Set up 978 docking control chip. */
3184         pci_read_config_word(pcidev, 0x58, &w);
3185         w|=1<<2;        /* Enable 978. */
3186         w|=1<<3;        /* Turn on 978 hardware volume control. */
3187         w&=~(1<<11);    /* Turn on 978 mixer volume control. */
3188         pci_write_config_word(pcidev, 0x58, w);
3189         
3190         sound_reset(iobase);
3191
3192         /*
3193          *      Ring Bus Setup
3194          */
3195
3196         /* setup usual 0x34 stuff.. 0x36 may be chip specific */
3197         outw(0xC090, iobase+0x34); /* direct sound, stereo */
3198         udelay(20);
3199         outw(0x3000, iobase+0x36); /* direct sound, stereo */
3200         udelay(20);
3201
3202
3203         /*
3204          *      Reset the CODEC
3205          */
3206          
3207         maestro_ac97_reset(iobase,pcidev);
3208         
3209         /*
3210          *      Ring Bus Setup
3211          */
3212                  
3213         n=inl(iobase+0x34);
3214         n&=~0xF000;
3215         n|=12<<12;              /* Direct Sound, Stereo */
3216         outl(n, iobase+0x34);
3217
3218         n=inl(iobase+0x34);
3219         n&=~0x0F00;             /* Modem off */
3220         outl(n, iobase+0x34);
3221
3222         n=inl(iobase+0x34);
3223         n&=~0x00F0;
3224         n|=9<<4;                /* DAC, Stereo */
3225         outl(n, iobase+0x34);
3226         
3227         n=inl(iobase+0x34);
3228         n&=~0x000F;             /* ASSP off */
3229         outl(n, iobase+0x34);
3230         
3231         n=inl(iobase+0x34);
3232         n|=(1<<29);             /* Enable ring bus */
3233         outl(n, iobase+0x34);
3234         
3235         n=inl(iobase+0x34);
3236         n|=(1<<28);             /* Enable serial bus */
3237         outl(n, iobase+0x34);
3238         
3239         n=inl(iobase+0x34);
3240         n&=~0x00F00000;         /* MIC off */
3241         outl(n, iobase+0x34);
3242         
3243         n=inl(iobase+0x34);
3244         n&=~0x000F0000;         /* I2S off */
3245         outl(n, iobase+0x34);
3246         
3247
3248         w=inw(iobase+0x18);
3249         w&=~(1<<7);             /* ClkRun off */
3250         outw(w, iobase+0x18);
3251
3252         w=inw(iobase+0x18);
3253         w&=~(1<<6);             /* Hardware volume control interrupt off... for now. */
3254         outw(w, iobase+0x18);
3255         
3256         w=inw(iobase+0x18);
3257         w&=~(1<<4);             /* ASSP irq off */
3258         outw(w, iobase+0x18);
3259         
3260         w=inw(iobase+0x18);
3261         w&=~(1<<3);             /* ISDN irq off */
3262         outw(w, iobase+0x18);
3263         
3264         w=inw(iobase+0x18);
3265         w|=(1<<2);              /* Direct Sound IRQ on */
3266         outw(w, iobase+0x18);
3267
3268         w=inw(iobase+0x18);
3269         w&=~(1<<1);             /* MPU401 IRQ off */
3270         outw(w, iobase+0x18);
3271
3272         w=inw(iobase+0x18);
3273         w|=(1<<0);              /* SB IRQ on */
3274         outw(w, iobase+0x18);
3275
3276         /* Set hardware volume control registers to midpoints.
3277            We can tell which button was pushed based on how they change. */
3278         outb(0x88, iobase+0x1c);
3279         outb(0x88, iobase+0x1d);
3280         outb(0x88, iobase+0x1e);
3281         outb(0x88, iobase+0x1f);
3282
3283         /* it appears some maestros (dell 7500) only work if these are set,
3284                 regardless of whether we use the assp or not. */
3285
3286         outb(0, iobase+0xA4); 
3287         outb(3, iobase+0xA2); 
3288         outb(0, iobase+0xA6);
3289         
3290         for(apu=0;apu<16;apu++)
3291         {
3292                 /* Write 0 into the buffer area 0x1E0->1EF */
3293                 outw(0x01E0+apu, 0x10+iobase);
3294                 outw(0x0000, 0x12+iobase);
3295         
3296                 /*
3297                  * The 1.10 test program seem to write 0 into the buffer area
3298                  * 0x1D0-0x1DF too.
3299                  */
3300                 outw(0x01D0+apu, 0x10+iobase);
3301                 outw(0x0000, 0x12+iobase);
3302         }
3303
3304 #if 1
3305         wave_set_register(ess, IDR7_WAVE_ROMRAM, 
3306                 (wave_get_register(ess, IDR7_WAVE_ROMRAM)&0xFF00));
3307         wave_set_register(ess, IDR7_WAVE_ROMRAM,
3308                 wave_get_register(ess, IDR7_WAVE_ROMRAM)|0x100);
3309         wave_set_register(ess, IDR7_WAVE_ROMRAM,
3310                 wave_get_register(ess, IDR7_WAVE_ROMRAM)&~0x200);
3311         wave_set_register(ess, IDR7_WAVE_ROMRAM,
3312                 wave_get_register(ess, IDR7_WAVE_ROMRAM)|~0x400);
3313 #else           
3314         maestro_write(ess, IDR7_WAVE_ROMRAM, 
3315                 (maestro_read(ess, IDR7_WAVE_ROMRAM)&0xFF00));
3316         maestro_write(ess, IDR7_WAVE_ROMRAM,
3317                 maestro_read(ess, IDR7_WAVE_ROMRAM)|0x100);
3318         maestro_write(ess, IDR7_WAVE_ROMRAM,
3319                 maestro_read(ess, IDR7_WAVE_ROMRAM)&~0x200);
3320         maestro_write(ess, IDR7_WAVE_ROMRAM,
3321                 maestro_read(ess, IDR7_WAVE_ROMRAM)|0x400);
3322 #endif
3323         
3324         maestro_write(ess, IDR2_CRAM_DATA, 0x0000);
3325         maestro_write(ess, 0x08, 0xB004);
3326         /* Now back to the DirectSound stuff */
3327         maestro_write(ess, 0x09, 0x001B);
3328         maestro_write(ess, 0x0A, 0x8000);
3329         maestro_write(ess, 0x0B, 0x3F37);
3330         maestro_write(ess, 0x0C, 0x0098);
3331         
3332         /* parallel out ?? */
3333         maestro_write(ess, 0x0C, 
3334                 (maestro_read(ess, 0x0C)&~0xF000)|0x8000); 
3335         /* parallel in, has something to do with recording :) */
3336         maestro_write(ess, 0x0C, 
3337                 (maestro_read(ess, 0x0C)&~0x0F00)|0x0500);
3338
3339         maestro_write(ess, 0x0D, 0x7632);
3340                         
3341         /* Wave cache control on - test off, sg off, 
3342                 enable, enable extra chans 1Mb */
3343
3344         outw(inw(0x14+iobase)|(1<<8),0x14+iobase);
3345         outw(inw(0x14+iobase)&0xFE03,0x14+iobase);
3346         outw((inw(0x14+iobase)&0xFFFC), 0x14+iobase);
3347         outw(inw(0x14+iobase)|(1<<7),0x14+iobase);
3348
3349         outw(0xA1A0, 0x14+iobase);      /* 0300 ? */
3350
3351         /* Now clear the APU control ram */     
3352         for(apu=0;apu<NR_APUS;apu++)
3353         {
3354                 for(w=0;w<NR_APU_REGS;w++)
3355                         apu_set_register(ess, apu|ESS_CHAN_HARD, w, 0);
3356                 
3357         }
3358
3359         return 0;
3360         
3361 }
3362
3363 /* this guy tries to find the pci power management
3364  * register bank.  this should really be in core
3365  * code somewhere.  1 on success. */
3366 static int
3367 parse_power(struct ess_card *card, struct pci_dev *pcidev)
3368 {
3369         u32 n;
3370         u16 w;
3371         u8 next;
3372         int max = 64;  /* an a 8bit guy pointing to 32bit guys
3373                                 can only express so much. */
3374
3375         card->power_regs = 0;
3376
3377         /* check to see if we have a capabilities list in
3378                 the config register */
3379         pci_read_config_word(pcidev, PCI_STATUS, &w);
3380         if(!(w & PCI_STATUS_CAP_LIST)) return 0;
3381
3382         /* walk the list, starting at the head. */
3383         pci_read_config_byte(pcidev,PCI_CAPABILITY_LIST,&next);
3384
3385         while(next && max--) {
3386                 pci_read_config_dword(pcidev, next & ~3, &n);
3387                 if((n & 0xff) == PCI_CAP_ID_PM) {
3388                         card->power_regs = next;
3389                         break;
3390                 }
3391                 next = ((n>>8) & 0xff);
3392         }
3393
3394         return card->power_regs ? 1 : 0;
3395 }
3396
3397 static int __init
3398 maestro_probe(struct pci_dev *pcidev,const struct pci_device_id *pdid)
3399 {
3400         int card_type = pdid->driver_data;
3401         u32 n;
3402         int iobase;
3403         int i, ret;
3404         struct ess_card *card;
3405         struct ess_state *ess;
3406         struct pm_dev *pmdev;
3407         int num = 0;
3408
3409 /* when built into the kernel, we only print version if device is found */
3410 #ifndef MODULE
3411         static int printed_version;
3412         if (!printed_version++)
3413                 printk(version);
3414 #endif
3415
3416         /* don't pick up weird modem maestros */
3417         if(((pcidev->class >> 8) & 0xffff) != PCI_CLASS_MULTIMEDIA_AUDIO)
3418                 return -ENODEV;
3419
3420
3421         if ((ret=pci_enable_device(pcidev)))
3422                 return ret;
3423                         
3424         iobase = pci_resource_start(pcidev,0);
3425         if (!iobase || !(pci_resource_flags(pcidev, 0 ) & IORESOURCE_IO))
3426                 return -ENODEV;
3427
3428         if(pcidev->irq == 0)
3429                 return -ENODEV;
3430
3431         /* stake our claim on the iospace */
3432         if( request_region(iobase, 256, card_names[card_type]) == NULL )
3433         {
3434                 printk(KERN_WARNING "maestro: can't allocate 256 bytes I/O at 0x%4.4x\n", iobase);
3435                 return -EBUSY;
3436         }
3437
3438         /* just to be sure */
3439         pci_set_master(pcidev);
3440
3441         card = kmalloc(sizeof(struct ess_card), GFP_KERNEL);
3442         if(card == NULL)
3443         {
3444                 printk(KERN_WARNING "maestro: out of memory\n");
3445                 release_region(iobase, 256);
3446                 return -ENOMEM;
3447         }
3448         
3449         memset(card, 0, sizeof(*card));
3450         card->pcidev = pcidev;
3451
3452         pmdev = pm_register(PM_PCI_DEV, PM_PCI_ID(pcidev),
3453                         maestro_pm_callback);
3454         if (pmdev)
3455                 pmdev->data = card;
3456
3457         card->iobase = iobase;
3458         card->card_type = card_type;
3459         card->irq = pcidev->irq;
3460         card->magic = ESS_CARD_MAGIC;
3461         spin_lock_init(&card->lock);
3462         init_waitqueue_head(&card->suspend_queue);
3463
3464         card->dock_mute_vol = 50;
3465         
3466         /* init our groups of 6 apus */
3467         for(i=0;i<NR_DSPS;i++)
3468         {
3469                 struct ess_state *s=&card->channels[i];
3470
3471                 s->index = i;
3472
3473                 s->card = card;
3474                 init_waitqueue_head(&s->dma_adc.wait);
3475                 init_waitqueue_head(&s->dma_dac.wait);
3476                 init_waitqueue_head(&s->open_wait);
3477                 spin_lock_init(&s->lock);
3478                 init_MUTEX(&s->open_sem);
3479                 s->magic = ESS_STATE_MAGIC;
3480                 
3481                 s->apu[0] = 6*i;
3482                 s->apu[1] = (6*i)+1;
3483                 s->apu[2] = (6*i)+2;
3484                 s->apu[3] = (6*i)+3;
3485                 s->apu[4] = (6*i)+4;
3486                 s->apu[5] = (6*i)+5;
3487                 
3488                 if(s->dma_adc.ready || s->dma_dac.ready || s->dma_adc.rawbuf)
3489                         printk("maestro: BOTCH!\n");
3490                 /* register devices */
3491                 if ((s->dev_audio = register_sound_dsp(&ess_audio_fops, -1)) < 0)
3492                         break;
3493         }
3494         
3495         num = i;
3496         
3497         /* clear the rest if we ran out of slots to register */
3498         for(;i<NR_DSPS;i++)
3499         {
3500                 struct ess_state *s=&card->channels[i];
3501                 s->dev_audio = -1;
3502         }
3503         
3504         ess = &card->channels[0];
3505
3506         /*
3507          *      Ok card ready. Begin setup proper
3508          */
3509
3510         printk(KERN_INFO "maestro: Configuring %s found at IO 0x%04X IRQ %d\n", 
3511                 card_names[card_type],iobase,card->irq);
3512         pci_read_config_dword(pcidev, PCI_SUBSYSTEM_VENDOR_ID, &n);
3513         printk(KERN_INFO "maestro:  subvendor id: 0x%08x\n",n); 
3514
3515         /* turn off power management unless:
3516          *      - the user explicitly asks for it
3517          *              or
3518          *              - we're not a 2e, lesser chipps seem to have problems.
3519          *              - we're not on our _very_ small whitelist.  some implemenetations
3520          *                      really don't like the pm code, others require it.
3521          *                      feel free to expand this as required.
3522          */
3523 #define SUBSYSTEM_VENDOR(x) (x&0xffff)
3524         if(     (use_pm != 1) && 
3525                 ((card_type != TYPE_MAESTRO2E)  || (SUBSYSTEM_VENDOR(n) != 0x1028)))
3526                         use_pm = 0;
3527
3528         if(!use_pm) 
3529                 printk(KERN_INFO "maestro: not attempting power management.\n");
3530         else {
3531                 if(!parse_power(card,pcidev)) 
3532                         printk(KERN_INFO "maestro: no PCI power management interface found.\n");
3533                 else {
3534                         pci_read_config_dword(pcidev, card->power_regs, &n);
3535                         printk(KERN_INFO "maestro: PCI power management capability: 0x%x\n",n>>16);
3536                 }       
3537         }
3538
3539         maestro_config(card);
3540
3541         if(maestro_ac97_get(card, 0x00)==0x0080) {
3542                 printk(KERN_ERR "maestro: my goodness!  you seem to have a pt101 codec, which is quite rare.\n"
3543                                 "\tyou should tell someone about this.\n");
3544         } else {
3545                 maestro_ac97_init(card);
3546         }
3547
3548         if ((card->dev_mixer = register_sound_mixer(&ess_mixer_fops, -1)) < 0) {
3549                 printk("maestro: couldn't register mixer!\n");
3550         } else {
3551                 memcpy(card->mix.mixer_state,mixer_defaults,sizeof(card->mix.mixer_state));
3552                 mixer_push_state(card);
3553         }
3554         
3555         if((ret=request_irq(card->irq, ess_interrupt, SA_SHIRQ, card_names[card_type], card)))
3556         {
3557                 printk(KERN_ERR "maestro: unable to allocate irq %d,\n", card->irq);
3558                 unregister_sound_mixer(card->dev_mixer);
3559                 for(i=0;i<NR_DSPS;i++)
3560                 {
3561                         struct ess_state *s = &card->channels[i];
3562                         if(s->dev_audio != -1)
3563                                 unregister_sound_dsp(s->dev_audio);
3564                 }
3565                 release_region(card->iobase, 256);              
3566                 unregister_reboot_notifier(&maestro_nb);
3567                 kfree(card);
3568                 return ret;
3569         }
3570
3571         /* Turn on hardware volume control interrupt.
3572            This has to come after we grab the IRQ above,
3573            or a crash will result on installation if a button has been pressed,
3574            because in that case we'll get an immediate interrupt. */
3575         n = inw(iobase+0x18);
3576         n|=(1<<6);
3577         outw(n, iobase+0x18);
3578
3579         pci_set_drvdata(pcidev,card);
3580         /* now go to sleep 'till something interesting happens */
3581         maestro_power(card,ACPI_D2);
3582
3583         printk(KERN_INFO "maestro: %d channels configured.\n", num);
3584         return 0;
3585 }
3586
3587 static void maestro_remove(struct pci_dev *pcidev) {
3588         struct ess_card *card = pci_get_drvdata(pcidev);
3589         int i;
3590         u32 n;
3591         
3592         /* XXX maybe should force stop bob, but should be all 
3593                 stopped by _release by now */
3594
3595         /* Turn off hardware volume control interrupt.
3596            This has to come before we leave the IRQ below,
3597            or a crash results if a button is pressed ! */
3598         n = inw(card->iobase+0x18);
3599         n&=~(1<<6);
3600         outw(n, card->iobase+0x18);
3601
3602         free_irq(card->irq, card);
3603         unregister_sound_mixer(card->dev_mixer);
3604         for(i=0;i<NR_DSPS;i++)
3605         {
3606                 struct ess_state *ess = &card->channels[i];
3607                 if(ess->dev_audio != -1)
3608                         unregister_sound_dsp(ess->dev_audio);
3609         }
3610         /* Goodbye, Mr. Bond. */
3611         maestro_power(card,ACPI_D3);
3612         release_region(card->iobase, 256);
3613         kfree(card);
3614         pci_set_drvdata(pcidev,NULL);
3615 }
3616
3617 static struct pci_device_id maestro_pci_tbl[] = {
3618         {PCI_VENDOR_ESS, PCI_DEVICE_ID_ESS_ESS1968, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_MAESTRO2},
3619         {PCI_VENDOR_ESS, PCI_DEVICE_ID_ESS_ESS1978, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_MAESTRO2E},
3620         {PCI_VENDOR_ESS_OLD, PCI_DEVICE_ID_ESS_ESS0100, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_MAESTRO},
3621         {0,}
3622 };
3623 MODULE_DEVICE_TABLE(pci, maestro_pci_tbl);
3624
3625 static struct pci_driver maestro_pci_driver = {
3626         .name     = "maestro",
3627         .id_table = maestro_pci_tbl,
3628         .probe    = maestro_probe,
3629         .remove   = maestro_remove,
3630 };
3631
3632 static int __init init_maestro(void)
3633 {
3634         int rc;
3635
3636         rc = pci_module_init(&maestro_pci_driver);
3637         if (rc < 0)
3638                 return rc;
3639
3640         if (register_reboot_notifier(&maestro_nb))
3641                 printk(KERN_WARNING "maestro: reboot notifier registration failed; may not reboot properly.\n");
3642 #ifdef MODULE
3643         printk(version);
3644 #endif
3645         if (dsps_order < 0)   {
3646                 dsps_order = 1;
3647                 printk(KERN_WARNING "maestro: clipping dsps_order to %d\n",dsps_order);
3648         }
3649         else if (dsps_order > MAX_DSP_ORDER)  {
3650                 dsps_order = MAX_DSP_ORDER;
3651                 printk(KERN_WARNING "maestro: clipping dsps_order to %d\n",dsps_order);
3652         }
3653         return 0;
3654 }
3655
3656 static int maestro_notifier(struct notifier_block *nb, unsigned long event, void *buf)
3657 {
3658         /* this notifier is called when the kernel is really shut down. */
3659         M_printk("maestro: shutting down\n");
3660         /* this will remove all card instances too */
3661         pci_unregister_driver(&maestro_pci_driver);
3662         /* XXX dunno about power management */
3663         return NOTIFY_OK;
3664 }
3665
3666 /* --------------------------------------------------------------------- */
3667
3668
3669 static void cleanup_maestro(void) {
3670         M_printk("maestro: unloading\n");
3671         pci_unregister_driver(&maestro_pci_driver);
3672         pm_unregister_all(maestro_pm_callback);
3673         unregister_reboot_notifier(&maestro_nb);
3674 }
3675
3676 /* --------------------------------------------------------------------- */
3677
3678 void
3679 check_suspend(struct ess_card *card)
3680 {
3681         DECLARE_WAITQUEUE(wait, current);
3682
3683         if(!card->in_suspend) return;
3684
3685         card->in_suspend++;
3686         add_wait_queue(&(card->suspend_queue), &wait);
3687         current->state = TASK_UNINTERRUPTIBLE;
3688         schedule();
3689         remove_wait_queue(&(card->suspend_queue), &wait);
3690         current->state = TASK_RUNNING;
3691 }
3692
3693 static int 
3694 maestro_suspend(struct ess_card *card)
3695 {
3696         unsigned long flags;
3697         int i,j;
3698
3699         spin_lock_irqsave(&card->lock,flags); /* over-kill */
3700
3701         M_printk("maestro: apm in dev %p\n",card);
3702
3703         /* we have to read from the apu regs, need
3704                 to power it up */
3705         maestro_power(card,ACPI_D0);
3706
3707         for(i=0;i<NR_DSPS;i++) {
3708                 struct ess_state *s = &card->channels[i];
3709
3710                 if(s->dev_audio == -1)
3711                         continue;
3712
3713                 M_printk("maestro: stopping apus for device %d\n",i);
3714                 stop_dac(s);
3715                 stop_adc(s);
3716                 for(j=0;j<6;j++) 
3717                         card->apu_map[s->apu[j]][5]=apu_get_register(s,j,5);
3718
3719         }
3720
3721         /* get rid of interrupts? */
3722         if( card->dsps_open > 0)
3723                 stop_bob(&card->channels[0]);
3724
3725         card->in_suspend++;
3726
3727         spin_unlock_irqrestore(&card->lock,flags);
3728
3729         /* we trust in the bios to power down the chip on suspend.
3730          * XXX I'm also not sure that in_suspend will protect
3731          * against all reg accesses from here on out. 
3732          */
3733         return 0;
3734 }
3735 static int 
3736 maestro_resume(struct ess_card *card)
3737 {
3738         unsigned long flags;
3739         int i;
3740
3741         spin_lock_irqsave(&card->lock,flags); /* over-kill */
3742
3743         card->in_suspend = 0;
3744
3745         M_printk("maestro: resuming card at %p\n",card);
3746
3747         /* restore all our config */
3748         maestro_config(card);
3749         /* need to restore the base pointers.. */ 
3750         if(card->dmapages) 
3751                 set_base_registers(&card->channels[0],card->dmapages);
3752
3753         mixer_push_state(card);
3754
3755         /* set each channels' apu control registers before
3756          * restoring audio 
3757          */
3758         for(i=0;i<NR_DSPS;i++) {
3759                 struct ess_state *s = &card->channels[i];
3760                 int chan,reg;
3761
3762                 if(s->dev_audio == -1)
3763                         continue;
3764
3765                 for(chan = 0 ; chan < 6 ; chan++) {
3766                         wave_set_register(s,s->apu[chan]<<3,s->apu_base[chan]);
3767                         for(reg = 1 ; reg < NR_APU_REGS ; reg++)  
3768                                 apu_set_register(s,chan,reg,s->card->apu_map[s->apu[chan]][reg]);
3769                 }
3770                 for(chan = 0 ; chan < 6 ; chan++)  
3771                         apu_set_register(s,chan,0,s->card->apu_map[s->apu[chan]][0] & 0xFF0F);
3772         }
3773
3774         /* now we flip on the music */
3775
3776         if( card->dsps_open <= 0) {
3777                 /* this card's idle */
3778                 maestro_power(card,ACPI_D2);
3779         } else {
3780                 /* ok, we're actually playing things on
3781                         this card */
3782                 maestro_power(card,ACPI_D0);
3783                 start_bob(&card->channels[0]);
3784                 for(i=0;i<NR_DSPS;i++) {
3785                         struct ess_state *s = &card->channels[i];
3786
3787                         /* these use the apu_mode, and can handle
3788                                 spurious calls */
3789                         start_dac(s);   
3790                         start_adc(s);   
3791                 }
3792         }
3793
3794         spin_unlock_irqrestore(&card->lock,flags);
3795
3796         /* all right, we think things are ready, 
3797                 wake up people who were using the device
3798                 when we suspended */
3799         wake_up(&(card->suspend_queue));
3800
3801         return 0;
3802 }
3803
3804 int 
3805 maestro_pm_callback(struct pm_dev *dev, pm_request_t rqst, void *data) 
3806 {
3807         struct ess_card *card = (struct ess_card*) dev->data;
3808
3809         if ( ! card ) goto out;
3810
3811         M_printk("maestro: pm event 0x%x received for card %p\n", rqst, card);
3812         
3813         switch (rqst) {
3814                 case PM_SUSPEND: 
3815                         maestro_suspend(card);
3816                 break;
3817                 case PM_RESUME: 
3818                         maestro_resume(card);
3819                 break;
3820                 /*
3821                  * we'd also like to find out about
3822                  * power level changes because some biosen
3823                  * do mean things to the maestro when they
3824                  * change their power state.
3825                  */
3826         }
3827 out:
3828         return 0;
3829 }
3830
3831 module_init(init_maestro);
3832 module_exit(cleanup_maestro);