faac9650a5
changes: o rip the old select from his distribution to prevent extra pollution o the code now uses audio dma, helps reduce clicks o improved card support, should work in full duplex on sb16 cards o add better voxware ioctl support pointed out by Joao Carlos Mendes Luis <jonny@coppe.ufrj.br> o remove an unused file that I included for more complete history o and MANY other changes I have personally tested this code with a CS4237 based card and an AWE32 (non-PnP). Both cards worked fine in 8bit and 16bit mode.
1259 lines
34 KiB
C
1259 lines
34 KiB
C
/*
|
|
* snd/sound.c
|
|
*
|
|
* Main sound driver for FreeBSD. This file provides the main
|
|
* entry points for probe/attach and all i/o demultiplexing, including
|
|
* default routines for generic devices.
|
|
*
|
|
* (C) 1997 Luigi Rizzo (luigi@iet.unipi.it)
|
|
*
|
|
* Redistribution and use in source and binary forms, with or
|
|
* without modification, are permitted provided that the following
|
|
* conditions are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and/or other materials provided
|
|
* with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS
|
|
* IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
|
* AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
*
|
|
* For each card type a template "snddev_info" structure contains
|
|
* all the relevant parameters, both for configuration and runtime.
|
|
*
|
|
* In this file we build tables of pointers to the descriptors for
|
|
* the various supported cards. The generic probe routine scans
|
|
* the table(s) looking for a matching entry, then invokes the
|
|
* board-specific probe routine. If successful, a pointer to the
|
|
* correct snddev_info is stored in snddev_last_probed, for subsequent
|
|
* use in the attach routine. The generic attach routine copies
|
|
* the template to a permanent descriptor (pcm_info[unit] and
|
|
* friends), initializes all generic parameters, and calls the
|
|
* board-specific attach routine.
|
|
*
|
|
* On device calls, the generic routines do the checks on unit and
|
|
* device parameters, then call the board-specific routines if
|
|
* available, or try to perform the task using the default code.
|
|
*
|
|
*/
|
|
|
|
#include <i386/isa/snd/sound.h>
|
|
|
|
#if NPCM > 0 /* from "snd.h" */
|
|
|
|
#define SNDSTAT_BUF_SIZE 4000
|
|
static char status_buf[SNDSTAT_BUF_SIZE] ;
|
|
static int status_len = 0 ;
|
|
static void init_status(snddev_info *d);
|
|
|
|
static d_open_t sndopen;
|
|
static d_close_t sndclose;
|
|
static d_ioctl_t sndioctl;
|
|
static d_read_t sndread;
|
|
static d_write_t sndwrite;
|
|
static d_mmap_t sndmmap;
|
|
|
|
#define CDEV_MAJOR 30
|
|
static struct cdevsw snd_cdevsw = {
|
|
sndopen, sndclose, sndread, sndwrite,
|
|
sndioctl, nxstop, nxreset, nxdevtotty,
|
|
sndpoll, sndmmap, nxstrategy, "snd",
|
|
NULL, -1,
|
|
};
|
|
|
|
/*
|
|
* descriptors for active devices.
|
|
*
|
|
*/
|
|
snddev_info pcm_info[NPCM_MAX] ;
|
|
snddev_info midi_info[NPCM_MAX] ;
|
|
snddev_info synth_info[NPCM_MAX] ;
|
|
|
|
u_long nsnd = NPCM ; /* total number of sound devices */
|
|
|
|
/*
|
|
* the probe routine can only return an int to the upper layer. Hence,
|
|
* it leaves the pointer to the last successfully
|
|
* probed device descriptor in snddev_last_probed
|
|
*/
|
|
snddev_info *snddev_last_probed = NULL ;
|
|
|
|
static snddev_info *
|
|
generic_snd_probe(struct isa_device * dev, snddev_info **p[], char *s);
|
|
|
|
/*
|
|
* here are the lists of known cards. Similar cards (e.g. all
|
|
* sb clones, all mss clones, ... are in the same array.
|
|
* All lists of devices of the same type (eg. all pcm, all midi...)
|
|
* are in the same array.
|
|
* Each probe for a device type gets the pointer to the main array
|
|
* and then scans the sublists.
|
|
*
|
|
* XXX should use DATA_SET to create a linker set for sb_devs and other
|
|
* such structures.
|
|
*/
|
|
|
|
extern snddev_info sb_op_desc;
|
|
extern snddev_info mss_op_desc;
|
|
|
|
static snddev_info *sb_devs[] = { /* all SB clones */
|
|
&sb_op_desc,
|
|
NULL,
|
|
} ;
|
|
|
|
static snddev_info *mss_devs[] = { /* all WSS clones */
|
|
&mss_op_desc,
|
|
NULL,
|
|
} ;
|
|
|
|
static snddev_info **pcm_devslist[] = { /* all pcm devices */
|
|
mss_devs,
|
|
sb_devs,
|
|
NULL
|
|
} ;
|
|
|
|
|
|
int
|
|
pcmprobe(struct isa_device * dev)
|
|
{
|
|
bzero(&pcm_info[dev->id_unit], sizeof(pcm_info[dev->id_unit]) );
|
|
return generic_snd_probe(dev, pcm_devslist, "pcm") ? 1 : 0 ;
|
|
}
|
|
|
|
static snddev_info **midi_devslist[] = {/* all midi devices */
|
|
NULL
|
|
} ;
|
|
|
|
int
|
|
midiprobe(struct isa_device * dev)
|
|
{
|
|
bzero(&midi_info[dev->id_unit], sizeof(midi_info[dev->id_unit]) );
|
|
return 0 ;
|
|
return generic_snd_probe(dev, midi_devslist, "midi") ? 1 : 0 ;
|
|
}
|
|
|
|
int
|
|
synthprobe(struct isa_device * dev)
|
|
{
|
|
bzero(&synth_info[dev->id_unit], sizeof(synth_info[dev->id_unit]) );
|
|
return 0 ;
|
|
}
|
|
|
|
/*
|
|
* this is the generic attach routine
|
|
*/
|
|
|
|
int
|
|
pcmattach(struct isa_device * dev)
|
|
{
|
|
snddev_info *d = NULL ;
|
|
struct isa_device *dvp;
|
|
int stat = 0;
|
|
dev_t isadev;
|
|
|
|
if ( (dev->id_unit >= NPCM_MAX) || /* too many devs */
|
|
(snddev_last_probed == NULL) || /* last probe failed */
|
|
(snddev_last_probed->attach==NULL) ) /* no attach routine */
|
|
return 0 ; /* fail */
|
|
|
|
/*
|
|
* default initialization: copy generic parameters for the routine,
|
|
* initialize from the isa_device structure, and allocate memory.
|
|
* If everything succeeds, then call the attach routine for
|
|
* further initialization.
|
|
*/
|
|
pcm_info[dev->id_unit] = *snddev_last_probed ;
|
|
d = &pcm_info[dev->id_unit] ;
|
|
|
|
d->io_base = dev->id_iobase ;
|
|
d->irq = ffs(dev->id_irq) - 1 ;
|
|
d->dma1 = dev->id_drq ;
|
|
if (dev->id_flags != -1 && dev->id_flags & DV_F_DUAL_DMA) /* enable dma2 */
|
|
d->dma2 = dev->id_flags & DV_F_DRQ_MASK ;
|
|
else
|
|
d->dma2 = d->dma1 ;
|
|
/* XXX should also set bd_id from flags ? */
|
|
d->status_ptr = 0;
|
|
|
|
/*
|
|
* Allocates memory and initializes the dma structs properly. We
|
|
* use independent buffers for each channel. For the time being,
|
|
* this is done independently of the dma setting. In future
|
|
* revisions, if we see that we have a single dma, we might decide
|
|
* to use a single buffer to save memory.
|
|
*/
|
|
alloc_dbuf( &(d->dbuf_out), d->bufsize );
|
|
alloc_dbuf( &(d->dbuf_in), d->bufsize );
|
|
|
|
isa_dma_acquire(d->dma1);
|
|
if (d->dma2 != d->dma1)
|
|
isa_dma_acquire(d->dma2);
|
|
/*
|
|
* initialize standard parameters for the device. This can be
|
|
* overridden by device-specific configurations but better do
|
|
* here the generic things.
|
|
*/
|
|
|
|
d->play_speed = d->rec_speed = 8000 ;
|
|
d->play_blocksize = d->rec_blocksize = 2048 ;
|
|
d->play_fmt = d->rec_fmt = AFMT_MU_LAW ;
|
|
|
|
isadev = makedev(CDEV_MAJOR, 0);
|
|
cdevsw_add(&isadev, &snd_cdevsw, NULL);
|
|
|
|
/*
|
|
* should try and find a suitable value for id_id, otherwise
|
|
* the interrupt is not registered and dispatched properly.
|
|
* This is important for PnP devices, where "dev" is built on
|
|
* the fly and many field are not initialized.
|
|
*/
|
|
if (dev->id_driver == NULL) {
|
|
dev->id_driver = &pcmdriver ;
|
|
dvp=find_isadev(isa_devtab_tty, &pcmdriver, 0);
|
|
if (dvp)
|
|
dev->id_id = dvp->id_id;
|
|
}
|
|
|
|
d->magic = MAGIC(dev->id_unit); /* debugging... */
|
|
/*
|
|
* and finally, call the device attach routine
|
|
*/
|
|
stat = snddev_last_probed->attach(dev);
|
|
snddev_last_probed = NULL ;
|
|
|
|
return stat ;
|
|
}
|
|
|
|
int midiattach(struct isa_device * dev) { return 0 ; }
|
|
int synthattach(struct isa_device * dev) { return 0 ; }
|
|
|
|
struct isa_driver pcmdriver = { pcmprobe, pcmattach, "pcm" } ;
|
|
|
|
struct isa_driver mididriver = { midiprobe, midiattach, "midi" } ;
|
|
struct isa_driver synthdriver = { synthprobe, synthattach, "synth" } ;
|
|
|
|
void
|
|
pcmintr(int unit)
|
|
{
|
|
DEB(printf("__/\\/ pcmintr -- unit %d\n", unit));
|
|
pcm_info[unit].interrupts++;
|
|
if (pcm_info[unit].isr)
|
|
pcm_info[unit].isr(unit);
|
|
if (midi_info[unit].isr)
|
|
midi_info[unit].isr(unit);
|
|
if (synth_info[unit].isr)
|
|
synth_info[unit].isr(unit);
|
|
}
|
|
|
|
static snddev_info *
|
|
generic_snd_probe(struct isa_device * dev, snddev_info **p[], char *s)
|
|
{
|
|
snddev_info **q ;
|
|
struct isa_device saved_dev ;
|
|
|
|
snddev_last_probed = NULL ;
|
|
|
|
saved_dev = *dev ; /* the probe routine might alter parameters */
|
|
|
|
/*
|
|
* XXX todo: should try to match flags with device type.
|
|
*/
|
|
for ( ; p[0] != NULL ; p++ )
|
|
for ( q = *p ; q[0] ; q++ )
|
|
if (q[0]->probe && q[0]->probe(dev))
|
|
return (snddev_last_probed = q[0]) ;
|
|
else
|
|
*dev = saved_dev ;
|
|
|
|
return NULL ;
|
|
}
|
|
|
|
|
|
/*
|
|
* a small utility function which, given a device number, returns
|
|
* a pointer to the associated snddev_info struct, and sets the unit
|
|
* number.
|
|
*/
|
|
static snddev_info *
|
|
get_snddev_info(dev_t dev, int *unit)
|
|
{
|
|
int u;
|
|
snddev_info *d = NULL ;
|
|
|
|
dev = minor(dev);
|
|
u = dev >> 4 ;
|
|
if (unit)
|
|
*unit = u ;
|
|
|
|
if (u > NPCM_MAX)
|
|
return NULL ;
|
|
switch(dev & 0x0f) {
|
|
case SND_DEV_CTL : /* /dev/mixer handled by pcm */
|
|
case SND_DEV_STATUS : /* /dev/sndstat handled by pcm */
|
|
case SND_DEV_SNDPROC : /* /dev/sndproc handled by pcm */
|
|
case SND_DEV_DSP :
|
|
case SND_DEV_DSP16 :
|
|
case SND_DEV_AUDIO :
|
|
d = & pcm_info[u] ;
|
|
break ;
|
|
case SND_DEV_SEQ :
|
|
case SND_DEV_SEQ2 :
|
|
d = & synth_info[u] ;
|
|
break ;
|
|
case SND_DEV_MIDIN:
|
|
d = & midi_info[u] ;
|
|
break ;
|
|
default:
|
|
return NULL ;
|
|
}
|
|
return d ;
|
|
}
|
|
|
|
/*
|
|
* here are the switches for the main functions. The switches do
|
|
* all necessary checks on the device number to make sure
|
|
* that the device is configured. They also provide some default
|
|
* functionalities so that device-specific drivers have to deal
|
|
* only with special cases.
|
|
*/
|
|
|
|
static int
|
|
sndopen(dev_t i_dev, int flags, int mode, struct proc * p)
|
|
{
|
|
int dev, unit ;
|
|
snddev_info *d;
|
|
|
|
dev = minor(i_dev);
|
|
d = get_snddev_info(dev, &unit);
|
|
|
|
DEB(printf("open snd%d subdev %d flags 0x%08x mode 0x%08x\n",
|
|
unit, dev & 0xf, flags, mode));
|
|
|
|
if (d == NULL) {
|
|
printf("open: unit %d dev %d not configured, perhaps you want unit %d ?\n",
|
|
unit, dev & 0xf, unit + 1 );
|
|
return (ENXIO) ;
|
|
}
|
|
|
|
switch(dev & 0x0f) {
|
|
case SND_DEV_CTL : /* mixer ... */
|
|
return 0 ; /* always succeed */
|
|
|
|
case SND_DEV_STATUS : /* implemented right here */
|
|
init_status(&pcm_info[unit]);
|
|
d->status_ptr = 0 ;
|
|
return 0 ;
|
|
|
|
default:
|
|
if (d->open == NULL) {
|
|
printf("open: bad unit %d, perhaps you want unit %d ?\n",
|
|
unit, unit+1 );
|
|
return (ENXIO) ;
|
|
} else
|
|
return d->open(i_dev, flags, mode, p);
|
|
}
|
|
return ENXIO ;
|
|
}
|
|
|
|
static int
|
|
sndclose(dev_t i_dev, int flags, int mode, struct proc * p)
|
|
{
|
|
int dev, unit ;
|
|
snddev_info *d;
|
|
|
|
dev = minor(i_dev);
|
|
d = get_snddev_info(dev, &unit);
|
|
|
|
DEB(printf("close snd%d subdev %d\n", unit, dev & 0xf));
|
|
|
|
if (d == NULL) {
|
|
printf("close: unit %d dev %d not configured\n", unit, dev & 0xf );
|
|
return (ENXIO) ;
|
|
}
|
|
switch(dev & 0x0f) { /* only those for which close makes sense */
|
|
case SND_DEV_AUDIO :
|
|
case SND_DEV_DSP :
|
|
case SND_DEV_DSP16 :
|
|
case SND_DEV_SEQ:
|
|
case SND_DEV_SEQ2:
|
|
case SND_DEV_MIDIN:
|
|
if (d->close)
|
|
return d->close(i_dev, flags, mode, p);
|
|
}
|
|
return 0 ;
|
|
}
|
|
|
|
static int
|
|
sndread(dev_t i_dev, struct uio * buf, int flag)
|
|
{
|
|
int ret, dev, unit;
|
|
snddev_info *d ;
|
|
u_long s;
|
|
|
|
dev = minor(i_dev);
|
|
|
|
d = get_snddev_info(dev, &unit);
|
|
DEB(printf("read snd%d subdev %d flag 0x%08x\n", unit, dev & 0xf, flag));
|
|
|
|
if (d == NULL) {
|
|
printf("read: unit %d not configured\n", unit );
|
|
return ENXIO ;
|
|
}
|
|
if ( (dev & 0x0f) == SND_DEV_STATUS ) {
|
|
int l, c;
|
|
u_char *p;
|
|
|
|
l = buf->uio_resid;
|
|
s=spltty();
|
|
c = status_len - d->status_ptr ;
|
|
if (c < 0) /* should not happen! */
|
|
c = 0 ;
|
|
if (c < l)
|
|
l = c ;
|
|
p = status_buf + d->status_ptr ;
|
|
d->status_ptr += l ;
|
|
splx(s);
|
|
ret = uiomove(p, l, buf) ;
|
|
if (ret)
|
|
printf("pcm-stat: bad copyout\n");
|
|
return ret ;
|
|
}
|
|
if (d->read) /* device-specific read */
|
|
return d->read(i_dev, buf, flag);
|
|
|
|
/*
|
|
* the generic read routine. device-specific stuff should only
|
|
* be in the dma-handling procedures.
|
|
*/
|
|
s = spltty();
|
|
if ( d->flags & SND_F_READING ) {
|
|
/* another reader is in, deny request */
|
|
splx(s);
|
|
DDB(printf("read denied, another reader is in\n"));
|
|
return EBUSY ;
|
|
}
|
|
if (d->dma1 == d->dma2) { /* half duplex */
|
|
if ( d->flags & SND_F_WRITING ) {
|
|
/* another writer is in, deny request */
|
|
splx(s);
|
|
DDB(printf("read denied, half duplex and a writer is in\n"));
|
|
return EBUSY ;
|
|
}
|
|
while ( d->dbuf_out.dl ) {
|
|
/*
|
|
* we have a pending dma operation, post a read request
|
|
* and wait for the write to complete.
|
|
*/
|
|
d->flags |= SND_F_READING ;
|
|
DEB(printf("sndread: sleeping waiting for write to end\n"));
|
|
ret = tsleep( (caddr_t)&(d->dbuf_out),
|
|
PRIBIO | PCATCH , "sndrdw", hz ) ;
|
|
if (ret == ERESTART || ret == EINTR) {
|
|
d->flags &= ~SND_F_READING ;
|
|
splx(s);
|
|
return EINTR ;
|
|
}
|
|
}
|
|
}
|
|
d->flags |= SND_F_READING ;
|
|
splx(s);
|
|
|
|
return dsp_read_body(d, buf);
|
|
}
|
|
|
|
static int
|
|
sndwrite(dev_t i_dev, struct uio * buf, int flag)
|
|
{
|
|
int ret, dev, unit;
|
|
snddev_info *d;
|
|
u_long s;
|
|
|
|
dev = minor(i_dev);
|
|
d = get_snddev_info(dev, &unit);
|
|
|
|
DEB(printf("write snd%d subdev %d flag 0x%08x\n", unit, dev & 0xf, flag));
|
|
|
|
if (d == NULL) {
|
|
printf("write: unit %d not configured\n", unit );
|
|
return (ENXIO) ;
|
|
}
|
|
switch( dev & 0x0f) { /* only writeable devices */
|
|
case SND_DEV_MIDIN: /* XXX is this writable ? */
|
|
case SND_DEV_SEQ :
|
|
case SND_DEV_SEQ2 :
|
|
case SND_DEV_DSP :
|
|
case SND_DEV_DSP16 :
|
|
case SND_DEV_AUDIO :
|
|
break ;
|
|
default:
|
|
return EPERM ; /* for non-writeable devices ; */
|
|
}
|
|
if (d->write)
|
|
return d->write(i_dev, buf, flag);
|
|
|
|
/*
|
|
* Otherwise, use the generic write routine. device-specific
|
|
* stuff should only be in the dma-handling procedures.
|
|
*/
|
|
|
|
s = spltty();
|
|
if ( d->flags & SND_F_WRITING ) {
|
|
/* another writer is in, deny request */
|
|
splx(s);
|
|
DDB(printf("write denied, another writer is in\n"));
|
|
return EBUSY ;
|
|
}
|
|
if (d->dma1 == d->dma2) { /* half duplex */
|
|
if ( d->flags & SND_F_READING ) {
|
|
DDB(printf("write denied, half duplex and a reader is in\n"));
|
|
/* another reader is in, deny request */
|
|
splx(s);
|
|
return EBUSY ;
|
|
}
|
|
while ( d->dbuf_in.dl ) {
|
|
/*
|
|
* we have a pending read dma. Post a write request
|
|
* and wait for the read to complete (in fact I could
|
|
* abort the read dma...
|
|
*/
|
|
d->flags |= SND_F_WRITING ;
|
|
DEB(printf("sndwrite: sleeping waiting for read to end\n"));
|
|
ret = tsleep( (caddr_t)&(d->dbuf_out),
|
|
PRIBIO | PCATCH , "sndwr", hz ) ;
|
|
if (ret == ERESTART || ret == EINTR) {
|
|
d->flags &= ~SND_F_WRITING ;
|
|
splx(s);
|
|
return EINTR ;
|
|
}
|
|
}
|
|
}
|
|
d->flags |= SND_F_WRITING ;
|
|
splx(s);
|
|
|
|
return dsp_write_body(d, buf);
|
|
}
|
|
|
|
/*
|
|
* generic sound ioctl. Functions of the default driver can be
|
|
* overridden by the device-specific ioctl call.
|
|
* If a device-specific call returns ENOSYS (Function not implemented),
|
|
* the default driver is called. Otherwise, the returned value
|
|
* is passed up.
|
|
*
|
|
* The default handler, for many parameters, sets the value in the
|
|
* descriptor, sets SND_F_INIT, and calls the callback function with
|
|
* reason INIT. If successful, the callback returns 1 and the caller
|
|
* can update the parameter.
|
|
*/
|
|
|
|
static int
|
|
sndioctl(dev_t i_dev, int cmd, caddr_t arg, int mode, struct proc * p)
|
|
{
|
|
int ret = ENOSYS, dev, unit ;
|
|
snddev_info *d;
|
|
u_long s;
|
|
|
|
dev = minor(i_dev);
|
|
d = get_snddev_info(dev, &unit);
|
|
|
|
if (d == NULL) {
|
|
printf("ioctl: unit %d not configured\n", unit );
|
|
return (ENXIO) ;
|
|
}
|
|
if (d->ioctl)
|
|
ret = d->ioctl(dev, cmd, arg, mode, p);
|
|
if (ret != ENOSYS)
|
|
return ret ;
|
|
|
|
/*
|
|
* pass control to the default ioctl handler. Set ret to 0 now.
|
|
*/
|
|
ret = 0 ;
|
|
|
|
/*
|
|
* The linux ioctl interface for the sound driver has a thousand
|
|
* different calls, and it is unpractical to put the names in
|
|
* the switch(). So we have some tests before for common routines,
|
|
* such as the ones related to the mixer. But we really ought
|
|
* to redesign the interface!
|
|
*
|
|
* Reading from the mixer just requires to look at the cached
|
|
* copy in d->mix_levels[dev], so this routine should cover
|
|
* practically all needs for mixer reading.
|
|
*/
|
|
if ( (cmd & MIXER_READ(0)) == MIXER_READ(0) && (cmd & 0xff) < 32 ) {
|
|
int dev = cmd & 0x1f ;
|
|
if ( d->mix_devs & (1<<dev) ) { /* supported */
|
|
*(int *)arg = d->mix_levels[dev];
|
|
return 0 ;
|
|
} else
|
|
return EINVAL ;
|
|
}
|
|
|
|
/*
|
|
* all routines are called with int. blocked. Make sure that
|
|
* ints are re-enabled when calling slow or blocking functions!
|
|
*/
|
|
s = spltty();
|
|
switch(cmd) {
|
|
|
|
/*
|
|
* we start with the new ioctl interface.
|
|
*/
|
|
case AIONWRITE : /* how many bytes can write ? */
|
|
if (d->dbuf_out.dl)
|
|
dsp_wr_dmaupdate(&(d->dbuf_out));
|
|
*(int *)arg = d->dbuf_out.fl;
|
|
break;
|
|
|
|
case AIOSSIZE : /* set the current blocksize */
|
|
{
|
|
struct snd_size *p = (struct snd_size *)arg;
|
|
if (p->play_size <= 1 && p->rec_size <= 1) { /* means no blocks */
|
|
d->flags &= ~SND_F_HAS_SIZE ;
|
|
} else {
|
|
RANGE (p->play_size, 40, d->dbuf_out.bufsize /4);
|
|
d->play_blocksize = p->play_size & ~3 ;
|
|
RANGE (p->rec_size, 40, d->dbuf_in.bufsize /4);
|
|
d->rec_blocksize = p->rec_size & ~3 ;
|
|
d->flags |= SND_F_HAS_SIZE ;
|
|
}
|
|
}
|
|
splx(s);
|
|
ask_init(d);
|
|
/* FALLTHROUGH */
|
|
case AIOGSIZE : /* get the current blocksize */
|
|
{
|
|
struct snd_size *p = (struct snd_size *)arg;
|
|
p->play_size = d->play_blocksize ;
|
|
p->rec_size = d->rec_blocksize ;
|
|
}
|
|
break ;
|
|
|
|
case AIOSFMT :
|
|
{
|
|
snd_chan_param *p = (snd_chan_param *)arg;
|
|
d->play_speed = p->play_rate;
|
|
d->rec_speed = p->play_rate; /* XXX */
|
|
if (p->play_format & SND_F_STEREO)
|
|
d->flags |= SND_F_STEREO ;
|
|
else
|
|
d->flags &= ~SND_F_STEREO ;
|
|
d->play_fmt = p->play_format & ~AFMT_STEREO ;
|
|
d->rec_fmt = p->rec_format & ~AFMT_STEREO ;
|
|
}
|
|
splx(s);
|
|
if (!ask_init(d))
|
|
break ; /* could not reinit */
|
|
/* FALLTHROUGH */
|
|
|
|
case AIOGFMT :
|
|
{
|
|
snd_chan_param *p = (snd_chan_param *)arg;
|
|
p->play_rate = d->play_speed;
|
|
p->rec_rate = d->rec_speed;
|
|
p->play_format = d->play_fmt;
|
|
p->rec_format = d->rec_fmt;
|
|
if (d->flags & SND_F_STEREO) {
|
|
p->play_format |= AFMT_STEREO ;
|
|
p->rec_format |= AFMT_STEREO ;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case AIOGCAP : /* get capabilities */
|
|
/* this should really be implemented by the driver */
|
|
{
|
|
snd_capabilities *p = (snd_capabilities *)arg;
|
|
p->rate_min = 5000;
|
|
p->rate_max = 48000; /* default */
|
|
p->bufsize = d->bufsize;
|
|
p->formats = d->audio_fmt; /* default */
|
|
p->mixers = 1 ; /* default: one mixer */
|
|
p->inputs = d->mix_devs ;
|
|
p->left = p->right = 255 ;
|
|
}
|
|
break ;
|
|
|
|
case AIOSTOP:
|
|
if (*(int *)arg == AIOSYNC_PLAY) /* play */
|
|
*(int *)arg = dsp_wrabort(d, 1 /* restart */);
|
|
else if (*(int *)arg == AIOSYNC_CAPTURE)
|
|
*(int *)arg = dsp_rdabort(d, 1 /* restart */);
|
|
else {
|
|
splx(s);
|
|
printf("AIOSTOP: bad channel 0x%x\n", *(int *)arg);
|
|
*(int *)arg = 0 ;
|
|
}
|
|
break ;
|
|
|
|
case AIOSYNC:
|
|
printf("AIOSYNC chan 0x%03lx pos %ld unimplemented\n",
|
|
((snd_sync_parm *)arg)->chan,
|
|
((snd_sync_parm *)arg)->pos);
|
|
break;
|
|
/*
|
|
* here follow the standard ioctls (filio.h etc.)
|
|
*/
|
|
case FIONREAD : /* get # bytes to read */
|
|
if ( d->dbuf_in.dl )
|
|
dsp_rd_dmaupdate(&(d->dbuf_in));
|
|
*(int *)arg = d->dbuf_in.rl;
|
|
break;
|
|
|
|
case FIOASYNC: /*set/clear async i/o */
|
|
printf("FIOASYNC\n");
|
|
break;
|
|
|
|
case SNDCTL_DSP_NONBLOCK :
|
|
case FIONBIO : /* set/clear non-blocking i/o */
|
|
if ( *(int *)arg == 0 )
|
|
d->flags &= ~SND_F_NBIO ;
|
|
else
|
|
d->flags |= SND_F_NBIO ;
|
|
break ;
|
|
|
|
/*
|
|
* Finally, here is the linux-compatible ioctl interface
|
|
*/
|
|
case SNDCTL_DSP_GETBLKSIZE:
|
|
*(int *) arg = d->play_blocksize ;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_SETBLKSIZE :
|
|
{
|
|
int t = *(int *)arg;
|
|
if (t <= 1) { /* means no blocks */
|
|
d->flags &= ~SND_F_HAS_SIZE ;
|
|
} else {
|
|
RANGE (t, 40, d->dbuf_out.bufsize /4);
|
|
d->play_blocksize =
|
|
d->rec_blocksize = t & ~3 ; /* align to multiple of 4 */
|
|
d->flags |= SND_F_HAS_SIZE ;
|
|
}
|
|
}
|
|
splx(s);
|
|
ask_init(d);
|
|
break ;
|
|
case SNDCTL_DSP_RESET:
|
|
DEB(printf("dsp reset\n"));
|
|
dsp_wrabort(d, 1 /* restart */);
|
|
dsp_rdabort(d, 1 /* restart */);
|
|
break ;
|
|
|
|
case SNDCTL_DSP_SYNC:
|
|
DEB(printf("dsp sync\n"));
|
|
splx(s);
|
|
snd_sync(d, 1, d->dbuf_out.bufsize - 4); /* DMA does not start with <4 bytes */
|
|
break ;
|
|
|
|
case SNDCTL_DSP_SPEED:
|
|
d->play_speed = d->rec_speed = *(int *)arg ;
|
|
splx(s);
|
|
if (ask_init(d))
|
|
*(int *)arg = d->play_speed ;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_STEREO:
|
|
if ( *(int *)arg == -1) {
|
|
*(int *)arg = (d->flags & SND_F_STEREO) ? 1 : 0 ;
|
|
break;
|
|
}
|
|
if ( *(int *)arg == 0 )
|
|
d->flags &= ~SND_F_STEREO ; /* mono */
|
|
else if ( *(int *)arg == 1 )
|
|
d->flags |= SND_F_STEREO ; /* stereo */
|
|
else {
|
|
printf("dsp stereo: %d is invalid, assuming 1\n", *(int *)arg );
|
|
d->flags |= SND_F_STEREO ; /* stereo */
|
|
}
|
|
splx(s);
|
|
if (ask_init(d))
|
|
*(int *)arg = (d->flags & SND_F_STEREO) ? 1 : 0 ;
|
|
break ;
|
|
|
|
case SOUND_PCM_WRITE_CHANNELS:
|
|
if ( *(int *)arg == 1)
|
|
d->flags &= ~SND_F_STEREO ; /* mono */
|
|
else if ( *(int *)arg == 2)
|
|
d->flags |= SND_F_STEREO ; /* stereo */
|
|
else {
|
|
ret = EINVAL ;
|
|
break ;
|
|
}
|
|
splx(s);
|
|
if (ask_init(d))
|
|
*(int *)arg = (d->flags & SND_F_STEREO) ? 2 : 1 ;
|
|
break ;
|
|
|
|
case SOUND_PCM_READ_RATE:
|
|
*(int *)arg = d->play_speed;
|
|
break ;
|
|
|
|
case SOUND_PCM_READ_CHANNELS:
|
|
*(int *)arg = (d->flags & SND_F_STEREO) ? 2 : 1;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_GETFMTS: /* returns a mask of supported fmts */
|
|
*(int *)arg = (int)d->audio_fmt ;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_SETFMT: /* sets _one_ format */
|
|
d->play_fmt = d->rec_fmt = *(int *)arg ;
|
|
splx(s);
|
|
if (ask_init(d))
|
|
*(int *)arg = d->play_fmt ;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_SUBDIVIDE:
|
|
/* XXX watch out, this is RW! */
|
|
printf("SNDCTL_DSP_SUBDIVIDE yet unimplemented\n");
|
|
break;
|
|
|
|
case SNDCTL_DSP_SETFRAGMENT:
|
|
/* XXX watch out, this is RW! */
|
|
printf("SNDCTL_DSP_SETFRAGMENT 0x%08x\n", *(int *)arg);
|
|
{
|
|
int bytes, count;
|
|
bytes = *(int *)arg & 0xffff ;
|
|
count = ( *(int *)arg >> 16) & 0xffff ;
|
|
if (bytes < 7)
|
|
bytes = 7 ;
|
|
if (bytes > 15)
|
|
bytes = 15 ;
|
|
d->play_blocksize =
|
|
d->rec_blocksize = min ( 1<< bytes, d->dbuf_in.bufsize) ;
|
|
count = d->dbuf_in.bufsize / d->play_blocksize ;
|
|
bytes = ffs(d->play_blocksize) - 1;
|
|
#if 0
|
|
/*
|
|
* don't change arg, since it's fake anyways and some
|
|
* programs might fail if we do.
|
|
*/
|
|
*(int *)arg = (count << 16) | bytes ;
|
|
#endif
|
|
}
|
|
break ;
|
|
|
|
case SNDCTL_DSP_GETISPACE:
|
|
/* return space available in the input queue */
|
|
((audio_buf_info *)arg)->bytes = d->dbuf_in.fl ;
|
|
((audio_buf_info *)arg)->fragments = 1 ;
|
|
((audio_buf_info *)arg)->fragstotal =
|
|
d->dbuf_in.bufsize / d->rec_blocksize ;
|
|
((audio_buf_info *)arg)->fragsize = d->rec_blocksize ;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_GETOSPACE:
|
|
/* return space available in the output queue */
|
|
((audio_buf_info *)arg)->bytes = d->dbuf_out.fl ;
|
|
((audio_buf_info *)arg)->fragments = 1 ;
|
|
((audio_buf_info *)arg)->fragstotal =
|
|
d->dbuf_out.bufsize / d->play_blocksize ;
|
|
((audio_buf_info *)arg)->fragsize = d->play_blocksize ;
|
|
break ;
|
|
|
|
case SNDCTL_DSP_GETCAPS :
|
|
printf("dsp getcaps\n");
|
|
break ;
|
|
|
|
case SOUND_PCM_READ_BITS:
|
|
if (d->play_fmt == AFMT_S16_LE)
|
|
*(int *) arg = 16 ;
|
|
else
|
|
*(int *) arg = 8 ;
|
|
break ;
|
|
|
|
/*
|
|
* mixer calls
|
|
*/
|
|
|
|
case SOUND_MIXER_READ_DEVMASK :
|
|
case SOUND_MIXER_READ_STEREODEVS :
|
|
*(int *)arg = d->mix_devs;
|
|
break ;
|
|
|
|
case SOUND_MIXER_READ_RECMASK :
|
|
*(int *)arg = d->mix_rec_devs;
|
|
break ;
|
|
|
|
case SOUND_MIXER_READ_RECSRC :
|
|
*(int *)arg = d->mix_recsrc ;
|
|
break;
|
|
|
|
case SOUND_MIXER_READ_CAPS :
|
|
/*
|
|
* XXX - This needs to be fixed when the sound driver actually
|
|
* supports multiple inputs.
|
|
*/
|
|
*(int *)arg = SOUND_CAP_EXCL_INPUT ;
|
|
break;
|
|
|
|
default:
|
|
DEB(printf("default ioctl snd%d subdev %d fn 0x%08x fail\n",
|
|
unit, dev & 0xf, cmd));
|
|
ret = EINVAL;
|
|
break ;
|
|
}
|
|
splx(s);
|
|
return ret ;
|
|
}
|
|
|
|
/*
|
|
* function to poll what is currently available. Used to be select.
|
|
*/
|
|
int
|
|
sndpoll(dev_t i_dev, int events, struct proc *p)
|
|
{
|
|
int dev, unit, c = 1 /* default: success */ ;
|
|
snddev_info *d ;
|
|
u_long flags;
|
|
|
|
dev = minor(i_dev);
|
|
d = get_snddev_info(dev, &unit);
|
|
DEB(printf("sndpoll dev 0x%04x events 0x%08x\n",i_dev, events));
|
|
if (d == NULL ) {
|
|
printf("poll: unit %d not configured\n", unit );
|
|
return ( (events & (POLLIN|POLLOUT|POLLRDNORM|POLLWRNORM)) | POLLHUP);
|
|
}
|
|
if (d->poll == NULL)
|
|
return ( (events & (POLLIN|POLLOUT|POLLRDNORM|POLLWRNORM)) | POLLHUP);
|
|
else if (d->poll != sndpoll )
|
|
return d->poll(i_dev, events, p);
|
|
else {
|
|
/* handle it here with the generic code */
|
|
|
|
int lim ;
|
|
int revents = 0 ;
|
|
|
|
/*
|
|
* if the user selected a block size, then we want to use the
|
|
* device as a block device, and select will return ready when
|
|
* we have a full block.
|
|
* In all other cases, select will return when 1 byte is ready.
|
|
*/
|
|
lim = 1;
|
|
if (events & (POLLOUT | POLLWRNORM) ) {
|
|
if ( d->flags & SND_F_HAS_SIZE )
|
|
lim = d->play_blocksize ;
|
|
/* XXX fix the test here for half duplex devices */
|
|
if (1 /* write is compatible with current mode */) {
|
|
flags = spltty();
|
|
if (d->dbuf_out.dl)
|
|
dsp_wr_dmaupdate(&(d->dbuf_out));
|
|
c = d->dbuf_out.fl ;
|
|
if (c < lim) /* no space available */
|
|
selrecord(p, & (d->wsel));
|
|
else
|
|
revents |= events & (POLLOUT | POLLWRNORM);
|
|
splx(flags);
|
|
}
|
|
}
|
|
if (events & (POLLIN | POLLRDNORM)) {
|
|
if ( d->flags & SND_F_HAS_SIZE )
|
|
lim = d->rec_blocksize ;
|
|
/* XXX fix the test here */
|
|
if (1 /* read is compatible with current mode */) {
|
|
flags = spltty();
|
|
if ( d->dbuf_in.dl == 0 ) /* dma idle, restart it */
|
|
dsp_rdintr(d);
|
|
else
|
|
dsp_rd_dmaupdate(&(d->dbuf_in));
|
|
c = d->dbuf_in.rl ;
|
|
if (c < lim) /* no data available */
|
|
selrecord(p, & (d->rsel));
|
|
else
|
|
revents |= events & (POLLIN | POLLRDNORM);
|
|
splx(flags);
|
|
}
|
|
DEB(printf("sndpoll on read: %d >= %d flags 0x%08x\n",
|
|
c, lim, d->flags));
|
|
return c < lim ? 0 : 1 ;
|
|
}
|
|
return revents;
|
|
}
|
|
return ENXIO ; /* notreached */
|
|
}
|
|
|
|
/*
|
|
* The mmap interface allows access to the play and read buffer,
|
|
* plus the device descriptor.
|
|
* The various blocks are accessible at the following offsets:
|
|
*
|
|
* 0x00000000 ( 0 ) : write buffer ;
|
|
* 0x01000000 (16 MB) : read buffer ;
|
|
* 0x02000000 (32 MB) : device descriptor (dangerous!)
|
|
*
|
|
* WARNING: the mmap routines assume memory areas are aligned. This
|
|
* is true (probably) for the dma buffers, but likely false for the
|
|
* device descriptor. As a consequence, we do not know where it is
|
|
* located in the requested area.
|
|
*/
|
|
#include <sys/mman.h>
|
|
#include <vm/vm.h>
|
|
#include <vm/vm_kern.h>
|
|
#include <vm/vm_param.h>
|
|
#include <vm/pmap.h>
|
|
#include <vm/vm_extern.h>
|
|
|
|
static int
|
|
sndmmap(dev_t dev, int offset, int nprot)
|
|
{
|
|
snddev_info *d = get_snddev_info(dev, NULL);
|
|
|
|
DEB(printf("sndmmap d 0x%p dev 0x%04x ofs 0x%08x nprot 0x%08x\n",
|
|
d, dev, offset, nprot));
|
|
|
|
if (d == NULL || nprot & PROT_EXEC)
|
|
return -1 ; /* forbidden */
|
|
|
|
if (offset >= d->dbuf_out.bufsize && (nprot & PROT_WRITE) )
|
|
return -1 ; /* can only write to the first block */
|
|
|
|
if (offset < d->dbuf_out.bufsize)
|
|
return i386_btop(vtophys(d->dbuf_out.buf + offset));
|
|
offset -= 1 << 24;
|
|
if ( (offset >= 0) && (offset < d->dbuf_in.bufsize))
|
|
return i386_btop(vtophys(d->dbuf_in.buf + offset));
|
|
offset -= 1 << 24;
|
|
if ( (offset >= 0) && (offset < 0x2000)) {
|
|
return i386_btop(vtophys( ((int)d & ~0xfff) + offset));
|
|
}
|
|
return -1 ;
|
|
}
|
|
|
|
|
|
/*
|
|
* ask_init sets the init flag in the device descriptor, and
|
|
* possibly calls the appropriate callback routine, returning 1
|
|
* if the callback was successful. This enables ioctls handler for
|
|
* rw parameters to read back the updated value.
|
|
* Since the init callback can be slow, ask_init() should be called
|
|
* with interrupts enabled.
|
|
*/
|
|
|
|
int
|
|
ask_init(snddev_info *d)
|
|
{
|
|
u_long s;
|
|
|
|
if ( d->callback == NULL )
|
|
return 0 ;
|
|
s = spltty();
|
|
if ( d->flags & SND_F_PENDING_IO ||
|
|
d->dbuf_out.dl || d->dbuf_in.dl ) {
|
|
/* cannot do it now, record the request and return */
|
|
d->flags |= SND_F_INIT ;
|
|
splx(s);
|
|
return 0 ;
|
|
} else {
|
|
splx(s);
|
|
d->callback(d, SND_CB_INIT );
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* these are the functions for the soundstat device. We copy parameters
|
|
* from the device info structure to static variables, and from there
|
|
* back to the structure when done.
|
|
*/
|
|
|
|
static void
|
|
init_status(snddev_info *d)
|
|
{
|
|
/*
|
|
* Write the status information to the status_buf and update
|
|
* status_len. There is a limit of SNDSTAT_BUF_SIZE bytes for the data.
|
|
* put_status handles this and returns 0 in case of failure. Since
|
|
* it never oveflows the buffer, we do not care to check.
|
|
*/
|
|
|
|
int i;
|
|
|
|
if (status_len != 0) /* only do init once */
|
|
return ;
|
|
sprintf(status_buf,
|
|
"FreeBSD Audio Driver (971023) " __DATE__ " " __TIME__ "\n"
|
|
"Installed devices:\n");
|
|
|
|
for (i = 0; i < NPCM_MAX; i++) {
|
|
if (pcm_info[i].open)
|
|
sprintf(status_buf + strlen(status_buf),
|
|
"pcm%d: <%s> at 0x%x irq %d dma %d:%d\n",
|
|
i, pcm_info[i].name, pcm_info[i].io_base,
|
|
pcm_info[i].irq,
|
|
pcm_info[i].dma1, pcm_info[i].dma2);
|
|
if (midi_info[i].open)
|
|
sprintf(status_buf + strlen(status_buf),
|
|
"midi%d: <%s> at 0x%x irq %d dma %d:%d\n",
|
|
i, midi_info[i].name, midi_info[i].io_base,
|
|
midi_info[i].irq,
|
|
midi_info[i].dma1, midi_info[i].dma2);
|
|
if (synth_info[i].open)
|
|
sprintf(status_buf + strlen(status_buf),
|
|
"synth%d: <%s> at 0x%x irq %d dma %d:%d\n",
|
|
i, synth_info[i].name, synth_info[i].io_base,
|
|
synth_info[i].irq,
|
|
synth_info[i].dma1, synth_info[i].dma2);
|
|
}
|
|
status_len = strlen(status_buf) ;
|
|
}
|
|
|
|
/*
|
|
* finally, some "libraries"
|
|
*/
|
|
|
|
/*
|
|
* isa_dmastatus1() is a wrapper for isa_dmastatus(), which
|
|
* might return -1 or -2 in some cases (errors). Since for the
|
|
* user code it is more comfortable not to check for these cases,
|
|
* negative values are mapped back to 0 (which is reasonable).
|
|
*/
|
|
|
|
int
|
|
isa_dmastatus1(int channel)
|
|
{
|
|
int r = isa_dmastatus(channel);
|
|
if (r<0) r = 0;
|
|
return r;
|
|
}
|
|
|
|
/*
|
|
* snd_conflict scans already-attached boards to see if
|
|
* the current address is conflicting with one of the already
|
|
* assigned ones. Returns 1 if a conflict is detected.
|
|
*/
|
|
int
|
|
snd_conflict(int io_base)
|
|
{
|
|
int i;
|
|
for (i=0; i< NPCM_MAX ; i++) {
|
|
if ( (io_base == pcm_info[i].io_base ) ||
|
|
(io_base == pcm_info[i].alt_base ) ||
|
|
(io_base == pcm_info[i].conf_base) ||
|
|
(io_base == pcm_info[i].mix_base ) ||
|
|
(io_base == pcm_info[i].midi_base) ||
|
|
(io_base == pcm_info[i].synth_base) ) {
|
|
printf("device at 0x%x already attached as unit %d\n",
|
|
io_base, i);
|
|
return 1 ;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
snd_set_blocksize(snddev_info *d)
|
|
{
|
|
int tmp ;
|
|
/*
|
|
* compute the sample size, and possibly
|
|
* set the blocksize so as to guarantee approx 1/4s
|
|
* between callbacks.
|
|
*/
|
|
tmp = 1 ;
|
|
if (d->flags & SND_F_STEREO) tmp += tmp;
|
|
if (d->play_fmt & (AFMT_S16_LE|AFMT_U16_LE)) tmp += tmp;
|
|
d->dbuf_out.sample_size = tmp ;
|
|
tmp = tmp * d->play_speed;
|
|
if ( (d->flags & SND_F_HAS_SIZE) == 0) {
|
|
d->play_blocksize = (tmp / 4) & ~3; /* 0.25s, aligned to 4 */
|
|
RANGE (d->play_blocksize, 1024, (d->bufsize / 4) & ~3);
|
|
}
|
|
|
|
tmp = 1 ;
|
|
if (d->flags & SND_F_STEREO) tmp += tmp;
|
|
if (d->rec_fmt & (AFMT_S16_LE|AFMT_U16_LE)) tmp += tmp;
|
|
tmp = tmp * d->rec_speed;
|
|
d->dbuf_in.sample_size = tmp ;
|
|
if ( (d->flags & SND_F_HAS_SIZE) == 0) {
|
|
d->rec_blocksize = (tmp / 4) & ~3; /* 0.25s, aligned to 4 */
|
|
RANGE (d->rec_blocksize, 1024, (d->bufsize / 4) & ~3);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* The various mixers use a variety of bitmasks etc. The Voxware
|
|
* driver had a very nice technique to describe a mixer and interface
|
|
* to it. A table defines, for each channel, which register, bits,
|
|
* offset, polarity to use. This procedure creates the new value
|
|
* using the table and the old value.
|
|
*/
|
|
|
|
void
|
|
change_bits(mixer_tab *t, u_char *regval, int dev, int chn, int newval)
|
|
{
|
|
u_char mask;
|
|
int shift;
|
|
|
|
DEB(printf("ch_bits dev %d ch %d val %d old 0x%02x "
|
|
"r %d p %d bit %d off %d\n",
|
|
dev, chn, newval, *regval,
|
|
(*t)[dev][chn].regno, (*t)[dev][chn].polarity,
|
|
(*t)[dev][chn].nbits, (*t)[dev][chn].bitoffs ) );
|
|
|
|
if ( (*t)[dev][chn].polarity == 1) /* reverse */
|
|
newval = 100 - newval ;
|
|
|
|
mask = (1 << (*t)[dev][chn].nbits) - 1;
|
|
newval = (int) ((newval * mask) + 50) / 100; /* Scale it */
|
|
shift = (*t)[dev][chn].bitoffs /*- (*t)[dev][LEFT_CHN].nbits + 1*/;
|
|
|
|
*regval &= ~(mask << shift); /* Filter out the previous value */
|
|
*regval |= (newval & mask) << shift; /* Set the new value */
|
|
}
|
|
|
|
|
|
/*
|
|
* code for translating between U8 and ULAW. Needed to support
|
|
* /dev/audio on the SoundBlaster. Actually, we would also need
|
|
* ulaw -> 16 bits (for the soundblaster as well, when used in
|
|
* full-duplex)
|
|
*/
|
|
|
|
#if 1
|
|
void
|
|
translate_bytes (u_char *table, u_char *buff, int n)
|
|
{
|
|
u_long i;
|
|
|
|
if (n <= 0)
|
|
return;
|
|
|
|
for (i = 0; i < n; ++i)
|
|
buff[i] = table[buff[i]];
|
|
}
|
|
#else
|
|
/* inline */
|
|
void
|
|
translate_bytes (const void *table, void *buff, int n)
|
|
{
|
|
if (n > 0) {
|
|
__asm__ ( " cld\n"
|
|
"1: lodsb\n"
|
|
" xlatb\n"
|
|
" stosb\n"
|
|
" loop 1b\n":
|
|
: "b" ((long) table), "c" (n), "D" ((long) buff), "S" ((long) buff)
|
|
: "bx", "cx", "di", "si", "ax");
|
|
}
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif /* NPCM > 0 */
|