Re: pthread_suspend_np() and interrupt : system block
"pm.boyer" <[email protected]> Thu, 14 Apr 2005 10:51:26 +0200
| Newsgroups | gmane.linux.real-time.rtlinux.general |
|---|---|
| Message-ID | <[email protected]> |
Tanks a lot. I send you my code in attached files : rt_es1371.c : the RT-driver for the audio card (SoundBlaster PCI 128) test2.c : a very simple RT-application that use the driver. regards, mr Ravi vc BPM ======================================================================= ---> rt_es1371?c : ======================================================================= /*****************************************************************************/ /* es1371_write * es1371.c -- Creative Ensoniq ES1371. * * Copyright (C) 1998-1999 Thomas Sailer ([email protected]) * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. * * Special thanks to Ensoniq * * * Module command line parameters: * joystick must be set to the base I/O-Port to be used for * the gameport. Legal values are 0x200, 0x208, 0x210 and 0x218. * The gameport is mirrored eight times. * * Supported devices: * /dev/dsp standard /dev/dsp device, (mostly) OSS compatible * /dev/mixer standard /dev/mixer device, (mostly) OSS compatible * /dev/dsp1 additional DAC, like /dev/dsp, but outputs to mixer "SYNTH" setting * /dev/midi simple MIDI UART interface, no ioctl * * NOTE: the card does not have any FM/Wavetable synthesizer, it is supposed * to be done in software. That is what /dev/dac is for. By now (Q2 1998) * there are several MIDI to PCM (WAV) packages, one of them is timidity. * * Revision history * 04.06.98 0.1 Initial release * Mixer stuff should be overhauled; especially optional AC97 mixer bits * should be detected. This results in strange behaviour of some mixer * settings, like master volume and mic. * 08.06.98 0.2 First release using Alan Cox' soundcore instead of miscdevice * 03.08.98 0.3 Do not include modversions.h * Now mixer behaviour can basically be selected between * "OSS documented" and "OSS actual" behaviour * 31.08.98 0.4 Fix realplayer problems - dac.count issues * 27.10.98 0.5 Fix joystick support * -- Oliver Neukum ([email protected]) * 10.12.98 0.6 Fix drain_dac trying to wait on not yet initialized DMA * 23.12.98 0.7 Fix a few f_file & FMODE_ bugs * Don't wake up app until there are fragsize bytes to read/write * 06.01.99 0.8 remove the silly SA_INTERRUPT flag. * hopefully killed the egcs section type conflict * 12.03.99 0.9 cinfo.blocks should be reset after GETxPTR ioctl. * reported by Johan Maes <[email protected]> * 22.03.99 0.10 return EAGAIN instead of EBUSY when O_NONBLOCK * read/write cannot be executed * 07.04.99 0.11 implemented the following ioctl's: SOUND_PCM_READ_RATE, * SOUND_PCM_READ_CHANNELS, SOUND_PCM_READ_BITS; * Alpha fixes reported by Peter Jones <[email protected]> * Another Alpha fix (wait_src_ready in init routine) * reported by "Ivan N. Kokshaysky" <[email protected]> * Note: joystick address handling might still be wrong on archs * other than i386 * 15.06.99 0.12 Fix bad allocation bug. * Thanks to Deti Fliegl <[email protected]> * 28.06.99 0.13 Add pci_set_master * 03.08.99 0.14 adapt to Linus' new __setup/__initcall * added kernel command line option "es1371=joystickaddr" * removed CONFIG_SOUND_ES1371_JOYPORT_BOOT kludge * 10.08.99 0.15 (Re)added S/PDIF module option for cards revision >= 4. * Initial version by Dave Platt <[email protected]>. * module_init/__setup fixes * 08.16.99 0.16 Joe Cotellese <[email protected]> * Added detection for ES1371 revision ID so that we can * detect the ES1373 and later parts. * added AC97 #defines for readability * added a /proc file system for dumping hardware state * updated SRC and CODEC w/r functions to accomodate bugs * in some versions of the ES137x chips. * 31.08.99 0.17 add spin_lock_init * __initlocaldata to fix gcc 2.7.x problems * replaced current->state = x with set_current_state(x) * 03.09.99 0.18 change read semantics for MIDI to match * OSS more closely; remove possible wakeup race * 21.10.99 0.19 Round sampling rates, requested by * Kasamatsu Kenichi <[email protected]> * * 01.06.00 0.00 RTLinux port by Nicolas Ferre <[email protected]> using * David Olofson one for es1370 and his Driver Programming * Interface v0.1.0 * */ /*****************************************************************************/ #include <rtl.h> #include <posix/pthread.h> #include <rtl_core.h> #include <rtl_printf.h> //#include "rtl_drvsync.h" #include <rtl_spinlock.h> #include <rtl_sync.h> #include <rtl_time.h> /* BPM */ //#include <linux/rtl.h> #include <rtl_sched.h> //#include <linux/cons.h> #include <rtl_posixio.h> //#include <linux/config.h> //#include <linux/version.h> //#include <linux/module.h> //#include <linux/string.h> //#include <linux/ioport.h> //#include <linux/sched.h> //#include <linux/delay.h> //#include <linux/sound.h> // #include <linux/malloc.h> deprecated use slab.h instead #include <linux/slab.h> #include "rtl_soundcard.h" #include <linux/pci.h> //#include <linux/init.h> //#include <linux/poll.h> //#include <linux/bitops.h> //#include <linux/proc_fs.h> //#include <asm/spinlock.h> //#include <linux/highmem.h> /* BPM --> PKMAP_NR */ #include <arch/rtl_io.h> //#include <asm/dma.h> //#include <asm/uaccess.h> // get_user () //#include <asm/hardirq.h> #include "ac97.h" #include <posix/semaphore.h> /* --------------------------------------------------------------------- */ #undef OSS_DOCUMENTED_MIXER_SEMANTICS #define ES1371_DEBUG //#undef ES1371_DEBUG #ifdef ES1371_DEBUG #define DBG(x) {x} #else #define DBG(x) {} #endif /* ES1371_DEBUG */ /* --------------------------------------------------------------------- */ #ifndef PCI_VENDOR_ID_ENSONIQ #define PCI_VENDOR_ID_ENSONIQ 0x1274 #endif #ifndef PCI_DEVICE_ID_ENSONIQ_ES1371 #define PCI_DEVICE_ID_ENSONIQ_ES1371 0x1371 #endif /* ES1371 chip ID */ /* This is a little confusing because all ES1371 compatible chips have the same DEVICE_ID, the only thing differentiating them is the REV_ID field. This is only significant if you want to enable features on the later parts. Yes, I know it's stupid and why didn't we use the sub IDs? */ #define ES1371REV_ES1373_A 0x04 #define ES1371REV_ES1373_B 0x06 #define ES1371REV_CT5880_A 0x07 #define ES1371REV_ES1371_B 0x09 #define ES1371_MAGIC ((PCI_VENDOR_ID_ENSONIQ<<16)|PCI_DEVICE_ID_ENSONIQ_ES1371) #define ES1371_EXTENT 0x40 #define JOY_EXTENT 8 #define ES1371_REG_CONTROL 0x00 #define ES1371_REG_STATUS 0x04 #define ES1371_REG_UART_DATA 0x08 #define ES1371_REG_UART_STATUS 0x09 #define ES1371_REG_UART_CONTROL 0x09 #define ES1371_REG_UART_TEST 0x0a #define ES1371_REG_MEMPAGE 0x0c #define ES1371_REG_SRCONV 0x10 #define ES1371_REG_CODEC 0x14 #define ES1371_REG_LEGACY 0x18 #define ES1371_REG_SERIAL_CONTROL 0x20 #define ES1371_REG_DAC1_SCOUNT 0x24 #define ES1371_REG_DAC2_SCOUNT 0x28 #define ES1371_REG_ADC_SCOUNT 0x2c #define ES1371_REG_DAC1_FRAMEADR 0xc30 #define ES1371_REG_DAC1_FRAMECNT 0xc34 #define ES1371_REG_DAC2_FRAMEADR 0xc38 #define ES1371_REG_DAC2_FRAMECNT 0xc3c #define ES1371_REG_ADC_FRAMEADR 0xd30 #define ES1371_REG_ADC_FRAMECNT 0xd34 #define ES1371_FMT_U8_MONO 0 #define ES1371_FMT_U8_STEREO 1 #define ES1371_FMT_S16_MONO 2 #define ES1371_FMT_S16_STEREO 3 #define ES1371_FMT_STEREO 1 #define ES1371_FMT_S16 2 #define ES1371_FMT_MASK 3 static const unsigned sample_size[] = { 1, 2, 2, 4 }; static const unsigned sample_shift[] = { 0, 1, 1, 2 }; #define CTRL_SPDIFEN_B 0x04000000 #define CTRL_JOY_SHIFT 24 #define CTRL_JOY_MASK 3 #define CTRL_JOY_200 0x00000000 /* joystick base address */ #define CTRL_JOY_208 0x01000000 #define CTRL_JOY_210 0x02000000 #define CTRL_JOY_218 0x03000000 #define CTRL_GPIO_IN0 0x00100000 /* general purpose inputs/outputs */ #define CTRL_GPIO_IN1 0x00200000 #define CTRL_GPIO_IN2 0x00400000 #define CTRL_GPIO_IN3 0x00800000 #define CTRL_GPIO_OUT0 0x00010000 #define CTRL_GPIO_OUT1 0x00020000 #define CTRL_GPIO_OUT2 0x00040000 #define CTRL_GPIO_OUT3 0x00080000 #define CTRL_MSFMTSEL 0x00008000 /* MPEG serial data fmt: 0 = Sony, 1 = I2S */ #define CTRL_SYNCRES 0x00004000 /* AC97 warm reset */ #define CTRL_ADCSTOP 0x00002000 /* stop ADC transfers */ #define CTRL_PWR_INTRM 0x00001000 /* 1 = power level ints enabled */ #define CTRL_M_CB 0x00000800 /* recording source: 0 = ADC, 1 = MPEG */ #define CTRL_CCB_INTRM 0x00000400 /* 1 = CCB "voice" ints enabled */ #define CTRL_PDLEV0 0x00000000 /* power down level */ #define CTRL_PDLEV1 0x00000100 #define CTRL_PDLEV2 0x00000200 #define CTRL_PDLEV3 0x00000300 #define CTRL_BREQ 0x00000080 /* 1 = test mode (internal mem test) */ #define CTRL_DAC1_EN 0x00000040 /* enable DAC1 */ #define CTRL_DAC2_EN 0x00000020 /* enable DAC2 */ #define CTRL_ADC_EN 0x00000010 /* enable ADC */ #define CTRL_UART_EN 0x00000008 /* enable MIDI uart */ #define CTRL_JYSTK_EN 0x00000004 /* enable Joystick port */ #define CTRL_XTALCLKDIS 0x00000002 /* 1 = disable crystal clock input */ #define CTRL_PCICLKDIS 0x00000001 /* 1 = disable PCI clock distribution */ #define STAT_INTR 0x80000000 /* wired or of all interrupt bits */ #define STAT_EN_SPDIF 0x00040000 /* enable S/PDIF circuitry */ #define STAT_TS_SPDIF 0x00020000 /* test S/PDIF circuitry */ #define STAT_TESTMODE 0x00010000 /* test ASIC */ #define STAT_SYNC_ERR 0x00000100 /* 1 = codec sync error */ #define STAT_VC 0x000000c0 /* CCB int source, 0=DAC1, 1=DAC2, 2=ADC, 3=undef */ #define STAT_SH_VC 6 #define STAT_MPWR 0x00000020 /* power level interrupt */ #define STAT_MCCB 0x00000010 /* CCB int pending */ #define STAT_UART 0x00000008 /* UART int pending */ #define STAT_DAC1 0x00000004 /* DAC1 int pending */ #define STAT_DAC2 0x00000002 /* DAC2 int pending */ #define STAT_ADC 0x00000001 /* ADC int pending */ #define USTAT_RXINT 0x80 /* UART rx int pending */ #define USTAT_TXINT 0x04 /* UART tx int pending */ #define USTAT_TXRDY 0x02 /* UART tx ready */ #define USTAT_RXRDY 0x01 /* UART rx ready */ #define UCTRL_RXINTEN 0x80 /* 1 = enable RX ints */ #define UCTRL_TXINTEN 0x60 /* TX int enable field mask */ #define UCTRL_ENA_TXINT 0x20 /* enable TX int */ #define UCTRL_CNTRL 0x03 /* control field */ #define UCTRL_CNTRL_SWR 0x03 /* software reset command */ /* sample rate converter */ #define SRC_OKSTATE 1 #define SRC_RAMADDR_MASK 0xfe000000 #define SRC_RAMADDR_SHIFT 25 #define SRC_DAC1FREEZE (1UL << 21) #define SRC_DAC2FREEZE (1UL << 20) #define SRC_ADCFREEZE (1UL << 19) #define SRC_WE 0x01000000 /* read/write control for SRC RAM */ #define SRC_BUSY 0x00800000 /* SRC busy */ #define SRC_DIS 0x00400000 /* 1 = disable SRC */ #define SRC_DDAC1 0x00200000 /* 1 = disable accum update for DAC1 */ #define SRC_DDAC2 0x00100000 /* 1 = disable accum update for DAC2 */ #define SRC_DADC 0x00080000 /* 1 = disable accum update for ADC2 */ #define SRC_CTLMASK 0x00780000 #define SRC_RAMDATA_MASK 0x0000ffff #define SRC_RAMDATA_SHIFT 0 #define SRCREG_ADC 0x78 #define SRCREG_DAC1 0x70 #define SRCREG_DAC2 0x74 #define SRCREG_VOL_ADC 0x6c #define SRCREG_VOL_DAC1 0x7c #define SRCREG_VOL_DAC2 0x7e #define SRCREG_TRUNC_N 0x00 #define SRCREG_INT_REGS 0x01 #define SRCREG_ACCUM_FRAC 0x02 #define SRCREG_VFREQ_FRAC 0x03 #define CODEC_PIRD 0x00800000 /* 0 = write AC97 register */ #define CODEC_PIADD_MASK 0x007f0000 #define CODEC_PIADD_SHIFT 16 #define CODEC_PIDAT_MASK 0x0000ffff #define CODEC_PIDAT_SHIFT 0 #define CODEC_RDY 0x80000000 /* AC97 read data valid */ #define CODEC_WIP 0x40000000 /* AC97 write in progress */ #define CODEC_PORD 0x00800000 /* 0 = write AC97 register */ #define CODEC_POADD_MASK 0x007f0000 #define CODEC_POADD_SHIFT 16 #define CODEC_PODAT_MASK 0x0000ffff #define CODEC_PODAT_SHIFT 0 #define LEGACY_JFAST 0x80000000 /* fast joystick timing */ #define LEGACY_FIRQ 0x01000000 /* force IRQ */ #define SCTRL_DACTEST 0x00400000 /* 1 = DAC test, test vector generation purposes */ #define SCTRL_P2ENDINC 0x00380000 /* */ #define SCTRL_SH_P2ENDINC 19 #define SCTRL_P2STINC 0x00070000 /* */ #define SCTRL_SH_P2STINC 16 #define SCTRL_R1LOOPSEL 0x00008000 /* 0 = loop mode */ #define SCTRL_P2LOOPSEL 0x00004000 /* 0 = loop mode */ #define SCTRL_P1LOOPSEL 0x00002000 /* 0 = loop mode */ #define SCTRL_P2PAUSE 0x00001000 /* 1 = pause mode */ #define SCTRL_P1PAUSE 0x00000800 /* 1 = pause mode */ #define SCTRL_R1INTEN 0x00000400 /* enable interrupt */ #define SCTRL_P2INTEN 0x00000200 /* enable interrupt */ #define SCTRL_P1INTEN 0x00000100 /* enable interrupt */ #define SCTRL_P1SCTRLD 0x00000080 /* reload sample count register for DAC1 */ #define SCTRL_P2DACSEN 0x00000040 /* 1 = DAC2 play back last sample when disabled */ #define SCTRL_R1SEB 0x00000020 /* 1 = 16bit */ #define SCTRL_R1SMB 0x00000010 /* 1 = stereo */ #define SCTRL_R1FMT 0x00000030 /* format mask */ #define SCTRL_SH_R1FMT 4 #define SCTRL_P2SEB 0x00000008 /* 1 = 16bit */ #define SCTRL_P2SMB 0x00000004 /* 1 = stereo */ #define SCTRL_P2FMT 0x0000000c /* format mask */ #define SCTRL_SH_P2FMT 2 #define SCTRL_P1SEB 0x00000002 /* 1 = 16bit */ #define SCTRL_P1SMB 0x00000001 /* 1 = stereo */ #define SCTRL_P1FMT 0x00000003 /* format mask */ #define SCTRL_SH_P1FMT 0 /* codec constants */ #define CODEC_ID_DEDICATEDMIC 0x001 #define CODEC_ID_MODEMCODEC 0x002 #define CODEC_ID_BASSTREBLE 0x004 #define CODEC_ID_SIMULATEDSTEREO 0x008 #define CODEC_ID_HEADPHONEOUT 0x010 #define CODEC_ID_LOUDNESS 0x020 #define CODEC_ID_18BITDAC 0x040 #define CODEC_ID_20BITDAC 0x080 #define CODEC_ID_18BITADC 0x100 #define CODEC_ID_20BITADC 0x200 #define CODEC_ID_SESHIFT 10 #define CODEC_ID_SEMASK 0x1f /* misc stuff */ #define POLL_COUNT 0x1000 #define FMODE_DAC 4 /* slight misuse of mode_t */ /* MIDI buffer sizes */ #define MIDIINBUF 256 #define MIDIOUTBUF 256 #define FMODE_MIDI_SHIFT 3 #define FMODE_MIDI_READ (FMODE_READ << FMODE_MIDI_SHIFT) #define FMODE_MIDI_WRITE (FMODE_WRITE << FMODE_MIDI_SHIFT) #define SND_DEV_DSP16 5 /* --------------------------------------------------------------------- */ #define rtd_get_user(x, ptr) \ ({ \ int ret; \ (x) = (*(ptr)); \ ret = 0; \ }) #define rtd_get_user_ret(x, ptr, rval) \ ({ \ if(rtd_get_user(x,ptr)) \ return rval; \ }) #define rtd_put_user(x, ptr) \ ({ \ int ret; \ (*(ptr)) = (x); \ ret = 0; \ }) #define rtd_put_user_ret(x, ptr, rval) \ ({ \ if(rtd_put_user(x,ptr)) \ return rval; \ }) #define rtd_copy_to_user(to, from, n) \ ({ \ int ret; \ memcpy(to, from, n); \ ret = 0; \ }) #define rtd_copy_to_user_ret(to, from, n, rval) \ ({ \ if(rtd_copy_to_user(to, from, n)) \ return rval; \ }) #define rtd_copy_from_user(to, from, n) \ ({ \ int ret; \ memcpy(to, from, n); \ ret = 0; \ }) #define rtd_copy_from_user_ret(to, from, n, rval) \ ({ \ if(rtd_copy_from_user(to, from, n)) \ return rval; \ }) #define DEBINT(x) #define DEBRTL(x) x static int BPMsuspend=0; static const char *stereo_enhancement[] __initdata = { "no 3D stereo enhancement", "Analog Devices Phat Stereo", "Creative Stereo Enhancement", "National Semiconductor 3D Stereo Enhancement", "YAMAHA Ymersion", "BBE 3D Stereo Enhancement", "Crystal Semiconductor 3D Stereo Enhancement", "Qsound QXpander", "Spatializer 3D Stereo Enhancement", "SRS 3D Stereo Enhancement", "Platform Technologies 3D Stereo Enhancement", "AKM 3D Audio", "Aureal Stereo Enhancement", "AZTECH 3D Enhancement", "Binaura 3D Audio Enhancement", "ESS Technology Stereo Enhancement", "Harman International VMAx", "NVidea 3D Stereo Enhancement", "Philips Incredible Sound", "Texas Instruments 3D Stereo Enhancement", "VLSI Technology 3D Stereo Enhancement" }; /* --------------------------------------------------------------------- */ struct es1371_state { /* magic */ unsigned int magic; /* we keep sb cards in a linked list */ struct es1371_state *next; /* the corresponding pci_dev structure */ struct pci_dev *dev; /* soundcore stuff */ int dev_audio; int dev_mixer; int dev_dac; int dev_midi; /* hardware resources */ unsigned long io; /* long for SPARC */ unsigned int irq; u8 rev; /* the chip revision */ #ifdef ES1371_DEBUG /* debug /proc entry */ struct proc_dir_entry *ps; #endif /* ES1371_DEBUG */ /* mixer registers; there is no HW readback */ struct { unsigned short codec_id; unsigned int modcnt; #ifndef OSS_DOCUMENTED_MIXER_SEMANTICS unsigned short vol[13]; #endif /* OSS_DOCUMENTED_MIXER_SEMANTICS */ } mix; /* wave stuff */ unsigned ctrl; unsigned sctrl; unsigned dac1rate, dac2rate, adcrate; spinlock_t lock; struct semaphore open_sem; mode_t open_mode; struct wait_queue *open_wait; pthread_t thisThread; struct dmabuf { void *rawbuf; dma_addr_t dmaaddr; unsigned buforder; unsigned numfrag; unsigned fragshift; unsigned hwptr, swptr; unsigned total_bytes; int count; unsigned error; /* over/underrun */ struct wait_queue *wait; /* redundant, but makes calculations easier */ unsigned fragsize; unsigned dmasize; unsigned fragsamples; /* OSS stuff */ unsigned mapped:1; unsigned ready:1; unsigned endcleared:1; unsigned ossfragshift; int ossmaxfrags; unsigned subdivision; } dma_dac1, dma_dac2, dma_adc; /* midi stuff */ struct { unsigned ird, iwr, icnt; unsigned ord, owr, ocnt; struct wait_queue *iwait; struct wait_queue *owait; unsigned char ibuf[MIDIINBUF]; unsigned char obuf[MIDIOUTBUF]; } midi; }; /* --------------------------------------------------------------------- */ static struct es1371_state *devs_es = NULL; /* --------------------------------------------------------------------- */ #define VALIDATE_STATE(s) \ ({ \ if (!(s) || (s)->magic != ES1371_MAGIC) { \ rtl_printf("es1371: invalid magic value\n"); \ return -ENXIO; \ } \ }) /* --------------------------------------------------------------------- */ /* --------------------------------------------------------------------- */ extern inline unsigned ld2(unsigned int x) { unsigned r = 0; if (x >= 0x10000) { x >>= 16; r += 16; } if (x >= 0x100) { x >>= 8; r += 8; } if (x >= 0x10) { x >>= 4; r += 4; } if (x >= 4) { x >>= 2; r += 2; } if (x >= 2) r++; return r; } /* --------------------------------------------------------------------- */ static unsigned wait_src_ready(struct es1371_state *s) { unsigned int t, r; for (t = 0; t < POLL_COUNT; t++) { if (!((r = inl(s->io + ES1371_REG_SRCONV)) & SRC_BUSY)) return r; udelay(1); } rtl_printf("rt_es1371: sample rate converter timeout r = 0x%08x\n", r); return r; } static unsigned src_read(struct es1371_state *s, unsigned reg) { unsigned int temp,i,orig; /* wait for ready */ temp = wait_src_ready (s); /* we can only access the SRC at certain times, make sure we're allowed to before we read */ orig = temp; /* expose the SRC state bits */ outl ( (temp & SRC_CTLMASK) | (reg << SRC_RAMADDR_SHIFT) | 0x10000UL, s->io + ES1371_REG_SRCONV); /* now, wait for busy and the correct time to read */ temp = wait_src_ready (s); if ( (temp & 0x00870000UL ) != ( SRC_OKSTATE << 16 )){ /* wait for the right state */ for (i=0; i<POLL_COUNT; i++){ temp = inl (s->io + ES1371_REG_SRCONV); if ( (temp & 0x00870000UL ) == ( SRC_OKSTATE << 16 )) break; } } /* hide the state bits */ outl ((orig & SRC_CTLMASK) | (reg << SRC_RAMADDR_SHIFT), s->io + ES1371_REG_SRCONV); return temp; } static void src_write(struct es1371_state *s, unsigned reg, unsigned data) { unsigned int r; r = wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DDAC2 | SRC_DADC); r |= (reg << SRC_RAMADDR_SHIFT) & SRC_RAMADDR_MASK; r |= (data << SRC_RAMDATA_SHIFT) & SRC_RAMDATA_MASK; outl(r | SRC_WE, s->io + ES1371_REG_SRCONV); } /* --------------------------------------------------------------------- */ /* most of the following here is black magic */ static void set_adc_rate(struct es1371_state *s, unsigned rate) { unsigned long flags; unsigned int n, truncm, freq; if (rate > 48000) rate = 48000; if (rate < 4000) rate = 4000; n = rate / 3000; if ((1 << n) & ((1 << 15) | (1 << 13) | (1 << 11) | (1 << 9))) n--; truncm = (21 * n - 1) | 1; freq = ((48000UL << 15) / rate) * n; s->adcrate = (48000UL << 15) / (freq / n); rtl_spin_lock_irqsave(&s->lock, flags); if (rate >= 24000) { if (truncm > 239) truncm = 239; src_write(s, SRCREG_ADC+SRCREG_TRUNC_N, (((239 - truncm) >> 1) << 9) | (n << 4)); } else { if (truncm > 119) truncm = 119; src_write(s, SRCREG_ADC+SRCREG_TRUNC_N, 0x8000 | (((119 - truncm) >> 1) << 9) | (n << 4)); } src_write(s, SRCREG_ADC+SRCREG_INT_REGS, (src_read(s, SRCREG_ADC+SRCREG_INT_REGS) & 0x00ff) | ((freq >> 5) & 0xfc00)); src_write(s, SRCREG_ADC+SRCREG_VFREQ_FRAC, freq & 0x7fff); src_write(s, SRCREG_VOL_ADC, n << 8); src_write(s, SRCREG_VOL_ADC+1, n << 8); rtl_spin_unlock_irqrestore(&s->lock, flags); } static void set_dac1_rate(struct es1371_state *s, unsigned rate) { unsigned long flags; unsigned int freq, r; if (rate > 48000) rate = 48000; if (rate < 4000) rate = 4000; freq = ((rate << 15) + 1500) / 3000; s->dac1rate = (freq * 3000 + 16384) >> 15; rtl_spin_lock_irqsave(&s->lock, flags); r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC2 | SRC_DADC)) | SRC_DDAC1; outl(r, s->io + ES1371_REG_SRCONV); src_write(s, SRCREG_DAC1+SRCREG_INT_REGS, (src_read(s, SRCREG_DAC1+SRCREG_INT_REGS) & 0x00ff) | ((freq >> 5) & 0xfc00)); src_write(s, SRCREG_DAC1+SRCREG_VFREQ_FRAC, freq & 0x7fff); r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC2 | SRC_DADC)); outl(r, s->io + ES1371_REG_SRCONV); rtl_spin_unlock_irqrestore(&s->lock, flags); } static void set_dac2_rate(struct es1371_state *s, unsigned rate) { unsigned long flags; unsigned int freq, r; if (rate > 48000) rate = 48000; if (rate < 4000) rate = 4000; freq = ((rate << 15) + 1500) / 3000; s->dac2rate = (freq * 3000 + 16384) >> 15; rtl_spin_lock_irqsave(&s->lock, flags); r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DADC)) | SRC_DDAC2; outl(r, s->io + ES1371_REG_SRCONV); src_write(s, SRCREG_DAC2+SRCREG_INT_REGS, (src_read(s, SRCREG_DAC2+SRCREG_INT_REGS) & 0x00ff) | ((freq >> 5) & 0xfc00)); src_write(s, SRCREG_DAC2+SRCREG_VFREQ_FRAC, freq & 0x7fff); r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DADC)); outl(r, s->io + ES1371_REG_SRCONV); rtl_spin_unlock_irqrestore(&s->lock, flags); } /* --------------------------------------------------------------------- */ static void __init src_init(struct es1371_state *s) { unsigned int i; /* before we enable or disable the SRC we need to wait for it to become ready */ wait_src_ready(s); outl(SRC_DIS, s->io + ES1371_REG_SRCONV); for (i = 0; i < 0x80; i++) src_write(s, i, 0); src_write(s, SRCREG_DAC1+SRCREG_TRUNC_N, 16 << 4); src_write(s, SRCREG_DAC1+SRCREG_INT_REGS, 16 << 10); src_write(s, SRCREG_DAC2+SRCREG_TRUNC_N, 16 << 4); src_write(s, SRCREG_DAC2+SRCREG_INT_REGS, 16 << 10); src_write(s, SRCREG_VOL_ADC, 1 << 12); src_write(s, SRCREG_VOL_ADC+1, 1 << 12); src_write(s, SRCREG_VOL_DAC1, 1 << 12); src_write(s, SRCREG_VOL_DAC1+1, 1 << 12); src_write(s, SRCREG_VOL_DAC2, 1 << 12); src_write(s, SRCREG_VOL_DAC2+1, 1 << 12); set_adc_rate(s, 22050); set_dac1_rate(s, 22050); set_dac2_rate(s, 22050); /* WARNING: * enabling the sample rate converter without properly programming * its parameters causes the chip to lock up (the SRC busy bit will * be stuck high, and I've found no way to rectify this other than * power cycle) */ wait_src_ready(s); outl(0, s->io+ES1371_REG_SRCONV); } /* --------------------------------------------------------------------- */ static void wrcodec(struct es1371_state *s, unsigned addr, unsigned data) { unsigned long flags; unsigned t, x; for (t = 0; t < POLL_COUNT; t++) if (!(inl(s->io+ES1371_REG_CODEC) & CODEC_WIP)) break; rtl_spin_lock_irqsave(&s->lock, flags); /* save the current state for later */ x = wait_src_ready(s); /* enable SRC state data in SRC mux */ outl(( x & (SRC_DIS | SRC_DDAC1 | SRC_DDAC2 | SRC_DADC)) | 0x00010000, s->io+ES1371_REG_SRCONV); /* wait for not busy (state 0) first to avoid transition states */ for (t=0; t<POLL_COUNT; t++){ if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0 ) break; udelay(1); } /* wait for a SAFE time to write addr/data and then do it, dammit */ for (t=0; t<POLL_COUNT; t++){ if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0x00010000) break; udelay(1); } outl(((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) | ((data << CODEC_PODAT_SHIFT) & CODEC_PODAT_MASK), s->io+ES1371_REG_CODEC); /* restore SRC reg */ wait_src_ready(s); outl(x, s->io+ES1371_REG_SRCONV); rtl_spin_unlock_irqrestore(&s->lock, flags); } static unsigned rdcodec(struct es1371_state *s, unsigned addr) { unsigned long flags; unsigned t, x; /* wait for WIP to go away */ for (t = 0; t < 0x1000; t++) if (!(inl(s->io+ES1371_REG_CODEC) & CODEC_WIP)) break; rtl_spin_lock_irqsave(&s->lock, flags); /* save the current state for later */ x = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DDAC2 | SRC_DADC)); /* enable SRC state data in SRC mux */ outl( x | 0x00010000, s->io+ES1371_REG_SRCONV); /* wait for not busy (state 0) first to avoid transition states */ for (t=0; t<POLL_COUNT; t++){ if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0 ) break; udelay(1); } /* wait for a SAFE time to write addr/data and then do it, dammit */ for (t=0; t<POLL_COUNT; t++){ if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0x00010000) break; udelay(1); } outl(((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) | CODEC_PORD, s->io+ES1371_REG_CODEC); /* restore SRC reg */ wait_src_ready(s); outl(x, s->io+ES1371_REG_SRCONV); rtl_spin_unlock_irqrestore(&s->lock, flags); /* wait for WIP again */ for (t = 0; t < 0x1000; t++) if (!(inl(s->io+ES1371_REG_CODEC) & CODEC_WIP)) break; /* now wait for the stinkin' data (RDY) */ for (t = 0; t < POLL_COUNT; t++) if ((x = inl(s->io+ES1371_REG_CODEC)) & CODEC_RDY) break; return ((x & CODEC_PIDAT_MASK) >> CODEC_PIDAT_SHIFT); } /* --------------------------------------------------------------------- */ extern inline void stop_adc(struct es1371_state *s) { unsigned long flags; rtl_spin_lock_irqsave(&s->lock, flags); s->ctrl &= ~CTRL_ADC_EN; outl(s->ctrl, s->io+ES1371_REG_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } extern inline void stop_dac1(struct es1371_state *s) { unsigned long flags; rtl_spin_lock_irqsave(&s->lock, flags); s->ctrl &= ~CTRL_DAC1_EN; outl(s->ctrl, s->io+ES1371_REG_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } extern inline void stop_dac2(struct es1371_state *s) { unsigned long flags; rtl_spin_lock_irqsave(&s->lock, flags); s->ctrl &= ~CTRL_DAC2_EN; outl(s->ctrl, s->io+ES1371_REG_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } static void start_adc(struct es1371_state *s) { unsigned long flags; unsigned fragremain, fshift; rtl_spin_lock_irqsave(&s->lock, flags); if (!(s->ctrl & CTRL_ADC_EN) && (s->dma_adc.mapped || s->dma_adc.count < (signed)(s->dma_adc.dmasize - 2*s->dma_adc.fragsize)) && s->dma_adc.ready) { s->ctrl |= CTRL_ADC_EN; s->sctrl = (s->sctrl & ~SCTRL_R1LOOPSEL) | SCTRL_R1INTEN; outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); fragremain = ((- s->dma_adc.hwptr) & (s->dma_adc.fragsize-1)); fshift = sample_shift[(s->sctrl & SCTRL_R1FMT) >> SCTRL_SH_R1FMT]; if (fragremain < 2*fshift) fragremain = s->dma_adc.fragsize; outl((fragremain >> fshift) - 1, s->io+ES1371_REG_ADC_SCOUNT); outl(s->ctrl, s->io+ES1371_REG_CONTROL); outl((s->dma_adc.fragsize >> fshift) - 1, s->io+ES1371_REG_ADC_SCOUNT); } rtl_spin_unlock_irqrestore(&s->lock, flags); } static void start_dac1(struct es1371_state *s) { unsigned long flags; unsigned fragremain, fshift; rtl_spin_lock_irqsave(&s->lock, flags); if (!(s->ctrl & CTRL_DAC1_EN) && (s->dma_dac1.mapped || s->dma_dac1.count > 0) && s->dma_dac1.ready) { s->ctrl |= CTRL_DAC1_EN; s->sctrl = (s->sctrl & ~(SCTRL_P1LOOPSEL | SCTRL_P1PAUSE | SCTRL_P1SCTRLD)) | SCTRL_P1INTEN; outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); fragremain = ((- s->dma_dac1.hwptr) & (s->dma_dac1.fragsize-1)); fshift = sample_shift[(s->sctrl & SCTRL_P1FMT) >> SCTRL_SH_P1FMT]; if (fragremain < 2*fshift) fragremain = s->dma_dac1.fragsize; outl((fragremain >> fshift) - 1, s->io+ES1371_REG_DAC1_SCOUNT); outl(s->ctrl, s->io+ES1371_REG_CONTROL); outl((s->dma_dac1.fragsize >> fshift) - 1, s->io+ES1371_REG_DAC1_SCOUNT); } rtl_spin_unlock_irqrestore(&s->lock, flags); } static void start_dac2(struct es1371_state *s) { unsigned long flags; unsigned fragremain, fshift; rtl_spin_lock_irqsave(&s->lock,flags); // BPM rtd_spin_lock_irqsave(...flags) if (!(s->ctrl & CTRL_DAC2_EN) && (s->dma_dac2.mapped || s->dma_dac2.count > 0) && s->dma_dac2.ready) { s->ctrl |= CTRL_DAC2_EN; s->sctrl = (s->sctrl & ~(SCTRL_P2LOOPSEL | SCTRL_P2PAUSE | SCTRL_P2DACSEN | SCTRL_P2ENDINC | SCTRL_P2STINC)) | SCTRL_P2INTEN | (((s->sctrl & SCTRL_P2FMT) ? 2 : 1) << SCTRL_SH_P2ENDINC) | (0 << SCTRL_SH_P2STINC); outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); fragremain = ((- s->dma_dac2.hwptr) & (s->dma_dac2.fragsize-1)); fshift = sample_shift[(s->sctrl & SCTRL_P2FMT) >> SCTRL_SH_P2FMT]; if (fragremain < 2*fshift) fragremain = s->dma_dac2.fragsize; outl((fragremain >> fshift) - 1, s->io+ES1371_REG_DAC2_SCOUNT); outl(s->ctrl, s->io+ES1371_REG_CONTROL); outl((s->dma_dac2.fragsize >> fshift) - 1, s->io+ES1371_REG_DAC2_SCOUNT); } rtl_spin_unlock_irqrestore(&s->lock,flags); // BPM rtd_spin_unlock_irqrestore(...flags) } /* --------------------------------------------------------------------- */ #define DMABUF_DEFAULTORDER (17-PAGE_SHIFT) #define DMABUF_MINORDER 1 extern inline void dealloc_dmabuf(struct es1371_state *s, struct dmabuf *db) { /* BPM unsigned long map, mapend; */ struct page *map, *mapend; if (db->rawbuf) { /* undo marking the pages as reserved */ /* BPM MAP_NR : indefini au chargement du module mapend = PKMAP_NR(db->rawbuf + (PAGE_SIZE << db->buforder) - 1); for (map = PKMAP_NR(db->rawbuf); map <= mapend; map++) clear_bit(PG_reserved, &mem_map[map].flags); */ mapend = virt_to_page(db->rawbuf + (PAGE_SIZE << db->buforder) - 1); for (map = virt_to_page(db->rawbuf); map <= mapend; map++) mem_map_unreserve(map); // free_pages((unsigned long)db->rawbuf, db->buforder); pci_free_consistent(s->dev, PAGE_SIZE << db->buforder, db->rawbuf, db->dmaaddr); } db->rawbuf = NULL; db->mapped = db->ready = 0; } static int prog_dmabuf(struct es1371_state *s, struct dmabuf *db, unsigned rate, unsigned fmt, unsigned reg) { int order; unsigned bytepersec; unsigned bufs; /* BPM unsigned long map, mapend; */ struct page *map, *mapend; db->hwptr = db->swptr = db->total_bytes = db->count = db->error = db->endcleared = 0; if (!db->rawbuf) { db->ready = db->mapped = 0; /* BPM for (order = DMABUF_DEFAULTORDER; order >= DMABUF_MINORDER; order--) if ((db->rawbuf = (void *)__get_free_pages(GFP_KERNEL, order))) break; */ for (order = DMABUF_DEFAULTORDER; order >= DMABUF_MINORDER; order--) if ((db->rawbuf = pci_alloc_consistent(s->dev, PAGE_SIZE << order, &db->dmaaddr))) break; if (!db->rawbuf) return -ENOMEM; db->buforder = order; /* now mark the pages as reserved; otherwise remap_page_range doesn't do what we want */ /* BPM MAP_NR : indefini au chargement du module mapend = PKMAP_NR(db->rawbuf + (PAGE_SIZE << db->buforder) - 1); for (map = PKMAP_NR(db->rawbuf); map <= mapend; map++) set_bit(PG_reserved, &mem_map[map].flags); */ mapend = virt_to_page(db->rawbuf + (PAGE_SIZE << db->buforder) - 1); for (map = virt_to_page(db->rawbuf); map <= mapend; map++) mem_map_reserve(map); } fmt &= ES1371_FMT_MASK; bytepersec = rate << sample_shift[fmt]; bufs = PAGE_SIZE << db->buforder; if (db->ossfragshift) { if ((1000 << db->ossfragshift) < bytepersec) db->fragshift = ld2(bytepersec/1000); else db->fragshift = db->ossfragshift; } else { db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1)); if (db->fragshift < 3) db->fragshift = 3; } db->numfrag = bufs >> db->fragshift; while (db->numfrag < 4 && db->fragshift > 3) { db->fragshift--; db->numfrag = bufs >> db->fragshift; } db->fragsize = 1 << db->fragshift; if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag) db->numfrag = db->ossmaxfrags; db->fragsamples = db->fragsize >> sample_shift[fmt]; db->dmasize = db->numfrag << db->fragshift; memset(db->rawbuf, (fmt & ES1371_FMT_S16) ? 0 : 0x80, db->dmasize); outl((reg >> 8) & 15, s->io+ES1371_REG_MEMPAGE); outl(db->dmaaddr, s->io+(reg & 0xff)); outl((db->dmasize >> 2)-1, s->io+((reg + 4) & 0xff)); db->ready = 1; return 0; } extern inline int prog_dmabuf_adc(struct es1371_state *s) { return 0; } extern inline int prog_dmabuf_dac2(struct es1371_state *s) { stop_dac2(s); return prog_dmabuf(s, &s->dma_dac2, s->dac2rate, (s->sctrl >> SCTRL_SH_P2FMT) & ES1371_FMT_MASK, ES1371_REG_DAC2_FRAMEADR); } extern inline unsigned get_hwptr(struct es1371_state *s, struct dmabuf *db, unsigned reg) { unsigned hwptr, diff; outl((reg >> 8) & 15, s->io+ES1371_REG_MEMPAGE); hwptr = (inl(s->io+(reg & 0xff)) >> 14) & 0x3fffc; diff = (db->dmasize + hwptr - db->hwptr) % db->dmasize; db->hwptr = hwptr; return diff; } extern inline void clear_advance(void *buf, unsigned bsize, unsigned bptr, unsigned len, unsigned char c) { if (bptr + len > bsize) { unsigned x = bsize - bptr; memset(((char *)buf) + bptr, c, x); bptr = 0; len -= x; } memset(((char *)buf) + bptr, c, len); } /* call with spinlock held! */ static void es1371_update_ptr(struct es1371_state *s) { int diff; /* update DAC2 pointer */ if (s->ctrl & CTRL_DAC2_EN) { DEBINT(rtl_printf("es1371 : update_ptr : Begin DAC2 , before get_hwptr() \n");) diff = get_hwptr(s, &s->dma_dac2, ES1371_REG_DAC2_FRAMECNT); DEBINT(rtl_printf("es1371 : update_ptr : after get_hwptr() diff=%d\n",diff);) s->dma_dac2.total_bytes += diff; if (s->dma_dac2.mapped) { DEBINT(rtl_printf("es1371 : update_ptr : mapped\n");) s->dma_dac2.count += diff; if (s->dma_dac2.count >= (signed)s->dma_dac2.fragsize) pthread_wakeup_np(s->thisThread); s->thisThread=NULL; } else { s->dma_dac2.count -= diff; DEBINT(rtl_printf("es1371 : update_ptr : unmapped s->dma_dac2.count=%d \n",s->dma_dac2.count);) if (s->dma_dac2.count <= 0) { s->ctrl &= ~CTRL_DAC2_EN; outl(s->ctrl, s->io+ES1371_REG_CONTROL); s->dma_dac2.error++; } else if (s->dma_dac2.count <= (signed)s->dma_dac2.fragsize && !s->dma_dac2.endcleared) { clear_advance(s->dma_dac2.rawbuf, s->dma_dac2.dmasize, s->dma_dac2.swptr, s->dma_dac2.fragsize, (s->sctrl & SCTRL_P2SEB) ? 0 : 0x80); s->dma_dac2.endcleared = 1; } if (s->dma_dac2.count + (signed)s->dma_dac2.fragsize <= (signed)s->dma_dac2.dmasize) { if ( BPMsuspend == 1 ) { if ( s->thisThread!=NULL ) { DEBINT(rtl_printf("es1371 : update_ptr : before rtd_wake_up() \n");) pthread_wakeup_np(s->thisThread); s->thisThread=NULL; DEBINT(rtl_printf("es1371 : update_ptr : after rtd_wake_up() \n");) } } } } } } /* BPM my interrupt handler */ static unsigned int myHandler(unsigned int irq, struct pt_regs *regs) { struct es1371_state *s; unsigned int intsrc, sctl; rtl_printf("INTERRUPT \n"); s = devs_es; VALIDATE_STATE(s); /* fastpath out, to ease interrupt sharing */ intsrc = inl(s->io+ES1371_REG_STATUS); if (!(intsrc & 0x80000000)) { rtl_printf("es1371 : RT-Thread : return error if (!(intsrc & 0x80000000)) \n"); return 0; } spin_lock(&s->lock); /* clear audio interrupts first */ sctl = s->sctrl; if (intsrc & STAT_ADC) sctl &= ~SCTRL_R1INTEN; if (intsrc & STAT_DAC1) sctl &= ~SCTRL_P1INTEN; if (intsrc & STAT_DAC2) sctl &= ~SCTRL_P2INTEN; outl(sctl, s->io+ES1371_REG_SERIAL_CONTROL); outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); es1371_update_ptr(s); // es1371_handle_midi(s); spin_unlock(&s->lock); DEBINT(rtl_printf("es1371 : RT-Thread : after : spin_lock() :Fin Fin \n");) rtl_hard_enable_irq(irq); return 0; } /* * AC97 Mixer Register to Connections mapping of the Concert 97 board * * AC97_MASTER_VOL_STEREO Line Out * AC97_MASTER_VOL_MONO TAD Output * AC97_PCBEEP_VOL none * AC97_PHONE_VOL TAD Input (mono) * AC97_MIC_VOL MIC Input (mono) * AC97_LINEIN_VOL Line Input (stereo) * AC97_CD_VOL CD Input (stereo) * AC97_VIDEO_VOL none * AC97_AUX_VOL Aux Input (stereo) * AC97_PCMOUT_VOL Wave Output (stereo) */ #define AC97_PESSIMISTIC /* * this define causes the driver to assume that all optional * AC97 bits are missing. This is what Ensoniq does too in their * Windows driver. Maybe we should one day autoprobe for these * bits. But anyway I have to see an AC97 codec that implements * one of those optional (volume) bits. */ static const unsigned int recsrc[8] = { SOUND_MASK_MIC, SOUND_MASK_CD, SOUND_MASK_VIDEO, SOUND_MASK_LINE1, SOUND_MASK_LINE, SOUND_MASK_VOLUME, SOUND_MASK_PHONEOUT, SOUND_MASK_PHONEIN }; static const unsigned char volreg[SOUND_MIXER_NRDEVICES] = { /* 5 bit stereo */ [SOUND_MIXER_LINE] = AC97_LINEIN_VOL, [SOUND_MIXER_CD] = AC97_CD_VOL, [SOUND_MIXER_VIDEO] = AC97_VIDEO_VOL, [SOUND_MIXER_LINE1] = AC97_AUX_VOL, [SOUND_MIXER_PCM] = AC97_PCMOUT_VOL, /* 6 bit stereo */ [SOUND_MIXER_VOLUME] = AC97_MASTER_VOL_STEREO, [SOUND_MIXER_PHONEOUT] = AC97_HEADPHONE_VOL, /* 6 bit mono */ [SOUND_MIXER_OGAIN] = AC97_MASTER_VOL_MONO, [SOUND_MIXER_PHONEIN] = AC97_PHONE_VOL, /* 4 bit mono but shifted by 1 */ [SOUND_MIXER_SPEAKER] = AC97_MASTER_TONE, /* 6 bit mono + preamp */ [SOUND_MIXER_MIC] = AC97_MIC_VOL, /* 4 bit stereo */ [SOUND_MIXER_RECLEV] = AC97_RECORD_GAIN, /* 4 bit mono */ [SOUND_MIXER_IGAIN] = AC97_RECORD_GAIN_MIC }; #ifdef OSS_DOCUMENTED_MIXER_SEMANTICS #define swab(x) ((((x) >> 8) & 0xff) | (((x) << 8) & 0xff00)) #else /* OSS_DOCUMENTED_MIXER_SEMANTICS */ static const unsigned char volidx[SOUND_MIXER_NRDEVICES] = { /* 5 bit stereo */ [SOUND_MIXER_LINE] = 1, [SOUND_MIXER_CD] = 2, [SOUND_MIXER_VIDEO] = 3, [SOUND_MIXER_LINE1] = 4, [SOUND_MIXER_PCM] = 5, /* 6 bit stereo */ [SOUND_MIXER_VOLUME] = 6, [SOUND_MIXER_PHONEOUT] = 7, /* 6 bit mono */ [SOUND_MIXER_OGAIN] = 8, [SOUND_MIXER_PHONEIN] = 9, /* 4 bit mono but shifted by 1 */ [SOUND_MIXER_SPEAKER] = 10, /* 6 bit mono + preamp */ [SOUND_MIXER_MIC] = 11, /* 4 bit stereo */ [SOUND_MIXER_RECLEV] = 12, /* 4 bit mono */ [SOUND_MIXER_IGAIN] = 13 }; #endif /* OSS_DOCUMENTED_MIXER_SEMANTICS */ static int mixer_wrch(struct es1371_state *s, unsigned int ch, int val) { int i; unsigned l1, r1; l1 = val & 0xff; r1 = (val >> 8) & 0xff; if (l1 > 100) l1 = 100; if (r1 > 100) r1 = 100; switch (ch) { case SOUND_MIXER_LINE: case SOUND_MIXER_CD: case SOUND_MIXER_VIDEO: case SOUND_MIXER_LINE1: case SOUND_MIXER_PCM: if (l1 < 7 && r1 < 7) { wrcodec(s, volreg[ch], AC97_MUTE); return 0; } if (l1 < 7) l1 = 7; if (r1 < 7) r1 = 7; wrcodec(s, volreg[ch], (((100 - l1) / 3) << 8) | ((100 - r1) / 3)); return 0; case SOUND_MIXER_PHONEOUT: if (!(s->mix.codec_id & CODEC_ID_HEADPHONEOUT)) return -EINVAL; /* fall through */ case SOUND_MIXER_VOLUME: #ifdef AC97_PESSIMISTIC if (l1 < 7 && r1 < 7) { wrcodec(s, volreg[ch], AC97_MUTE); return 0; } if (l1 < 7) l1 = 7; if (r1 < 7) r1 = 7; wrcodec(s, volreg[ch], (((100 - l1) / 3) << 8) | ((100 - r1) / 3)); return 0; #else /* AC97_PESSIMISTIC */ if (l1 < 4 && r1 < 4) { wrcodec(s, volreg[ch], AC97_MUTE); return 0; } if (l1 < 4) l1 = 4; if (r1 < 4) r1 = 4; wrcodec(s, volreg[ch], ((2 * (100 - l1) / 3) << 8) | (2 * (100 - r1) / 3)); return 0; #endif /* AC97_PESSIMISTIC */ case SOUND_MIXER_OGAIN: case SOUND_MIXER_PHONEIN: #ifdef AC97_PESSIMISTIC wrcodec(s, volreg[ch], (l1 < 7) ? AC97_MUTE : (100 - l1) / 3); return 0; #else /* AC97_PESSIMISTIC */ wrcodec(s, volreg[ch], (l1 < 4) ? AC97_MUTE : (2 * (100 - l1) / 3)); return 0; #endif /* AC97_PESSIMISTIC */ case SOUND_MIXER_SPEAKER: wrcodec(s, AC97_PCBEEP_VOL, (l1 < 10) ? AC97_MUTE : ((100 - l1) / 6) << 1); return 0; case SOUND_MIXER_MIC: #ifdef AC97_PESSIMISTIC if (l1 < 11) { wrcodec(s, AC97_MIC_VOL, AC97_MUTE); return 0; } i = 0; if (l1 >= 27) { l1 -= 27; i = 0x40; } if (l1 < 11) l1 = 11; wrcodec(s, AC97_MIC_VOL, ((73 - l1) / 2) | i); return 0; #else /* AC97_PESSIMISTIC */ if (l1 < 9) { wrcodec(s, AC97_MIC_VOL, AC97_MUTE); return 0; } i = 0; if (l1 >= 13) { l1 -= 13; i = 0x40; } if (l1 < 9) l1 = 9; wrcodec(s, AC97_MIC_VOL, (((87 - l1) * 4) / 5) | i); return 0; #endif /* AC97_PESSIMISTIC */ case SOUND_MIXER_BASS: val = ((l1 * 15) / 100) & 0xf; wrcodec(s, AC97_MASTER_TONE, (rdcodec(s, AC97_MASTER_TONE) & 0x00ff) | (val << 8)); return 0; case SOUND_MIXER_TREBLE: val = ((l1 * 15) / 100) & 0xf; wrcodec(s, AC97_MASTER_TONE, (rdcodec(s, AC97_MASTER_TONE) & 0xff00) | val); return 0; /* SOUND_MIXER_RECLEV and SOUND_MIXER_IGAIN specify gain */ case SOUND_MIXER_RECLEV: if (l1 < 10 || r1 < 10) { wrcodec(s, AC97_RECORD_GAIN, AC97_MUTE); return 0; } if (l1 < 10) l1 = 10; if (r1 < 10) r1 = 10; wrcodec(s, AC97_RECORD_GAIN, (((l1 - 10) / 6) << 8) | ((r1 - 10) / 6)); return 0; case SOUND_MIXER_IGAIN: if (!(s->mix.codec_id & CODEC_ID_DEDICATEDMIC)) return -EINVAL; wrcodec(s, AC97_RECORD_GAIN_MIC, (l1 < 10) ? AC97_MUTE : ((l1 - 10) / 6) & 0xf); return 0; default: return -EINVAL; } } static int mixer_ioctl(struct es1371_state *s, unsigned int cmd, unsigned long arg) { int i, val; VALIDATE_STATE(s); if (cmd == SOUND_MIXER_PRIVATE1) { if (!(s->mix.codec_id & (CODEC_ID_SEMASK << CODEC_ID_SESHIFT))) return -EINVAL; rtd_get_user_ret(val, (int *)arg, -EFAULT); if (val & 1) wrcodec(s, AC97_3D_CONTROL, ((val << 3) & 0xf00) | ((val >> 1) & 0xf)); val = rdcodec(s, AC97_3D_CONTROL); return rtd_put_user(((val & 0xf) << 1) | ((val & 0xf00) >> 3), (int *)arg); } if (cmd == SOUND_MIXER_INFO) { mixer_info info; strncpy(info.id, "ES1371", sizeof(info.id)); strncpy(info.name, "Ensoniq ES1371", sizeof(info.name)); info.modify_counter = s->mix.modcnt; if (rtd_copy_to_user((void *)arg, &info, sizeof(info))) return -EFAULT; return 0; } if (cmd == SOUND_OLD_MIXER_INFO) { _old_mixer_info info; strncpy(info.id, "ES1371", sizeof(info.id)); strncpy(info.name, "Ensoniq ES1371", sizeof(info.name)); if (rtd_copy_to_user((void *)arg, &info, sizeof(info))) return -EFAULT; return 0; } if (cmd == OSS_GETVERSION) return rtd_put_user(SOUND_VERSION, (int *)arg); if (_IOC_TYPE(cmd) != 'M' || _IOC_SIZE(cmd) != sizeof(int)) return -EINVAL; if (_IOC_DIR(cmd) == _IOC_READ) { switch (_IOC_NR(cmd)) { case SOUND_MIXER_RECSRC: /* Arg contains a bit for each recording source */ return rtd_put_user(recsrc[rdcodec(s, AC97_RECORD_SELECT) & 7], (int *)arg); case SOUND_MIXER_DEVMASK: /* Arg contains a bit for each supported device */ return rtd_put_user(SOUND_MASK_LINE | SOUND_MASK_CD | SOUND_MASK_VIDEO | SOUND_MASK_LINE1 | SOUND_MASK_PCM | SOUND_MASK_VOLUME | SOUND_MASK_OGAIN | SOUND_MASK_PHONEIN | SOUND_MASK_SPEAKER | SOUND_MASK_MIC | SOUND_MASK_RECLEV | ((s->mix.codec_id & CODEC_ID_BASSTREBLE) ? (SOUND_MASK_BASS | SOUND_MASK_TREBLE) : 0) | ((s->mix.codec_id & CODEC_ID_HEADPHONEOUT) ? SOUND_MASK_PHONEOUT : 0) | ((s->mix.codec_id & CODEC_ID_DEDICATEDMIC) ? SOUND_MASK_IGAIN : 0), (int *)arg); case SOUND_MIXER_RECMASK: /* Arg contains a bit for each supported recording source */ return rtd_put_user(SOUND_MASK_MIC | SOUND_MASK_CD | SOUND_MASK_VIDEO | SOUND_MASK_LINE1 | SOUND_MASK_LINE | SOUND_MASK_VOLUME | SOUND_MASK_PHONEOUT | SOUND_MASK_PHONEIN, (int *)arg); case SOUND_MIXER_STEREODEVS: /* Mixer channels supporting stereo */ return rtd_put_user(SOUND_MASK_LINE | SOUND_MASK_CD | SOUND_MASK_VIDEO | SOUND_MASK_LINE1 | SOUND_MASK_PCM | SOUND_MASK_VOLUME | SOUND_MASK_PHONEOUT | SOUND_MASK_RECLEV, (int *)arg); case SOUND_MIXER_CAPS: return rtd_put_user(SOUND_CAP_EXCL_INPUT, (int *)arg); default: i = _IOC_NR(cmd); if (i >= SOUND_MIXER_NRDEVICES) return -EINVAL; #ifdef OSS_DOCUMENTED_MIXER_SEMANTICS return mixer_rdch(s, i, (int *)arg); #else /* OSS_DOCUMENTED_MIXER_SEMANTICS */ if (!volidx[i]) return -EINVAL; return rtd_put_user(s->mix.vol[volidx[i]-1], (int *)arg); #endif /* OSS_DOCUMENTED_MIXER_SEMANTICS */ } } if (_IOC_DIR(cmd) != (_IOC_READ|_IOC_WRITE)) return -EINVAL; s->mix.modcnt++; switch (_IOC_NR(cmd)) { case SOUND_MIXER_RECSRC: /* Arg contains a bit for each recording source */ rtd_get_user_ret(val, (int *)arg, -EFAULT); i = hweight32(val); if (i == 0) return 0; /*val = mixer_recmask(s);*/ else if (i > 1) val &= ~recsrc[rdcodec(s, AC97_RECORD_SELECT) & 7]; for (i = 0; i < 8; i++) { if (val & recsrc[i]) { wrcodec(s, AC97_RECORD_SELECT, 0x101 * i); return 0; } } return 0; default: i = _IOC_NR(cmd); if (i >= SOUND_MIXER_NRDEVICES) return -EINVAL; rtd_get_user_ret(val, (int *)arg, -EFAULT); if (mixer_wrch(s, i, val)) return -EINVAL; #ifdef OSS_DOCUMENTED_MIXER_SEMANTICS return mixer_rdch(s, i, (int *)arg); #else /* OSS_DOCUMENTED_MIXER_SEMANTICS */ if (!volidx[i]) return -EINVAL; s->mix.vol[volidx[i]-1] = val; return rtd_put_user(s->mix.vol[volidx[i]-1], (int *)arg); #endif /* OSS_DOCUMENTED_MIXER_SEMANTICS */ } } /* --------------------------------------------------------------------- */ static loff_t es1371_llseek(struct rtl_file *file, loff_t offset, int origin) { return -ESPIPE; } /* --------------------------------------------------------------------- */ /* --------------------------------------------------------------------- */ static int drain_dac2(struct es1371_state *s, int nonblock) { /* struct wait_queue wait = { current, NULL };*/ unsigned long flags; int count, tmo; if (s->dma_dac2.mapped || !s->dma_dac2.ready) return 0; /* current->state = TASK_INTERRUPTIBLE; add_wait_queue(&s->dma_dac2.wait, &wait);*/ DEBRTL(rtl_printf("es1371: drain_dac2 : Waiting for DMA...\n");) for (;;) { rtl_spin_lock_irqsave(&s->lock, flags); count = s->dma_dac2.count; rtl_spin_unlock_irqrestore(&s->lock, flags); if (count <= 0) break; // if (rtd_signal_pending_current()) // break; if (nonblock) { /* remove_wait_queue(&s->dma_dac2.wait, &wait); current->state = TASK_RUNNING;*/ return -EBUSY; } tmo = 3 * HZ * (count + s->dma_dac2.fragsize) / 2 / s->dac2rate; tmo >>= sample_shift[(s->sctrl & SCTRL_P2FMT) >> SCTRL_SH_P2FMT]; DEBRTL(rtl_printf("es1371: drain_dac2 : before waiting... \n");) s->thisThread=pthread_self(); pthread_suspend_np(pthread_self()); } DEBRTL(rtl_printf("es1371: drain_dac2 : End \n");) return 0; } /* --------------------------------------------------------------------- */ static ssize_t es1371_read(struct rtl_file *file, char *buffer, size_t count, loff_t *ppos) { struct es1371_state *s = devs_es; ssize_t ret; unsigned long flags; unsigned swptr; int cnt; VALIDATE_STATE(s); if (ppos != &file->f_pos) return -ESPIPE; if (s->dma_adc.mapped) return -ENXIO; if (!s->dma_adc.ready && (ret = prog_dmabuf_adc(s))) return ret; ret = 0; while (count > 0) { rtl_spin_lock_irqsave(&s->lock, flags); swptr = s->dma_adc.swptr; cnt = s->dma_adc.dmasize-swptr; if (s->dma_adc.count < cnt) cnt = s->dma_adc.count; rtl_spin_unlock_irqrestore(&s->lock, flags); if (cnt > count) cnt = count; if (cnt <= 0) { start_adc(s); if (file->f_flags & O_NONBLOCK) return ret ? ret : -EAGAIN; s->thisThread=pthread_self(); pthread_suspend_np(pthread_self()); continue; } memcpy(buffer, s->dma_adc.rawbuf + swptr, cnt); swptr = (swptr + cnt) % s->dma_adc.dmasize; rtl_spin_lock_irqsave(&s->lock, flags); s->dma_adc.swptr = swptr; s->dma_adc.count -= cnt; rtl_spin_unlock_irqrestore(&s->lock, flags); count -= cnt; buffer += cnt; ret += cnt; start_adc(s); } return ret; } static int nbBuf=1; static int nbSuspend=0; static ssize_t es1371_write(struct rtl_file *file, const char *buffer, size_t count, loff_t *ppos) { struct es1371_state *s = devs_es; ssize_t ret; unsigned long flags; unsigned swptr; int cnt; int noBuf=nbBuf; int noWhile=0; hrtime_t ghl,thhl; unsigned long interrupt_state; nbBuf++; DEBRTL(rtl_printf("es1371 : write : Begin noBuf=%d pthread_self()=%x \n",noBuf,pthread_self());) VALIDATE_STATE(s); if (ppos != &file->f_pos) return -ESPIPE; if (s->dma_dac2.mapped) return -ENXIO; if (!s->dma_dac2.ready && (ret = prog_dmabuf_dac2(s))) return ret; ret = 0; while (count > 0) { noWhile++; rtl_spin_lock_irqsave(&s->lock,flags); if (s->dma_dac2.count < 0) { s->dma_dac2.count = 0; s->dma_dac2.swptr = s->dma_dac2.hwptr; } swptr = s->dma_dac2.swptr; cnt = s->dma_dac2.dmasize-swptr; if (s->dma_dac2.count + cnt > s->dma_dac2.dmasize) cnt = s->dma_dac2.dmasize - s->dma_dac2.count; rtl_spin_unlock_irqrestore(&s->lock,flags); // rtd_spin_unlock_irqrestore(,flags) if (cnt > count) cnt = count; if (cnt <= 0) { start_dac2(s); if (file->f_flags & O_NONBLOCK) return ret ? ret : -EAGAIN; DEBRTL(rtl_printf(KERN_EMERG "es1371 : write : pthread_self()=%x \n",pthread_self());) if ( BPMsuspend == 1 ) { DEBRTL(rtl_printf(KERN_EMERG "es1371 : write : before suspend()-(%d) flags=%lx noBuf=%d noWile=%d\n",BPMsuspend,flags,noBuf,noWhile);) s->thisThread=pthread_self(); pthread_suspend_np(pthread_self()); // BPM } else { DEBRTL(rtl_printf("es1371 : write : before usleep()-(%d) flags=%lx noBuf=%d noWile=%d\n",BPMsuspend,flags,noBuf,noWhile);) usleep(15000); } DEBRTL(rtl_printf("es1371 : write : after WakeUp() and CONTINUEnow noBuf=%d noWile=%d\n",noBuf,noWhile);) continue; } DEBRTL(rtl_printf("es1371 : write : cnt=%d before copy to rawbuf : noBuf=%d noWhile=%d rawbuf=%x swptr=%u buffer=%x\n",cnt,noBuf,noWhile,s->dma_dac2.rawbuf,swptr,buffer);) memcpy(s->dma_dac2.rawbuf + swptr, buffer, cnt); // BPM DEBRTL(rtl_printf("es1371 : write : after copy to rawbuf noBuf=%d noWile=%d\n",noBuf,noWhile);) swptr = (swptr + cnt) % s->dma_dac2.dmasize; rtl_spin_lock_irqsave(&s->lock,flags); s->dma_dac2.swptr = swptr; s->dma_dac2.count += cnt; s->dma_dac2.endcleared = 0; rtl_spin_unlock_irqrestore(&s->lock,flags); count -= cnt; buffer += cnt; ret += cnt; start_dac2(s); } DEBRTL(rtl_printf("es1371 : write : End End noBuf=%d noWhile=%d ret=%d\n",noBuf,noWhile,ret);) return ret; } static unsigned int es1371_poll(struct rtl_file *file, struct poll_table_struct *wait) { struct es1371_state *s = devs_es; unsigned long flags; unsigned int mask = 0; /* VALIDATE_STATE(s); if (file->f_flags & FMODE_WRITE) rtd_poll_wait(file, &s->dma_dac2.wait, wait); if (file->f_flags & FMODE_READ) rtd_poll_wait(file, &s->dma_adc.wait, wait); rtd_spin_lock_irqsave(&s->lock, flags); es1371_update_ptr(s); if (file->f_flags & FMODE_READ) { if (s->dma_adc.count >= (signed)s->dma_adc.fragsize) mask |= POLLIN | POLLRDNORM; } if (file->f_flags & FMODE_WRITE) { if (s->dma_dac2.mapped) { if (s->dma_dac2.count >= (signed)s->dma_dac2.fragsize) mask |= POLLOUT | POLLWRNORM; } else { if ((signed)s->dma_dac2.dmasize >= s->dma_dac2.count + (signed)s->dma_dac2.fragsize) mask |= POLLOUT | POLLWRNORM; } } rtd_spin_unlock_irqrestore(&s->lock, flags); */ return mask; } static int es1371_mmap(struct rtl_file *file, struct vm_area_struct *vma) { struct es1371_state *s = devs_es; struct dmabuf *db; int ret; unsigned long size; VALIDATE_STATE(s); if (vma->vm_flags & VM_WRITE) { if ((ret = prog_dmabuf_dac2(s)) != 0) return ret; db = &s->dma_dac2; } else if (vma->vm_flags & VM_READ) { if ((ret = prog_dmabuf_adc(s)) != 0) return ret; db = &s->dma_adc; } else return -EINVAL; if (vma->vm_pgoff != 0) return -EINVAL; size = vma->vm_end - vma->vm_start; if (size > (PAGE_SIZE << db->buforder)) return -EINVAL; if (remap_page_range(vma->vm_start, virt_to_phys(db->rawbuf), size, vma->vm_page_prot)) return -EAGAIN; db->mapped = 1; return 0; } static int es1371_ioctl(struct rtl_file *file, unsigned int cmd, unsigned long arg) { struct es1371_state *s; unsigned long flags; audio_buf_info abinfo; count_info cinfo; int val, mapped, ret; rtl_printf("rt_es1371 : ioctl : Debut 1 \n \n \n"); s = devs_es; rtl_printf("rt_es1371 : ioctl : Debut 2 \n \n \n"); VALIDATE_STATE(s); rtl_printf("rt_es1371 : ioctl : Debut 3 \n \n \n"); mapped = ((file->f_flags & FMODE_WRITE) && s->dma_dac2.mapped) || ((file->f_flags & FMODE_READ) && s->dma_adc.mapped); rtl_printf("rt_es1371 : ioctl : Debut 4 \n \n \n"); switch (cmd) { case SNDCTL_DSP_RESET: rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_RESET debut \n \n"); if (file->f_flags & FMODE_WRITE) { rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_RESET debut FMODE_WRITE \n \n"); stop_dac2(s); rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_RESET apres stop_dac2() \n \n"); s->dma_dac2.swptr = s->dma_dac2.hwptr = s->dma_dac2.count = s->dma_dac2.total_bytes = 0; } if (file->f_flags & FMODE_READ) { rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_RESET debut FMODE_READ \n \n"); stop_adc(s); s->dma_adc.swptr = s->dma_adc.hwptr = s->dma_adc.count = s->dma_adc.total_bytes = 0; } rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_RESET fin \n \n"); return 0; case SNDCTL_DSP_SPEED: val=*((int*)arg); if (val >= 0) { if (file->f_flags & FMODE_READ) { stop_adc(s); s->dma_adc.ready = 0; set_adc_rate(s, val); } if (file->f_flags & FMODE_WRITE) { stop_dac2(s); s->dma_dac2.ready = 0; set_dac2_rate(s, val); } } *((int*)arg)=((file->f_flags & FMODE_READ) ? s->adcrate : s->dac2rate); return 0; case SNDCTL_DSP_STEREO: val=*((int*)arg); if (file->f_flags & FMODE_READ) { stop_adc(s); s->dma_adc.ready = 0; rtl_spin_lock_irqsave(&s->lock, flags); if (val) s->sctrl |= SCTRL_R1SMB; else s->sctrl &= ~SCTRL_R1SMB; outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } if (file->f_flags & FMODE_WRITE) { stop_dac2(s); s->dma_dac2.ready = 0; rtl_spin_lock_irqsave(&s->lock, flags); if (val) s->sctrl |= SCTRL_P2SMB; else s->sctrl &= ~SCTRL_P2SMB; outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } return 0; case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/ rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_SETFMT Debut \n"); val = *((int*)arg); rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_SETFMT val=%d \n",val); if (val != AFMT_QUERY) { if (file->f_flags & FMODE_READ) { stop_adc(s); s->dma_adc.ready = 0; rtl_spin_lock_irqsave(&s->lock, flags); if (val == AFMT_S16_LE) s->sctrl |= SCTRL_R1SEB; else s->sctrl &= ~SCTRL_R1SEB; outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } if (file->f_flags & FMODE_WRITE) { rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_SETFMT deb FMODE_WRITE \n"); stop_dac2(s); s->dma_dac2.ready = 0; rtl_spin_lock_irqsave(&s->lock, flags); if (val == AFMT_S16_LE) { s->sctrl |= SCTRL_P2SEB; rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_SETFMT if SCTRL_P2SEB s->sctrl=%d \n",s->sctrl); } else { s->sctrl &= ~SCTRL_P2SEB; rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_SETFMT if ~SCTRL_P2SEB s->sctrl=%d \n",s->sctrl); } outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); } } ret=0; (*(int*)arg)=((s->sctrl & ((file->f_flags & FMODE_READ) ? SCTRL_R1SEB : SCTRL_P2SEB)) ? AFMT_S16_LE : AFMT_U8); rtl_printf("rt_es1371 : ioctl : SNDCTL_DSP_SETFMT FinFin : ret=%d arg=%d \n",ret,*((int*)arg)); return ret; case SNDCTL_DSP_GETOSPACE: if (!(file->f_flags & FMODE_WRITE)) return -EINVAL; if (!(s->ctrl & CTRL_DAC2_EN) && (val = prog_dmabuf_dac2(s)) != 0) return val; rtl_spin_lock_irqsave(&s->lock, flags); es1371_update_ptr(s); abinfo.fragsize = s->dma_dac2.fragsize; abinfo.bytes = s->dma_dac2.dmasize - s->dma_dac2.count; abinfo.fragstotal = s->dma_dac2.numfrag; abinfo.fragments = abinfo.bytes >> s->dma_dac2.fragshift; rtl_spin_unlock_irqrestore(&s->lock, flags); memcpy((void *)arg, &abinfo, sizeof(abinfo)); return 0; } rtl_printf("rt_es1371 : ioctl : fin ERROR case \n"); return -1; //mixer_ioctl(s, cmd, arg); } static int es1371_open( struct rtl_file *file) { struct es1371_state *s = devs_es; unsigned long flags; int minor; DEBRTL(rtl_printf("\n es1371_open : Begin flags=%lx \n",flags);) minor = file->f_minor; DEBRTL(rtl_printf(" es1371_open : minor=%d \n",minor);) while (s && ((s->dev_audio ^ minor) & ~0xf)) s = s->next; DEBRTL(rtl_printf(" es1371_open : s=%x \n",s);) if (!s) return -ENODEV; VALIDATE_STATE(s); /* wait for device to become free */ if(s->open_mode) return -EBUSY; if (file->f_flags & FMODE_READ) { s->dma_adc.ossfragshift = s->dma_adc.ossmaxfrags = s->dma_adc.subdivision = 0; set_adc_rate(s, 8000); } if (file->f_flags & FMODE_WRITE) { s->dma_dac2.ossfragshift = s->dma_dac2.ossmaxfrags = s->dma_dac2.subdivision = 0; set_dac2_rate(s, 8000); } rtl_spin_lock_irqsave(&s->lock, flags); if (file->f_flags & FMODE_READ) { s->sctrl &= ~SCTRL_R1FMT; if ((minor & 0xf) == SND_DEV_DSP16) s->sctrl |= ES1371_FMT_S16_MONO << SCTRL_SH_R1FMT; else s->sctrl |= ES1371_FMT_U8_MONO << SCTRL_SH_R1FMT; } if (file->f_flags & FMODE_WRITE) { s->sctrl &= ~SCTRL_P2FMT; if ((minor & 0xf) == SND_DEV_DSP16) s->sctrl |= ES1371_FMT_S16_MONO << SCTRL_SH_P2FMT; else s->sctrl |= ES1371_FMT_U8_MONO << SCTRL_SH_P2FMT; } outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); rtl_spin_unlock_irqrestore(&s->lock, flags); s->open_mode |= file->f_flags & (FMODE_READ | FMODE_WRITE); up(&s->open_sem); MOD_INC_USE_COUNT; s->thisThread=NULL; // BPM rtl_printf(" es1371_open : End Ok \n"); return 0; } static int es1371_release(struct rtl_file *file) { struct es1371_state *s = devs_es; // BPM (struct es1371_state *)file->private_data; DEBRTL(rtl_printf("\n es1371_release : Begin \n");) VALIDATE_STATE(s); if (file->f_flags & FMODE_WRITE) { drain_dac2(s, file->f_flags & O_NONBLOCK); } down(&s->open_sem); if (file->f_flags & FMODE_WRITE) { stop_dac2(s); dealloc_dmabuf(s,&s->dma_dac2); } if (file->f_flags & FMODE_READ) { stop_adc(s); dealloc_dmabuf(s,&s->dma_adc); } s->open_mode &= (~file->f_flags) & (FMODE_READ|FMODE_WRITE); up(&s->open_sem); MOD_DEC_USE_COUNT; DEBRTL(rtl_printf(" es1371_release : End Ok \n");) return 0; } static /*const*/ struct rtl_file_operations es1371_audio_fops = { es1371_llseek, es1371_read, es1371_write, // NULL, /* readdir */ // &es1371_poll, es1371_ioctl, NULL, //es1371_mmap, es1371_open, // NULL, /* flush */ es1371_release, // NULL, /* fsync */ // NULL, /* fasync */ // NULL, /* check_media_change */ // NULL, /* revalidate */ // NULL, /* lock */ }; /* --------------------------------------------------------------------- */ /* --------------------------------------------------------------------- */ /* --------------------------------------------------------------------- */ /* * for debugging purposes, we'll create a proc device that dumps the * CODEC chipstate */ #ifdef ES1371_DEBUG static int proc_es1371_dump (char *buf, char **start, off_t fpos, int length, int *eof, void *data) { int len = 0; struct es1371_state *s = devs_es; int cnt; /* print out header */ len += sprintf(buf + len, "\t\tCreative ES137x Debug Dump-o-matic\n"); /* print out CODEC state */ len += sprintf (buf + len, "AC97 CODEC state\n"); for (cnt=0; cnt <= 0x7e; cnt = cnt +2) len+= sprintf (buf + len, "reg:0x%02x val:0x%04x\n", cnt, rdcodec(s , cnt)); if (fpos >=len){ *start = buf; *eof =1; return 0; } *start = buf + fpos; if ((len -= fpos) > length) return length; *eof =1; return len; } #endif /* ES1371_DEBUG */ /* --------------------------------------------------------------------- */ /* maximum number of devices */ #define NR_DEVICE 5 #if CONFIG_SOUND_ES1371_JOYPORT_BOOT static int joystick[NR_DEVICE] = { CONFIG_SOUND_ES1371_GAMEPORT , 0, }; #else static int joystick[NR_DEVICE] = { 0, }; #endif static int spdif[NR_DEVICE] = { 0, }; /* --------------------------------------------------------------------- */ static struct initvol { int mixch; int vol; } initvol[] __initdata = { { SOUND_MIXER_WRITE_LINE, 0x4040 }, { SOUND_MIXER_WRITE_CD, 0x4040 }, { MIXER_WRITE(SOUND_MIXER_VIDEO), 0x4040 }, { SOUND_MIXER_WRITE_LINE1, 0x4040 }, { SOUND_MIXER_WRITE_PCM, 0x4040 }, { SOUND_MIXER_WRITE_VOLUME, 0x4040 }, { MIXER_WRITE(SOUND_MIXER_PHONEOUT), 0x4040 }, { SOUND_MIXER_WRITE_OGAIN, 0x4040 }, { MIXER_WRITE(SOUND_MIXER_PHONEIN), 0x4040 }, { SOUND_MIXER_WRITE_SPEAKER, 0x4040 }, { SOUND_MIXER_WRITE_MIC, 0x4040 }, { SOUND_MIXER_WRITE_RECLEV, 0x4040 }, { SOUND_MIXER_WRITE_IGAIN, 0x4040 } }; int init_module(void) { struct es1371_state *s; struct pci_dev *pcidev = NULL; mm_segment_t fs; int i, val, val2, index = 0; unsigned cssr; pthread_attr_t attr; struct sched_param sched_param; DEBRTL(rtl_printf("Begin rt_es1371.o module \n");) if (!pci_present()) /* No PCI bus in this machine! */ return -ENODEV; rtl_printf("es1371: version v0.19 time " __TIME__ " " __DATE__ "\n"); while (index < NR_DEVICE && (pcidev = pci_find_device(PCI_VENDOR_ID_ENSONIQ, PCI_DEVICE_ID_ENSONIQ_ES1371, pcidev))) { if (pcidev->irq == 0) continue; if (!(s = kmalloc(sizeof(struct es1371_state), GFP_KERNEL))) { rtl_printf("rt_es1371: out of memory \n"); continue; } memset(s, 0, sizeof(struct es1371_state)); /* rtd_init_waitqueue(&s->dma_adc.wait); rtd_init_waitqueue(&s->dma_dac1.wait); rtd_init_waitqueue(&s->dma_dac2.wait); rtd_init_waitqueue(&s->open_wait); rtd_init_waitqueue(&s->midi.iwait); rtd_init_waitqueue(&s->midi.owait); */ s->dev=pcidev; init_MUTEX(&s->open_sem); rtl_spin_lock_init(&s->lock); s->magic = ES1371_MAGIC; s->io = pci_resource_start(pcidev, 0); s->irq = pcidev->irq; pci_read_config_byte(pcidev, PCI_REVISION_ID, &s->rev); if (check_region(s->io, ES1371_EXTENT)) { rtl_printf("es1371: io ports %#lx-%#lx in use\n", s->io, s->io+ES1371_EXTENT-1); goto err_region; } request_region(s->io, ES1371_EXTENT, "es1371"); if ( rtl_request_global_irq(s->irq,myHandler) ) { rtl_printf("es1371: irq %u in use\n", s->irq); goto err_irq; } rtl_printf("es1371: found adapter at io %#lx irq %u\n es1371: features: joystick 0x%x\n", s->io, s->irq, joystick[index]); /* register devices */ // if ((s->dev_audio = register_sound_dsp((struct file *)(&es1371_audio_fops), -1)) < 0) // goto err_dev1; s->dev_audio = 3; rtl_printf("rt_es1371: register_sound_dsp(es1371_audio_fops)->major=%d \n",s->dev_audio); if (rtl_register_chrdev(s->dev_audio, "dsp", &es1371_audio_fops) < 0) goto err_dev1_rt; // if ((s->dev_mixer = register_sound_mixer((struct file *)(&es1371_mixer_fops), -1)) < 0) // goto err_dev2; s->dev_mixer = 0; /* rtl_printf("rt_es1371: register_sound_mixer(es1371_mixer_fops)->major=%d \n",s->dev_mixer); if (rtl_register_chrdev(s->dev_mixer, "mixer", &es1371_mixer_fops) < 0) goto err_dev2_rt; */ // if ((s->dev_dac = register_sound_dsp((struct file *)(&es1371_dac_fops), -1)) < 0) // goto err_dev3; s->dev_dac = 19; /* rtl_printf("rt_es1371: register_sound_dsp(es1371_dac_fops)->major=%d \n",s->dev_dac); if (rtl_register_chrdev(s->dev_dac, "dac", &es1371_dac_fops) < 0) goto err_dev3_rt; */ // if ((s->dev_midi = register_sound_midi((struct file *)(&es1371_midi_fops), -1)) < 0) // goto err_dev4; s->dev_midi = 2; /* rtl_printf("rt_es1371: register_sound_midi(es1371_midi_fops)->major=%d \n",s->dev_midi); if (rtl_register_chrdev(s->dev_midi, "midi", &es1371_midi_fops) < 0) goto err_dev4_rt; */ DEBRTL(rtl_printf("rt_es1371: rtl_register_chrdev..............s() ok\n");) #ifdef ES1371_DEBUG /* intialize the debug proc device */ /* s->ps = create_proc_entry("es1371", S_IFREG | S_IRUGO, NULL); if (s->ps) s->ps->read_proc = proc_es1371_dump; */ #endif /* ES1371_DEBUG */ /* initialize codec registers */ s->ctrl = 0; if ((joystick[index] & ~0x18) == 0x200) { if (check_region(joystick[index], JOY_EXTENT)) rtl_printf("es1371: joystick address 0x%x already in use\n", joystick[index]); else { s->ctrl |= CTRL_JYSTK_EN | (((joystick[index] >> 3) & CTRL_JOY_MASK) << CTRL_JOY_SHIFT); } } s->sctrl = 0; cssr = 0; /* check to see if s/pdif mode is being requested */ if (spdif[index]) { if (s->rev >= 4) { rtl_printf("es1371: enabling S/PDIF output\n"); cssr |= STAT_EN_SPDIF; s->ctrl |= CTRL_SPDIFEN_B; } else { rtl_printf("es1371: revision %d does not support S/PDIF\n", s->rev); } } /* initialize the chips */ outl(s->ctrl, s->io+ES1371_REG_CONTROL); outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL); outl(0, s->io+ES1371_REG_LEGACY); pci_set_master(pcidev); /* enable bus mastering */ /* AC97 warm reset to start the bitclk */ outl(s->ctrl | CTRL_SYNCRES, s->io+ES1371_REG_CONTROL); udelay(2); outl(s->ctrl, s->io+ES1371_REG_CONTROL); /* init the sample rate converter */ src_init(s); /* codec init */ wrcodec(s, AC97_RESET, 0); /* reset codec */ s->mix.codec_id = rdcodec(s, AC97_RESET); /* get codec ID */ val = rdcodec(s, AC97_VENDOR_ID1); val2 = rdcodec(s, AC97_VENDOR_ID2); rtl_printf("es1371: codec vendor %c%c%c revision %d\n", (val >> 8) & 0xff, val & 0xff, (val2 >> 8) & 0xff, val2 & 0xff); rtl_printf("es1371: codec features"); if (s->mix.codec_id & CODEC_ID_DEDICATEDMIC) rtl_printf(" dedicated MIC PCM in"); if (s->mix.codec_id & CODEC_ID_MODEMCODEC) rtl_printf(" Modem Line Codec"); if (s->mix.codec_id & CODEC_ID_BASSTREBLE) rtl_printf(" Bass & Treble"); if (s->mix.codec_id & CODEC_ID_SIMULATEDSTEREO) rtl_printf(" Simulated Stereo"); if (s->mix.codec_id & CODEC_ID_HEADPHONEOUT) rtl_printf(" Headphone out"); if (s->mix.codec_id & CODEC_ID_LOUDNESS) rtl_printf(" Loudness"); if (s->mix.codec_id & CODEC_ID_18BITDAC) rtl_printf(" 18bit DAC"); if (s->mix.codec_id & CODEC_ID_20BITDAC) rtl_printf(" 20bit DAC"); if (s->mix.codec_id & CODEC_ID_18BITADC) rtl_printf(" 18bit ADC"); if (s->mix.codec_id & CODEC_ID_20BITADC) rtl_printf(" 20bit ADC"); rtl_printf("%s\n", (s->mix.codec_id & 0x3ff) ? "" : " none"); val = (s->mix.codec_id >> CODEC_ID_SESHIFT) & CODEC_ID_SEMASK; rtl_printf("es1371: stereo enhancement: %s\n", (val <= 20) ? stereo_enhancement[val] : "unknown"); fs = get_fs(); set_fs(KERNEL_DS); val = SOUND_MASK_LINE; mixer_ioctl(s, SOUND_MIXER_WRITE_RECSRC, (unsigned long)&val); for (i = 0; i < sizeof(initvol)/sizeof(initvol[0]); i++) { val = initvol[i].vol; mixer_ioctl(s, initvol[i].mixch, (unsigned long)&val); } set_fs(fs); /* turn on S/PDIF output driver if requested */ outl(cssr, s->io+ES1371_REG_STATUS); /* queue it for later freeing */ s->next = devs_es; devs_es = s; index++; DEBRTL(rtl_printf("rt_es1371: ------------ 1st device registered ok ------------\n");) continue; err_dev4_rt: unregister_sound_midi(s->dev_midi); err_dev4: rtl_unregister_chrdev(s->dev_dac, "dac"); err_dev3_rt: unregister_sound_dsp(s->dev_dac); err_dev3: rtl_unregister_chrdev(s->dev_mixer, "mixer"); err_dev2_rt: unregister_sound_mixer(s->dev_mixer); err_dev2: rtl_unregister_chrdev(s->dev_audio, "dsp"); err_dev1_rt: unregister_sound_dsp(s->dev_audio); err_dev1: rtl_printf("rt_es1371: cannot register misc device\n"); err_irq: release_region(s->io, ES1371_EXTENT); err_region: /* BPM kfree_s(s, sizeof(struct es1371_state)); */ kfree(s); } if (!devs_es) return -ENODEV; rtl_printf("rt_es1371 : OOOOOOOOKKKKKKKK\n"); return 0; } /* --------------------------------------------------------------------- */ #ifdef MODULE MODULE_PARM(joystick, "1-" __MODULE_STRING(NR_DEVICE) "i"); MODULE_PARM_DESC(joystick, "sets address and enables joystick interface (still need separate driver)"); MODULE_PARM(spdif, "1-" __MODULE_STRING(NR_DEVICE) "i"); MODULE_PARM_DESC(spdif, "if 1 the output is in S/PDIF digital mode"); MODULE_PARM(BPMsuspend, "i"); MODULE_AUTHOR("Thomas M. Sailer, [email protected], [email protected]"); MODULE_DESCRIPTION("ES1371 AudioPCI97 Driver"); void cleanup_module(void) { struct es1371_state *s; rtl_printf("rt_es1371: unloading .....\n"); while ((s = devs_es)) { devs_es = devs_es->next; #ifdef ES1371_DEBUG /* if (s->ps) remove_proc_entry("es1371", NULL); */ #endif /* ES1371_DEBUG */ outl(0, s->io+ES1371_REG_CONTROL); /* switch everything off */ outl(0, s->io+ES1371_REG_SERIAL_CONTROL); /* clear serial interrupts */ rtl_free_global_irq(s->irq); release_region(s->io, ES1371_EXTENT); /* rtl_unregister_chrdev(s->dev_midi, "midi"); rtl_unregister_chrdev(s->dev_dac, "dac"); rtl_unregister_chrdev(s->dev_mixer, "mixer"); */ rtl_unregister_chrdev(s->dev_audio, "dsp"); /* unregister_sound_dsp(s->dev_audio); unregister_sound_mixer(s->dev_mixer); unregister_sound_dsp(s->dev_dac); unregister_sound_midi(s->dev_midi); */ /* BPM kfree_s(s, sizeof(struct es1371_state)); */ kfree(s); } rtl_printf("rt_es1371: unloaded\n"); } #endif /* MODULE */ ======================================================================= <--- end of rt_es1371.c : ======================================================================= ======================================================================= ---> test2.c : ======================================================================= //#include <linux/module.h> //#include <linux/kernel.h> #include <rtl.h> #include <posix/pthread.h> #include <rtl_fifo.h> #include <rtl_time.h> #include <rtl_sched.h> #include <arch/rtl_io.h> //#include <linux/cons.h> #include <rtl_posixio.h> #include <posix/semaphore.h> //#include <string.h> #include <rtl_fifo.h> #include "rtl_soundcard.h" int ioctl(int fd, unsigned int cmd, void * arg); int open(char *, int); int write(int fd,char* outBuffer,int nbBuffer); int close(int); static char outBuffer[400000]; static pthread_t thread; static int fd=-1; static sem_t sem; static int nbBuffer=0; void * start_routine(void *arg) { int cmdNext=1; int len = 10; int cpt=0,inb; rtl_printf("test2 : Thread TOP BEGIN \n"); while( nbBuffer > 1 && cpt < 10 ) { cpt++; rtl_printf("test2 : thread : before write to dsp , bufNo=%d\n",cpt); write(fd,outBuffer,nbBuffer); rtl_printf("test2 : buffer wrote to dsp noBuft=%d\n",cpt); usleep(10000); if ( nbBuffer == 1 ) break; } rtl_printf("test2 : end thread cpt=%d\n",cpt); return 0; } int init_module(void) { pthread_attr_t attr; struct sched_param sched_param; int fBuffer,fSyncro,ret; audio_buf_info abinfo; int val; rtl_printf("test2 : Begin \n"); if((fd = open("/dev/dsp", FMODE_WRITE)) < 0 ) { rtl_printf("Couldn't open device! (%d)\n",fd); return -1; } rtl_printf("test2 : /dev/dsp opened (%d)\n",fd); ret = ioctl(fd,SNDCTL_DSP_RESET,NULL); rtl_printf("test2 : ioctl : SNDCTL_DSP_RESET=%d \n \n",ret); if(ret<0) goto fail; val = AFMT_S16_LE; rtl_printf("test2 : ioctl : SNDCTL_DSP_SETFMT before val=%d \n",val); ret = ioctl(fd,SNDCTL_DSP_SETFMT,&val); rtl_printf("test2 : ioctl : SNDCTL_DSP_SETFMT after ret=%d val=%d \n",ret,val); if(ret<0) goto fail; val = 2; ret = ioctl(fd,SNDCTL_DSP_STEREO,&val); rtl_printf("test2 : ioctl : SNDCTL_DSP_STEREO=%d\n \n",ret); if(ret<0) goto fail; val = 48000; ret = ioctl(fd,SNDCTL_DSP_SPEED,&val); rtl_printf("test2 : ioctl : SNDCTL_DSP_SPEED=%d \n \n",ret); if(ret<0) goto fail; ret = ioctl(fd,SNDCTL_DSP_GETOSPACE,&abinfo); rtl_printf("test2 : ioctl : SNDCTL_DSP_GETOSPACE=%d \n \n",ret); if(ret<0) goto fail; nbBuffer = abinfo.fragstotal * abinfo.fragsize; rtl_printf("test2 : ioctl ok nbBuffer=%d\n \n",nbBuffer); pthread_attr_init (&attr); sched_param.sched_priority = 4; pthread_attr_setschedparam (&attr, &sched_param); ret = pthread_create (&thread, &attr, start_routine, (void *)1); rtl_printf("test2 : scheduled fin initmodule\n"); return ret; fail: rtl_printf("test2 : erreur ioctl() \n"); if ( fd >= 0 ) close(fd); return -1; } void cleanup_module(void) { if ( fd >= 0 ) close(fd); pthread_cancel (thread); pthread_join (thread, NULL); } ======================================================================= <--- end of test2.c : ======================================================================= V C R wrote: > Hi > > Could you post the code somewhere I could have a look at it ? I > remember coming up against something like this much earlier and maybe > I could help. > > Regards > > VC > > On Apr 11, 2005 8:11 PM, pm.boyer <[email protected]> wrote: > >>Thank you for your reply, >>but i must explain you more exactly my software. >> >>I use only one rt-thread, which is blocked (and all the system with) when >>it enter in the pthread_suspend_np(). >> >>( I want to use a rt-driver inside RTLinux. ) >> >>This rt-thread use a driver to send data to a PCI sound card. >>( the sound card is Sound Blaster PCI 128 and i have modified a linux >> driver (es1371.c) by changing some linux call by rt-linux call ( like >> request_irq() by rtl_request_irq() ...) >> >>Exactly i have two modules : one for the rt-driver ( with init_module(), >>cleanup_module() and open(), close(), read(), write(), ioctl() functions to >>access the audio card ), and one where in the init_module i open the audio >>device and create a rt-thread that send audio-buffers whith the write function >>to the audio card whith the write function of the driver ). >> >>The driver use a DMA ring-buffer to send/receive data to the PCI audio card, >>and an interrupt handler is installed and used by the audio card to inform >>the driver after access to the DMA buffer. >> >>The write function in the driver, write data (to send to the card) in the DMA >>ring-buffer, and when the buffer is full, it call phtread_suspend_np() to wait >>the card read the data from the ring-buffer through the PCI bus, when some data >>are read and then space freed, the card throw an interrupt, and in the interrupt >>handler the rt-thread is awakened, and then the rt-thread can continue to write >>the next data to the ring-buffer.....( normally ! because this don't work ) >> >>This don't work. When the rt-thread enter in the pthread_suspend_np() function >>all the system (Linux and RTLinux) block, there is no interrupt fired to wakeup >>the thread, my keyboard no respond, system die. >>But if i replace the pthread_suspend_np() function by usleep() function, all >>work good, all seems ok ( no blocking ). >> >>I have looked into the pthread_suspend_np() and usleep() functions, and i have >>saw that they use rtl_schedule() functions too. I have put some rtl_printf() >>into the rtl_schedule(), and to see which is the caller, i have rtl_printf-ed >>the priority of the calling thread. (my rt-thread have priority = 4 ). >>And i have saw that, some time a thread (?) whith a priority = -1 calls >>rtl_schedule(). >>When i use usleep(), in place of pthread_suspend_np(), during the call of >>usleep, into the rtl_schedule my thread whith priority 4 is replaced with >>a thread with priority -1, but all seems ok and work good, my calling thread >>leave usleep normally at the end of sleeping time (10ms). >>But when i use pthread_suspend_np(), in the first call of rtl_schedule(), my >>thread is replaced by thread of priority -1, but leave normally the rtl_schedule >>function, then another call to rtl_schedule is done whith priority -1, executed >>normally, ----> but after it has left the rtl_schedule function : all block ! >>system die. !!!!!! >> >>Is some body can understand some thing, can help me ? >> >>Tanks. >> >>PS : i use RTLinux 3.2-pre1 whith linux kernel 2.4.19. >> >> > _______________________________________________ Rtl mailing list [email protected] http://hq.fsmlabs.com/mailman/listinfo/rtl http:/www.rtlinux-gpl.org/