kevin/linux
1
Fork 0
Code
cb8e2f8385
linux/sound/oss/maestro.c
Jesper Juhl 09417379be [PATCH] remove redundant NULL checks before kfree() in sound/ and avoid casting pointers about to be kfree()'ed 
Checking a pointer for NULL before calling kfree() on it is redundant,
kfree() deals with NULL pointers just fine.
This patch removes such checks from sound/

This patch also makes another, but closely related, change.
It avoids casting pointers about to be kfree()'ed.

Signed-off-by: Jesper Juhl <juhl-lkml@dif.dk>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>
2005-06-25 16:25:00 -07:00

3833 lines
106 KiB
C
Raw Blame History

/*****************************************************************************
*
* ESS Maestro/Maestro-2/Maestro-2E driver for Linux 2.[23].x
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* (c) Copyright 1999 Alan Cox <alan.cox@linux.org>
*
* Based heavily on SonicVibes.c:
* Copyright (C) 1998-1999 Thomas Sailer (sailer@ife.ee.ethz.ch)
*
* Heavily modified by Zach Brown <zab@zabbo.net> based on lunch
* with ESS engineers. Many thanks to Howard Kim for providing
* contacts and hardware. Honorable mention goes to Eric
* Brombaugh for all sorts of things. Best regards to the
* proprietors of Hack Central for fine lodging.
*
* Supported devices:
* /dev/dsp0-3 standard /dev/dsp device, (mostly) OSS compatible
* /dev/mixer standard /dev/mixer device, (mostly) OSS compatible
*
* Hardware Description
*
* A working Maestro setup contains the Maestro chip wired to a
* codec or 2. In the Maestro we have the APUs, the ASSP, and the
* Wavecache. The APUs can be though of as virtual audio routing
* channels. They can take data from a number of sources and perform
* basic encodings of the data. The wavecache is a storehouse for
* PCM data. Typically it deals with PCI and interracts with the
* APUs. The ASSP is a wacky DSP like device that ESS is loth
* to release docs on. Thankfully it isn't required on the Maestro
* until you start doing insane things like FM emulation and surround
* encoding. The codecs are almost always AC-97 compliant codecs,
* but it appears that early Maestros may have had PT101 (an ESS
* part?) wired to them. The only real difference in the Maestro
* families is external goop like docking capability, memory for
* the ASSP, and initialization differences.
*
* Driver Operation
*
* We only drive the APU/Wavecache as typical DACs and drive the
* mixers in the codecs. There are 64 APUs. We assign 6 to each
* /dev/dsp? device. 2 channels for output, and 4 channels for
* input.
*
* Each APU can do a number of things, but we only really use
* 3 basic functions. For playback we use them to convert PCM
* data fetched over PCI by the wavecahche into analog data that
* is handed to the codec. One APU for mono, and a pair for stereo.
* When in stereo, the combination of smarts in the APU and Wavecache
* decide which wavecache gets the left or right channel.
*
* For record we still use the old overly mono system. For each in
* coming channel the data comes in from the codec, through a 'input'
* APU, through another rate converter APU, and then into memory via
* the wavecache and PCI. If its stereo, we mash it back into LRLR in
* software. The pass between the 2 APUs is supposedly what requires us
* to have a 512 byte buffer sitting around in wavecache/memory.
*
* The wavecache makes our life even more fun. First off, it can
* only address the first 28 bits of PCI address space, making it
* useless on quite a few architectures. Secondly, its insane.
* It claims to fetch from 4 regions of PCI space, each 4 meg in length.
* But that doesn't really work. You can only use 1 region. So all our
* allocations have to be in 4meg of each other. Booo. Hiss.
* So we have a module parameter, dsps_order, that is the order of
* the number of dsps to provide. All their buffer space is allocated
* on open time. The sonicvibes OSS routines we inherited really want
* power of 2 buffers, so we have all those next to each other, then
* 512 byte regions for the recording wavecaches. This ends up
* wasting quite a bit of memory. The only fixes I can see would be
* getting a kernel allocator that could work in zones, or figuring out
* just how to coerce the WP into doing what we want.
*
* The indirection of the various registers means we have to spinlock
* nearly all register accesses. We have the main register indirection
* like the wave cache, maestro registers, etc. Then we have beasts
* like the APU interface that is indirect registers gotten at through
* the main maestro indirection. Ouch. We spinlock around the actual
* ports on a per card basis. This means spinlock activity at each IO
* operation, but the only IO operation clusters are in non critical
* paths and it makes the code far easier to follow. Interrupts are
* blocked while holding the locks because the int handler has to
* get at some of them :(. The mixer interface doesn't, however.
* We also have an OSS state lock that is thrown around in a few
* places.
*
* This driver has brute force APM suspend support. We catch suspend
* notifications and stop all work being done on the chip. Any people
* that try between this shutdown and the real suspend operation will
* be put to sleep. When we resume we restore our software state on
* the chip and wake up the people that were using it. The code thats
* being used now is quite dirty and assumes we're on a uni-processor
* machine. Much of it will need to be cleaned up for SMP ACPI or
* similar.
*
* We also pay attention to PCI power management now. The driver
* will power down units of the chip that it knows aren't needed.
* The WaveProcessor and company are only powered on when people
* have /dev/dsp*s open. On removal the driver will
* power down the maestro entirely. There could still be
* trouble with BIOSen that magically change power states
* themselves, but we'll see.
*
* History
* v0.15 - May 21 2001 - Marcus Meissner <mm@caldera.de>
* Ported to Linux 2.4 PCI API. Some clean ups, global devs list
* removed (now using pci device driver data).
* PM needs to be polished still. Bumped version.
* (still kind of v0.14) May 13 2001 - Ben Pfaff <pfaffben@msu.edu>
* Add support for 978 docking and basic hardware volume control
* (still kind of v0.14) Nov 23 - Alan Cox <alan@redhat.com>
* Add clocking= for people with seriously warped hardware
* (still v0.14) Nov 10 2000 - Bartlomiej Zolnierkiewicz <bkz@linux-ide.org>
* add __init to maestro_ac97_init() and maestro_install()
* (still based on v0.14) Mar 29 2000 - Zach Brown <zab@redhat.com>
* move to 2.3 power management interface, which
* required hacking some suspend/resume/check paths
* make static compilation work
* v0.14 - Jan 28 2000 - Zach Brown <zab@redhat.com>
* add PCI power management through ACPI regs.
* we now shut down on machine reboot/halt
* leave scary PCI config items alone (isa stuff, mostly)
* enable 1921s, it seems only mine was broke.
* fix swapped left/right pcm dac. har har.
* up bob freq, increase buffers, fix pointers at underflow
* silly compilation problems
* v0.13 - Nov 18 1999 - Zach Brown <zab@redhat.com>
* fix nec Versas? man would that be cool.
* v0.12 - Nov 12 1999 - Zach Brown <zab@redhat.com>
* brown bag volume max fix..
* v0.11 - Nov 11 1999 - Zach Brown <zab@redhat.com>
* use proper stereo apu decoding, mmap/write should work.
* make volume sliders more useful, tweak rate calculation.
* fix lame 8bit format reporting bug. duh. apm apu saving buglet also
* fix maestro 1 clock freq "bug", remove pt101 support
* v0.10 - Oct 28 1999 - Zach Brown <zab@redhat.com>
* aha, so, sometimes the WP writes a status word to offset 0
* from one of the PCMBARs. rearrange allocation accordingly..
* cheers again to Eric for being a good hacker in investigating this.
* Jeroen Hoogervorst submits 7500 fix out of nowhere. yay. :)
* v0.09 - Oct 23 1999 - Zach Brown <zab@redhat.com>
* added APM support.
* re-order something such that some 2Es now work. Magic!
* new codec reset routine. made some codecs come to life.
* fix clear_advance, sync some control with ESS.
* now write to all base regs to be paranoid.
* v0.08 - Oct 20 1999 - Zach Brown <zab@redhat.com>
* Fix initial buflen bug. I am so smart. also smp compiling..
* I owe Eric yet another beer: fixed recmask, igain,
* muting, and adc sync consistency. Go Team.
* v0.07 - Oct 4 1999 - Zach Brown <zab@redhat.com>
* tweak adc/dac, formating, and stuff to allow full duplex
* allocate dsps memory at open() so we can fit in the wavecache window
* fix wavecache braindamage. again. no more scribbling?
* fix ess 1921 codec bug on some laptops.
* fix dumb pci scanning bug
* started 2.3 cleanup, redid spinlocks, little cleanups
* v0.06 - Sep 20 1999 - Zach Brown <zab@redhat.com>
* fix wavecache thinkos. limit to 1 /dev/dsp.
* eric is wearing his thinking toque this week.
* spotted apu mode bugs and gain ramping problem
* don't touch weird mixer regs, make recmask optional
* fixed igain inversion, defaults for mixers, clean up rec_start
* make mono recording work.
* report subsystem stuff, please send reports.
* littles: parallel out, amp now
* v0.05 - Sep 17 1999 - Zach Brown <zab@redhat.com>
* merged and fixed up Eric's initial recording code
* munged format handling to catch misuse, needs rewrite.
* revert ring bus init, fixup shared int, add pci busmaster setting
* fix mixer oss interface, fix mic mute and recmask
* mask off unsupported mixers, reset with all 1s, modularize defaults
* make sure bob is running while we need it
* got rid of device limit, initial minimal apm hooks
* pull out dead code/includes, only allow multimedia/audio maestros
* v0.04 - Sep 01 1999 - Zach Brown <zab@redhat.com>
* copied memory leak fix from sonicvibes driver
* different ac97 reset, play with 2.0 ac97, simplify ring bus setup
* bob freq code, region sanity, jitter sync fix; all from Eric
*
* TODO
* fix bob frequency
* endianness
* do smart things with ac97 2.0 bits.
* dual codecs
* leave 54->61 open
*
* it also would be fun to have a mode that would not use pci dma at all
* but would copy into the wavecache on board memory and use that
* on architectures that don't like the maestro's pci dma ickiness.
*/
/*****************************************************************************/
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/smp_lock.h>
#include <linux/string.h>
#include <linux/ctype.h>
#include <linux/ioport.h>
#include <linux/delay.h>
#include <linux/sound.h>
#include <linux/slab.h>
#include <linux/soundcard.h>
#include <linux/pci.h>
#include <linux/spinlock.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/poll.h>
#include <linux/reboot.h>
#include <linux/bitops.h>
#include <linux/wait.h>
#include <asm/current.h>
#include <asm/dma.h>
#include <asm/io.h>
#include <asm/page.h>
#include <asm/uaccess.h>
#include <linux/pm.h>
static int maestro_pm_callback(struct pm_dev *dev, pm_request_t rqst, void *d);
#include "maestro.h"
static struct pci_driver maestro_pci_driver;
/* --------------------------------------------------------------------- */
#define M_DEBUG 1
#ifdef M_DEBUG
static int debug;
#define M_printk(args...) {if (debug) printk(args);}
#else
#define M_printk(x)
#endif
/* we try to setup 2^(dsps_order) /dev/dsp devices */
static int dsps_order;
/* whether or not we mess around with power management */
static int use_pm=2; /* set to 1 for force */
/* clocking for broken hardware - a few laptops seem to use a 50Khz clock
ie insmod with clocking=50000 or so */
static int clocking=48000;
MODULE_AUTHOR("Zach Brown <zab@zabbo.net>, Alan Cox <alan@redhat.com>");
MODULE_DESCRIPTION("ESS Maestro Driver");
MODULE_LICENSE("GPL");
#ifdef M_DEBUG
module_param(debug, bool, 0644);
#endif
module_param(dsps_order, int, 0);
module_param(use_pm, int, 0);
module_param(clocking, int, 0);
/* --------------------------------------------------------------------- */
#define DRIVER_VERSION "0.15"
#ifndef PCI_VENDOR_ESS
#define PCI_VENDOR_ESS 0x125D
#define PCI_DEVICE_ID_ESS_ESS1968 0x1968 /* Maestro 2 */
#define PCI_DEVICE_ID_ESS_ESS1978 0x1978 /* Maestro 2E */
#define PCI_VENDOR_ESS_OLD 0x1285 /* Platform Tech,
the people the maestro
was bought from */
#define PCI_DEVICE_ID_ESS_ESS0100 0x0100 /* maestro 1 */
#endif /* PCI_VENDOR_ESS */
#define ESS_CHAN_HARD 0x100
/* NEC Versas ? */
#define NEC_VERSA_SUBID1 0x80581033
#define NEC_VERSA_SUBID2 0x803c1033
/* changed so that I could actually find all the
references and fix them up. it's a little more readable now. */
#define ESS_FMT_STEREO 0x01
#define ESS_FMT_16BIT 0x02
#define ESS_FMT_MASK 0x03
#define ESS_DAC_SHIFT 0
#define ESS_ADC_SHIFT 4
#define ESS_STATE_MAGIC 0x125D1968
#define ESS_CARD_MAGIC 0x19283746
#define DAC_RUNNING 1
#define ADC_RUNNING 2
#define MAX_DSP_ORDER 2
#define MAX_DSPS (1<<MAX_DSP_ORDER)
#define NR_DSPS (1<<dsps_order)
#define NR_IDRS 32
#define NR_APUS 64
#define NR_APU_REGS 16
/* acpi states */
enum {
ACPI_D0=0,
ACPI_D1,
ACPI_D2,
ACPI_D3
};
/* bits in the acpi masks */
#define ACPI_12MHZ ( 1 << 15)
#define ACPI_24MHZ ( 1 << 14)
#define ACPI_978 ( 1 << 13)
#define ACPI_SPDIF ( 1 << 12)
#define ACPI_GLUE ( 1 << 11)
#define ACPI__10 ( 1 << 10) /* reserved */
#define ACPI_PCIINT ( 1 << 9)
#define ACPI_HV ( 1 << 8) /* hardware volume */
#define ACPI_GPIO ( 1 << 7)
#define ACPI_ASSP ( 1 << 6)
#define ACPI_SB ( 1 << 5) /* sb emul */
#define ACPI_FM ( 1 << 4) /* fm emul */
#define ACPI_RB ( 1 << 3) /* ringbus / aclink */
#define ACPI_MIDI ( 1 << 2)
#define ACPI_GP ( 1 << 1) /* game port */
#define ACPI_WP ( 1 << 0) /* wave processor */
#define ACPI_ALL (0xffff)
#define ACPI_SLEEP (~(ACPI_SPDIF|ACPI_ASSP|ACPI_SB|ACPI_FM| \
ACPI_MIDI|ACPI_GP|ACPI_WP))
#define ACPI_NONE (ACPI__10)
/* these masks indicate which units we care about at
which states */
static u16 acpi_state_mask[] = {
[ACPI_D0] = ACPI_ALL,
[ACPI_D1] = ACPI_SLEEP,
[ACPI_D2] = ACPI_SLEEP,
[ACPI_D3] = ACPI_NONE
};
static char version[] __devinitdata =
KERN_INFO "maestro: version " DRIVER_VERSION " time " __TIME__ " " __DATE__ "\n";
static const unsigned sample_size[] = { 1, 2, 2, 4 };
static const unsigned sample_shift[] = { 0, 1, 1, 2 };
enum card_types_t {
TYPE_MAESTRO,
TYPE_MAESTRO2,
TYPE_MAESTRO2E
};
static const char *card_names[]={
[TYPE_MAESTRO] = "ESS Maestro",
[TYPE_MAESTRO2] = "ESS Maestro 2",
[TYPE_MAESTRO2E] = "ESS Maestro 2E"
};
static int clock_freq[]={
[TYPE_MAESTRO] = (49152000L / 1024L),
[TYPE_MAESTRO2] = (50000000L / 1024L),
[TYPE_MAESTRO2E] = (50000000L / 1024L)
};
static int maestro_notifier(struct notifier_block *nb, unsigned long event, void *buf);
static struct notifier_block maestro_nb = {maestro_notifier, NULL, 0};
/* --------------------------------------------------------------------- */
struct ess_state {
unsigned int magic;
/* FIXME: we probably want submixers in here, but only one record pair */
u8 apu[6]; /* l/r output, l/r intput converters, l/r input apus */
u8 apu_mode[6]; /* Running mode for this APU */
u8 apu_pan[6]; /* Panning setup for this APU */
u32 apu_base[6]; /* base address for this apu */
struct ess_card *card; /* Card info */
/* wave stuff */
unsigned int rateadc, ratedac;
unsigned char fmt, enable;
int index;
/* this locks around the oss state in the driver */
spinlock_t lock;
/* only let 1 be opening at a time */
struct semaphore open_sem;
wait_queue_head_t open_wait;
mode_t open_mode;
/* soundcore stuff */
int dev_audio;
struct dmabuf {
void *rawbuf;
unsigned buforder;
unsigned numfrag;
unsigned fragshift;
/* XXX zab - swptr only in here so that it can be referenced by
clear_advance, as far as I can tell :( */
unsigned hwptr, swptr;
unsigned total_bytes;
int count;
unsigned error; /* over/underrun */
wait_queue_head_t wait;
/* redundant, but makes calculations easier */
unsigned fragsize;
unsigned dmasize;
unsigned fragsamples;
/* OSS stuff */
unsigned mapped:1;
unsigned ready:1; /* our oss buffers are ready to go */
unsigned endcleared:1;
unsigned ossfragshift;
int ossmaxfrags;
unsigned subdivision;
u16 base; /* Offset for ptr */
} dma_dac, dma_adc;
/* pointer to each dsp?s piece of the apu->src buffer page */
void *mixbuf;
};
struct ess_card {
unsigned int magic;
/* We keep maestro cards in a linked list */
struct ess_card *next;
int dev_mixer;
int card_type;
/* as most of this is static,
perhaps it should be a pointer to a global struct */
struct mixer_goo {
int modcnt;
int supported_mixers;
int stereo_mixers;
int record_sources;
/* the caller must guarantee arg sanity before calling these */
/* int (*read_mixer)(struct ess_card *card, int index);*/
void (*write_mixer)(struct ess_card *card,int mixer, unsigned int left,unsigned int right);
int (*recmask_io)(struct ess_card *card,int rw,int mask);
unsigned int mixer_state[SOUND_MIXER_NRDEVICES];
} mix;
int power_regs;
int in_suspend;
wait_queue_head_t suspend_queue;
struct ess_state channels[MAX_DSPS];
u16 maestro_map[NR_IDRS]; /* Register map */
/* we have to store this junk so that we can come back from a
suspend */
u16 apu_map[NR_APUS][NR_APU_REGS]; /* contents of apu regs */
/* this locks around the physical registers on the card */
spinlock_t lock;
/* memory for this card.. wavecache limited :(*/
void *dmapages;
int dmaorder;
/* hardware resources */
struct pci_dev *pcidev;
u32 iobase;
u32 irq;
int bob_freq;
char dsps_open;
int dock_mute_vol;
};
static void set_mixer(struct ess_card *card,unsigned int mixer, unsigned int val );
static unsigned
ld2(unsigned int x)
{
unsigned r = 0;
if (x >= 0x10000) {
x >>= 16;
r += 16;
}
if (x >= 0x100) {
x >>= 8;
r += 8;
}
if (x >= 0x10) {
x >>= 4;
r += 4;
}
if (x >= 4) {
x >>= 2;
r += 2;
}
if (x >= 2)
r++;
return r;
}
/* --------------------------------------------------------------------- */
static void check_suspend(struct ess_card *card);
/* --------------------------------------------------------------------- */
/*
* ESS Maestro AC97 codec programming interface.
*/
static void maestro_ac97_set(struct ess_card *card, u8 cmd, u16 val)
{
int io = card->iobase;
int i;
/*
* Wait for the codec bus to be free
*/
check_suspend(card);
for(i=0;i<10000;i++)
{
if(!(inb(io+ESS_AC97_INDEX)&1))
break;
}
/*
* Write the bus
*/
outw(val, io+ESS_AC97_DATA);
mdelay(1);
outb(cmd, io+ESS_AC97_INDEX);
mdelay(1);
}
static u16 maestro_ac97_get(struct ess_card *card, u8 cmd)
{
int io = card->iobase;
int sanity=10000;
u16 data;
int i;
check_suspend(card);
/*
* Wait for the codec bus to be free
*/
for(i=0;i<10000;i++)
{
if(!(inb(io+ESS_AC97_INDEX)&1))
break;
}
outb(cmd|0x80, io+ESS_AC97_INDEX);
mdelay(1);
while(inb(io+ESS_AC97_INDEX)&1)
{
sanity--;
if(!sanity)
{
printk(KERN_ERR "maestro: ac97 codec timeout reading 0x%x.\n",cmd);
return 0;
}
}
data=inw(io+ESS_AC97_DATA);
mdelay(1);
return data;
}
/* OSS interface to the ac97s.. */
#define AC97_STEREO_MASK (SOUND_MASK_VOLUME|\
SOUND_MASK_PCM|SOUND_MASK_LINE|SOUND_MASK_CD|\
SOUND_MASK_VIDEO|SOUND_MASK_LINE1|SOUND_MASK_IGAIN)
#define AC97_SUPPORTED_MASK (AC97_STEREO_MASK | \
SOUND_MASK_BASS|SOUND_MASK_TREBLE|SOUND_MASK_MIC|\
SOUND_MASK_SPEAKER)
#define AC97_RECORD_MASK (SOUND_MASK_MIC|\
SOUND_MASK_CD| SOUND_MASK_VIDEO| SOUND_MASK_LINE1| SOUND_MASK_LINE|\
SOUND_MASK_PHONEIN)
#define supported_mixer(CARD,FOO) ( CARD->mix.supported_mixers & (1<<FOO) )
/* this table has default mixer values for all OSS mixers.
be sure to fill it in if you add oss mixers
to anyone's supported mixer defines */
static unsigned int mixer_defaults[SOUND_MIXER_NRDEVICES] = {
[SOUND_MIXER_VOLUME] = 0x3232,
[SOUND_MIXER_BASS] = 0x3232,
[SOUND_MIXER_TREBLE] = 0x3232,
[SOUND_MIXER_SPEAKER] = 0x3232,
[SOUND_MIXER_MIC] = 0x8000, /* annoying */
[SOUND_MIXER_LINE] = 0x3232,
[SOUND_MIXER_CD] = 0x3232,
[SOUND_MIXER_VIDEO] = 0x3232,
[SOUND_MIXER_LINE1] = 0x3232,
[SOUND_MIXER_PCM] = 0x3232,
[SOUND_MIXER_IGAIN] = 0x3232
};
static struct ac97_mixer_hw {
unsigned char offset;
int scale;
} ac97_hw[SOUND_MIXER_NRDEVICES]= {
[SOUND_MIXER_VOLUME] = {0x02,63},
[SOUND_MIXER_BASS] = {0x08,15},
[SOUND_MIXER_TREBLE] = {0x08,15},
[SOUND_MIXER_SPEAKER] = {0x0a,15},
[SOUND_MIXER_MIC] = {0x0e,31},
[SOUND_MIXER_LINE] = {0x10,31},
[SOUND_MIXER_CD] = {0x12,31},
[SOUND_MIXER_VIDEO] = {0x14,31},
[SOUND_MIXER_LINE1] = {0x16,31},
[SOUND_MIXER_PCM] = {0x18,31},
[SOUND_MIXER_IGAIN] = {0x1c,15}
};
#if 0 /* *shrug* removed simply because we never used it.
feel free to implement again if needed */
/* reads the given OSS mixer from the ac97
the caller must have insured that the ac97 knows
about that given mixer, and should be holding a
spinlock for the card */
static int ac97_read_mixer(struct ess_card *card, int mixer)
{
u16 val;
int ret=0;
struct ac97_mixer_hw *mh = &ac97_hw[mixer];
val = maestro_ac97_get(card, mh->offset);
if(AC97_STEREO_MASK & (1<<mixer)) {
/* nice stereo mixers .. */
int left,right;
left = (val >> 8) & 0x7f;
right = val & 0x7f;
if (mixer == SOUND_MIXER_IGAIN) {
right = (right * 100) / mh->scale;
left = (left * 100) / mh->scale;
} else {
right = 100 - ((right * 100) / mh->scale);
left = 100 - ((left * 100) / mh->scale);
}
ret = left | (right << 8);
} else if (mixer == SOUND_MIXER_SPEAKER) {
ret = 100 - ((((val & 0x1e)>>1) * 100) / mh->scale);
} else if (mixer == SOUND_MIXER_MIC) {
ret = 100 - (((val & 0x1f) * 100) / mh->scale);
/* the low bit is optional in the tone sliders and masking
it lets is avoid the 0xf 'bypass'.. */
} else if (mixer == SOUND_MIXER_BASS) {
ret = 100 - ((((val >> 8) & 0xe) * 100) / mh->scale);
} else if (mixer == SOUND_MIXER_TREBLE) {
ret = 100 - (((val & 0xe) * 100) / mh->scale);
}
M_printk("read mixer %d (0x%x) %x -> %x\n",mixer,mh->offset,val,ret);
return ret;
}
#endif
/* write the OSS encoded volume to the given OSS encoded mixer,
again caller's job to make sure all is well in arg land,
call with spinlock held */
/* linear scale -> log */
static unsigned char lin2log[101] =
{
0, 0 , 15 , 23 , 30 , 34 , 38 , 42 , 45 , 47 ,
50 , 52 , 53 , 55 , 57 , 58 , 60 , 61 , 62 ,
63 , 65 , 66 , 67 , 68 , 69 , 69 , 70 , 71 ,
72 , 73 , 73 , 74 , 75 , 75 , 76 , 77 , 77 ,
78 , 78 , 79 , 80 , 80 , 81 , 81 , 82 , 82 ,
83 , 83 , 84 , 84 , 84 , 85 , 85 , 86 , 86 ,
87 , 87 , 87 , 88 , 88 , 88 , 89 , 89 , 89 ,
90 , 90 , 90 , 91 , 91 , 91 , 92 , 92 , 92 ,
93 , 93 , 93 , 94 , 94 , 94 , 94 , 95 , 95 ,
95 , 95 , 96 , 96 , 96 , 96 , 97 , 97 , 97 ,
97 , 98 , 98 , 98 , 98 , 99 , 99 , 99 , 99 , 99
};
static void ac97_write_mixer(struct ess_card *card,int mixer, unsigned int left, unsigned int right)
{
u16 val=0;
struct ac97_mixer_hw *mh = &ac97_hw[mixer];
M_printk("wrote mixer %d (0x%x) %d,%d",mixer,mh->offset,left,right);
if(AC97_STEREO_MASK & (1<<mixer)) {
/* stereo mixers, mute them if we can */
if (mixer == SOUND_MIXER_IGAIN) {
/* igain's slider is reversed.. */
right = (right * mh->scale) / 100;
left = (left * mh->scale) / 100;
if ((left == 0) && (right == 0))
val |= 0x8000;
} else if (mixer == SOUND_MIXER_PCM || mixer == SOUND_MIXER_CD) {
/* log conversion seems bad for them */
if ((left == 0) && (right == 0))
val = 0x8000;
right = ((100 - right) * mh->scale) / 100;
left = ((100 - left) * mh->scale) / 100;
} else {
/* log conversion for the stereo controls */
if((left == 0) && (right == 0))
val = 0x8000;
right = ((100 - lin2log[right]) * mh->scale) / 100;
left = ((100 - lin2log[left]) * mh->scale) / 100;
}
val |= (left << 8) | right;
} else if (mixer == SOUND_MIXER_SPEAKER) {
val = (((100 - left) * mh->scale) / 100) << 1;
} else if (mixer == SOUND_MIXER_MIC) {
val = maestro_ac97_get(card, mh->offset) & ~0x801f;
val |= (((100 - left) * mh->scale) / 100);
/* the low bit is optional in the tone sliders and masking
it lets is avoid the 0xf 'bypass'.. */
} else if (mixer == SOUND_MIXER_BASS) {
val = maestro_ac97_get(card , mh->offset) & ~0x0f00;
val |= ((((100 - left) * mh->scale) / 100) << 8) & 0x0e00;
} else if (mixer == SOUND_MIXER_TREBLE) {
val = maestro_ac97_get(card , mh->offset) & ~0x000f;
val |= (((100 - left) * mh->scale) / 100) & 0x000e;
}
maestro_ac97_set(card , mh->offset, val);
M_printk(" -> %x\n",val);
}
/* the following tables allow us to go from
OSS <-> ac97 quickly. */
enum ac97_recsettings {
AC97_REC_MIC=0,
AC97_REC_CD,
AC97_REC_VIDEO,
AC97_REC_AUX,
AC97_REC_LINE,
AC97_REC_STEREO, /* combination of all enabled outputs.. */
AC97_REC_MONO, /*.. or the mono equivalent */
AC97_REC_PHONE
};
static unsigned int ac97_oss_mask[] = {
[AC97_REC_MIC] = SOUND_MASK_MIC,
[AC97_REC_CD] = SOUND_MASK_CD,
[AC97_REC_VIDEO] = SOUND_MASK_VIDEO,
[AC97_REC_AUX] = SOUND_MASK_LINE1,
[AC97_REC_LINE] = SOUND_MASK_LINE,
[AC97_REC_PHONE] = SOUND_MASK_PHONEIN
};
/* indexed by bit position */
static unsigned int ac97_oss_rm[] = {
[SOUND_MIXER_MIC] = AC97_REC_MIC,
[SOUND_MIXER_CD] = AC97_REC_CD,
[SOUND_MIXER_VIDEO] = AC97_REC_VIDEO,
[SOUND_MIXER_LINE1] = AC97_REC_AUX,
[SOUND_MIXER_LINE] = AC97_REC_LINE,
[SOUND_MIXER_PHONEIN] = AC97_REC_PHONE
};
/* read or write the recmask
the ac97 can really have left and right recording
inputs independently set, but OSS doesn't seem to
want us to express that to the user.
the caller guarantees that we have a supported bit set,
and they must be holding the card's spinlock */
static int
ac97_recmask_io(struct ess_card *card, int read, int mask)
{
unsigned int val = ac97_oss_mask[ maestro_ac97_get(card, 0x1a) & 0x7 ];
if (read) return val;
/* oss can have many inputs, maestro can't. try
to pick the 'new' one */
if (mask != val) mask &= ~val;
val = ffs(mask) - 1;
val = ac97_oss_rm[val];
val |= val << 8; /* set both channels */
M_printk("maestro: setting ac97 recmask to 0x%x\n",val);
maestro_ac97_set(card,0x1a,val);
return 0;
};
/*
* The Maestro can be wired to a standard AC97 compliant codec
* (see www.intel.com for the pdf's on this), or to a PT101 codec
* which appears to be the ES1918 (data sheet on the esstech.com.tw site)
*
* The PT101 setup is untested.
*/
static u16 __init maestro_ac97_init(struct ess_card *card)
{
u16 vend1, vend2, caps;
card->mix.supported_mixers = AC97_SUPPORTED_MASK;
card->mix.stereo_mixers = AC97_STEREO_MASK;
card->mix.record_sources = AC97_RECORD_MASK;
/* card->mix.read_mixer = ac97_read_mixer;*/
card->mix.write_mixer = ac97_write_mixer;
card->mix.recmask_io = ac97_recmask_io;
vend1 = maestro_ac97_get(card, 0x7c);
vend2 = maestro_ac97_get(card, 0x7e);
caps = maestro_ac97_get(card, 0x00);
printk(KERN_INFO "maestro: AC97 Codec detected: v: 0x%2x%2x caps: 0x%x pwr: 0x%x\n",
vend1,vend2,caps,maestro_ac97_get(card,0x26) & 0xf);
if (! (caps & 0x4) ) {
/* no bass/treble nobs */
card->mix.supported_mixers &= ~(SOUND_MASK_BASS|SOUND_MASK_TREBLE);
}
/* XXX endianness, dork head. */
/* vendor specifc bits.. */
switch ((long)(vend1 << 16) | vend2) {
case 0x545200ff: /* TriTech */
/* no idea what this does */
maestro_ac97_set(card,0x2a,0x0001);
maestro_ac97_set(card,0x2c,0x0000);
maestro_ac97_set(card,0x2c,0xffff);
break;
#if 0 /* i thought the problems I was seeing were with
the 1921, but apparently they were with the pci board
it was on, so this code is commented out.
lets see if this holds true. */
case 0x83847609: /* ESS 1921 */
/* writing to 0xe (mic) or 0x1a (recmask) seems
to hang this codec */
card->mix.supported_mixers &= ~(SOUND_MASK_MIC);
card->mix.record_sources = 0;
card->mix.recmask_io = NULL;
#if 0 /* don't ask. I have yet to see what these actually do. */
maestro_ac97_set(card,0x76,0xABBA); /* o/~ Take a chance on me o/~ */
udelay(20);
maestro_ac97_set(card,0x78,0x3002);
udelay(20);
maestro_ac97_set(card,0x78,0x3802);
udelay(20);
#endif
break;
#endif
default: break;
}
maestro_ac97_set(card, 0x1E, 0x0404);
/* null misc stuff */
maestro_ac97_set(card, 0x20, 0x0000);
return 0;
}
#if 0 /* there has been 1 person on the planet with a pt101 that we
know of. If they care, they can put this back in :) */
static u16 maestro_pt101_init(struct ess_card *card,int iobase)
{
printk(KERN_INFO "maestro: PT101 Codec detected, initializing but _not_ installing mixer device.\n");
/* who knows.. */
maestro_ac97_set(iobase, 0x2A, 0x0001);
maestro_ac97_set(iobase, 0x2C, 0x0000);
maestro_ac97_set(iobase, 0x2C, 0xFFFF);
maestro_ac97_set(iobase, 0x10, 0x9F1F);
maestro_ac97_set(iobase, 0x12, 0x0808);
maestro_ac97_set(iobase, 0x14, 0x9F1F);
maestro_ac97_set(iobase, 0x16, 0x9F1F);
maestro_ac97_set(iobase, 0x18, 0x0404);
maestro_ac97_set(iobase, 0x1A, 0x0000);
maestro_ac97_set(iobase, 0x1C, 0x0000);
maestro_ac97_set(iobase, 0x02, 0x0404);
maestro_ac97_set(iobase, 0x04, 0x0808);
maestro_ac97_set(iobase, 0x0C, 0x801F);
maestro_ac97_set(iobase, 0x0E, 0x801F);
return 0;
}
#endif
/* this is very magic, and very slow.. */
static void
maestro_ac97_reset(int ioaddr, struct pci_dev *pcidev)
{
u16 save_68;
u16 w;
u32 vend;
outw( inw(ioaddr + 0x38) & 0xfffc, ioaddr + 0x38);
outw( inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
outw( inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
/* reset the first codec */
outw(0x0000, ioaddr+0x36);
save_68 = inw(ioaddr+0x68);
pci_read_config_word(pcidev, 0x58, &w); /* something magical with gpio and bus arb. */
pci_read_config_dword(pcidev, PCI_SUBSYSTEM_VENDOR_ID, &vend);
if( w & 0x1)
save_68 |= 0x10;
outw(0xfffe, ioaddr + 0x64); /* tickly gpio 0.. */
outw(0x0001, ioaddr + 0x68);
outw(0x0000, ioaddr + 0x60);
udelay(20);
outw(0x0001, ioaddr + 0x60);
mdelay(20);
outw(save_68 | 0x1, ioaddr + 0x68); /* now restore .. */
outw( (inw(ioaddr + 0x38) & 0xfffc)|0x1, ioaddr + 0x38);
outw( (inw(ioaddr + 0x3a) & 0xfffc)|0x1, ioaddr + 0x3a);
outw( (inw(ioaddr + 0x3c) & 0xfffc)|0x1, ioaddr + 0x3c);
/* now the second codec */
outw(0x0000, ioaddr+0x36);
outw(0xfff7, ioaddr + 0x64);
save_68 = inw(ioaddr+0x68);
outw(0x0009, ioaddr + 0x68);
outw(0x0001, ioaddr + 0x60);
udelay(20);
outw(0x0009, ioaddr + 0x60);
mdelay(500); /* .. ouch.. */
outw( inw(ioaddr + 0x38) & 0xfffc, ioaddr + 0x38);
outw( inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
outw( inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
#if 0 /* the loop here needs to be much better if we want it.. */
M_printk("trying software reset\n");
/* try and do a software reset */
outb(0x80|0x7c, ioaddr + 0x30);
for (w=0; ; w++) {
if ((inw(ioaddr+ 0x30) & 1) == 0) {
if(inb(ioaddr + 0x32) !=0) break;
outb(0x80|0x7d, ioaddr + 0x30);
if (((inw(ioaddr+ 0x30) & 1) == 0) && (inb(ioaddr + 0x32) !=0)) break;
outb(0x80|0x7f, ioaddr + 0x30);
if (((inw(ioaddr+ 0x30) & 1) == 0) && (inb(ioaddr + 0x32) !=0)) break;
}
if( w > 10000) {
outb( inb(ioaddr + 0x37) | 0x08, ioaddr + 0x37); /* do a software reset */
mdelay(500); /* oh my.. */
outb( inb(ioaddr + 0x37) & ~0x08, ioaddr + 0x37);
udelay(1);
outw( 0x80, ioaddr+0x30);
for(w = 0 ; w < 10000; w++) {
if((inw(ioaddr + 0x30) & 1) ==0) break;
}
}
}
#endif
if ( vend == NEC_VERSA_SUBID1 || vend == NEC_VERSA_SUBID2) {
/* turn on external amp? */
outw(0xf9ff, ioaddr + 0x64);
outw(inw(ioaddr+0x68) | 0x600, ioaddr + 0x68);
outw(0x0209, ioaddr + 0x60);
}
/* Turn on the 978 docking chip.
First frob the "master output enable" bit,
then set most of the playback volume control registers to max. */
outb(inb(ioaddr+0xc0)|(1<<5), ioaddr+0xc0);
outb(0xff, ioaddr+0xc3);
outb(0xff, ioaddr+0xc4);
outb(0xff, ioaddr+0xc6);
outb(0xff, ioaddr+0xc8);
outb(0x3f, ioaddr+0xcf);
outb(0x3f, ioaddr+0xd0);
}
/*
* Indirect register access. Not all registers are readable so we
* need to keep register state ourselves
*/
#define WRITEABLE_MAP 0xEFFFFF
#define READABLE_MAP 0x64003F
/*
* The Maestro engineers were a little indirection happy. These indirected
* registers themselves include indirect registers at another layer
*/
static void __maestro_write(struct ess_card *card, u16 reg, u16 data)
{
long ioaddr = card->iobase;
outw(reg, ioaddr+0x02);
outw(data, ioaddr+0x00);
if( reg >= NR_IDRS) printk("maestro: IDR %d out of bounds!\n",reg);
else card->maestro_map[reg]=data;
}
static void maestro_write(struct ess_state *s, u16 reg, u16 data)
{
unsigned long flags;
check_suspend(s->card);
spin_lock_irqsave(&s->card->lock,flags);
__maestro_write(s->card,reg,data);
spin_unlock_irqrestore(&s->card->lock,flags);
}
static u16 __maestro_read(struct ess_card *card, u16 reg)
{
long ioaddr = card->iobase;
outw(reg, ioaddr+0x02);
return card->maestro_map[reg]=inw(ioaddr+0x00);
}
static u16 maestro_read(struct ess_state *s, u16 reg)
{
if(READABLE_MAP & (1<<reg))
{
unsigned long flags;
check_suspend(s->card);
spin_lock_irqsave(&s->card->lock,flags);
__maestro_read(s->card,reg);
spin_unlock_irqrestore(&s->card->lock,flags);
}
return s->card->maestro_map[reg];
}
/*
* These routines handle accessing the second level indirections to the
* wave ram.
*/
/*
* The register names are the ones ESS uses (see 104T31.ZIP)
*/
#define IDR0_DATA_PORT 0x00
#define IDR1_CRAM_POINTER 0x01
#define IDR2_CRAM_DATA 0x02
#define IDR3_WAVE_DATA 0x03
#define IDR4_WAVE_PTR_LOW 0x04
#define IDR5_WAVE_PTR_HI 0x05
#define IDR6_TIMER_CTRL 0x06
#define IDR7_WAVE_ROMRAM 0x07
static void apu_index_set(struct ess_card *card, u16 index)
{
int i;
__maestro_write(card, IDR1_CRAM_POINTER, index);
for(i=0;i<1000;i++)
if(__maestro_read(card, IDR1_CRAM_POINTER)==index)
return;
printk(KERN_WARNING "maestro: APU register select failed.\n");
}
static void apu_data_set(struct ess_card *card, u16 data)
{
int i;
for(i=0;i<1000;i++)
{
if(__maestro_read(card, IDR0_DATA_PORT)==data)
return;
__maestro_write(card, IDR0_DATA_PORT, data);
}
}
/*
* This is the public interface for APU manipulation. It handles the
* interlock to avoid two APU writes in parallel etc. Don't diddle
* directly with the stuff above.
*/
static void apu_set_register(struct ess_state *s, u16 channel, u8 reg, u16 data)
{
unsigned long flags;
check_suspend(s->card);
if(channel&ESS_CHAN_HARD)
channel&=~ESS_CHAN_HARD;
else
{
if(channel>5)
printk("BAD CHANNEL %d.\n",channel);
else
channel = s->apu[channel];
/* store based on real hardware apu/reg */
s->card->apu_map[channel][reg]=data;
}
reg|=(channel<<4);
/* hooray for double indirection!! */
spin_lock_irqsave(&s->card->lock,flags);
apu_index_set(s->card, reg);
apu_data_set(s->card, data);
spin_unlock_irqrestore(&s->card->lock,flags);
}
static u16 apu_get_register(struct ess_state *s, u16 channel, u8 reg)
{
unsigned long flags;
u16 v;
check_suspend(s->card);
if(channel&ESS_CHAN_HARD)
channel&=~ESS_CHAN_HARD;
else
channel = s->apu[channel];
reg|=(channel<<4);
spin_lock_irqsave(&s->card->lock,flags);
apu_index_set(s->card, reg);
v=__maestro_read(s->card, IDR0_DATA_PORT);
spin_unlock_irqrestore(&s->card->lock,flags);
return v;
}
/*
* The wavecache buffers between the APUs and
* pci bus mastering
*/
static void wave_set_register(struct ess_state *s, u16 reg, u16 value)
{
long ioaddr = s->card->iobase;
unsigned long flags;
check_suspend(s->card);
spin_lock_irqsave(&s->card->lock,flags);
outw(reg, ioaddr+0x10);
outw(value, ioaddr+0x12);
spin_unlock_irqrestore(&s->card->lock,flags);
}
static u16 wave_get_register(struct ess_state *s, u16 reg)
{
long ioaddr = s->card->iobase;
unsigned long flags;
u16 value;
check_suspend(s->card);
spin_lock_irqsave(&s->card->lock,flags);
outw(reg, ioaddr+0x10);
value=inw(ioaddr+0x12);
spin_unlock_irqrestore(&s->card->lock,flags);
return value;
}
static void sound_reset(int ioaddr)
{
outw(0x2000, 0x18+ioaddr);
udelay(1);
outw(0x0000, 0x18+ioaddr);
udelay(1);
}
/* sets the play formats of these apus, should be passed the already shifted format */
static void set_apu_fmt(struct ess_state *s, int apu, int mode)
{
int apu_fmt = 0x10;
if(!(mode&ESS_FMT_16BIT)) apu_fmt+=0x20;
if((mode&ESS_FMT_STEREO)) apu_fmt+=0x10;
s->apu_mode[apu] = apu_fmt;
s->apu_mode[apu+1] = apu_fmt;
}
/* this only fixes the output apu mode to be later set by start_dac and
company. output apu modes are set in ess_rec_setup */
static void set_fmt(struct ess_state *s, unsigned char mask, unsigned char data)
{
s->fmt = (s->fmt & mask) | data;
set_apu_fmt(s, 0, (s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK);
}
/* this is off by a little bit.. */
static u32 compute_rate(struct ess_state *s, u32 freq)
{
u32 clock = clock_freq[s->card->card_type];
freq = (freq * clocking)/48000;
if (freq == 48000)
return 0x10000;
return ((freq / clock) <<16 )+
(((freq % clock) << 16) / clock);
}
static void set_dac_rate(struct ess_state *s, unsigned int rate)
{
u32 freq;
int fmt = (s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK;
if (rate > 48000)
rate = 48000;
if (rate < 4000)
rate = 4000;
s->ratedac = rate;
if(! (fmt & ESS_FMT_16BIT) && !(fmt & ESS_FMT_STEREO))
rate >>= 1;
/* M_printk("computing dac rate %d with mode %d\n",rate,s->fmt);*/
freq = compute_rate(s, rate);
/* Load the frequency, turn on 6dB */
apu_set_register(s, 0, 2,(apu_get_register(s, 0, 2)&0x00FF)|
( ((freq&0xFF)<<8)|0x10 ));
apu_set_register(s, 0, 3, freq>>8);
apu_set_register(s, 1, 2,(apu_get_register(s, 1, 2)&0x00FF)|
( ((freq&0xFF)<<8)|0x10 ));
apu_set_register(s, 1, 3, freq>>8);
}
static void set_adc_rate(struct ess_state *s, unsigned rate)
{
u32 freq;
/* Sample Rate conversion APUs don't like 0x10000 for their rate */
if (rate > 47999)
rate = 47999;
if (rate < 4000)
rate = 4000;
s->rateadc = rate;
freq = compute_rate(s, rate);
/* Load the frequency, turn on 6dB */
apu_set_register(s, 2, 2,(apu_get_register(s, 2, 2)&0x00FF)|
( ((freq&0xFF)<<8)|0x10 ));
apu_set_register(s, 2, 3, freq>>8);
apu_set_register(s, 3, 2,(apu_get_register(s, 3, 2)&0x00FF)|
( ((freq&0xFF)<<8)|0x10 ));
apu_set_register(s, 3, 3, freq>>8);
/* fix mixer rate at 48khz. and its _must_ be 0x10000. */
freq = 0x10000;
apu_set_register(s, 4, 2,(apu_get_register(s, 4, 2)&0x00FF)|
( ((freq&0xFF)<<8)|0x10 ));
apu_set_register(s, 4, 3, freq>>8);
apu_set_register(s, 5, 2,(apu_get_register(s, 5, 2)&0x00FF)|
( ((freq&0xFF)<<8)|0x10 ));
apu_set_register(s, 5, 3, freq>>8);
}
/* Stop our host of recording apus */
static inline void stop_adc(struct ess_state *s)
{
/* XXX lets hope we don't have to lock around this */
if (! (s->enable & ADC_RUNNING)) return;
s->enable &= ~ADC_RUNNING;
apu_set_register(s, 2, 0, apu_get_register(s, 2, 0)&0xFF0F);
apu_set_register(s, 3, 0, apu_get_register(s, 3, 0)&0xFF0F);
apu_set_register(s, 4, 0, apu_get_register(s, 2, 0)&0xFF0F);
apu_set_register(s, 5, 0, apu_get_register(s, 3, 0)&0xFF0F);
}
/* stop output apus */
static void stop_dac(struct ess_state *s)
{
/* XXX have to lock around this? */
if (! (s->enable & DAC_RUNNING)) return;
s->enable &= ~DAC_RUNNING;
apu_set_register(s, 0, 0, apu_get_register(s, 0, 0)&0xFF0F);
apu_set_register(s, 1, 0, apu_get_register(s, 1, 0)&0xFF0F);
}
static void start_dac(struct ess_state *s)
{
/* XXX locks? */
if ( (s->dma_dac.mapped || s->dma_dac.count > 0) &&
s->dma_dac.ready &&
(! (s->enable & DAC_RUNNING)) ) {
s->enable |= DAC_RUNNING;
apu_set_register(s, 0, 0,
(apu_get_register(s, 0, 0)&0xFF0F)|s->apu_mode[0]);
if((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_STEREO)
apu_set_register(s, 1, 0,
(apu_get_register(s, 1, 0)&0xFF0F)|s->apu_mode[1]);
}
}
static void start_adc(struct ess_state *s)
{
/* XXX locks? */
if ((s->dma_adc.mapped || s->dma_adc.count < (signed)(s->dma_adc.dmasize - 2*s->dma_adc.fragsize))
&& s->dma_adc.ready && (! (s->enable & ADC_RUNNING)) ) {
s->enable |= ADC_RUNNING;
apu_set_register(s, 2, 0,
(apu_get_register(s, 2, 0)&0xFF0F)|s->apu_mode[2]);
apu_set_register(s, 4, 0,
(apu_get_register(s, 4, 0)&0xFF0F)|s->apu_mode[4]);
if( s->fmt & (ESS_FMT_STEREO << ESS_ADC_SHIFT)) {
apu_set_register(s, 3, 0,
(apu_get_register(s, 3, 0)&0xFF0F)|s->apu_mode[3]);
apu_set_register(s, 5, 0,
(apu_get_register(s, 5, 0)&0xFF0F)|s->apu_mode[5]);
}
}
}
/*
* Native play back driver
*/
/* the mode passed should be already shifted and masked */
static void
ess_play_setup(struct ess_state *ess, int mode, u32 rate, void *buffer, int size)
{
u32 pa;
u32 tmpval;
int high_apu = 0;
int channel;
M_printk("mode=%d rate=%d buf=%p len=%d.\n",
mode, rate, buffer, size);
/* all maestro sizes are in 16bit words */
size >>=1;
if(mode&ESS_FMT_STEREO) {
high_apu++;
/* only 16/stereo gets size divided */
if(mode&ESS_FMT_16BIT)
size>>=1;
}
for(channel=0; channel <= high_apu; channel++)
{
pa = virt_to_bus(buffer);
/* set the wavecache control reg */
tmpval = (pa - 0x10) & 0xFFF8;
if(!(mode & ESS_FMT_16BIT)) tmpval |= 4;
if(mode & ESS_FMT_STEREO) tmpval |= 2;
ess->apu_base[channel]=tmpval;
wave_set_register(ess, ess->apu[channel]<<3, tmpval);
pa -= virt_to_bus(ess->card->dmapages);
pa>>=1; /* words */
/* base offset of dma calcs when reading the pointer
on the left one */
if(!channel) ess->dma_dac.base = pa&0xFFFF;
pa|=0x00400000; /* System RAM */
/* XXX the 16bit here might not be needed.. */
if((mode & ESS_FMT_STEREO) && (mode & ESS_FMT_16BIT)) {
if(channel)
pa|=0x00800000; /* Stereo */
pa>>=1;
}
/* XXX think about endianess when writing these registers */
M_printk("maestro: ess_play_setup: APU[%d] pa = 0x%x\n", ess->apu[channel], pa);
/* start of sample */
apu_set_register(ess, channel, 4, ((pa>>16)&0xFF)<<8);
apu_set_register(ess, channel, 5, pa&0xFFFF);
/* sample end */
apu_set_register(ess, channel, 6, (pa+size)&0xFFFF);
/* setting loop len == sample len */
apu_set_register(ess, channel, 7, size);
/* clear effects/env.. */
apu_set_register(ess, channel, 8, 0x0000);
/* set amp now to 0xd0 (?), low byte is 'amplitude dest'? */
apu_set_register(ess, channel, 9, 0xD000);
/* clear routing stuff */
apu_set_register(ess, channel, 11, 0x0000);
/* dma on, no envelopes, filter to all 1s) */
apu_set_register(ess, channel, 0, 0x400F);
if(mode&ESS_FMT_16BIT)
ess->apu_mode[channel]=0x10;
else
ess->apu_mode[channel]=0x30;
if(mode&ESS_FMT_STEREO) {
/* set panning: left or right */
apu_set_register(ess, channel, 10, 0x8F00 | (channel ? 0 : 0x10));
ess->apu_mode[channel] += 0x10;
} else
apu_set_register(ess, channel, 10, 0x8F08);
}
/* clear WP interrupts */
outw(1, ess->card->iobase+0x04);
/* enable WP ints */
outw(inw(ess->card->iobase+0x18)|4, ess->card->iobase+0x18);
/* go team! */
set_dac_rate(ess,rate);
start_dac(ess);
}
/*
* Native record driver
*/
/* again, passed mode is alrady shifted/masked */
static void
ess_rec_setup(struct ess_state *ess, int mode, u32 rate, void *buffer, int size)
{
int apu_step = 2;
int channel;
M_printk("maestro: ess_rec_setup: mode=%d rate=%d buf=0x%p len=%d.\n",
mode, rate, buffer, size);
/* all maestro sizes are in 16bit words */
size >>=1;
/* we're given the full size of the buffer, but
in stereo each channel will only use its half */
if(mode&ESS_FMT_STEREO) {
size >>=1;
apu_step = 1;
}
/* APU assignments: 2 = mono/left SRC
3 = right SRC
4 = mono/left Input Mixer
5 = right Input Mixer */
for(channel=2;channel<6;channel+=apu_step)
{
int i;
int bsize, route;
u32 pa;
u32 tmpval;
/* data seems to flow from the codec, through an apu into
the 'mixbuf' bit of page, then through the SRC apu
and out to the real 'buffer'. ok. sure. */
if(channel & 0x04) {
/* ok, we're an input mixer going from adc
through the mixbuf to the other apus */
if(!(channel & 0x01)) {
pa = virt_to_bus(ess->mixbuf);
} else {
pa = virt_to_bus(ess->mixbuf + (PAGE_SIZE >> 4));
}
/* we source from a 'magic' apu */
bsize = PAGE_SIZE >> 5; /* half of this channels alloc, in words */
route = 0x14 + (channel - 4); /* parallel in crap, see maestro reg 0xC [8-11] */
ess->apu_mode[channel] = 0x90; /* Input Mixer */
} else {
/* we're a rate converter taking
input from the input apus and outputing it to
system memory */
if(!(channel & 0x01)) {
pa = virt_to_bus(buffer);
} else {
/* right channel records its split half.
*2 accommodates for rampant shifting earlier */
pa = virt_to_bus(buffer + size*2);
}
ess->apu_mode[channel] = 0xB0; /* Sample Rate Converter */
bsize = size;
/* get input from inputing apu */
route = channel + 2;
}
M_printk("maestro: ess_rec_setup: getting pa 0x%x from %d\n",pa,channel);
/* set the wavecache control reg */
tmpval = (pa - 0x10) & 0xFFF8;
ess->apu_base[channel]=tmpval;
wave_set_register(ess, ess->apu[channel]<<3, tmpval);
pa -= virt_to_bus(ess->card->dmapages);
pa>>=1; /* words */
/* base offset of dma calcs when reading the pointer
on this left one */
if(channel==2) ess->dma_adc.base = pa&0xFFFF;
pa|=0x00400000; /* bit 22 -> System RAM */
M_printk("maestro: ess_rec_setup: APU[%d] pa = 0x%x size = 0x%x route = 0x%x\n",
ess->apu[channel], pa, bsize, route);
/* Begin loading the APU */
for(i=0;i<15;i++) /* clear all PBRs */
apu_set_register(ess, channel, i, 0x0000);
apu_set_register(ess, channel, 0, 0x400F);
/* need to enable subgroups.. and we should probably
have different groups for different /dev/dsps.. */
apu_set_register(ess, channel, 2, 0x8);
/* Load the buffer into the wave engine */
apu_set_register(ess, channel, 4, ((pa>>16)&0xFF)<<8);
/* XXX reg is little endian.. */
apu_set_register(ess, channel, 5, pa&0xFFFF);
apu_set_register(ess, channel, 6, (pa+bsize)&0xFFFF);
apu_set_register(ess, channel, 7, bsize);
/* clear effects/env.. */
apu_set_register(ess, channel, 8, 0x00F0);
/* amplitude now? sure. why not. */
apu_set_register(ess, channel, 9, 0x0000);
/* set filter tune, radius, polar pan */
apu_set_register(ess, channel, 10, 0x8F08);
/* route input */
apu_set_register(ess, channel, 11, route);
}
/* clear WP interrupts */
outw(1, ess->card->iobase+0x04);
/* enable WP ints */
outw(inw(ess->card->iobase+0x18)|4, ess->card->iobase+0x18);
/* let 'er rip */
set_adc_rate(ess,rate);
start_adc(ess);
}
/* --------------------------------------------------------------------- */
static void set_dmaa(struct ess_state *s, unsigned int addr, unsigned int count)
{
M_printk("set_dmaa??\n");
}
static void set_dmac(struct ess_state *s, unsigned int addr, unsigned int count)
{
M_printk("set_dmac??\n");
}
/* Playback pointer */
static inline unsigned get_dmaa(struct ess_state *s)
{
int offset;
offset = apu_get_register(s,0,5);
/* M_printk("dmaa: offset: %d, base: %d\n",offset,s->dma_dac.base); */
offset-=s->dma_dac.base;
return (offset&0xFFFE)<<1; /* hardware is in words */
}
/* Record pointer */
static inline unsigned get_dmac(struct ess_state *s)
{
int offset;
offset = apu_get_register(s,2,5);
/* M_printk("dmac: offset: %d, base: %d\n",offset,s->dma_adc.base); */
/* The offset is an address not a position relative to base */
offset-=s->dma_adc.base;
return (offset&0xFFFE)<<1; /* hardware is in words */
}
/*
* Meet Bob, the timer...
*/
static irqreturn_t ess_interrupt(int irq, void *dev_id, struct pt_regs *regs);
static void stop_bob(struct ess_state *s)
{
/* Mask IDR 11,17 */
maestro_write(s, 0x11, maestro_read(s, 0x11)&~1);
maestro_write(s, 0x17, maestro_read(s, 0x17)&~1);
}
/* eventually we could be clever and limit bob ints
to the frequency at which our smallest duration
chunks may expire */
#define ESS_SYSCLK 50000000
static void start_bob(struct ess_state *s)
{
int prescale;
int divide;
/* XXX make freq selector much smarter, see calc_bob_rate */
int freq = 200;
/* compute ideal interrupt frequency for buffer size & play rate */
/* first, find best prescaler value to match freq */
for(prescale=5;prescale<12;prescale++)
if(freq > (ESS_SYSCLK>>(prescale+9)))
break;
/* next, back off prescaler whilst getting divider into optimum range */
divide=1;
while((prescale > 5) && (divide<32))
{
prescale--;
divide <<=1;
}
divide>>=1;
/* now fine-tune the divider for best match */
for(;divide<31;divide++)
if(freq >= ((ESS_SYSCLK>>(prescale+9))/(divide+1)))
break;
/* divide = 0 is illegal, but don't let prescale = 4! */
if(divide == 0)
{
divide++;
if(prescale>5)
prescale--;
}
maestro_write(s, 6, 0x9000 | (prescale<<5) | divide); /* set reg */
/* Now set IDR 11/17 */
maestro_write(s, 0x11, maestro_read(s, 0x11)|1);
maestro_write(s, 0x17, maestro_read(s, 0x17)|1);
}
/* --------------------------------------------------------------------- */
/* this quickly calculates the frequency needed for bob
and sets it if its different than what bob is
currently running at. its called often so
needs to be fairly quick. */
#define BOB_MIN 50
#define BOB_MAX 400
static void calc_bob_rate(struct ess_state *s) {
#if 0 /* this thing tries to set the frequency of bob such that
there are 2 interrupts / buffer walked by the dac/adc. That
is probably very wrong for people who actually care about
mid buffer positioning. it should be calculated as bytes/interrupt
and that needs to be decided :) so for now just use the static 150
in start_bob.*/
unsigned int dac_rate=2,adc_rate=1,newrate;
static int israte=-1;
if (s->dma_dac.fragsize == 0) dac_rate = BOB_MIN;
else {
dac_rate = (2 * s->ratedac * sample_size[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK]) /
(s->dma_dac.fragsize) ;
}
if (s->dma_adc.fragsize == 0) adc_rate = BOB_MIN;
else {
adc_rate = (2 * s->rateadc * sample_size[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK]) /
(s->dma_adc.fragsize) ;
}
if(dac_rate > adc_rate) newrate = adc_rate;
else newrate=dac_rate;
if(newrate > BOB_MAX) newrate = BOB_MAX;
else {
if(newrate < BOB_MIN)
newrate = BOB_MIN;
}
if( israte != newrate) {
printk("dac: %d adc: %d rate: %d\n",dac_rate,adc_rate,israte);
israte=newrate;
}
#endif
}
static int
prog_dmabuf(struct ess_state *s, unsigned rec)
{
struct dmabuf *db = rec ? &s->dma_adc : &s->dma_dac;
unsigned rate = rec ? s->rateadc : s->ratedac;
unsigned bytepersec;
unsigned bufs;
unsigned char fmt;
unsigned long flags;
spin_lock_irqsave(&s->lock, flags);
fmt = s->fmt;
if (rec) {
stop_adc(s);
fmt >>= ESS_ADC_SHIFT;
} else {
stop_dac(s);
fmt >>= ESS_DAC_SHIFT;
}
spin_unlock_irqrestore(&s->lock, flags);
fmt &= ESS_FMT_MASK;
db->hwptr = db->swptr = db->total_bytes = db->count = db->error = db->endcleared = 0;
/* this algorithm is a little nuts.. where did /1000 come from? */
bytepersec = rate << sample_shift[fmt];
bufs = PAGE_SIZE << db->buforder;
if (db->ossfragshift) {
if ((1000 << db->ossfragshift) < bytepersec)
db->fragshift = ld2(bytepersec/1000);
else
db->fragshift = db->ossfragshift;
} else {
db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1));
if (db->fragshift < 3)
db->fragshift = 3;
}
db->numfrag = bufs >> db->fragshift;
while (db->numfrag < 4 && db->fragshift > 3) {
db->fragshift--;
db->numfrag = bufs >> db->fragshift;
}
db->fragsize = 1 << db->fragshift;
if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag)
db->numfrag = db->ossmaxfrags;
db->fragsamples = db->fragsize >> sample_shift[fmt];
db->dmasize = db->numfrag << db->fragshift;
M_printk("maestro: setup oss: numfrag: %d fragsize: %d dmasize: %d\n",db->numfrag,db->fragsize,db->dmasize);
memset(db->rawbuf, (fmt & ESS_FMT_16BIT) ? 0 : 0x80, db->dmasize);
spin_lock_irqsave(&s->lock, flags);
if (rec)
ess_rec_setup(s, fmt, s->rateadc, db->rawbuf, db->dmasize);
else
ess_play_setup(s, fmt, s->ratedac, db->rawbuf, db->dmasize);
spin_unlock_irqrestore(&s->lock, flags);
db->ready = 1;
return 0;
}
static __inline__ void
clear_advance(struct ess_state *s)
{
unsigned char c = ((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_16BIT) ? 0 : 0x80;
unsigned char *buf = s->dma_dac.rawbuf;
unsigned bsize = s->dma_dac.dmasize;
unsigned bptr = s->dma_dac.swptr;
unsigned len = s->dma_dac.fragsize;
if (bptr + len > bsize) {
unsigned x = bsize - bptr;
memset(buf + bptr, c, x);
/* account for wrapping? */
bptr = 0;
len -= x;
}
memset(buf + bptr, c, len);
}
/* call with spinlock held! */
static void
ess_update_ptr(struct ess_state *s)
{
unsigned hwptr;
int diff;
/* update ADC pointer */
if (s->dma_adc.ready) {
/* oh boy should this all be re-written. everything in the current code paths think
that the various counters/pointers are expressed in bytes to the user but we have
two apus doing stereo stuff so we fix it up here.. it propagates to all the various
counters from here. */
if ( s->fmt & (ESS_FMT_STEREO << ESS_ADC_SHIFT)) {
hwptr = (get_dmac(s)*2) % s->dma_adc.dmasize;
} else {
hwptr = get_dmac(s) % s->dma_adc.dmasize;
}
diff = (s->dma_adc.dmasize + hwptr - s->dma_adc.hwptr) % s->dma_adc.dmasize;
s->dma_adc.hwptr = hwptr;
s->dma_adc.total_bytes += diff;
s->dma_adc.count += diff;
if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
wake_up(&s->dma_adc.wait);
if (!s->dma_adc.mapped) {
if (s->dma_adc.count > (signed)(s->dma_adc.dmasize - ((3 * s->dma_adc.fragsize) >> 1))) {
/* FILL ME
wrindir(s, SV_CIENABLE, s->enable); */
stop_adc(s);
/* brute force everyone back in sync, sigh */
s->dma_adc.count = 0;
s->dma_adc.swptr = 0;
s->dma_adc.hwptr = 0;
s->dma_adc.error++;
}
}
}
/* update DAC pointer */
if (s->dma_dac.ready) {
hwptr = get_dmaa(s) % s->dma_dac.dmasize;
/* the apu only reports the length it has seen, not the
length of the memory that has been used (the WP
knows that) */
if ( ((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK) == (ESS_FMT_STEREO|ESS_FMT_16BIT))
hwptr<<=1;
diff = (s->dma_dac.dmasize + hwptr - s->dma_dac.hwptr) % s->dma_dac.dmasize;
/* M_printk("updating dac: hwptr: %d diff: %d\n",hwptr,diff);*/
s->dma_dac.hwptr = hwptr;
s->dma_dac.total_bytes += diff;
if (s->dma_dac.mapped) {
s->dma_dac.count += diff;
if (s->dma_dac.count >= (signed)s->dma_dac.fragsize) {
wake_up(&s->dma_dac.wait);
}
} else {
s->dma_dac.count -= diff;
/* M_printk("maestro: ess_update_ptr: diff: %d, count: %d\n", diff, s->dma_dac.count); */
if (s->dma_dac.count <= 0) {
M_printk("underflow! diff: %d count: %d hw: %d sw: %d\n", diff, s->dma_dac.count,
hwptr, s->dma_dac.swptr);
/* FILL ME
wrindir(s, SV_CIENABLE, s->enable); */
/* XXX how on earth can calling this with the lock held work.. */
stop_dac(s);
/* brute force everyone back in sync, sigh */
s->dma_dac.count = 0;
s->dma_dac.swptr = hwptr;
s->dma_dac.error++;
} else if (s->dma_dac.count <= (signed)s->dma_dac.fragsize && !s->dma_dac.endcleared) {
clear_advance(s);
s->dma_dac.endcleared = 1;
}
if (s->dma_dac.count + (signed)s->dma_dac.fragsize <= (signed)s->dma_dac.dmasize) {
wake_up(&s->dma_dac.wait);
/* printk("waking up DAC count: %d sw: %d hw: %d\n",s->dma_dac.count, s->dma_dac.swptr,
hwptr);*/
}
}
}
}
static irqreturn_t
ess_interrupt(int irq, void *dev_id, struct pt_regs *regs)
{
struct ess_state *s;
struct ess_card *c = (struct ess_card *)dev_id;
int i;
u32 event;
if ( ! (event = inb(c->iobase+0x1A)) )
return IRQ_NONE;
outw(inw(c->iobase+4)&1, c->iobase+4);
/* M_printk("maestro int: %x\n",event);*/
if(event&(1<<6))
{
int x;
enum {UP_EVT, DOWN_EVT, MUTE_EVT} vol_evt;
int volume;
/* Figure out which volume control button was pushed,
based on differences from the default register
values. */
x = inb(c->iobase+0x1c);
if (x&1) vol_evt = MUTE_EVT;
else if (((x>>1)&7) > 4) vol_evt = UP_EVT;
else vol_evt = DOWN_EVT;
/* Reset the volume control registers. */
outb(0x88, c->iobase+0x1c);
outb(0x88, c->iobase+0x1d);
outb(0x88, c->iobase+0x1e);
outb(0x88, c->iobase+0x1f);
/* Deal with the button press in a hammer-handed
manner by adjusting the master mixer volume. */
volume = c->mix.mixer_state[0] & 0xff;
if (vol_evt == UP_EVT) {
volume += 5;
if (volume > 100)
volume = 100;
}
else if (vol_evt == DOWN_EVT) {
volume -= 5;
if (volume < 0)
volume = 0;
} else {
/* vol_evt == MUTE_EVT */
if (volume == 0)
volume = c->dock_mute_vol;
else {
c->dock_mute_vol = volume;
volume = 0;
}
}
set_mixer (c, 0, (volume << 8) | volume);
}
/* Ack all the interrupts. */
outb(0xFF, c->iobase+0x1A);
/*
* Update the pointers for all APU's we are running.
*/
for(i=0;i<NR_DSPS;i++)
{
s=&c->channels[i];
if(s->dev_audio == -1)
break;
spin_lock(&s->lock);
ess_update_ptr(s);
spin_unlock(&s->lock);
}
return IRQ_HANDLED;
}
/* --------------------------------------------------------------------- */
static const char invalid_magic[] = KERN_CRIT "maestro: invalid magic value in %s\n";
#define VALIDATE_MAGIC(FOO,MAG) \
({ \
if (!(FOO) || (FOO)->magic != MAG) { \
printk(invalid_magic,__FUNCTION__); \
return -ENXIO; \
} \
})
#define VALIDATE_STATE(a) VALIDATE_MAGIC(a,ESS_STATE_MAGIC)
#define VALIDATE_CARD(a) VALIDATE_MAGIC(a,ESS_CARD_MAGIC)
static void set_mixer(struct ess_card *card,unsigned int mixer, unsigned int val )
{
unsigned int left,right;
/* cleanse input a little */
right = ((val >> 8) & 0xff) ;
left = (val & 0xff) ;
if(right > 100) right = 100;
if(left > 100) left = 100;
card->mix.mixer_state[mixer]=(right << 8) | left;
card->mix.write_mixer(card,mixer,left,right);
}
static void
mixer_push_state(struct ess_card *card)
{
int i;
for(i = 0 ; i < SOUND_MIXER_NRDEVICES ; i++) {
if( ! supported_mixer(card,i)) continue;
set_mixer(card,i,card->mix.mixer_state[i]);
}
}
static int mixer_ioctl(struct ess_card *card, unsigned int cmd, unsigned long arg)
{
int i, val=0;
unsigned long flags;
void __user *argp = (void __user *)arg;
int __user *p = argp;
VALIDATE_CARD(card);
if (cmd == SOUND_MIXER_INFO) {
mixer_info info;
memset(&info, 0, sizeof(info));
strlcpy(info.id, card_names[card->card_type], sizeof(info.id));
strlcpy(info.name, card_names[card->card_type], sizeof(info.name));
info.modify_counter = card->mix.modcnt;
if (copy_to_user(argp, &info, sizeof(info)))
return -EFAULT;
return 0;
}
if (cmd == SOUND_OLD_MIXER_INFO) {
_old_mixer_info info;
memset(&info, 0, sizeof(info));
strlcpy(info.id, card_names[card->card_type], sizeof(info.id));
strlcpy(info.name, card_names[card->card_type], sizeof(info.name));
if (copy_to_user(argp, &info, sizeof(info)))
return -EFAULT;
return 0;
}
if (cmd == OSS_GETVERSION)
return put_user(SOUND_VERSION, p);
if (_IOC_TYPE(cmd) != 'M' || _IOC_SIZE(cmd) != sizeof(int))
return -EINVAL;
if (_IOC_DIR(cmd) == _IOC_READ) {
switch (_IOC_NR(cmd)) {
case SOUND_MIXER_RECSRC: /* give them the current record source */
if(!card->mix.recmask_io) {
val = 0;
} else {
spin_lock_irqsave(&card->lock, flags);
val = card->mix.recmask_io(card,1,0);
spin_unlock_irqrestore(&card->lock, flags);
}
break;
case SOUND_MIXER_DEVMASK: /* give them the supported mixers */
val = card->mix.supported_mixers;
break;
case SOUND_MIXER_RECMASK: /* Arg contains a bit for each supported recording source */
val = card->mix.record_sources;
break;
case SOUND_MIXER_STEREODEVS: /* Mixer channels supporting stereo */
val = card->mix.stereo_mixers;
break;
case SOUND_MIXER_CAPS:
val = SOUND_CAP_EXCL_INPUT;
break;
default: /* read a specific mixer */
i = _IOC_NR(cmd);
if ( ! supported_mixer(card,i))
return -EINVAL;
/* do we ever want to touch the hardware? */
/* spin_lock_irqsave(&card->lock, flags);
val = card->mix.read_mixer(card,i);
spin_unlock_irqrestore(&card->lock, flags);*/
val = card->mix.mixer_state[i];
/* M_printk("returned 0x%x for mixer %d\n",val,i);*/
break;
}
return put_user(val, p);
}
if (_IOC_DIR(cmd) != (_IOC_WRITE|_IOC_READ))
return -EINVAL;
card->mix.modcnt++;
if (get_user(val, p))
return -EFAULT;
switch (_IOC_NR(cmd)) {
case SOUND_MIXER_RECSRC: /* Arg contains a bit for each recording source */
if (!card->mix.recmask_io) return -EINVAL;
if(!val) return 0;
if(! (val &= card->mix.record_sources)) return -EINVAL;
spin_lock_irqsave(&card->lock, flags);
card->mix.recmask_io(card,0,val);
spin_unlock_irqrestore(&card->lock, flags);
return 0;
default:
i = _IOC_NR(cmd);
if ( ! supported_mixer(card,i))
return -EINVAL;
spin_lock_irqsave(&card->lock, flags);
set_mixer(card,i,val);
spin_unlock_irqrestore(&card->lock, flags);
return 0;
}
}
/* --------------------------------------------------------------------- */
static int ess_open_mixdev(struct inode *inode, struct file *file)
{
unsigned int minor = iminor(inode);
struct ess_card *card = NULL;
struct pci_dev *pdev = NULL;
struct pci_driver *drvr;
while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) {
drvr = pci_dev_driver (pdev);
if (drvr == &maestro_pci_driver) {
card = (struct ess_card*)pci_get_drvdata (pdev);
if (!card)
continue;
if (card->dev_mixer == minor)
break;
}
}
if (!card)
return -ENODEV;
file->private_data = card;
return nonseekable_open(inode, file);
}
static int ess_release_mixdev(struct inode *inode, struct file *file)
{
struct ess_card *card = (struct ess_card *)file->private_data;
VALIDATE_CARD(card);
return 0;
}
static int ess_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
struct ess_card *card = (struct ess_card *)file->private_data;
VALIDATE_CARD(card);
return mixer_ioctl(card, cmd, arg);
}
static /*const*/ struct file_operations ess_mixer_fops = {
.owner = THIS_MODULE,
.llseek = no_llseek,
.ioctl = ess_ioctl_mixdev,
.open = ess_open_mixdev,
.release = ess_release_mixdev,
};
/* --------------------------------------------------------------------- */
static int drain_dac(struct ess_state *s, int nonblock)
{
DECLARE_WAITQUEUE(wait,current);
unsigned long flags;
int count;
signed long tmo;
if (s->dma_dac.mapped || !s->dma_dac.ready)
return 0;
current->state = TASK_INTERRUPTIBLE;
add_wait_queue(&s->dma_dac.wait, &wait);
for (;;) {
/* XXX uhm.. questionable locking*/
spin_lock_irqsave(&s->lock, flags);
count = s->dma_dac.count;
spin_unlock_irqrestore(&s->lock, flags);
if (count <= 0)
break;
if (signal_pending(current))
break;
if (nonblock) {
remove_wait_queue(&s->dma_dac.wait, &wait);
current->state = TASK_RUNNING;
return -EBUSY;
}
tmo = (count * HZ) / s->ratedac;
tmo >>= sample_shift[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK];
/* XXX this is just broken. someone is waking us up alot, or schedule_timeout is broken.
or something. who cares. - zach */
if (!schedule_timeout(tmo ? tmo : 1) && tmo)
M_printk(KERN_DEBUG "maestro: dma timed out?? %ld\n",jiffies);
}
remove_wait_queue(&s->dma_dac.wait, &wait);
current->state = TASK_RUNNING;
if (signal_pending(current))
return -ERESTARTSYS;
return 0;
}
/* --------------------------------------------------------------------- */
/* Zach sez: "god this is gross.." */
static int
comb_stereo(unsigned char *real_buffer,unsigned char *tmp_buffer, int offset,
int count, int bufsize)
{
/* No such thing as stereo recording, so we
use dual input mixers. which means we have to
combine mono to stereo buffer. yuck.
but we don't have to be able to work a byte at a time..*/
unsigned char *so,*left,*right;
int i;
so = tmp_buffer;
left = real_buffer + offset;
right = real_buffer + bufsize/2 + offset;
/* 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);*/
for(i=count/4; i ; i--) {
(*(so+2)) = *(right++);
(*(so+3)) = *(right++);
(*so) = *(left++);
(*(so+1)) = *(left++);
so+=4;
}
return 0;
}
/* in this loop, dma_adc.count signifies the amount of data thats waiting
to be copied to the user's buffer. it is filled by the interrupt
handler and drained by this loop. */
static ssize_t
ess_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
{
struct ess_state *s = (struct ess_state *)file->private_data;
ssize_t ret;
unsigned long flags;
unsigned swptr;
int cnt;
unsigned char *combbuf = NULL;
VALIDATE_STATE(s);
if (s->dma_adc.mapped)
return -ENXIO;
if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
return ret;
if (!access_ok(VERIFY_WRITE, buffer, count))
return -EFAULT;
if(!(combbuf = kmalloc(count,GFP_KERNEL)))
return -ENOMEM;
ret = 0;
calc_bob_rate(s);
while (count > 0) {
spin_lock_irqsave(&s->lock, flags);
/* remember, all these things are expressed in bytes to be
sent to the user.. hence the evil / 2 down below */
swptr = s->dma_adc.swptr;
cnt = s->dma_adc.dmasize-swptr;
if (s->dma_adc.count < cnt)
cnt = s->dma_adc.count;
spin_unlock_irqrestore(&s->lock, flags);
if (cnt > count)
cnt = count;
if ( cnt > 0 ) cnt &= ~3;
if (cnt <= 0) {
start_adc(s);
if (file->f_flags & O_NONBLOCK)
{
ret = ret ? ret : -EAGAIN;
goto rec_return_free;
}
if (!interruptible_sleep_on_timeout(&s->dma_adc.wait, HZ)) {
if(! s->card->in_suspend) printk(KERN_DEBUG "maestro: read: chip lockup? dmasz %u fragsz %u count %i hwptr %u swptr %u\n",
s->dma_adc.dmasize, s->dma_adc.fragsize, s->dma_adc.count,
s->dma_adc.hwptr, s->dma_adc.swptr);
stop_adc(s);
spin_lock_irqsave(&s->lock, flags);
set_dmac(s, virt_to_bus(s->dma_adc.rawbuf), s->dma_adc.numfrag << s->dma_adc.fragshift);
/* program enhanced mode registers */
/* FILL ME */
/* wrindir(s, SV_CIDMACBASECOUNT1, (s->dma_adc.fragsamples-1) >> 8);
wrindir(s, SV_CIDMACBASECOUNT0, s->dma_adc.fragsamples-1); */
s->dma_adc.count = s->dma_adc.hwptr = s->dma_adc.swptr = 0;
spin_unlock_irqrestore(&s->lock, flags);
}
if (signal_pending(current))
{
ret = ret ? ret : -ERESTARTSYS;
goto rec_return_free;
}
continue;
}
if(s->fmt & (ESS_FMT_STEREO << ESS_ADC_SHIFT)) {
/* swptr/2 so that we know the real offset in each apu's buffer */
comb_stereo(s->dma_adc.rawbuf,combbuf,swptr/2,cnt,s->dma_adc.dmasize);
if (copy_to_user(buffer, combbuf, cnt)) {
ret = ret ? ret : -EFAULT;
goto rec_return_free;
}
} else {
if (copy_to_user(buffer, s->dma_adc.rawbuf + swptr, cnt)) {
ret = ret ? ret : -EFAULT;
goto rec_return_free;
}
}
swptr = (swptr + cnt) % s->dma_adc.dmasize;
spin_lock_irqsave(&s->lock, flags);
s->dma_adc.swptr = swptr;
s->dma_adc.count -= cnt;
spin_unlock_irqrestore(&s->lock, flags);
count -= cnt;
buffer += cnt;
ret += cnt;
start_adc(s);
}
rec_return_free:
kfree(combbuf);
return ret;
}
static ssize_t
ess_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
{
struct ess_state *s = (struct ess_state *)file->private_data;
ssize_t ret;
unsigned long flags;
unsigned swptr;
int cnt;
VALIDATE_STATE(s);
if (s->dma_dac.mapped)
return -ENXIO;
if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
return ret;
if (!access_ok(VERIFY_READ, buffer, count))
return -EFAULT;
ret = 0;
calc_bob_rate(s);
while (count > 0) {
spin_lock_irqsave(&s->lock, flags);
if (s->dma_dac.count < 0) {
s->dma_dac.count = 0;
s->dma_dac.swptr = s->dma_dac.hwptr;
}
swptr = s->dma_dac.swptr;
cnt = s->dma_dac.dmasize-swptr;
if (s->dma_dac.count + cnt > s->dma_dac.dmasize)
cnt = s->dma_dac.dmasize - s->dma_dac.count;
spin_unlock_irqrestore(&s->lock, flags);
if (cnt > count)
cnt = count;
if (cnt <= 0) {
start_dac(s);
if (file->f_flags & O_NONBLOCK) {
if(!ret) ret = -EAGAIN;
goto return_free;
}
if (!interruptible_sleep_on_timeout(&s->dma_dac.wait, HZ)) {
if(! s->card->in_suspend) printk(KERN_DEBUG "maestro: write: chip lockup? dmasz %u fragsz %u count %i hwptr %u swptr %u\n",
s->dma_dac.dmasize, s->dma_dac.fragsize, s->dma_dac.count,
s->dma_dac.hwptr, s->dma_dac.swptr);
stop_dac(s);
spin_lock_irqsave(&s->lock, flags);
set_dmaa(s, virt_to_bus(s->dma_dac.rawbuf), s->dma_dac.numfrag << s->dma_dac.fragshift);
/* program enhanced mode registers */
/* wrindir(s, SV_CIDMAABASECOUNT1, (s->dma_dac.fragsamples-1) >> 8);
wrindir(s, SV_CIDMAABASECOUNT0, s->dma_dac.fragsamples-1); */
/* FILL ME */
s->dma_dac.count = s->dma_dac.hwptr = s->dma_dac.swptr = 0;
spin_unlock_irqrestore(&s->lock, flags);
}
if (signal_pending(current)) {
if (!ret) ret = -ERESTARTSYS;
goto return_free;
}
continue;
}
if (copy_from_user(s->dma_dac.rawbuf + swptr, buffer, cnt)) {
if (!ret) ret = -EFAULT;
goto return_free;
}
/* printk("wrote %d bytes at sw: %d cnt: %d while hw: %d\n",cnt, swptr, s->dma_dac.count, s->dma_dac.hwptr);*/
swptr = (swptr + cnt) % s->dma_dac.dmasize;
spin_lock_irqsave(&s->lock, flags);
s->dma_dac.swptr = swptr;
s->dma_dac.count += cnt;
s->dma_dac.endcleared = 0;
spin_unlock_irqrestore(&s->lock, flags);
count -= cnt;
buffer += cnt;
ret += cnt;
start_dac(s);
}
return_free:
return ret;
}
/* No kernel lock - we have our own spinlock */
static unsigned int ess_poll(struct file *file, struct poll_table_struct *wait)
{
struct ess_state *s = (struct ess_state *)file->private_data;
unsigned long flags;
unsigned int mask = 0;
VALIDATE_STATE(s);
/* In 0.14 prog_dmabuf always returns success anyway ... */
if (file->f_mode & FMODE_WRITE) {
if (!s->dma_dac.ready && prog_dmabuf(s, 0))
return 0;
}
if (file->f_mode & FMODE_READ) {
if (!s->dma_adc.ready && prog_dmabuf(s, 1))
return 0;
}
if (file->f_mode & FMODE_WRITE)
poll_wait(file, &s->dma_dac.wait, wait);
if (file->f_mode & FMODE_READ)
poll_wait(file, &s->dma_adc.wait, wait);
spin_lock_irqsave(&s->lock, flags);
ess_update_ptr(s);
if (file->f_mode & FMODE_READ) {
if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
mask |= POLLIN | POLLRDNORM;
}
if (file->f_mode & FMODE_WRITE) {
if (s->dma_dac.mapped) {
if (s->dma_dac.count >= (signed)s->dma_dac.fragsize)
mask |= POLLOUT | POLLWRNORM;
} else {
if ((signed)s->dma_dac.dmasize >= s->dma_dac.count + (signed)s->dma_dac.fragsize)
mask |= POLLOUT | POLLWRNORM;
}
}
spin_unlock_irqrestore(&s->lock, flags);
return mask;
}
static int ess_mmap(struct file *file, struct vm_area_struct *vma)
{
struct ess_state *s = (struct ess_state *)file->private_data;
struct dmabuf *db;
int ret = -EINVAL;
unsigned long size;
VALIDATE_STATE(s);
lock_kernel();
if (vma->vm_flags & VM_WRITE) {
if ((ret = prog_dmabuf(s, 1)) != 0)
goto out;
db = &s->dma_dac;
} else
#if 0
/* if we can have the wp/wc do the combining
we can turn this back on. */
if (vma->vm_flags & VM_READ) {
if ((ret = prog_dmabuf(s, 0)) != 0)
goto out;
db = &s->dma_adc;
} else
#endif
goto out;
ret = -EINVAL;
if (vma->vm_pgoff != 0)
goto out;
size = vma->vm_end - vma->vm_start;
if (size > (PAGE_SIZE << db->buforder))
goto out;
ret = -EAGAIN;
if (remap_pfn_range(vma, vma->vm_start,
virt_to_phys(db->rawbuf) >> PAGE_SHIFT,
size, vma->vm_page_prot))
goto out;
db->mapped = 1;
ret = 0;
out:
unlock_kernel();
return ret;
}
static int ess_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
struct ess_state *s = (struct ess_state *)file->private_data;
unsigned long flags;
audio_buf_info abinfo;
count_info cinfo;
int val, mapped, ret;
unsigned char fmtm, fmtd;
void __user *argp = (void __user *)arg;
int __user *p = argp;
/* printk("maestro: ess_ioctl: cmd %d\n", cmd);*/
VALIDATE_STATE(s);
mapped = ((file->f_mode & FMODE_WRITE) && s->dma_dac.mapped) ||
((file->f_mode & FMODE_READ) && s->dma_adc.mapped);
switch (cmd) {
case OSS_GETVERSION:
return put_user(SOUND_VERSION, p);
case SNDCTL_DSP_SYNC:
if (file->f_mode & FMODE_WRITE)
return drain_dac(s, file->f_flags & O_NONBLOCK);
return 0;
case SNDCTL_DSP_SETDUPLEX:
/* XXX fix */
return 0;
case SNDCTL_DSP_GETCAPS:
return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, p);
case SNDCTL_DSP_RESET:
if (file->f_mode & FMODE_WRITE) {
stop_dac(s);
synchronize_irq(s->card->pcidev->irq);
s->dma_dac.swptr = s->dma_dac.hwptr = s->dma_dac.count = s->dma_dac.total_bytes = 0;
}
if (file->f_mode & FMODE_READ) {
stop_adc(s);
synchronize_irq(s->card->pcidev->irq);
s->dma_adc.swptr = s->dma_adc.hwptr = s->dma_adc.count = s->dma_adc.total_bytes = 0;
}
return 0;
case SNDCTL_DSP_SPEED:
if (get_user(val, p))
return -EFAULT;
if (val >= 0) {
if (file->f_mode & FMODE_READ) {
stop_adc(s);
s->dma_adc.ready = 0;
set_adc_rate(s, val);
}
if (file->f_mode & FMODE_WRITE) {
stop_dac(s);
s->dma_dac.ready = 0;
set_dac_rate(s, val);
}
}
return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, p);
case SNDCTL_DSP_STEREO:
if (get_user(val, p))
return -EFAULT;
fmtd = 0;
fmtm = ~0;
if (file->f_mode & FMODE_READ) {
stop_adc(s);
s->dma_adc.ready = 0;
if (val)
fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
else
fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
}
if (file->f_mode & FMODE_WRITE) {
stop_dac(s);
s->dma_dac.ready = 0;
if (val)
fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
else
fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
}
set_fmt(s, fmtm, fmtd);
return 0;
case SNDCTL_DSP_CHANNELS:
if (get_user(val, p))
return -EFAULT;
if (val != 0) {
fmtd = 0;
fmtm = ~0;
if (file->f_mode & FMODE_READ) {
stop_adc(s);
s->dma_adc.ready = 0;
if (val >= 2)
fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
else
fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
}
if (file->f_mode & FMODE_WRITE) {
stop_dac(s);
s->dma_dac.ready = 0;
if (val >= 2)
fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
else
fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
}
set_fmt(s, fmtm, fmtd);
}
return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT)
: (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, p);
case SNDCTL_DSP_GETFMTS: /* Returns a mask */
return put_user(AFMT_U8|AFMT_S16_LE, p);
case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
if (get_user(val, p))
return -EFAULT;
if (val != AFMT_QUERY) {
fmtd = 0;
fmtm = ~0;
if (file->f_mode & FMODE_READ) {
stop_adc(s);
s->dma_adc.ready = 0;
/* fixed at 16bit for now */
fmtd |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
#if 0
if (val == AFMT_S16_LE)
fmtd |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
else
fmtm &= ~(ESS_FMT_16BIT << ESS_ADC_SHIFT);
#endif
}
if (file->f_mode & FMODE_WRITE) {
stop_dac(s);
s->dma_dac.ready = 0;
if (val == AFMT_S16_LE)
fmtd |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
else
fmtm &= ~(ESS_FMT_16BIT << ESS_DAC_SHIFT);
}
set_fmt(s, fmtm, fmtd);
}
return put_user((s->fmt & ((file->f_mode & FMODE_READ) ?
(ESS_FMT_16BIT << ESS_ADC_SHIFT)
: (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ?
AFMT_S16_LE :
AFMT_U8,
p);
case SNDCTL_DSP_POST:
return 0;
case SNDCTL_DSP_GETTRIGGER:
val = 0;
if ((file->f_mode & FMODE_READ) && (s->enable & ADC_RUNNING))
val |= PCM_ENABLE_INPUT;
if ((file->f_mode & FMODE_WRITE) && (s->enable & DAC_RUNNING))
val |= PCM_ENABLE_OUTPUT;
return put_user(val, p);
case SNDCTL_DSP_SETTRIGGER:
if (get_user(val, p))
return -EFAULT;
if (file->f_mode & FMODE_READ) {
if (val & PCM_ENABLE_INPUT) {
if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
return ret;
start_adc(s);
} else
stop_adc(s);
}
if (file->f_mode & FMODE_WRITE) {
if (val & PCM_ENABLE_OUTPUT) {
if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
return ret;
start_dac(s);
} else
stop_dac(s);
}
return 0;
case SNDCTL_DSP_GETOSPACE:
if (!(file->f_mode & FMODE_WRITE))
return -EINVAL;
if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
return ret;
spin_lock_irqsave(&s->lock, flags);
ess_update_ptr(s);
abinfo.fragsize = s->dma_dac.fragsize;
abinfo.bytes = s->dma_dac.dmasize - s->dma_dac.count;
abinfo.fragstotal = s->dma_dac.numfrag;
abinfo.fragments = abinfo.bytes >> s->dma_dac.fragshift;
spin_unlock_irqrestore(&s->lock, flags);
return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
case SNDCTL_DSP_GETISPACE:
if (!(file->f_mode & FMODE_READ))
return -EINVAL;
if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
return ret;
spin_lock_irqsave(&s->lock, flags);
ess_update_ptr(s);
abinfo.fragsize = s->dma_adc.fragsize;
abinfo.bytes = s->dma_adc.count;
abinfo.fragstotal = s->dma_adc.numfrag;
abinfo.fragments = abinfo.bytes >> s->dma_adc.fragshift;
spin_unlock_irqrestore(&s->lock, flags);
return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
case SNDCTL_DSP_NONBLOCK:
file->f_flags |= O_NONBLOCK;
return 0;
case SNDCTL_DSP_GETODELAY:
if (!(file->f_mode & FMODE_WRITE))
return -EINVAL;
if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
return ret;
spin_lock_irqsave(&s->lock, flags);
ess_update_ptr(s);
val = s->dma_dac.count;
spin_unlock_irqrestore(&s->lock, flags);
return put_user(val, p);
case SNDCTL_DSP_GETIPTR:
if (!(file->f_mode & FMODE_READ))
return -EINVAL;
if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
return ret;
spin_lock_irqsave(&s->lock, flags);
ess_update_ptr(s);
cinfo.bytes = s->dma_adc.total_bytes;
cinfo.blocks = s->dma_adc.count >> s->dma_adc.fragshift;
cinfo.ptr = s->dma_adc.hwptr;
if (s->dma_adc.mapped)
s->dma_adc.count &= s->dma_adc.fragsize-1;
spin_unlock_irqrestore(&s->lock, flags);
if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
return -EFAULT;
return 0;
case SNDCTL_DSP_GETOPTR:
if (!(file->f_mode & FMODE_WRITE))
return -EINVAL;
if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
return ret;
spin_lock_irqsave(&s->lock, flags);
ess_update_ptr(s);
cinfo.bytes = s->dma_dac.total_bytes;
cinfo.blocks = s->dma_dac.count >> s->dma_dac.fragshift;
cinfo.ptr = s->dma_dac.hwptr;
if (s->dma_dac.mapped)
s->dma_dac.count &= s->dma_dac.fragsize-1;
spin_unlock_irqrestore(&s->lock, flags);
if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
return -EFAULT;
return 0;
case SNDCTL_DSP_GETBLKSIZE:
if (file->f_mode & FMODE_WRITE) {
if ((val = prog_dmabuf(s, 0)))
return val;
return put_user(s->dma_dac.fragsize, p);
}
if ((val = prog_dmabuf(s, 1)))
return val;
return put_user(s->dma_adc.fragsize, p);
case SNDCTL_DSP_SETFRAGMENT:
if (get_user(val, p))
return -EFAULT;
M_printk("maestro: SETFRAGMENT: %0x\n",val);
if (file->f_mode & FMODE_READ) {
s->dma_adc.ossfragshift = val & 0xffff;
s->dma_adc.ossmaxfrags = (val >> 16) & 0xffff;
if (s->dma_adc.ossfragshift < 4)
s->dma_adc.ossfragshift = 4;
if (s->dma_adc.ossfragshift > 15)
s->dma_adc.ossfragshift = 15;
if (s->dma_adc.ossmaxfrags < 4)
s->dma_adc.ossmaxfrags = 4;
}
if (file->f_mode & FMODE_WRITE) {
s->dma_dac.ossfragshift = val & 0xffff;
s->dma_dac.ossmaxfrags = (val >> 16) & 0xffff;
if (s->dma_dac.ossfragshift < 4)
s->dma_dac.ossfragshift = 4;
if (s->dma_dac.ossfragshift > 15)
s->dma_dac.ossfragshift = 15;
if (s->dma_dac.ossmaxfrags < 4)
s->dma_dac.ossmaxfrags = 4;
}
return 0;
case SNDCTL_DSP_SUBDIVIDE:
if ((file->f_mode & FMODE_READ && s->dma_adc.subdivision) ||
(file->f_mode & FMODE_WRITE && s->dma_dac.subdivision))
return -EINVAL;
if (get_user(val, p))
return -EFAULT;
if (val != 1 && val != 2 && val != 4)
return -EINVAL;
if (file->f_mode & FMODE_READ)
s->dma_adc.subdivision = val;
if (file->f_mode & FMODE_WRITE)
s->dma_dac.subdivision = val;
return 0;
case SOUND_PCM_READ_RATE:
return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, p);
case SOUND_PCM_READ_CHANNELS:
return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT)
: (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, p);
case SOUND_PCM_READ_BITS:
return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_16BIT << ESS_ADC_SHIFT)
: (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ? 16 : 8, p);
case SOUND_PCM_WRITE_FILTER:
case SNDCTL_DSP_SETSYNCRO:
case SOUND_PCM_READ_FILTER:
return -EINVAL;
}
return -EINVAL;
}
static void
set_base_registers(struct ess_state *s,void *vaddr)
{
unsigned long packed_phys = virt_to_bus(vaddr)>>12;
wave_set_register(s, 0x01FC , packed_phys);
wave_set_register(s, 0x01FD , packed_phys);
wave_set_register(s, 0x01FE , packed_phys);
wave_set_register(s, 0x01FF , packed_phys);
}
/*
* this guy makes sure we're in the right power
* state for what we want to be doing
*/
static void maestro_power(struct ess_card *card, int tostate)
{
u16 active_mask = acpi_state_mask[tostate];
u8 state;
if(!use_pm) return;
pci_read_config_byte(card->pcidev, card->power_regs+0x4, &state);
state&=3;
/* make sure we're in the right state */
if(state != tostate) {
M_printk(KERN_WARNING "maestro: dev %02x:%02x.%x switching from D%d to D%d\n",
card->pcidev->bus->number,
PCI_SLOT(card->pcidev->devfn),
PCI_FUNC(card->pcidev->devfn),
state,tostate);
pci_write_config_byte(card->pcidev, card->power_regs+0x4, tostate);
}
/* and make sure the units we care about are on
XXX we might want to do this before state flipping? */
pci_write_config_word(card->pcidev, 0x54, ~ active_mask);
pci_write_config_word(card->pcidev, 0x56, ~ active_mask);
}
/* we allocate a large power of two for all our memory.
this is cut up into (not to scale :):
|silly fifo word | 512byte mixbuf per adc | dac/adc * channels |
*/
static int
allocate_buffers(struct ess_state *s)
{
void *rawbuf=NULL;
int order,i;
struct page *page, *pend;
/* alloc as big a chunk as we can */
for (order = (dsps_order + (16-PAGE_SHIFT) + 1); order >= (dsps_order + 2 + 1); order--)
if((rawbuf = (void *)__get_free_pages(GFP_KERNEL|GFP_DMA, order)))
break;
if (!rawbuf)
return 1;
M_printk("maestro: allocated %ld (%d) bytes at %p\n",PAGE_SIZE<<order,order, rawbuf);
if ((virt_to_bus(rawbuf) + (PAGE_SIZE << order) - 1) & ~((1<<28)-1)) {
printk(KERN_ERR "maestro: DMA buffer beyond 256MB! busaddr 0x%lx size %ld\n",
virt_to_bus(rawbuf), PAGE_SIZE << order);
kfree(rawbuf);
return 1;
}
s->card->dmapages = rawbuf;
s->card->dmaorder = order;
for(i=0;i<NR_DSPS;i++) {
struct ess_state *ess = &s->card->channels[i];
if(ess->dev_audio == -1)
continue;
ess->dma_dac.ready = s->dma_dac.mapped = 0;
ess->dma_adc.ready = s->dma_adc.mapped = 0;
ess->dma_adc.buforder = ess->dma_dac.buforder = order - 1 - dsps_order - 1;
/* offset dac and adc buffers starting half way through and then at each [da][ad]c's
order's intervals.. */
ess->dma_dac.rawbuf = rawbuf + (PAGE_SIZE<<(order-1)) + (i * ( PAGE_SIZE << (ess->dma_dac.buforder + 1 )));
ess->dma_adc.rawbuf = ess->dma_dac.rawbuf + ( PAGE_SIZE << ess->dma_dac.buforder);
/* offset mixbuf by a mixbuf so that the lame status fifo can
happily scribble away.. */
ess->mixbuf = rawbuf + (512 * (i+1));
M_printk("maestro: setup apu %d: dac: %p adc: %p mix: %p\n",i,ess->dma_dac.rawbuf,
ess->dma_adc.rawbuf, ess->mixbuf);
}
/* now mark the pages as reserved; otherwise remap_pfn_range doesn't do what we want */
pend = virt_to_page(rawbuf + (PAGE_SIZE << order) - 1);
for (page = virt_to_page(rawbuf); page <= pend; page++)
SetPageReserved(page);
return 0;
}
static void
free_buffers(struct ess_state *s)
{
struct page *page, *pend;
s->dma_dac.rawbuf = s->dma_adc.rawbuf = NULL;
s->dma_dac.mapped = s->dma_adc.mapped = 0;
s->dma_dac.ready = s->dma_adc.ready = 0;
M_printk("maestro: freeing %p\n",s->card->dmapages);
/* undo marking the pages as reserved */
pend = virt_to_page(s->card->dmapages + (PAGE_SIZE << s->card->dmaorder) - 1);
for (page = virt_to_page(s->card->dmapages); page <= pend; page++)
ClearPageReserved(page);
free_pages((unsigned long)s->card->dmapages,s->card->dmaorder);
s->card->dmapages = NULL;
}
static int
ess_open(struct inode *inode, struct file *file)
{
unsigned int minor = iminor(inode);
struct ess_state *s = NULL;
unsigned char fmtm = ~0, fmts = 0;
struct pci_dev *pdev = NULL;
/*
* Scan the cards and find the channel. We only
* do this at open time so it is ok
*/
while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) {
struct ess_card *c;
struct pci_driver *drvr;
drvr = pci_dev_driver (pdev);
if (drvr == &maestro_pci_driver) {
int i;
struct ess_state *sp;
c = (struct ess_card*)pci_get_drvdata (pdev);
if (!c)
continue;
for(i=0;i<NR_DSPS;i++)
{
sp=&c->channels[i];
if(sp->dev_audio < 0)
continue;
if((sp->dev_audio ^ minor) & ~0xf)
continue;
s=sp;
}
}
}
if (!s)
return -ENODEV;
VALIDATE_STATE(s);
file->private_data = s;
/* wait for device to become free */
down(&s->open_sem);
while (s->open_mode & file->f_mode) {
if (file->f_flags & O_NONBLOCK) {
up(&s->open_sem);
return -EWOULDBLOCK;
}
up(&s->open_sem);
interruptible_sleep_on(&s->open_wait);
if (signal_pending(current))
return -ERESTARTSYS;
down(&s->open_sem);
}
/* under semaphore.. */
if ((s->card->dmapages==NULL) && allocate_buffers(s)) {
up(&s->open_sem);
return -ENOMEM;
}
/* we're covered by the open_sem */
if( ! s->card->dsps_open ) {
maestro_power(s->card,ACPI_D0);
start_bob(s);
}
s->card->dsps_open++;
M_printk("maestro: open, %d bobs now\n",s->card->dsps_open);
/* ok, lets write WC base regs now that we've
powered up the chip */
M_printk("maestro: writing 0x%lx (bus 0x%lx) to the wp\n",virt_to_bus(s->card->dmapages),
((virt_to_bus(s->card->dmapages))&0xFFE00000)>>12);
set_base_registers(s,s->card->dmapages);
if (file->f_mode & FMODE_READ) {
/*
fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_ADC_SHIFT);
if ((minor & 0xf) == SND_DEV_DSP16)
fmts |= ESS_FMT_16BIT << ESS_ADC_SHIFT; */
fmtm &= ~((ESS_FMT_STEREO|ESS_FMT_16BIT) << ESS_ADC_SHIFT);
fmts = (ESS_FMT_STEREO|ESS_FMT_16BIT) << ESS_ADC_SHIFT;
s->dma_adc.ossfragshift = s->dma_adc.ossmaxfrags = s->dma_adc.subdivision = 0;
set_adc_rate(s, 8000);
}
if (file->f_mode & FMODE_WRITE) {
fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_DAC_SHIFT);
if ((minor & 0xf) == SND_DEV_DSP16)
fmts |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
s->dma_dac.ossfragshift = s->dma_dac.ossmaxfrags = s->dma_dac.subdivision = 0;
set_dac_rate(s, 8000);
}
set_fmt(s, fmtm, fmts);
s->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
up(&s->open_sem);
return nonseekable_open(inode, file);
}
static int
ess_release(struct inode *inode, struct file *file)
{
struct ess_state *s = (struct ess_state *)file->private_data;
VALIDATE_STATE(s);
lock_kernel();
if (file->f_mode & FMODE_WRITE)
drain_dac(s, file->f_flags & O_NONBLOCK);
down(&s->open_sem);
if (file->f_mode & FMODE_WRITE) {
stop_dac(s);
}
if (file->f_mode & FMODE_READ) {
stop_adc(s);
}
s->open_mode &= (~file->f_mode) & (FMODE_READ|FMODE_WRITE);
/* we're covered by the open_sem */
M_printk("maestro: %d dsps now alive\n",s->card->dsps_open-1);
if( --s->card->dsps_open <= 0) {
s->card->dsps_open = 0;
stop_bob(s);
free_buffers(s);
maestro_power(s->card,ACPI_D2);
}
up(&s->open_sem);
wake_up(&s->open_wait);
unlock_kernel();
return 0;
}
static struct file_operations ess_audio_fops = {
.owner = THIS_MODULE,
.llseek = no_llseek,
.read = ess_read,
.write = ess_write,
.poll = ess_poll,
.ioctl = ess_ioctl,
.mmap = ess_mmap,
.open = ess_open,
.release = ess_release,
};
static int
maestro_config(struct ess_card *card)
{
struct pci_dev *pcidev = card->pcidev;
struct ess_state *ess = &card->channels[0];
int apu,iobase = card->iobase;
u16 w;
u32 n;
/* We used to muck around with pci config space that
* we had no business messing with. We don't know enough
* about the machine to know which DMA mode is appropriate,
* etc. We were guessing wrong on some machines and making
* them unhappy. We now trust in the BIOS to do things right,
* which almost certainly means a new host of problems will
* arise with broken BIOS implementations. screw 'em.
* We're already intolerant of machines that don't assign
* IRQs.
*/
/* do config work at full power */
maestro_power(card,ACPI_D0);
pci_read_config_word(pcidev, 0x50, &w);
w&=~(1<<5); /* Don't swap left/right (undoc)*/
pci_write_config_word(pcidev, 0x50, w);
pci_read_config_word(pcidev, 0x52, &w);
w&=~(1<<15); /* Turn off internal clock multiplier */
/* XXX how do we know which to use? */
w&=~(1<<14); /* External clock */
w|= (1<<7); /* Hardware volume control on */
w|= (1<<6); /* Debounce off: easier to push the HWV buttons. */
w&=~(1<<5); /* GPIO 4:5 */
w|= (1<<4); /* Disconnect from the CHI. Enabling this made a dell 7500 work. */
w&=~(1<<2); /* MIDI fix off (undoc) */
w&=~(1<<1); /* reserved, always write 0 */
pci_write_config_word(pcidev, 0x52, w);
/*
* Legacy mode
*/
pci_read_config_word(pcidev, 0x40, &w);
w|=(1<<15); /* legacy decode off */
w&=~(1<<14); /* Disable SIRQ */
w&=~(0x1f); /* disable mpu irq/io, game port, fm, SB */
pci_write_config_word(pcidev, 0x40, w);
/* Set up 978 docking control chip. */
pci_read_config_word(pcidev, 0x58, &w);
w|=1<<2; /* Enable 978. */
w|=1<<3; /* Turn on 978 hardware volume control. */
w&=~(1<<11); /* Turn on 978 mixer volume control. */
pci_write_config_word(pcidev, 0x58, w);
sound_reset(iobase);
/*
* Ring Bus Setup
*/
/* setup usual 0x34 stuff.. 0x36 may be chip specific */
outw(0xC090, iobase+0x34); /* direct sound, stereo */
udelay(20);
outw(0x3000, iobase+0x36); /* direct sound, stereo */
udelay(20);
/*
* Reset the CODEC
*/
maestro_ac97_reset(iobase,pcidev);
/*
* Ring Bus Setup
*/
n=inl(iobase+0x34);
n&=~0xF000;
n|=12<<12; /* Direct Sound, Stereo */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n&=~0x0F00; /* Modem off */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n&=~0x00F0;
n|=9<<4; /* DAC, Stereo */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n&=~0x000F; /* ASSP off */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n|=(1<<29); /* Enable ring bus */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n|=(1<<28); /* Enable serial bus */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n&=~0x00F00000; /* MIC off */
outl(n, iobase+0x34);
n=inl(iobase+0x34);
n&=~0x000F0000; /* I2S off */
outl(n, iobase+0x34);
w=inw(iobase+0x18);
w&=~(1<<7); /* ClkRun off */
outw(w, iobase+0x18);
w=inw(iobase+0x18);
w&=~(1<<6); /* Hardware volume control interrupt off... for now. */
outw(w, iobase+0x18);
w=inw(iobase+0x18);
w&=~(1<<4); /* ASSP irq off */
outw(w, iobase+0x18);
w=inw(iobase+0x18);
w&=~(1<<3); /* ISDN irq off */
outw(w, iobase+0x18);
w=inw(iobase+0x18);
w|=(1<<2); /* Direct Sound IRQ on */
outw(w, iobase+0x18);
w=inw(iobase+0x18);
w&=~(1<<1); /* MPU401 IRQ off */
outw(w, iobase+0x18);
w=inw(iobase+0x18);
w|=(1<<0); /* SB IRQ on */
outw(w, iobase+0x18);
/* Set hardware volume control registers to midpoints.
We can tell which button was pushed based on how they change. */
outb(0x88, iobase+0x1c);
outb(0x88, iobase+0x1d);
outb(0x88, iobase+0x1e);
outb(0x88, iobase+0x1f);
/* it appears some maestros (dell 7500) only work if these are set,
regardless of whether we use the assp or not. */
outb(0, iobase+0xA4);
outb(3, iobase+0xA2);
outb(0, iobase+0xA6);
for(apu=0;apu<16;apu++)
{
/* Write 0 into the buffer area 0x1E0->1EF */
outw(0x01E0+apu, 0x10+iobase);
outw(0x0000, 0x12+iobase);
/*
* The 1.10 test program seem to write 0 into the buffer area
* 0x1D0-0x1DF too.
*/
outw(0x01D0+apu, 0x10+iobase);
outw(0x0000, 0x12+iobase);
}
#if 1
wave_set_register(ess, IDR7_WAVE_ROMRAM,
(wave_get_register(ess, IDR7_WAVE_ROMRAM)&0xFF00));
wave_set_register(ess, IDR7_WAVE_ROMRAM,
wave_get_register(ess, IDR7_WAVE_ROMRAM)|0x100);
wave_set_register(ess, IDR7_WAVE_ROMRAM,
wave_get_register(ess, IDR7_WAVE_ROMRAM)&~0x200);
wave_set_register(ess, IDR7_WAVE_ROMRAM,
wave_get_register(ess, IDR7_WAVE_ROMRAM)|~0x400);
#else
maestro_write(ess, IDR7_WAVE_ROMRAM,
(maestro_read(ess, IDR7_WAVE_ROMRAM)&0xFF00));
maestro_write(ess, IDR7_WAVE_ROMRAM,
maestro_read(ess, IDR7_WAVE_ROMRAM)|0x100);
maestro_write(ess, IDR7_WAVE_ROMRAM,
maestro_read(ess, IDR7_WAVE_ROMRAM)&~0x200);
maestro_write(ess, IDR7_WAVE_ROMRAM,
maestro_read(ess, IDR7_WAVE_ROMRAM)|0x400);
#endif
maestro_write(ess, IDR2_CRAM_DATA, 0x0000);
maestro_write(ess, 0x08, 0xB004);
/* Now back to the DirectSound stuff */
maestro_write(ess, 0x09, 0x001B);
maestro_write(ess, 0x0A, 0x8000);
maestro_write(ess, 0x0B, 0x3F37);
maestro_write(ess, 0x0C, 0x0098);
/* parallel out ?? */
maestro_write(ess, 0x0C,
(maestro_read(ess, 0x0C)&~0xF000)|0x8000);
/* parallel in, has something to do with recording :) */
maestro_write(ess, 0x0C,
(maestro_read(ess, 0x0C)&~0x0F00)|0x0500);
maestro_write(ess, 0x0D, 0x7632);
/* Wave cache control on - test off, sg off,
enable, enable extra chans 1Mb */
outw(inw(0x14+iobase)|(1<<8),0x14+iobase);
outw(inw(0x14+iobase)&0xFE03,0x14+iobase);
outw((inw(0x14+iobase)&0xFFFC), 0x14+iobase);
outw(inw(0x14+iobase)|(1<<7),0x14+iobase);
outw(0xA1A0, 0x14+iobase); /* 0300 ? */
/* Now clear the APU control ram */
for(apu=0;apu<NR_APUS;apu++)
{
for(w=0;w<NR_APU_REGS;w++)
apu_set_register(ess, apu|ESS_CHAN_HARD, w, 0);
}
return 0;
}
/* this guy tries to find the pci power management
* register bank. this should really be in core
* code somewhere. 1 on success. */
static int
parse_power(struct ess_card *card, struct pci_dev *pcidev)
{
u32 n;
u16 w;
u8 next;
int max = 64; /* an a 8bit guy pointing to 32bit guys
can only express so much. */
card->power_regs = 0;
/* check to see if we have a capabilities list in
the config register */
pci_read_config_word(pcidev, PCI_STATUS, &w);
if(!(w & PCI_STATUS_CAP_LIST)) return 0;
/* walk the list, starting at the head. */
pci_read_config_byte(pcidev,PCI_CAPABILITY_LIST,&next);
while(next && max--) {
pci_read_config_dword(pcidev, next & ~3, &n);
if((n & 0xff) == PCI_CAP_ID_PM) {
card->power_regs = next;
break;
}
next = ((n>>8) & 0xff);
}
return card->power_regs ? 1 : 0;
}
static int __init
maestro_probe(struct pci_dev *pcidev,const struct pci_device_id *pdid)
{
int card_type = pdid->driver_data;
u32 n;
int iobase;
int i, ret;
struct ess_card *card;
struct ess_state *ess;
struct pm_dev *pmdev;
int num = 0;
/* when built into the kernel, we only print version if device is found */
#ifndef MODULE
static int printed_version;
if (!printed_version++)
printk(version);
#endif
/* don't pick up weird modem maestros */
if(((pcidev->class >> 8) & 0xffff) != PCI_CLASS_MULTIMEDIA_AUDIO)
return -ENODEV;
if ((ret=pci_enable_device(pcidev)))
return ret;
iobase = pci_resource_start(pcidev,0);
if (!iobase || !(pci_resource_flags(pcidev, 0 ) & IORESOURCE_IO))
return -ENODEV;
if(pcidev->irq == 0)
return -ENODEV;
/* stake our claim on the iospace */
if( request_region(iobase, 256, card_names[card_type]) == NULL )
{
printk(KERN_WARNING "maestro: can't allocate 256 bytes I/O at 0x%4.4x\n", iobase);
return -EBUSY;
}
/* just to be sure */
pci_set_master(pcidev);
card = kmalloc(sizeof(struct ess_card), GFP_KERNEL);
if(card == NULL)
{
printk(KERN_WARNING "maestro: out of memory\n");
release_region(iobase, 256);
return -ENOMEM;
}
memset(card, 0, sizeof(*card));
card->pcidev = pcidev;
pmdev = pm_register(PM_PCI_DEV, PM_PCI_ID(pcidev),
maestro_pm_callback);
if (pmdev)
pmdev->data = card;
card->iobase = iobase;
card->card_type = card_type;
card->irq = pcidev->irq;
card->magic = ESS_CARD_MAGIC;
spin_lock_init(&card->lock);
init_waitqueue_head(&card->suspend_queue);
card->dock_mute_vol = 50;
/* init our groups of 6 apus */
for(i=0;i<NR_DSPS;i++)
{
struct ess_state *s=&card->channels[i];
s->index = i;
s->card = card;
init_waitqueue_head(&s->dma_adc.wait);
init_waitqueue_head(&s->dma_dac.wait);
init_waitqueue_head(&s->open_wait);
spin_lock_init(&s->lock);
init_MUTEX(&s->open_sem);
s->magic = ESS_STATE_MAGIC;
s->apu[0] = 6*i;
s->apu[1] = (6*i)+1;
s->apu[2] = (6*i)+2;
s->apu[3] = (6*i)+3;
s->apu[4] = (6*i)+4;
s->apu[5] = (6*i)+5;
if(s->dma_adc.ready || s->dma_dac.ready || s->dma_adc.rawbuf)
printk("maestro: BOTCH!\n");
/* register devices */
if ((s->dev_audio = register_sound_dsp(&ess_audio_fops, -1)) < 0)
break;
}
num = i;
/* clear the rest if we ran out of slots to register */
for(;i<NR_DSPS;i++)
{
struct ess_state *s=&card->channels[i];
s->dev_audio = -1;
}
ess = &card->channels[0];
/*
* Ok card ready. Begin setup proper
*/
printk(KERN_INFO "maestro: Configuring %s found at IO 0x%04X IRQ %d\n",
card_names[card_type],iobase,card->irq);
pci_read_config_dword(pcidev, PCI_SUBSYSTEM_VENDOR_ID, &n);
printk(KERN_INFO "maestro: subvendor id: 0x%08x\n",n);
/* turn off power management unless:
* - the user explicitly asks for it
* or
* - we're not a 2e, lesser chipps seem to have problems.
* - we're not on our _very_ small whitelist. some implemenetations
* really don't like the pm code, others require it.
* feel free to expand this as required.
*/
#define SUBSYSTEM_VENDOR(x) (x&0xffff)
if( (use_pm != 1) &&
((card_type != TYPE_MAESTRO2E) || (SUBSYSTEM_VENDOR(n) != 0x1028)))
use_pm = 0;
if(!use_pm)
printk(KERN_INFO "maestro: not attempting power management.\n");
else {
if(!parse_power(card,pcidev))
printk(KERN_INFO "maestro: no PCI power management interface found.\n");
else {
pci_read_config_dword(pcidev, card->power_regs, &n);
printk(KERN_INFO "maestro: PCI power management capability: 0x%x\n",n>>16);
}
}
maestro_config(card);
if(maestro_ac97_get(card, 0x00)==0x0080) {
printk(KERN_ERR "maestro: my goodness! you seem to have a pt101 codec, which is quite rare.\n"
"\tyou should tell someone about this.\n");
} else {
maestro_ac97_init(card);
}
if ((card->dev_mixer = register_sound_mixer(&ess_mixer_fops, -1)) < 0) {
printk("maestro: couldn't register mixer!\n");
} else {
memcpy(card->mix.mixer_state,mixer_defaults,sizeof(card->mix.mixer_state));
mixer_push_state(card);
}
if((ret=request_irq(card->irq, ess_interrupt, SA_SHIRQ, card_names[card_type], card)))
{
printk(KERN_ERR "maestro: unable to allocate irq %d,\n", card->irq);
unregister_sound_mixer(card->dev_mixer);
for(i=0;i<NR_DSPS;i++)
{
struct ess_state *s = &card->channels[i];
if(s->dev_audio != -1)
unregister_sound_dsp(s->dev_audio);
}
release_region(card->iobase, 256);
unregister_reboot_notifier(&maestro_nb);
kfree(card);
return ret;
}
/* Turn on hardware volume control interrupt.
This has to come after we grab the IRQ above,
or a crash will result on installation if a button has been pressed,
because in that case we'll get an immediate interrupt. */
n = inw(iobase+0x18);
n|=(1<<6);
outw(n, iobase+0x18);
pci_set_drvdata(pcidev,card);
/* now go to sleep 'till something interesting happens */
maestro_power(card,ACPI_D2);
printk(KERN_INFO "maestro: %d channels configured.\n", num);
return 0;
}
static void maestro_remove(struct pci_dev *pcidev) {
struct ess_card *card = pci_get_drvdata(pcidev);
int i;
u32 n;
/* XXX maybe should force stop bob, but should be all
stopped by _release by now */
/* Turn off hardware volume control interrupt.
This has to come before we leave the IRQ below,
or a crash results if a button is pressed ! */
n = inw(card->iobase+0x18);
n&=~(1<<6);
outw(n, card->iobase+0x18);
free_irq(card->irq, card);
unregister_sound_mixer(card->dev_mixer);
for(i=0;i<NR_DSPS;i++)
{
struct ess_state *ess = &card->channels[i];
if(ess->dev_audio != -1)
unregister_sound_dsp(ess->dev_audio);
}
/* Goodbye, Mr. Bond. */
maestro_power(card,ACPI_D3);
release_region(card->iobase, 256);
kfree(card);
pci_set_drvdata(pcidev,NULL);
}
static struct pci_device_id maestro_pci_tbl[] = {
{PCI_VENDOR_ESS, PCI_DEVICE_ID_ESS_ESS1968, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_MAESTRO2},
{PCI_VENDOR_ESS, PCI_DEVICE_ID_ESS_ESS1978, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_MAESTRO2E},
{PCI_VENDOR_ESS_OLD, PCI_DEVICE_ID_ESS_ESS0100, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_MAESTRO},
{0,}
};
MODULE_DEVICE_TABLE(pci, maestro_pci_tbl);
static struct pci_driver maestro_pci_driver = {
.name = "maestro",
.id_table = maestro_pci_tbl,
.probe = maestro_probe,
.remove = maestro_remove,
};
static int __init init_maestro(void)
{
int rc;
rc = pci_module_init(&maestro_pci_driver);
if (rc < 0)
return rc;
if (register_reboot_notifier(&maestro_nb))
printk(KERN_WARNING "maestro: reboot notifier registration failed; may not reboot properly.\n");
#ifdef MODULE
printk(version);
#endif
if (dsps_order < 0) {
dsps_order = 1;
printk(KERN_WARNING "maestro: clipping dsps_order to %d\n",dsps_order);
}
else if (dsps_order > MAX_DSP_ORDER) {
dsps_order = MAX_DSP_ORDER;
printk(KERN_WARNING "maestro: clipping dsps_order to %d\n",dsps_order);
}
return 0;
}
static int maestro_notifier(struct notifier_block *nb, unsigned long event, void *buf)
{
/* this notifier is called when the kernel is really shut down. */
M_printk("maestro: shutting down\n");
/* this will remove all card instances too */
pci_unregister_driver(&maestro_pci_driver);
/* XXX dunno about power management */
return NOTIFY_OK;
}
/* --------------------------------------------------------------------- */
static void cleanup_maestro(void) {
M_printk("maestro: unloading\n");
pci_unregister_driver(&maestro_pci_driver);
pm_unregister_all(maestro_pm_callback);
unregister_reboot_notifier(&maestro_nb);
}
/* --------------------------------------------------------------------- */
void
check_suspend(struct ess_card *card)
{
DECLARE_WAITQUEUE(wait, current);
if(!card->in_suspend) return;
card->in_suspend++;
add_wait_queue(&(card->suspend_queue), &wait);
current->state = TASK_UNINTERRUPTIBLE;
schedule();
remove_wait_queue(&(card->suspend_queue), &wait);
current->state = TASK_RUNNING;
}
static int
maestro_suspend(struct ess_card *card)
{
unsigned long flags;
int i,j;
spin_lock_irqsave(&card->lock,flags); /* over-kill */
M_printk("maestro: apm in dev %p\n",card);
/* we have to read from the apu regs, need
to power it up */
maestro_power(card,ACPI_D0);
for(i=0;i<NR_DSPS;i++) {
struct ess_state *s = &card->channels[i];
if(s->dev_audio == -1)
continue;
M_printk("maestro: stopping apus for device %d\n",i);
stop_dac(s);
stop_adc(s);
for(j=0;j<6;j++)
card->apu_map[s->apu[j]][5]=apu_get_register(s,j,5);
}
/* get rid of interrupts? */
if( card->dsps_open > 0)
stop_bob(&card->channels[0]);
card->in_suspend++;
spin_unlock_irqrestore(&card->lock,flags);
/* we trust in the bios to power down the chip on suspend.
* XXX I'm also not sure that in_suspend will protect
* against all reg accesses from here on out.
*/
return 0;
}
static int
maestro_resume(struct ess_card *card)
{
unsigned long flags;
int i;
spin_lock_irqsave(&card->lock,flags); /* over-kill */
card->in_suspend = 0;
M_printk("maestro: resuming card at %p\n",card);
/* restore all our config */
maestro_config(card);
/* need to restore the base pointers.. */
if(card->dmapages)
set_base_registers(&card->channels[0],card->dmapages);
mixer_push_state(card);
/* set each channels' apu control registers before
* restoring audio
*/
for(i=0;i<NR_DSPS;i++) {
struct ess_state *s = &card->channels[i];
int chan,reg;
if(s->dev_audio == -1)
continue;
for(chan = 0 ; chan < 6 ; chan++) {
wave_set_register(s,s->apu[chan]<<3,s->apu_base[chan]);
for(reg = 1 ; reg < NR_APU_REGS ; reg++)
apu_set_register(s,chan,reg,s->card->apu_map[s->apu[chan]][reg]);
}
for(chan = 0 ; chan < 6 ; chan++)
apu_set_register(s,chan,0,s->card->apu_map[s->apu[chan]][0] & 0xFF0F);
}
/* now we flip on the music */
if( card->dsps_open <= 0) {
/* this card's idle */
maestro_power(card,ACPI_D2);
} else {
/* ok, we're actually playing things on
this card */
maestro_power(card,ACPI_D0);
start_bob(&card->channels[0]);
for(i=0;i<NR_DSPS;i++) {
struct ess_state *s = &card->channels[i];
/* these use the apu_mode, and can handle
spurious calls */
start_dac(s);
start_adc(s);
}
}
spin_unlock_irqrestore(&card->lock,flags);
/* all right, we think things are ready,
wake up people who were using the device
when we suspended */
wake_up(&(card->suspend_queue));
return 0;
}
int
maestro_pm_callback(struct pm_dev *dev, pm_request_t rqst, void *data)
{
struct ess_card *card = (struct ess_card*) dev->data;
if ( ! card ) goto out;
M_printk("maestro: pm event 0x%x received for card %p\n", rqst, card);
switch (rqst) {
case PM_SUSPEND:
maestro_suspend(card);
break;
case PM_RESUME:
maestro_resume(card);
break;
/*
* we'd also like to find out about
* power level changes because some biosen
* do mean things to the maestro when they
* change their power state.
*/
}
out:
return 0;
}
module_init(init_maestro);
module_exit(cleanup_maestro);
View Git Blame Copy Permalink