NetBSD/sys/arch/amiga/dev/aucc.c

/*	$NetBSD: aucc.c,v 1.24 1999/03/04 20:45:01 is Exp $	*/

/*
 * Copyright (c) 1999 Bernardo Innocenti
 * All rights reserved.
 *
 * Copyright (c) 1997 Stephan Thesing
 * All rights reserved.
 *
 * 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 Stephan Thesing.
 * 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.
 */

/* TODO:
 *
 * - ulaw -> 14bit conversion
 * - channel allocation is wrong for 14bit mono
 * - convert the... err... conversion routines to 68k asm for best performance
 * 	XXX: NO. aucc audio is limited by chipmem speed, anyway. You dont 
 *	want to make life difficult for amigappc work.
 *		-is
 *
 * - rely on auconv.c routines for ulaw/alaw conversions
 * - perhaps use a calibration table for better 14bit output
 * - set 31KHz AGA video mode to allow 44.1KHz even if grfcc is missing
 *	in the kernel
 * - 14bit output requires maximum volume
 */

#include "aucc.h"
#if NAUCC > 0

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/errno.h>
#include <sys/ioctl.h>
#include <sys/device.h>
#include <sys/proc.h>
#include <machine/cpu.h>

#include <sys/audioio.h>
#include <dev/audio_if.h>
#include <amiga/amiga/cc.h>
#include <amiga/amiga/custom.h>
#include <amiga/amiga/device.h>
#include <amiga/dev/auccvar.h>


#ifdef LEV6_DEFER
#define AUCC_MAXINT 3
#define AUCC_ALLINTF (INTF_AUD0|INTF_AUD1|INTF_AUD2)
#else
#define AUCC_MAXINT 4
#define AUCC_ALLINTF (INTF_AUD0|INTF_AUD1|INTF_AUD2|INTF_AUD3)
#endif
/* this unconditionally; we may use AUD3 as slave channel with LEV6_DEFER */
#define AUCC_ALLDMAF (DMAF_AUD0|DMAF_AUD1|DMAF_AUD2|DMAF_AUD3)

#ifdef AUDIO_DEBUG
/*extern printf __P((const char *,...));*/
int     auccdebug = 1;
#define DPRINTF(x)      if (auccdebug) printf x
#else
#define DPRINTF(x)
#endif

#ifdef splaudio
#undef splaudio
#endif

#define splaudio() spl4();

/* clock frequency.. */
extern int eclockfreq; 


/* hw audio ch */
extern struct audio_channel channel[4];


/*
 * Software state.
 */
struct aucc_softc {
	struct	device sc_dev;		/* base device */

	int	sc_open;		/* single use device */
	aucc_data_t sc_channel[4];	/* per channel freq, ... */
	u_int	sc_encoding;		/* encoding AUDIO_ENCODING_.*/
	int	sc_channels;		/* # of channels used */
	int	sc_precision;		/* 8 or 16 bits */
	int	sc_14bit;		/* 14bit output enabled */

	int	sc_intrcnt;		/* interrupt count */
	int	sc_channelmask;  	/* which channels are used ? */
	void (*sc_decodefunc) __P((u_char **, u_char *, int));
				/* pointer to format conversion routine */
};

/* interrupt interfaces */
void aucc_inthdl __P((int)); 

/* forward declarations */
static int init_aucc __P((struct aucc_softc *));
static u_int freqtoper  __P((u_int));
static u_int pertofreq  __P((u_int));

/* autoconfiguration driver */
void	auccattach __P((struct device *, struct device *, void *));
int	auccmatch __P((struct device *, struct cfdata *, void *));

struct cfattach aucc_ca = {
	sizeof(struct aucc_softc),
	auccmatch,
	auccattach
};

struct audio_device aucc_device = {
	"Amiga-audio",
	"2.0",
	"aucc"
};


struct aucc_softc *aucc=NULL;


unsigned char ulaw_to_lin[] = {
	0x82, 0x86, 0x8a, 0x8e, 0x92, 0x96, 0x9a, 0x9e,
	0xa2, 0xa6, 0xaa, 0xae, 0xb2, 0xb6, 0xba, 0xbe,
	0xc1, 0xc3, 0xc5, 0xc7, 0xc9, 0xcb, 0xcd, 0xcf,
	0xd1, 0xd3, 0xd5, 0xd7, 0xd9, 0xdb, 0xdd, 0xdf,
	0xe1, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8,
	0xe9, 0xea, 0xeb, 0xec, 0xed, 0xee, 0xef, 0xf0,
	0xf0, 0xf1, 0xf1, 0xf2, 0xf2, 0xf3, 0xf3, 0xf4,
	0xf4, 0xf5, 0xf5, 0xf6, 0xf6, 0xf7, 0xf7, 0xf8,
	0xf8, 0xf8, 0xf9, 0xf9, 0xf9, 0xf9, 0xfa, 0xfa,
	0xfa, 0xfa, 0xfb, 0xfb, 0xfb, 0xfb, 0xfc, 0xfc,
	0xfc, 0xfc, 0xfc, 0xfc, 0xfd, 0xfd, 0xfd, 0xfd,
	0xfd, 0xfd, 0xfd, 0xfd, 0xfe, 0xfe, 0xfe, 0xfe,
	0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe,
	0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
	0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
	0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00,
	0x7d, 0x79, 0x75, 0x71, 0x6d, 0x69, 0x65, 0x61,
	0x5d, 0x59, 0x55, 0x51, 0x4d, 0x49, 0x45, 0x41,
	0x3e, 0x3c, 0x3a, 0x38, 0x36, 0x34, 0x32, 0x30,
	0x2e, 0x2c, 0x2a, 0x28, 0x26, 0x24, 0x22, 0x20,
	0x1e, 0x1d, 0x1c, 0x1b, 0x1a, 0x19, 0x18, 0x17,
	0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0f,
	0x0f, 0x0e, 0x0e, 0x0d, 0x0d, 0x0c, 0x0c, 0x0b,
	0x0b, 0x0a, 0x0a, 0x09, 0x09, 0x08, 0x08, 0x07,
	0x07, 0x07, 0x06, 0x06, 0x06, 0x06, 0x05, 0x05,
	0x05, 0x05, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03,
	0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02,
	0x02, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01,
	0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
};

/*
 * Define our interface to the higher level audio driver.
 */
int	aucc_open __P((void *, int));
void	aucc_close __P((void *));
int	aucc_set_out_sr __P((void *, u_long));
int	aucc_query_encoding __P((void *, struct audio_encoding *));
int	aucc_round_blocksize __P((void *, int));
int	aucc_commit_settings __P((void *));
int	aucc_start_output __P((void *, void *, int, void (*)(void *),
				  void *));
int	aucc_start_input __P((void *, void *, int, void (*)(void *),
				 void *));
int	aucc_halt_output __P((void *));
int	aucc_halt_input __P((void *));
int	aucc_getdev __P((void *, struct audio_device *));
int	aucc_set_port __P((void *, mixer_ctrl_t *));
int	aucc_get_port __P((void *, mixer_ctrl_t *));
int	aucc_query_devinfo __P((void *, mixer_devinfo_t *));
void	aucc_encode __P((int, int, int, int, u_char *, u_short **));
int	aucc_set_params __P((void *, int, int,
	    struct audio_params *, struct audio_params *));
int	aucc_get_props __P((void *));


static void aucc_decode_slinear8_1ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear8_2ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear8_3ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear8_4ch __P((u_char **, u_char *, int));

static void aucc_decode_ulinear8_1ch __P((u_char **, u_char *, int));
static void aucc_decode_ulinear8_2ch __P((u_char **, u_char *, int));
static void aucc_decode_ulinear8_3ch __P((u_char **, u_char *, int));
static void aucc_decode_ulinear8_4ch __P((u_char **, u_char *, int));

static void aucc_decode_ulaw_1ch __P((u_char **, u_char *, int));
static void aucc_decode_ulaw_2ch __P((u_char **, u_char *, int));
static void aucc_decode_ulaw_3ch __P((u_char **, u_char *, int));
static void aucc_decode_ulaw_4ch __P((u_char **, u_char *, int));

static void aucc_decode_slinear16_1ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear16_2ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear16_3ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear16_4ch __P((u_char **, u_char *, int));

static void aucc_decode_slinear16sw_1ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear16sw_2ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear16sw_3ch __P((u_char **, u_char *, int));
static void aucc_decode_slinear16sw_4ch __P((u_char **, u_char *, int));



struct audio_hw_if sa_hw_if = {
	aucc_open,
	aucc_close,
	NULL,
	aucc_query_encoding,
	aucc_set_params,
	aucc_round_blocksize,
	aucc_commit_settings,
	NULL,
	NULL,
	aucc_start_output,
	aucc_start_input,
	aucc_halt_output,
	aucc_halt_input,
	NULL,
	aucc_getdev,
	NULL,
	aucc_set_port,
	aucc_get_port,
	aucc_query_devinfo,
	NULL,
	NULL,
	NULL,
	NULL,
	aucc_get_props,
};

/* autoconfig routines */

int
auccmatch(pdp, cfp, aux)
	struct device *pdp;
	struct cfdata *cfp;
	void *aux;
{
	if (matchname((char *)aux, "aucc") &&
#ifdef DRACO
	    !is_draco() &&
#endif
	    (cfp->cf_unit == 0))
		return 1;

	return 0;
}

/*
 * Audio chip found.
 */
void
auccattach(parent, self, args)
	struct device *parent, *self;
	void *args;
{
	register struct aucc_softc *sc = (struct aucc_softc *)self;
	register int i;

	printf("\n");

	if((i=init_aucc(sc))) {
		printf("audio: no chipmem\n");
		return;
	}

	audio_attach_mi(&sa_hw_if, sc, &sc->sc_dev);
}


static int
init_aucc(sc)
	struct aucc_softc *sc;
{
	register int i, err=0;

	/* init values per channel */
 	for (i=0;i<4;i++) {
		sc->sc_channel[i].nd_freq=8000;
		sc->sc_channel[i].nd_per=freqtoper(8000);
		sc->sc_channel[i].nd_busy=0;
		sc->sc_channel[i].nd_dma=alloc_chipmem(AUDIO_BUF_SIZE*2);
		if (sc->sc_channel[i].nd_dma==NULL)
			err=1;
	 	sc->sc_channel[i].nd_dmalength=0;
		sc->sc_channel[i].nd_volume=64; 
		sc->sc_channel[i].nd_intr=NULL;
		sc->sc_channel[i].nd_intrdata=NULL;
		sc->sc_channel[i].nd_doublebuf=0;
		DPRINTF(("dma buffer for channel %d is %p\n", i,
		    sc->sc_channel[i].nd_dma));
	}

	if (err) {
		for(i=0;i<4;i++)
			if (sc->sc_channel[i].nd_dma)
				free_chipmem(sc->sc_channel[i].nd_dma);
	}

	sc->sc_channels=1;
	sc->sc_channelmask=0xf;
	sc->sc_precision=8;
	sc->sc_14bit = 0;
	sc->sc_encoding=AUDIO_ENCODING_ULAW;
	sc->sc_decodefunc = aucc_decode_ulaw_1ch;

	/* clear interrupts and dma: */
	custom.intena = AUCC_ALLINTF;
	custom.dmacon = AUCC_ALLDMAF;

	return err;
}

int
aucc_open(addr, flags)
	void *addr;
	int flags;
{
	struct aucc_softc *sc = addr;
	int i;

	DPRINTF(("sa_open: unit %p\n",sc));

	if (sc->sc_open)
		return (EBUSY);
	sc->sc_open = 1;
	for (i=0;i<AUCC_MAXINT;i++) {
		sc->sc_channel[i].nd_intr=NULL;
		sc->sc_channel[i].nd_intrdata=NULL;
	}
	aucc=sc;
	sc->sc_channelmask=0xf;

	DPRINTF(("saopen: ok -> sc=0x%p\n",sc));

	return (0);
}

void
aucc_close(addr)
	void *addr;
{
	register struct aucc_softc *sc = addr;

	DPRINTF(("sa_close: sc=0x%p\n", sc));
	/*
	 * halt i/o, clear open flag, and done.
	 */
	aucc_halt_output(sc);
	sc->sc_open = 0;

	DPRINTF(("sa_close: closed.\n"));
}

int
aucc_set_out_sr(addr, sr)
	void *addr;
	u_long sr;
{
	struct aucc_softc *sc=addr;
	u_long per;
	register int i;

	per=freqtoper(sr);
	if (per>0xffff)
		return EINVAL;
	sr=pertofreq(per);

	for (i=0;i<4;i++) {
		sc->sc_channel[i].nd_freq=sr;
		sc->sc_channel[i].nd_per=per;
	}

	return(0);	
}

int
aucc_query_encoding(addr, fp)
	void *addr;
	struct audio_encoding *fp;
{
	switch (fp->index) {
		case 0:
			strcpy(fp->name, AudioEslinear);
			fp->encoding = AUDIO_ENCODING_SLINEAR;
			fp->precision = 8;
			fp->flags = 0;
			break;
		case 1:
			strcpy(fp->name, AudioEmulaw);
			fp->encoding = AUDIO_ENCODING_ULAW;
			fp->precision = 8;
			fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
			break;
		
		case 2:
			strcpy(fp->name, AudioEulinear);
			fp->encoding = AUDIO_ENCODING_ULINEAR;
			fp->precision = 8;
			fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
			break;

		case 3:
			strcpy(fp->name, AudioEslinear);
			fp->encoding = AUDIO_ENCODING_SLINEAR;
			fp->precision = 16;
			fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
			break;

		case 4:
			strcpy(fp->name, AudioEslinear_be);
			fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
			fp->precision = 16;
			fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
			break;

		case 5:
			strcpy(fp->name, AudioEslinear_le);
			fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
			fp->precision = 16;
			fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
			break;

		default:
			return(EINVAL);
			/*NOTREACHED*/
	}
	return(0);
}

int
aucc_set_params(addr, setmode, usemode, p, r)
	void *addr;
	int setmode, usemode;
	struct  audio_params *p, *r;
{
	struct aucc_softc *sc = addr;

	/* if (setmode & AUMODE_RECORD)
		return 0 ENXIO*/;

#ifdef AUCCDEBUG
	printf("aucc_set_params(setmode 0x%x, usemode 0x%x, "
		"enc %d, bits %d, chn %d, sr %ld)\n", setmode, usemode,
		p->encoding, p->precision, p->channels, p->sample_rate);
#endif

	switch (p->precision) {
	case 8:
		switch (p->encoding) {
		case AUDIO_ENCODING_ULAW:
			switch (p->channels) {
			case 1:
				sc->sc_decodefunc = aucc_decode_ulaw_1ch;
				break;
			case 2:
				sc->sc_decodefunc = aucc_decode_ulaw_2ch;
				break;
			case 3:
				sc->sc_decodefunc = aucc_decode_ulaw_3ch;
				break;
			case 4:
				sc->sc_decodefunc = aucc_decode_ulaw_4ch;
				break;
			default:
				return EINVAL;
			}
			break;

		case AUDIO_ENCODING_SLINEAR:
		case AUDIO_ENCODING_SLINEAR_BE:
		case AUDIO_ENCODING_SLINEAR_LE:
			switch (p->channels) {
			case 1:
				sc->sc_decodefunc = aucc_decode_slinear8_1ch;
				break;
			case 2:
				sc->sc_decodefunc = aucc_decode_slinear8_2ch;
				break;
			case 3:
				sc->sc_decodefunc = aucc_decode_slinear8_3ch;
				break;
			case 4:
				sc->sc_decodefunc = aucc_decode_slinear8_4ch;
				break;
			default:
				return EINVAL;
			}
			break;

		case AUDIO_ENCODING_ULINEAR:
		case AUDIO_ENCODING_ULINEAR_BE:
		case AUDIO_ENCODING_ULINEAR_LE:
			switch (p->channels) {
			case 1:
				sc->sc_decodefunc = aucc_decode_ulinear8_1ch;
				break;
			case 2:
				sc->sc_decodefunc = aucc_decode_ulinear8_2ch;
				break;
			case 3:
				sc->sc_decodefunc = aucc_decode_ulinear8_3ch;
				break;
			case 4:
				sc->sc_decodefunc = aucc_decode_ulinear8_4ch;
				break;
			default:
				return EINVAL;
			}
			break;

		default:
			return EINVAL;
		}
		break;

	case 16:
		switch (p->encoding) {
#if BYTE_ORDER == BIG_ENDIAN
		case AUDIO_ENCODING_SLINEAR:
#endif
		case AUDIO_ENCODING_SLINEAR_BE:
			switch (p->channels) {
			case 1:
				sc->sc_decodefunc = aucc_decode_slinear16_1ch;
				break;

			case 2:
				sc->sc_decodefunc = aucc_decode_slinear16_2ch;
				break;
			case 3:
				sc->sc_decodefunc = aucc_decode_slinear16_3ch;
				break;
			case 4:
				sc->sc_decodefunc = aucc_decode_slinear16_4ch;
				break;
			default:
				return EINVAL;
			}
			break;

#if BYTE_ORDER == LITTLE_ENDIAN
		case AUDIO_ENCODING_SLINEAR:
#endif
		case AUDIO_ENCODING_SLINEAR_LE:
			switch (p->channels) {
			case 1:
				sc->sc_decodefunc = aucc_decode_slinear16sw_1ch;
				break;
			case 2:
				sc->sc_decodefunc = aucc_decode_slinear16sw_2ch;
				break;
			case 3:
				sc->sc_decodefunc = aucc_decode_slinear16sw_3ch;
				break;
			case 4:
				sc->sc_decodefunc = aucc_decode_slinear16sw_4ch;
				break;
			default:
				return EINVAL;
			}
			break;

		default:
			return EINVAL;
		}
		break;

	default:
		return EINVAL;
	}

	sc->sc_encoding = p->encoding;
	sc->sc_precision = p->precision;
	sc->sc_14bit = ((p->precision == 16) && (p->channels <= 2));
	sc->sc_channels = sc->sc_14bit ? (p->channels * 2) : p->channels;

	return aucc_set_out_sr(addr, p->sample_rate);
}

int
aucc_round_blocksize(addr, blk)
	void *addr;
	int blk;
{
	/* round up to even size */
	return blk > AUDIO_BUF_SIZE ? AUDIO_BUF_SIZE : blk;
}

int
aucc_commit_settings(addr)
	void *addr;
{
	register struct aucc_softc *sc = addr;
	register int i;

	DPRINTF(("sa_commit.\n"));

	for (i=0;i<4;i++) {
		custom.aud[i].vol=sc->sc_channel[i].nd_volume;
		custom.aud[i].per=sc->sc_channel[i].nd_per;
	}

	DPRINTF(("commit done\n"));

	return(0);
}

static int masks[4] = {1,3,7,15}; /* masks for n first channels */
static int masks2[4] = {1,2,4,8};

int
aucc_start_output(addr, p, cc, intr, arg)
	void *addr;
	void *p;
	int cc;
	void (*intr) __P((void *));
	void *arg;
{
	struct aucc_softc *sc;
	int mask;
	int i, j, k, len;
	u_char *dmap[4];


	sc = addr;
	mask = sc->sc_channelmask;

	dmap[0] = dmap[1] = dmap[2] = dmap[3] = NULL;

	DPRINTF(("sa_start_output: cc=%d %p (%p)\n", cc, intr, arg));

	if (sc->sc_channels > 1)
		mask &= masks[sc->sc_channels - 1];
		/* we use first sc_channels channels */
	if (mask == 0) /* active and used channels are disjoint */
		return EINVAL;

	for (i=0;i<4;i++) {
		/* channels available ? */
		if ((masks2[i] & mask) && (sc->sc_channel[i].nd_busy))
			return EBUSY; /* channel is busy */
		if (channel[i].isaudio == -1)
			return EBUSY; /* system uses them */
	}

	/* enable interrupt on 1st channel */
	for (i = j = 0; i < AUCC_MAXINT; i++) {
		if (masks2[i] & mask) {
			DPRINTF(("first channel is %d\n",i));
			j=i;
			sc->sc_channel[i].nd_intr=intr;
			sc->sc_channel[i].nd_intrdata=arg;
			break;
		}
	}

	DPRINTF(("dmap is %p %p %p %p, mask=0x%x\n", dmap[0], dmap[1],
		dmap[2], dmap[3], mask));

	/* disable ints, dma for channels, until all parameters set */
	/* XXX dont disable DMA! custom.dmacon=mask;*/
	custom.intreq = mask << INTB_AUD0;
	custom.intena = mask << INTB_AUD0;

	/* copy data to dma buffer */
		
	if (sc->sc_channels == 1) {
		dmap[0] =
		dmap[1] =
		dmap[2] =
		dmap[3] = (u_char *)sc->sc_channel[j].nd_dma;
	}
	else {
		for (k=0; k<4; k++) {
			if (masks2[k+j] & mask)
				dmap[k] = (u_char *)sc->sc_channel[k+j].nd_dma;
		}
	}

	sc->sc_channel[j].nd_doublebuf ^= 1;
	if (sc->sc_channel[j].nd_doublebuf) {
		dmap[0] += AUDIO_BUF_SIZE;
		dmap[1] += AUDIO_BUF_SIZE;
		dmap[2] += AUDIO_BUF_SIZE;
		dmap[3] += AUDIO_BUF_SIZE;
	}

	/* compute output length in bytes per channel.
	 * divide by two only for 16bit->8bit conversion.
	 */
	len = cc / sc->sc_channels;
	if (!sc->sc_14bit && (sc->sc_precision == 16))
		len /= 2;

	/* call audio decoding routine */
	sc->sc_decodefunc (dmap, (u_char *)p, len);

	/* dma buffers: we use same buffer 4 all channels
	 * write dma location and length
	 */
	for (i = k = 0; i < 4; i++) {
		if (masks2[i] & mask) {
			DPRINTF(("turning channel %d on\n",i));
			/* sc->sc_channel[i].nd_busy=1; */
			channel[i].isaudio = 1;
			channel[i].play_count = 1;
			channel[i].handler = NULL;
			custom.aud[i].per = sc->sc_channel[i].nd_per;
			if (sc->sc_14bit && (i > 1))
				custom.aud[i].vol = 1;
			else
				custom.aud[i].vol = sc->sc_channel[i].nd_volume;
			custom.aud[i].lc = PREP_DMA_MEM(dmap[k++]);
			custom.aud[i].len = len / 2;
			sc->sc_channel[i].nd_mask = mask;
			DPRINTF(("per is %d, vol is %d, len is %d\n",\
			    sc->sc_channel[i].nd_per,
			    sc->sc_channel[i].nd_volume, len));
		}
	}

	channel[j].handler=aucc_inthdl;

	/* enable ints */
	custom.intena = INTF_SETCLR | INTF_INTEN | (masks2[j] << INTB_AUD0);

	DPRINTF(("enabled ints: 0x%x\n", (masks2[j] << INTB_AUD0)));

	/* enable dma */
	custom.dmacon = DMAF_SETCLR | DMAF_MASTER | mask;

	DPRINTF(("enabled dma, mask=0x%x\n",mask));

	return(0);
}

/* ARGSUSED */
int
aucc_start_input(addr, p, cc, intr, arg)
	void *addr;
	void *p;
	int cc;
	void (*intr) __P((void *));
	void *arg;
{

	return ENXIO; /* no input */
}

int
aucc_halt_output(addr)
	void *addr;
{
	register struct aucc_softc *sc = addr;
	register int i;

	/* XXX only halt, if input is also halted ?? */
	/* stop dma, etc */
	custom.intena = AUCC_ALLINTF;
	custom.dmacon = AUCC_ALLDMAF;
	/* mark every busy unit idle */
	for (i=0;i<4;i++) {
		sc->sc_channel[i].nd_busy=sc->sc_channel[i].nd_mask=0;
		channel[i].isaudio=0;
		channel[i].play_count=0;
	}

	return(0);
}

int
aucc_halt_input(addr)
	void *addr;
{
	/* no input */

	return ENXIO;
}

int
aucc_getdev(addr, retp)
        void *addr;
        struct audio_device *retp;
{
        *retp = aucc_device;
        return 0;
}

int
aucc_set_port(addr, cp)
	void *addr;
	mixer_ctrl_t *cp;
{
	register struct aucc_softc *sc = addr;
	register int i,j;

	DPRINTF(("aucc_set_port: port=%d", cp->dev));

	switch (cp->type) {
	case AUDIO_MIXER_SET:
		if (cp->dev!=AUCC_CHANNELS)
			return EINVAL;
		i=cp->un.mask;
		if ((i<1) || (i>15))
			return EINVAL;

		sc->sc_channelmask=i;
		break;

	case AUDIO_MIXER_VALUE:
		i=cp->un.value.num_channels;
		if ((i<1) || (i>4))
			return EINVAL;

#ifdef __XXXwhatsthat
		if (cp->dev!=AUCC_VOLUME)
			return EINVAL;
#endif

		/* set volume for channel 0..i-1 */

		/* evil workaround for xanim bug, IMO */
		if ((sc->sc_channels == 1) && (i == 2)) {
			sc->sc_channel[0].nd_volume = 
			    sc->sc_channel[3].nd_volume = 
			    cp->un.value.level[0]>>2;
			sc->sc_channel[1].nd_volume = 
			    sc->sc_channel[2].nd_volume = 
			    cp->un.value.level[1]>>2;
		} else if (i>1) {
			for (j=0;j<i;j++)
	 			sc->sc_channel[j].nd_volume =
				    cp->un.value.level[j]>>2;
		} else if (sc->sc_channels > 1)
			for (j=0; j<sc->sc_channels; j++)
	 			sc->sc_channel[j].nd_volume =
				    cp->un.value.level[0]>>2;
		else
			for (j=0; j<4; j++)
	 			sc->sc_channel[j].nd_volume =
				    cp->un.value.level[0]>>2;
		break;

	default:
		return EINVAL;
		break;
	}
	return 0;
}


int
aucc_get_port(addr, cp)
	void *addr;
	mixer_ctrl_t *cp;
{
	register struct aucc_softc *sc = addr;
	register int i,j;

	DPRINTF(("aucc_get_port: port=%d", cp->dev));

	switch (cp->type) {
	case AUDIO_MIXER_SET:
		if (cp->dev!=AUCC_CHANNELS)
			return EINVAL;
		cp->un.mask=sc->sc_channelmask;
		break;

	case AUDIO_MIXER_VALUE:
		i = cp->un.value.num_channels;
		if ((i<1)||(i>4))
			return EINVAL;

		for (j=0;j<i;j++)
			cp->un.value.level[j] =
			    (sc->sc_channel[j].nd_volume<<2) +
			    (sc->sc_channel[j].nd_volume>>4);
		break;

	default:
		return EINVAL;
	}
	return 0;
}


int
aucc_get_props(addr)
	void *addr;
{
	return 0;
}

int
aucc_query_devinfo(addr, dip)
	void *addr;
	register mixer_devinfo_t *dip;
{
	register int i;

	switch(dip->index) {
	case AUCC_CHANNELS:
		dip->type = AUDIO_MIXER_SET;
		dip->mixer_class = AUCC_OUTPUT_CLASS;
		dip->prev = dip->next = AUDIO_MIXER_LAST;
                strcpy(dip->label.name, AudioNspeaker);
		for (i=0;i<16;i++) {
			sprintf(dip->un.s.member[i].label.name,
			    "channelmask%d", i);
			dip->un.s.member[i].mask = i;
		}
		dip->un.s.num_mem = 16;
		break;

	case AUCC_VOLUME:
		dip->type = AUDIO_MIXER_VALUE;
		dip->mixer_class = AUCC_OUTPUT_CLASS;
		dip->prev = dip->next = AUDIO_MIXER_LAST;
		strcpy(dip->label.name, AudioNmaster);
		dip->un.v.num_channels = 4;
		strcpy(dip->un.v.units.name, AudioNvolume);
		break;

	case AUCC_OUTPUT_CLASS:
		dip->type = AUDIO_MIXER_CLASS;
		dip->mixer_class = AUCC_OUTPUT_CLASS;
		dip->next = dip->prev = AUDIO_MIXER_LAST;
		strcpy(dip->label.name, AudioCoutputs);
		break;

	default:
		return ENXIO;
	}

	DPRINTF(("AUDIO_MIXER_DEVINFO: name=%s\n", dip->label.name));

	return(0);
}


/* audio int handler */
void
aucc_inthdl(int ch)
{
	register int i;
	register int mask=aucc->sc_channel[ch].nd_mask;

	/* for all channels in this maskgroup:
	   disable dma, int 
	   mark idle */
	DPRINTF(("inthandler called, channel %d, mask 0x%x\n",ch,mask));

	custom.intreq=mask<<INTB_AUD0; /* clear request */
	/*
	 * XXX: maybe we can leave ints and/or DMA on,
	 * if another sample has to be played?
	 */
	custom.intena=mask<<INTB_AUD0;
	/*
	 * XXX custom.dmacon=mask; NO!!! 
	 */ 
	for (i=0; i<4; i++) {
		if (masks2[i]&&mask) {
			DPRINTF(("marking channel %d idle\n",i));
			aucc->sc_channel[i].nd_busy=0;
			aucc->sc_channel[i].nd_mask=0;
			channel[i].isaudio=channel[i].play_count=0;
		}
	}

	/* call handler */
	if (aucc->sc_channel[ch].nd_intr) {
		DPRINTF(("calling %p\n",aucc->sc_channel[ch].nd_intr));
		(*(aucc->sc_channel[ch].nd_intr))
		    (aucc->sc_channel[ch].nd_intrdata);
	}
	else
		DPRINTF(("zero int handler\n"));
	DPRINTF(("ints done\n"));
}




/* transform frequency to period, adjust bounds */
static u_int
freqtoper(u_int freq) {
	u_int per=eclockfreq*5/freq;
	
	if (per<124)
		per=124; /* must have at least 124 ticks between samples */

	return per;
}

/* transform period to frequency */
static u_int
pertofreq(u_int per) {
	u_int freq=eclockfreq*5/per;

	return freq;
}

static void aucc_decode_slinear8_1ch (u_char **dmap, u_char *p, int i) {
	memcpy (dmap[0], p, i);
}

static void aucc_decode_slinear8_2ch (u_char **dmap, u_char *p, int i) {
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];

	while (i--) {
		*ch0++ = *p++;
		*ch1++ = *p++;
	}
}

static void aucc_decode_slinear8_3ch (u_char **dmap, u_char *p, int i) {
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];

	while (i--) {
		*ch0++ = *p++;
		*ch1++ = *p++;
		*ch2++ = *p++;
	}
}

static void aucc_decode_slinear8_4ch (u_char **dmap, u_char *p, int i) {
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch0++ = *p++;
		*ch1++ = *p++;
		*ch2++ = *p++;
		*ch3++ = *p++;
	}
}

static void
aucc_decode_ulinear8_1ch (dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];

	while (i--)
		*ch0++ = *p++ - 128;
}

static void
aucc_decode_ulinear8_2ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];

	while (i--) {
		*ch0++ = *p++ - 128;
		*ch1++ = *p++ - 128;
	}
}

static void
aucc_decode_ulinear8_3ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];

	while (i--) {
		*ch0++ = *p++ - 128;
		*ch1++ = *p++ - 128;
		*ch2++ = *p++ - 128;
	}
}

static void
aucc_decode_ulinear8_4ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch0++ = *p++ - 128;
		*ch1++ = *p++ - 128;
		*ch2++ = *p++ - 128;
		*ch3++ = *p++ - 128;
	}
}


static void
aucc_decode_ulaw_1ch (dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];

	while (i--)
		*ch0++ = ulaw_to_lin[*p++];
}

static void
aucc_decode_ulaw_2ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];

	while (i--) {
		*ch0++ = ulaw_to_lin[*p++];
		*ch1++ = ulaw_to_lin[*p++];
	}
}

static void
aucc_decode_ulaw_3ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];

	while (i--) {
		*ch0++ = ulaw_to_lin[*p++];
		*ch1++ = ulaw_to_lin[*p++];
		*ch2++ = ulaw_to_lin[*p++];
	}
}

static void
aucc_decode_ulaw_4ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch0++ = ulaw_to_lin[*p++];
		*ch1++ = ulaw_to_lin[*p++];
		*ch2++ = ulaw_to_lin[*p++];
		*ch3++ = ulaw_to_lin[*p++];
	}
}


/* 14bit output */
static void
aucc_decode_slinear16_1ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch3 = dmap[1]; /* XXX should be 3 */

	while (i--) {
		*ch0++ = *p++;
		*ch3++ = *p++ >> 2;
	}
}

/* 14bit stereo output */
static void
aucc_decode_slinear16_2ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch0++ = *p++;
		*ch3++ = *p++ >> 2;
		*ch1++ = *p++;
		*ch2++ = *p++ >> 2;
	}
}

static void
aucc_decode_slinear16_3ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];

	while (i--) {
		*ch0++ = *p++; p++;
		*ch1++ = *p++; p++;
		*ch2++ = *p++; p++;
	}
}

static void
aucc_decode_slinear16_4ch (dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch0++ = *p++; p++;
		*ch1++ = *p++; p++;
		*ch2++ = *p++; p++;
		*ch3++ = *p++; p++;
	}
}

/* 14bit output, swap bytes */
static void
aucc_decode_slinear16sw_1ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch3++ = *p++ >> 2;
		*ch0++ = *p++;
	}
}

static void
aucc_decode_slinear16sw_2ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		*ch3++ = *p++ >> 2;
		*ch0++ = *p++;
		*ch2++ = *p++ >> 2;
		*ch1++ = *p++;
	}
}

static void
aucc_decode_slinear16sw_3ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];

	while (i--) {
		p++; *ch0++ = *p++;
		p++; *ch1++ = *p++;
		p++; *ch2++ = *p++;
	}
}

static void
aucc_decode_slinear16sw_4ch(dmap, p, i)
	u_char **dmap;
	u_char *p;
	int i;
{
	u_char *ch0 = dmap[0];
	u_char *ch1 = dmap[1];
	u_char *ch2 = dmap[2];
	u_char *ch3 = dmap[3];

	while (i--) {
		p++; *ch0++ = *p++;
		p++; *ch1++ = *p++;
		p++; *ch2++ = *p++;
		p++; *ch3++ = *p++;
	}
}


#endif /* NAUCC > 0 */