864 lines
19 KiB
C
864 lines
19 KiB
C
/* $NetBSD: vidcaudio.c,v 1.10 1997/03/25 05:09:01 mark Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1995 Melvin Tang-Richardson
|
|
*
|
|
* 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.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the RiscBSD team.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 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.
|
|
*/
|
|
|
|
/*
|
|
* Yikes just had a look at this and realised that it does not conform
|
|
* to Kernel Normal Form at all. I have fixed the first few functions
|
|
* but there are a lot more still to do - mark
|
|
*/
|
|
|
|
/*
|
|
* audio driver for the RiscPC 16 bit sound
|
|
*
|
|
* Interfaces with the NetBSD generic audio driver to provide SUN
|
|
* /dev/audio (partial) compatibility.
|
|
*
|
|
*/
|
|
|
|
#include <sys/param.h> /* proc.h */
|
|
#include <sys/types.h> /* dunno */
|
|
#include <sys/conf.h> /* autoconfig functions */
|
|
#include <sys/device.h> /* device calls */
|
|
#include <sys/proc.h> /* device calls */
|
|
#include <sys/audioio.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/systm.h>
|
|
|
|
#include <vm/vm.h>
|
|
#include <vm/vm_kern.h>
|
|
|
|
#include <dev/audio_if.h>
|
|
|
|
#include <machine/irqhandler.h>
|
|
#include <machine/iomd.h>
|
|
#include <machine/vidc.h>
|
|
#include <machine/katelib.h>
|
|
|
|
#include <arm32/mainbus/mainbus.h>
|
|
#include "waveform.h"
|
|
#include "vidcaudio.h"
|
|
|
|
#undef DEBUG
|
|
|
|
struct audio_general {
|
|
int in_sr;
|
|
int out_sr;
|
|
vm_offset_t silence;
|
|
irqhandler_t ih;
|
|
|
|
void (*intr) ();
|
|
void *arg;
|
|
|
|
vm_offset_t next_cur;
|
|
vm_offset_t next_end;
|
|
void (*next_intr) ();
|
|
void *next_arg;
|
|
|
|
int buffer;
|
|
int in_progress;
|
|
|
|
int open;
|
|
} ag;
|
|
|
|
struct vidcaudio_softc {
|
|
struct device device;
|
|
int iobase;
|
|
|
|
int open;
|
|
|
|
u_int encoding;
|
|
u_int precision;
|
|
int channels;
|
|
|
|
int inport;
|
|
int outport;
|
|
};
|
|
|
|
int vidcaudio_probe __P((struct device *parent, void *match, void *aux));
|
|
void vidcaudio_attach __P((struct device *parent, struct device *self, void *aux));
|
|
int vidcaudio_open __P((dev_t dev, int flags));
|
|
void vidcaudio_close __P((void *addr));
|
|
|
|
int vidcaudio_intr __P((void *arg));
|
|
int vidcaudio_dma_program __P((vm_offset_t cur, vm_offset_t end, void (*intr)(), void *arg));
|
|
void vidcaudio_dummy_routine __P((void *arg));
|
|
int vidcaudio_stereo __P((int channel, int position));
|
|
int vidcaudio_rate __P((int rate));
|
|
void vidcaudio_shutdown __P((void));
|
|
int vidcaudio_hw_attach __P((struct vidcaudio_softc *sc));
|
|
|
|
static int sound_dma_intr;
|
|
|
|
struct cfattach vidcaudio_ca = {
|
|
sizeof(struct vidcaudio_softc), vidcaudio_probe, vidcaudio_attach
|
|
};
|
|
|
|
struct cfdriver vidcaudio_cd = {
|
|
NULL, "vidcaudio", DV_DULL
|
|
};
|
|
|
|
|
|
void
|
|
vidcaudio_beep_generate()
|
|
{
|
|
vidcaudio_dma_program ( ag.silence, ag.silence+sizeof(beep_waveform)-16,
|
|
vidcaudio_dummy_routine, NULL );
|
|
}
|
|
|
|
|
|
int
|
|
vidcaudio_probe(parent, match, aux)
|
|
struct device *parent;
|
|
void *match;
|
|
void *aux;
|
|
{
|
|
int id;
|
|
|
|
id = IOMD_ID;
|
|
|
|
/* So far I only know about this IOMD */
|
|
|
|
switch (id) {
|
|
case RPC600_IOMD_ID:
|
|
return(1);
|
|
break;
|
|
case ARM7500_IOC_ID:
|
|
#ifdef RC7500
|
|
return(0);
|
|
#else
|
|
return(1);
|
|
#endif
|
|
break;
|
|
default:
|
|
printf("vidcaudio: Unknown IOMD id=%04x", id);
|
|
break;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
void
|
|
vidcaudio_attach(parent, self, aux)
|
|
struct device *parent;
|
|
struct device *self;
|
|
void *aux;
|
|
{
|
|
struct mainbus_attach_args *mb = aux;
|
|
struct vidcaudio_softc *sc = (void *)self;
|
|
int id;
|
|
|
|
sc->iobase = mb->mb_iobase;
|
|
|
|
sc->open = 0;
|
|
sc->encoding = AUDIO_ENCODING_ULAW;
|
|
sc->precision = 8;
|
|
sc->channels = 1;
|
|
sc->inport = 0;
|
|
sc->outport = 0;
|
|
ag.in_sr = 24*1024;
|
|
ag.out_sr = 24*1024;
|
|
ag.in_progress = 0;
|
|
|
|
ag.next_cur = 0;
|
|
ag.next_end = 0;
|
|
ag.next_intr = NULL;
|
|
ag.next_arg = NULL;
|
|
|
|
vidcaudio_rate(32);
|
|
|
|
/* Program the silence buffer and reset the DMA channel */
|
|
|
|
ag.silence = kmem_alloc(kernel_map, NBPG);
|
|
if (ag.silence == NULL)
|
|
panic("vidcaudio: Cannot allocate memory\n");
|
|
|
|
bzero((char *)ag.silence, NBPG);
|
|
bcopy((char *)beep_waveform, (char *)ag.silence, sizeof(beep_waveform));
|
|
|
|
ag.buffer = 0;
|
|
|
|
/* Install the irq handler for the DMA interrupt */
|
|
ag.ih.ih_func = vidcaudio_intr;
|
|
ag.ih.ih_arg = NULL;
|
|
ag.ih.ih_level = IPL_NONE;
|
|
ag.ih.ih_name = "vidcaudio";
|
|
|
|
ag.intr = NULL;
|
|
/* ag.nextintr = NULL;*/
|
|
|
|
id = IOMD_ID;
|
|
|
|
switch (id) {
|
|
#ifndef CPU_ARM7500
|
|
case RPC600_IOMD_ID:
|
|
sound_dma_intr = IRQ_DMASCH0;
|
|
break;
|
|
#else
|
|
case ARM7500_IOC_ID:
|
|
sound_dma_intr = IRQ_SDMA;
|
|
break;
|
|
#endif
|
|
}
|
|
|
|
disable_irq(sound_dma_intr);
|
|
|
|
if (irq_claim(sound_dma_intr, &(ag.ih)))
|
|
panic("vidcaudio: couldn't claim IRQ %d\n", sound_dma_intr);
|
|
|
|
disable_irq(sound_dma_intr);
|
|
|
|
vidcaudio_dma_program(ag.silence, ag.silence+NBPG-16,
|
|
vidcaudio_dummy_routine, NULL);
|
|
|
|
vidcaudio_hw_attach(sc);
|
|
|
|
printf("\n");
|
|
|
|
#ifdef DEBUG
|
|
printf(" UNDER DEVELOPMENT (nuts)\n");
|
|
#endif
|
|
}
|
|
|
|
int
|
|
vidcaudio_open(dev, flags)
|
|
dev_t dev;
|
|
int flags;
|
|
{
|
|
struct vidcaudio_softc *sc;
|
|
int unit = AUDIOUNIT(dev);
|
|
int s;
|
|
|
|
#ifdef DEBUG
|
|
printf("DEBUG: vidcaudio_open called\n");
|
|
#endif
|
|
|
|
if (unit >= vidcaudio_cd.cd_ndevs)
|
|
return ENODEV;
|
|
|
|
sc = vidcaudio_cd.cd_devs[unit];
|
|
|
|
if (!sc)
|
|
return ENXIO;
|
|
|
|
s = splhigh();
|
|
|
|
if (sc->open != 0) {
|
|
(void)splx(s);
|
|
return EBUSY;
|
|
}
|
|
|
|
sc->open=1;
|
|
ag.open=1;
|
|
|
|
(void)splx(s);
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
vidcaudio_close(addr)
|
|
void *addr;
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
|
|
vidcaudio_shutdown();
|
|
|
|
#ifdef DEBUG
|
|
printf("DEBUG: vidcaudio_close called\n");
|
|
#endif
|
|
|
|
sc->open = 0;
|
|
ag.open = 0;
|
|
}
|
|
|
|
/* ************************************************************************* *
|
|
| Interface to the generic audio driver |
|
|
* ************************************************************************* */
|
|
|
|
int vidcaudio_set_in_sr __P((void *, u_long));
|
|
u_long vidcaudio_get_in_sr __P((void *));
|
|
int vidcaudio_set_out_sr __P((void *, u_long));
|
|
u_long vidcaudio_get_out_sr __P((void *));
|
|
int vidcaudio_query_encoding __P((void *, struct audio_encoding *));
|
|
int vidcaudio_set_format __P((void *, u_int, u_int));
|
|
int vidcaudio_get_encoding __P((void *));
|
|
int vidcaudio_get_precision __P((void *));
|
|
int vidcaudio_set_channels __P((void *, int));
|
|
int vidcaudio_get_channels __P((void *));
|
|
int vidcaudio_round_blocksize __P((void *, int));
|
|
int vidcaudio_set_out_port __P((void *, int));
|
|
int vidcaudio_get_out_port __P((void *));
|
|
int vidcaudio_set_in_port __P((void *, int));
|
|
int vidcaudio_get_in_port __P((void *));
|
|
int vidcaudio_commit_settings __P((void *));
|
|
void vidcaudio_sw_encode __P((void *, int, u_char *, int));
|
|
void vidcaudio_sw_decode __P((void *, int, u_char *, int));
|
|
int vidcaudio_start_output __P((void *, void *, int, void (*)(), void *));
|
|
int vidcaudio_start_input __P((void *, void *, int, void (*)(), void *));
|
|
int vidcaudio_halt_output __P((void *));
|
|
int vidcaudio_halt_input __P((void *));
|
|
int vidcaudio_cont_output __P((void *));
|
|
int vidcaudio_cont_input __P((void *));
|
|
int vidcaudio_speaker_ctl __P((void *, int));
|
|
int vidcaudio_getdev __P((void *, struct audio_device *));
|
|
int vidcaudio_setfd __P((void *, int));
|
|
int vidcaudio_set_port __P((void *, mixer_ctrl_t *));
|
|
int vidcaudio_get_port __P((void *, mixer_ctrl_t *));
|
|
int vidcaudio_query_devinfo __P((void *, mixer_devinfo_t *));
|
|
|
|
struct audio_device vidcaudio_device = {
|
|
"VidcAudio 8-bit",
|
|
"x",
|
|
"vidcaudio"
|
|
};
|
|
|
|
int
|
|
vidcaudio_set_in_sr(addr, sr)
|
|
void *addr;
|
|
u_long sr;
|
|
{
|
|
ag.in_sr = sr;
|
|
return 0;
|
|
}
|
|
|
|
u_long
|
|
vidcaudio_get_in_sr(addr)
|
|
void *addr;
|
|
{
|
|
return ag.in_sr;
|
|
}
|
|
|
|
int
|
|
vidcaudio_set_out_sr(addr, sr)
|
|
void *addr;
|
|
u_long sr;
|
|
{
|
|
ag.out_sr = sr;
|
|
return 0;
|
|
}
|
|
|
|
u_long
|
|
vidcaudio_get_out_sr(addr)
|
|
void *addr;
|
|
{
|
|
return(ag.out_sr);
|
|
}
|
|
|
|
int vidcaudio_query_encoding ( void *addr, struct audio_encoding *fp )
|
|
{
|
|
switch ( fp->index )
|
|
{
|
|
case 0:
|
|
strcpy (fp->name, "vidc" );
|
|
fp->format_id = AUDIO_ENCODING_ULAW;
|
|
break;
|
|
|
|
default:
|
|
return (EINVAL);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int vidcaudio_set_format ( void *addr, u_int encoding, u_int precision )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
|
|
if (encoding != AUDIO_ENCODING_ULAW)
|
|
return (EINVAL);
|
|
if (precision != 8)
|
|
return (EINVAL);
|
|
|
|
sc->encoding = encoding;
|
|
sc->precision = precision;
|
|
return (0);
|
|
}
|
|
|
|
int vidcaudio_get_encoding ( void *addr )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
|
|
return (sc->encoding);
|
|
}
|
|
|
|
int vidcaudio_get_precision ( void *addr )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
|
|
return (sc->precision);
|
|
}
|
|
|
|
int vidcaudio_set_channels ( void *addr, int channels )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
|
|
if (channels != 1)
|
|
return (EINVAL);
|
|
|
|
sc->channels = channels;
|
|
return (0);
|
|
}
|
|
|
|
int vidcaudio_get_channels ( void *addr )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
|
|
return (sc->channels);
|
|
}
|
|
|
|
int vidcaudio_round_blocksize ( void *addr, int blk )
|
|
{
|
|
|
|
if (blk > NBPG)
|
|
blk = NBPG;
|
|
return (blk);
|
|
}
|
|
|
|
int vidcaudio_set_out_port ( void *addr, int port )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
sc->outport = port;
|
|
return 0;
|
|
}
|
|
|
|
int vidcaudio_get_out_port ( void *addr )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
return sc->outport;
|
|
}
|
|
|
|
int vidcaudio_set_in_port ( void *addr, int port )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
sc->inport = port;
|
|
return 0;
|
|
}
|
|
|
|
int vidcaudio_get_in_port ( void *addr )
|
|
{
|
|
struct vidcaudio_softc *sc = addr;
|
|
return sc->inport;
|
|
}
|
|
|
|
int vidcaudio_commit_settings ( void *addr )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: committ_settings\n" );
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
void vidcaudio_sw_encode ( void *addr, int e, u_char *p, int cc )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: sw_encode\n" );
|
|
#endif
|
|
return;
|
|
}
|
|
|
|
void vidcaudio_sw_decode ( void *addr, int e, u_char *p, int cc )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: sw_decode\n" );
|
|
#endif
|
|
}
|
|
|
|
#define ROUND(s) ( ((int)s) & (~(NBPG-1)) )
|
|
|
|
int vidcaudio_start_output ( void *addr, void *p, int cc,
|
|
void (*intr)(), void *arg )
|
|
{
|
|
/* I can only DMA inside 1 page */
|
|
|
|
#ifdef DEBUG
|
|
printf ( "vidcaudio_start_output (%d) %08x %08x\n", cc, intr, arg );
|
|
#endif
|
|
|
|
if ( ROUND(p) != ROUND(p+cc) )
|
|
{
|
|
/* If it's over a page I can fix it up by copying it into my buffer */
|
|
|
|
#ifdef DEBUG
|
|
printf ( "vidcaudio: DMA over page boundary requested. Fixing up\n" );
|
|
#endif
|
|
bcopy ( (char *)ag.silence, p, cc>NBPG ? NBPG : cc );
|
|
p=(void *)ag.silence;
|
|
|
|
/* I can't DMA any more than that, but it is possible to fix it up */
|
|
/* by handling multiple buffers and only interrupting the audio */
|
|
/* driver after sending out all the stuff it gave me. That it more */
|
|
/* than I can be bothered to do right now and it probablly wont */
|
|
/* happen so I'll just truncate the buffer and tell the user */
|
|
|
|
if ( cc>NBPG )
|
|
{
|
|
printf ( "vidcaudio: DMA buffer truncated. I could fix this up\n" );
|
|
cc=NBPG;
|
|
}
|
|
}
|
|
vidcaudio_dma_program ( (vm_offset_t)p, (vm_offset_t)(p+cc), intr, arg );
|
|
return 0;
|
|
}
|
|
|
|
int vidcaudio_start_input ( void *addr, void *p, int cc,
|
|
void (*intr)(), void *arg )
|
|
{
|
|
return EIO;
|
|
}
|
|
|
|
int vidcaudio_halt_output ( void *addr )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: vidcaudio_halt_output\n" );
|
|
#endif
|
|
return EIO;
|
|
}
|
|
|
|
int vidcaudio_halt_input ( void *addr )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: vidcaudio_halt_output\n" );
|
|
#endif
|
|
return EIO;
|
|
}
|
|
|
|
int vidcaudio_cont_output ( void *addr )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: vidcaudio_halt_output\n" );
|
|
#endif
|
|
return EIO;
|
|
}
|
|
|
|
int vidcaudio_cont_input ( void *addr )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: vidcaudio_halt_output\n" );
|
|
#endif
|
|
return EIO;
|
|
}
|
|
|
|
int vidcaudio_speaker_ctl ( void *addr, int newstate )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "DEBUG: vidcaudio_speaker_ctl\n" );
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
int vidcaudio_getdev ( void *addr, struct audio_device *retp )
|
|
{
|
|
*retp = vidcaudio_device;
|
|
return 0;
|
|
}
|
|
|
|
|
|
int vidcaudio_setfd ( void *addr, int flag )
|
|
{
|
|
return ENOTTY;
|
|
}
|
|
|
|
int vidcaudio_set_port ( void *addr, mixer_ctrl_t *cp )
|
|
{
|
|
return EINVAL;
|
|
}
|
|
|
|
int vidcaudio_get_port ( void *addr, mixer_ctrl_t *cp )
|
|
{
|
|
return EINVAL;
|
|
}
|
|
|
|
int vidcaudio_query_devinfo ( void *addr, mixer_devinfo_t *dip )
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
struct audio_hw_if vidcaudio_hw_if = {
|
|
vidcaudio_open,
|
|
vidcaudio_close,
|
|
NULL,
|
|
vidcaudio_set_in_sr,
|
|
vidcaudio_get_in_sr,
|
|
vidcaudio_set_out_sr,
|
|
vidcaudio_get_out_sr,
|
|
vidcaudio_query_encoding,
|
|
vidcaudio_set_format,
|
|
vidcaudio_get_encoding,
|
|
vidcaudio_get_precision,
|
|
vidcaudio_set_channels,
|
|
vidcaudio_get_channels,
|
|
vidcaudio_round_blocksize,
|
|
vidcaudio_set_out_port,
|
|
vidcaudio_get_out_port,
|
|
vidcaudio_set_in_port,
|
|
vidcaudio_get_in_port,
|
|
vidcaudio_commit_settings,
|
|
vidcaudio_sw_encode,
|
|
vidcaudio_sw_decode,
|
|
vidcaudio_start_output,
|
|
vidcaudio_start_input,
|
|
vidcaudio_halt_output,
|
|
vidcaudio_halt_input,
|
|
vidcaudio_cont_output,
|
|
vidcaudio_cont_input,
|
|
vidcaudio_speaker_ctl,
|
|
vidcaudio_getdev,
|
|
vidcaudio_setfd,
|
|
vidcaudio_set_port,
|
|
vidcaudio_get_port,
|
|
vidcaudio_query_devinfo,
|
|
0, /* not full duplex */
|
|
0
|
|
};
|
|
|
|
void vidcaudio_dummy_routine ( void *arg )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "vidcaudio_dummy_routine\n" );
|
|
#endif
|
|
}
|
|
|
|
int vidcaudio_hw_attach ( struct vidcaudio_softc *sc )
|
|
{
|
|
return ( audio_hardware_attach ( &vidcaudio_hw_if, sc ) );
|
|
}
|
|
|
|
int vidcaudio_rate ( int rate )
|
|
{
|
|
WriteWord ( VIDC_BASE, VIDC_SFR | rate );
|
|
return 0;
|
|
}
|
|
|
|
int vidcaudio_stereo ( int channel, int position )
|
|
{
|
|
if ( channel<0 ) return EINVAL;
|
|
if ( channel>7 ) return EINVAL;
|
|
channel = channel<<24 | VIDC_SIR0;
|
|
WriteWord ( VIDC_BASE, channel|position );
|
|
return 0;
|
|
}
|
|
|
|
#define PHYS(x) (pmap_extract( kernel_pmap, ((x)&PG_FRAME) ))
|
|
|
|
/*
|
|
* Program the next buffer to be used
|
|
* This function must be re-entrant, maximum re-entrancy of 2
|
|
*/
|
|
|
|
#define FLAGS (0)
|
|
|
|
int vidcaudio_dma_program ( vm_offset_t cur, vm_offset_t end,
|
|
void (*intr)(), void *arg )
|
|
{
|
|
/* If there isn't a transfer in progress then start a new one */
|
|
if ( ag.in_progress==0 )
|
|
{
|
|
ag.buffer = 0;
|
|
WriteWord ( IOMD_SD0CR, 0x90 ); /* Reset State Machine */
|
|
WriteWord ( IOMD_SD0CR, 0x30 ); /* Reset State Machine */
|
|
|
|
WriteWord ( IOMD_SD0CURB, PHYS(cur) );
|
|
WriteWord ( IOMD_SD0ENDB, PHYS(end-16)|FLAGS );
|
|
WriteWord ( IOMD_SD0CURA, PHYS(cur) );
|
|
WriteWord ( IOMD_SD0ENDA, PHYS(end-16)|FLAGS );
|
|
|
|
ag.in_progress = 1;
|
|
|
|
ag.next_cur = ag.next_end = 0;
|
|
ag.next_intr = ag.next_arg = 0;
|
|
|
|
ag.intr = intr;
|
|
ag.arg = arg;
|
|
|
|
/* The driver 'clicks' between buffer swaps, leading me to think */
|
|
/* that the fifo is much small than on other sound cards. So */
|
|
/* so I'm going to have to do some tricks here */
|
|
|
|
(*ag.intr)(ag.arg); /* Schedule the next buffer */
|
|
ag.intr = vidcaudio_dummy_routine; /* Already done this */
|
|
ag.arg = NULL;
|
|
|
|
#ifdef PRINT
|
|
printf ( "vidcaudio: start output\n" );
|
|
#endif
|
|
#ifdef DEBUG
|
|
printf ( "SE" );
|
|
#endif
|
|
enable_irq(sound_dma_intr);
|
|
}
|
|
else
|
|
{
|
|
/* Otherwise schedule the next one */
|
|
if ( ag.next_cur!=0 )
|
|
{
|
|
/* If there's one scheduled then complain */
|
|
printf ( "vidcaudio: Buffer already Q'ed\n" );
|
|
return EIO;
|
|
}
|
|
else
|
|
{
|
|
/* We're OK to schedule it now */
|
|
ag.buffer = (++ag.buffer) & 1;
|
|
ag.next_cur = PHYS(cur);
|
|
ag.next_end = PHYS(end-16);
|
|
ag.next_intr = intr;
|
|
ag.next_arg = arg;
|
|
#ifdef DEBUG
|
|
printf ( "s" );
|
|
#endif
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void vidcaudio_shutdown ( void )
|
|
{
|
|
/* Shut down the channel */
|
|
ag.intr = NULL;
|
|
ag.in_progress = 0;
|
|
#ifdef PRINT
|
|
printf ( "vidcaudio: stop output\n" );
|
|
#endif
|
|
WriteWord ( IOMD_SD0CURB, ag.silence );
|
|
WriteWord ( IOMD_SD0ENDB, (ag.silence + NBPG - 16) | (1<<30) );
|
|
disable_irq(sound_dma_intr);
|
|
}
|
|
|
|
int vidcaudio_intr ( void *arg )
|
|
{
|
|
int status = ReadByte(IOMD_SD0ST);
|
|
void (*nintr)();
|
|
void *narg;
|
|
void (*xintr)();
|
|
void *xarg;
|
|
int xcur, xend;
|
|
WriteWord ( IOMD_DMARQ, 0x10 );
|
|
|
|
#ifdef PRINT
|
|
printf ( "I" );
|
|
#endif
|
|
|
|
if ( ag.open==0 )
|
|
{
|
|
vidcaudio_shutdown ();
|
|
return 0;
|
|
}
|
|
|
|
/* Have I got the generic audio device attached */
|
|
|
|
#ifdef DEBUG
|
|
printf ( "[B%01x]", status );
|
|
#endif
|
|
|
|
nintr=ag.intr;
|
|
narg=ag.arg;
|
|
ag.intr = NULL;
|
|
|
|
xintr=ag.next_intr;
|
|
xarg=ag.next_arg;
|
|
xcur=ag.next_cur;
|
|
xend=ag.next_end;
|
|
ag.next_cur = 0;
|
|
ag.intr = xintr;
|
|
ag.arg = xarg;
|
|
|
|
if ( nintr )
|
|
{
|
|
#ifdef DEBUG
|
|
printf ( "i" );
|
|
#endif
|
|
(*nintr)(narg);
|
|
}
|
|
|
|
if ( xcur==0 )
|
|
{
|
|
vidcaudio_shutdown ();
|
|
}
|
|
else
|
|
{
|
|
#define OVERRUN (0x04)
|
|
#define INTERRUPT (0x02)
|
|
#define BANK_A (0x00)
|
|
#define BANK_B (0x01)
|
|
switch ( status&0x7 )
|
|
{
|
|
case (INTERRUPT|BANK_A):
|
|
#ifdef PRINT
|
|
printf( "B" );
|
|
#endif
|
|
WriteWord ( IOMD_SD0CURB, xcur );
|
|
WriteWord ( IOMD_SD0ENDB, xend|FLAGS );
|
|
break;
|
|
|
|
case (INTERRUPT|BANK_B):
|
|
#ifdef PRINT
|
|
printf( "A" );
|
|
#endif
|
|
WriteWord ( IOMD_SD0CURA, xcur );
|
|
WriteWord ( IOMD_SD0ENDA, xend|FLAGS );
|
|
break;
|
|
|
|
case (OVERRUN|INTERRUPT|BANK_A):
|
|
#ifdef PRINT
|
|
printf( "A" );
|
|
#endif
|
|
WriteWord ( IOMD_SD0CURA, xcur );
|
|
WriteWord ( IOMD_SD0ENDA, xend|FLAGS );
|
|
break;
|
|
|
|
case (OVERRUN|INTERRUPT|BANK_B):
|
|
#ifdef PRINT
|
|
printf( "B" );
|
|
#endif
|
|
WriteWord ( IOMD_SD0CURB, xcur );
|
|
WriteWord ( IOMD_SD0ENDB, xend|FLAGS );
|
|
break;
|
|
}
|
|
/*
|
|
ag.next_cur = 0;
|
|
ag.intr = xintr;
|
|
ag.arg = xarg;
|
|
*/
|
|
}
|
|
#ifdef PRINT
|
|
printf ( "i" );
|
|
#endif
|
|
|
|
if ( ag.next_cur==0 )
|
|
{
|
|
(*ag.intr)(ag.arg); /* Schedule the next buffer */
|
|
ag.intr = vidcaudio_dummy_routine; /* Already done this */
|
|
ag.arg = NULL;
|
|
}
|
|
return(0); /* Pass interrupt on down the chain */
|
|
}
|
|
|
|
|