d8b47cbb70
Define ISADMA_{READ,WRITE,RAW} macros with the same numeric
values as the B_{READ,WRITE,RAW} and use them instead throughout.
1607 lines
38 KiB
C
1607 lines
38 KiB
C
/*
|
|
* sound/dmabuf.c
|
|
*
|
|
* The DMA buffer manager for digitized voice applications
|
|
*
|
|
* Copyright by Hannu Savolainen 1993, 1994, 1995
|
|
*
|
|
* 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.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
#include <i386/isa/sound/sound_config.h>
|
|
|
|
#include <sys/select.h>
|
|
|
|
#include <machine/md_var.h>
|
|
|
|
#if defined(CONFIG_AUDIO) || defined(CONFIG_GUS)
|
|
#ifdef ALLOW_POLL
|
|
|
|
int
|
|
DMAbuf_poll(int dev, struct fileinfo * file, int events, select_table * wait);
|
|
#endif;
|
|
|
|
static void
|
|
reorganize_buffers(int dev, struct dma_buffparms * dmap);
|
|
|
|
static int *in_sleeper[MAX_AUDIO_DEV] = {NULL};
|
|
static volatile struct snd_wait in_sleep_flag[MAX_AUDIO_DEV] = {{0}};
|
|
static int *out_sleeper[MAX_AUDIO_DEV] = {NULL};
|
|
static volatile struct snd_wait out_sleep_flag[MAX_AUDIO_DEV] = {{0}};
|
|
|
|
static int ndmaps = 0;
|
|
|
|
#define MAX_DMAP (MAX_AUDIO_DEV*2)
|
|
|
|
static struct dma_buffparms dmaps[MAX_DMAP] = {{0}};
|
|
/*
|
|
* Primitive way to allocate such a large array. Needs dynamic run-time
|
|
* alloction.
|
|
*/
|
|
|
|
static int space_in_queue(int dev);
|
|
|
|
static void dma_reset_output(int dev);
|
|
static void dma_reset_input(int dev);
|
|
|
|
static void
|
|
reorganize_buffers(int dev, struct dma_buffparms * dmap)
|
|
{
|
|
/*
|
|
* This routine breaks the physical device buffers to logical ones.
|
|
*/
|
|
|
|
struct audio_operations *dsp_dev = audio_devs[dev];
|
|
u_int sr, nc;
|
|
int bsz, sz, n, i;
|
|
|
|
if (dmap->fragment_size == 0) {
|
|
/* Compute the fragment size using the default algorithm */
|
|
|
|
sr = dsp_dev->ioctl(dev, SOUND_PCM_READ_RATE, 0, 1);
|
|
nc = dsp_dev->ioctl(dev, SOUND_PCM_READ_CHANNELS, 0, 1);
|
|
sz = dsp_dev->ioctl(dev, SOUND_PCM_READ_BITS, 0, 1);
|
|
|
|
if (sz == 8)
|
|
dmap->neutral_byte = 254;
|
|
else
|
|
dmap->neutral_byte = 0x00;
|
|
|
|
if (sr < 1 || nc < 1 || sz < 1) {
|
|
printf("Warning: Invalid PCM parameters[%d] sr=%d, nc=%d, sz=%d\n",
|
|
dev, sr, nc, sz);
|
|
sr = DSP_DEFAULT_SPEED;
|
|
nc = 1;
|
|
sz = 8;
|
|
}
|
|
sz = sr * nc * sz;
|
|
|
|
sz /= 8; /* #bits -> #bytes */
|
|
|
|
/*
|
|
* Compute a buffer size for time not exeeding 1 second.
|
|
* Usually this algorithm gives a buffer size for 0.5 to 1.0
|
|
* seconds of sound (using the current speed, sample size and
|
|
* #channels).
|
|
*/
|
|
|
|
bsz = dsp_dev->buffsize;
|
|
while (bsz > sz)
|
|
bsz /= 2;
|
|
|
|
if (bsz == dsp_dev->buffsize)
|
|
bsz /= 2; /* Needs at least 2 buffers */
|
|
|
|
if (dmap->subdivision == 0) /* Not already set */
|
|
dmap->subdivision = 1; /* Init to default value */
|
|
else
|
|
bsz /= dmap->subdivision;
|
|
|
|
if (bsz < 16)
|
|
bsz = 16; /* Just a sanity check */
|
|
|
|
dmap->fragment_size = bsz;
|
|
} else {
|
|
/*
|
|
* The process has specified the buffer sice with
|
|
* SNDCTL_DSP_SETFRAGMENT or the buffer sice computation has
|
|
* already been done.
|
|
*/
|
|
|
|
if (dmap->fragment_size > (audio_devs[dev]->buffsize / 2))
|
|
dmap->fragment_size = (audio_devs[dev]->buffsize / 2);
|
|
bsz = dmap->fragment_size;
|
|
}
|
|
|
|
bsz &= ~0x03; /* Force size which is multiple of 4 bytes */
|
|
#ifdef OS_DMA_ALIGN_CHECK
|
|
OS_DMA_ALIGN_CHECK(bsz);
|
|
#endif
|
|
|
|
n = dsp_dev->buffsize / bsz;
|
|
|
|
if (n > MAX_SUB_BUFFERS)
|
|
n = MAX_SUB_BUFFERS;
|
|
|
|
if (n > dmap->max_fragments)
|
|
n = dmap->max_fragments;
|
|
dmap->nbufs = n;
|
|
dmap->bytes_in_use = n * bsz;
|
|
|
|
for (i = 0; i < dmap->nbufs; i++) {
|
|
dmap->counts[i] = 0;
|
|
}
|
|
|
|
if (dmap->raw_buf)
|
|
fillw (dmap->neutral_byte, dmap->raw_buf,
|
|
dmap->bytes_in_use/2);
|
|
|
|
dmap->flags |= DMA_ALLOC_DONE;
|
|
|
|
}
|
|
|
|
static void
|
|
dma_init_buffers(int dev, struct dma_buffparms * dmap)
|
|
{
|
|
if (dmap == audio_devs[dev]->dmap_out) {
|
|
out_sleep_flag[dev].aborting = 0;
|
|
out_sleep_flag[dev].mode = WK_NONE;
|
|
} else {
|
|
in_sleep_flag[dev].aborting = 0;
|
|
in_sleep_flag[dev].mode = WK_NONE;
|
|
}
|
|
|
|
dmap->flags = DMA_BUSY; /* Other flags off */
|
|
dmap->qlen = dmap->qhead = dmap->qtail = 0;
|
|
dmap->nbufs = 1;
|
|
dmap->bytes_in_use = audio_devs[dev]->buffsize;
|
|
|
|
dmap->dma_mode = DMODE_NONE;
|
|
dmap->mapping_flags = 0;
|
|
dmap->neutral_byte = 0x00;
|
|
}
|
|
|
|
static int
|
|
open_dmap(int dev, int mode, struct dma_buffparms * dmap, int chan)
|
|
{
|
|
if (dmap->flags & DMA_BUSY)
|
|
return -(EBUSY);
|
|
|
|
#ifdef RUNTIME_DMA_ALLOC
|
|
{
|
|
int err;
|
|
|
|
if ((err = sound_alloc_dmap(dev, dmap, chan)) < 0)
|
|
return err;
|
|
}
|
|
#endif
|
|
|
|
if (dmap->raw_buf == NULL)
|
|
return -(ENOSPC); /* Memory allocation failed during boot */
|
|
|
|
if (0) {
|
|
printf("Unable to grab(2) DMA%d for the audio driver\n", chan);
|
|
return -(EBUSY);
|
|
}
|
|
dmap->open_mode = mode;
|
|
dmap->subdivision = dmap->underrun_count = 0;
|
|
dmap->fragment_size = 0;
|
|
dmap->max_fragments = 65536; /* Just a large value */
|
|
dmap->byte_counter = 0;
|
|
isa_dma_acquire(chan);
|
|
dmap->dma_chan = chan;
|
|
dma_init_buffers(dev, dmap);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
close_dmap(int dev, struct dma_buffparms * dmap, int chan)
|
|
{
|
|
if (dmap->flags & DMA_BUSY)
|
|
dmap->dma_mode = DMODE_NONE;
|
|
dmap->flags &= ~DMA_BUSY;
|
|
isa_dma_release(dmap->dma_chan);
|
|
#ifdef RUNTIME_DMA_ALLOC
|
|
sound_free_dmap(dev, dmap);
|
|
#endif
|
|
}
|
|
|
|
int
|
|
DMAbuf_open(int dev, int mode)
|
|
{
|
|
int retval;
|
|
struct dma_buffparms *dmap_in = NULL;
|
|
struct dma_buffparms *dmap_out = NULL;
|
|
|
|
if (dev >= num_audiodevs) {
|
|
printf("PCM device %d not installed.\n", dev);
|
|
return -(ENXIO);
|
|
}
|
|
if (!audio_devs[dev]) {
|
|
printf("PCM device %d not initialized\n", dev);
|
|
return -(ENXIO);
|
|
}
|
|
if (!(audio_devs[dev]->flags & DMA_DUPLEX)) {
|
|
audio_devs[dev]->dmap_in = audio_devs[dev]->dmap_out;
|
|
audio_devs[dev]->dmachan2 = audio_devs[dev]->dmachan1;
|
|
}
|
|
if ((retval = audio_devs[dev]->open(dev, mode)) < 0)
|
|
return retval;
|
|
|
|
dmap_out = audio_devs[dev]->dmap_out;
|
|
dmap_in = audio_devs[dev]->dmap_in;
|
|
|
|
if ((retval = open_dmap(dev, mode, dmap_out, audio_devs[dev]->dmachan1)) < 0) {
|
|
audio_devs[dev]->close(dev);
|
|
return retval;
|
|
}
|
|
audio_devs[dev]->enable_bits = mode;
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX && dmap_out != dmap_in) {
|
|
if ((retval = open_dmap(dev, mode, dmap_in, audio_devs[dev]->dmachan2)) < 0) {
|
|
audio_devs[dev]->close(dev);
|
|
close_dmap(dev, dmap_out, audio_devs[dev]->dmachan1);
|
|
return retval;
|
|
}
|
|
}
|
|
audio_devs[dev]->open_mode = mode;
|
|
audio_devs[dev]->go = 1;
|
|
|
|
in_sleep_flag[dev].aborting = 0;
|
|
in_sleep_flag[dev].mode = WK_NONE;
|
|
|
|
out_sleep_flag[dev].aborting = 0;
|
|
out_sleep_flag[dev].mode = WK_NONE;
|
|
|
|
audio_devs[dev]->ioctl(dev, SOUND_PCM_WRITE_BITS, (ioctl_arg) 8, 1);
|
|
audio_devs[dev]->ioctl(dev, SOUND_PCM_WRITE_CHANNELS, (ioctl_arg) 1, 1);
|
|
audio_devs[dev]->ioctl(dev, SOUND_PCM_WRITE_RATE, (ioctl_arg) DSP_DEFAULT_SPEED, 1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
dma_reset(int dev)
|
|
{
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
audio_devs[dev]->reset(dev);
|
|
splx(flags);
|
|
|
|
dma_reset_output(dev);
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX)
|
|
dma_reset_input(dev);
|
|
}
|
|
|
|
static void
|
|
dma_reset_output(int dev)
|
|
{
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
if (!(audio_devs[dev]->flags & DMA_DUPLEX) ||
|
|
!audio_devs[dev]->halt_output)
|
|
audio_devs[dev]->reset(dev);
|
|
else
|
|
audio_devs[dev]->halt_output(dev);
|
|
splx(flags);
|
|
|
|
dma_init_buffers(dev, audio_devs[dev]->dmap_out);
|
|
reorganize_buffers(dev, audio_devs[dev]->dmap_out);
|
|
}
|
|
|
|
static void
|
|
dma_reset_input(int dev)
|
|
{
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
if (!(audio_devs[dev]->flags & DMA_DUPLEX) ||
|
|
!audio_devs[dev]->halt_input)
|
|
audio_devs[dev]->reset(dev);
|
|
else
|
|
audio_devs[dev]->halt_input(dev);
|
|
splx(flags);
|
|
|
|
dma_init_buffers(dev, audio_devs[dev]->dmap_in);
|
|
reorganize_buffers(dev, audio_devs[dev]->dmap_in);
|
|
}
|
|
|
|
static int
|
|
dma_sync(int dev)
|
|
{
|
|
u_long flags;
|
|
|
|
if (!audio_devs[dev]->go && (!audio_devs[dev]->enable_bits & PCM_ENABLE_OUTPUT))
|
|
return 0;
|
|
|
|
if (audio_devs[dev]->dmap_out->dma_mode == DMODE_OUTPUT) {
|
|
flags = splhigh();
|
|
|
|
out_sleep_flag[dev].aborting = 0;
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if(audio_devs[dev]->dmap_out->mapping_flags & DMA_MAP_MAPPED &&
|
|
audio_devs[dev]->dmap_out->qlen) {
|
|
splx(flags);
|
|
|
|
return audio_devs[dev]->dmap_out->qlen;
|
|
}
|
|
|
|
#endif
|
|
while (!PROCESS_ABORTING (out_sleep_flag[dev])
|
|
&& audio_devs[dev]->dmap_out->qlen){
|
|
int chn;
|
|
|
|
out_sleeper[dev] = &chn;
|
|
DO_SLEEP1(chn, out_sleep_flag[dev], 10 * hz);
|
|
if (TIMED_OUT (out_sleep_flag[dev]) ) {
|
|
|
|
splx(flags);
|
|
|
|
return audio_devs[dev]->dmap_out->qlen;
|
|
|
|
}
|
|
}
|
|
|
|
|
|
splx(flags);
|
|
|
|
/*
|
|
* Some devices such as GUS have huge amount of on board RAM
|
|
* for the audio data. We have to wait until the device has
|
|
* finished playing.
|
|
*/
|
|
|
|
flags = splhigh();
|
|
if (audio_devs[dev]->local_qlen) { /* Device has hidden buffers */
|
|
while (!(PROCESS_ABORTING (out_sleep_flag[dev]))
|
|
&& audio_devs[dev]->local_qlen(dev)) {
|
|
int chn;
|
|
out_sleeper[dev] = &chn;
|
|
DO_SLEEP(chn, out_sleep_flag[dev], 10 * hz);
|
|
|
|
}
|
|
}
|
|
splx(flags);
|
|
}
|
|
return audio_devs[dev]->dmap_out->qlen;
|
|
}
|
|
|
|
int
|
|
DMAbuf_release(int dev, int mode)
|
|
{
|
|
u_long flags;
|
|
|
|
if (!((out_sleep_flag[dev].aborting))
|
|
&& (audio_devs[dev]->dmap_out->dma_mode == DMODE_OUTPUT)) {
|
|
dma_sync(dev);
|
|
}
|
|
flags = splhigh();
|
|
|
|
audio_devs[dev]->close(dev);
|
|
|
|
close_dmap(dev, audio_devs[dev]->dmap_out, audio_devs[dev]->dmachan1);
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX)
|
|
close_dmap(dev, audio_devs[dev]->dmap_in, audio_devs[dev]->dmachan2);
|
|
audio_devs[dev]->open_mode = 0;
|
|
|
|
splx(flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
activate_recording(int dev, struct dma_buffparms * dmap)
|
|
{
|
|
if (!(audio_devs[dev]->enable_bits & PCM_ENABLE_INPUT))
|
|
return 0;
|
|
|
|
if (dmap->flags & DMA_RESTART) {
|
|
dma_reset_input(dev);
|
|
dmap->flags &= ~DMA_RESTART;
|
|
}
|
|
if (dmap->dma_mode == DMODE_OUTPUT) { /* Direction change */
|
|
dma_sync(dev);
|
|
dma_reset(dev);
|
|
dmap->dma_mode = DMODE_NONE;
|
|
}
|
|
if (!(dmap->flags & DMA_ALLOC_DONE))
|
|
reorganize_buffers(dev, dmap);
|
|
|
|
if (!dmap->dma_mode) {
|
|
int err;
|
|
|
|
if ((err = audio_devs[dev]->prepare_for_input(dev,
|
|
dmap->fragment_size, dmap->nbufs)) < 0) {
|
|
return err;
|
|
}
|
|
dmap->dma_mode = DMODE_INPUT;
|
|
}
|
|
if (!(dmap->flags & DMA_ACTIVE)) {
|
|
audio_devs[dev]->start_input(dev,
|
|
dmap->raw_buf_phys + dmap->qtail * dmap->fragment_size,
|
|
dmap->fragment_size, 0,
|
|
!(audio_devs[dev]->flags & DMA_AUTOMODE) ||
|
|
!(dmap->flags & DMA_STARTED));
|
|
dmap->flags |= DMA_ACTIVE | DMA_STARTED;
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
DMAbuf_getrdbuffer(int dev, char **buf, int *len, int dontblock)
|
|
{
|
|
u_long flags;
|
|
int err = EIO;
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_in;
|
|
|
|
flags = splhigh();
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (audio_devs[dev]->dmap_in->mapping_flags & DMA_MAP_MAPPED) {
|
|
printf("Sound: Can't read from mmapped device (1)\n");
|
|
return -(EINVAL);
|
|
} else
|
|
#endif
|
|
if (!dmap->qlen) {
|
|
int timeout;
|
|
|
|
if ((err = activate_recording(dev, dmap)) < 0) {
|
|
splx(flags);
|
|
return err;
|
|
}
|
|
/* Wait for the next block */
|
|
|
|
if (dontblock) {
|
|
splx(flags);
|
|
return -(EAGAIN);
|
|
}
|
|
if (!(audio_devs[dev]->enable_bits & PCM_ENABLE_INPUT) &
|
|
audio_devs[dev]->go) {
|
|
splx(flags);
|
|
return -(EAGAIN);
|
|
}
|
|
if (!audio_devs[dev]->go)
|
|
timeout = 0;
|
|
else
|
|
timeout = 2 * hz;
|
|
|
|
{
|
|
int chn;
|
|
|
|
in_sleeper[dev] = &chn;
|
|
DO_SLEEP(chn, in_sleep_flag[dev], timeout);
|
|
|
|
};
|
|
/* XXX note -- nobody seems to set the mode to WK_TIMEOUT - lr */
|
|
if ((in_sleep_flag[dev].mode & WK_TIMEOUT)) {
|
|
/* XXX hey, we are in splhigh here ? lr 970705 */
|
|
printf("Sound: DMA (input) timed out - IRQ/DRQ config error?\n");
|
|
err = EIO;
|
|
audio_devs[dev]->reset(dev);
|
|
in_sleep_flag[dev].aborting = 1;
|
|
} else
|
|
err = EINTR;
|
|
}
|
|
splx(flags);
|
|
|
|
if (!dmap->qlen)
|
|
return -(err);
|
|
|
|
*buf = &dmap->raw_buf[dmap->qhead * dmap->fragment_size + dmap->counts[dmap->qhead]];
|
|
*len = dmap->fragment_size - dmap->counts[dmap->qhead];
|
|
|
|
return dmap->qhead;
|
|
}
|
|
|
|
int
|
|
DMAbuf_rmchars(int dev, int buff_no, int c)
|
|
{
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_in;
|
|
|
|
int p = dmap->counts[dmap->qhead] + c;
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (audio_devs[dev]->dmap_in->mapping_flags & DMA_MAP_MAPPED) {
|
|
printf("Sound: Can't read from mmapped device (2)\n");
|
|
return -(EINVAL);
|
|
} else
|
|
#endif
|
|
if (p >= dmap->fragment_size) { /* This buffer is completely empty */
|
|
dmap->counts[dmap->qhead] = 0;
|
|
if (dmap->qlen <= 0 || dmap->qlen > dmap->nbufs)
|
|
printf("\nSound: Audio queue1 corrupted for dev%d (%d/%d)\n",
|
|
dev, dmap->qlen, dmap->nbufs);
|
|
dmap->qlen--;
|
|
dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
|
|
} else
|
|
dmap->counts[dmap->qhead] = p;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
dma_subdivide(int dev, struct dma_buffparms * dmap, ioctl_arg arg, int fact)
|
|
{
|
|
if (fact == 0) {
|
|
fact = dmap->subdivision;
|
|
if (fact == 0)
|
|
fact = 1;
|
|
return *(int *) arg = fact;
|
|
}
|
|
if (dmap->subdivision != 0 || dmap->fragment_size)/* Loo late to change */
|
|
return -(EINVAL);
|
|
|
|
if (fact > MAX_REALTIME_FACTOR)
|
|
return -(EINVAL);
|
|
|
|
if (fact != 1 && fact != 2 && fact != 4 && fact != 8 && fact != 16)
|
|
return -(EINVAL);
|
|
|
|
dmap->subdivision = fact;
|
|
return *(int *) arg = fact;
|
|
}
|
|
|
|
static int
|
|
dma_set_fragment(int dev, struct dma_buffparms * dmap, ioctl_arg arg, int fact)
|
|
{
|
|
int bytes, count;
|
|
|
|
if (fact == 0)
|
|
return -(EIO);
|
|
|
|
if (dmap->subdivision != 0 || dmap->fragment_size)/* Loo late to change */
|
|
return -(EINVAL);
|
|
|
|
bytes = fact & 0xffff;
|
|
count = (fact >> 16) & 0xffff;
|
|
|
|
if (count == 0)
|
|
count = MAX_SUB_BUFFERS;
|
|
|
|
#if amancio
|
|
if (bytes < 4 || bytes > 17) /* <16 || > 128k */
|
|
return -(EINVAL);
|
|
#endif
|
|
|
|
if (count < 2)
|
|
return -(EINVAL);
|
|
|
|
#ifdef OS_DMA_MINBITS
|
|
if (bytes < OS_DMA_MINBITS)
|
|
bytes = OS_DMA_MINBITS;
|
|
#endif
|
|
|
|
dmap->fragment_size = (1 << bytes);
|
|
|
|
dmap->max_fragments = count;
|
|
|
|
if (dmap->fragment_size > audio_devs[dev]->buffsize)
|
|
dmap->fragment_size = audio_devs[dev]->buffsize;
|
|
|
|
if (dmap->fragment_size == audio_devs[dev]->buffsize &&
|
|
audio_devs[dev]->flags & DMA_AUTOMODE)
|
|
dmap->fragment_size /= 2; /* Needs at least 2 buffers */
|
|
|
|
dmap->subdivision = 1; /* Disable SNDCTL_DSP_SUBDIVIDE */
|
|
return *(int *) arg = bytes | (count << 16);
|
|
}
|
|
|
|
static int
|
|
get_buffer_pointer(int dev, int chan, struct dma_buffparms * dmap)
|
|
{
|
|
int pos;
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
|
|
if (!(dmap->flags & DMA_ACTIVE))
|
|
pos = 0;
|
|
else
|
|
{
|
|
pos = isa_dmastatus(chan);
|
|
}
|
|
|
|
splx(flags);
|
|
|
|
pos = dmap->bytes_in_use - pos ;
|
|
if (audio_devs[dev]->flags & DMA_AUTOMODE)
|
|
return pos;
|
|
else
|
|
{
|
|
pos = dmap->fragment_size - pos;
|
|
if (pos < 0)
|
|
return 0;
|
|
return pos;
|
|
}
|
|
|
|
|
|
}
|
|
|
|
int
|
|
DMAbuf_ioctl(int dev, u_int cmd, ioctl_arg arg, int local)
|
|
{
|
|
struct dma_buffparms *dmap_out = audio_devs[dev]->dmap_out;
|
|
struct dma_buffparms *dmap_in = audio_devs[dev]->dmap_in;
|
|
|
|
switch (cmd) {
|
|
|
|
|
|
case SNDCTL_DSP_RESET:
|
|
dma_reset(dev);
|
|
return 0;
|
|
break;
|
|
|
|
case SNDCTL_DSP_SYNC:
|
|
dma_sync(dev);
|
|
dma_reset(dev);
|
|
return 0;
|
|
break;
|
|
|
|
case SNDCTL_DSP_GETBLKSIZE:
|
|
if (!(dmap_out->flags & DMA_ALLOC_DONE))
|
|
reorganize_buffers(dev, dmap_out);
|
|
|
|
return *(int *) arg = dmap_out->fragment_size;
|
|
break;
|
|
|
|
case SNDCTL_DSP_SETBLKSIZE:
|
|
{
|
|
int size = (*(int *) arg);
|
|
|
|
if (!(dmap_out->flags & DMA_ALLOC_DONE) && size) {
|
|
if ((size >> 16) > 0 )
|
|
dmap_out->fragment_size = size >> 16;
|
|
else {
|
|
dmap_out->fragment_size = size;
|
|
}
|
|
dmap_out->max_fragments = 8888;
|
|
|
|
size &= 0xffff;
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX) {
|
|
dmap_in->fragment_size = size;
|
|
dmap_in->max_fragments = 8888;
|
|
}
|
|
return 0;
|
|
|
|
} else
|
|
return -(EINVAL); /* Too late to change */
|
|
|
|
}
|
|
break;
|
|
|
|
case SNDCTL_DSP_SUBDIVIDE:
|
|
{
|
|
int fact = (*(int *) arg);
|
|
int ret;
|
|
|
|
ret = dma_subdivide(dev, dmap_out, arg, fact);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX)
|
|
ret = dma_subdivide(dev, dmap_in, arg, fact);
|
|
|
|
return ret;
|
|
}
|
|
break;
|
|
|
|
case SNDCTL_DSP_SETFRAGMENT:
|
|
{
|
|
int fact = (*(int *) arg);
|
|
int ret;
|
|
|
|
ret = dma_set_fragment(dev, dmap_out, arg, fact);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX)
|
|
ret = dma_set_fragment(dev, dmap_in, arg, fact);
|
|
|
|
return ret;
|
|
}
|
|
break;
|
|
|
|
case SNDCTL_DSP_GETISPACE:
|
|
case SNDCTL_DSP_GETOSPACE:
|
|
if (!local)
|
|
return -(EINVAL);
|
|
else {
|
|
struct dma_buffparms *dmap = dmap_out;
|
|
|
|
audio_buf_info *info = (audio_buf_info *) arg;
|
|
|
|
if (cmd == SNDCTL_DSP_GETISPACE && audio_devs[dev]->flags & DMA_DUPLEX)
|
|
dmap = dmap_in;
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (dmap->mapping_flags & DMA_MAP_MAPPED)
|
|
return -(EINVAL);
|
|
#endif
|
|
|
|
if (!(dmap->flags & DMA_ALLOC_DONE))
|
|
reorganize_buffers(dev, dmap);
|
|
|
|
info->fragstotal = dmap->nbufs;
|
|
|
|
if (cmd == SNDCTL_DSP_GETISPACE)
|
|
info->fragments = dmap->qlen;
|
|
else {
|
|
if (!space_in_queue(dev))
|
|
info->fragments = 0;
|
|
else {
|
|
info->fragments = dmap->nbufs - dmap->qlen;
|
|
if (audio_devs[dev]->local_qlen) {
|
|
int tmp = audio_devs[dev]->local_qlen(dev);
|
|
|
|
if (tmp & info->fragments)
|
|
tmp--; /* This buffer has been counted twice */
|
|
info->fragments -= tmp;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (info->fragments < 0)
|
|
info->fragments = 0;
|
|
else if (info->fragments > dmap->nbufs)
|
|
info->fragments = dmap->nbufs;
|
|
|
|
info->fragsize = dmap->fragment_size;
|
|
info->bytes = info->fragments * dmap->fragment_size;
|
|
|
|
if (cmd == SNDCTL_DSP_GETISPACE && dmap->qlen)
|
|
info->bytes -= dmap->counts[dmap->qhead];
|
|
}
|
|
return 0;
|
|
|
|
case SNDCTL_DSP_SETTRIGGER:
|
|
{
|
|
u_long flags;
|
|
|
|
int bits = (*(int *) arg) & audio_devs[dev]->open_mode;
|
|
int changed;
|
|
|
|
if (audio_devs[dev]->trigger == NULL)
|
|
return -(EINVAL);
|
|
|
|
if (!(audio_devs[dev]->flags & DMA_DUPLEX))
|
|
if ((bits & PCM_ENABLE_INPUT) && (bits & PCM_ENABLE_OUTPUT)) {
|
|
printf("Sound: Device doesn't have full duplex capability\n");
|
|
return -(EINVAL);
|
|
}
|
|
flags = splhigh();
|
|
changed = audio_devs[dev]->enable_bits ^ bits;
|
|
|
|
if ((changed & bits) & PCM_ENABLE_INPUT && audio_devs[dev]->go) {
|
|
if (!(dmap_in->flags & DMA_ALLOC_DONE))
|
|
reorganize_buffers(dev, dmap_in);
|
|
activate_recording(dev, dmap_in);
|
|
}
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if ((changed & bits) & PCM_ENABLE_OUTPUT &&
|
|
dmap_out->mapping_flags & DMA_MAP_MAPPED &&
|
|
audio_devs[dev]->go) {
|
|
if (!(dmap_out->flags & DMA_ALLOC_DONE))
|
|
reorganize_buffers(dev, dmap_out);
|
|
|
|
audio_devs[dev]->prepare_for_output (dev,
|
|
dmap_out->fragment_size, dmap_out->nbufs);
|
|
|
|
dmap_out->counts[dmap_out->qhead] = dmap_out->fragment_size;
|
|
DMAbuf_start_output(dev, 0, dmap_out->fragment_size);
|
|
dmap_out->dma_mode = DMODE_OUTPUT;
|
|
}
|
|
#endif
|
|
|
|
audio_devs[dev]->enable_bits = bits;
|
|
if (changed && audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev, bits * audio_devs[dev]->go);
|
|
splx(flags);
|
|
}
|
|
case SNDCTL_DSP_GETTRIGGER:
|
|
return *(int *) arg = audio_devs[dev]->enable_bits;
|
|
break;
|
|
|
|
case SNDCTL_DSP_SETSYNCRO:
|
|
|
|
if (!audio_devs[dev]->trigger)
|
|
return -(EINVAL);
|
|
|
|
audio_devs[dev]->trigger(dev, 0);
|
|
audio_devs[dev]->go = 0;
|
|
return 0;
|
|
break;
|
|
|
|
case SNDCTL_DSP_GETIPTR:
|
|
{
|
|
count_info info;
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
info.bytes = audio_devs[dev]->dmap_in->byte_counter;
|
|
info.ptr = get_buffer_pointer(dev, audio_devs[dev]->dmachan2, audio_devs[dev]->dmap_in);
|
|
info.blocks = audio_devs[dev]->dmap_in->qlen;
|
|
info.bytes += info.ptr;
|
|
|
|
bcopy((char *) &info, &(((char *) arg)[0]), sizeof(info));
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (audio_devs[dev]->dmap_in->mapping_flags & DMA_MAP_MAPPED)
|
|
audio_devs[dev]->dmap_in->qlen = 0; /* Ack interrupts */
|
|
#endif
|
|
splx(flags);
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
case SNDCTL_DSP_GETOPTR:
|
|
{
|
|
count_info info;
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
info.bytes = audio_devs[dev]->dmap_out->byte_counter;
|
|
info.ptr = get_buffer_pointer(dev, audio_devs[dev]->dmachan1, audio_devs[dev]->dmap_out);
|
|
info.blocks = audio_devs[dev]->dmap_out->qlen;
|
|
info.bytes += info.ptr;
|
|
bcopy((char *) &info, &(((char *) arg)[0]), sizeof(info));
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (audio_devs[dev]->dmap_out->mapping_flags & DMA_MAP_MAPPED)
|
|
audio_devs[dev]->dmap_out->qlen = 0; /* Ack interrupts */
|
|
#endif
|
|
splx(flags);
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
return audio_devs[dev]->ioctl(dev, cmd, arg, local);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* DMAbuf_start_devices() is called by the /dev/music driver to start one or
|
|
* more audio devices at desired moment.
|
|
*/
|
|
|
|
void
|
|
DMAbuf_start_devices(u_int devmask)
|
|
{
|
|
int dev;
|
|
|
|
for (dev = 0; dev < num_audiodevs; dev++)
|
|
if (devmask & (1 << dev))
|
|
if (audio_devs[dev]->open_mode != 0)
|
|
if (!audio_devs[dev]->go) {
|
|
/* OK to start the device */
|
|
audio_devs[dev]->go = 1;
|
|
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
}
|
|
|
|
static int
|
|
space_in_queue(int dev)
|
|
{
|
|
int len, max, tmp;
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_out;
|
|
if (dmap->qlen >= dmap->nbufs) /* No space at all */
|
|
return 0;
|
|
|
|
/*
|
|
* Verify that there are no more pending buffers than the limit
|
|
* defined by the process.
|
|
*/
|
|
|
|
max = dmap->max_fragments;
|
|
len = dmap->qlen;
|
|
|
|
if (audio_devs[dev]->local_qlen) {
|
|
tmp = audio_devs[dev]->local_qlen(dev);
|
|
if (tmp & len)
|
|
tmp--; /* This buffer has been counted twice */
|
|
len += tmp;
|
|
}
|
|
|
|
if (len >= max)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
int
|
|
DMAbuf_getwrbuffer(int dev, char **buf, int *size, int dontblock)
|
|
{
|
|
u_long flags;
|
|
int abort, err = EIO;
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_out;
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (audio_devs[dev]->dmap_out->mapping_flags & DMA_MAP_MAPPED) {
|
|
printf("Sound: Can't write to mmapped device (3)\n");
|
|
return -(EINVAL);
|
|
}
|
|
#endif
|
|
|
|
if (dmap->dma_mode == DMODE_INPUT) { /* Direction change */
|
|
dma_reset(dev);
|
|
dmap->dma_mode = DMODE_NONE;
|
|
} else if (dmap->flags & DMA_RESTART) { /* Restart buffering */
|
|
dma_sync(dev);
|
|
dma_reset_output(dev);
|
|
}
|
|
dmap->flags &= ~DMA_RESTART;
|
|
|
|
if (!(dmap->flags & DMA_ALLOC_DONE))
|
|
reorganize_buffers(dev, dmap);
|
|
|
|
if (!dmap->dma_mode) {
|
|
int err;
|
|
|
|
dmap->dma_mode = DMODE_OUTPUT;
|
|
if ((err = audio_devs[dev]->prepare_for_output(dev,
|
|
dmap->fragment_size, dmap->nbufs)) < 0)
|
|
return err;
|
|
}
|
|
flags = splhigh();
|
|
|
|
abort = 0;
|
|
while (!space_in_queue(dev) && !abort) {
|
|
int timeout;
|
|
|
|
if (dontblock) {
|
|
splx(flags);
|
|
return -(EAGAIN);
|
|
}
|
|
if (!(audio_devs[dev]->enable_bits & PCM_ENABLE_OUTPUT) &&
|
|
audio_devs[dev]->go) {
|
|
splx(flags);
|
|
return -(EAGAIN);
|
|
}
|
|
/*
|
|
* Wait for free space
|
|
*/
|
|
if (!audio_devs[dev]->go)
|
|
timeout = 0;
|
|
else
|
|
timeout = 2 * hz;
|
|
|
|
{
|
|
int chn;
|
|
|
|
out_sleep_flag[dev].mode = WK_SLEEP;
|
|
out_sleeper[dev] = &chn;
|
|
DO_SLEEP2(chn, out_sleep_flag[dev], timeout);
|
|
|
|
if ((out_sleep_flag[dev].mode & WK_TIMEOUT)) {
|
|
printf("Sound: DMA (output) timed out - IRQ/DRQ config error?\n");
|
|
err = EIO;
|
|
abort = 1;
|
|
out_sleep_flag[dev].aborting = 1;
|
|
audio_devs[dev]->reset(dev);
|
|
} else if ((out_sleep_flag[dev].aborting) ||
|
|
CURSIG(curproc)) {
|
|
err = EINTR;
|
|
abort = 1;
|
|
}
|
|
}
|
|
}
|
|
splx(flags);
|
|
|
|
if (!space_in_queue(dev)) {
|
|
return -(err); /* Caught a signal ? */
|
|
}
|
|
*buf = dmap->raw_buf + dmap->qtail * dmap->fragment_size;
|
|
*size = dmap->fragment_size;
|
|
dmap->counts[dmap->qtail] = 0;
|
|
return dmap->qtail;
|
|
}
|
|
|
|
int
|
|
DMAbuf_start_output(int dev, int buff_no, int l)
|
|
{
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_out;
|
|
|
|
/*
|
|
* Bypass buffering if using mmaped access
|
|
*/
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (audio_devs[dev]->dmap_out->mapping_flags & DMA_MAP_MAPPED) {
|
|
l = dmap->fragment_size;
|
|
dmap->counts[dmap->qtail] = l;
|
|
dmap->flags &= ~DMA_RESTART;
|
|
dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
|
|
} else
|
|
#else
|
|
if (dmap != NULL)
|
|
#endif
|
|
{
|
|
|
|
if (buff_no != dmap->qtail)
|
|
printf("Sound warning: DMA buffers out of sync %d != %d\n", buff_no, dmap->qtail);
|
|
|
|
dmap->qlen++;
|
|
if (dmap->qlen <= 0 || dmap->qlen > dmap->nbufs)
|
|
printf("\nSound: Audio queue2 corrupted for dev%d (%d/%d)\n",
|
|
dev, dmap->qlen, dmap->nbufs);
|
|
|
|
dmap->counts[dmap->qtail] = l;
|
|
|
|
if ((l != dmap->fragment_size) &&
|
|
((audio_devs[dev]->flags & DMA_AUTOMODE) &&
|
|
audio_devs[dev]->flags & NEEDS_RESTART))
|
|
dmap->flags |= DMA_RESTART;
|
|
else
|
|
dmap->flags &= ~DMA_RESTART;
|
|
|
|
dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
|
|
}
|
|
if (!(dmap->flags & DMA_ACTIVE)) {
|
|
dmap->flags |= DMA_ACTIVE;
|
|
audio_devs[dev]->output_block(dev, dmap->raw_buf_phys +
|
|
dmap->qhead * dmap->fragment_size,
|
|
dmap->counts[dmap->qhead], 0,
|
|
!(audio_devs[dev]->flags & DMA_AUTOMODE) ||
|
|
!(dmap->flags & DMA_STARTED));
|
|
dmap->flags |= DMA_STARTED;
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
DMAbuf_start_dma(int dev, u_long physaddr, int count, int dma_mode)
|
|
{
|
|
int chan;
|
|
struct dma_buffparms *dmap;
|
|
|
|
if (dma_mode == 1) {
|
|
chan = audio_devs[dev]->dmachan1;
|
|
dmap = audio_devs[dev]->dmap_out;
|
|
|
|
} else {
|
|
chan = audio_devs[dev]->dmachan2;
|
|
dmap = audio_devs[dev]->dmap_in;
|
|
}
|
|
|
|
/*
|
|
* The count must be one less than the actual size. This is handled
|
|
* by set_dma_addr()
|
|
*/
|
|
|
|
#ifndef PSEUDO_DMA_AUTOINIT
|
|
if (audio_devs[dev]->flags & DMA_AUTOMODE) {
|
|
/* Auto restart mode. Transfer the whole buffer */
|
|
isa_dmastart(ISADMA_RAW | ((dma_mode == 0) ? ISADMA_READ : ISADMA_WRITE),
|
|
(caddr_t) (void *) (uintptr_t) dmap->raw_buf_phys,
|
|
dmap->bytes_in_use, chan);
|
|
|
|
} else
|
|
#endif
|
|
{
|
|
isa_dmastart((dma_mode == 0) ? ISADMA_READ : ISADMA_WRITE,
|
|
(caddr_t) (void *) (uintptr_t) physaddr, count, chan);
|
|
}
|
|
return count;
|
|
}
|
|
|
|
void
|
|
DMAbuf_init()
|
|
{
|
|
int dev;
|
|
|
|
/*
|
|
* NOTE! This routine could be called several times.
|
|
* XXX is it ok to make it run only the first time ? -- lr970710
|
|
*/
|
|
|
|
for (dev = 0; dev < num_audiodevs; dev++)
|
|
if (audio_devs[dev]->dmap_out == NULL) {
|
|
audio_devs[dev]->dmap_out =
|
|
audio_devs[dev]->dmap_in = &dmaps[ndmaps++];
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX)
|
|
audio_devs[dev]->dmap_in = &dmaps[ndmaps++];
|
|
}
|
|
}
|
|
|
|
void
|
|
DMAbuf_outputintr(int dev, int event_type)
|
|
{
|
|
/*
|
|
* Event types: 0 = DMA transfer done. Device still has more data in
|
|
* the local buffer. 1 = DMA transfer done. Device doesn't have local
|
|
* buffer or it's empty now. 2 = No DMA transfer but the device has
|
|
* now more space in its local buffer.
|
|
*/
|
|
|
|
u_long flags;
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_out;
|
|
dmap->byte_counter += dmap->counts[dmap->qhead];
|
|
#ifdef OS_DMA_INTR
|
|
sound_dma_intr(dev, audio_devs[dev]->dmap_out, audio_devs[dev]->dmachan1);
|
|
#endif
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (dmap->mapping_flags & DMA_MAP_MAPPED) {
|
|
/* mmapped access */
|
|
|
|
dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
|
|
dmap->qlen++; /* Yes increment it (don't decrement) */
|
|
dmap->flags &= ~DMA_ACTIVE;
|
|
dmap->counts[dmap->qhead] = dmap->fragment_size;
|
|
|
|
if (!(audio_devs[dev]->flags & DMA_AUTOMODE)) {
|
|
audio_devs[dev]->output_block(dev, dmap->raw_buf_phys +
|
|
dmap->qhead * dmap->fragment_size,
|
|
dmap->counts[dmap->qhead], 1,
|
|
!(audio_devs[dev]->flags & DMA_AUTOMODE));
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
#ifdef PSEUDO_DMA_AUTOINIT
|
|
else {
|
|
DMAbuf_start_dma(dev, dmap->raw_buf_phys +
|
|
dmap->qhead * dmap->fragment_size,
|
|
dmap->counts[dmap->qhead], 1);
|
|
}
|
|
#endif
|
|
dmap->flags |= DMA_ACTIVE;
|
|
|
|
} else
|
|
#endif
|
|
if (event_type != 2) {
|
|
if (dmap->qlen <= 0 || dmap->qlen > dmap->nbufs) {
|
|
printf("\nSound: Audio queue3 corrupted for dev%d (%d/%d)\n",
|
|
dev, dmap->qlen, dmap->nbufs);
|
|
return;
|
|
}
|
|
if (!(audio_devs[dev]->flags & DMA_DISABLE))
|
|
isa_dmadone(0, 0, 0, audio_devs[dev]->dmachan1);
|
|
|
|
dmap->qlen--;
|
|
dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
|
|
dmap->flags &= ~DMA_ACTIVE;
|
|
if (dmap->qlen) {
|
|
/* if (!(audio_devs[dev]->flags & NEEDS_RESTART)) */
|
|
{
|
|
audio_devs[dev]->output_block(dev, dmap->raw_buf_phys +
|
|
dmap->qhead * dmap->fragment_size,
|
|
dmap->counts[dmap->qhead], 1,
|
|
!(audio_devs[dev]->flags & DMA_AUTOMODE));
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
|
|
#ifdef PSEUDO_DMA_AUTOINIT
|
|
/* else */
|
|
{
|
|
DMAbuf_start_dma(dev, dmap->raw_buf_phys +
|
|
dmap->qhead * dmap->fragment_size,
|
|
dmap->counts[dmap->qhead], 1);
|
|
}
|
|
#endif
|
|
dmap->flags |= DMA_ACTIVE;
|
|
} else if (event_type == 1) {
|
|
dmap->underrun_count++;
|
|
if ((audio_devs[dev]->flags & DMA_DUPLEX) &&
|
|
audio_devs[dev]->halt_output)
|
|
audio_devs[dev]->halt_output(dev);
|
|
else
|
|
audio_devs[dev]->halt_xfer(dev);
|
|
|
|
if ((audio_devs[dev]->flags & DMA_AUTOMODE) &&
|
|
audio_devs[dev]->flags & NEEDS_RESTART)
|
|
dmap->flags |= DMA_RESTART;
|
|
else
|
|
dmap->flags &= ~DMA_RESTART;
|
|
}
|
|
} /* event_type != 2 */
|
|
flags = splhigh();
|
|
|
|
if ((out_sleep_flag[dev].mode & WK_SLEEP)) {
|
|
out_sleep_flag[dev].mode = WK_WAKEUP;
|
|
wakeup(out_sleeper[dev]);
|
|
}
|
|
|
|
if(selinfo[dev].si_pid) {
|
|
selwakeup(&selinfo[dev]);
|
|
}
|
|
|
|
splx(flags);
|
|
}
|
|
|
|
void
|
|
DMAbuf_inputintr(int dev)
|
|
{
|
|
u_long flags;
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_in;
|
|
|
|
dmap->byte_counter += dmap->fragment_size;
|
|
|
|
#ifdef OS_DMA_INTR
|
|
sound_dma_intr(dev, audio_devs[dev]->dmap_in, audio_devs[dev]->dmachan2);
|
|
#endif
|
|
if (!(audio_devs[dev]->flags & DMA_DISABLE))
|
|
isa_dmadone(0, 0, 0, audio_devs[dev]->dmachan2);
|
|
|
|
#ifdef ALLOW_BUFFER_MAPPING
|
|
if (dmap->mapping_flags & DMA_MAP_MAPPED) {
|
|
dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
|
|
dmap->qlen++;
|
|
|
|
if (!(audio_devs[dev]->flags & NEEDS_RESTART)) {
|
|
audio_devs[dev]->start_input(dev, dmap->raw_buf_phys +
|
|
dmap->qtail * dmap->fragment_size,
|
|
dmap->fragment_size, 1,
|
|
!(audio_devs[dev]->flags & DMA_AUTOMODE));
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
#ifdef PSEUDO_DMA_AUTOINIT
|
|
else {
|
|
DMAbuf_start_dma(dev, dmap->raw_buf_phys +
|
|
dmap->qtail * dmap->fragment_size,
|
|
dmap->counts[dmap->qtail], 0);
|
|
}
|
|
#endif
|
|
|
|
dmap->flags |= DMA_ACTIVE;
|
|
} else
|
|
#endif
|
|
if (dmap->qlen == (dmap->nbufs - 1)) {
|
|
/* printf ("Sound: Recording overrun\n"); */
|
|
dmap->underrun_count++;
|
|
if ((audio_devs[dev]->flags & DMA_DUPLEX) &&
|
|
audio_devs[dev]->halt_input)
|
|
audio_devs[dev]->halt_input(dev);
|
|
else
|
|
audio_devs[dev]->halt_xfer(dev);
|
|
|
|
dmap->flags &= ~DMA_ACTIVE;
|
|
if (audio_devs[dev]->flags & DMA_AUTOMODE)
|
|
dmap->flags |= DMA_RESTART;
|
|
else
|
|
dmap->flags &= ~DMA_RESTART;
|
|
} else {
|
|
dmap->qlen++;
|
|
if (dmap->qlen <= 0 || dmap->qlen > dmap->nbufs)
|
|
printf("\nSound: Audio queue4 corrupted for dev%d (%d/%d)\n",
|
|
dev, dmap->qlen, dmap->nbufs);
|
|
dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
|
|
|
|
/* if (!(audio_devs[dev]->flags & DMA_AUTOMODE)) */
|
|
{
|
|
audio_devs[dev]->start_input(dev, dmap->raw_buf_phys +
|
|
dmap->qtail * dmap->fragment_size,
|
|
dmap->fragment_size, 1,
|
|
!(audio_devs[dev]->flags & DMA_AUTOMODE));
|
|
if (audio_devs[dev]->trigger)
|
|
audio_devs[dev]->trigger(dev,
|
|
audio_devs[dev]->enable_bits * audio_devs[dev]->go);
|
|
}
|
|
#ifdef PSEUDO_DMA_AUTOINIT
|
|
/* else */
|
|
{
|
|
DMAbuf_start_dma(dev, dmap->raw_buf_phys +
|
|
dmap->qtail * dmap->fragment_size,
|
|
dmap->counts[dmap->qtail], 0);
|
|
}
|
|
#endif
|
|
|
|
dmap->flags |= DMA_ACTIVE;
|
|
}
|
|
|
|
flags = splhigh();
|
|
if ((in_sleep_flag[dev].mode & WK_SLEEP)) {
|
|
in_sleep_flag[dev].mode = WK_WAKEUP;
|
|
wakeup(in_sleeper[dev]);
|
|
}
|
|
if (selinfo[dev].si_pid)
|
|
selwakeup(&selinfo[dev]);
|
|
splx(flags);
|
|
}
|
|
|
|
int
|
|
DMAbuf_open_dma(int dev)
|
|
{
|
|
int err;
|
|
u_long flags;
|
|
flags = splhigh();
|
|
|
|
if ((err = open_dmap(dev, OPEN_READWRITE, audio_devs[dev]->dmap_out,
|
|
audio_devs[dev]->dmachan1)) < 0) {
|
|
splx(flags);
|
|
return -(EBUSY);
|
|
}
|
|
dma_init_buffers(dev, audio_devs[dev]->dmap_out);
|
|
/* audio_devs[dev]->dmap_out->flags |= DMA_ALLOC_DONE; */
|
|
audio_devs[dev]->dmap_out->fragment_size = audio_devs[dev]->buffsize;
|
|
/* reorganize_buffers (dev, audio_devs[dev]->dmap_out); */
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX) {
|
|
if ((err = open_dmap(dev, OPEN_READWRITE,
|
|
audio_devs[dev]->dmap_in, audio_devs[dev]->dmachan2)) < 0) {
|
|
printf("Unable to grab DMA%d for the audio driver\n",
|
|
audio_devs[dev]->dmachan2);
|
|
close_dmap(dev, audio_devs[dev]->dmap_out,
|
|
audio_devs[dev]->dmachan1);
|
|
splx(flags);
|
|
return -(EBUSY);
|
|
}
|
|
dma_init_buffers(dev, audio_devs[dev]->dmap_in);
|
|
/* audio_devs[dev]->dmap_in->flags |= DMA_ALLOC_DONE; */
|
|
audio_devs[dev]->dmap_in->fragment_size = audio_devs[dev]->buffsize;
|
|
/* reorganize_buffers (dev, audio_devs[dev]->dmap_in); */
|
|
} else {
|
|
audio_devs[dev]->dmap_in = audio_devs[dev]->dmap_out;
|
|
audio_devs[dev]->dmachan2 = audio_devs[dev]->dmachan1;
|
|
}
|
|
|
|
splx(flags);
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
DMAbuf_close_dma(int dev)
|
|
{
|
|
DMAbuf_reset_dma(dev);
|
|
close_dmap(dev, audio_devs[dev]->dmap_out, audio_devs[dev]->dmachan1);
|
|
|
|
if (audio_devs[dev]->flags & DMA_DUPLEX)
|
|
close_dmap(dev, audio_devs[dev]->dmap_in, audio_devs[dev]->dmachan2);
|
|
|
|
}
|
|
|
|
void
|
|
DMAbuf_reset_dma(int dev)
|
|
{
|
|
}
|
|
|
|
#ifdef ALLOW_POLL
|
|
|
|
int
|
|
DMAbuf_poll(int dev, struct fileinfo * file, int events, select_table * wait)
|
|
{
|
|
struct dma_buffparms *dmap;
|
|
u_long flags;
|
|
int revents = 0;
|
|
|
|
dmap = audio_devs[dev]->dmap_in;
|
|
|
|
if (events & (POLLIN | POLLRDNORM)) {
|
|
if (dmap->dma_mode != DMODE_INPUT) {
|
|
if ((audio_devs[dev]->flags & DMA_DUPLEX) && !dmap->qlen &&
|
|
audio_devs[dev]->enable_bits & PCM_ENABLE_INPUT &&
|
|
audio_devs[dev]->go) {
|
|
u_long flags;
|
|
|
|
flags = splhigh();
|
|
|
|
activate_recording(dev, dmap);
|
|
splx(flags);
|
|
|
|
}
|
|
return 0;
|
|
}
|
|
if (!dmap->qlen) {
|
|
flags = splhigh();
|
|
|
|
selrecord(wait, &selinfo[dev]);
|
|
|
|
splx(flags);
|
|
|
|
return 0;
|
|
} else
|
|
revents |= events & (POLLIN | POLLRDNORM);
|
|
|
|
}
|
|
|
|
if (events & (POLLOUT | POLLWRNORM)) {
|
|
|
|
dmap = audio_devs[dev]->dmap_out;
|
|
if (dmap->dma_mode == DMODE_INPUT)
|
|
return 0;
|
|
|
|
if (dmap->dma_mode == DMODE_NONE)
|
|
return ( events & (POLLOUT | POLLWRNORM));
|
|
|
|
if (dmap->mapping_flags & DMA_MAP_MAPPED) {
|
|
|
|
if(dmap->qlen)
|
|
return 1;
|
|
flags = splhigh();
|
|
selrecord(wait, &selinfo[dev]);
|
|
|
|
splx(flags);
|
|
|
|
return 0;
|
|
|
|
}
|
|
if (!space_in_queue(dev)) {
|
|
flags = splhigh();
|
|
selrecord(wait, &selinfo[dev]);
|
|
splx(flags);
|
|
|
|
} else
|
|
revents |= events & (POLLOUT | POLLWRNORM);
|
|
|
|
|
|
}
|
|
|
|
return (revents);
|
|
}
|
|
|
|
|
|
#ifdef amancio
|
|
int
|
|
DMAbuf_select(int dev, struct fileinfo * file, int sel_type, select_table * wait)
|
|
{
|
|
struct dma_buffparms *dmap = audio_devs[dev]->dmap_out;
|
|
struct dma_buffparms *dmapin = audio_devs[dev]->dmap_in;
|
|
u_long flags;
|
|
|
|
switch (sel_type) {
|
|
case FREAD:
|
|
if (dmapin->dma_mode != DMODE_INPUT)
|
|
return 0;
|
|
|
|
if (!dmap->qlen) {
|
|
flags = splhigh();
|
|
selrecord(wait, &selinfo[dev]);
|
|
splx(flags);
|
|
|
|
return 0;
|
|
}
|
|
return 1;
|
|
break;
|
|
|
|
case FWRITE:
|
|
if (dmap->dma_mode == DMODE_INPUT)
|
|
return 0;
|
|
|
|
if (dmap->dma_mode == DMODE_NONE)
|
|
return 1;
|
|
|
|
if (!space_in_queue(dev)) {
|
|
flags = splhigh();
|
|
|
|
selrecord(wait, &selinfo[dev]);
|
|
splx(flags);
|
|
|
|
return 0;
|
|
}
|
|
return 1;
|
|
break;
|
|
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#endif /* ALLOW_POLL */
|
|
#endif
|
|
|
|
#else /* CONFIG_AUDIO */
|
|
/*
|
|
* Stub versions if audio services not included
|
|
*/
|
|
|
|
int
|
|
DMAbuf_open(int dev, int mode)
|
|
{
|
|
return -(ENXIO);
|
|
}
|
|
|
|
int
|
|
DMAbuf_release(int dev, int mode)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
DMAbuf_getwrbuffer(int dev, char **buf, int *size, int dontblock)
|
|
{
|
|
return -(EIO);
|
|
}
|
|
|
|
int
|
|
DMAbuf_getrdbuffer(int dev, char **buf, int *len, int dontblock)
|
|
{
|
|
return -(EIO);
|
|
}
|
|
|
|
int
|
|
DMAbuf_rmchars(int dev, int buff_no, int c)
|
|
{
|
|
return -(EIO);
|
|
}
|
|
|
|
int
|
|
DMAbuf_start_output(int dev, int buff_no, int l)
|
|
{
|
|
return -(EIO);
|
|
}
|
|
|
|
int
|
|
DMAbuf_ioctl(int dev, u_int cmd, ioctl_arg arg, int local)
|
|
{
|
|
return -(EIO);
|
|
}
|
|
|
|
void
|
|
DMAbuf_init()
|
|
{
|
|
}
|
|
|
|
int
|
|
DMAbuf_start_dma(int dev, u_long physaddr, int count, int dma_mode)
|
|
{
|
|
return -(EIO);
|
|
}
|
|
|
|
int
|
|
DMAbuf_open_dma(int dev)
|
|
{
|
|
return -(ENXIO);
|
|
}
|
|
|
|
void
|
|
DMAbuf_close_dma(int dev)
|
|
{
|
|
return;
|
|
}
|
|
|
|
void
|
|
DMAbuf_reset_dma(int dev)
|
|
{
|
|
return;
|
|
}
|
|
|
|
void
|
|
DMAbuf_inputintr(int dev)
|
|
{
|
|
return;
|
|
}
|
|
|
|
void
|
|
DMAbuf_outputintr(int dev, int underrun_flag)
|
|
{
|
|
return;
|
|
}
|
|
#endif /* CONFIG_AUDIO */
|