| /* |
| * Support for VIA 82Cxxx Audio Codecs |
| * Copyright 1999,2000 Jeff Garzik |
| * |
| * Updated to support the VIA 8233/8235 audio subsystem |
| * Alan Cox <alan@redhat.com> (C) Copyright 2002, 2003 Red Hat Inc |
| * |
| * Distributed under the GNU GENERAL PUBLIC LICENSE (GPL) Version 2. |
| * See the "COPYING" file distributed with this software for more info. |
| * NO WARRANTY |
| * |
| * For a list of known bugs (errata) and documentation, |
| * see via-audio.pdf in Documentation/DocBook. |
| * If this documentation does not exist, run "make pdfdocs". |
| */ |
| |
| |
| #define VIA_VERSION "1.9.1-ac4-2.5" |
| |
| |
| #include <linux/config.h> |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/fs.h> |
| #include <linux/mm.h> |
| #include <linux/pci.h> |
| #include <linux/poison.h> |
| #include <linux/init.h> |
| #include <linux/interrupt.h> |
| #include <linux/proc_fs.h> |
| #include <linux/spinlock.h> |
| #include <linux/sound.h> |
| #include <linux/poll.h> |
| #include <linux/soundcard.h> |
| #include <linux/ac97_codec.h> |
| #include <linux/smp_lock.h> |
| #include <linux/ioport.h> |
| #include <linux/delay.h> |
| #include <linux/dma-mapping.h> |
| #include <asm/io.h> |
| #include <asm/uaccess.h> |
| #include <linux/mutex.h> |
| |
| #include "sound_config.h" |
| #include "dev_table.h" |
| #include "mpu401.h" |
| |
| |
| #undef VIA_DEBUG /* define to enable debugging output and checks */ |
| #ifdef VIA_DEBUG |
| /* note: prints function name for you */ |
| #define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args) |
| #else |
| #define DPRINTK(fmt, args...) |
| #endif |
| |
| #undef VIA_NDEBUG /* define to disable lightweight runtime checks */ |
| #ifdef VIA_NDEBUG |
| #define assert(expr) |
| #else |
| #define assert(expr) \ |
| if(!(expr)) { \ |
| printk( "Assertion failed! %s,%s,%s,line=%d\n", \ |
| #expr,__FILE__,__FUNCTION__,__LINE__); \ |
| } |
| #endif |
| |
| #define VIA_SUPPORT_MMAP 1 /* buggy, for now... */ |
| |
| #define MAX_CARDS 1 |
| |
| #define VIA_CARD_NAME "VIA 82Cxxx Audio driver " VIA_VERSION |
| #define VIA_MODULE_NAME "via82cxxx" |
| #define PFX VIA_MODULE_NAME ": " |
| |
| #define VIA_COUNTER_LIMIT 100000 |
| |
| /* size of DMA buffers */ |
| #define VIA_MAX_BUFFER_DMA_PAGES 32 |
| |
| /* buffering default values in ms */ |
| #define VIA_DEFAULT_FRAG_TIME 20 |
| #define VIA_DEFAULT_BUFFER_TIME 500 |
| |
| /* the hardware has a 256 fragment limit */ |
| #define VIA_MIN_FRAG_NUMBER 2 |
| #define VIA_MAX_FRAG_NUMBER 128 |
| |
| #define VIA_MAX_FRAG_SIZE PAGE_SIZE |
| #define VIA_MIN_FRAG_SIZE (VIA_MAX_BUFFER_DMA_PAGES * PAGE_SIZE / VIA_MAX_FRAG_NUMBER) |
| |
| |
| /* 82C686 function 5 (audio codec) PCI configuration registers */ |
| #define VIA_ACLINK_STATUS 0x40 |
| #define VIA_ACLINK_CTRL 0x41 |
| #define VIA_FUNC_ENABLE 0x42 |
| #define VIA_PNP_CONTROL 0x43 |
| #define VIA_FM_NMI_CTRL 0x48 |
| |
| /* |
| * controller base 0 (scatter-gather) registers |
| * |
| * NOTE: Via datasheet lists first channel as "read" |
| * channel and second channel as "write" channel. |
| * I changed the naming of the constants to be more |
| * clear than I felt the datasheet to be. |
| */ |
| |
| #define VIA_BASE0_PCM_OUT_CHAN 0x00 /* output PCM to user */ |
| #define VIA_BASE0_PCM_OUT_CHAN_STATUS 0x00 |
| #define VIA_BASE0_PCM_OUT_CHAN_CTRL 0x01 |
| #define VIA_BASE0_PCM_OUT_CHAN_TYPE 0x02 |
| |
| #define VIA_BASE0_PCM_IN_CHAN 0x10 /* input PCM from user */ |
| #define VIA_BASE0_PCM_IN_CHAN_STATUS 0x10 |
| #define VIA_BASE0_PCM_IN_CHAN_CTRL 0x11 |
| #define VIA_BASE0_PCM_IN_CHAN_TYPE 0x12 |
| |
| /* offsets from base */ |
| #define VIA_PCM_STATUS 0x00 |
| #define VIA_PCM_CONTROL 0x01 |
| #define VIA_PCM_TYPE 0x02 |
| #define VIA_PCM_LEFTVOL 0x02 |
| #define VIA_PCM_RIGHTVOL 0x03 |
| #define VIA_PCM_TABLE_ADDR 0x04 |
| #define VIA_PCM_STOPRATE 0x08 /* 8233+ */ |
| #define VIA_PCM_BLOCK_COUNT 0x0C |
| |
| /* XXX unused DMA channel for FM PCM data */ |
| #define VIA_BASE0_FM_OUT_CHAN 0x20 |
| #define VIA_BASE0_FM_OUT_CHAN_STATUS 0x20 |
| #define VIA_BASE0_FM_OUT_CHAN_CTRL 0x21 |
| #define VIA_BASE0_FM_OUT_CHAN_TYPE 0x22 |
| |
| /* Six channel audio output on 8233 */ |
| #define VIA_BASE0_MULTI_OUT_CHAN 0x40 |
| #define VIA_BASE0_MULTI_OUT_CHAN_STATUS 0x40 |
| #define VIA_BASE0_MULTI_OUT_CHAN_CTRL 0x41 |
| #define VIA_BASE0_MULTI_OUT_CHAN_TYPE 0x42 |
| |
| #define VIA_BASE0_AC97_CTRL 0x80 |
| #define VIA_BASE0_SGD_STATUS_SHADOW 0x84 |
| #define VIA_BASE0_GPI_INT_ENABLE 0x8C |
| #define VIA_INTR_OUT ((1<<0) | (1<<4) | (1<<8)) |
| #define VIA_INTR_IN ((1<<1) | (1<<5) | (1<<9)) |
| #define VIA_INTR_FM ((1<<2) | (1<<6) | (1<<10)) |
| #define VIA_INTR_MASK (VIA_INTR_OUT | VIA_INTR_IN | VIA_INTR_FM) |
| |
| /* Newer VIA we need to monitor the low 3 bits of each channel. This |
| mask covers the channels we don't yet use as well |
| */ |
| |
| #define VIA_NEW_INTR_MASK 0x77077777UL |
| |
| /* VIA_BASE0_AUDIO_xxx_CHAN_TYPE bits */ |
| #define VIA_IRQ_ON_FLAG (1<<0) /* int on each flagged scatter block */ |
| #define VIA_IRQ_ON_EOL (1<<1) /* int at end of scatter list */ |
| #define VIA_INT_SEL_PCI_LAST_LINE_READ (0) /* int at PCI read of last line */ |
| #define VIA_INT_SEL_LAST_SAMPLE_SENT (1<<2) /* int at last sample sent */ |
| #define VIA_INT_SEL_ONE_LINE_LEFT (1<<3) /* int at less than one line to send */ |
| #define VIA_PCM_FMT_STEREO (1<<4) /* PCM stereo format (bit clear == mono) */ |
| #define VIA_PCM_FMT_16BIT (1<<5) /* PCM 16-bit format (bit clear == 8-bit) */ |
| #define VIA_PCM_REC_FIFO (1<<6) /* PCM Recording FIFO */ |
| #define VIA_RESTART_SGD_ON_EOL (1<<7) /* restart scatter-gather at EOL */ |
| #define VIA_PCM_FMT_MASK (VIA_PCM_FMT_STEREO|VIA_PCM_FMT_16BIT) |
| #define VIA_CHAN_TYPE_MASK (VIA_RESTART_SGD_ON_EOL | \ |
| VIA_IRQ_ON_FLAG | \ |
| VIA_IRQ_ON_EOL) |
| #define VIA_CHAN_TYPE_INT_SELECT (VIA_INT_SEL_LAST_SAMPLE_SENT) |
| |
| /* PCI configuration register bits and masks */ |
| #define VIA_CR40_AC97_READY 0x01 |
| #define VIA_CR40_AC97_LOW_POWER 0x02 |
| #define VIA_CR40_SECONDARY_READY 0x04 |
| |
| #define VIA_CR41_AC97_ENABLE 0x80 /* enable AC97 codec */ |
| #define VIA_CR41_AC97_RESET 0x40 /* clear bit to reset AC97 */ |
| #define VIA_CR41_AC97_WAKEUP 0x20 /* wake up from power-down mode */ |
| #define VIA_CR41_AC97_SDO 0x10 /* force Serial Data Out (SDO) high */ |
| #define VIA_CR41_VRA 0x08 /* enable variable sample rate */ |
| #define VIA_CR41_PCM_ENABLE 0x04 /* AC Link SGD Read Channel PCM Data Output */ |
| #define VIA_CR41_FM_PCM_ENABLE 0x02 /* AC Link FM Channel PCM Data Out */ |
| #define VIA_CR41_SB_PCM_ENABLE 0x01 /* AC Link SB PCM Data Output */ |
| #define VIA_CR41_BOOT_MASK (VIA_CR41_AC97_ENABLE | \ |
| VIA_CR41_AC97_WAKEUP | \ |
| VIA_CR41_AC97_SDO) |
| #define VIA_CR41_RUN_MASK (VIA_CR41_AC97_ENABLE | \ |
| VIA_CR41_AC97_RESET | \ |
| VIA_CR41_VRA | \ |
| VIA_CR41_PCM_ENABLE) |
| |
| #define VIA_CR42_SB_ENABLE 0x01 |
| #define VIA_CR42_MIDI_ENABLE 0x02 |
| #define VIA_CR42_FM_ENABLE 0x04 |
| #define VIA_CR42_GAME_ENABLE 0x08 |
| #define VIA_CR42_MIDI_IRQMASK 0x40 |
| #define VIA_CR42_MIDI_PNP 0x80 |
| |
| #define VIA_CR44_SECOND_CODEC_SUPPORT (1 << 6) |
| #define VIA_CR44_AC_LINK_ACCESS (1 << 7) |
| |
| #define VIA_CR48_FM_TRAP_TO_NMI (1 << 2) |
| |
| /* controller base 0 register bitmasks */ |
| #define VIA_INT_DISABLE_MASK (~(0x01|0x02)) |
| #define VIA_SGD_STOPPED (1 << 2) |
| #define VIA_SGD_PAUSED (1 << 6) |
| #define VIA_SGD_ACTIVE (1 << 7) |
| #define VIA_SGD_TERMINATE (1 << 6) |
| #define VIA_SGD_FLAG (1 << 0) |
| #define VIA_SGD_EOL (1 << 1) |
| #define VIA_SGD_START (1 << 7) |
| |
| #define VIA_CR80_FIRST_CODEC 0 |
| #define VIA_CR80_SECOND_CODEC (1 << 30) |
| #define VIA_CR80_FIRST_CODEC_VALID (1 << 25) |
| #define VIA_CR80_VALID (1 << 25) |
| #define VIA_CR80_SECOND_CODEC_VALID (1 << 27) |
| #define VIA_CR80_BUSY (1 << 24) |
| #define VIA_CR83_BUSY (1) |
| #define VIA_CR83_FIRST_CODEC_VALID (1 << 1) |
| #define VIA_CR80_READ (1 << 23) |
| #define VIA_CR80_WRITE_MODE 0 |
| #define VIA_CR80_REG_IDX(idx) ((((idx) & 0xFF) >> 1) << 16) |
| |
| /* capabilities we announce */ |
| #ifdef VIA_SUPPORT_MMAP |
| #define VIA_DSP_CAP (DSP_CAP_REVISION | DSP_CAP_DUPLEX | DSP_CAP_MMAP | \ |
| DSP_CAP_TRIGGER | DSP_CAP_REALTIME) |
| #else |
| #define VIA_DSP_CAP (DSP_CAP_REVISION | DSP_CAP_DUPLEX | \ |
| DSP_CAP_TRIGGER | DSP_CAP_REALTIME) |
| #endif |
| |
| /* scatter-gather DMA table entry, exactly as passed to hardware */ |
| struct via_sgd_table { |
| u32 addr; |
| u32 count; /* includes additional VIA_xxx bits also */ |
| }; |
| |
| #define VIA_EOL (1 << 31) |
| #define VIA_FLAG (1 << 30) |
| #define VIA_STOP (1 << 29) |
| |
| |
| enum via_channel_states { |
| sgd_stopped = 0, |
| sgd_in_progress = 1, |
| }; |
| |
| |
| struct via_buffer_pgtbl { |
| dma_addr_t handle; |
| void *cpuaddr; |
| }; |
| |
| |
| struct via_channel { |
| atomic_t n_frags; |
| atomic_t hw_ptr; |
| wait_queue_head_t wait; |
| |
| unsigned int sw_ptr; |
| unsigned int slop_len; |
| unsigned int n_irqs; |
| int bytes; |
| |
| unsigned is_active : 1; |
| unsigned is_record : 1; |
| unsigned is_mapped : 1; |
| unsigned is_enabled : 1; |
| unsigned is_multi: 1; /* 8233 6 channel */ |
| u8 pcm_fmt; /* VIA_PCM_FMT_xxx */ |
| u8 channels; /* Channel count */ |
| |
| unsigned rate; /* sample rate */ |
| unsigned int frag_size; |
| unsigned int frag_number; |
| |
| unsigned char intmask; |
| |
| volatile struct via_sgd_table *sgtable; |
| dma_addr_t sgt_handle; |
| |
| unsigned int page_number; |
| struct via_buffer_pgtbl pgtbl[VIA_MAX_BUFFER_DMA_PAGES]; |
| |
| long iobase; |
| |
| const char *name; |
| }; |
| |
| |
| /* data stored for each chip */ |
| struct via_info { |
| struct pci_dev *pdev; |
| long baseaddr; |
| |
| struct ac97_codec *ac97; |
| spinlock_t ac97_lock; |
| spinlock_t lock; |
| int card_num; /* unique card number, from 0 */ |
| |
| int dev_dsp; /* /dev/dsp index from register_sound_dsp() */ |
| |
| unsigned rev_h : 1; |
| unsigned legacy: 1; /* Has legacy ports */ |
| unsigned intmask: 1; /* Needs int bits */ |
| unsigned sixchannel: 1; /* 8233/35 with 6 channel support */ |
| unsigned volume: 1; |
| |
| unsigned locked_rate : 1; |
| |
| int mixer_vol; /* 8233/35 volume - not yet implemented */ |
| |
| struct mutex syscall_mutex; |
| struct mutex open_mutex; |
| |
| /* The 8233/8235 have 4 DX audio channels, two record and |
| one six channel out. We bind ch_in to DX 1, ch_out to multichannel |
| and ch_fm to DX 2. DX 3 and REC0/REC1 are unused at the |
| moment */ |
| |
| struct via_channel ch_in; |
| struct via_channel ch_out; |
| struct via_channel ch_fm; |
| |
| #ifdef CONFIG_MIDI_VIA82CXXX |
| void *midi_devc; |
| struct address_info midi_info; |
| #endif |
| }; |
| |
| |
| /* number of cards, used for assigning unique numbers to cards */ |
| static unsigned via_num_cards; |
| |
| |
| |
| /**************************************************************** |
| * |
| * prototypes |
| * |
| * |
| */ |
| |
| static int via_init_one (struct pci_dev *dev, const struct pci_device_id *id); |
| static void __devexit via_remove_one (struct pci_dev *pdev); |
| |
| static ssize_t via_dsp_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos); |
| static ssize_t via_dsp_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos); |
| static unsigned int via_dsp_poll(struct file *file, struct poll_table_struct *wait); |
| static int via_dsp_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg); |
| static int via_dsp_open (struct inode *inode, struct file *file); |
| static int via_dsp_release(struct inode *inode, struct file *file); |
| static int via_dsp_mmap(struct file *file, struct vm_area_struct *vma); |
| |
| static u16 via_ac97_read_reg (struct ac97_codec *codec, u8 reg); |
| static void via_ac97_write_reg (struct ac97_codec *codec, u8 reg, u16 value); |
| static u8 via_ac97_wait_idle (struct via_info *card); |
| |
| static void via_chan_free (struct via_info *card, struct via_channel *chan); |
| static void via_chan_clear (struct via_info *card, struct via_channel *chan); |
| static void via_chan_pcm_fmt (struct via_channel *chan, int reset); |
| static void via_chan_buffer_free (struct via_info *card, struct via_channel *chan); |
| |
| |
| /**************************************************************** |
| * |
| * Various data the driver needs |
| * |
| * |
| */ |
| |
| |
| static struct pci_device_id via_pci_tbl[] = { |
| { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686_5, |
| PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, |
| { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8233_5, |
| PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1}, |
| { 0, } |
| }; |
| MODULE_DEVICE_TABLE(pci,via_pci_tbl); |
| |
| |
| static struct pci_driver via_driver = { |
| .name = VIA_MODULE_NAME, |
| .id_table = via_pci_tbl, |
| .probe = via_init_one, |
| .remove = __devexit_p(via_remove_one), |
| }; |
| |
| |
| /**************************************************************** |
| * |
| * Low-level base 0 register read/write helpers |
| * |
| * |
| */ |
| |
| /** |
| * via_chan_stop - Terminate DMA on specified PCM channel |
| * @iobase: PCI base address for SGD channel registers |
| * |
| * Terminate scatter-gather DMA operation for given |
| * channel (derived from @iobase), if DMA is active. |
| * |
| * Note that @iobase is not the PCI base address, |
| * but the PCI base address plus an offset to |
| * one of three PCM channels supported by the chip. |
| * |
| */ |
| |
| static inline void via_chan_stop (long iobase) |
| { |
| if (inb (iobase + VIA_PCM_STATUS) & VIA_SGD_ACTIVE) |
| outb (VIA_SGD_TERMINATE, iobase + VIA_PCM_CONTROL); |
| } |
| |
| |
| /** |
| * via_chan_status_clear - Clear status flags on specified DMA channel |
| * @iobase: PCI base address for SGD channel registers |
| * |
| * Clear any pending status flags for the given |
| * DMA channel (derived from @iobase), if any |
| * flags are asserted. |
| * |
| * Note that @iobase is not the PCI base address, |
| * but the PCI base address plus an offset to |
| * one of three PCM channels supported by the chip. |
| * |
| */ |
| |
| static inline void via_chan_status_clear (long iobase) |
| { |
| u8 tmp = inb (iobase + VIA_PCM_STATUS); |
| |
| if (tmp != 0) |
| outb (tmp, iobase + VIA_PCM_STATUS); |
| } |
| |
| |
| /** |
| * sg_begin - Begin recording or playback on a PCM channel |
| * @chan: Channel for which DMA operation shall begin |
| * |
| * Start scatter-gather DMA for the given channel. |
| * |
| */ |
| |
| static inline void sg_begin (struct via_channel *chan) |
| { |
| DPRINTK("Start with intmask %d\n", chan->intmask); |
| DPRINTK("About to start from %d to %d\n", |
| inl(chan->iobase + VIA_PCM_BLOCK_COUNT), |
| inb(chan->iobase + VIA_PCM_STOPRATE + 3)); |
| outb (VIA_SGD_START|chan->intmask, chan->iobase + VIA_PCM_CONTROL); |
| DPRINTK("Status is now %02X\n", inb(chan->iobase + VIA_PCM_STATUS)); |
| DPRINTK("Control is now %02X\n", inb(chan->iobase + VIA_PCM_CONTROL)); |
| } |
| |
| |
| static int sg_active (long iobase) |
| { |
| u8 tmp = inb (iobase + VIA_PCM_STATUS); |
| if ((tmp & VIA_SGD_STOPPED) || (tmp & VIA_SGD_PAUSED)) { |
| printk(KERN_WARNING "via82cxxx warning: SG stopped or paused\n"); |
| return 0; |
| } |
| if (tmp & VIA_SGD_ACTIVE) |
| return 1; |
| return 0; |
| } |
| |
| static int via_sg_offset(struct via_channel *chan) |
| { |
| return inl (chan->iobase + VIA_PCM_BLOCK_COUNT) & 0x00FFFFFF; |
| } |
| |
| /**************************************************************** |
| * |
| * Miscellaneous debris |
| * |
| * |
| */ |
| |
| |
| /** |
| * via_syscall_down - down the card-specific syscell semaphore |
| * @card: Private info for specified board |
| * @nonblock: boolean, non-zero if O_NONBLOCK is set |
| * |
| * Encapsulates standard method of acquiring the syscall sem. |
| * |
| * Returns negative errno on error, or zero for success. |
| */ |
| |
| static inline int via_syscall_down (struct via_info *card, int nonblock) |
| { |
| /* Thomas Sailer: |
| * EAGAIN is supposed to be used if IO is pending, |
| * not if there is contention on some internal |
| * synchronization primitive which should be |
| * held only for a short time anyway |
| */ |
| nonblock = 0; |
| |
| if (nonblock) { |
| if (!mutex_trylock(&card->syscall_mutex)) |
| return -EAGAIN; |
| } else { |
| if (mutex_lock_interruptible(&card->syscall_mutex)) |
| return -ERESTARTSYS; |
| } |
| |
| return 0; |
| } |
| |
| |
| /** |
| * via_stop_everything - Stop all audio operations |
| * @card: Private info for specified board |
| * |
| * Stops all DMA operations and interrupts, and clear |
| * any pending status bits resulting from those operations. |
| */ |
| |
| static void via_stop_everything (struct via_info *card) |
| { |
| u8 tmp, new_tmp; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (card != NULL); |
| |
| /* |
| * terminate any existing operations on audio read/write channels |
| */ |
| via_chan_stop (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN); |
| via_chan_stop (card->baseaddr + VIA_BASE0_PCM_IN_CHAN); |
| via_chan_stop (card->baseaddr + VIA_BASE0_FM_OUT_CHAN); |
| if(card->sixchannel) |
| via_chan_stop (card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN); |
| |
| /* |
| * clear any existing stops / flags (sanity check mainly) |
| */ |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN); |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_IN_CHAN); |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_FM_OUT_CHAN); |
| if(card->sixchannel) |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN); |
| |
| /* |
| * clear any enabled interrupt bits |
| */ |
| tmp = inb (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN_TYPE); |
| new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); |
| if (tmp != new_tmp) |
| outb (0, card->baseaddr + VIA_BASE0_PCM_OUT_CHAN_TYPE); |
| |
| tmp = inb (card->baseaddr + VIA_BASE0_PCM_IN_CHAN_TYPE); |
| new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); |
| if (tmp != new_tmp) |
| outb (0, card->baseaddr + VIA_BASE0_PCM_IN_CHAN_TYPE); |
| |
| tmp = inb (card->baseaddr + VIA_BASE0_FM_OUT_CHAN_TYPE); |
| new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); |
| if (tmp != new_tmp) |
| outb (0, card->baseaddr + VIA_BASE0_FM_OUT_CHAN_TYPE); |
| |
| if(card->sixchannel) |
| { |
| tmp = inb (card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN_TYPE); |
| new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); |
| if (tmp != new_tmp) |
| outb (0, card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN_TYPE); |
| } |
| |
| udelay(10); |
| |
| /* |
| * clear any existing flags |
| */ |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN); |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_IN_CHAN); |
| via_chan_status_clear (card->baseaddr + VIA_BASE0_FM_OUT_CHAN); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| /** |
| * via_set_rate - Set PCM rate for given channel |
| * @ac97: Pointer to generic codec info struct |
| * @chan: Private info for specified channel |
| * @rate: Desired PCM sample rate, in Khz |
| * |
| * Sets the PCM sample rate for a channel. |
| * |
| * Values for @rate are clamped to a range of 4000 Khz through 48000 Khz, |
| * due to hardware constraints. |
| */ |
| |
| static int via_set_rate (struct ac97_codec *ac97, |
| struct via_channel *chan, unsigned rate) |
| { |
| struct via_info *card = ac97->private_data; |
| int rate_reg; |
| u32 dacp; |
| u32 mast_vol, phone_vol, mono_vol, pcm_vol; |
| u32 mute_vol = 0x8000; /* The mute volume? -- Seems to work! */ |
| |
| DPRINTK ("ENTER, rate = %d\n", rate); |
| |
| if (chan->rate == rate) |
| goto out; |
| if (card->locked_rate) { |
| chan->rate = 48000; |
| goto out; |
| } |
| |
| if (rate > 48000) rate = 48000; |
| if (rate < 4000) rate = 4000; |
| |
| rate_reg = chan->is_record ? AC97_PCM_LR_ADC_RATE : |
| AC97_PCM_FRONT_DAC_RATE; |
| |
| /* Save current state */ |
| dacp=via_ac97_read_reg(ac97, AC97_POWER_CONTROL); |
| mast_vol = via_ac97_read_reg(ac97, AC97_MASTER_VOL_STEREO); |
| mono_vol = via_ac97_read_reg(ac97, AC97_MASTER_VOL_MONO); |
| phone_vol = via_ac97_read_reg(ac97, AC97_HEADPHONE_VOL); |
| pcm_vol = via_ac97_read_reg(ac97, AC97_PCMOUT_VOL); |
| /* Mute - largely reduces popping */ |
| via_ac97_write_reg(ac97, AC97_MASTER_VOL_STEREO, mute_vol); |
| via_ac97_write_reg(ac97, AC97_MASTER_VOL_MONO, mute_vol); |
| via_ac97_write_reg(ac97, AC97_HEADPHONE_VOL, mute_vol); |
| via_ac97_write_reg(ac97, AC97_PCMOUT_VOL, mute_vol); |
| /* Power down the DAC */ |
| via_ac97_write_reg(ac97, AC97_POWER_CONTROL, dacp|0x0200); |
| |
| /* Set new rate */ |
| via_ac97_write_reg (ac97, rate_reg, rate); |
| |
| /* Power DAC back up */ |
| via_ac97_write_reg(ac97, AC97_POWER_CONTROL, dacp); |
| udelay (200); /* reduces popping */ |
| |
| /* Restore volumes */ |
| via_ac97_write_reg(ac97, AC97_MASTER_VOL_STEREO, mast_vol); |
| via_ac97_write_reg(ac97, AC97_MASTER_VOL_MONO, mono_vol); |
| via_ac97_write_reg(ac97, AC97_HEADPHONE_VOL, phone_vol); |
| via_ac97_write_reg(ac97, AC97_PCMOUT_VOL, pcm_vol); |
| |
| /* the hardware might return a value different than what we |
| * passed to it, so read the rate value back from hardware |
| * to see what we came up with |
| */ |
| chan->rate = via_ac97_read_reg (ac97, rate_reg); |
| |
| if (chan->rate == 0) { |
| card->locked_rate = 1; |
| chan->rate = 48000; |
| printk (KERN_WARNING PFX "Codec rate locked at 48Khz\n"); |
| } |
| |
| out: |
| DPRINTK ("EXIT, returning rate %d Hz\n", chan->rate); |
| return chan->rate; |
| } |
| |
| |
| /**************************************************************** |
| * |
| * Channel-specific operations |
| * |
| * |
| */ |
| |
| |
| /** |
| * via_chan_init_defaults - Initialize a struct via_channel |
| * @card: Private audio chip info |
| * @chan: Channel to be initialized |
| * |
| * Zero @chan, and then set all static defaults for the structure. |
| */ |
| |
| static void via_chan_init_defaults (struct via_info *card, struct via_channel *chan) |
| { |
| memset (chan, 0, sizeof (*chan)); |
| |
| if(card->intmask) |
| chan->intmask = 0x23; /* Turn on the IRQ bits */ |
| |
| if (chan == &card->ch_out) { |
| chan->name = "PCM-OUT"; |
| if(card->sixchannel) |
| { |
| chan->iobase = card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN; |
| chan->is_multi = 1; |
| DPRINTK("Using multichannel for pcm out\n"); |
| } |
| else |
| chan->iobase = card->baseaddr + VIA_BASE0_PCM_OUT_CHAN; |
| } else if (chan == &card->ch_in) { |
| chan->name = "PCM-IN"; |
| chan->iobase = card->baseaddr + VIA_BASE0_PCM_IN_CHAN; |
| chan->is_record = 1; |
| } else if (chan == &card->ch_fm) { |
| chan->name = "PCM-OUT-FM"; |
| chan->iobase = card->baseaddr + VIA_BASE0_FM_OUT_CHAN; |
| } else { |
| BUG(); |
| } |
| |
| init_waitqueue_head (&chan->wait); |
| |
| chan->pcm_fmt = VIA_PCM_FMT_MASK; |
| chan->is_enabled = 1; |
| |
| chan->frag_number = 0; |
| chan->frag_size = 0; |
| atomic_set(&chan->n_frags, 0); |
| atomic_set (&chan->hw_ptr, 0); |
| } |
| |
| /** |
| * via_chan_init - Initialize PCM channel |
| * @card: Private audio chip info |
| * @chan: Channel to be initialized |
| * |
| * Performs some of the preparations necessary to begin |
| * using a PCM channel. |
| * |
| * Currently the preparations consist of |
| * setting the PCM channel to a known state. |
| */ |
| |
| |
| static void via_chan_init (struct via_info *card, struct via_channel *chan) |
| { |
| |
| DPRINTK ("ENTER\n"); |
| |
| /* bzero channel structure, and init members to defaults */ |
| via_chan_init_defaults (card, chan); |
| |
| /* stop any existing channel output */ |
| via_chan_clear (card, chan); |
| via_chan_status_clear (chan->iobase); |
| via_chan_pcm_fmt (chan, 1); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| /** |
| * via_chan_buffer_init - Initialize PCM channel buffer |
| * @card: Private audio chip info |
| * @chan: Channel to be initialized |
| * |
| * Performs some of the preparations necessary to begin |
| * using a PCM channel. |
| * |
| * Currently the preparations include allocating the |
| * scatter-gather DMA table and buffers, |
| * and passing the |
| * address of the DMA table to the hardware. |
| * |
| * Note that special care is taken when passing the |
| * DMA table address to hardware, because it was found |
| * during driver development that the hardware did not |
| * always "take" the address. |
| */ |
| |
| static int via_chan_buffer_init (struct via_info *card, struct via_channel *chan) |
| { |
| int page, offset; |
| int i; |
| |
| DPRINTK ("ENTER\n"); |
| |
| |
| chan->intmask = 0; |
| if(card->intmask) |
| chan->intmask = 0x23; /* Turn on the IRQ bits */ |
| |
| if (chan->sgtable != NULL) { |
| DPRINTK ("EXIT\n"); |
| return 0; |
| } |
| |
| /* alloc DMA-able memory for scatter-gather table */ |
| chan->sgtable = pci_alloc_consistent (card->pdev, |
| (sizeof (struct via_sgd_table) * chan->frag_number), |
| &chan->sgt_handle); |
| if (!chan->sgtable) { |
| printk (KERN_ERR PFX "DMA table alloc fail, aborting\n"); |
| DPRINTK ("EXIT\n"); |
| return -ENOMEM; |
| } |
| |
| memset ((void*)chan->sgtable, 0, |
| (sizeof (struct via_sgd_table) * chan->frag_number)); |
| |
| /* alloc DMA-able memory for scatter-gather buffers */ |
| |
| chan->page_number = (chan->frag_number * chan->frag_size) / PAGE_SIZE + |
| (((chan->frag_number * chan->frag_size) % PAGE_SIZE) ? 1 : 0); |
| |
| for (i = 0; i < chan->page_number; i++) { |
| chan->pgtbl[i].cpuaddr = pci_alloc_consistent (card->pdev, PAGE_SIZE, |
| &chan->pgtbl[i].handle); |
| |
| if (!chan->pgtbl[i].cpuaddr) { |
| chan->page_number = i; |
| goto err_out_nomem; |
| } |
| |
| #ifndef VIA_NDEBUG |
| memset (chan->pgtbl[i].cpuaddr, 0xBC, chan->frag_size); |
| #endif |
| |
| #if 1 |
| DPRINTK ("dmabuf_pg #%d (h=%lx, v2p=%lx, a=%p)\n", |
| i, (long)chan->pgtbl[i].handle, |
| virt_to_phys(chan->pgtbl[i].cpuaddr), |
| chan->pgtbl[i].cpuaddr); |
| #endif |
| } |
| |
| for (i = 0; i < chan->frag_number; i++) { |
| |
| page = i / (PAGE_SIZE / chan->frag_size); |
| offset = (i % (PAGE_SIZE / chan->frag_size)) * chan->frag_size; |
| |
| chan->sgtable[i].count = cpu_to_le32 (chan->frag_size | VIA_FLAG); |
| chan->sgtable[i].addr = cpu_to_le32 (chan->pgtbl[page].handle + offset); |
| |
| #if 1 |
| DPRINTK ("dmabuf #%d (32(h)=%lx)\n", |
| i, |
| (long)chan->sgtable[i].addr); |
| #endif |
| } |
| |
| /* overwrite the last buffer information */ |
| chan->sgtable[chan->frag_number - 1].count = cpu_to_le32 (chan->frag_size | VIA_EOL); |
| |
| /* set location of DMA-able scatter-gather info table */ |
| DPRINTK ("outl (0x%X, 0x%04lX)\n", |
| chan->sgt_handle, chan->iobase + VIA_PCM_TABLE_ADDR); |
| |
| via_ac97_wait_idle (card); |
| outl (chan->sgt_handle, chan->iobase + VIA_PCM_TABLE_ADDR); |
| udelay (20); |
| via_ac97_wait_idle (card); |
| /* load no rate adaption, stereo 16bit, set up ring slots */ |
| if(card->sixchannel) |
| { |
| if(!chan->is_multi) |
| { |
| outl (0xFFFFF | (0x3 << 20) | (chan->frag_number << 24), chan->iobase + VIA_PCM_STOPRATE); |
| udelay (20); |
| via_ac97_wait_idle (card); |
| } |
| } |
| |
| DPRINTK ("inl (0x%lX) = %x\n", |
| chan->iobase + VIA_PCM_TABLE_ADDR, |
| inl(chan->iobase + VIA_PCM_TABLE_ADDR)); |
| |
| DPRINTK ("EXIT\n"); |
| return 0; |
| |
| err_out_nomem: |
| printk (KERN_ERR PFX "DMA buffer alloc fail, aborting\n"); |
| via_chan_buffer_free (card, chan); |
| DPRINTK ("EXIT\n"); |
| return -ENOMEM; |
| } |
| |
| |
| /** |
| * via_chan_free - Release a PCM channel |
| * @card: Private audio chip info |
| * @chan: Channel to be released |
| * |
| * Performs all the functions necessary to clean up |
| * an initialized channel. |
| * |
| * Currently these functions include disabled any |
| * active DMA operations, setting the PCM channel |
| * back to a known state, and releasing any allocated |
| * sound buffers. |
| */ |
| |
| static void via_chan_free (struct via_info *card, struct via_channel *chan) |
| { |
| DPRINTK ("ENTER\n"); |
| |
| spin_lock_irq (&card->lock); |
| |
| /* stop any existing channel output */ |
| via_chan_status_clear (chan->iobase); |
| via_chan_stop (chan->iobase); |
| via_chan_status_clear (chan->iobase); |
| |
| spin_unlock_irq (&card->lock); |
| |
| synchronize_irq(card->pdev->irq); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| static void via_chan_buffer_free (struct via_info *card, struct via_channel *chan) |
| { |
| int i; |
| |
| DPRINTK ("ENTER\n"); |
| |
| /* zero location of DMA-able scatter-gather info table */ |
| via_ac97_wait_idle(card); |
| outl (0, chan->iobase + VIA_PCM_TABLE_ADDR); |
| |
| for (i = 0; i < chan->page_number; i++) |
| if (chan->pgtbl[i].cpuaddr) { |
| pci_free_consistent (card->pdev, PAGE_SIZE, |
| chan->pgtbl[i].cpuaddr, |
| chan->pgtbl[i].handle); |
| chan->pgtbl[i].cpuaddr = NULL; |
| chan->pgtbl[i].handle = 0; |
| } |
| |
| chan->page_number = 0; |
| |
| if (chan->sgtable) { |
| pci_free_consistent (card->pdev, |
| (sizeof (struct via_sgd_table) * chan->frag_number), |
| (void*)chan->sgtable, chan->sgt_handle); |
| chan->sgtable = NULL; |
| } |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| /** |
| * via_chan_pcm_fmt - Update PCM channel settings |
| * @chan: Channel to be updated |
| * @reset: Boolean. If non-zero, channel will be reset |
| * to 8-bit mono mode. |
| * |
| * Stores the settings of the current PCM format, |
| * 8-bit or 16-bit, and mono/stereo, into the |
| * hardware settings for the specified channel. |
| * If @reset is non-zero, the channel is reset |
| * to 8-bit mono mode. Otherwise, the channel |
| * is set to the values stored in the channel |
| * information struct @chan. |
| */ |
| |
| static void via_chan_pcm_fmt (struct via_channel *chan, int reset) |
| { |
| DPRINTK ("ENTER, pcm_fmt=0x%02X, reset=%s\n", |
| chan->pcm_fmt, reset ? "yes" : "no"); |
| |
| assert (chan != NULL); |
| |
| if (reset) |
| { |
| /* reset to 8-bit mono mode */ |
| chan->pcm_fmt = 0; |
| chan->channels = 1; |
| } |
| |
| /* enable interrupts on FLAG and EOL */ |
| chan->pcm_fmt |= VIA_CHAN_TYPE_MASK; |
| |
| /* if we are recording, enable recording fifo bit */ |
| if (chan->is_record) |
| chan->pcm_fmt |= VIA_PCM_REC_FIFO; |
| /* set interrupt select bits where applicable (PCM in & out channels) */ |
| if (!chan->is_record) |
| chan->pcm_fmt |= VIA_CHAN_TYPE_INT_SELECT; |
| |
| DPRINTK("SET FMT - %02x %02x\n", chan->intmask , chan->is_multi); |
| |
| if(chan->intmask) |
| { |
| u32 m; |
| |
| /* |
| * Channel 0x4 is up to 6 x 16bit and has to be |
| * programmed differently |
| */ |
| |
| if(chan->is_multi) |
| { |
| u8 c = 0; |
| |
| /* |
| * Load the type bit for num channels |
| * and 8/16bit |
| */ |
| |
| if(chan->pcm_fmt & VIA_PCM_FMT_16BIT) |
| c = 1 << 7; |
| if(chan->pcm_fmt & VIA_PCM_FMT_STEREO) |
| c |= (2<<4); |
| else |
| c |= (1<<4); |
| |
| outb(c, chan->iobase + VIA_PCM_TYPE); |
| |
| /* |
| * Set the channel steering |
| * Mono |
| * Channel 0 to slot 3 |
| * Channel 0 to slot 4 |
| * Stereo |
| * Channel 0 to slot 3 |
| * Channel 1 to slot 4 |
| */ |
| |
| switch(chan->channels) |
| { |
| case 1: |
| outl(0xFF000000 | (1<<0) | (1<<4) , chan->iobase + VIA_PCM_STOPRATE); |
| break; |
| case 2: |
| outl(0xFF000000 | (1<<0) | (2<<4) , chan->iobase + VIA_PCM_STOPRATE); |
| break; |
| case 4: |
| outl(0xFF000000 | (1<<0) | (2<<4) | (3<<8) | (4<<12), chan->iobase + VIA_PCM_STOPRATE); |
| break; |
| case 6: |
| outl(0xFF000000 | (1<<0) | (2<<4) | (5<<8) | (6<<12) | (3<<16) | (4<<20), chan->iobase + VIA_PCM_STOPRATE); |
| break; |
| } |
| } |
| else |
| { |
| /* |
| * New style, turn off channel volume |
| * control, set bits in the right register |
| */ |
| outb(0x0, chan->iobase + VIA_PCM_LEFTVOL); |
| outb(0x0, chan->iobase + VIA_PCM_RIGHTVOL); |
| |
| m = inl(chan->iobase + VIA_PCM_STOPRATE); |
| m &= ~(3<<20); |
| if(chan->pcm_fmt & VIA_PCM_FMT_STEREO) |
| m |= (1 << 20); |
| if(chan->pcm_fmt & VIA_PCM_FMT_16BIT) |
| m |= (1 << 21); |
| outl(m, chan->iobase + VIA_PCM_STOPRATE); |
| } |
| } |
| else |
| outb (chan->pcm_fmt, chan->iobase + VIA_PCM_TYPE); |
| |
| |
| DPRINTK ("EXIT, pcm_fmt = 0x%02X, reg = 0x%02X\n", |
| chan->pcm_fmt, |
| inb (chan->iobase + VIA_PCM_TYPE)); |
| } |
| |
| |
| /** |
| * via_chan_clear - Stop DMA channel operation, and reset pointers |
| * @card: the chip to accessed |
| * @chan: Channel to be cleared |
| * |
| * Call via_chan_stop to halt DMA operations, and then resets |
| * all software pointers which track DMA operation. |
| */ |
| |
| static void via_chan_clear (struct via_info *card, struct via_channel *chan) |
| { |
| DPRINTK ("ENTER\n"); |
| via_chan_stop (chan->iobase); |
| via_chan_buffer_free(card, chan); |
| chan->is_active = 0; |
| chan->is_mapped = 0; |
| chan->is_enabled = 1; |
| chan->slop_len = 0; |
| chan->sw_ptr = 0; |
| chan->n_irqs = 0; |
| atomic_set (&chan->hw_ptr, 0); |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| /** |
| * via_chan_set_speed - Set PCM sample rate for given channel |
| * @card: Private info for specified board |
| * @chan: Channel whose sample rate will be adjusted |
| * @val: New sample rate, in Khz |
| * |
| * Helper function for the %SNDCTL_DSP_SPEED ioctl. OSS semantics |
| * demand that all audio operations halt (if they are not already |
| * halted) when the %SNDCTL_DSP_SPEED is given. |
| * |
| * This function halts all audio operations for the given channel |
| * @chan, and then calls via_set_rate to set the audio hardware |
| * to the new rate. |
| */ |
| |
| static int via_chan_set_speed (struct via_info *card, |
| struct via_channel *chan, int val) |
| { |
| DPRINTK ("ENTER, requested rate = %d\n", val); |
| |
| via_chan_clear (card, chan); |
| |
| val = via_set_rate (card->ac97, chan, val); |
| |
| DPRINTK ("EXIT, returning %d\n", val); |
| return val; |
| } |
| |
| |
| /** |
| * via_chan_set_fmt - Set PCM sample size for given channel |
| * @card: Private info for specified board |
| * @chan: Channel whose sample size will be adjusted |
| * @val: New sample size, use the %AFMT_xxx constants |
| * |
| * Helper function for the %SNDCTL_DSP_SETFMT ioctl. OSS semantics |
| * demand that all audio operations halt (if they are not already |
| * halted) when the %SNDCTL_DSP_SETFMT is given. |
| * |
| * This function halts all audio operations for the given channel |
| * @chan, and then calls via_chan_pcm_fmt to set the audio hardware |
| * to the new sample size, either 8-bit or 16-bit. |
| */ |
| |
| static int via_chan_set_fmt (struct via_info *card, |
| struct via_channel *chan, int val) |
| { |
| DPRINTK ("ENTER, val=%s\n", |
| val == AFMT_U8 ? "AFMT_U8" : |
| val == AFMT_S16_LE ? "AFMT_S16_LE" : |
| "unknown"); |
| |
| via_chan_clear (card, chan); |
| |
| assert (val != AFMT_QUERY); /* this case is handled elsewhere */ |
| |
| switch (val) { |
| case AFMT_S16_LE: |
| if ((chan->pcm_fmt & VIA_PCM_FMT_16BIT) == 0) { |
| chan->pcm_fmt |= VIA_PCM_FMT_16BIT; |
| via_chan_pcm_fmt (chan, 0); |
| } |
| break; |
| |
| case AFMT_U8: |
| if (chan->pcm_fmt & VIA_PCM_FMT_16BIT) { |
| chan->pcm_fmt &= ~VIA_PCM_FMT_16BIT; |
| via_chan_pcm_fmt (chan, 0); |
| } |
| break; |
| |
| default: |
| DPRINTK ("unknown AFMT: 0x%X\n", val); |
| val = AFMT_S16_LE; |
| } |
| |
| DPRINTK ("EXIT\n"); |
| return val; |
| } |
| |
| |
| /** |
| * via_chan_set_stereo - Enable or disable stereo for a DMA channel |
| * @card: Private info for specified board |
| * @chan: Channel whose stereo setting will be adjusted |
| * @val: New sample size, use the %AFMT_xxx constants |
| * |
| * Helper function for the %SNDCTL_DSP_CHANNELS and %SNDCTL_DSP_STEREO ioctls. OSS semantics |
| * demand that all audio operations halt (if they are not already |
| * halted) when %SNDCTL_DSP_CHANNELS or SNDCTL_DSP_STEREO is given. |
| * |
| * This function halts all audio operations for the given channel |
| * @chan, and then calls via_chan_pcm_fmt to set the audio hardware |
| * to enable or disable stereo. |
| */ |
| |
| static int via_chan_set_stereo (struct via_info *card, |
| struct via_channel *chan, int val) |
| { |
| DPRINTK ("ENTER, channels = %d\n", val); |
| |
| via_chan_clear (card, chan); |
| |
| switch (val) { |
| |
| /* mono */ |
| case 1: |
| chan->pcm_fmt &= ~VIA_PCM_FMT_STEREO; |
| chan->channels = 1; |
| via_chan_pcm_fmt (chan, 0); |
| break; |
| |
| /* stereo */ |
| case 2: |
| chan->pcm_fmt |= VIA_PCM_FMT_STEREO; |
| chan->channels = 2; |
| via_chan_pcm_fmt (chan, 0); |
| break; |
| |
| case 4: |
| case 6: |
| if(chan->is_multi) |
| { |
| chan->pcm_fmt |= VIA_PCM_FMT_STEREO; |
| chan->channels = val; |
| break; |
| } |
| /* unknown */ |
| default: |
| val = -EINVAL; |
| break; |
| } |
| |
| DPRINTK ("EXIT, returning %d\n", val); |
| return val; |
| } |
| |
| static int via_chan_set_buffering (struct via_info *card, |
| struct via_channel *chan, int val) |
| { |
| int shift; |
| |
| DPRINTK ("ENTER\n"); |
| |
| /* in both cases the buffer cannot be changed */ |
| if (chan->is_active || chan->is_mapped) { |
| DPRINTK ("EXIT\n"); |
| return -EINVAL; |
| } |
| |
| /* called outside SETFRAGMENT */ |
| /* set defaults or do nothing */ |
| if (val < 0) { |
| |
| if (chan->frag_size && chan->frag_number) |
| goto out; |
| |
| DPRINTK ("\n"); |
| |
| chan->frag_size = (VIA_DEFAULT_FRAG_TIME * chan->rate * chan->channels |
| * ((chan->pcm_fmt & VIA_PCM_FMT_16BIT) ? 2 : 1)) / 1000 - 1; |
| |
| shift = 0; |
| while (chan->frag_size) { |
| chan->frag_size >>= 1; |
| shift++; |
| } |
| chan->frag_size = 1 << shift; |
| |
| chan->frag_number = (VIA_DEFAULT_BUFFER_TIME / VIA_DEFAULT_FRAG_TIME); |
| |
| DPRINTK ("setting default values %d %d\n", chan->frag_size, chan->frag_number); |
| } else { |
| chan->frag_size = 1 << (val & 0xFFFF); |
| chan->frag_number = (val >> 16) & 0xFFFF; |
| |
| DPRINTK ("using user values %d %d\n", chan->frag_size, chan->frag_number); |
| } |
| |
| /* quake3 wants frag_number to be a power of two */ |
| shift = 0; |
| while (chan->frag_number) { |
| chan->frag_number >>= 1; |
| shift++; |
| } |
| chan->frag_number = 1 << shift; |
| |
| if (chan->frag_size > VIA_MAX_FRAG_SIZE) |
| chan->frag_size = VIA_MAX_FRAG_SIZE; |
| else if (chan->frag_size < VIA_MIN_FRAG_SIZE) |
| chan->frag_size = VIA_MIN_FRAG_SIZE; |
| |
| if (chan->frag_number < VIA_MIN_FRAG_NUMBER) |
| chan->frag_number = VIA_MIN_FRAG_NUMBER; |
| if (chan->frag_number > VIA_MAX_FRAG_NUMBER) |
| chan->frag_number = VIA_MAX_FRAG_NUMBER; |
| |
| if ((chan->frag_number * chan->frag_size) / PAGE_SIZE > VIA_MAX_BUFFER_DMA_PAGES) |
| chan->frag_number = (VIA_MAX_BUFFER_DMA_PAGES * PAGE_SIZE) / chan->frag_size; |
| |
| out: |
| if (chan->is_record) |
| atomic_set (&chan->n_frags, 0); |
| else |
| atomic_set (&chan->n_frags, chan->frag_number); |
| |
| DPRINTK ("EXIT\n"); |
| |
| return 0; |
| } |
| |
| #ifdef VIA_CHAN_DUMP_BUFS |
| /** |
| * via_chan_dump_bufs - Display DMA table contents |
| * @chan: Channel whose DMA table will be displayed |
| * |
| * Debugging function which displays the contents of the |
| * scatter-gather DMA table for the given channel @chan. |
| */ |
| |
| static void via_chan_dump_bufs (struct via_channel *chan) |
| { |
| int i; |
| |
| for (i = 0; i < chan->frag_number; i++) { |
| DPRINTK ("#%02d: addr=%x, count=%u, flag=%d, eol=%d\n", |
| i, chan->sgtable[i].addr, |
| chan->sgtable[i].count & 0x00FFFFFF, |
| chan->sgtable[i].count & VIA_FLAG ? 1 : 0, |
| chan->sgtable[i].count & VIA_EOL ? 1 : 0); |
| } |
| DPRINTK ("buf_in_use = %d, nextbuf = %d\n", |
| atomic_read (&chan->buf_in_use), |
| atomic_read (&chan->sw_ptr)); |
| } |
| #endif /* VIA_CHAN_DUMP_BUFS */ |
| |
| |
| /** |
| * via_chan_flush_frag - Flush partially-full playback buffer to hardware |
| * @chan: Channel whose DMA table will be flushed |
| * |
| * Flushes partially-full playback buffer to hardware. |
| */ |
| |
| static void via_chan_flush_frag (struct via_channel *chan) |
| { |
| DPRINTK ("ENTER\n"); |
| |
| assert (chan->slop_len > 0); |
| |
| if (chan->sw_ptr == (chan->frag_number - 1)) |
| chan->sw_ptr = 0; |
| else |
| chan->sw_ptr++; |
| |
| chan->slop_len = 0; |
| |
| assert (atomic_read (&chan->n_frags) > 0); |
| atomic_dec (&chan->n_frags); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| |
| /** |
| * via_chan_maybe_start - Initiate audio hardware DMA operation |
| * @chan: Channel whose DMA is to be started |
| * |
| * Initiate DMA operation, if the DMA engine for the given |
| * channel @chan is not already active. |
| */ |
| |
| static inline void via_chan_maybe_start (struct via_channel *chan) |
| { |
| assert (chan->is_active == sg_active(chan->iobase)); |
| |
| DPRINTK ("MAYBE START %s\n", chan->name); |
| if (!chan->is_active && chan->is_enabled) { |
| chan->is_active = 1; |
| sg_begin (chan); |
| DPRINTK ("starting channel %s\n", chan->name); |
| } |
| } |
| |
| |
| /**************************************************************** |
| * |
| * Interface to ac97-codec module |
| * |
| * |
| */ |
| |
| /** |
| * via_ac97_wait_idle - Wait until AC97 codec is not busy |
| * @card: Private info for specified board |
| * |
| * Sleep until the AC97 codec is no longer busy. |
| * Returns the final value read from the SGD |
| * register being polled. |
| */ |
| |
| static u8 via_ac97_wait_idle (struct via_info *card) |
| { |
| u8 tmp8; |
| int counter = VIA_COUNTER_LIMIT; |
| |
| DPRINTK ("ENTER/EXIT\n"); |
| |
| assert (card != NULL); |
| assert (card->pdev != NULL); |
| |
| do { |
| udelay (15); |
| |
| tmp8 = inb (card->baseaddr + 0x83); |
| } while ((tmp8 & VIA_CR83_BUSY) && (counter-- > 0)); |
| |
| if (tmp8 & VIA_CR83_BUSY) |
| printk (KERN_WARNING PFX "timeout waiting on AC97 codec\n"); |
| return tmp8; |
| } |
| |
| |
| /** |
| * via_ac97_read_reg - Read AC97 standard register |
| * @codec: Pointer to generic AC97 codec info |
| * @reg: Index of AC97 register to be read |
| * |
| * Read the value of a single AC97 codec register, |
| * as defined by the Intel AC97 specification. |
| * |
| * Defines the standard AC97 read-register operation |
| * required by the kernel's ac97_codec interface. |
| * |
| * Returns the 16-bit value stored in the specified |
| * register. |
| */ |
| |
| static u16 via_ac97_read_reg (struct ac97_codec *codec, u8 reg) |
| { |
| unsigned long data; |
| struct via_info *card; |
| int counter; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (codec != NULL); |
| assert (codec->private_data != NULL); |
| |
| card = codec->private_data; |
| |
| spin_lock(&card->ac97_lock); |
| |
| /* Every time we write to register 80 we cause a transaction. |
| The only safe way to clear the valid bit is to write it at |
| the same time as the command */ |
| data = (reg << 16) | VIA_CR80_READ | VIA_CR80_VALID; |
| |
| outl (data, card->baseaddr + VIA_BASE0_AC97_CTRL); |
| udelay (20); |
| |
| for (counter = VIA_COUNTER_LIMIT; counter > 0; counter--) { |
| udelay (1); |
| if ((((data = inl(card->baseaddr + VIA_BASE0_AC97_CTRL)) & |
| (VIA_CR80_VALID|VIA_CR80_BUSY)) == VIA_CR80_VALID)) |
| goto out; |
| } |
| |
| printk (KERN_WARNING PFX "timeout while reading AC97 codec (0x%lX)\n", data); |
| goto err_out; |
| |
| out: |
| /* Once the valid bit has become set, we must wait a complete AC97 |
| frame before the data has settled. */ |
| udelay(25); |
| data = (unsigned long) inl (card->baseaddr + VIA_BASE0_AC97_CTRL); |
| |
| outb (0x02, card->baseaddr + 0x83); |
| |
| if (((data & 0x007F0000) >> 16) == reg) { |
| DPRINTK ("EXIT, success, data=0x%lx, retval=0x%lx\n", |
| data, data & 0x0000FFFF); |
| spin_unlock(&card->ac97_lock); |
| return data & 0x0000FFFF; |
| } |
| |
| printk (KERN_WARNING "via82cxxx_audio: not our index: reg=0x%x, newreg=0x%lx\n", |
| reg, ((data & 0x007F0000) >> 16)); |
| |
| err_out: |
| spin_unlock(&card->ac97_lock); |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| } |
| |
| |
| /** |
| * via_ac97_write_reg - Write AC97 standard register |
| * @codec: Pointer to generic AC97 codec info |
| * @reg: Index of AC97 register to be written |
| * @value: Value to be written to AC97 register |
| * |
| * Write the value of a single AC97 codec register, |
| * as defined by the Intel AC97 specification. |
| * |
| * Defines the standard AC97 write-register operation |
| * required by the kernel's ac97_codec interface. |
| */ |
| |
| static void via_ac97_write_reg (struct ac97_codec *codec, u8 reg, u16 value) |
| { |
| u32 data; |
| struct via_info *card; |
| int counter; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (codec != NULL); |
| assert (codec->private_data != NULL); |
| |
| card = codec->private_data; |
| |
| spin_lock(&card->ac97_lock); |
| |
| data = (reg << 16) + value; |
| outl (data, card->baseaddr + VIA_BASE0_AC97_CTRL); |
| udelay (10); |
| |
| for (counter = VIA_COUNTER_LIMIT; counter > 0; counter--) { |
| if ((inb (card->baseaddr + 0x83) & VIA_CR83_BUSY) == 0) |
| goto out; |
| |
| udelay (15); |
| } |
| |
| printk (KERN_WARNING PFX "timeout after AC97 codec write (0x%X, 0x%X)\n", reg, value); |
| |
| out: |
| spin_unlock(&card->ac97_lock); |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| static int via_mixer_open (struct inode *inode, struct file *file) |
| { |
| int minor = iminor(inode); |
| struct via_info *card; |
| struct pci_dev *pdev = NULL; |
| struct pci_driver *drvr; |
| |
| DPRINTK ("ENTER\n"); |
| |
| while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) { |
| drvr = pci_dev_driver (pdev); |
| if (drvr == &via_driver) { |
| assert (pci_get_drvdata (pdev) != NULL); |
| |
| card = pci_get_drvdata (pdev); |
| if (card->ac97->dev_mixer == minor) |
| goto match; |
| } |
| } |
| |
| DPRINTK ("EXIT, returning -ENODEV\n"); |
| return -ENODEV; |
| |
| match: |
| file->private_data = card->ac97; |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return nonseekable_open(inode, file); |
| } |
| |
| static int via_mixer_ioctl (struct inode *inode, struct file *file, unsigned int cmd, |
| unsigned long arg) |
| { |
| struct ac97_codec *codec = file->private_data; |
| struct via_info *card; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| int rc; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (codec != NULL); |
| card = codec->private_data; |
| assert (card != NULL); |
| |
| rc = via_syscall_down (card, nonblock); |
| if (rc) goto out; |
| |
| #if 0 |
| /* |
| * Intercept volume control on 8233 and 8235 |
| */ |
| if(card->volume) |
| { |
| switch(cmd) |
| { |
| case SOUND_MIXER_READ_VOLUME: |
| return card->mixer_vol; |
| case SOUND_MIXER_WRITE_VOLUME: |
| { |
| int v; |
| if(get_user(v, (int *)arg)) |
| { |
| rc = -EFAULT; |
| goto out; |
| } |
| card->mixer_vol = v; |
| } |
| } |
| } |
| #endif |
| rc = codec->mixer_ioctl(codec, cmd, arg); |
| |
| mutex_unlock(&card->syscall_mutex); |
| |
| out: |
| DPRINTK ("EXIT, returning %d\n", rc); |
| return rc; |
| } |
| |
| |
| static struct file_operations via_mixer_fops = { |
| .owner = THIS_MODULE, |
| .open = via_mixer_open, |
| .llseek = no_llseek, |
| .ioctl = via_mixer_ioctl, |
| }; |
| |
| |
| static int __devinit via_ac97_reset (struct via_info *card) |
| { |
| struct pci_dev *pdev = card->pdev; |
| u8 tmp8; |
| u16 tmp16; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (pdev != NULL); |
| |
| #ifndef NDEBUG |
| { |
| u8 r40,r41,r42,r43,r44,r48; |
| pci_read_config_byte (card->pdev, 0x40, &r40); |
| pci_read_config_byte (card->pdev, 0x41, &r41); |
| pci_read_config_byte (card->pdev, 0x42, &r42); |
| pci_read_config_byte (card->pdev, 0x43, &r43); |
| pci_read_config_byte (card->pdev, 0x44, &r44); |
| pci_read_config_byte (card->pdev, 0x48, &r48); |
| DPRINTK ("PCI config: %02X %02X %02X %02X %02X %02X\n", |
| r40,r41,r42,r43,r44,r48); |
| |
| spin_lock_irq (&card->lock); |
| DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", |
| inb (card->baseaddr + 0x00), |
| inb (card->baseaddr + 0x01), |
| inb (card->baseaddr + 0x02), |
| inl (card->baseaddr + 0x04), |
| inl (card->baseaddr + 0x0C), |
| inl (card->baseaddr + 0x80), |
| inl (card->baseaddr + 0x84)); |
| spin_unlock_irq (&card->lock); |
| |
| } |
| #endif |
| |
| /* |
| * Reset AC97 controller: enable, disable, enable, |
| * pausing after each command for good luck. Only |
| * do this if the codec is not ready, because it causes |
| * loud pops and such due to such a hard codec reset. |
| */ |
| pci_read_config_byte (pdev, VIA_ACLINK_STATUS, &tmp8); |
| if ((tmp8 & VIA_CR40_AC97_READY) == 0) { |
| pci_write_config_byte (pdev, VIA_ACLINK_CTRL, |
| VIA_CR41_AC97_ENABLE | |
| VIA_CR41_AC97_RESET | |
| VIA_CR41_AC97_WAKEUP); |
| udelay (100); |
| |
| pci_write_config_byte (pdev, VIA_ACLINK_CTRL, 0); |
| udelay (100); |
| |
| pci_write_config_byte (pdev, VIA_ACLINK_CTRL, |
| VIA_CR41_AC97_ENABLE | |
| VIA_CR41_PCM_ENABLE | |
| VIA_CR41_VRA | VIA_CR41_AC97_RESET); |
| udelay (100); |
| } |
| |
| /* Make sure VRA is enabled, in case we didn't do a |
| * complete codec reset, above |
| */ |
| pci_read_config_byte (pdev, VIA_ACLINK_CTRL, &tmp8); |
| if (((tmp8 & VIA_CR41_VRA) == 0) || |
| ((tmp8 & VIA_CR41_AC97_ENABLE) == 0) || |
| ((tmp8 & VIA_CR41_PCM_ENABLE) == 0) || |
| ((tmp8 & VIA_CR41_AC97_RESET) == 0)) { |
| pci_write_config_byte (pdev, VIA_ACLINK_CTRL, |
| VIA_CR41_AC97_ENABLE | |
| VIA_CR41_PCM_ENABLE | |
| VIA_CR41_VRA | VIA_CR41_AC97_RESET); |
| udelay (100); |
| } |
| |
| if(card->legacy) |
| { |
| #if 0 /* this breaks on K7M */ |
| /* disable legacy stuff */ |
| pci_write_config_byte (pdev, 0x42, 0x00); |
| udelay(10); |
| #endif |
| |
| /* route FM trap to IRQ, disable FM trap */ |
| pci_write_config_byte (pdev, 0x48, 0x05); |
| udelay(10); |
| } |
| |
| /* disable all codec GPI interrupts */ |
| outl (0, pci_resource_start (pdev, 0) + 0x8C); |
| |
| /* WARNING: this line is magic. Remove this |
| * and things break. */ |
| /* enable variable rate */ |
| tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); |
| if ((tmp16 & 1) == 0) |
| via_ac97_write_reg (card->ac97, AC97_EXTENDED_STATUS, tmp16 | 1); |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| } |
| |
| |
| static void via_ac97_codec_wait (struct ac97_codec *codec) |
| { |
| assert (codec->private_data != NULL); |
| via_ac97_wait_idle (codec->private_data); |
| } |
| |
| |
| static int __devinit via_ac97_init (struct via_info *card) |
| { |
| int rc; |
| u16 tmp16; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (card != NULL); |
| |
| card->ac97 = ac97_alloc_codec(); |
| if(card->ac97 == NULL) |
| return -ENOMEM; |
| |
| card->ac97->private_data = card; |
| card->ac97->codec_read = via_ac97_read_reg; |
| card->ac97->codec_write = via_ac97_write_reg; |
| card->ac97->codec_wait = via_ac97_codec_wait; |
| |
| card->ac97->dev_mixer = register_sound_mixer (&via_mixer_fops, -1); |
| if (card->ac97->dev_mixer < 0) { |
| printk (KERN_ERR PFX "unable to register AC97 mixer, aborting\n"); |
| DPRINTK ("EXIT, returning -EIO\n"); |
| ac97_release_codec(card->ac97); |
| return -EIO; |
| } |
| |
| rc = via_ac97_reset (card); |
| if (rc) { |
| printk (KERN_ERR PFX "unable to reset AC97 codec, aborting\n"); |
| goto err_out; |
| } |
| |
| mdelay(10); |
| |
| if (ac97_probe_codec (card->ac97) == 0) { |
| printk (KERN_ERR PFX "unable to probe AC97 codec, aborting\n"); |
| rc = -EIO; |
| goto err_out; |
| } |
| |
| /* enable variable rate */ |
| tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); |
| via_ac97_write_reg (card->ac97, AC97_EXTENDED_STATUS, tmp16 | 1); |
| |
| /* |
| * If we cannot enable VRA, we have a locked-rate codec. |
| * We try again to enable VRA before assuming so, however. |
| */ |
| tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); |
| if ((tmp16 & 1) == 0) { |
| via_ac97_write_reg (card->ac97, AC97_EXTENDED_STATUS, tmp16 | 1); |
| tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); |
| if ((tmp16 & 1) == 0) { |
| card->locked_rate = 1; |
| printk (KERN_WARNING PFX "Codec rate locked at 48Khz\n"); |
| } |
| } |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| |
| err_out: |
| unregister_sound_mixer (card->ac97->dev_mixer); |
| DPRINTK ("EXIT, returning %d\n", rc); |
| ac97_release_codec(card->ac97); |
| return rc; |
| } |
| |
| |
| static void via_ac97_cleanup (struct via_info *card) |
| { |
| DPRINTK ("ENTER\n"); |
| |
| assert (card != NULL); |
| assert (card->ac97->dev_mixer >= 0); |
| |
| unregister_sound_mixer (card->ac97->dev_mixer); |
| ac97_release_codec(card->ac97); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| |
| /**************************************************************** |
| * |
| * Interrupt-related code |
| * |
| */ |
| |
| /** |
| * via_intr_channel - handle an interrupt for a single channel |
| * @card: unused |
| * @chan: handle interrupt for this channel |
| * |
| * This is the "meat" of the interrupt handler, |
| * containing the actions taken each time an interrupt |
| * occurs. All communication and coordination with |
| * userspace takes place here. |
| * |
| * Locking: inside card->lock |
| */ |
| |
| static void via_intr_channel (struct via_info *card, struct via_channel *chan) |
| { |
| u8 status; |
| int n; |
| |
| /* check pertinent bits of status register for action bits */ |
| status = inb (chan->iobase) & (VIA_SGD_FLAG | VIA_SGD_EOL | VIA_SGD_STOPPED); |
| if (!status) |
| return; |
| |
| /* acknowledge any flagged bits ASAP */ |
| outb (status, chan->iobase); |
| |
| if (!chan->sgtable) /* XXX: temporary solution */ |
| return; |
| |
| /* grab current h/w ptr value */ |
| n = atomic_read (&chan->hw_ptr); |
| |
| /* sanity check: make sure our h/w ptr doesn't have a weird value */ |
| assert (n >= 0); |
| assert (n < chan->frag_number); |
| |
| |
| /* reset SGD data structure in memory to reflect a full buffer, |
| * and advance the h/w ptr, wrapping around to zero if needed |
| */ |
| if (n == (chan->frag_number - 1)) { |
| chan->sgtable[n].count = cpu_to_le32(chan->frag_size | VIA_EOL); |
| atomic_set (&chan->hw_ptr, 0); |
| } else { |
| chan->sgtable[n].count = cpu_to_le32(chan->frag_size | VIA_FLAG); |
| atomic_inc (&chan->hw_ptr); |
| } |
| |
| /* accounting crap for SNDCTL_DSP_GETxPTR */ |
| chan->n_irqs++; |
| chan->bytes += chan->frag_size; |
| /* FIXME - signed overflow is undefined */ |
| if (chan->bytes < 0) /* handle overflow of 31-bit value */ |
| chan->bytes = chan->frag_size; |
| /* all following checks only occur when not in mmap(2) mode */ |
| if (!chan->is_mapped) |
| { |
| /* If we are recording, then n_frags represents the number |
| * of fragments waiting to be handled by userspace. |
| * If we are playback, then n_frags represents the number |
| * of fragments remaining to be filled by userspace. |
| * We increment here. If we reach max number of fragments, |
| * this indicates an underrun/overrun. For this case under OSS, |
| * we stop the record/playback process. |
| */ |
| if (atomic_read (&chan->n_frags) < chan->frag_number) |
| atomic_inc (&chan->n_frags); |
| assert (atomic_read (&chan->n_frags) <= chan->frag_number); |
| if (atomic_read (&chan->n_frags) == chan->frag_number) { |
| chan->is_active = 0; |
| via_chan_stop (chan->iobase); |
| } |
| } |
| /* wake up anyone listening to see when interrupts occur */ |
| wake_up_all (&chan->wait); |
| |
| DPRINTK ("%s intr, status=0x%02X, hwptr=0x%lX, chan->hw_ptr=%d\n", |
| chan->name, status, (long) inl (chan->iobase + 0x04), |
| atomic_read (&chan->hw_ptr)); |
| |
| DPRINTK ("%s intr, channel n_frags == %d, missed %d\n", chan->name, |
| atomic_read (&chan->n_frags), missed); |
| } |
| |
| |
| static irqreturn_t via_interrupt(int irq, void *dev_id, struct pt_regs *regs) |
| { |
| struct via_info *card = dev_id; |
| u32 status32; |
| |
| /* to minimize interrupt sharing costs, we use the SGD status |
| * shadow register to check the status of all inputs and |
| * outputs with a single 32-bit bus read. If no interrupt |
| * conditions are flagged, we exit immediately |
| */ |
| status32 = inl (card->baseaddr + VIA_BASE0_SGD_STATUS_SHADOW); |
| if (!(status32 & VIA_INTR_MASK)) |
| { |
| #ifdef CONFIG_MIDI_VIA82CXXX |
| if (card->midi_devc) |
| uart401intr(irq, card->midi_devc, regs); |
| #endif |
| return IRQ_HANDLED; |
| } |
| DPRINTK ("intr, status32 == 0x%08X\n", status32); |
| |
| /* synchronize interrupt handling under SMP. this spinlock |
| * goes away completely on UP |
| */ |
| spin_lock (&card->lock); |
| |
| if (status32 & VIA_INTR_OUT) |
| via_intr_channel (card, &card->ch_out); |
| if (status32 & VIA_INTR_IN) |
| via_intr_channel (card, &card->ch_in); |
| if (status32 & VIA_INTR_FM) |
| via_intr_channel (card, &card->ch_fm); |
| |
| spin_unlock (&card->lock); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static irqreturn_t via_new_interrupt(int irq, void *dev_id, struct pt_regs *regs) |
| { |
| struct via_info *card = dev_id; |
| u32 status32; |
| |
| /* to minimize interrupt sharing costs, we use the SGD status |
| * shadow register to check the status of all inputs and |
| * outputs with a single 32-bit bus read. If no interrupt |
| * conditions are flagged, we exit immediately |
| */ |
| status32 = inl (card->baseaddr + VIA_BASE0_SGD_STATUS_SHADOW); |
| if (!(status32 & VIA_NEW_INTR_MASK)) |
| return IRQ_NONE; |
| /* |
| * goes away completely on UP |
| */ |
| spin_lock (&card->lock); |
| |
| via_intr_channel (card, &card->ch_out); |
| via_intr_channel (card, &card->ch_in); |
| via_intr_channel (card, &card->ch_fm); |
| |
| spin_unlock (&card->lock); |
| return IRQ_HANDLED; |
| } |
| |
| |
| /** |
| * via_interrupt_init - Initialize interrupt handling |
| * @card: Private info for specified board |
| * |
| * Obtain and reserve IRQ for using in handling audio events. |
| * Also, disable any IRQ-generating resources, to make sure |
| * we don't get interrupts before we want them. |
| */ |
| |
| static int via_interrupt_init (struct via_info *card) |
| { |
| u8 tmp8; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (card != NULL); |
| assert (card->pdev != NULL); |
| |
| /* check for sane IRQ number. can this ever happen? */ |
| if (card->pdev->irq < 2) { |
| printk (KERN_ERR PFX "insane IRQ %d, aborting\n", |
| card->pdev->irq); |
| DPRINTK ("EXIT, returning -EIO\n"); |
| return -EIO; |
| } |
| |
| /* VIA requires this is done */ |
| pci_write_config_byte(card->pdev, PCI_INTERRUPT_LINE, card->pdev->irq); |
| |
| if(card->legacy) |
| { |
| /* make sure FM irq is not routed to us */ |
| pci_read_config_byte (card->pdev, VIA_FM_NMI_CTRL, &tmp8); |
| if ((tmp8 & VIA_CR48_FM_TRAP_TO_NMI) == 0) { |
| tmp8 |= VIA_CR48_FM_TRAP_TO_NMI; |
| pci_write_config_byte (card->pdev, VIA_FM_NMI_CTRL, tmp8); |
| } |
| if (request_irq (card->pdev->irq, via_interrupt, SA_SHIRQ, VIA_MODULE_NAME, card)) { |
| printk (KERN_ERR PFX "unable to obtain IRQ %d, aborting\n", |
| card->pdev->irq); |
| DPRINTK ("EXIT, returning -EBUSY\n"); |
| return -EBUSY; |
| } |
| } |
| else |
| { |
| if (request_irq (card->pdev->irq, via_new_interrupt, SA_SHIRQ, VIA_MODULE_NAME, card)) { |
| printk (KERN_ERR PFX "unable to obtain IRQ %d, aborting\n", |
| card->pdev->irq); |
| DPRINTK ("EXIT, returning -EBUSY\n"); |
| return -EBUSY; |
| } |
| } |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| } |
| |
| |
| /**************************************************************** |
| * |
| * OSS DSP device |
| * |
| */ |
| |
| static struct file_operations via_dsp_fops = { |
| .owner = THIS_MODULE, |
| .open = via_dsp_open, |
| .release = via_dsp_release, |
| .read = via_dsp_read, |
| .write = via_dsp_write, |
| .poll = via_dsp_poll, |
| .llseek = no_llseek, |
| .ioctl = via_dsp_ioctl, |
| .mmap = via_dsp_mmap, |
| }; |
| |
| |
| static int __devinit via_dsp_init (struct via_info *card) |
| { |
| u8 tmp8; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (card != NULL); |
| |
| if(card->legacy) |
| { |
| /* turn off legacy features, if not already */ |
| pci_read_config_byte (card->pdev, VIA_FUNC_ENABLE, &tmp8); |
| if (tmp8 & (VIA_CR42_SB_ENABLE | VIA_CR42_FM_ENABLE)) { |
| tmp8 &= ~(VIA_CR42_SB_ENABLE | VIA_CR42_FM_ENABLE); |
| pci_write_config_byte (card->pdev, VIA_FUNC_ENABLE, tmp8); |
| } |
| } |
| |
| via_stop_everything (card); |
| |
| card->dev_dsp = register_sound_dsp (&via_dsp_fops, -1); |
| if (card->dev_dsp < 0) { |
| DPRINTK ("EXIT, returning -ENODEV\n"); |
| return -ENODEV; |
| } |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| } |
| |
| |
| static void via_dsp_cleanup (struct via_info *card) |
| { |
| DPRINTK ("ENTER\n"); |
| |
| assert (card != NULL); |
| assert (card->dev_dsp >= 0); |
| |
| via_stop_everything (card); |
| |
| unregister_sound_dsp (card->dev_dsp); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| static struct page * via_mm_nopage (struct vm_area_struct * vma, |
| unsigned long address, int *type) |
| { |
| struct via_info *card = vma->vm_private_data; |
| struct via_channel *chan = &card->ch_out; |
| struct page *dmapage; |
| unsigned long pgoff; |
| int rd, wr; |
| |
| DPRINTK ("ENTER, start %lXh, ofs %lXh, pgoff %ld, addr %lXh\n", |
| vma->vm_start, |
| address - vma->vm_start, |
| (address - vma->vm_start) >> PAGE_SHIFT, |
| address); |
| |
| if (address > vma->vm_end) { |
| DPRINTK ("EXIT, returning NOPAGE_SIGBUS\n"); |
| return NOPAGE_SIGBUS; /* Disallow mremap */ |
| } |
| if (!card) { |
| DPRINTK ("EXIT, returning NOPAGE_OOM\n"); |
| return NOPAGE_OOM; /* Nothing allocated */ |
| } |
| |
| pgoff = vma->vm_pgoff + ((address - vma->vm_start) >> PAGE_SHIFT); |
| rd = card->ch_in.is_mapped; |
| wr = card->ch_out.is_mapped; |
| |
| #ifndef VIA_NDEBUG |
| { |
| unsigned long max_bufs = chan->frag_number; |
| if (rd && wr) max_bufs *= 2; |
| /* via_dsp_mmap() should ensure this */ |
| assert (pgoff < max_bufs); |
| } |
| #endif |
| |
| /* if full-duplex (read+write) and we have two sets of bufs, |
| * then the playback buffers come first, sez soundcard.c */ |
| if (pgoff >= chan->page_number) { |
| pgoff -= chan->page_number; |
| chan = &card->ch_in; |
| } else if (!wr) |
| chan = &card->ch_in; |
| |
| assert ((((unsigned long)chan->pgtbl[pgoff].cpuaddr) % PAGE_SIZE) == 0); |
| |
| dmapage = virt_to_page (chan->pgtbl[pgoff].cpuaddr); |
| DPRINTK ("EXIT, returning page %p for cpuaddr %lXh\n", |
| dmapage, (unsigned long) chan->pgtbl[pgoff].cpuaddr); |
| get_page (dmapage); |
| if (type) |
| *type = VM_FAULT_MINOR; |
| return dmapage; |
| } |
| |
| |
| #ifndef VM_RESERVED |
| static int via_mm_swapout (struct page *page, struct file *filp) |
| { |
| return 0; |
| } |
| #endif /* VM_RESERVED */ |
| |
| |
| static struct vm_operations_struct via_mm_ops = { |
| .nopage = via_mm_nopage, |
| |
| #ifndef VM_RESERVED |
| .swapout = via_mm_swapout, |
| #endif |
| }; |
| |
| |
| static int via_dsp_mmap(struct file *file, struct vm_area_struct *vma) |
| { |
| struct via_info *card; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| int rc = -EINVAL, rd=0, wr=0; |
| unsigned long max_size, size, start, offset; |
| |
| assert (file != NULL); |
| assert (vma != NULL); |
| card = file->private_data; |
| assert (card != NULL); |
| |
| DPRINTK ("ENTER, start %lXh, size %ld, pgoff %ld\n", |
| vma->vm_start, |
| vma->vm_end - vma->vm_start, |
| vma->vm_pgoff); |
| |
| max_size = 0; |
| if (vma->vm_flags & VM_READ) { |
| rd = 1; |
| via_chan_set_buffering(card, &card->ch_in, -1); |
| via_chan_buffer_init (card, &card->ch_in); |
| max_size += card->ch_in.page_number << PAGE_SHIFT; |
| } |
| if (vma->vm_flags & VM_WRITE) { |
| wr = 1; |
| via_chan_set_buffering(card, &card->ch_out, -1); |
| via_chan_buffer_init (card, &card->ch_out); |
| max_size += card->ch_out.page_number << PAGE_SHIFT; |
| } |
| |
| start = vma->vm_start; |
| offset = (vma->vm_pgoff << PAGE_SHIFT); |
| size = vma->vm_end - vma->vm_start; |
| |
| /* some basic size/offset sanity checks */ |
| if (size > max_size) |
| goto out; |
| if (offset > max_size - size) |
| goto out; |
| |
| rc = via_syscall_down (card, nonblock); |
| if (rc) goto out; |
| |
| vma->vm_ops = &via_mm_ops; |
| vma->vm_private_data = card; |
| |
| #ifdef VM_RESERVED |
| vma->vm_flags |= VM_RESERVED; |
| #endif |
| |
| if (rd) |
| card->ch_in.is_mapped = 1; |
| if (wr) |
| card->ch_out.is_mapped = 1; |
| |
| mutex_unlock(&card->syscall_mutex); |
| rc = 0; |
| |
| out: |
| DPRINTK ("EXIT, returning %d\n", rc); |
| return rc; |
| } |
| |
| |
| static ssize_t via_dsp_do_read (struct via_info *card, |
| char __user *userbuf, size_t count, |
| int nonblock) |
| { |
| DECLARE_WAITQUEUE(wait, current); |
| const char __user *orig_userbuf = userbuf; |
| struct via_channel *chan = &card->ch_in; |
| size_t size; |
| int n, tmp; |
| ssize_t ret = 0; |
| |
| /* if SGD has not yet been started, start it */ |
| via_chan_maybe_start (chan); |
| |
| handle_one_block: |
| /* just to be a nice neighbor */ |
| /* Thomas Sailer: |
| * But also to ourselves, release semaphore if we do so */ |
| if (need_resched()) { |
| mutex_unlock(&card->syscall_mutex); |
| schedule (); |
| ret = via_syscall_down (card, nonblock); |
| if (ret) |
| goto out; |
| } |
| |
| /* grab current channel software pointer. In the case of |
| * recording, this is pointing to the next buffer that |
| * will receive data from the audio hardware. |
| */ |
| n = chan->sw_ptr; |
| |
| /* n_frags represents the number of fragments waiting |
| * to be copied to userland. sleep until at least |
| * one buffer has been read from the audio hardware. |
| */ |
| add_wait_queue(&chan->wait, &wait); |
| for (;;) { |
| __set_current_state(TASK_INTERRUPTIBLE); |
| tmp = atomic_read (&chan->n_frags); |
| assert (tmp >= 0); |
| assert (tmp <= chan->frag_number); |
| if (tmp) |
| break; |
| if (nonblock || !chan->is_active) { |
| ret = -EAGAIN; |
| break; |
| } |
| |
| mutex_unlock(&card->syscall_mutex); |
| |
| DPRINTK ("Sleeping on block %d\n", n); |
| schedule(); |
| |
| ret = via_syscall_down (card, nonblock); |
| if (ret) |
| break; |
| |
| if (signal_pending (current)) { |
| ret = -ERESTARTSYS; |
| break; |
| } |
| } |
| set_current_state(TASK_RUNNING); |
| remove_wait_queue(&chan->wait, &wait); |
| if (ret) |
| goto out; |
| |
| /* Now that we have a buffer we can read from, send |
| * as much as sample data possible to userspace. |
| */ |
| while ((count > 0) && (chan->slop_len < chan->frag_size)) { |
| size_t slop_left = chan->frag_size - chan->slop_len; |
| void *base = chan->pgtbl[n / (PAGE_SIZE / chan->frag_size)].cpuaddr; |
| unsigned ofs = (n % (PAGE_SIZE / chan->frag_size)) * chan->frag_size; |
| |
| size = (count < slop_left) ? count : slop_left; |
| if (copy_to_user (userbuf, |
| base + ofs + chan->slop_len, |
| size)) { |
| ret = -EFAULT; |
| goto out; |
| } |
| |
| count -= size; |
| chan->slop_len += size; |
| userbuf += size; |
| } |
| |
| /* If we didn't copy the buffer completely to userspace, |
| * stop now. |
| */ |
| if (chan->slop_len < chan->frag_size) |
| goto out; |
| |
| /* |
| * If we get to this point, we copied one buffer completely |
| * to userspace, give the buffer back to the hardware. |
| */ |
| |
| /* advance channel software pointer to point to |
| * the next buffer from which we will copy |
| */ |
| if (chan->sw_ptr == (chan->frag_number - 1)) |
| chan->sw_ptr = 0; |
| else |
| chan->sw_ptr++; |
| |
| /* mark one less buffer waiting to be processed */ |
| assert (atomic_read (&chan->n_frags) > 0); |
| atomic_dec (&chan->n_frags); |
| |
| /* we are at a block boundary, there is no fragment data */ |
| chan->slop_len = 0; |
| |
| DPRINTK ("Flushed block %u, sw_ptr now %u, n_frags now %d\n", |
| n, chan->sw_ptr, atomic_read (&chan->n_frags)); |
| |
| DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", |
| inb (card->baseaddr + 0x00), |
| inb (card->baseaddr + 0x01), |
| inb (card->baseaddr + 0x02), |
| inl (card->baseaddr + 0x04), |
| inl (card->baseaddr + 0x0C), |
| inl (card->baseaddr + 0x80), |
| inl (card->baseaddr + 0x84)); |
| |
| if (count > 0) |
| goto handle_one_block; |
| |
| out: |
| return (userbuf != orig_userbuf) ? (userbuf - orig_userbuf) : ret; |
| } |
| |
| |
| static ssize_t via_dsp_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos) |
| { |
| struct via_info *card; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| int rc; |
| |
| DPRINTK ("ENTER, file=%p, buffer=%p, count=%u, ppos=%lu\n", |
| file, buffer, count, ppos ? ((unsigned long)*ppos) : 0); |
| |
| assert (file != NULL); |
| card = file->private_data; |
| assert (card != NULL); |
| |
| rc = via_syscall_down (card, nonblock); |
| if (rc) goto out; |
| |
| if (card->ch_in.is_mapped) { |
| rc = -ENXIO; |
| goto out_up; |
| } |
| |
| via_chan_set_buffering(card, &card->ch_in, -1); |
| rc = via_chan_buffer_init (card, &card->ch_in); |
| |
| if (rc) |
| goto out_up; |
| |
| rc = via_dsp_do_read (card, buffer, count, nonblock); |
| |
| out_up: |
| mutex_unlock(&card->syscall_mutex); |
| out: |
| DPRINTK ("EXIT, returning %ld\n",(long) rc); |
| return rc; |
| } |
| |
| |
| static ssize_t via_dsp_do_write (struct via_info *card, |
| const char __user *userbuf, size_t count, |
| int nonblock) |
| { |
| DECLARE_WAITQUEUE(wait, current); |
| const char __user *orig_userbuf = userbuf; |
| struct via_channel *chan = &card->ch_out; |
| volatile struct via_sgd_table *sgtable = chan->sgtable; |
| size_t size; |
| int n, tmp; |
| ssize_t ret = 0; |
| |
| handle_one_block: |
| /* just to be a nice neighbor */ |
| /* Thomas Sailer: |
| * But also to ourselves, release semaphore if we do so */ |
| if (need_resched()) { |
| mutex_unlock(&card->syscall_mutex); |
| schedule (); |
| ret = via_syscall_down (card, nonblock); |
| if (ret) |
| goto out; |
| } |
| |
| /* grab current channel fragment pointer. In the case of |
| * playback, this is pointing to the next fragment that |
| * should receive data from userland. |
| */ |
| n = chan->sw_ptr; |
| |
| /* n_frags represents the number of fragments remaining |
| * to be filled by userspace. Sleep until |
| * at least one fragment is available for our use. |
| */ |
| add_wait_queue(&chan->wait, &wait); |
| for (;;) { |
| __set_current_state(TASK_INTERRUPTIBLE); |
| tmp = atomic_read (&chan->n_frags); |
| assert (tmp >= 0); |
| assert (tmp <= chan->frag_number); |
| if (tmp) |
| break; |
| if (nonblock || !chan->is_active) { |
| ret = -EAGAIN; |
| break; |
| } |
| |
| mutex_unlock(&card->syscall_mutex); |
| |
| DPRINTK ("Sleeping on page %d, tmp==%d, ir==%d\n", n, tmp, chan->is_record); |
| schedule(); |
| |
| ret = via_syscall_down (card, nonblock); |
| if (ret) |
| break; |
| |
| if (signal_pending (current)) { |
| ret = -ERESTARTSYS; |
| break; |
| } |
| } |
| set_current_state(TASK_RUNNING); |
| remove_wait_queue(&chan->wait, &wait); |
| if (ret) |
| goto out; |
| |
| /* Now that we have at least one fragment we can write to, fill the buffer |
| * as much as possible with data from userspace. |
| */ |
| while ((count > 0) && (chan->slop_len < chan->frag_size)) { |
| size_t slop_left = chan->frag_size - chan->slop_len; |
| |
| size = (count < slop_left) ? count : slop_left; |
| if (copy_from_user (chan->pgtbl[n / (PAGE_SIZE / chan->frag_size)].cpuaddr + (n % (PAGE_SIZE / chan->frag_size)) * chan->frag_size + chan->slop_len, |
| userbuf, size)) { |
| ret = -EFAULT; |
| goto out; |
| } |
| |
| count -= size; |
| chan->slop_len += size; |
| userbuf += size; |
| } |
| |
| /* If we didn't fill up the buffer with data, stop now. |
| * Put a 'stop' marker in the DMA table too, to tell the |
| * audio hardware to stop if it gets here. |
| */ |
| if (chan->slop_len < chan->frag_size) { |
| sgtable[n].count = cpu_to_le32 (chan->slop_len | VIA_EOL | VIA_STOP); |
| goto out; |
| } |
| |
| /* |
| * If we get to this point, we have filled a buffer with |
| * audio data, flush the buffer to audio hardware. |
| */ |
| |
| /* Record the true size for the audio hardware to notice */ |
| if (n == (chan->frag_number - 1)) |
| sgtable[n].count = cpu_to_le32 (chan->frag_size | VIA_EOL); |
| else |
| sgtable[n].count = cpu_to_le32 (chan->frag_size | VIA_FLAG); |
| |
| /* advance channel software pointer to point to |
| * the next buffer we will fill with data |
| */ |
| if (chan->sw_ptr == (chan->frag_number - 1)) |
| chan->sw_ptr = 0; |
| else |
| chan->sw_ptr++; |
| |
| /* mark one less buffer as being available for userspace consumption */ |
| assert (atomic_read (&chan->n_frags) > 0); |
| atomic_dec (&chan->n_frags); |
| |
| /* we are at a block boundary, there is no fragment data */ |
| chan->slop_len = 0; |
| |
| /* if SGD has not yet been started, start it */ |
| via_chan_maybe_start (chan); |
| |
| DPRINTK ("Flushed block %u, sw_ptr now %u, n_frags now %d\n", |
| n, chan->sw_ptr, atomic_read (&chan->n_frags)); |
| |
| DPRINTK ("regs==S=%02X C=%02X TP=%02X BP=%08X RT=%08X SG=%08X CC=%08X SS=%08X\n", |
| inb (card->baseaddr + 0x00), |
| inb (card->baseaddr + 0x01), |
| inb (card->baseaddr + 0x02), |
| inl (card->baseaddr + 0x04), |
| inl (card->baseaddr + 0x08), |
| inl (card->baseaddr + 0x0C), |
| inl (card->baseaddr + 0x80), |
| inl (card->baseaddr + 0x84)); |
| |
| if (count > 0) |
| goto handle_one_block; |
| |
| out: |
| if (userbuf - orig_userbuf) |
| return userbuf - orig_userbuf; |
| else |
| return ret; |
| } |
| |
| |
| static ssize_t via_dsp_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) |
| { |
| struct via_info *card; |
| ssize_t rc; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| |
| DPRINTK ("ENTER, file=%p, buffer=%p, count=%u, ppos=%lu\n", |
| file, buffer, count, ppos ? ((unsigned long)*ppos) : 0); |
| |
| assert (file != NULL); |
| card = file->private_data; |
| assert (card != NULL); |
| |
| rc = via_syscall_down (card, nonblock); |
| if (rc) goto out; |
| |
| if (card->ch_out.is_mapped) { |
| rc = -ENXIO; |
| goto out_up; |
| } |
| |
| via_chan_set_buffering(card, &card->ch_out, -1); |
| rc = via_chan_buffer_init (card, &card->ch_out); |
| |
| if (rc) |
| goto out_up; |
| |
| rc = via_dsp_do_write (card, buffer, count, nonblock); |
| |
| out_up: |
| mutex_unlock(&card->syscall_mutex); |
| out: |
| DPRINTK ("EXIT, returning %ld\n",(long) rc); |
| return rc; |
| } |
| |
| |
| static unsigned int via_dsp_poll(struct file *file, struct poll_table_struct *wait) |
| { |
| struct via_info *card; |
| struct via_channel *chan; |
| unsigned int mask = 0; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (file != NULL); |
| card = file->private_data; |
| assert (card != NULL); |
| |
| if (file->f_mode & FMODE_READ) { |
| chan = &card->ch_in; |
| if (sg_active (chan->iobase)) |
| poll_wait(file, &chan->wait, wait); |
| if (atomic_read (&chan->n_frags) > 0) |
| mask |= POLLIN | POLLRDNORM; |
| } |
| |
| if (file->f_mode & FMODE_WRITE) { |
| chan = &card->ch_out; |
| if (sg_active (chan->iobase)) |
| poll_wait(file, &chan->wait, wait); |
| if (atomic_read (&chan->n_frags) > 0) |
| mask |= POLLOUT | POLLWRNORM; |
| } |
| |
| DPRINTK ("EXIT, returning %u\n", mask); |
| return mask; |
| } |
| |
| |
| /** |
| * via_dsp_drain_playback - sleep until all playback samples are flushed |
| * @card: Private info for specified board |
| * @chan: Channel to drain |
| * @nonblock: boolean, non-zero if O_NONBLOCK is set |
| * |
| * Sleeps until all playback has been flushed to the audio |
| * hardware. |
| * |
| * Locking: inside card->syscall_mutex |
| */ |
| |
| static int via_dsp_drain_playback (struct via_info *card, |
| struct via_channel *chan, int nonblock) |
| { |
| DECLARE_WAITQUEUE(wait, current); |
| int ret = 0; |
| |
| DPRINTK ("ENTER, nonblock = %d\n", nonblock); |
| |
| if (chan->slop_len > 0) |
| via_chan_flush_frag (chan); |
| |
| if (atomic_read (&chan->n_frags) == chan->frag_number) |
| goto out; |
| |
| via_chan_maybe_start (chan); |
| |
| add_wait_queue(&chan->wait, &wait); |
| for (;;) { |
| DPRINTK ("FRAGS %d FRAGNUM %d\n", atomic_read(&chan->n_frags), chan->frag_number); |
| __set_current_state(TASK_INTERRUPTIBLE); |
| if (atomic_read (&chan->n_frags) >= chan->frag_number) |
| break; |
| |
| if (nonblock) { |
| DPRINTK ("EXIT, returning -EAGAIN\n"); |
| ret = -EAGAIN; |
| break; |
| } |
| |
| #ifdef VIA_DEBUG |
| { |
| u8 r40,r41,r42,r43,r44,r48; |
| pci_read_config_byte (card->pdev, 0x40, &r40); |
| pci_read_config_byte (card->pdev, 0x41, &r41); |
| pci_read_config_byte (card->pdev, 0x42, &r42); |
| pci_read_config_byte (card->pdev, 0x43, &r43); |
| pci_read_config_byte (card->pdev, 0x44, &r44); |
| pci_read_config_byte (card->pdev, 0x48, &r48); |
| DPRINTK ("PCI config: %02X %02X %02X %02X %02X %02X\n", |
| r40,r41,r42,r43,r44,r48); |
| |
| DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", |
| inb (card->baseaddr + 0x00), |
| inb (card->baseaddr + 0x01), |
| inb (card->baseaddr + 0x02), |
| inl (card->baseaddr + 0x04), |
| inl (card->baseaddr + 0x0C), |
| inl (card->baseaddr + 0x80), |
| inl (card->baseaddr + 0x84)); |
| } |
| |
| if (!chan->is_active) |
| printk (KERN_ERR "sleeping but not active\n"); |
| #endif |
| |
| mutex_unlock(&card->syscall_mutex); |
| |
| DPRINTK ("sleeping, nbufs=%d\n", atomic_read (&chan->n_frags)); |
| schedule(); |
| |
| if ((ret = via_syscall_down (card, nonblock))) |
| break; |
| |
| if (signal_pending (current)) { |
| DPRINTK ("EXIT, returning -ERESTARTSYS\n"); |
| ret = -ERESTARTSYS; |
| break; |
| } |
| } |
| set_current_state(TASK_RUNNING); |
| remove_wait_queue(&chan->wait, &wait); |
| |
| #ifdef VIA_DEBUG |
| { |
| u8 r40,r41,r42,r43,r44,r48; |
| pci_read_config_byte (card->pdev, 0x40, &r40); |
| pci_read_config_byte (card->pdev, 0x41, &r41); |
| pci_read_config_byte (card->pdev, 0x42, &r42); |
| pci_read_config_byte (card->pdev, 0x43, &r43); |
| pci_read_config_byte (card->pdev, 0x44, &r44); |
| pci_read_config_byte (card->pdev, 0x48, &r48); |
| DPRINTK ("PCI config: %02X %02X %02X %02X %02X %02X\n", |
| r40,r41,r42,r43,r44,r48); |
| |
| DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", |
| inb (card->baseaddr + 0x00), |
| inb (card->baseaddr + 0x01), |
| inb (card->baseaddr + 0x02), |
| inl (card->baseaddr + 0x04), |
| inl (card->baseaddr + 0x0C), |
| inl (card->baseaddr + 0x80), |
| inl (card->baseaddr + 0x84)); |
| |
| DPRINTK ("final nbufs=%d\n", atomic_read (&chan->n_frags)); |
| } |
| #endif |
| |
| out: |
| DPRINTK ("EXIT, returning %d\n", ret); |
| return ret; |
| } |
| |
| |
| /** |
| * via_dsp_ioctl_space - get information about channel buffering |
| * @card: Private info for specified board |
| * @chan: pointer to channel-specific info |
| * @arg: user buffer for returned information |
| * |
| * Handles SNDCTL_DSP_GETISPACE and SNDCTL_DSP_GETOSPACE. |
| * |
| * Locking: inside card->syscall_mutex |
| */ |
| |
| static int via_dsp_ioctl_space (struct via_info *card, |
| struct via_channel *chan, |
| void __user *arg) |
| { |
| audio_buf_info info; |
| |
| via_chan_set_buffering(card, chan, -1); |
| |
| info.fragstotal = chan->frag_number; |
| info.fragsize = chan->frag_size; |
| |
| /* number of full fragments we can read/write without blocking */ |
| info.fragments = atomic_read (&chan->n_frags); |
| |
| if ((chan->slop_len % chan->frag_size > 0) && (info.fragments > 0)) |
| info.fragments--; |
| |
| /* number of bytes that can be read or written immediately |
| * without blocking. |
| */ |
| info.bytes = (info.fragments * chan->frag_size); |
| if (chan->slop_len % chan->frag_size > 0) |
| info.bytes += chan->frag_size - (chan->slop_len % chan->frag_size); |
| |
| DPRINTK ("EXIT, returning fragstotal=%d, fragsize=%d, fragments=%d, bytes=%d\n", |
| info.fragstotal, |
| info.fragsize, |
| info.fragments, |
| info.bytes); |
| |
| return copy_to_user (arg, &info, sizeof (info))?-EFAULT:0; |
| } |
| |
| |
| /** |
| * via_dsp_ioctl_ptr - get information about hardware buffer ptr |
| * @card: Private info for specified board |
| * @chan: pointer to channel-specific info |
| * @arg: user buffer for returned information |
| * |
| * Handles SNDCTL_DSP_GETIPTR and SNDCTL_DSP_GETOPTR. |
| * |
| * Locking: inside card->syscall_mutex |
| */ |
| |
| static int via_dsp_ioctl_ptr (struct via_info *card, |
| struct via_channel *chan, |
| void __user *arg) |
| { |
| count_info info; |
| |
| spin_lock_irq (&card->lock); |
| |
| info.bytes = chan->bytes; |
| info.blocks = chan->n_irqs; |
| chan->n_irqs = 0; |
| |
| spin_unlock_irq (&card->lock); |
| |
| if (chan->is_active) { |
| unsigned long extra; |
| info.ptr = atomic_read (&chan->hw_ptr) * chan->frag_size; |
| extra = chan->frag_size - via_sg_offset(chan); |
| info.ptr += extra; |
| info.bytes += extra; |
| } else { |
| info.ptr = 0; |
| } |
| |
| DPRINTK ("EXIT, returning bytes=%d, blocks=%d, ptr=%d\n", |
| info.bytes, |
| info.blocks, |
| info.ptr); |
| |
| return copy_to_user (arg, &info, sizeof (info))?-EFAULT:0; |
| } |
| |
| |
| static int via_dsp_ioctl_trigger (struct via_channel *chan, int val) |
| { |
| int enable, do_something; |
| |
| if (chan->is_record) |
| enable = (val & PCM_ENABLE_INPUT); |
| else |
| enable = (val & PCM_ENABLE_OUTPUT); |
| |
| if (!chan->is_enabled && enable) { |
| do_something = 1; |
| } else if (chan->is_enabled && !enable) { |
| do_something = -1; |
| } else { |
| do_something = 0; |
| } |
| |
| DPRINTK ("enable=%d, do_something=%d\n", |
| enable, do_something); |
| |
| if (chan->is_active && do_something) |
| return -EINVAL; |
| |
| if (do_something == 1) { |
| chan->is_enabled = 1; |
| via_chan_maybe_start (chan); |
| DPRINTK ("Triggering input\n"); |
| } |
| |
| else if (do_something == -1) { |
| chan->is_enabled = 0; |
| DPRINTK ("Setup input trigger\n"); |
| } |
| |
| return 0; |
| } |
| |
| |
| static int via_dsp_ioctl (struct inode *inode, struct file *file, |
| unsigned int cmd, unsigned long arg) |
| { |
| int rc, rd=0, wr=0, val=0; |
| struct via_info *card; |
| struct via_channel *chan; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| int __user *ip = (int __user *)arg; |
| void __user *p = (void __user *)arg; |
| |
| assert (file != NULL); |
| card = file->private_data; |
| assert (card != NULL); |
| |
| if (file->f_mode & FMODE_WRITE) |
| wr = 1; |
| if (file->f_mode & FMODE_READ) |
| rd = 1; |
| |
| rc = via_syscall_down (card, nonblock); |
| if (rc) |
| return rc; |
| rc = -EINVAL; |
| |
| switch (cmd) { |
| |
| /* OSS API version. XXX unverified */ |
| case OSS_GETVERSION: |
| DPRINTK ("ioctl OSS_GETVERSION, EXIT, returning SOUND_VERSION\n"); |
| rc = put_user (SOUND_VERSION, ip); |
| break; |
| |
| /* list of supported PCM data formats */ |
| case SNDCTL_DSP_GETFMTS: |
| DPRINTK ("DSP_GETFMTS, EXIT, returning AFMT U8|S16_LE\n"); |
| rc = put_user (AFMT_U8 | AFMT_S16_LE, ip); |
| break; |
| |
| /* query or set current channel's PCM data format */ |
| case SNDCTL_DSP_SETFMT: |
| if (get_user(val, ip)) { |
| rc = -EFAULT; |
| break; |
| } |
| DPRINTK ("DSP_SETFMT, val==%d\n", val); |
| if (val != AFMT_QUERY) { |
| rc = 0; |
| |
| if (rd) |
| rc = via_chan_set_fmt (card, &card->ch_in, val); |
| |
| if (rc >= 0 && wr) |
| rc = via_chan_set_fmt (card, &card->ch_out, val); |
| |
| if (rc < 0) |
| break; |
| |
| val = rc; |
| } else { |
| if ((rd && (card->ch_in.pcm_fmt & VIA_PCM_FMT_16BIT)) || |
| (wr && (card->ch_out.pcm_fmt & VIA_PCM_FMT_16BIT))) |
| val = AFMT_S16_LE; |
| else |
| val = AFMT_U8; |
| } |
| DPRINTK ("SETFMT EXIT, returning %d\n", val); |
| rc = put_user (val, ip); |
| break; |
| |
| /* query or set number of channels (1=mono, 2=stereo, 4/6 for multichannel) */ |
| case SNDCTL_DSP_CHANNELS: |
| if (get_user(val, ip)) { |
| rc = -EFAULT; |
| break; |
| } |
| DPRINTK ("DSP_CHANNELS, val==%d\n", val); |
| if (val != 0) { |
| rc = 0; |
| |
| if (rd) |
| rc = via_chan_set_stereo (card, &card->ch_in, val); |
| |
| if (rc >= 0 && wr) |
| rc = via_chan_set_stereo (card, &card->ch_out, val); |
| |
| if (rc < 0) |
| break; |
| |
| val = rc; |
| } else { |
| if (rd) |
| val = card->ch_in.channels; |
| else |
| val = card->ch_out.channels; |
| } |
| DPRINTK ("CHANNELS EXIT, returning %d\n", val); |
| rc = put_user (val, ip); |
| break; |
| |
| /* enable (val is not zero) or disable (val == 0) stereo */ |
| case SNDCTL_DSP_STEREO: |
| if (get_user(val, ip)) { |
| rc = -EFAULT; |
| break; |
| } |
| DPRINTK ("DSP_STEREO, val==%d\n", val); |
| rc = 0; |
| |
| if (rd) |
| rc = via_chan_set_stereo (card, &card->ch_in, val ? 2 : 1); |
| if (rc >= 0 && wr) |
| rc = via_chan_set_stereo (card, &card->ch_out, val ? 2 : 1); |
| |
| if (rc < 0) |
| break; |
| |
| val = rc - 1; |
| |
| DPRINTK ("STEREO EXIT, returning %d\n", val); |
| rc = put_user(val, ip); |
| break; |
| |
| /* query or set sampling rate */ |
| case SNDCTL_DSP_SPEED: |
| if (get_user(val, ip)) { |
| rc = -EFAULT; |
| break; |
| } |
| DPRINTK ("DSP_SPEED, val==%d\n", val); |
| if (val < 0) { |
| rc = -EINVAL; |
| break; |
| } |
| if (val > 0) { |
| rc = 0; |
| |
| if (rd) |
| rc = via_chan_set_speed (card, &card->ch_in, val); |
| if (rc >= 0 && wr) |
| rc = via_chan_set_speed (card, &card->ch_out, val); |
| |
| if (rc < 0) |
| break; |
| |
| val = rc; |
| } else { |
| if (rd) |
| val = card->ch_in.rate; |
| else if (wr) |
| val = card->ch_out.rate; |
| else |
| val = 0; |
| } |
| DPRINTK ("SPEED EXIT, returning %d\n", val); |
| rc = put_user (val, ip); |
| break; |
| |
| /* wait until all buffers have been played, and then stop device */ |
| case SNDCTL_DSP_SYNC: |
| DPRINTK ("DSP_SYNC\n"); |
| rc = 0; |
| if (wr) { |
| DPRINTK ("SYNC EXIT (after calling via_dsp_drain_playback)\n"); |
| rc = via_dsp_drain_playback (card, &card->ch_out, nonblock); |
| } |
| break; |
| |
| /* stop recording/playback immediately */ |
| case SNDCTL_DSP_RESET: |
| DPRINTK ("DSP_RESET\n"); |
| if (rd) { |
| via_chan_clear (card, &card->ch_in); |
| card->ch_in.frag_number = 0; |
| card->ch_in.frag_size = 0; |
| atomic_set(&card->ch_in.n_frags, 0); |
| } |
| |
| if (wr) { |
| via_chan_clear (card, &card->ch_out); |
| card->ch_out.frag_number = 0; |
| card->ch_out.frag_size = 0; |
| atomic_set(&card->ch_out.n_frags, 0); |
| } |
| |
| rc = 0; |
| break; |
| |
| case SNDCTL_DSP_NONBLOCK: |
| file->f_flags |= O_NONBLOCK; |
| rc = 0; |
| break; |
| |
| /* obtain bitmask of device capabilities, such as mmap, full duplex, etc. */ |
| case SNDCTL_DSP_GETCAPS: |
| DPRINTK ("DSP_GETCAPS\n"); |
| rc = put_user(VIA_DSP_CAP, ip); |
| break; |
| |
| /* obtain buffer fragment size */ |
| case SNDCTL_DSP_GETBLKSIZE: |
| DPRINTK ("DSP_GETBLKSIZE\n"); |
| |
| if (rd) { |
| via_chan_set_buffering(card, &card->ch_in, -1); |
| rc = put_user(card->ch_in.frag_size, ip); |
| } else if (wr) { |
| via_chan_set_buffering(card, &card->ch_out, -1); |
| rc = put_user(card->ch_out.frag_size, ip); |
| } |
| break; |
| |
| /* obtain information about input buffering */ |
| case SNDCTL_DSP_GETISPACE: |
| DPRINTK ("DSP_GETISPACE\n"); |
| if (rd) |
| rc = via_dsp_ioctl_space (card, &card->ch_in, p); |
| break; |
| |
| /* obtain information about output buffering */ |
| case SNDCTL_DSP_GETOSPACE: |
| DPRINTK ("DSP_GETOSPACE\n"); |
| if (wr) |
| rc = via_dsp_ioctl_space (card, &card->ch_out, p); |
| break; |
| |
| /* obtain information about input hardware pointer */ |
| case SNDCTL_DSP_GETIPTR: |
| DPRINTK ("DSP_GETIPTR\n"); |
| if (rd) |
| rc = via_dsp_ioctl_ptr (card, &card->ch_in, p); |
| break; |
| |
| /* obtain information about output hardware pointer */ |
| case SNDCTL_DSP_GETOPTR: |
| DPRINTK ("DSP_GETOPTR\n"); |
| if (wr) |
| rc = via_dsp_ioctl_ptr (card, &card->ch_out, p); |
| break; |
| |
| /* return number of bytes remaining to be played by DMA engine */ |
| case SNDCTL_DSP_GETODELAY: |
| { |
| DPRINTK ("DSP_GETODELAY\n"); |
| |
| chan = &card->ch_out; |
| |
| if (!wr) |
| break; |
| |
| if (chan->is_active) { |
| |
| val = chan->frag_number - atomic_read (&chan->n_frags); |
| |
| assert(val >= 0); |
| |
| if (val > 0) { |
| val *= chan->frag_size; |
| val -= chan->frag_size - via_sg_offset(chan); |
| } |
| val += chan->slop_len % chan->frag_size; |
| } else |
| val = 0; |
| |
| assert (val <= (chan->frag_size * chan->frag_number)); |
| |
| DPRINTK ("GETODELAY EXIT, val = %d bytes\n", val); |
| rc = put_user (val, ip); |
| break; |
| } |
| |
| /* handle the quick-start of a channel, |
| * or the notification that a quick-start will |
| * occur in the future |
| */ |
| case SNDCTL_DSP_SETTRIGGER: |
| if (get_user(val, ip)) { |
| rc = -EFAULT; |
| break; |
| } |
| DPRINTK ("DSP_SETTRIGGER, rd=%d, wr=%d, act=%d/%d, en=%d/%d\n", |
| rd, wr, card->ch_in.is_active, card->ch_out.is_active, |
| card->ch_in.is_enabled, card->ch_out.is_enabled); |
| |
| rc = 0; |
| |
| if (rd) |
| rc = via_dsp_ioctl_trigger (&card->ch_in, val); |
| |
| if (!rc && wr) |
| rc = via_dsp_ioctl_trigger (&card->ch_out, val); |
| |
| break; |
| |
| case SNDCTL_DSP_GETTRIGGER: |
| val = 0; |
| if ((file->f_mode & FMODE_READ) && card->ch_in.is_enabled) |
| val |= PCM_ENABLE_INPUT; |
| if ((file->f_mode & FMODE_WRITE) && card->ch_out.is_enabled) |
| val |= PCM_ENABLE_OUTPUT; |
| rc = put_user(val, ip); |
| break; |
| |
| /* Enable full duplex. Since we do this as soon as we are opened |
| * with O_RDWR, this is mainly a no-op that always returns success. |
| */ |
| case SNDCTL_DSP_SETDUPLEX: |
| DPRINTK ("DSP_SETDUPLEX\n"); |
| if (!rd || !wr) |
| break; |
| rc = 0; |
| break; |
| |
| /* set fragment size. implemented as a successful no-op for now */ |
| case SNDCTL_DSP_SETFRAGMENT: |
| if (get_user(val, ip)) { |
| rc = -EFAULT; |
| break; |
| } |
| DPRINTK ("DSP_SETFRAGMENT, val==%d\n", val); |
| |
| if (rd) |
| rc = via_chan_set_buffering(card, &card->ch_in, val); |
| |
| if (wr) |
| rc = via_chan_set_buffering(card, &card->ch_out, val); |
| |
| DPRINTK ("SNDCTL_DSP_SETFRAGMENT (fragshift==0x%04X (%d), maxfrags==0x%04X (%d))\n", |
| val & 0xFFFF, |
| val & 0xFFFF, |
| (val >> 16) & 0xFFFF, |
| (val >> 16) & 0xFFFF); |
| |
| rc = 0; |
| break; |
| |
| /* inform device of an upcoming pause in input (or output). */ |
| case SNDCTL_DSP_POST: |
| DPRINTK ("DSP_POST\n"); |
| if (wr) { |
| if (card->ch_out.slop_len > 0) |
| via_chan_flush_frag (&card->ch_out); |
| via_chan_maybe_start (&card->ch_out); |
| } |
| |
| rc = 0; |
| break; |
| |
| /* not implemented */ |
| default: |
| DPRINTK ("unhandled ioctl, cmd==%u, arg==%p\n", |
| cmd, p); |
| break; |
| } |
| |
| mutex_unlock(&card->syscall_mutex); |
| DPRINTK ("EXIT, returning %d\n", rc); |
| return rc; |
| } |
| |
| |
| static int via_dsp_open (struct inode *inode, struct file *file) |
| { |
| int minor = iminor(inode); |
| struct via_info *card; |
| struct pci_dev *pdev = NULL; |
| struct via_channel *chan; |
| struct pci_driver *drvr; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| |
| DPRINTK ("ENTER, minor=%d, file->f_mode=0x%x\n", minor, file->f_mode); |
| |
| if (!(file->f_mode & (FMODE_READ | FMODE_WRITE))) { |
| DPRINTK ("EXIT, returning -EINVAL\n"); |
| return -EINVAL; |
| } |
| |
| card = NULL; |
| while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) { |
| drvr = pci_dev_driver (pdev); |
| if (drvr == &via_driver) { |
| assert (pci_get_drvdata (pdev) != NULL); |
| |
| card = pci_get_drvdata (pdev); |
| DPRINTK ("dev_dsp = %d, minor = %d, assn = %d\n", |
| card->dev_dsp, minor, |
| (card->dev_dsp ^ minor) & ~0xf); |
| |
| if (((card->dev_dsp ^ minor) & ~0xf) == 0) |
| goto match; |
| } |
| } |
| |
| DPRINTK ("no matching %s found\n", card ? "minor" : "driver"); |
| return -ENODEV; |
| |
| match: |
| if (nonblock) { |
| if (!mutex_trylock(&card->open_mutex)) { |
| DPRINTK ("EXIT, returning -EAGAIN\n"); |
| return -EAGAIN; |
| } |
| } else { |
| if (mutex_lock_interruptible(&card->open_mutex)) { |
| DPRINTK ("EXIT, returning -ERESTARTSYS\n"); |
| return -ERESTARTSYS; |
| } |
| } |
| |
| file->private_data = card; |
| DPRINTK ("file->f_mode == 0x%x\n", file->f_mode); |
| |
| /* handle input from analog source */ |
| if (file->f_mode & FMODE_READ) { |
| chan = &card->ch_in; |
| |
| via_chan_init (card, chan); |
| |
| /* why is this forced to 16-bit stereo in all drivers? */ |
| chan->pcm_fmt = VIA_PCM_FMT_16BIT | VIA_PCM_FMT_STEREO; |
| chan->channels = 2; |
| |
| // TO DO - use FIFO: via_capture_fifo(card, 1); |
| via_chan_pcm_fmt (chan, 0); |
| via_set_rate (card->ac97, chan, 44100); |
| } |
| |
| /* handle output to analog source */ |
| if (file->f_mode & FMODE_WRITE) { |
| chan = &card->ch_out; |
| |
| via_chan_init (card, chan); |
| |
| if (file->f_mode & FMODE_READ) { |
| /* if in duplex mode make the recording and playback channels |
| have the same settings */ |
| chan->pcm_fmt = VIA_PCM_FMT_16BIT | VIA_PCM_FMT_STEREO; |
| chan->channels = 2; |
| via_chan_pcm_fmt (chan, 0); |
| via_set_rate (card->ac97, chan, 44100); |
| } else { |
| if ((minor & 0xf) == SND_DEV_DSP16) { |
| chan->pcm_fmt = VIA_PCM_FMT_16BIT; |
| via_chan_pcm_fmt (chan, 0); |
| via_set_rate (card->ac97, chan, 44100); |
| } else { |
| via_chan_pcm_fmt (chan, 1); |
| via_set_rate (card->ac97, chan, 8000); |
| } |
| } |
| } |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return nonseekable_open(inode, file); |
| } |
| |
| |
| static int via_dsp_release(struct inode *inode, struct file *file) |
| { |
| struct via_info *card; |
| int nonblock = (file->f_flags & O_NONBLOCK); |
| int rc; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (file != NULL); |
| card = file->private_data; |
| assert (card != NULL); |
| |
| rc = via_syscall_down (card, nonblock); |
| if (rc) { |
| DPRINTK ("EXIT (syscall_down error), rc=%d\n", rc); |
| return rc; |
| } |
| |
| if (file->f_mode & FMODE_WRITE) { |
| rc = via_dsp_drain_playback (card, &card->ch_out, nonblock); |
| if (rc && rc != -ERESTARTSYS) /* Nobody needs to know about ^C */ |
| printk (KERN_DEBUG "via_audio: ignoring drain playback error %d\n", rc); |
| |
| via_chan_free (card, &card->ch_out); |
| via_chan_buffer_free(card, &card->ch_out); |
| } |
| |
| if (file->f_mode & FMODE_READ) { |
| via_chan_free (card, &card->ch_in); |
| via_chan_buffer_free (card, &card->ch_in); |
| } |
| |
| mutex_unlock(&card->syscall_mutex); |
| mutex_unlock(&card->open_mutex); |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| } |
| |
| |
| /**************************************************************** |
| * |
| * Chip setup and kernel registration |
| * |
| * |
| */ |
| |
| static int __devinit via_init_one (struct pci_dev *pdev, const struct pci_device_id *id) |
| { |
| #ifdef CONFIG_MIDI_VIA82CXXX |
| u8 r42; |
| #endif |
| int rc; |
| struct via_info *card; |
| static int printed_version; |
| |
| DPRINTK ("ENTER\n"); |
| |
| if (printed_version++ == 0) |
| printk (KERN_INFO "Via 686a/8233/8235 audio driver " VIA_VERSION "\n"); |
| |
| rc = pci_enable_device (pdev); |
| if (rc) |
| goto err_out; |
| |
| rc = pci_request_regions (pdev, "via82cxxx_audio"); |
| if (rc) |
| goto err_out_disable; |
| |
| rc = pci_set_dma_mask(pdev, DMA_32BIT_MASK); |
| if (rc) |
| goto err_out_res; |
| rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK); |
| if (rc) |
| goto err_out_res; |
| |
| card = kmalloc (sizeof (*card), GFP_KERNEL); |
| if (!card) { |
| printk (KERN_ERR PFX "out of memory, aborting\n"); |
| rc = -ENOMEM; |
| goto err_out_res; |
| } |
| |
| pci_set_drvdata (pdev, card); |
| |
| memset (card, 0, sizeof (*card)); |
| card->pdev = pdev; |
| card->baseaddr = pci_resource_start (pdev, 0); |
| card->card_num = via_num_cards++; |
| spin_lock_init (&card->lock); |
| spin_lock_init (&card->ac97_lock); |
| mutex_init(&card->syscall_mutex); |
| mutex_init(&card->open_mutex); |
| |
| /* we must init these now, in case the intr handler needs them */ |
| via_chan_init_defaults (card, &card->ch_out); |
| via_chan_init_defaults (card, &card->ch_in); |
| via_chan_init_defaults (card, &card->ch_fm); |
| |
| /* if BAR 2 is present, chip is Rev H or later, |
| * which means it has a few extra features */ |
| if (pci_resource_start (pdev, 2) > 0) |
| card->rev_h = 1; |
| |
| /* Overkill for now, but more flexible done right */ |
| |
| card->intmask = id->driver_data; |
| card->legacy = !card->intmask; |
| card->sixchannel = id->driver_data; |
| |
| if(card->sixchannel) |
| printk(KERN_INFO PFX "Six channel audio available\n"); |
| if (pdev->irq < 1) { |
| printk (KERN_ERR PFX "invalid PCI IRQ %d, aborting\n", pdev->irq); |
| rc = -ENODEV; |
| goto err_out_kfree; |
| } |
| |
| if (!(pci_resource_flags (pdev, 0) & IORESOURCE_IO)) { |
| printk (KERN_ERR PFX "unable to locate I/O resources, aborting\n"); |
| rc = -ENODEV; |
| goto err_out_kfree; |
| } |
| |
| pci_set_master(pdev); |
| |
| /* |
| * init AC97 mixer and codec |
| */ |
| rc = via_ac97_init (card); |
| if (rc) { |
| printk (KERN_ERR PFX "AC97 init failed, aborting\n"); |
| goto err_out_kfree; |
| } |
| |
| /* |
| * init DSP device |
| */ |
| rc = via_dsp_init (card); |
| if (rc) { |
| printk (KERN_ERR PFX "DSP device init failed, aborting\n"); |
| goto err_out_have_mixer; |
| } |
| |
| /* |
| * init and turn on interrupts, as the last thing we do |
| */ |
| rc = via_interrupt_init (card); |
| if (rc) { |
| printk (KERN_ERR PFX "interrupt init failed, aborting\n"); |
| goto err_out_have_dsp; |
| } |
| |
| printk (KERN_INFO PFX "board #%d at 0x%04lX, IRQ %d\n", |
| card->card_num + 1, card->baseaddr, pdev->irq); |
| |
| #ifdef CONFIG_MIDI_VIA82CXXX |
| /* Disable by default */ |
| card->midi_info.io_base = 0; |
| |
| if(card->legacy) |
| { |
| pci_read_config_byte (pdev, 0x42, &r42); |
| /* Disable MIDI interrupt */ |
| pci_write_config_byte (pdev, 0x42, r42 | VIA_CR42_MIDI_IRQMASK); |
| if (r42 & VIA_CR42_MIDI_ENABLE) |
| { |
| if (r42 & VIA_CR42_MIDI_PNP) /* Address selected by iobase 2 - not tested */ |
| card->midi_info.io_base = pci_resource_start (pdev, 2); |
| else /* Address selected by byte 0x43 */ |
| { |
| u8 r43; |
| pci_read_config_byte (pdev, 0x43, &r43); |
| card->midi_info.io_base = 0x300 + ((r43 & 0x0c) << 2); |
| } |
| |
| card->midi_info.irq = -pdev->irq; |
| if (probe_uart401(& card->midi_info, THIS_MODULE)) |
| { |
| card->midi_devc=midi_devs[card->midi_info.slots[4]]->devc; |
| pci_write_config_byte(pdev, 0x42, r42 & ~VIA_CR42_MIDI_IRQMASK); |
| printk("Enabled Via MIDI\n"); |
| } |
| } |
| } |
| #endif |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| |
| err_out_have_dsp: |
| via_dsp_cleanup (card); |
| |
| err_out_have_mixer: |
| via_ac97_cleanup (card); |
| |
| err_out_kfree: |
| #ifndef VIA_NDEBUG |
| memset (card, OSS_POISON_FREE, sizeof (*card)); /* poison memory */ |
| #endif |
| kfree (card); |
| |
| err_out_res: |
| pci_release_regions (pdev); |
| |
| err_out_disable: |
| pci_disable_device (pdev); |
| |
| err_out: |
| pci_set_drvdata (pdev, NULL); |
| DPRINTK ("EXIT - returning %d\n", rc); |
| return rc; |
| } |
| |
| |
| static void __devexit via_remove_one (struct pci_dev *pdev) |
| { |
| struct via_info *card; |
| |
| DPRINTK ("ENTER\n"); |
| |
| assert (pdev != NULL); |
| card = pci_get_drvdata (pdev); |
| assert (card != NULL); |
| |
| #ifdef CONFIG_MIDI_VIA82CXXX |
| if (card->midi_info.io_base) |
| unload_uart401(&card->midi_info); |
| #endif |
| |
| free_irq (card->pdev->irq, card); |
| via_dsp_cleanup (card); |
| via_ac97_cleanup (card); |
| |
| #ifndef VIA_NDEBUG |
| memset (card, OSS_POISON_FREE, sizeof (*card)); /* poison memory */ |
| #endif |
| kfree (card); |
| |
| pci_set_drvdata (pdev, NULL); |
| |
| pci_release_regions (pdev); |
| pci_disable_device (pdev); |
| pci_set_power_state (pdev, 3); /* ...zzzzzz */ |
| |
| DPRINTK ("EXIT\n"); |
| return; |
| } |
| |
| |
| /**************************************************************** |
| * |
| * Driver initialization and cleanup |
| * |
| * |
| */ |
| |
| static int __init init_via82cxxx_audio(void) |
| { |
| int rc; |
| |
| DPRINTK ("ENTER\n"); |
| |
| rc = pci_register_driver (&via_driver); |
| if (rc) { |
| DPRINTK ("EXIT, returning %d\n", rc); |
| return rc; |
| } |
| |
| DPRINTK ("EXIT, returning 0\n"); |
| return 0; |
| } |
| |
| |
| static void __exit cleanup_via82cxxx_audio(void) |
| { |
| DPRINTK ("ENTER\n"); |
| |
| pci_unregister_driver (&via_driver); |
| |
| DPRINTK ("EXIT\n"); |
| } |
| |
| |
| module_init(init_via82cxxx_audio); |
| module_exit(cleanup_via82cxxx_audio); |
| |
| MODULE_AUTHOR("Jeff Garzik"); |
| MODULE_DESCRIPTION("DSP audio and mixer driver for Via 82Cxxx audio devices"); |
| MODULE_LICENSE("GPL"); |
| |