Linux-2.6.12-rc2
[deliverable/linux.git] / 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 if(combbuf) 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);
This page took 0.115882 seconds and 5 git commands to generate.