microsoft
/
WSL2-Linux-Kernel
зеркало из https://github.com/microsoft/WSL2-Linux-Kernel.git
1
0
Форкнуть 0
Код Задачи Пакеты Проекты Релизы Вики Активность
WSL2-Linux-Kernel/sound/oss/trident.c

4642 строки
123 KiB
C
Исходник Ответственный История

/*
* OSS driver for Linux 2.[46].x for
*
* Trident 4D-Wave
* SiS 7018
* ALi 5451
* Tvia/IGST CyberPro 5050
*
* Driver: Alan Cox <alan@redhat.com>
*
* Built from:
* Low level code: <audio@tridentmicro.com> from ALSA
* Framework: Thomas Sailer <sailer@ife.ee.ethz.ch>
* Extended by: Zach Brown <zab@redhat.com>
*
* Hacked up by:
* Aaron Holtzman <aholtzma@ess.engr.uvic.ca>
* Ollie Lho <ollie@sis.com.tw> SiS 7018 Audio Core Support
* Ching-Ling Lee <cling-li@ali.com.tw> ALi 5451 Audio Core Support
* Matt Wu <mattwu@acersoftech.com.cn> ALi 5451 Audio Core Support
* Peter Wächtler <pwaechtler@loewe-komp.de> CyberPro5050 support
* Muli Ben-Yehuda <mulix@mulix.org>
*
*
* 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.
*
* History
* v0.14.10j
* January 3 2004 Eugene Teo <eugeneteo@eugeneteo.net>
* minor cleanup to use pr_debug instead of TRDBG since it is already
* defined in linux/kernel.h.
* v0.14.10i
* December 29 2003 Muli Ben-Yehuda <mulix@mulix.org>
* major cleanup for 2.6, fix a few error patch buglets
* with returning without properly cleaning up first,
* get rid of lock_kernel().
* v0.14.10h
* Sept 10 2002 Pascal Schmidt <der.eremit@email.de>
* added support for ALi 5451 joystick port
* v0.14.10g
* Sept 05 2002 Alan Cox <alan@redhat.com>
* adapt to new pci joystick attachment interface
* v0.14.10f
* July 24 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
* patch from Eric Lemar (via Ian Soboroff): in suspend and resume,
* fix wrong cast from pci_dev* to struct trident_card*.
* v0.14.10e
* July 19 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
* rewrite the DMA buffer allocation/deallcoation functions, to make it
* modular and fix a bug where we would call free_pages on memory
* obtained with pci_alloc_consistent. Also remove unnecessary #ifdef
* CONFIG_PROC_FS and various other cleanups.
* v0.14.10d
* July 19 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
* made several printk(KERN_NOTICE...) into TRDBG(...), to avoid spamming
* my syslog with hundreds of messages.
* v0.14.10c
* July 16 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
* Cleaned up Lei Hu's 0.4.10 driver to conform to Documentation/CodingStyle
* and the coding style used in the rest of the file.
* v0.14.10b
* June 23 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
* add a missing unlock_set_fmt, remove a superflous lock/unlock pair
* with nothing in between.
* v0.14.10a
* June 21 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
* use a debug macro instead of #ifdef CONFIG_DEBUG, trim to 80 columns
* per line, use 'do {} while (0)' in statement macros.
* v0.14.10
* June 6 2002 Lei Hu <Lei_hu@ali.com.tw>
* rewrite the part to read/write registers of audio codec for Ali5451
* v0.14.9e
* January 2 2002 Vojtech Pavlik <vojtech@ucw.cz> added gameport
* support to avoid resource conflict with pcigame.c
* v0.14.9d
* October 8 2001 Arnaldo Carvalho de Melo <acme@conectiva.com.br>
* use set_current_state, properly release resources on failure in
* trident_probe, get rid of check_region
* v0.14.9c
* August 10 2001 Peter Wächtler <pwaechtler@loewe-komp.de>
* added support for Tvia (formerly Integraphics/IGST) CyberPro5050
* this chip is often found in settop boxes (combined video+audio)
* v0.14.9b
* Switch to static inline not extern inline (gcc 3)
* v0.14.9a
* Aug 6 2001 Alan Cox
* 0.14.9 crashed on rmmod due to a timer/bh left running. Simplified
* the existing logic (the BH doesn't help as ac97 is lock_irqsave)
* and used del_timer_sync to clean up
* Fixed a problem where the ALi change broke my generic card
* v0.14.9
* Jul 10 2001 Matt Wu
* Add H/W Volume Control
* v0.14.8a
* July 7 2001 Alan Cox
* Moved Matt Wu's ac97 register cache into the card structure
* v0.14.8
* Apr 30 2001 Matt Wu
* Set EBUF1 and EBUF2 to still mode
* Add dc97/ac97 reset function
* Fix power management: ali_restore_regs
* unreleased
* Mar 09 2001 Matt Wu
* Add cache for ac97 access
* v0.14.7
* Feb 06 2001 Matt Wu
* Fix ac97 initialization
* Fix bug: an extra tail will be played when playing
* Jan 05 2001 Matt Wu
* Implement multi-channels and S/PDIF in support for ALi 1535+
* v0.14.6
* Nov 1 2000 Ching-Ling Lee
* Fix the bug of memory leak when switching 5.1-channels to 2 channels.
* Add lock protection into dynamic changing format of data.
* Oct 18 2000 Ching-Ling Lee
* 5.1-channels support for ALi
* June 28 2000 Ching-Ling Lee
* S/PDIF out/in(playback/record) support for ALi 1535+, using /proc to be selected by user
* Simple Power Management support for ALi
* v0.14.5 May 23 2000 Ollie Lho
* Misc bug fix from the Net
* v0.14.4 May 20 2000 Aaron Holtzman
* Fix kfree'd memory access in release
* Fix race in open while looking for a free virtual channel slot
* remove open_wait wq (which appears to be unused)
* v0.14.3 May 10 2000 Ollie Lho
* fixed a small bug in trident_update_ptr, xmms 1.0.1 no longer uses 100% CPU
* v0.14.2 Mar 29 2000 Ching-Ling Lee
* Add clear to silence advance in trident_update_ptr
* fix invalid data of the end of the sound
* v0.14.1 Mar 24 2000 Ching-Ling Lee
* ALi 5451 support added, playback and recording O.K.
* ALi 5451 originally developed and structured based on sonicvibes, and
* suggested to merge into this file by Alan Cox.
* v0.14 Mar 15 2000 Ollie Lho
* 5.1 channel output support with channel binding. What's the Matrix ?
* v0.13.1 Mar 10 2000 Ollie Lho
* few minor bugs on dual codec support, needs more testing
* v0.13 Mar 03 2000 Ollie Lho
* new pci_* for 2.4 kernel, back ported to 2.2
* v0.12 Feb 23 2000 Ollie Lho
* Preliminary Recording support
* v0.11.2 Feb 19 2000 Ollie Lho
* removed incomplete full-dulplex support
* v0.11.1 Jan 28 2000 Ollie Lho
* small bug in setting sample rate for 4d-nx (reported by Aaron)
* v0.11 Jan 27 2000 Ollie Lho
* DMA bug, scheduler latency, second try
* v0.10 Jan 24 2000 Ollie Lho
* DMA bug fixed, found kernel scheduling problem
* v0.09 Jan 20 2000 Ollie Lho
* Clean up of channel register access routine (prepare for channel binding)
* v0.08 Jan 14 2000 Ollie Lho
* Isolation of AC97 codec code
* v0.07 Jan 13 2000 Ollie Lho
* Get rid of ugly old low level access routines (e.g. CHRegs.lp****)
* v0.06 Jan 11 2000 Ollie Lho
* Preliminary support for dual (more ?) AC97 codecs
* v0.05 Jan 08 2000 Luca Montecchiani <m.luca@iname.com>
* adapt to 2.3.x new __setup/__init call
* v0.04 Dec 31 1999 Ollie Lho
* Multiple Open, using Middle Loop Interrupt to smooth playback
* v0.03 Dec 24 1999 Ollie Lho
* mem leak in prog_dmabuf and dealloc_dmabuf removed
* v0.02 Dec 15 1999 Ollie Lho
* SiS 7018 support added, playback O.K.
* v0.01 Alan Cox et. al.
* Initial Release in kernel 2.3.30, does not work
*
* ToDo
* Clean up of low level channel register access code. (done)
* Fix the bug on dma buffer management in update_ptr, read/write, drain_dac (done)
* Dual AC97 codecs support (done)
* Recording support (done)
* Mmap support
* "Channel Binding" ioctl extension (done)
* new pci device driver interface for 2.4 kernel (done)
*
* Lock order (high->low)
* lock - hardware lock
* open_mutex - guard opens
* sem - guard dmabuf, write re-entry etc
*/
#include <linux/config.h>
#include <linux/module.h>
#include <linux/string.h>
#include <linux/ctype.h>
#include <linux/ioport.h>
#include <linux/sched.h>
#include <linux/delay.h>
#include <linux/sound.h>
#include <linux/slab.h>
#include <linux/soundcard.h>
#include <linux/pci.h>
#include <linux/init.h>
#include <linux/poll.h>
#include <linux/spinlock.h>
#include <linux/smp_lock.h>
#include <linux/ac97_codec.h>
#include <linux/bitops.h>
#include <linux/proc_fs.h>
#include <linux/interrupt.h>
#include <linux/pm.h>
#include <linux/gameport.h>
#include <linux/kernel.h>
#include <linux/mutex.h>
#include <asm/uaccess.h>
#include <asm/io.h>
#include <asm/dma.h>
#if defined(CONFIG_ALPHA_NAUTILUS) || defined(CONFIG_ALPHA_GENERIC)
#include <asm/hwrpb.h>
#endif
#include "trident.h"
#define DRIVER_VERSION "0.14.10j-2.6"
#if defined(CONFIG_GAMEPORT) || (defined(MODULE) && defined(CONFIG_GAMEPORT_MODULE))
#define SUPPORT_JOYSTICK 1
#endif
/* magic numbers to protect our data structures */
#define TRIDENT_CARD_MAGIC 0x5072696E /* "Prin" */
#define TRIDENT_STATE_MAGIC 0x63657373 /* "cess" */
#define TRIDENT_DMA_MASK 0x3fffffff /* DMA buffer mask for pci_alloc_consist */
#define ALI_DMA_MASK 0x7fffffff /* ALI Tridents have 31-bit DMA. Wow. */
#define NR_HW_CH 32
/* maximum number of AC97 codecs connected, AC97 2.0 defined 4, but 7018 and 4D-NX only
have 2 SDATA_IN lines (currently) */
#define NR_AC97 2
/* minor number of /dev/swmodem (temporary, experimental) */
#define SND_DEV_SWMODEM 7
static const unsigned ali_multi_channels_5_1[] = {
/*ALI_SURR_LEFT_CHANNEL, ALI_SURR_RIGHT_CHANNEL, */
ALI_CENTER_CHANNEL,
ALI_LEF_CHANNEL,
ALI_SURR_LEFT_CHANNEL,
ALI_SURR_RIGHT_CHANNEL
};
static const unsigned sample_size[] = { 1, 2, 2, 4 };
static const unsigned sample_shift[] = { 0, 1, 1, 2 };
static const char invalid_magic[] = KERN_CRIT "trident: invalid magic value in %s\n";
enum {
TRIDENT_4D_DX = 0,
TRIDENT_4D_NX,
SIS_7018,
ALI_5451,
CYBER5050
};
static char *card_names[] = {
"Trident 4DWave DX",
"Trident 4DWave NX",
"SiS 7018 PCI Audio",
"ALi Audio Accelerator",
"Tvia/IGST CyberPro 5050"
};
static struct pci_device_id trident_pci_tbl[] = {
{PCI_DEVICE(PCI_VENDOR_ID_TRIDENT, PCI_DEVICE_ID_TRIDENT_4DWAVE_DX),
PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TRIDENT_4D_DX},
{PCI_DEVICE(PCI_VENDOR_ID_TRIDENT, PCI_DEVICE_ID_TRIDENT_4DWAVE_NX),
0, 0, TRIDENT_4D_NX},
{PCI_DEVICE(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_7018), 0, 0, SIS_7018},
{PCI_DEVICE(PCI_VENDOR_ID_ALI, PCI_DEVICE_ID_ALI_5451), 0, 0, ALI_5451},
{PCI_DEVICE(PCI_VENDOR_ID_INTERG, PCI_DEVICE_ID_INTERG_5050),
0, 0, CYBER5050},
{0,}
};
MODULE_DEVICE_TABLE(pci, trident_pci_tbl);
/* "software" or virtual channel, an instance of opened /dev/dsp */
struct trident_state {
unsigned int magic;
struct trident_card *card; /* Card info */
/* file mode */
mode_t open_mode;
/* virtual channel number */
int virt;
struct dmabuf {
/* wave sample stuff */
unsigned int rate;
unsigned char fmt, enable;
/* hardware channel */
struct trident_channel *channel;
/* OSS buffer management stuff */
void *rawbuf;
dma_addr_t dma_handle;
unsigned buforder;
unsigned numfrag;
unsigned fragshift;
/* our buffer acts like a circular ring */
unsigned hwptr; /* where dma last started, updated by update_ptr */
unsigned swptr; /* where driver last clear/filled, updated by read/write */
int count; /* bytes to be comsumed or been generated by dma machine */
unsigned total_bytes; /* total bytes dmaed by hardware */
unsigned error; /* number of over/underruns */
/* put process on wait queue when no more space in buffer */
wait_queue_head_t wait;
/* redundant, but makes calculations easier */
unsigned fragsize;
unsigned dmasize;
unsigned fragsamples;
/* OSS stuff */
unsigned mapped:1;
unsigned ready:1;
unsigned endcleared:1;
unsigned update_flag;
unsigned ossfragshift;
int ossmaxfrags;
unsigned subdivision;
} dmabuf;
/* 5.1 channels */
struct trident_state *other_states[4];
int multi_channels_adjust_count;
unsigned chans_num;
unsigned long fmt_flag;
/* Guard against mmap/write/read races */
struct mutex sem;
};
/* hardware channels */
struct trident_channel {
int num; /* channel number */
u32 lba; /* Loop Begine Address, where dma buffer starts */
u32 eso; /* End Sample Offset, wehre dma buffer ends */
/* (in the unit of samples) */
u32 delta; /* delta value, sample rate / 48k for playback, */
/* 48k/sample rate for recording */
u16 attribute; /* control where PCM data go and come */
u16 fm_vol;
u32 control; /* signed/unsigned, 8/16 bits, mono/stereo */
};
struct trident_pcm_bank_address {
u32 start;
u32 stop;
u32 aint;
u32 aint_en;
};
static struct trident_pcm_bank_address bank_a_addrs = {
T4D_START_A,
T4D_STOP_A,
T4D_AINT_A,
T4D_AINTEN_A
};
static struct trident_pcm_bank_address bank_b_addrs = {
T4D_START_B,
T4D_STOP_B,
T4D_AINT_B,
T4D_AINTEN_B
};
struct trident_pcm_bank {
/* register addresses to control bank operations */
struct trident_pcm_bank_address *addresses;
/* each bank has 32 channels */
u32 bitmap; /* channel allocation bitmap */
struct trident_channel channels[32];
};
struct trident_card {
unsigned int magic;
/* We keep trident cards in a linked list */
struct trident_card *next;
/* single open lock mechanism, only used for recording */
struct mutex open_mutex;
/* The trident has a certain amount of cross channel interaction
so we use a single per card lock */
spinlock_t lock;
/* PCI device stuff */
struct pci_dev *pci_dev;
u16 pci_id;
u8 revision;
/* soundcore stuff */
int dev_audio;
/* structures for abstraction of hardware facilities, codecs, */
/* banks and channels */
struct ac97_codec *ac97_codec[NR_AC97];
struct trident_pcm_bank banks[NR_BANKS];
struct trident_state *states[NR_HW_CH];
/* hardware resources */
unsigned long iobase;
u32 irq;
/* Function support */
struct trident_channel *(*alloc_pcm_channel) (struct trident_card *);
struct trident_channel *(*alloc_rec_pcm_channel) (struct trident_card *);
void (*free_pcm_channel) (struct trident_card *, unsigned int chan);
void (*address_interrupt) (struct trident_card *);
/* Added by Matt Wu 01-05-2001 for spdif in */
int multi_channel_use_count;
int rec_channel_use_count;
u16 mixer_regs[64][NR_AC97]; /* Made card local by Alan */
int mixer_regs_ready;
/* Added for hardware volume control */
int hwvolctl;
struct timer_list timer;
/* Game port support */
struct gameport *gameport;
};
enum dmabuf_mode {
DM_PLAYBACK = 0,
DM_RECORD
};
/* table to map from CHANNELMASK to channel attribute for SiS 7018 */
static u16 mask2attr[] = {
PCM_LR, PCM_LR, SURR_LR, CENTER_LFE,
HSET, MIC, MODEM_LINE1, MODEM_LINE2,
I2S_LR, SPDIF_LR
};
/* table to map from channel attribute to CHANNELMASK for SiS 7018 */
static int attr2mask[] = {
DSP_BIND_MODEM1, DSP_BIND_MODEM2, DSP_BIND_FRONT, DSP_BIND_HANDSET,
DSP_BIND_I2S, DSP_BIND_CENTER_LFE, DSP_BIND_SURR, DSP_BIND_SPDIF
};
/* Added by Matt Wu 01-05-2001 for spdif in */
static int ali_close_multi_channels(void);
static void ali_delay(struct trident_card *card, int interval);
static void ali_detect_spdif_rate(struct trident_card *card);
static void ali_ac97_write(struct ac97_codec *codec, u8 reg, u16 val);
static u16 ali_ac97_read(struct ac97_codec *codec, u8 reg);
static struct trident_card *devs;
static void trident_ac97_set(struct ac97_codec *codec, u8 reg, u16 val);
static u16 trident_ac97_get(struct ac97_codec *codec, u8 reg);
static int trident_open_mixdev(struct inode *inode, struct file *file);
static int trident_ioctl_mixdev(struct inode *inode, struct file *file,
unsigned int cmd, unsigned long arg);
static void ali_ac97_set(struct trident_card *card, int secondary, u8 reg, u16 val);
static u16 ali_ac97_get(struct trident_card *card, int secondary, u8 reg);
static void ali_set_spdif_out_rate(struct trident_card *card, unsigned int rate);
static void ali_enable_special_channel(struct trident_state *stat);
static struct trident_channel *ali_alloc_rec_pcm_channel(struct trident_card *card);
static struct trident_channel *ali_alloc_pcm_channel(struct trident_card *card);
static void ali_restore_regs(struct trident_card *card);
static void ali_save_regs(struct trident_card *card);
static int trident_suspend(struct pci_dev *dev, pm_message_t unused);
static int trident_resume(struct pci_dev *dev);
static void ali_free_pcm_channel(struct trident_card *card, unsigned int channel);
static int ali_setup_multi_channels(struct trident_card *card, int chan_nums);
static unsigned int ali_get_spdif_in_rate(struct trident_card *card);
static void ali_setup_spdif_in(struct trident_card *card);
static void ali_disable_spdif_in(struct trident_card *card);
static void ali_disable_special_channel(struct trident_card *card, int ch);
static void ali_setup_spdif_out(struct trident_card *card, int flag);
static int ali_write_5_1(struct trident_state *state,
const char __user *buffer,
int cnt_for_multi_channel, unsigned int *copy_count,
unsigned int *state_cnt);
static int ali_allocate_other_states_resources(struct trident_state *state,
int chan_nums);
static void ali_free_other_states_resources(struct trident_state *state);
/* save registers for ALi Power Management */
static struct ali_saved_registers {
unsigned long global_regs[ALI_GLOBAL_REGS];
unsigned long channel_regs[ALI_CHANNELS][ALI_CHANNEL_REGS];
unsigned mixer_regs[ALI_MIXER_REGS];
} ali_registers;
#define seek_offset(dma_ptr, buffer, cnt, offset, copy_count) do { \
(dma_ptr) += (offset); \
(buffer) += (offset); \
(cnt) -= (offset); \
(copy_count) += (offset); \
} while (0)
static inline int lock_set_fmt(struct trident_state* state)
{
if (test_and_set_bit(0, &state->fmt_flag))
return -EFAULT;
return 0;
}
static inline void unlock_set_fmt(struct trident_state* state)
{
clear_bit(0, &state->fmt_flag);
}
static int
trident_enable_loop_interrupts(struct trident_card *card)
{
u32 global_control;
global_control = inl(TRID_REG(card, T4D_LFO_GC_CIR));
switch (card->pci_id) {
case PCI_DEVICE_ID_SI_7018:
global_control |= (ENDLP_IE | MIDLP_IE | BANK_B_EN);
break;
case PCI_DEVICE_ID_ALI_5451:
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
case PCI_DEVICE_ID_INTERG_5050:
global_control |= (ENDLP_IE | MIDLP_IE);
break;
default:
return 0;
}
outl(global_control, TRID_REG(card, T4D_LFO_GC_CIR));
pr_debug("trident: Enable Loop Interrupts, globctl = 0x%08X\n",
inl(TRID_REG(card, T4D_LFO_GC_CIR)));
return 1;
}
static int
trident_disable_loop_interrupts(struct trident_card *card)
{
u32 global_control;
global_control = inl(TRID_REG(card, T4D_LFO_GC_CIR));
global_control &= ~(ENDLP_IE | MIDLP_IE);
outl(global_control, TRID_REG(card, T4D_LFO_GC_CIR));
pr_debug("trident: Disabled Loop Interrupts, globctl = 0x%08X\n",
global_control);
return 1;
}
static void
trident_enable_voice_irq(struct trident_card *card, unsigned int channel)
{
unsigned int mask = 1 << (channel & 0x1f);
struct trident_pcm_bank *bank = &card->banks[channel >> 5];
u32 reg, addr = bank->addresses->aint_en;
reg = inl(TRID_REG(card, addr));
reg |= mask;
outl(reg, TRID_REG(card, addr));
#ifdef DEBUG
reg = inl(TRID_REG(card, addr));
pr_debug("trident: enabled IRQ on channel %d, %s = 0x%08x(addr:%X)\n",
channel, addr == T4D_AINTEN_B ? "AINTEN_B" : "AINTEN_A",
reg, addr);
#endif /* DEBUG */
}
static void
trident_disable_voice_irq(struct trident_card *card, unsigned int channel)
{
unsigned int mask = 1 << (channel & 0x1f);
struct trident_pcm_bank *bank = &card->banks[channel >> 5];
u32 reg, addr = bank->addresses->aint_en;
reg = inl(TRID_REG(card, addr));
reg &= ~mask;
outl(reg, TRID_REG(card, addr));
/* Ack the channel in case the interrupt was set before we disable it. */
outl(mask, TRID_REG(card, bank->addresses->aint));
#ifdef DEBUG
reg = inl(TRID_REG(card, addr));
pr_debug("trident: disabled IRQ on channel %d, %s = 0x%08x(addr:%X)\n",
channel, addr == T4D_AINTEN_B ? "AINTEN_B" : "AINTEN_A",
reg, addr);
#endif /* DEBUG */
}
static void
trident_start_voice(struct trident_card *card, unsigned int channel)
{
unsigned int mask = 1 << (channel & 0x1f);
struct trident_pcm_bank *bank = &card->banks[channel >> 5];
u32 addr = bank->addresses->start;
#ifdef DEBUG
u32 reg;
#endif /* DEBUG */
outl(mask, TRID_REG(card, addr));
#ifdef DEBUG
reg = inl(TRID_REG(card, addr));
pr_debug("trident: start voice on channel %d, %s = 0x%08x(addr:%X)\n",
channel, addr == T4D_START_B ? "START_B" : "START_A",
reg, addr);
#endif /* DEBUG */
}
static void
trident_stop_voice(struct trident_card *card, unsigned int channel)
{
unsigned int mask = 1 << (channel & 0x1f);
struct trident_pcm_bank *bank = &card->banks[channel >> 5];
u32 addr = bank->addresses->stop;
#ifdef DEBUG
u32 reg;
#endif /* DEBUG */
outl(mask, TRID_REG(card, addr));
#ifdef DEBUG
reg = inl(TRID_REG(card, addr));
pr_debug("trident: stop voice on channel %d, %s = 0x%08x(addr:%X)\n",
channel, addr == T4D_STOP_B ? "STOP_B" : "STOP_A",
reg, addr);
#endif /* DEBUG */
}
static u32
trident_get_interrupt_mask(struct trident_card *card, unsigned int channel)
{
struct trident_pcm_bank *bank = &card->banks[channel];
u32 addr = bank->addresses->aint;
return inl(TRID_REG(card, addr));
}
static int
trident_check_channel_interrupt(struct trident_card *card, unsigned int channel)
{
unsigned int mask = 1 << (channel & 0x1f);
u32 reg = trident_get_interrupt_mask(card, channel >> 5);
#ifdef DEBUG
if (reg & mask)
pr_debug("trident: channel %d has interrupt, %s = 0x%08x\n",
channel, reg == T4D_AINT_B ? "AINT_B" : "AINT_A",
reg);
#endif /* DEBUG */
return (reg & mask) ? 1 : 0;
}
static void
trident_ack_channel_interrupt(struct trident_card *card, unsigned int channel)
{
unsigned int mask = 1 << (channel & 0x1f);
struct trident_pcm_bank *bank = &card->banks[channel >> 5];
u32 reg, addr = bank->addresses->aint;
reg = inl(TRID_REG(card, addr));
reg &= mask;
outl(reg, TRID_REG(card, addr));
#ifdef DEBUG
reg = inl(TRID_REG(card, T4D_AINT_B));
pr_debug("trident: Ack channel %d interrupt, AINT_B = 0x%08x\n",
channel, reg);
#endif /* DEBUG */
}
static struct trident_channel *
trident_alloc_pcm_channel(struct trident_card *card)
{
struct trident_pcm_bank *bank;
int idx;
bank = &card->banks[BANK_B];
for (idx = 31; idx >= 0; idx--) {
if (!(bank->bitmap & (1 << idx))) {
struct trident_channel *channel = &bank->channels[idx];
bank->bitmap |= 1 << idx;
channel->num = idx + 32;
return channel;
}
}
/* no more free channels available */
printk(KERN_ERR "trident: no more channels available on Bank B.\n");
return NULL;
}
static void
trident_free_pcm_channel(struct trident_card *card, unsigned int channel)
{
int bank;
unsigned char b;
if (channel < 31 || channel > 63)
return;
if (card->pci_id == PCI_DEVICE_ID_TRIDENT_4DWAVE_DX ||
card->pci_id == PCI_DEVICE_ID_TRIDENT_4DWAVE_NX) {
b = inb(TRID_REG(card, T4D_REC_CH));
if ((b & ~0x80) == channel)
outb(0x0, TRID_REG(card, T4D_REC_CH));
}
bank = channel >> 5;
channel = channel & 0x1f;
card->banks[bank].bitmap &= ~(1 << (channel));
}
static struct trident_channel *
cyber_alloc_pcm_channel(struct trident_card *card)
{
struct trident_pcm_bank *bank;
int idx;
/* The cyberpro 5050 has only 32 voices and one bank */
/* .. at least they are not documented (if you want to call that
* crap documentation), perhaps broken ? */
bank = &card->banks[BANK_A];
for (idx = 31; idx >= 0; idx--) {
if (!(bank->bitmap & (1 << idx))) {
struct trident_channel *channel = &bank->channels[idx];
bank->bitmap |= 1 << idx;
channel->num = idx;
return channel;
}
}
/* no more free channels available */
printk(KERN_ERR "cyberpro5050: no more channels available on Bank A.\n");
return NULL;
}
static void
cyber_free_pcm_channel(struct trident_card *card, unsigned int channel)
{
if (channel > 31)
return;
card->banks[BANK_A].bitmap &= ~(1 << (channel));
}
static inline void
cyber_outidx(int port, int idx, int data)
{
outb(idx, port);
outb(data, port + 1);
}
static inline int
cyber_inidx(int port, int idx)
{
outb(idx, port);
return inb(port + 1);
}
static int
cyber_init_ritual(struct trident_card *card)
{
/* some black magic, taken from SDK samples */
/* remove this and nothing will work */
int portDat;
int ret = 0;
unsigned long flags;
/*
* Keep interrupts off for the configure - we don't want to
* clash with another cyberpro config event
*/
spin_lock_irqsave(&card->lock, flags);
portDat = cyber_inidx(CYBER_PORT_AUDIO, CYBER_IDX_AUDIO_ENABLE);
/* enable, if it was disabled */
if ((portDat & CYBER_BMSK_AUENZ) != CYBER_BMSK_AUENZ_ENABLE) {
printk(KERN_INFO "cyberpro5050: enabling audio controller\n");
cyber_outidx(CYBER_PORT_AUDIO, CYBER_IDX_AUDIO_ENABLE,
portDat | CYBER_BMSK_AUENZ_ENABLE);
/* check again if hardware is enabled now */
portDat = cyber_inidx(CYBER_PORT_AUDIO, CYBER_IDX_AUDIO_ENABLE);
}
if ((portDat & CYBER_BMSK_AUENZ) != CYBER_BMSK_AUENZ_ENABLE) {
printk(KERN_ERR "cyberpro5050: initAudioAccess: no success\n");
ret = -1;
} else {
cyber_outidx(CYBER_PORT_AUDIO, CYBER_IDX_IRQ_ENABLE,
CYBER_BMSK_AUDIO_INT_ENABLE);
cyber_outidx(CYBER_PORT_AUDIO, 0xbf, 0x01);
cyber_outidx(CYBER_PORT_AUDIO, 0xba, 0x20);
cyber_outidx(CYBER_PORT_AUDIO, 0xbb, 0x08);
cyber_outidx(CYBER_PORT_AUDIO, 0xbf, 0x02);
cyber_outidx(CYBER_PORT_AUDIO, 0xb3, 0x06);
cyber_outidx(CYBER_PORT_AUDIO, 0xbf, 0x00);
}
spin_unlock_irqrestore(&card->lock, flags);
return ret;
}
/* called with spin lock held */
static int
trident_load_channel_registers(struct trident_card *card, u32 * data,
unsigned int channel)
{
int i;
if (channel > 63)
return 0;
/* select hardware channel to write */
outb(channel, TRID_REG(card, T4D_LFO_GC_CIR));
/* Output the channel registers, but don't write register
three to an ALI chip. */
for (i = 0; i < CHANNEL_REGS; i++) {
if (i == 3 && card->pci_id == PCI_DEVICE_ID_ALI_5451)
continue;
outl(data[i], TRID_REG(card, CHANNEL_START + 4 * i));
}
if (card->pci_id == PCI_DEVICE_ID_ALI_5451 ||
card->pci_id == PCI_DEVICE_ID_INTERG_5050) {
outl(ALI_EMOD_Still, TRID_REG(card, ALI_EBUF1));
outl(ALI_EMOD_Still, TRID_REG(card, ALI_EBUF2));
}
return 1;
}
/* called with spin lock held */
static int
trident_write_voice_regs(struct trident_state *state)
{
unsigned int data[CHANNEL_REGS + 1];
struct trident_channel *channel;
channel = state->dmabuf.channel;
data[1] = channel->lba;
data[4] = channel->control;
switch (state->card->pci_id) {
case PCI_DEVICE_ID_ALI_5451:
data[0] = 0; /* Current Sample Offset */
data[2] = (channel->eso << 16) | (channel->delta & 0xffff);
data[3] = 0;
break;
case PCI_DEVICE_ID_SI_7018:
case PCI_DEVICE_ID_INTERG_5050:
data[0] = 0; /* Current Sample Offset */
data[2] = (channel->eso << 16) | (channel->delta & 0xffff);
data[3] = (channel->attribute << 16) | (channel->fm_vol & 0xffff);
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
data[0] = 0; /* Current Sample Offset */
data[2] = (channel->eso << 16) | (channel->delta & 0xffff);
data[3] = channel->fm_vol & 0xffff;
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
data[0] = (channel->delta << 24);
data[2] = ((channel->delta << 16) & 0xff000000) |
(channel->eso & 0x00ffffff);
data[3] = channel->fm_vol & 0xffff;
break;
default:
return 0;
}
return trident_load_channel_registers(state->card, data, channel->num);
}
static int
compute_rate_play(u32 rate)
{
int delta;
/* We special case 44100 and 8000 since rounding with the equation
does not give us an accurate enough value. For 11025 and 22050
the equation gives us the best answer. All other frequencies will
also use the equation. JDW */
if (rate == 44100)
delta = 0xeb3;
else if (rate == 8000)
delta = 0x2ab;
else if (rate == 48000)
delta = 0x1000;
else
delta = (((rate << 12) + rate) / 48000) & 0x0000ffff;
return delta;
}
static int
compute_rate_rec(u32 rate)
{
int delta;
if (rate == 44100)
delta = 0x116a;
else if (rate == 8000)
delta = 0x6000;
else if (rate == 48000)
delta = 0x1000;
else
delta = ((48000 << 12) / rate) & 0x0000ffff;
return delta;
}
/* set playback sample rate */
static unsigned int
trident_set_dac_rate(struct trident_state *state, unsigned int rate)
{
struct dmabuf *dmabuf = &state->dmabuf;
if (rate > 48000)
rate = 48000;
if (rate < 4000)
rate = 4000;
dmabuf->rate = rate;
dmabuf->channel->delta = compute_rate_play(rate);
trident_write_voice_regs(state);
pr_debug("trident: called trident_set_dac_rate : rate = %d\n", rate);
return rate;
}
/* set recording sample rate */
static unsigned int
trident_set_adc_rate(struct trident_state *state, unsigned int rate)
{
struct dmabuf *dmabuf = &state->dmabuf;
if (rate > 48000)
rate = 48000;
if (rate < 4000)
rate = 4000;
dmabuf->rate = rate;
dmabuf->channel->delta = compute_rate_rec(rate);
trident_write_voice_regs(state);
pr_debug("trident: called trident_set_adc_rate : rate = %d\n", rate);
return rate;
}
/* prepare channel attributes for playback */
static void
trident_play_setup(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
struct trident_channel *channel = dmabuf->channel;
channel->lba = dmabuf->dma_handle;
channel->delta = compute_rate_play(dmabuf->rate);
channel->eso = dmabuf->dmasize >> sample_shift[dmabuf->fmt];
channel->eso -= 1;
if (state->card->pci_id != PCI_DEVICE_ID_SI_7018) {
channel->attribute = 0;
if (state->card->pci_id == PCI_DEVICE_ID_ALI_5451) {
if ((channel->num == ALI_SPDIF_IN_CHANNEL) ||
(channel->num == ALI_PCM_IN_CHANNEL))
ali_disable_special_channel(state->card, channel->num);
else if ((inl(TRID_REG(state->card, ALI_GLOBAL_CONTROL))
& ALI_SPDIF_OUT_CH_ENABLE)
&& (channel->num == ALI_SPDIF_OUT_CHANNEL)) {
ali_set_spdif_out_rate(state->card,
state->dmabuf.rate);
state->dmabuf.channel->delta = 0x1000;
}
}
}
channel->fm_vol = 0x0;
channel->control = CHANNEL_LOOP;
if (dmabuf->fmt & TRIDENT_FMT_16BIT) {
/* 16-bits */
channel->control |= CHANNEL_16BITS;
/* signed */
channel->control |= CHANNEL_SIGNED;
}
if (dmabuf->fmt & TRIDENT_FMT_STEREO)
/* stereo */
channel->control |= CHANNEL_STEREO;
pr_debug("trident: trident_play_setup, LBA = 0x%08x, Delta = 0x%08x, "
"ESO = 0x%08x, Control = 0x%08x\n", channel->lba,
channel->delta, channel->eso, channel->control);
trident_write_voice_regs(state);
}
/* prepare channel attributes for recording */
static void
trident_rec_setup(struct trident_state *state)
{
u16 w;
u8 bval;
struct trident_card *card = state->card;
struct dmabuf *dmabuf = &state->dmabuf;
struct trident_channel *channel = dmabuf->channel;
unsigned int rate;
/* Enable AC-97 ADC (capture) */
switch (card->pci_id) {
case PCI_DEVICE_ID_ALI_5451:
ali_enable_special_channel(state);
break;
case PCI_DEVICE_ID_SI_7018:
/* for 7018, the ac97 is always in playback/record (duplex) mode */
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
w = inb(TRID_REG(card, DX_ACR2_AC97_COM_STAT));
outb(w | 0x48, TRID_REG(card, DX_ACR2_AC97_COM_STAT));
/* enable and set record channel */
outb(0x80 | channel->num, TRID_REG(card, T4D_REC_CH));
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
w = inw(TRID_REG(card, T4D_MISCINT));
outw(w | 0x1000, TRID_REG(card, T4D_MISCINT));
/* enable and set record channel */
outb(0x80 | channel->num, TRID_REG(card, T4D_REC_CH));
break;
case PCI_DEVICE_ID_INTERG_5050:
/* don't know yet, using special channel 22 in GC1(0xd4)? */
break;
default:
return;
}
channel->lba = dmabuf->dma_handle;
channel->delta = compute_rate_rec(dmabuf->rate);
if ((card->pci_id == PCI_DEVICE_ID_ALI_5451) &&
(channel->num == ALI_SPDIF_IN_CHANNEL)) {
rate = ali_get_spdif_in_rate(card);
if (rate == 0) {
printk(KERN_WARNING "trident: ALi 5451 "
"S/PDIF input setup error!\n");
rate = 48000;
}
bval = inb(TRID_REG(card, ALI_SPDIF_CTRL));
if (bval & 0x10) {
outb(bval, TRID_REG(card, ALI_SPDIF_CTRL));
printk(KERN_WARNING "trident: cleared ALi "
"5451 S/PDIF parity error flag.\n");
}
if (rate != 48000)
channel->delta = ((rate << 12) / dmabuf->rate) & 0x0000ffff;
}
channel->eso = dmabuf->dmasize >> sample_shift[dmabuf->fmt];
channel->eso -= 1;
if (state->card->pci_id != PCI_DEVICE_ID_SI_7018) {
channel->attribute = 0;
}
channel->fm_vol = 0x0;
channel->control = CHANNEL_LOOP;
if (dmabuf->fmt & TRIDENT_FMT_16BIT) {
/* 16-bits */
channel->control |= CHANNEL_16BITS;
/* signed */
channel->control |= CHANNEL_SIGNED;
}
if (dmabuf->fmt & TRIDENT_FMT_STEREO)
/* stereo */
channel->control |= CHANNEL_STEREO;
pr_debug("trident: trident_rec_setup, LBA = 0x%08x, Delat = 0x%08x, "
"ESO = 0x%08x, Control = 0x%08x\n", channel->lba,
channel->delta, channel->eso, channel->control);
trident_write_voice_regs(state);
}
/* get current playback/recording dma buffer pointer (byte offset from LBA),
called with spinlock held! */
static inline unsigned
trident_get_dma_addr(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
u32 cso;
if (!dmabuf->enable)
return 0;
outb(dmabuf->channel->num, TRID_REG(state->card, T4D_LFO_GC_CIR));
switch (state->card->pci_id) {
case PCI_DEVICE_ID_ALI_5451:
case PCI_DEVICE_ID_SI_7018:
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
case PCI_DEVICE_ID_INTERG_5050:
/* 16 bits ESO, CSO for 7018 and DX */
cso = inw(TRID_REG(state->card, CH_DX_CSO_ALPHA_FMS + 2));
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
/* 24 bits ESO, CSO for NX */
cso = inl(TRID_REG(state->card, CH_NX_DELTA_CSO)) & 0x00ffffff;
break;
default:
return 0;
}
pr_debug("trident: trident_get_dma_addr: chip reported channel: %d, "
"cso = 0x%04x\n", dmabuf->channel->num, cso);
/* ESO and CSO are in units of Samples, convert to byte offset */
cso <<= sample_shift[dmabuf->fmt];
return (cso % dmabuf->dmasize);
}
/* Stop recording (lock held) */
static inline void
__stop_adc(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned int chan_num = dmabuf->channel->num;
struct trident_card *card = state->card;
dmabuf->enable &= ~ADC_RUNNING;
trident_stop_voice(card, chan_num);
trident_disable_voice_irq(card, chan_num);
}
static void
stop_adc(struct trident_state *state)
{
struct trident_card *card = state->card;
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
__stop_adc(state);
spin_unlock_irqrestore(&card->lock, flags);
}
static void
start_adc(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned int chan_num = dmabuf->channel->num;
struct trident_card *card = state->card;
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
if ((dmabuf->mapped ||
dmabuf->count < (signed) dmabuf->dmasize) &&
dmabuf->ready) {
dmabuf->enable |= ADC_RUNNING;
trident_enable_voice_irq(card, chan_num);
trident_start_voice(card, chan_num);
}
spin_unlock_irqrestore(&card->lock, flags);
}
/* stop playback (lock held) */
static inline void
__stop_dac(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned int chan_num = dmabuf->channel->num;
struct trident_card *card = state->card;
dmabuf->enable &= ~DAC_RUNNING;
trident_stop_voice(card, chan_num);
if (state->chans_num == 6) {
trident_stop_voice(card, state->other_states[0]->
dmabuf.channel->num);
trident_stop_voice(card, state->other_states[1]->
dmabuf.channel->num);
trident_stop_voice(card, state->other_states[2]->
dmabuf.channel->num);
trident_stop_voice(card, state->other_states[3]->
dmabuf.channel->num);
}
trident_disable_voice_irq(card, chan_num);
}
static void
stop_dac(struct trident_state *state)
{
struct trident_card *card = state->card;
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
__stop_dac(state);
spin_unlock_irqrestore(&card->lock, flags);
}
static void
start_dac(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned int chan_num = dmabuf->channel->num;
struct trident_card *card = state->card;
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
if ((dmabuf->mapped || dmabuf->count > 0) && dmabuf->ready) {
dmabuf->enable |= DAC_RUNNING;
trident_enable_voice_irq(card, chan_num);
trident_start_voice(card, chan_num);
if (state->chans_num == 6) {
trident_start_voice(card, state->other_states[0]->
dmabuf.channel->num);
trident_start_voice(card, state->other_states[1]->
dmabuf.channel->num);
trident_start_voice(card, state->other_states[2]->
dmabuf.channel->num);
trident_start_voice(card, state->other_states[3]->
dmabuf.channel->num);
}
}
spin_unlock_irqrestore(&card->lock, flags);
}
#define DMABUF_DEFAULTORDER (15-PAGE_SHIFT)
#define DMABUF_MINORDER 1
/* alloc a DMA buffer of with a buffer of this order */
static int
alloc_dmabuf(struct dmabuf *dmabuf, struct pci_dev *pci_dev, int order)
{
void *rawbuf = NULL;
struct page *page, *pend;
if (!(rawbuf = pci_alloc_consistent(pci_dev, PAGE_SIZE << order,
&dmabuf->dma_handle)))
return -ENOMEM;
pr_debug("trident: allocated %ld (order = %d) bytes at %p\n",
PAGE_SIZE << order, order, rawbuf);
dmabuf->ready = dmabuf->mapped = 0;
dmabuf->rawbuf = rawbuf;
dmabuf->buforder = order;
/* 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;
}
/* allocate the main DMA buffer, playback and recording buffer should be */
/* allocated separately */
static int
alloc_main_dmabuf(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
int order;
int ret = -ENOMEM;
/* alloc as big a chunk as we can, FIXME: is this necessary ?? */
for (order = DMABUF_DEFAULTORDER; order >= DMABUF_MINORDER; order--) {
if (!(ret = alloc_dmabuf(dmabuf, state->card->pci_dev, order)))
return 0;
/* else try again */
}
return ret;
}
/* deallocate a DMA buffer */
static void
dealloc_dmabuf(struct dmabuf *dmabuf, struct pci_dev *pci_dev)
{
struct page *page, *pend;
if (dmabuf->rawbuf) {
/* undo marking the pages as reserved */
pend = virt_to_page(dmabuf->rawbuf + (PAGE_SIZE << dmabuf->buforder) - 1);
for (page = virt_to_page(dmabuf->rawbuf); page <= pend; page++)
ClearPageReserved(page);
pci_free_consistent(pci_dev, PAGE_SIZE << dmabuf->buforder,
dmabuf->rawbuf, dmabuf->dma_handle);
dmabuf->rawbuf = NULL;
}
dmabuf->mapped = dmabuf->ready = 0;
}
static int
prog_dmabuf(struct trident_state *state, enum dmabuf_mode rec)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned bytepersec;
struct trident_state *s = state;
unsigned bufsize, dma_nums;
unsigned long flags;
int ret, i, order;
if ((ret = lock_set_fmt(state)) < 0)
return ret;
if (state->chans_num == 6)
dma_nums = 5;
else
dma_nums = 1;
for (i = 0; i < dma_nums; i++) {
if (i > 0) {
s = state->other_states[i - 1];
dmabuf = &s->dmabuf;
dmabuf->fmt = state->dmabuf.fmt;
dmabuf->rate = state->dmabuf.rate;
}
spin_lock_irqsave(&s->card->lock, flags);
dmabuf->hwptr = dmabuf->swptr = dmabuf->total_bytes = 0;
dmabuf->count = dmabuf->error = 0;
spin_unlock_irqrestore(&s->card->lock, flags);
/* allocate DMA buffer if not allocated yet */
if (!dmabuf->rawbuf) {
if (i == 0) {
if ((ret = alloc_main_dmabuf(state))) {
unlock_set_fmt(state);
return ret;
}
} else {
ret = -ENOMEM;
order = state->dmabuf.buforder - 1;
if (order >= DMABUF_MINORDER) {
ret = alloc_dmabuf(dmabuf,
state->card->pci_dev,
order);
}
if (ret) {
/* release the main DMA buffer */
dealloc_dmabuf(&state->dmabuf, state->card->pci_dev);
/* release the auxiliary DMA buffers */
for (i -= 2; i >= 0; i--)
dealloc_dmabuf(&state->other_states[i]->dmabuf,
state->card->pci_dev);
unlock_set_fmt(state);
return ret;
}
}
}
/* FIXME: figure out all this OSS fragment stuff */
bytepersec = dmabuf->rate << sample_shift[dmabuf->fmt];
bufsize = PAGE_SIZE << dmabuf->buforder;
if (dmabuf->ossfragshift) {
if ((1000 << dmabuf->ossfragshift) < bytepersec)
dmabuf->fragshift = ld2(bytepersec / 1000);
else
dmabuf->fragshift = dmabuf->ossfragshift;
} else {
/* lets hand out reasonable big ass buffers by default */
dmabuf->fragshift = (dmabuf->buforder + PAGE_SHIFT - 2);
}
dmabuf->numfrag = bufsize >> dmabuf->fragshift;
while (dmabuf->numfrag < 4 && dmabuf->fragshift > 3) {
dmabuf->fragshift--;
dmabuf->numfrag = bufsize >> dmabuf->fragshift;
}
dmabuf->fragsize = 1 << dmabuf->fragshift;
if (dmabuf->ossmaxfrags >= 4 && dmabuf->ossmaxfrags < dmabuf->numfrag)
dmabuf->numfrag = dmabuf->ossmaxfrags;
dmabuf->fragsamples = dmabuf->fragsize >> sample_shift[dmabuf->fmt];
dmabuf->dmasize = dmabuf->numfrag << dmabuf->fragshift;
memset(dmabuf->rawbuf, (dmabuf->fmt & TRIDENT_FMT_16BIT) ? 0 : 0x80,
dmabuf->dmasize);
spin_lock_irqsave(&s->card->lock, flags);
if (rec == DM_RECORD)
trident_rec_setup(s);
else /* DM_PLAYBACK */
trident_play_setup(s);
spin_unlock_irqrestore(&s->card->lock, flags);
/* set the ready flag for the dma buffer */
dmabuf->ready = 1;
pr_debug("trident: prog_dmabuf(%d), sample rate = %d, "
"format = %d, numfrag = %d, fragsize = %d "
"dmasize = %d\n", dmabuf->channel->num,
dmabuf->rate, dmabuf->fmt, dmabuf->numfrag,
dmabuf->fragsize, dmabuf->dmasize);
}
unlock_set_fmt(state);
return 0;
}
static inline int prog_dmabuf_record(struct trident_state* state)
{
return prog_dmabuf(state, DM_RECORD);
}
static inline int prog_dmabuf_playback(struct trident_state* state)
{
return prog_dmabuf(state, DM_PLAYBACK);
}
/* we are doing quantum mechanics here, the buffer can only be empty, half or full filled i.e.
|------------|------------| or |xxxxxxxxxxxx|------------| or |xxxxxxxxxxxx|xxxxxxxxxxxx|
but we almost always get this
|xxxxxx------|------------| or |xxxxxxxxxxxx|xxxxx-------|
so we have to clear the tail space to "silence"
|xxxxxx000000|------------| or |xxxxxxxxxxxx|xxxxxx000000|
*/
static void
trident_clear_tail(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned swptr;
unsigned char silence = (dmabuf->fmt & TRIDENT_FMT_16BIT) ? 0 : 0x80;
unsigned int len;
unsigned long flags;
spin_lock_irqsave(&state->card->lock, flags);
swptr = dmabuf->swptr;
spin_unlock_irqrestore(&state->card->lock, flags);
if (swptr == 0 || swptr == dmabuf->dmasize / 2 ||
swptr == dmabuf->dmasize)
return;
if (swptr < dmabuf->dmasize / 2)
len = dmabuf->dmasize / 2 - swptr;
else
len = dmabuf->dmasize - swptr;
memset(dmabuf->rawbuf + swptr, silence, len);
if (state->card->pci_id != PCI_DEVICE_ID_ALI_5451) {
spin_lock_irqsave(&state->card->lock, flags);
dmabuf->swptr += len;
dmabuf->count += len;
spin_unlock_irqrestore(&state->card->lock, flags);
}
/* restart the dma machine in case it is halted */
start_dac(state);
}
static int
drain_dac(struct trident_state *state, int nonblock)
{
DECLARE_WAITQUEUE(wait, current);
struct dmabuf *dmabuf = &state->dmabuf;
unsigned long flags;
unsigned long tmo;
int count;
unsigned long diff = 0;
if (dmabuf->mapped || !dmabuf->ready)
return 0;
add_wait_queue(&dmabuf->wait, &wait);
for (;;) {
/* It seems that we have to set the current state to TASK_INTERRUPTIBLE
every time to make the process really go to sleep */
set_current_state(TASK_INTERRUPTIBLE);
spin_lock_irqsave(&state->card->lock, flags);
count = dmabuf->count;
spin_unlock_irqrestore(&state->card->lock, flags);
if (count <= 0)
break;
if (signal_pending(current))
break;
if (nonblock) {
remove_wait_queue(&dmabuf->wait, &wait);
set_current_state(TASK_RUNNING);
return -EBUSY;
}
/* No matter how much data is left in the buffer, we have to wait until
CSO == ESO/2 or CSO == ESO when address engine interrupts */
if (state->card->pci_id == PCI_DEVICE_ID_ALI_5451 ||
state->card->pci_id == PCI_DEVICE_ID_INTERG_5050) {
diff = dmabuf->swptr - trident_get_dma_addr(state) + dmabuf->dmasize;
diff = diff % (dmabuf->dmasize);
tmo = (diff * HZ) / dmabuf->rate;
} else {
tmo = (dmabuf->dmasize * HZ) / dmabuf->rate;
}
tmo >>= sample_shift[dmabuf->fmt];
if (!schedule_timeout(tmo ? tmo : 1) && tmo) {
break;
}
}
remove_wait_queue(&dmabuf->wait, &wait);
set_current_state(TASK_RUNNING);
if (signal_pending(current))
return -ERESTARTSYS;
return 0;
}
/* update buffer manangement pointers, especially, */
/* dmabuf->count and dmabuf->hwptr */
static void
trident_update_ptr(struct trident_state *state)
{
struct dmabuf *dmabuf = &state->dmabuf;
unsigned hwptr, swptr;
int clear_cnt = 0;
int diff;
unsigned char silence;
unsigned half_dmasize;
/* update hardware pointer */
hwptr = trident_get_dma_addr(state);
diff = (dmabuf->dmasize + hwptr - dmabuf->hwptr) % dmabuf->dmasize;
dmabuf->hwptr = hwptr;
dmabuf->total_bytes += diff;
/* error handling and process wake up for ADC */
if (dmabuf->enable == ADC_RUNNING) {
if (dmabuf->mapped) {
dmabuf->count -= diff;
if (dmabuf->count >= (signed) dmabuf->fragsize)
wake_up(&dmabuf->wait);
} else {
dmabuf->count += diff;
if (dmabuf->count < 0 ||
dmabuf->count > dmabuf->dmasize) {
/* buffer underrun or buffer overrun, */
/* we have no way to recover it here, just */
/* stop the machine and let the process */
/* force hwptr and swptr to sync */
__stop_adc(state);
dmabuf->error++;
}
if (dmabuf->count < (signed) dmabuf->dmasize / 2)
wake_up(&dmabuf->wait);
}
}
/* error handling and process wake up for DAC */
if (dmabuf->enable == DAC_RUNNING) {
if (dmabuf->mapped) {
dmabuf->count += diff;
if (dmabuf->count >= (signed) dmabuf->fragsize)
wake_up(&dmabuf->wait);
} else {
dmabuf->count -= diff;
if (dmabuf->count < 0 ||
dmabuf->count > dmabuf->dmasize) {
/* buffer underrun or buffer overrun, we have no way to recover
it here, just stop the machine and let the process force hwptr
and swptr to sync */
__stop_dac(state);
dmabuf->error++;
} else if (!dmabuf->endcleared) {
swptr = dmabuf->swptr;
silence = (dmabuf->fmt & TRIDENT_FMT_16BIT ? 0 : 0x80);
if (dmabuf->update_flag & ALI_ADDRESS_INT_UPDATE) {
/* We must clear end data of 1/2 dmabuf if needed.
According to 1/2 algorithm of Address Engine Interrupt,
check the validation of the data of half dmasize. */
half_dmasize = dmabuf->dmasize / 2;
if ((diff = hwptr - half_dmasize) < 0)
diff = hwptr;
if ((dmabuf->count + diff) < half_dmasize) {
//there is invalid data in the end of half buffer
if ((clear_cnt = half_dmasize - swptr) < 0)
clear_cnt += half_dmasize;
//clear the invalid data
memset(dmabuf->rawbuf + swptr, silence, clear_cnt);
if (state->chans_num == 6) {
clear_cnt = clear_cnt / 2;
swptr = swptr / 2;
memset(state->other_states[0]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
memset(state->other_states[1]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
memset(state->other_states[2]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
memset(state->other_states[3]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
}
dmabuf->endcleared = 1;
}
} else if (dmabuf->count < (signed) dmabuf->fragsize) {
clear_cnt = dmabuf->fragsize;
if ((swptr + clear_cnt) > dmabuf->dmasize)
clear_cnt = dmabuf->dmasize - swptr;
memset(dmabuf->rawbuf + swptr, silence, clear_cnt);
if (state->chans_num == 6) {
clear_cnt = clear_cnt / 2;
swptr = swptr / 2;
memset(state->other_states[0]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
memset(state->other_states[1]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
memset(state->other_states[2]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
memset(state->other_states[3]->dmabuf.rawbuf + swptr,
silence, clear_cnt);
}
dmabuf->endcleared = 1;
}
}
/* trident_update_ptr is called by interrupt handler or by process via
ioctl/poll, we only wake up the waiting process when we have more
than 1/2 buffer free (always true for interrupt handler) */
if (dmabuf->count < (signed) dmabuf->dmasize / 2)
wake_up(&dmabuf->wait);
}
}
dmabuf->update_flag &= ~ALI_ADDRESS_INT_UPDATE;
}
static void
trident_address_interrupt(struct trident_card *card)
{
int i;
struct trident_state *state;
unsigned int channel;
/* Update the pointers for all channels we are running. */
/* FIXME: should read interrupt status only once */
for (i = 0; i < NR_HW_CH; i++) {
channel = 63 - i;
if (trident_check_channel_interrupt(card, channel)) {
trident_ack_channel_interrupt(card, channel);
if ((state = card->states[i]) != NULL) {
trident_update_ptr(state);
} else {
printk(KERN_WARNING "trident: spurious channel "
"irq %d.\n", channel);
trident_stop_voice(card, channel);
trident_disable_voice_irq(card, channel);
}
}
}
}
static void
ali_hwvol_control(struct trident_card *card, int opt)
{
u16 dwTemp, volume[2], mute, diff, *pVol[2];
dwTemp = ali_ac97_read(card->ac97_codec[0], 0x02);
mute = dwTemp & 0x8000;
volume[0] = dwTemp & 0x001f;
volume[1] = (dwTemp & 0x1f00) >> 8;
if (volume[0] < volume[1]) {
pVol[0] = &volume[0];
pVol[1] = &volume[1];
} else {
pVol[1] = &volume[0];
pVol[0] = &volume[1];
}
diff = *(pVol[1]) - *(pVol[0]);
if (opt == 1) { // MUTE
dwTemp ^= 0x8000;
ali_ac97_write(card->ac97_codec[0],
0x02, dwTemp);
} else if (opt == 2) { // Down
if (mute)
return;
if (*(pVol[1]) < 0x001f) {
(*pVol[1])++;
*(pVol[0]) = *(pVol[1]) - diff;
}
dwTemp &= 0xe0e0;
dwTemp |= (volume[0]) | (volume[1] << 8);
ali_ac97_write(card->ac97_codec[0], 0x02, dwTemp);
card->ac97_codec[0]->mixer_state[0] = ((32 - volume[0]) * 25 / 8) |
(((32 - volume[1]) * 25 / 8) << 8);
} else if (opt == 4) { // Up
if (mute)
return;
if (*(pVol[0]) > 0) {
(*pVol[0])--;
*(pVol[1]) = *(pVol[0]) + diff;
}
dwTemp &= 0xe0e0;
dwTemp |= (volume[0]) | (volume[1] << 8);
ali_ac97_write(card->ac97_codec[0], 0x02, dwTemp);
card->ac97_codec[0]->mixer_state[0] = ((32 - volume[0]) * 25 / 8) |
(((32 - volume[1]) * 25 / 8) << 8);
} else {
/* Nothing needs doing */
}
}
/*
* Re-enable reporting of vol change after 0.1 seconds
*/
static void
ali_timeout(unsigned long ptr)
{
struct trident_card *card = (struct trident_card *) ptr;
u16 temp = 0;
/* Enable GPIO IRQ (MISCINT bit 18h) */
temp = inw(TRID_REG(card, T4D_MISCINT + 2));
temp |= 0x0004;
outw(temp, TRID_REG(card, T4D_MISCINT + 2));
}
/*
* Set up the timer to clear the vol change notification
*/
static void
ali_set_timer(struct trident_card *card)
{
/* Add Timer Routine to Enable GPIO IRQ */
del_timer(&card->timer); /* Never queue twice */
card->timer.function = ali_timeout;
card->timer.data = (unsigned long) card;
card->timer.expires = jiffies + HZ / 10;
add_timer(&card->timer);
}
/*
* Process a GPIO event
*/
static void
ali_queue_task(struct trident_card *card, int opt)
{
u16 temp;
/* Disable GPIO IRQ (MISCINT bit 18h) */
temp = inw(TRID_REG(card, T4D_MISCINT + 2));
temp &= (u16) (~0x0004);
outw(temp, TRID_REG(card, T4D_MISCINT + 2));
/* Adjust the volume */
ali_hwvol_control(card, opt);
/* Set the timer for 1/10th sec */
ali_set_timer(card);
}
static void
cyber_address_interrupt(struct trident_card *card)
{
int i, irq_status;
struct trident_state *state;
unsigned int channel;
/* Update the pointers for all channels we are running. */
/* FIXED: read interrupt status only once */
irq_status = inl(TRID_REG(card, T4D_AINT_A));
pr_debug("cyber_address_interrupt: irq_status 0x%X\n", irq_status);
for (i = 0; i < NR_HW_CH; i++) {
channel = 31 - i;
if (irq_status & (1 << channel)) {
/* clear bit by writing a 1, zeroes are ignored */
outl((1 << channel), TRID_REG(card, T4D_AINT_A));
pr_debug("cyber_interrupt: channel %d\n", channel);
if ((state = card->states[i]) != NULL) {
trident_update_ptr(state);
} else {
printk(KERN_WARNING "cyber5050: spurious "
"channel irq %d.\n", channel);
trident_stop_voice(card, channel);
trident_disable_voice_irq(card, channel);
}
}
}
}
static irqreturn_t
trident_interrupt(int irq, void *dev_id, struct pt_regs *regs)
{
struct trident_card *card = (struct trident_card *) dev_id;
u32 event;
u32 gpio;
spin_lock(&card->lock);
event = inl(TRID_REG(card, T4D_MISCINT));
pr_debug("trident: trident_interrupt called, MISCINT = 0x%08x\n",
event);
if (event & ADDRESS_IRQ) {
card->address_interrupt(card);
}
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
/* GPIO IRQ (H/W Volume Control) */
event = inl(TRID_REG(card, T4D_MISCINT));
if (event & (1 << 25)) {
gpio = inl(TRID_REG(card, ALI_GPIO));
if (!timer_pending(&card->timer))
ali_queue_task(card, gpio & 0x07);
}
event = inl(TRID_REG(card, T4D_MISCINT));
outl(event | (ST_TARGET_REACHED | MIXER_OVERFLOW | MIXER_UNDERFLOW),
TRID_REG(card, T4D_MISCINT));
spin_unlock(&card->lock);
return IRQ_HANDLED;
}
/* manually clear interrupt status, bad hardware design, blame T^2 */
outl((ST_TARGET_REACHED | MIXER_OVERFLOW | MIXER_UNDERFLOW),
TRID_REG(card, T4D_MISCINT));
spin_unlock(&card->lock);
return IRQ_HANDLED;
}
/* in this loop, dmabuf.count signifies the amount of data that is waiting */
/* to be copied to the user's buffer. it is filled by the dma machine and */
/* drained by this loop. */
static ssize_t
trident_read(struct file *file, char __user *buffer, size_t count, loff_t * ppos)
{
struct trident_state *state = (struct trident_state *)file->private_data;
struct dmabuf *dmabuf = &state->dmabuf;
ssize_t ret = 0;
unsigned long flags;
unsigned swptr;
int cnt;
pr_debug("trident: trident_read called, count = %d\n", count);
VALIDATE_STATE(state);
if (dmabuf->mapped)
return -ENXIO;
if (!access_ok(VERIFY_WRITE, buffer, count))
return -EFAULT;
mutex_lock(&state->sem);
if (!dmabuf->ready && (ret = prog_dmabuf_record(state)))
goto out;
while (count > 0) {
spin_lock_irqsave(&state->card->lock, flags);
if (dmabuf->count > (signed) dmabuf->dmasize) {
/* buffer overrun, we are recovering from */
/* sleep_on_timeout, resync hwptr and swptr, */
/* make process flush the buffer */
dmabuf->count = dmabuf->dmasize;
dmabuf->swptr = dmabuf->hwptr;
}
swptr = dmabuf->swptr;
cnt = dmabuf->dmasize - swptr;
if (dmabuf->count < cnt)
cnt = dmabuf->count;
spin_unlock_irqrestore(&state->card->lock, flags);
if (cnt > count)
cnt = count;
if (cnt <= 0) {
unsigned long tmo;
/* buffer is empty, start the dma machine and */
/* wait for data to be recorded */
start_adc(state);
if (file->f_flags & O_NONBLOCK) {
if (!ret)
ret = -EAGAIN;
goto out;
}
mutex_unlock(&state->sem);
/* No matter how much space left in the buffer, */
/* we have to wait until CSO == ESO/2 or CSO == ESO */
/* when address engine interrupts */
tmo = (dmabuf->dmasize * HZ) / (dmabuf->rate * 2);
tmo >>= sample_shift[dmabuf->fmt];
/* There are two situations when sleep_on_timeout returns, one is when
the interrupt is serviced correctly and the process is waked up by
ISR ON TIME. Another is when timeout is expired, which means that
either interrupt is NOT serviced correctly (pending interrupt) or it
is TOO LATE for the process to be scheduled to run (scheduler latency)
which results in a (potential) buffer overrun. And worse, there is
NOTHING we can do to prevent it. */
if (!interruptible_sleep_on_timeout(&dmabuf->wait, tmo)) {
pr_debug(KERN_ERR "trident: recording schedule timeout, "
"dmasz %u fragsz %u count %i hwptr %u swptr %u\n",
dmabuf->dmasize, dmabuf->fragsize, dmabuf->count,
dmabuf->hwptr, dmabuf->swptr);
/* a buffer overrun, we delay the recovery until next time the
while loop begin and we REALLY have space to record */
}
if (signal_pending(current)) {
if (!ret)
ret = -ERESTARTSYS;
goto out;
}
mutex_lock(&state->sem);
if (dmabuf->mapped) {
if (!ret)
ret = -ENXIO;
goto out;
}
continue;
}
if (copy_to_user(buffer, dmabuf->rawbuf + swptr, cnt)) {
if (!ret)
ret = -EFAULT;
goto out;
}
swptr = (swptr + cnt) % dmabuf->dmasize;
spin_lock_irqsave(&state->card->lock, flags);
dmabuf->swptr = swptr;
dmabuf->count -= cnt;
spin_unlock_irqrestore(&state->card->lock, flags);
count -= cnt;
buffer += cnt;
ret += cnt;
start_adc(state);
}
out:
mutex_unlock(&state->sem);
return ret;
}
/* in this loop, dmabuf.count signifies the amount of data that is waiting to be dma to
the soundcard. it is drained by the dma machine and filled by this loop. */
static ssize_t
trident_write(struct file *file, const char __user *buffer, size_t count, loff_t * ppos)
{
struct trident_state *state = (struct trident_state *)file->private_data;
struct dmabuf *dmabuf = &state->dmabuf;
ssize_t ret;
unsigned long flags;
unsigned swptr;
int cnt;
unsigned int state_cnt;
unsigned int copy_count;
int lret; /* for lock_set_fmt */
pr_debug("trident: trident_write called, count = %d\n", count);
VALIDATE_STATE(state);
/*
* Guard against an mmap or ioctl while writing
*/
mutex_lock(&state->sem);
if (dmabuf->mapped) {
ret = -ENXIO;
goto out;
}
if (!dmabuf->ready && (ret = prog_dmabuf_playback(state)))
goto out;
if (!access_ok(VERIFY_READ, buffer, count)) {
ret = -EFAULT;
goto out;
}
ret = 0;
while (count > 0) {
spin_lock_irqsave(&state->card->lock, flags);
if (dmabuf->count < 0) {
/* buffer underrun, we are recovering from */
/* sleep_on_timeout, resync hwptr and swptr */
dmabuf->count = 0;
dmabuf->swptr = dmabuf->hwptr;
}
swptr = dmabuf->swptr;
cnt = dmabuf->dmasize - swptr;
if (dmabuf->count + cnt > dmabuf->dmasize)
cnt = dmabuf->dmasize - dmabuf->count;
spin_unlock_irqrestore(&state->card->lock, flags);
if (cnt > count)
cnt = count;
if (cnt <= 0) {
unsigned long tmo;
/* buffer is full, start the dma machine and */
/* wait for data to be played */
start_dac(state);
if (file->f_flags & O_NONBLOCK) {
if (!ret)
ret = -EAGAIN;
goto out;
}
/* No matter how much data left in the buffer, */
/* we have to wait until CSO == ESO/2 or CSO == ESO */
/* when address engine interrupts */
lock_set_fmt(state);
tmo = (dmabuf->dmasize * HZ) / (dmabuf->rate * 2);
tmo >>= sample_shift[dmabuf->fmt];
unlock_set_fmt(state);
mutex_unlock(&state->sem);
/* There are two situations when sleep_on_timeout */
/* returns, one is when the interrupt is serviced */
/* correctly and the process is waked up by ISR */
/* ON TIME. Another is when timeout is expired, which */
/* means that either interrupt is NOT serviced */
/* correctly (pending interrupt) or it is TOO LATE */
/* for the process to be scheduled to run */
/* (scheduler latency) which results in a (potential) */
/* buffer underrun. And worse, there is NOTHING we */
/* can do to prevent it. */
if (!interruptible_sleep_on_timeout(&dmabuf->wait, tmo)) {
pr_debug(KERN_ERR "trident: playback schedule "
"timeout, dmasz %u fragsz %u count %i "
"hwptr %u swptr %u\n", dmabuf->dmasize,
dmabuf->fragsize, dmabuf->count,
dmabuf->hwptr, dmabuf->swptr);
/* a buffer underrun, we delay the recovery */
/* until next time the while loop begin and */
/* we REALLY have data to play */
}
if (signal_pending(current)) {
if (!ret)
ret = -ERESTARTSYS;
goto out_nolock;
}
mutex_lock(&state->sem);
if (dmabuf->mapped) {
if (!ret)
ret = -ENXIO;
goto out;
}
continue;
}
if ((lret = lock_set_fmt(state)) < 0) {
ret = lret;
goto out;
}
if (state->chans_num == 6) {
copy_count = 0;
state_cnt = 0;
if (ali_write_5_1(state, buffer, cnt, &copy_count,
&state_cnt) == -EFAULT) {
if (state_cnt) {
swptr = (swptr + state_cnt) % dmabuf->dmasize;
spin_lock_irqsave(&state->card->lock, flags);
dmabuf->swptr = swptr;
dmabuf->count += state_cnt;
dmabuf->endcleared = 0;
spin_unlock_irqrestore(&state->card->lock, flags);
}
ret += copy_count;
if (!ret)
ret = -EFAULT;
unlock_set_fmt(state);
goto out;
}
} else {
if (copy_from_user(dmabuf->rawbuf + swptr,
buffer, cnt)) {
if (!ret)
ret = -EFAULT;
unlock_set_fmt(state);
goto out;
}
state_cnt = cnt;
}
unlock_set_fmt(state);
swptr = (swptr + state_cnt) % dmabuf->dmasize;
spin_lock_irqsave(&state->card->lock, flags);
dmabuf->swptr = swptr;
dmabuf->count += state_cnt;
dmabuf->endcleared = 0;
spin_unlock_irqrestore(&state->card->lock, flags);
count -= cnt;
buffer += cnt;
ret += cnt;
start_dac(state);
}
out:
mutex_unlock(&state->sem);
out_nolock:
return ret;
}
/* No kernel lock - we have our own spinlock */
static unsigned int
trident_poll(struct file *file, struct poll_table_struct *wait)
{
struct trident_state *state = (struct trident_state *)file->private_data;
struct dmabuf *dmabuf = &state->dmabuf;
unsigned long flags;
unsigned int mask = 0;
VALIDATE_STATE(state);
/*
* Guard against a parallel poll and write causing multiple
* prog_dmabuf events
*/
mutex_lock(&state->sem);
if (file->f_mode & FMODE_WRITE) {
if (!dmabuf->ready && prog_dmabuf_playback(state)) {
mutex_unlock(&state->sem);
return 0;
}
poll_wait(file, &dmabuf->wait, wait);
}
if (file->f_mode & FMODE_READ) {
if (!dmabuf->ready && prog_dmabuf_record(state)) {
mutex_unlock(&state->sem);
return 0;
}
poll_wait(file, &dmabuf->wait, wait);
}
mutex_unlock(&state->sem);
spin_lock_irqsave(&state->card->lock, flags);
trident_update_ptr(state);
if (file->f_mode & FMODE_READ) {
if (dmabuf->count >= (signed) dmabuf->fragsize)
mask |= POLLIN | POLLRDNORM;
}
if (file->f_mode & FMODE_WRITE) {
if (dmabuf->mapped) {
if (dmabuf->count >= (signed) dmabuf->fragsize)
mask |= POLLOUT | POLLWRNORM;
} else {
if ((signed) dmabuf->dmasize >= dmabuf->count +
(signed) dmabuf->fragsize)
mask |= POLLOUT | POLLWRNORM;
}
}
spin_unlock_irqrestore(&state->card->lock, flags);
return mask;
}
static int
trident_mmap(struct file *file, struct vm_area_struct *vma)
{
struct trident_state *state = (struct trident_state *)file->private_data;
struct dmabuf *dmabuf = &state->dmabuf;
int ret = -EINVAL;
unsigned long size;
VALIDATE_STATE(state);
/*
* Lock against poll read write or mmap creating buffers. Also lock
* a read or write against an mmap.
*/
mutex_lock(&state->sem);
if (vma->vm_flags & VM_WRITE) {
if ((ret = prog_dmabuf_playback(state)) != 0)
goto out;
} else if (vma->vm_flags & VM_READ) {
if ((ret = prog_dmabuf_record(state)) != 0)
goto out;
} else
goto out;
ret = -EINVAL;
if (vma->vm_pgoff != 0)
goto out;
size = vma->vm_end - vma->vm_start;
if (size > (PAGE_SIZE << dmabuf->buforder))
goto out;
ret = -EAGAIN;
if (remap_pfn_range(vma, vma->vm_start,
virt_to_phys(dmabuf->rawbuf) >> PAGE_SHIFT,
size, vma->vm_page_prot))
goto out;
dmabuf->mapped = 1;
ret = 0;
out:
mutex_unlock(&state->sem);
return ret;
}
static int
trident_ioctl(struct inode *inode, struct file *file,
unsigned int cmd, unsigned long arg)
{
struct trident_state *state = (struct trident_state *)file->private_data;
struct dmabuf *dmabuf = &state->dmabuf;
unsigned long flags;
audio_buf_info abinfo;
count_info cinfo;
int val, mapped, ret = 0;
struct trident_card *card = state->card;
void __user *argp = (void __user *)arg;
int __user *p = argp;
VALIDATE_STATE(state);
mapped = ((file->f_mode & (FMODE_WRITE | FMODE_READ)) && dmabuf->mapped);
pr_debug("trident: trident_ioctl, command = %2d, arg = 0x%08x\n",
_IOC_NR(cmd), arg ? *p : 0);
switch (cmd) {
case OSS_GETVERSION:
ret = put_user(SOUND_VERSION, p);
break;
case SNDCTL_DSP_RESET:
/* FIXME: spin_lock ? */
if (file->f_mode & FMODE_WRITE) {
stop_dac(state);
synchronize_irq(card->irq);
dmabuf->ready = 0;
dmabuf->swptr = dmabuf->hwptr = 0;
dmabuf->count = dmabuf->total_bytes = 0;
}
if (file->f_mode & FMODE_READ) {
stop_adc(state);
synchronize_irq(card->irq);
dmabuf->ready = 0;
dmabuf->swptr = dmabuf->hwptr = 0;
dmabuf->count = dmabuf->total_bytes = 0;
}
break;
case SNDCTL_DSP_SYNC:
if (file->f_mode & FMODE_WRITE)
ret = drain_dac(state, file->f_flags & O_NONBLOCK);
break;
case SNDCTL_DSP_SPEED: /* set smaple rate */
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if (val >= 0) {
if (file->f_mode & FMODE_WRITE) {
stop_dac(state);
dmabuf->ready = 0;
spin_lock_irqsave(&state->card->lock, flags);
trident_set_dac_rate(state, val);
spin_unlock_irqrestore(&state->card->lock, flags);
}
if (file->f_mode & FMODE_READ) {
stop_adc(state);
dmabuf->ready = 0;
spin_lock_irqsave(&state->card->lock, flags);
trident_set_adc_rate(state, val);
spin_unlock_irqrestore(&state->card->lock, flags);
}
}
ret = put_user(dmabuf->rate, p);
break;
case SNDCTL_DSP_STEREO: /* set stereo or mono channel */
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if ((ret = lock_set_fmt(state)) < 0)
return ret;
if (file->f_mode & FMODE_WRITE) {
stop_dac(state);
dmabuf->ready = 0;
if (val)
dmabuf->fmt |= TRIDENT_FMT_STEREO;
else
dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
}
if (file->f_mode & FMODE_READ) {
stop_adc(state);
dmabuf->ready = 0;
if (val)
dmabuf->fmt |= TRIDENT_FMT_STEREO;
else
dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
}
unlock_set_fmt(state);
break;
case SNDCTL_DSP_GETBLKSIZE:
if (file->f_mode & FMODE_WRITE) {
if ((val = prog_dmabuf_playback(state)))
ret = val;
else
ret = put_user(dmabuf->fragsize, p);
break;
}
if (file->f_mode & FMODE_READ) {
if ((val = prog_dmabuf_record(state)))
ret = val;
else
ret = put_user(dmabuf->fragsize, p);
break;
}
/* neither READ nor WRITE? is this even possible? */
ret = -EINVAL;
break;
case SNDCTL_DSP_GETFMTS: /* Returns a mask of supported sample format */
ret = put_user(AFMT_S16_LE | AFMT_U16_LE | AFMT_S8 |
AFMT_U8, p);
break;
case SNDCTL_DSP_SETFMT: /* Select sample format */
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if ((ret = lock_set_fmt(state)) < 0)
return ret;
if (val != AFMT_QUERY) {
if (file->f_mode & FMODE_WRITE) {
stop_dac(state);
dmabuf->ready = 0;
if (val == AFMT_S16_LE)
dmabuf->fmt |= TRIDENT_FMT_16BIT;
else
dmabuf->fmt &= ~TRIDENT_FMT_16BIT;
}
if (file->f_mode & FMODE_READ) {
stop_adc(state);
dmabuf->ready = 0;
if (val == AFMT_S16_LE)
dmabuf->fmt |= TRIDENT_FMT_16BIT;
else
dmabuf->fmt &= ~TRIDENT_FMT_16BIT;
}
}
unlock_set_fmt(state);
ret = put_user((dmabuf->fmt & TRIDENT_FMT_16BIT) ? AFMT_S16_LE :
AFMT_U8, p);
break;
case SNDCTL_DSP_CHANNELS:
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if (val != 0) {
if ((ret = lock_set_fmt(state)) < 0)
return ret;
if (file->f_mode & FMODE_WRITE) {
stop_dac(state);
dmabuf->ready = 0;
//prevent from memory leak
if ((state->chans_num > 2) && (state->chans_num != val)) {
ali_free_other_states_resources(state);
state->chans_num = 1;
}
if (val >= 2) {
dmabuf->fmt |= TRIDENT_FMT_STEREO;
if ((val == 6) && (state->card->pci_id == PCI_DEVICE_ID_ALI_5451)) {
if (card->rec_channel_use_count > 0) {
printk(KERN_ERR "trident: Record is "
"working on the card!\n");
ret = -EBUSY;
unlock_set_fmt(state);
break;
}
ret = ali_setup_multi_channels(state->card, 6);
if (ret < 0) {
unlock_set_fmt(state);
break;
}
mutex_lock(&state->card->open_mutex);
ret = ali_allocate_other_states_resources(state, 6);
if (ret < 0) {
mutex_unlock(&state->card->open_mutex);
unlock_set_fmt(state);
break;
}
state->card->multi_channel_use_count++;
mutex_unlock(&state->card->open_mutex);
} else
val = 2; /*yield to 2-channels */
} else
dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
state->chans_num = val;
}
if (file->f_mode & FMODE_READ) {
stop_adc(state);
dmabuf->ready = 0;
if (val >= 2) {
if (!((file->f_mode & FMODE_WRITE) &&
(val == 6)))
val = 2;
dmabuf->fmt |= TRIDENT_FMT_STEREO;
} else
dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
state->chans_num = val;
}
unlock_set_fmt(state);
}
ret = put_user(val, p);
break;
case SNDCTL_DSP_POST:
/* Cause the working fragment to be output */
break;
case SNDCTL_DSP_SUBDIVIDE:
if (dmabuf->subdivision) {
ret = -EINVAL;
break;
}
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if (val != 1 && val != 2 && val != 4) {
ret = -EINVAL;
break;
}
dmabuf->subdivision = val;
break;
case SNDCTL_DSP_SETFRAGMENT:
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
dmabuf->ossfragshift = val & 0xffff;
dmabuf->ossmaxfrags = (val >> 16) & 0xffff;
if (dmabuf->ossfragshift < 4)
dmabuf->ossfragshift = 4;
if (dmabuf->ossfragshift > 15)
dmabuf->ossfragshift = 15;
if (dmabuf->ossmaxfrags < 4)
dmabuf->ossmaxfrags = 4;
break;
case SNDCTL_DSP_GETOSPACE:
if (!(file->f_mode & FMODE_WRITE)) {
ret = -EINVAL;
break;
}
if (!dmabuf->ready && (val = prog_dmabuf_playback(state)) != 0) {
ret = val;
break;
}
spin_lock_irqsave(&state->card->lock, flags);
trident_update_ptr(state);
abinfo.fragsize = dmabuf->fragsize;
abinfo.bytes = dmabuf->dmasize - dmabuf->count;
abinfo.fragstotal = dmabuf->numfrag;
abinfo.fragments = abinfo.bytes >> dmabuf->fragshift;
spin_unlock_irqrestore(&state->card->lock, flags);
ret = copy_to_user(argp, &abinfo, sizeof (abinfo)) ?
-EFAULT : 0;
break;
case SNDCTL_DSP_GETISPACE:
if (!(file->f_mode & FMODE_READ)) {
ret = -EINVAL;
break;
}
if (!dmabuf->ready && (val = prog_dmabuf_record(state)) != 0) {
ret = val;
break;
}
spin_lock_irqsave(&state->card->lock, flags);
trident_update_ptr(state);
abinfo.fragsize = dmabuf->fragsize;
abinfo.bytes = dmabuf->count;
abinfo.fragstotal = dmabuf->numfrag;
abinfo.fragments = abinfo.bytes >> dmabuf->fragshift;
spin_unlock_irqrestore(&state->card->lock, flags);
ret = copy_to_user(argp, &abinfo, sizeof (abinfo)) ?
-EFAULT : 0;
break;
case SNDCTL_DSP_NONBLOCK:
file->f_flags |= O_NONBLOCK;
break;
case SNDCTL_DSP_GETCAPS:
ret = put_user(DSP_CAP_REALTIME | DSP_CAP_TRIGGER |
DSP_CAP_MMAP | DSP_CAP_BIND, p);
break;
case SNDCTL_DSP_GETTRIGGER:
val = 0;
if ((file->f_mode & FMODE_READ) && dmabuf->enable)
val |= PCM_ENABLE_INPUT;
if ((file->f_mode & FMODE_WRITE) && dmabuf->enable)
val |= PCM_ENABLE_OUTPUT;
ret = put_user(val, p);
break;
case SNDCTL_DSP_SETTRIGGER:
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if (file->f_mode & FMODE_READ) {
if (val & PCM_ENABLE_INPUT) {
if (!dmabuf->ready &&
(ret = prog_dmabuf_record(state)))
break;
start_adc(state);
} else
stop_adc(state);
}
if (file->f_mode & FMODE_WRITE) {
if (val & PCM_ENABLE_OUTPUT) {
if (!dmabuf->ready &&
(ret = prog_dmabuf_playback(state)))
break;
start_dac(state);
} else
stop_dac(state);
}
break;
case SNDCTL_DSP_GETIPTR:
if (!(file->f_mode & FMODE_READ)) {
ret = -EINVAL;
break;
}
if (!dmabuf->ready && (val = prog_dmabuf_record(state))
!= 0) {
ret = val;
break;
}
spin_lock_irqsave(&state->card->lock, flags);
trident_update_ptr(state);
cinfo.bytes = dmabuf->total_bytes;
cinfo.blocks = dmabuf->count >> dmabuf->fragshift;
cinfo.ptr = dmabuf->hwptr;
if (dmabuf->mapped)
dmabuf->count &= dmabuf->fragsize - 1;
spin_unlock_irqrestore(&state->card->lock, flags);
ret = copy_to_user(argp, &cinfo, sizeof (cinfo)) ?
-EFAULT : 0;
break;
case SNDCTL_DSP_GETOPTR:
if (!(file->f_mode & FMODE_WRITE)) {
ret = -EINVAL;
break;
}
if (!dmabuf->ready && (val = prog_dmabuf_playback(state))
!= 0) {
ret = val;
break;
}
spin_lock_irqsave(&state->card->lock, flags);
trident_update_ptr(state);
cinfo.bytes = dmabuf->total_bytes;
cinfo.blocks = dmabuf->count >> dmabuf->fragshift;
cinfo.ptr = dmabuf->hwptr;
if (dmabuf->mapped)
dmabuf->count &= dmabuf->fragsize - 1;
spin_unlock_irqrestore(&state->card->lock, flags);
ret = copy_to_user(argp, &cinfo, sizeof (cinfo)) ?
-EFAULT : 0;
break;
case SNDCTL_DSP_SETDUPLEX:
ret = -EINVAL;
break;
case SNDCTL_DSP_GETODELAY:
if (!(file->f_mode & FMODE_WRITE)) {
ret = -EINVAL;
break;
}
if (!dmabuf->ready && (val = prog_dmabuf_playback(state)) != 0) {
ret = val;
break;
}
spin_lock_irqsave(&state->card->lock, flags);
trident_update_ptr(state);
val = dmabuf->count;
spin_unlock_irqrestore(&state->card->lock, flags);
ret = put_user(val, p);
break;
case SOUND_PCM_READ_RATE:
ret = put_user(dmabuf->rate, p);
break;
case SOUND_PCM_READ_CHANNELS:
ret = put_user((dmabuf->fmt & TRIDENT_FMT_STEREO) ? 2 : 1,
p);
break;
case SOUND_PCM_READ_BITS:
ret = put_user((dmabuf->fmt & TRIDENT_FMT_16BIT) ? AFMT_S16_LE :
AFMT_U8, p);
break;
case SNDCTL_DSP_GETCHANNELMASK:
ret = put_user(DSP_BIND_FRONT | DSP_BIND_SURR |
DSP_BIND_CENTER_LFE, p);
break;
case SNDCTL_DSP_BIND_CHANNEL:
if (state->card->pci_id != PCI_DEVICE_ID_SI_7018) {
ret = -EINVAL;
break;
}
if (get_user(val, p)) {
ret = -EFAULT;
break;
}
if (val == DSP_BIND_QUERY) {
val = dmabuf->channel->attribute | 0x3c00;
val = attr2mask[val >> 8];
} else {
dmabuf->ready = 0;
if (file->f_mode & FMODE_READ)
dmabuf->channel->attribute = (CHANNEL_REC |
SRC_ENABLE);
if (file->f_mode & FMODE_WRITE)
dmabuf->channel->attribute = (CHANNEL_SPC_PB |
SRC_ENABLE);
dmabuf->channel->attribute |= mask2attr[ffs(val)];
}
ret = put_user(val, p);
break;
case SNDCTL_DSP_MAPINBUF:
case SNDCTL_DSP_MAPOUTBUF:
case SNDCTL_DSP_SETSYNCRO:
case SOUND_PCM_WRITE_FILTER:
case SOUND_PCM_READ_FILTER:
default:
ret = -EINVAL;
break;
}
return ret;
}
static int
trident_open(struct inode *inode, struct file *file)
{
int i = 0;
int minor = iminor(inode);
struct trident_card *card = devs;
struct trident_state *state = NULL;
struct dmabuf *dmabuf = NULL;
/* Added by Matt Wu 01-05-2001 */
/* TODO: there's some redundacy here wrt the check below */
/* for multi_use_count > 0. Should we return -EBUSY or find */
/* a different card? for now, don't break current behaviour */
/* -- mulix */
if (file->f_mode & FMODE_READ) {
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
if (card->multi_channel_use_count > 0)
return -EBUSY;
}
}
/* find an available virtual channel (instance of /dev/dsp) */
while (card != NULL) {
mutex_lock(&card->open_mutex);
if (file->f_mode & FMODE_READ) {
/* Skip opens on cards that are in 6 channel mode */
if (card->multi_channel_use_count > 0) {
mutex_unlock(&card->open_mutex);
card = card->next;
continue;
}
}
for (i = 0; i < NR_HW_CH; i++) {
if (card->states[i] == NULL) {
state = card->states[i] = kmalloc(sizeof(*state), GFP_KERNEL);
if (state == NULL) {
mutex_unlock(&card->open_mutex);
return -ENOMEM;
}
memset(state, 0, sizeof(*state));
mutex_init(&state->sem);
dmabuf = &state->dmabuf;
goto found_virt;
}
}
mutex_unlock(&card->open_mutex);
card = card->next;
}
/* no more virtual channel avaiable */
if (!state) {
return -ENODEV;
}
found_virt:
/* found a free virtual channel, allocate hardware channels */
if (file->f_mode & FMODE_READ)
dmabuf->channel = card->alloc_rec_pcm_channel(card);
else
dmabuf->channel = card->alloc_pcm_channel(card);
if (dmabuf->channel == NULL) {
kfree(card->states[i]);
card->states[i] = NULL;
return -ENODEV;
}
/* initialize the virtual channel */
state->virt = i;
state->card = card;
state->magic = TRIDENT_STATE_MAGIC;
init_waitqueue_head(&dmabuf->wait);
file->private_data = state;
/* set default sample format. According to OSS Programmer's */
/* Guide /dev/dsp should be default to unsigned 8-bits, mono, */
/* with sample rate 8kHz and /dev/dspW will accept 16-bits sample */
if (file->f_mode & FMODE_WRITE) {
dmabuf->fmt &= ~TRIDENT_FMT_MASK;
if ((minor & 0x0f) == SND_DEV_DSP16)
dmabuf->fmt |= TRIDENT_FMT_16BIT;
dmabuf->ossfragshift = 0;
dmabuf->ossmaxfrags = 0;
dmabuf->subdivision = 0;
if (card->pci_id == PCI_DEVICE_ID_SI_7018) {
/* set default channel attribute to normal playback */
dmabuf->channel->attribute = CHANNEL_PB;
}
trident_set_dac_rate(state, 8000);
}
if (file->f_mode & FMODE_READ) {
/* FIXME: Trident 4d can only record in signed 16-bits stereo, */
/* 48kHz sample, to be dealed with in trident_set_adc_rate() ?? */
dmabuf->fmt &= ~TRIDENT_FMT_MASK;
if ((minor & 0x0f) == SND_DEV_DSP16)
dmabuf->fmt |= TRIDENT_FMT_16BIT;
dmabuf->ossfragshift = 0;
dmabuf->ossmaxfrags = 0;
dmabuf->subdivision = 0;
if (card->pci_id == PCI_DEVICE_ID_SI_7018) {
/* set default channel attribute to 0x8a80, record from
PCM L/R FIFO and mono = (left + right + 1)/2 */
dmabuf->channel->attribute = (CHANNEL_REC | PCM_LR |
MONO_MIX);
}
trident_set_adc_rate(state, 8000);
/* Added by Matt Wu 01-05-2001 */
if (card->pci_id == PCI_DEVICE_ID_ALI_5451)
card->rec_channel_use_count++;
}
state->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
mutex_unlock(&card->open_mutex);
pr_debug("trident: open virtual channel %d, hard channel %d\n",
state->virt, dmabuf->channel->num);
return nonseekable_open(inode, file);
}
static int
trident_release(struct inode *inode, struct file *file)
{
struct trident_state *state = (struct trident_state *)file->private_data;
struct trident_card *card;
struct dmabuf *dmabuf;
VALIDATE_STATE(state);
card = state->card;
dmabuf = &state->dmabuf;
if (file->f_mode & FMODE_WRITE) {
trident_clear_tail(state);
drain_dac(state, file->f_flags & O_NONBLOCK);
}
pr_debug("trident: closing virtual channel %d, hard channel %d\n",
state->virt, dmabuf->channel->num);
/* stop DMA state machine and free DMA buffers/channels */
mutex_lock(&card->open_mutex);
if (file->f_mode & FMODE_WRITE) {
stop_dac(state);
dealloc_dmabuf(&state->dmabuf, state->card->pci_dev);
state->card->free_pcm_channel(state->card, dmabuf->channel->num);
/* Added by Matt Wu */
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
if (state->chans_num > 2) {
if (card->multi_channel_use_count-- < 0)
card->multi_channel_use_count = 0;
if (card->multi_channel_use_count == 0)
ali_close_multi_channels();
ali_free_other_states_resources(state);
}
}
}
if (file->f_mode & FMODE_READ) {
stop_adc(state);
dealloc_dmabuf(&state->dmabuf, state->card->pci_dev);
state->card->free_pcm_channel(state->card, dmabuf->channel->num);
/* Added by Matt Wu */
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
if (card->rec_channel_use_count-- < 0)
card->rec_channel_use_count = 0;
}
}
card->states[state->virt] = NULL;
kfree(state);
/* we're covered by the open_mutex */
mutex_unlock(&card->open_mutex);
return 0;
}
static /*const */ struct file_operations trident_audio_fops = {
.owner = THIS_MODULE,
.llseek = no_llseek,
.read = trident_read,
.write = trident_write,
.poll = trident_poll,
.ioctl = trident_ioctl,
.mmap = trident_mmap,
.open = trident_open,
.release = trident_release,
};
/* trident specific AC97 functions */
/* Write AC97 codec registers */
static void
trident_ac97_set(struct ac97_codec *codec, u8 reg, u16 val)
{
struct trident_card *card = (struct trident_card *)codec->private_data;
unsigned int address, mask, busy;
unsigned short count = 0xffff;
unsigned long flags;
u32 data;
data = ((u32) val) << 16;
switch (card->pci_id) {
default:
case PCI_DEVICE_ID_SI_7018:
address = SI_AC97_WRITE;
mask = SI_AC97_BUSY_WRITE | SI_AC97_AUDIO_BUSY;
if (codec->id)
mask |= SI_AC97_SECONDARY;
busy = SI_AC97_BUSY_WRITE;
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
address = DX_ACR0_AC97_W;
mask = busy = DX_AC97_BUSY_WRITE;
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
address = NX_ACR1_AC97_W;
mask = NX_AC97_BUSY_WRITE;
if (codec->id)
mask |= NX_AC97_WRITE_SECONDARY;
busy = NX_AC97_BUSY_WRITE;
break;
case PCI_DEVICE_ID_INTERG_5050:
address = SI_AC97_WRITE;
mask = busy = SI_AC97_BUSY_WRITE;
if (codec->id)
mask |= SI_AC97_SECONDARY;
break;
}
spin_lock_irqsave(&card->lock, flags);
do {
if ((inw(TRID_REG(card, address)) & busy) == 0)
break;
} while (count--);
data |= (mask | (reg & AC97_REG_ADDR));
if (count == 0) {
printk(KERN_ERR "trident: AC97 CODEC write timed out.\n");
spin_unlock_irqrestore(&card->lock, flags);
return;
}
outl(data, TRID_REG(card, address));
spin_unlock_irqrestore(&card->lock, flags);
}
/* Read AC97 codec registers */
static u16
trident_ac97_get(struct ac97_codec *codec, u8 reg)
{
struct trident_card *card = (struct trident_card *)codec->private_data;
unsigned int address, mask, busy;
unsigned short count = 0xffff;
unsigned long flags;
u32 data;
switch (card->pci_id) {
default:
case PCI_DEVICE_ID_SI_7018:
address = SI_AC97_READ;
mask = SI_AC97_BUSY_READ | SI_AC97_AUDIO_BUSY;
if (codec->id)
mask |= SI_AC97_SECONDARY;
busy = SI_AC97_BUSY_READ;
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
address = DX_ACR1_AC97_R;
mask = busy = DX_AC97_BUSY_READ;
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
if (codec->id)
address = NX_ACR3_AC97_R_SECONDARY;
else
address = NX_ACR2_AC97_R_PRIMARY;
mask = NX_AC97_BUSY_READ;
busy = NX_AC97_BUSY_READ | NX_AC97_BUSY_DATA;
break;
case PCI_DEVICE_ID_INTERG_5050:
address = SI_AC97_READ;
mask = busy = SI_AC97_BUSY_READ;
if (codec->id)
mask |= SI_AC97_SECONDARY;
break;
}
data = (mask | (reg & AC97_REG_ADDR));
spin_lock_irqsave(&card->lock, flags);
outl(data, TRID_REG(card, address));
do {
data = inl(TRID_REG(card, address));
if ((data & busy) == 0)
break;
} while (count--);
spin_unlock_irqrestore(&card->lock, flags);
if (count == 0) {
printk(KERN_ERR "trident: AC97 CODEC read timed out.\n");
data = 0;
}
return ((u16) (data >> 16));
}
/* rewrite ac97 read and write mixer register by hulei for ALI*/
static int
acquirecodecaccess(struct trident_card *card)
{
u16 wsemamask = 0x6000; /* bit 14..13 */
u16 wsemabits;
u16 wcontrol;
int block = 0;
int ncount = 25;
while (1) {
wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
wsemabits = wcontrol & wsemamask;
if (wsemabits == 0x4000)
return 1; /* 0x4000 is audio ,then success */
if (ncount-- < 0)
break;
if (wsemabits == 0) {
unlock:
outl(((u32) (wcontrol & 0x1eff) | 0x00004000),
TRID_REG(card, ALI_AC97_WRITE));
continue;
}
udelay(20);
}
if (!block) {
pr_debug("accesscodecsemaphore: try unlock\n");
block = 1;
goto unlock;
}
return 0;
}
static void
releasecodecaccess(struct trident_card *card)
{
unsigned long wcontrol;
wcontrol = inl(TRID_REG(card, ALI_AC97_WRITE));
outl((wcontrol & 0xffff1eff), TRID_REG(card, ALI_AC97_WRITE));
}
static int
waitforstimertick(struct trident_card *card)
{
unsigned long chk1, chk2;
unsigned int wcount = 0xffff;
chk1 = inl(TRID_REG(card, ALI_STIMER));
while (1) {
chk2 = inl(TRID_REG(card, ALI_STIMER));
if ((wcount > 0) && chk1 != chk2)
return 1;
if (wcount <= 0)
break;
udelay(50);
}
return 0;
}
/* Read AC97 codec registers for ALi*/
static u16
ali_ac97_get(struct trident_card *card, int secondary, u8 reg)
{
unsigned int address, mask;
unsigned int ncount;
unsigned long aud_reg;
u32 data;
u16 wcontrol;
unsigned long flags;
if (!card)
BUG();
address = ALI_AC97_READ;
if (card->revision == ALI_5451_V02) {
address = ALI_AC97_WRITE;
}
mask = ALI_AC97_READ_ACTION | ALI_AC97_AUDIO_BUSY;
if (secondary)
mask |= ALI_AC97_SECONDARY;
spin_lock_irqsave(&card->lock, flags);
if (!acquirecodecaccess(card))
printk(KERN_ERR "access codec fail\n");
wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
wcontrol &= 0xfe00;
wcontrol |= (0x8000 | reg);
outw(wcontrol, TRID_REG(card, ALI_AC97_WRITE));
data = (mask | (reg & AC97_REG_ADDR));
if (!waitforstimertick(card)) {
printk(KERN_ERR "ali_ac97_read: BIT_CLOCK is dead\n");
goto releasecodec;
}
udelay(20);
ncount = 10;
while (1) {
if ((inw(TRID_REG(card, ALI_AC97_WRITE)) & ALI_AC97_BUSY_READ)
!= 0)
break;
if (ncount <= 0)
break;
if (ncount-- == 1) {
pr_debug("ali_ac97_read :try clear busy flag\n");
aud_reg = inl(TRID_REG(card, ALI_AC97_WRITE));
outl((aud_reg & 0xffff7fff),
TRID_REG(card, ALI_AC97_WRITE));
}
udelay(10);
}
data = inl(TRID_REG(card, address));
spin_unlock_irqrestore(&card->lock, flags);
return ((u16) (data >> 16));
releasecodec:
releasecodecaccess(card);
spin_unlock_irqrestore(&card->lock, flags);
printk(KERN_ERR "ali_ac97_read: AC97 CODEC read timed out.\n");
return 0;
}
/* Write AC97 codec registers for hulei*/
static void
ali_ac97_set(struct trident_card *card, int secondary, u8 reg, u16 val)
{
unsigned int address, mask;
unsigned int ncount;
u32 data;
u16 wcontrol;
unsigned long flags;
data = ((u32) val) << 16;
if (!card)
BUG();
address = ALI_AC97_WRITE;
mask = ALI_AC97_WRITE_ACTION | ALI_AC97_AUDIO_BUSY;
if (secondary)
mask |= ALI_AC97_SECONDARY;
if (card->revision == ALI_5451_V02)
mask |= ALI_AC97_WRITE_MIXER_REGISTER;
spin_lock_irqsave(&card->lock, flags);
if (!acquirecodecaccess(card))
printk(KERN_ERR "ali_ac97_write: access codec fail\n");
wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
wcontrol &= 0xff00;
wcontrol |= (0x8100 | reg); /* bit 8=1: (ali1535 )reserved/ */
/* ali1535+ write */
outl((data | wcontrol), TRID_REG(card, ALI_AC97_WRITE));
if (!waitforstimertick(card)) {
printk(KERN_ERR "BIT_CLOCK is dead\n");
goto releasecodec;
}
ncount = 10;
while (1) {
wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
if (!(wcontrol & 0x8000))
break;
if (ncount <= 0)
break;
if (ncount-- == 1) {
pr_debug("ali_ac97_set :try clear busy flag!!\n");
outw(wcontrol & 0x7fff,
TRID_REG(card, ALI_AC97_WRITE));
}
udelay(10);
}
releasecodec:
releasecodecaccess(card);
spin_unlock_irqrestore(&card->lock, flags);
return;
}
static void
ali_enable_special_channel(struct trident_state *stat)
{
struct trident_card *card = stat->card;
unsigned long s_channels;
s_channels = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
s_channels |= (1 << stat->dmabuf.channel->num);
outl(s_channels, TRID_REG(card, ALI_GLOBAL_CONTROL));
}
static u16
ali_ac97_read(struct ac97_codec *codec, u8 reg)
{
int id;
u16 data;
struct trident_card *card = NULL;
/* Added by Matt Wu */
if (!codec)
BUG();
card = (struct trident_card *) codec->private_data;
if (!card->mixer_regs_ready)
return ali_ac97_get(card, codec->id, reg);
/*
* FIXME: need to stop this caching some registers
*/
if (codec->id)
id = 1;
else
id = 0;
data = card->mixer_regs[reg / 2][id];
return data;
}
static void
ali_ac97_write(struct ac97_codec *codec, u8 reg, u16 val)
{
int id;
struct trident_card *card;
/* Added by Matt Wu */
if (!codec)
BUG();
card = (struct trident_card *) codec->private_data;
if (!card->mixer_regs_ready) {
ali_ac97_set(card, codec->id, reg, val);
return;
}
if (codec->id)
id = 1;
else
id = 0;
card->mixer_regs[reg / 2][id] = val;
ali_ac97_set(card, codec->id, reg, val);
}
/*
flag: ALI_SPDIF_OUT_TO_SPDIF_OUT
ALI_PCM_TO_SPDIF_OUT
*/
static void
ali_setup_spdif_out(struct trident_card *card, int flag)
{
unsigned long spdif;
unsigned char ch;
char temp;
struct pci_dev *pci_dev = NULL;
pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
pci_dev);
if (pci_dev == NULL)
return;
pci_read_config_byte(pci_dev, 0x61, &temp);
temp |= 0x40;
pci_write_config_byte(pci_dev, 0x61, temp);
pci_read_config_byte(pci_dev, 0x7d, &temp);
temp |= 0x01;
pci_write_config_byte(pci_dev, 0x7d, temp);
pci_read_config_byte(pci_dev, 0x7e, &temp);
temp &= (~0x20);
temp |= 0x10;
pci_write_config_byte(pci_dev, 0x7e, temp);
ch = inb(TRID_REG(card, ALI_SCTRL));
outb(ch | ALI_SPDIF_OUT_ENABLE, TRID_REG(card, ALI_SCTRL));
ch = inb(TRID_REG(card, ALI_SPDIF_CTRL));
outb(ch & ALI_SPDIF_OUT_CH_STATUS, TRID_REG(card, ALI_SPDIF_CTRL));
if (flag & ALI_SPDIF_OUT_TO_SPDIF_OUT) {
spdif = inw(TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif |= ALI_SPDIF_OUT_CH_ENABLE;
spdif &= ALI_SPDIF_OUT_SEL_SPDIF;
outw(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif = inw(TRID_REG(card, ALI_SPDIF_CS));
if (flag & ALI_SPDIF_OUT_NON_PCM)
spdif |= 0x0002;
else
spdif &= (~0x0002);
outw(spdif, TRID_REG(card, ALI_SPDIF_CS));
} else {
spdif = inw(TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif |= ALI_SPDIF_OUT_SEL_PCM;
outw(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
}
}
static void
ali_disable_special_channel(struct trident_card *card, int ch)
{
unsigned long sc;
sc = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
sc &= ~(1 << ch);
outl(sc, TRID_REG(card, ALI_GLOBAL_CONTROL));
}
static void
ali_disable_spdif_in(struct trident_card *card)
{
unsigned long spdif;
spdif = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif &= (~ALI_SPDIF_IN_SUPPORT);
outl(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
ali_disable_special_channel(card, ALI_SPDIF_IN_CHANNEL);
}
static void
ali_setup_spdif_in(struct trident_card *card)
{
unsigned long spdif;
//Set SPDIF IN Supported
spdif = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif |= ALI_SPDIF_IN_SUPPORT;
outl(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
//Set SPDIF IN Rec
spdif = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif |= ALI_SPDIF_IN_CH_ENABLE;
outl(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
spdif = inb(TRID_REG(card, ALI_SPDIF_CTRL));
spdif |= ALI_SPDIF_IN_CH_STATUS;
outb(spdif, TRID_REG(card, ALI_SPDIF_CTRL));
/*
spdif = inb(TRID_REG(card, ALI_SPDIF_CTRL));
spdif |= ALI_SPDIF_IN_FUNC_ENABLE;
outb(spdif, TRID_REG(card, ALI_SPDIF_CTRL));
*/
}
static void
ali_delay(struct trident_card *card, int interval)
{
unsigned long begintimer, currenttimer;
begintimer = inl(TRID_REG(card, ALI_STIMER));
currenttimer = inl(TRID_REG(card, ALI_STIMER));
while (currenttimer < begintimer + interval)
currenttimer = inl(TRID_REG(card, ALI_STIMER));
}
static void
ali_detect_spdif_rate(struct trident_card *card)
{
u16 wval = 0;
u16 count = 0;
u8 bval = 0, R1 = 0, R2 = 0;
bval = inb(TRID_REG(card, ALI_SPDIF_CTRL));
bval |= 0x02;
outb(bval, TRID_REG(card, ALI_SPDIF_CTRL));
bval = inb(TRID_REG(card, ALI_SPDIF_CTRL + 1));
bval |= 0x1F;
outb(bval, TRID_REG(card, ALI_SPDIF_CTRL + 1));
while (((R1 < 0x0B) || (R1 > 0x0E)) && (R1 != 0x12) &&
count <= 50000) {
count++;
ali_delay(card, 6);
bval = inb(TRID_REG(card, ALI_SPDIF_CTRL + 1));
R1 = bval & 0x1F;
}
if (count > 50000) {
printk(KERN_WARNING "trident: Error in "
"ali_detect_spdif_rate!\n");
return;
}
count = 0;
while (count <= 50000) {
count++;
ali_delay(card, 6);
bval = inb(TRID_REG(card, ALI_SPDIF_CTRL + 1));
R2 = bval & 0x1F;
if (R2 != R1)
R1 = R2;
else
break;
}
if (count > 50000) {
printk(KERN_WARNING "trident: Error in "
"ali_detect_spdif_rate!\n");
return;
}
switch (R2) {
case 0x0b:
case 0x0c:
case 0x0d:
case 0x0e:
wval = inw(TRID_REG(card, ALI_SPDIF_CTRL + 2));
wval &= 0xE0F0;
wval |= (u16) 0x09 << 8 | (u16) 0x05;
outw(wval, TRID_REG(card, ALI_SPDIF_CTRL + 2));
bval = inb(TRID_REG(card, ALI_SPDIF_CS + 3)) & 0xF0;
outb(bval | 0x02, TRID_REG(card, ALI_SPDIF_CS + 3));
break;
case 0x12:
wval = inw(TRID_REG(card, ALI_SPDIF_CTRL + 2));
wval &= 0xE0F0;
wval |= (u16) 0x0E << 8 | (u16) 0x08;
outw(wval, TRID_REG(card, ALI_SPDIF_CTRL + 2));
bval = inb(TRID_REG(card, ALI_SPDIF_CS + 3)) & 0xF0;
outb(bval | 0x03, TRID_REG(card, ALI_SPDIF_CS + 3));
break;
default:
break;
}
}
static unsigned int
ali_get_spdif_in_rate(struct trident_card *card)
{
u32 dwRate = 0;
u8 bval = 0;
ali_detect_spdif_rate(card);
bval = inb(TRID_REG(card, ALI_SPDIF_CTRL));
bval &= 0x7F;
bval |= 0x40;
outb(bval, TRID_REG(card, ALI_SPDIF_CTRL));
bval = inb(TRID_REG(card, ALI_SPDIF_CS + 3));
bval &= 0x0F;
switch (bval) {
case 0:
dwRate = 44100;
break;
case 1:
dwRate = 48000;
break;
case 2:
dwRate = 32000;
break;
default:
// Error occurs
break;
}
return dwRate;
}
static int
ali_close_multi_channels(void)
{
char temp = 0;
struct pci_dev *pci_dev = NULL;
pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
pci_dev);
if (pci_dev == NULL)
return -1;
pci_read_config_byte(pci_dev, 0x59, &temp);
temp &= ~0x80;
pci_write_config_byte(pci_dev, 0x59, temp);
pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M7101,
pci_dev);
if (pci_dev == NULL)
return -1;
pci_read_config_byte(pci_dev, 0xB8, &temp);
temp &= ~0x20;
pci_write_config_byte(pci_dev, 0xB8, temp);
return 0;
}
static int
ali_setup_multi_channels(struct trident_card *card, int chan_nums)
{
unsigned long dwValue;
char temp = 0;
struct pci_dev *pci_dev = NULL;
pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
pci_dev);
if (pci_dev == NULL)
return -1;
pci_read_config_byte(pci_dev, 0x59, &temp);
temp |= 0x80;
pci_write_config_byte(pci_dev, 0x59, temp);
pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M7101,
pci_dev);
if (pci_dev == NULL)
return -1;
pci_read_config_byte(pci_dev, (int) 0xB8, &temp);
temp |= 0x20;
pci_write_config_byte(pci_dev, (int) 0xB8, (u8) temp);
if (chan_nums == 6) {
dwValue = inl(TRID_REG(card, ALI_SCTRL)) | 0x000f0000;
outl(dwValue, TRID_REG(card, ALI_SCTRL));
mdelay(4);
dwValue = inl(TRID_REG(card, ALI_SCTRL));
if (dwValue & 0x2000000) {
ali_ac97_write(card->ac97_codec[0], 0x02, 8080);
ali_ac97_write(card->ac97_codec[0], 0x36, 0);
ali_ac97_write(card->ac97_codec[0], 0x38, 0);
/*
* On a board with a single codec you won't get the
* surround. On other boards configure it.
*/
if (card->ac97_codec[1] != NULL) {
ali_ac97_write(card->ac97_codec[1], 0x36, 0);
ali_ac97_write(card->ac97_codec[1], 0x38, 0);
ali_ac97_write(card->ac97_codec[1], 0x02, 0x0606);
ali_ac97_write(card->ac97_codec[1], 0x18, 0x0303);
ali_ac97_write(card->ac97_codec[1], 0x74, 0x3);
}
return 1;
}
}
return -EINVAL;
}
static void
ali_free_pcm_channel(struct trident_card *card, unsigned int channel)
{
int bank;
if (channel > 31)
return;
bank = channel >> 5;
channel = channel & 0x1f;
card->banks[bank].bitmap &= ~(1 << (channel));
}
static int
ali_allocate_other_states_resources(struct trident_state *state, int chan_nums)
{
struct trident_card *card = state->card;
struct trident_state *s;
int i, state_count = 0;
struct trident_pcm_bank *bank;
struct trident_channel *channel;
unsigned long num;
bank = &card->banks[BANK_A];
if (chan_nums != 6)
return 0;
for (i = 0; (i < ALI_CHANNELS) && (state_count != 4); i++) {
if (card->states[i])
continue;
num = ali_multi_channels_5_1[state_count];
if (!(bank->bitmap & (1 << num))) {
bank->bitmap |= 1 << num;
channel = &bank->channels[num];
channel->num = num;
} else {
state_count--;
for (; state_count >= 0; state_count--) {
kfree(state->other_states[state_count]);
num = ali_multi_channels_5_1[state_count];
ali_free_pcm_channel(card, num);
}
return -EBUSY;
}
s = card->states[i] = kmalloc(sizeof(*state), GFP_KERNEL);
if (!s) {
num = ali_multi_channels_5_1[state_count];
ali_free_pcm_channel(card, num);
state_count--;
for (; state_count >= 0; state_count--) {
num = ali_multi_channels_5_1[state_count];
ali_free_pcm_channel(card, num);
kfree(state->other_states[state_count]);
}
return -ENOMEM;
}
memset(s, 0, sizeof(*state));
s->dmabuf.channel = channel;
s->dmabuf.ossfragshift = s->dmabuf.ossmaxfrags =
s->dmabuf.subdivision = 0;
init_waitqueue_head(&s->dmabuf.wait);
s->magic = card->magic;
s->card = card;
s->virt = i;
ali_enable_special_channel(s);
state->other_states[state_count++] = s;
}
if (state_count != 4) {
state_count--;
for (; state_count >= 0; state_count--) {
kfree(state->other_states[state_count]);
num = ali_multi_channels_5_1[state_count];
ali_free_pcm_channel(card, num);
}
return -EBUSY;
}
return 0;
}
static void
ali_save_regs(struct trident_card *card)
{
unsigned long flags;
int i, j;
spin_lock_irqsave(&card->lock, flags);
ali_registers.global_regs[0x2c] = inl(TRID_REG(card, T4D_MISCINT));
//ali_registers.global_regs[0x20] = inl(TRID_REG(card,T4D_START_A));
ali_registers.global_regs[0x21] = inl(TRID_REG(card, T4D_STOP_A));
//disable all IRQ bits
outl(ALI_DISABLE_ALL_IRQ, TRID_REG(card, T4D_MISCINT));
for (i = 1; i < ALI_MIXER_REGS; i++)
ali_registers.mixer_regs[i] = ali_ac97_read(card->ac97_codec[0],
i * 2);
for (i = 0; i < ALI_GLOBAL_REGS; i++) {
if ((i * 4 == T4D_MISCINT) || (i * 4 == T4D_STOP_A))
continue;
ali_registers.global_regs[i] = inl(TRID_REG(card, i * 4));
}
for (i = 0; i < ALI_CHANNELS; i++) {
outb(i, TRID_REG(card, T4D_LFO_GC_CIR));
for (j = 0; j < ALI_CHANNEL_REGS; j++)
ali_registers.channel_regs[i][j] = inl(TRID_REG(card,
j * 4 + 0xe0));
}
//Stop all HW channel
outl(ALI_STOP_ALL_CHANNELS, TRID_REG(card, T4D_STOP_A));
spin_unlock_irqrestore(&card->lock, flags);
}
static void
ali_restore_regs(struct trident_card *card)
{
unsigned long flags;
int i, j;
spin_lock_irqsave(&card->lock, flags);
for (i = 1; i < ALI_MIXER_REGS; i++)
ali_ac97_write(card->ac97_codec[0], i * 2,
ali_registers.mixer_regs[i]);
for (i = 0; i < ALI_CHANNELS; i++) {
outb(i, TRID_REG(card, T4D_LFO_GC_CIR));
for (j = 0; j < ALI_CHANNEL_REGS; j++)
outl(ali_registers.channel_regs[i][j],
TRID_REG(card, j * 4 + 0xe0));
}
for (i = 0; i < ALI_GLOBAL_REGS; i++) {
if ((i * 4 == T4D_MISCINT) || (i * 4 == T4D_STOP_A) ||
(i * 4 == T4D_START_A))
continue;
outl(ali_registers.global_regs[i], TRID_REG(card, i * 4));
}
//start HW channel
outl(ali_registers.global_regs[0x20], TRID_REG(card, T4D_START_A));
//restore IRQ enable bits
outl(ali_registers.global_regs[0x2c], TRID_REG(card, T4D_MISCINT));
spin_unlock_irqrestore(&card->lock, flags);
}
static int
trident_suspend(struct pci_dev *dev, pm_message_t unused)
{
struct trident_card *card = pci_get_drvdata(dev);
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
ali_save_regs(card);
}
return 0;
}
static int
trident_resume(struct pci_dev *dev)
{
struct trident_card *card = pci_get_drvdata(dev);
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
ali_restore_regs(card);
}
return 0;
}
static struct trident_channel *
ali_alloc_pcm_channel(struct trident_card *card)
{
struct trident_pcm_bank *bank;
int idx;
bank = &card->banks[BANK_A];
if (inl(TRID_REG(card, ALI_GLOBAL_CONTROL)) &
(ALI_SPDIF_OUT_CH_ENABLE)) {
idx = ALI_SPDIF_OUT_CHANNEL;
if (!(bank->bitmap & (1 << idx))) {
struct trident_channel *channel = &bank->channels[idx];
bank->bitmap |= 1 << idx;
channel->num = idx;
return channel;
}
}
for (idx = ALI_PCM_OUT_CHANNEL_FIRST; idx <= ALI_PCM_OUT_CHANNEL_LAST;
idx++) {
if (!(bank->bitmap & (1 << idx))) {
struct trident_channel *channel = &bank->channels[idx];
bank->bitmap |= 1 << idx;
channel->num = idx;
return channel;
}
}
/* no more free channels avaliable */
#if 0
printk(KERN_ERR "ali: no more channels available on Bank A.\n");
#endif /* 0 */
return NULL;
}
static struct trident_channel *
ali_alloc_rec_pcm_channel(struct trident_card *card)
{
struct trident_pcm_bank *bank;
int idx;
if (inl(TRID_REG(card, ALI_GLOBAL_CONTROL)) & ALI_SPDIF_IN_SUPPORT)
idx = ALI_SPDIF_IN_CHANNEL;
else
idx = ALI_PCM_IN_CHANNEL;
bank = &card->banks[BANK_A];
if (!(bank->bitmap & (1 << idx))) {
struct trident_channel *channel = &bank->channels[idx];
bank->bitmap |= 1 << idx;
channel->num = idx;
return channel;
}
/* no free recordable channels avaliable */
#if 0
printk(KERN_ERR "ali: no recordable channels available on Bank A.\n");
#endif /* 0 */
return NULL;
}
static void
ali_set_spdif_out_rate(struct trident_card *card, unsigned int rate)
{
unsigned char ch_st_sel;
unsigned short status_rate;
switch (rate) {
case 44100:
status_rate = 0;
break;
case 32000:
status_rate = 0x300;
break;
case 48000:
default:
status_rate = 0x200;
break;
}
/* select spdif_out */
ch_st_sel = inb(TRID_REG(card, ALI_SPDIF_CTRL)) & ALI_SPDIF_OUT_CH_STATUS;
ch_st_sel |= 0x80; /* select right */
outb(ch_st_sel, TRID_REG(card, ALI_SPDIF_CTRL));
outb(status_rate | 0x20, TRID_REG(card, ALI_SPDIF_CS + 2));
ch_st_sel &= (~0x80); /* select left */
outb(ch_st_sel, TRID_REG(card, ALI_SPDIF_CTRL));
outw(status_rate | 0x10, TRID_REG(card, ALI_SPDIF_CS + 2));
}
static void
ali_address_interrupt(struct trident_card *card)
{
int i, channel;
struct trident_state *state;
u32 mask, channel_mask;
mask = trident_get_interrupt_mask(card, 0);
for (i = 0; i < NR_HW_CH; i++) {
if ((state = card->states[i]) == NULL)
continue;
channel = state->dmabuf.channel->num;
if ((channel_mask = 1 << channel) & mask) {
mask &= ~channel_mask;
trident_ack_channel_interrupt(card, channel);
udelay(100);
state->dmabuf.update_flag |= ALI_ADDRESS_INT_UPDATE;
trident_update_ptr(state);
}
}
if (mask) {
for (i = 0; i < NR_HW_CH; i++) {
if (mask & (1 << i)) {
printk("ali: spurious channel irq %d.\n", i);
trident_ack_channel_interrupt(card, i);
trident_stop_voice(card, i);
trident_disable_voice_irq(card, i);
}
}
}
}
/* Updating the values of counters of other_states' DMAs without lock
protection is no harm because all DMAs of multi-channels and interrupt
depend on a master state's DMA, and changing the counters of the master
state DMA is protected by a spinlock.
*/
static int
ali_write_5_1(struct trident_state *state, const char __user *buf,
int cnt_for_multi_channel, unsigned int *copy_count,
unsigned int *state_cnt)
{
struct dmabuf *dmabuf = &state->dmabuf;
struct dmabuf *dmabuf_temp;
const char __user *buffer = buf;
unsigned swptr, other_dma_nums, sample_s;
unsigned int i, loop;
other_dma_nums = 4;
sample_s = sample_size[dmabuf->fmt] >> 1;
swptr = dmabuf->swptr;
if ((i = state->multi_channels_adjust_count) > 0) {
if (i == 1) {
if (copy_from_user(dmabuf->rawbuf + swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
i--;
(*state_cnt) += sample_s;
state->multi_channels_adjust_count++;
} else
i = i - (state->chans_num - other_dma_nums);
for (; (i < other_dma_nums) && (cnt_for_multi_channel > 0); i++) {
dmabuf_temp = &state->other_states[i]->dmabuf;
if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
}
if (cnt_for_multi_channel == 0)
state->multi_channels_adjust_count += i;
}
if (cnt_for_multi_channel > 0) {
loop = cnt_for_multi_channel / (state->chans_num * sample_s);
for (i = 0; i < loop; i++) {
if (copy_from_user(dmabuf->rawbuf + swptr, buffer,
sample_s * 2))
return -EFAULT;
seek_offset(swptr, buffer, cnt_for_multi_channel,
sample_s * 2, *copy_count);
(*state_cnt) += (sample_s * 2);
dmabuf_temp = &state->other_states[0]->dmabuf;
if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
dmabuf_temp = &state->other_states[1]->dmabuf;
if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
dmabuf_temp = &state->other_states[2]->dmabuf;
if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
dmabuf_temp = &state->other_states[3]->dmabuf;
if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
}
if (cnt_for_multi_channel > 0) {
state->multi_channels_adjust_count = cnt_for_multi_channel / sample_s;
if (copy_from_user(dmabuf->rawbuf + swptr, buffer, sample_s))
return -EFAULT;
seek_offset(swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
(*state_cnt) += sample_s;
if (cnt_for_multi_channel > 0) {
if (copy_from_user(dmabuf->rawbuf + swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(swptr, buffer, cnt_for_multi_channel,
sample_s, *copy_count);
(*state_cnt) += sample_s;
if (cnt_for_multi_channel > 0) {
int diff = state->chans_num - other_dma_nums;
loop = state->multi_channels_adjust_count - diff;
for (i = 0; i < loop; i++) {
dmabuf_temp = &state->other_states[i]->dmabuf;
if (copy_from_user(dmabuf_temp->rawbuf +
dmabuf_temp->swptr,
buffer, sample_s))
return -EFAULT;
seek_offset(dmabuf_temp->swptr, buffer,
cnt_for_multi_channel,
sample_s, *copy_count);
}
}
}
} else
state->multi_channels_adjust_count = 0;
}
for (i = 0; i < other_dma_nums; i++) {
dmabuf_temp = &state->other_states[i]->dmabuf;
dmabuf_temp->swptr = dmabuf_temp->swptr % dmabuf_temp->dmasize;
}
return *state_cnt;
}
static void
ali_free_other_states_resources(struct trident_state *state)
{
int i;
struct trident_card *card = state->card;
struct trident_state *s;
unsigned other_states_count;
other_states_count = state->chans_num - 2; /* except PCM L/R channels */
for (i = 0; i < other_states_count; i++) {
s = state->other_states[i];
dealloc_dmabuf(&s->dmabuf, card->pci_dev);
ali_disable_special_channel(s->card, s->dmabuf.channel->num);
state->card->free_pcm_channel(s->card, s->dmabuf.channel->num);
card->states[s->virt] = NULL;
kfree(s);
}
}
static struct proc_dir_entry *res;
static int
ali_write_proc(struct file *file, const char __user *buffer, unsigned long count, void *data)
{
struct trident_card *card = (struct trident_card *) data;
unsigned long flags;
char c;
if (count < 0)
return -EINVAL;
if (count == 0)
return 0;
if (get_user(c, buffer))
return -EFAULT;
spin_lock_irqsave(&card->lock, flags);
switch (c) {
case '0':
ali_setup_spdif_out(card, ALI_PCM_TO_SPDIF_OUT);
ali_disable_special_channel(card, ALI_SPDIF_OUT_CHANNEL);
break;
case '1':
ali_setup_spdif_out(card, ALI_SPDIF_OUT_TO_SPDIF_OUT |
ALI_SPDIF_OUT_PCM);
break;
case '2':
ali_setup_spdif_out(card, ALI_SPDIF_OUT_TO_SPDIF_OUT |
ALI_SPDIF_OUT_NON_PCM);
break;
case '3':
ali_disable_spdif_in(card); //default
break;
case '4':
ali_setup_spdif_in(card);
break;
}
spin_unlock_irqrestore(&card->lock, flags);
return count;
}
/* OSS /dev/mixer file operation methods */
static int
trident_open_mixdev(struct inode *inode, struct file *file)
{
int i = 0;
int minor = iminor(inode);
struct trident_card *card = devs;
for (card = devs; card != NULL; card = card->next)
for (i = 0; i < NR_AC97; i++)
if (card->ac97_codec[i] != NULL &&
card->ac97_codec[i]->dev_mixer == minor)
goto match;
if (!card) {
return -ENODEV;
}
match:
file->private_data = card->ac97_codec[i];
return nonseekable_open(inode, file);
}
static int
trident_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd,
unsigned long arg)
{
struct ac97_codec *codec = (struct ac97_codec *) file->private_data;
return codec->mixer_ioctl(codec, cmd, arg);
}
static /*const */ struct file_operations trident_mixer_fops = {
.owner = THIS_MODULE,
.llseek = no_llseek,
.ioctl = trident_ioctl_mixdev,
.open = trident_open_mixdev,
};
static int
ali_reset_5451(struct trident_card *card)
{
struct pci_dev *pci_dev = NULL;
unsigned int dwVal;
unsigned short wCount, wReg;
pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
pci_dev);
if (pci_dev == NULL)
return -1;
pci_read_config_dword(pci_dev, 0x7c, &dwVal);
pci_write_config_dword(pci_dev, 0x7c, dwVal | 0x08000000);
udelay(5000);
pci_read_config_dword(pci_dev, 0x7c, &dwVal);
pci_write_config_dword(pci_dev, 0x7c, dwVal & 0xf7ffffff);
udelay(5000);
pci_dev = card->pci_dev;
if (pci_dev == NULL)
return -1;
pci_read_config_dword(pci_dev, 0x44, &dwVal);
pci_write_config_dword(pci_dev, 0x44, dwVal | 0x000c0000);
udelay(500);
pci_read_config_dword(pci_dev, 0x44, &dwVal);
pci_write_config_dword(pci_dev, 0x44, dwVal & 0xfffbffff);
udelay(5000);
/* TODO: recognize if we have a PM capable codec and only do this */
/* if the codec is PM capable */
wCount = 2000;
while (wCount--) {
wReg = ali_ac97_get(card, 0, AC97_POWER_CONTROL);
if ((wReg & 0x000f) == 0x000f)
return 0;
udelay(5000);
}
/* This is non fatal if you have a non PM capable codec.. */
return 0;
}
/* AC97 codec initialisation. */
static int __devinit
trident_ac97_init(struct trident_card *card)
{
int num_ac97 = 0;
unsigned long ready_2nd = 0;
struct ac97_codec *codec;
int i = 0;
/* initialize controller side of AC link, and find out if secondary codes
really exist */
switch (card->pci_id) {
case PCI_DEVICE_ID_ALI_5451:
if (ali_reset_5451(card)) {
printk(KERN_ERR "trident_ac97_init: error "
"resetting 5451.\n");
return -1;
}
outl(0x80000001, TRID_REG(card, ALI_GLOBAL_CONTROL));
outl(0x00000000, TRID_REG(card, T4D_AINTEN_A));
outl(0xffffffff, TRID_REG(card, T4D_AINT_A));
outl(0x00000000, TRID_REG(card, T4D_MUSICVOL_WAVEVOL));
outb(0x10, TRID_REG(card, ALI_MPUR2));
ready_2nd = inl(TRID_REG(card, ALI_SCTRL));
ready_2nd &= 0x3fff;
outl(ready_2nd | PCMOUT | 0x8000, TRID_REG(card, ALI_SCTRL));
ready_2nd = inl(TRID_REG(card, ALI_SCTRL));
ready_2nd &= SI_AC97_SECONDARY_READY;
if (card->revision < ALI_5451_V02)
ready_2nd = 0;
break;
case PCI_DEVICE_ID_SI_7018:
/* disable AC97 GPIO interrupt */
outl(0x00, TRID_REG(card, SI_AC97_GPIO));
/* when power up the AC link is in cold reset mode so stop it */
outl(PCMOUT | SURROUT | CENTEROUT | LFEOUT | SECONDARY_ID,
TRID_REG(card, SI_SERIAL_INTF_CTRL));
/* it take a long time to recover from a cold reset */
/* (especially when you have more than one codec) */
udelay(2000);
ready_2nd = inl(TRID_REG(card, SI_SERIAL_INTF_CTRL));
ready_2nd &= SI_AC97_SECONDARY_READY;
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
/* playback on */
outl(DX_AC97_PLAYBACK, TRID_REG(card, DX_ACR2_AC97_COM_STAT));
break;
case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
/* enable AC97 Output Slot 3,4 (PCM Left/Right Playback) */
outl(NX_AC97_PCM_OUTPUT, TRID_REG(card, NX_ACR0_AC97_COM_STAT));
ready_2nd = inl(TRID_REG(card, NX_ACR0_AC97_COM_STAT));
ready_2nd &= NX_AC97_SECONDARY_READY;
break;
case PCI_DEVICE_ID_INTERG_5050:
/* disable AC97 GPIO interrupt */
outl(0x00, TRID_REG(card, SI_AC97_GPIO));
/* when power up, the AC link is in cold reset mode, so stop it */
outl(PCMOUT | SURROUT | CENTEROUT | LFEOUT,
TRID_REG(card, SI_SERIAL_INTF_CTRL));
/* it take a long time to recover from a cold reset (especially */
/* when you have more than one codec) */
udelay(2000);
ready_2nd = inl(TRID_REG(card, SI_SERIAL_INTF_CTRL));
ready_2nd &= SI_AC97_SECONDARY_READY;
break;
}
for (num_ac97 = 0; num_ac97 < NR_AC97; num_ac97++) {
if ((codec = ac97_alloc_codec()) == NULL)
return -ENOMEM;
/* initialize some basic codec information, other fields */
/* will be filled in ac97_probe_codec */
codec->private_data = card;
codec->id = num_ac97;
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
codec->codec_read = ali_ac97_read;
codec->codec_write = ali_ac97_write;
} else {
codec->codec_read = trident_ac97_get;
codec->codec_write = trident_ac97_set;
}
if (ac97_probe_codec(codec) == 0)
break;
codec->dev_mixer = register_sound_mixer(&trident_mixer_fops, -1);
if (codec->dev_mixer < 0) {
printk(KERN_ERR "trident: couldn't register mixer!\n");
ac97_release_codec(codec);
break;
}
card->ac97_codec[num_ac97] = codec;
/* if there is no secondary codec at all, don't probe any more */
if (!ready_2nd)
break;
}
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
for (num_ac97 = 0; num_ac97 < NR_AC97; num_ac97++) {
if (card->ac97_codec[num_ac97] == NULL)
break;
for (i = 0; i < 64; i++) {
u16 reg = ali_ac97_get(card, num_ac97, i * 2);
card->mixer_regs[i][num_ac97] = reg;
}
}
}
return num_ac97 + 1;
}
#ifdef SUPPORT_JOYSTICK
/* Gameport functions for the cards ADC gameport */
static unsigned char trident_game_read(struct gameport *gameport)
{
struct trident_card *card = gameport->port_data;
return inb(TRID_REG(card, T4D_GAME_LEG));
}
static void trident_game_trigger(struct gameport *gameport)
{
struct trident_card *card = gameport->port_data;
outb(0xff, TRID_REG(card, T4D_GAME_LEG));
}
static int trident_game_cooked_read(struct gameport *gameport,
int *axes, int *buttons)
{
struct trident_card *card = gameport->port_data;
int i;
*buttons = (~inb(TRID_REG(card, T4D_GAME_LEG)) >> 4) & 0xf;
for (i = 0; i < 4; i++) {
axes[i] = inw(TRID_REG(card, T4D_GAME_AXD) + i * sizeof (u16));
if (axes[i] == 0xffff)
axes[i] = -1;
}
return 0;
}
static int trident_game_open(struct gameport *gameport, int mode)
{
struct trident_card *card = gameport->port_data;
switch (mode) {
case GAMEPORT_MODE_COOKED:
outb(0x80, TRID_REG(card, T4D_GAME_CR));
msleep(20);
return 0;
case GAMEPORT_MODE_RAW:
outb(0x00, TRID_REG(card, T4D_GAME_CR));
return 0;
default:
return -1;
}
return 0;
}
static int __devinit trident_register_gameport(struct trident_card *card)
{
struct gameport *gp;
card->gameport = gp = gameport_allocate_port();
if (!gp) {
printk(KERN_ERR "trident: can not allocate memory for gameport\n");
return -ENOMEM;
}
gameport_set_name(gp, "Trident 4DWave");
gameport_set_phys(gp, "pci%s/gameport0", pci_name(card->pci_dev));
gp->read = trident_game_read;
gp->trigger = trident_game_trigger;
gp->cooked_read = trident_game_cooked_read;
gp->open = trident_game_open;
gp->fuzz = 64;
gp->port_data = card;
gameport_register_port(gp);
return 0;
}
static inline void trident_unregister_gameport(struct trident_card *card)
{
if (card->gameport)
gameport_unregister_port(card->gameport);
}
#else
static inline int trident_register_gameport(struct trident_card *card) { return -ENOSYS; }
static inline void trident_unregister_gameport(struct trident_card *card) { }
#endif /* SUPPORT_JOYSTICK */
/* install the driver, we do not allocate hardware channel nor DMA buffer */
/* now, they are defered until "ACCESS" time (in prog_dmabuf called by */
/* open/read/write/ioctl/mmap) */
static int __devinit
trident_probe(struct pci_dev *pci_dev, const struct pci_device_id *pci_id)
{
unsigned long iobase;
struct trident_card *card;
u8 bits;
u8 revision;
int i = 0;
u16 temp;
struct pci_dev *pci_dev_m1533 = NULL;
int rc = -ENODEV;
u64 dma_mask;
if (pci_enable_device(pci_dev))
goto out;
if (pci_dev->device == PCI_DEVICE_ID_ALI_5451)
dma_mask = ALI_DMA_MASK;
else
dma_mask = TRIDENT_DMA_MASK;
if (pci_set_dma_mask(pci_dev, dma_mask)) {
printk(KERN_ERR "trident: architecture does not support"
" %s PCI busmaster DMA\n",
pci_dev->device == PCI_DEVICE_ID_ALI_5451 ?
"32-bit" : "30-bit");
goto out;
}
pci_read_config_byte(pci_dev, PCI_CLASS_REVISION, &revision);
if (pci_id->device == PCI_DEVICE_ID_INTERG_5050)
iobase = pci_resource_start(pci_dev, 1);
else
iobase = pci_resource_start(pci_dev, 0);
if (!request_region(iobase, 256, card_names[pci_id->driver_data])) {
printk(KERN_ERR "trident: can't allocate I/O space at "
"0x%4.4lx\n", iobase);
goto out;
}
rc = -ENOMEM;
if ((card = kmalloc(sizeof(*card), GFP_KERNEL)) == NULL) {
printk(KERN_ERR "trident: out of memory\n");
goto out_release_region;
}
memset(card, 0, sizeof (*card));
init_timer(&card->timer);
card->iobase = iobase;
card->pci_dev = pci_dev;
card->pci_id = pci_id->device;
card->revision = revision;
card->irq = pci_dev->irq;
card->next = devs;
card->magic = TRIDENT_CARD_MAGIC;
card->banks[BANK_A].addresses = &bank_a_addrs;
card->banks[BANK_A].bitmap = 0UL;
card->banks[BANK_B].addresses = &bank_b_addrs;
card->banks[BANK_B].bitmap = 0UL;
mutex_init(&card->open_mutex);
spin_lock_init(&card->lock);
init_timer(&card->timer);
devs = card;
pci_set_master(pci_dev);
printk(KERN_INFO "trident: %s found at IO 0x%04lx, IRQ %d\n",
card_names[pci_id->driver_data], card->iobase, card->irq);
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
/* ALi channel Management */
card->alloc_pcm_channel = ali_alloc_pcm_channel;
card->alloc_rec_pcm_channel = ali_alloc_rec_pcm_channel;
card->free_pcm_channel = ali_free_pcm_channel;
card->address_interrupt = ali_address_interrupt;
/* Added by Matt Wu 01-05-2001 for spdif in */
card->multi_channel_use_count = 0;
card->rec_channel_use_count = 0;
/* ALi SPDIF OUT function */
if (card->revision == ALI_5451_V02) {
ali_setup_spdif_out(card, ALI_PCM_TO_SPDIF_OUT);
res = create_proc_entry("ALi5451", 0, NULL);
if (res) {
res->write_proc = ali_write_proc;
res->data = card;
}
}
/* Add H/W Volume Control By Matt Wu Jul. 06, 2001 */
card->hwvolctl = 0;
pci_dev_m1533 = pci_find_device(PCI_VENDOR_ID_AL,
PCI_DEVICE_ID_AL_M1533,
pci_dev_m1533);
rc = -ENODEV;
if (pci_dev_m1533 == NULL)
goto out_proc_fs;
pci_read_config_byte(pci_dev_m1533, 0x63, &bits);
if (bits & (1 << 5))
card->hwvolctl = 1;
if (card->hwvolctl) {
/* Clear m1533 pci cfg 78h bit 30 to zero, which makes
GPIO11/12/13 work as ACGP_UP/DOWN/MUTE. */
pci_read_config_byte(pci_dev_m1533, 0x7b, &bits);
bits &= 0xbf; /*clear bit 6 */
pci_write_config_byte(pci_dev_m1533, 0x7b, bits);
}
} else if (card->pci_id == PCI_DEVICE_ID_INTERG_5050) {
card->alloc_pcm_channel = cyber_alloc_pcm_channel;
card->alloc_rec_pcm_channel = cyber_alloc_pcm_channel;
card->free_pcm_channel = cyber_free_pcm_channel;
card->address_interrupt = cyber_address_interrupt;
cyber_init_ritual(card);
} else {
card->alloc_pcm_channel = trident_alloc_pcm_channel;
card->alloc_rec_pcm_channel = trident_alloc_pcm_channel;
card->free_pcm_channel = trident_free_pcm_channel;
card->address_interrupt = trident_address_interrupt;
}
/* claim our irq */
rc = -ENODEV;
if (request_irq(card->irq, &trident_interrupt, SA_SHIRQ,
card_names[pci_id->driver_data], card)) {
printk(KERN_ERR "trident: unable to allocate irq %d\n",
card->irq);
goto out_proc_fs;
}
/* register /dev/dsp */
if ((card->dev_audio = register_sound_dsp(&trident_audio_fops, -1)) < 0) {
printk(KERN_ERR "trident: couldn't register DSP device!\n");
goto out_free_irq;
}
card->mixer_regs_ready = 0;
/* initialize AC97 codec and register /dev/mixer */
if (trident_ac97_init(card) <= 0) {
/* unregister audio devices */
for (i = 0; i < NR_AC97; i++) {
if (card->ac97_codec[i] != NULL) {
struct ac97_codec* codec = card->ac97_codec[i];
unregister_sound_mixer(codec->dev_mixer);
ac97_release_codec(codec);
}
}
goto out_unregister_sound_dsp;
}
card->mixer_regs_ready = 1;
outl(0x00, TRID_REG(card, T4D_MUSICVOL_WAVEVOL));
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
/* Add H/W Volume Control By Matt Wu Jul. 06, 2001 */
if (card->hwvolctl) {
/* Enable GPIO IRQ (MISCINT bit 18h) */
temp = inw(TRID_REG(card, T4D_MISCINT + 2));
temp |= 0x0004;
outw(temp, TRID_REG(card, T4D_MISCINT + 2));
/* Enable H/W Volume Control GLOVAL CONTROL bit 0 */
temp = inw(TRID_REG(card, ALI_GLOBAL_CONTROL));
temp |= 0x0001;
outw(temp, TRID_REG(card, ALI_GLOBAL_CONTROL));
}
if (card->revision == ALI_5451_V02)
ali_close_multi_channels();
/* edited by HMSEO for GT sound */
#if defined(CONFIG_ALPHA_NAUTILUS) || defined(CONFIG_ALPHA_GENERIC)
{
u16 ac97_data;
extern struct hwrpb_struct *hwrpb;
if ((hwrpb->sys_type) == 201) {
printk(KERN_INFO "trident: Running on Alpha system "
"type Nautilus\n");
ac97_data = ali_ac97_get(card, 0, AC97_POWER_CONTROL);
ali_ac97_set(card, 0, AC97_POWER_CONTROL,
ac97_data | ALI_EAPD_POWER_DOWN);
}
}
#endif /* CONFIG_ALPHA_NAUTILUS || CONFIG_ALPHA_GENERIC */
/* edited by HMSEO for GT sound */
}
rc = 0;
pci_set_drvdata(pci_dev, card);
/* Enable Address Engine Interrupts */
trident_enable_loop_interrupts(card);
/* Register gameport */
trident_register_gameport(card);
out:
return rc;
out_unregister_sound_dsp:
unregister_sound_dsp(card->dev_audio);
out_free_irq:
free_irq(card->irq, card);
out_proc_fs:
if (res) {
remove_proc_entry("ALi5451", NULL);
res = NULL;
}
kfree(card);
devs = NULL;
out_release_region:
release_region(iobase, 256);
return rc;
}
static void __devexit
trident_remove(struct pci_dev *pci_dev)
{
int i;
struct trident_card *card = pci_get_drvdata(pci_dev);
/*
* Kill running timers before unload. We can't have them
* going off after rmmod!
*/
if (card->hwvolctl)
del_timer_sync(&card->timer);
/* ALi S/PDIF and Power Management */
if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
ali_setup_spdif_out(card, ALI_PCM_TO_SPDIF_OUT);
ali_disable_special_channel(card, ALI_SPDIF_OUT_CHANNEL);
ali_disable_spdif_in(card);
remove_proc_entry("ALi5451", NULL);
}
/* Unregister gameport */
trident_unregister_gameport(card);
/* Kill interrupts, and SP/DIF */
trident_disable_loop_interrupts(card);
/* free hardware resources */
free_irq(card->irq, card);
release_region(card->iobase, 256);
/* unregister audio devices */
for (i = 0; i < NR_AC97; i++)
if (card->ac97_codec[i] != NULL) {
unregister_sound_mixer(card->ac97_codec[i]->dev_mixer);
ac97_release_codec(card->ac97_codec[i]);
}
unregister_sound_dsp(card->dev_audio);
kfree(card);
pci_set_drvdata(pci_dev, NULL);
}
MODULE_AUTHOR("Alan Cox, Aaron Holtzman, Ollie Lho, Ching Ling Lee, Muli Ben-Yehuda");
MODULE_DESCRIPTION("Trident 4DWave/SiS 7018/ALi 5451 and Tvia/IGST CyberPro5050 PCI "
"Audio Driver");
MODULE_LICENSE("GPL");
#define TRIDENT_MODULE_NAME "trident"
static struct pci_driver trident_pci_driver = {
.name = TRIDENT_MODULE_NAME,
.id_table = trident_pci_tbl,
.probe = trident_probe,
.remove = __devexit_p(trident_remove),
.suspend = trident_suspend,
.resume = trident_resume
};
static int __init
trident_init_module(void)
{
printk(KERN_INFO "Trident 4DWave/SiS 7018/ALi 5451,Tvia CyberPro "
"5050 PCI Audio, version " DRIVER_VERSION ", " __TIME__ " "
__DATE__ "\n");
return pci_register_driver(&trident_pci_driver);
}
static void __exit
trident_cleanup_module(void)
{
pci_unregister_driver(&trident_pci_driver);
}
module_init(trident_init_module);
module_exit(trident_cleanup_module);
Ссылка в новой задаче Показать git blame Копировать постоянную ссылку