freebsd-nq/sys/i386/isa/sound/sb16_dsp.c
1997-11-23 07:35:06 +00:00

538 lines
12 KiB
C

/*
* sound/sb16_dsp.c
*
* The low level driver for the SoundBlaster DSP chip.
*
* (C) 1993 J. Schubert (jsb@sth.ruhr-uni-bochum.de)
*
* based on SB-driver by (C) Hannu Savolainen
*
* 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.
*
*/
#define DEB(x)
#define DEB1(x)
#include <i386/isa/sound/sound_config.h>
#include "sb.h"
#include <i386/isa/sound/sb_mixer.h>
#include <i386/isa/sound/sbcard.h>
#if defined(CONFIG_SB16) && (NSB > 0) && defined(CONFIG_AUDIO) && defined(CONFIG_SBPRO)
extern sound_os_info *sb_osp;
extern int sbc_base;
static int sb16_dsp_ok = 0;
static int dsp_16bit = 0;
static int dsp_stereo = 0;
static int dsp_current_speed = 8000;
static int dsp_busy = 0;
static int dma16, dma8;
static int trigger_bits = 0;
static u_long dsp_count = 0;
static int irq_mode = IMODE_NONE;
static int my_dev = 0;
static volatile int intr_active = 0;
static int sb16_dsp_open(int dev, int mode);
static void sb16_dsp_close(int dev);
static void sb16_dsp_output_block(int dev, u_long buf, int count, int intrflag, int dma_restart);
static void sb16_dsp_start_input(int dev, u_long buf, int count, int intrflag, int dma_restart);
static int sb16_dsp_ioctl(int dev, u_int cmd, ioctl_arg arg, int local);
static int sb16_dsp_prepare_for_input(int dev, int bsize, int bcount);
static int sb16_dsp_prepare_for_output(int dev, int bsize, int bcount);
static void sb16_dsp_reset(int dev);
static void sb16_dsp_halt(int dev);
static void sb16_dsp_trigger(int dev, int bits);
static int dsp_set_speed(int);
static int dsp_set_stereo(int);
static void dsp_cleanup(void);
static struct audio_operations sb16_dsp_operations =
{
"SoundBlaster 16",
DMA_AUTOMODE,
AFMT_U8 | AFMT_S16_LE,
NULL,
sb16_dsp_open,
sb16_dsp_close,
sb16_dsp_output_block,
sb16_dsp_start_input,
sb16_dsp_ioctl,
sb16_dsp_prepare_for_input,
sb16_dsp_prepare_for_output,
sb16_dsp_reset,
sb16_dsp_halt,
NULL,
NULL,
NULL,
NULL,
sb16_dsp_trigger
};
static int
sb_dsp_command01(u_char val)
{
int i = 1 << 16;
while (--i & (!inb(DSP_STATUS) & 0x80));
if (!i)
printf("SB16 sb_dsp_command01 Timeout\n");
return sb_dsp_command(val);
}
static int
dsp_set_speed(int mode)
{
DEB(printf("dsp_set_speed(%d)\n", mode));
if (mode) {
RANGE (mode, 5000, 44100);
dsp_current_speed = mode;
}
return mode;
}
static int
dsp_set_stereo(int mode)
{
DEB(printf("dsp_set_stereo(%d)\n", mode));
dsp_stereo = mode;
return mode;
}
static int
dsp_set_bits(int arg)
{
DEB(printf("dsp_set_bits(%d)\n", arg));
if (arg)
dsp_16bit = (arg == 16) ? 1 : 0 ;
return dsp_16bit ? 16 : 8;
}
static int
sb16_dsp_ioctl(int dev, u_int cmd, ioctl_arg arg, int local)
{
switch (cmd) {
case SOUND_PCM_WRITE_RATE:
if (local)
return dsp_set_speed((int) arg);
return *(int *) arg = dsp_set_speed((*(int *) arg));
case SOUND_PCM_READ_RATE:
if (local)
return dsp_current_speed;
return *(int *) arg = dsp_current_speed;
case SNDCTL_DSP_STEREO:
if (local)
return dsp_set_stereo((int) arg);
return *(int *) arg = dsp_set_stereo((*(int *) arg));
case SOUND_PCM_WRITE_CHANNELS:
if (local)
return dsp_set_stereo((int) arg - 1) + 1;
return *(int *) arg = dsp_set_stereo((*(int *) arg) - 1) + 1;
case SOUND_PCM_READ_CHANNELS:
if (local)
return dsp_stereo + 1;
return *(int *) arg = dsp_stereo + 1;
case SNDCTL_DSP_SETFMT:
if (local)
return dsp_set_bits((int) arg);
return *(int *) arg = dsp_set_bits((*(int *) arg));
case SOUND_PCM_READ_BITS:
if (local)
return dsp_16bit ? 16 : 8;
return *(int *) arg = dsp_16bit ? 16 : 8;
case SOUND_PCM_WRITE_FILTER: /* NOT YET IMPLEMENTED */
if ((*(int *) arg) > 1)
return *(int *) arg = -(EINVAL);
case FIOASYNC:
if (local)
return 1;
return *(int *) arg = 1;
case FIONBIO:
if (local)
return 1;
return *(int *) arg = 1;
default:
return -(EINVAL);
}
return -(EINVAL);
}
static int
sb16_dsp_open(int dev, int mode)
{
int retval;
DEB(printf("sb16_dsp_open()\n"));
if (!sb16_dsp_ok) {
printf("SB16 Error: SoundBlaster board not installed\n");
return -(ENXIO);
}
if (intr_active)
return -(EBUSY);
sb_reset_dsp();
irq_mode = IMODE_NONE;
dsp_busy = 1;
trigger_bits = 0;
return 0;
}
static void
sb16_dsp_close(int dev)
{
u_long flags;
DEB(printf("sb16_dsp_close()\n"));
sb_dsp_command01(0xd9);
sb_dsp_command01(0xd5);
flags = splhigh();
audio_devs[dev]->dmachan1 = dma8;
dsp_cleanup();
dsp_busy = 0;
splx(flags);
}
static void
sb16_dsp_output_block(int dev, u_long buf, int count, int intrflag, int dma_restart)
{
u_long flags, cnt;
cnt = count;
if (dsp_16bit)
cnt >>= 1;
cnt--;
if (audio_devs[dev]->flags & DMA_AUTOMODE && intrflag && cnt==dsp_count) {
irq_mode = IMODE_OUTPUT;
intr_active = 1;
return; /* Auto mode on. No need to react */
}
flags = splhigh();
if (dma_restart) {
sb16_dsp_halt(dev);
DMAbuf_start_dma(dev, buf, count, 1);
}
sb_dsp_command(0x41);
sb_dsp_command((u_char) ((dsp_current_speed >> 8) & 0xff));
sb_dsp_command((u_char) (dsp_current_speed & 0xff));
sb_dsp_command((u_char) (dsp_16bit ? 0xb6 : 0xc6));
dsp_count = cnt;
sb_dsp_command((u_char) ((dsp_stereo ? 0x20 : 0) +
(dsp_16bit ? 0x10 : 0)));
sb_dsp_command((u_char) (cnt & 0xff));
sb_dsp_command((u_char) (cnt >> 8));
irq_mode = IMODE_OUTPUT;
intr_active = 1;
splx(flags);
}
static void
sb16_dsp_start_input(int dev, u_long buf, int count, int intrflag, int dma_restart)
{
u_long flags, cnt;
cnt = count;
if (dsp_16bit)
cnt >>= 1;
cnt--;
if (audio_devs[dev]->flags & DMA_AUTOMODE && intrflag && cnt == dsp_count) {
irq_mode = IMODE_INPUT;
intr_active = 1;
return; /* Auto mode on. No need to react */
}
flags = splhigh();
if (dma_restart) {
sb_reset_dsp();
DMAbuf_start_dma(dev, buf, count, 0);
}
sb_dsp_command(0x42);
sb_dsp_command((u_char) ((dsp_current_speed >> 8) & 0xff));
sb_dsp_command((u_char) (dsp_current_speed & 0xff));
sb_dsp_command((u_char) (dsp_16bit ? 0xbe : 0xce));
dsp_count = cnt;
sb_dsp_command((u_char) ((dsp_stereo ? 0x20 : 0) +
(dsp_16bit ? 0x10 : 0)));
sb_dsp_command01((u_char) (cnt & 0xff));
sb_dsp_command((u_char) (cnt >> 8));
irq_mode = IMODE_INPUT;
intr_active = 1;
splx(flags);
}
static int
sb16_dsp_prepare_for_input(int dev, int bsize, int bcount)
{
int fudge;
struct dma_buffparms *dmap = audio_devs[dev]->dmap_in;
audio_devs[my_dev]->dmachan2 = dsp_16bit ? dma16 : dma8;
fudge = audio_devs[my_dev]->dmachan2 ;
if (dmap->dma_chan != fudge ) {
isa_dma_release( dmap->dma_chan);
isa_dma_acquire(fudge);
dmap->dma_chan = fudge;
}
dsp_count = 0;
dsp_cleanup();
if (dsp_16bit)
sb_dsp_command(0xd5); /* Halt DMA until trigger() is called */
else
sb_dsp_command(0xd0); /* Halt DMA until trigger() is called */
trigger_bits = 0;
return 0;
}
static int
sb16_dsp_prepare_for_output(int dev, int bsize, int bcount)
{
int fudge = dsp_16bit ? dma16 : dma8;
struct dma_buffparms *dmap = audio_devs[dev]->dmap_out;
if (dmap->dma_chan != fudge ) {
isa_dma_release( dmap->dma_chan);
isa_dma_acquire(fudge);
dmap->dma_chan = fudge;
}
audio_devs[my_dev]->dmachan1 = fudge;
dsp_count = 0;
dsp_cleanup();
if (dsp_16bit)
sb_dsp_command(0xd5); /* Halt DMA until trigger() is called */
else
sb_dsp_command(0xd0); /* Halt DMA until trigger() is called */
trigger_bits = 0;
return 0;
}
static void
sb16_dsp_trigger(int dev, int bits)
{
if (bits != 0)
bits = 1;
if (bits == trigger_bits) /* No change */
return;
trigger_bits = bits;
if (!bits)
sb_dsp_command(0xd0); /* Halt DMA */
else if (bits & irq_mode)
sb_dsp_command(0xd4); /* Continue DMA */
}
static void
dsp_cleanup(void)
{
irq_mode = IMODE_NONE;
intr_active = 0;
}
static void
sb16_dsp_reset(int dev)
{
u_long flags;
flags = splhigh();
sb_reset_dsp();
dsp_cleanup();
splx(flags);
}
static void
sb16_dsp_halt(int dev)
{
if (dsp_16bit) {
sb_dsp_command01(0xd9);
sb_dsp_command01(0xd5);
} else {
sb_dsp_command01(0xda);
sb_dsp_command01(0xd0);
}
}
static void
set_irq_hw(int level)
{
int ival;
switch (level) {
case 5:
ival = 2;
break;
case 7:
ival = 4;
break;
case 9:
ival = 1;
break;
case 10:
ival = 8;
break;
default:
printf("SB16_IRQ_LEVEL %d does not exist\n", level);
return;
}
sb_setmixer(IRQ_NR, ival);
}
void
sb16_dsp_init(struct address_info * hw_config)
{
if (sbc_major < 4)
return; /* Not a SB16 */
sprintf(sb16_dsp_operations.name, "SoundBlaster 16 %d.%d",
sbc_major, sbc_minor);
conf_printf(sb16_dsp_operations.name, hw_config);
if (num_audiodevs < MAX_AUDIO_DEV) {
audio_devs[my_dev = num_audiodevs++] = &sb16_dsp_operations;
audio_devs[my_dev]->dmachan1 = dma8;
audio_devs[my_dev]->buffsize = DSP_BUFFSIZE;
} else
printf("SB: Too many DSP devices available\n");
sb16_dsp_ok = 1;
return;
}
int
sb16_dsp_detect(struct address_info * hw_config)
{
struct address_info *sb_config;
if (sb16_dsp_ok)
return 1; /* Can't drive two cards */
if (!(sb_config = sound_getconf(SNDCARD_SB))) {
printf("SB16 Error: Plain SB not configured\n");
return 0;
}
/*
* sb_setmixer(OPSW,0xf); if(sb_getmixer(OPSW)!=0xf) return 0;
*/
if (!sb_reset_dsp())
return 0;
if (sbc_major < 4) /* Set by the plain SB driver */
return 0; /* Not a SB16 */
if (hw_config->dma < 4)
if (hw_config->dma != sb_config->dma) {
printf("SB16 Error: Invalid DMA channel %d/%d\n",
sb_config->dma, hw_config->dma);
return 0;
}
dma16 = hw_config->dma;
dma8 = sb_config->dma;
/* hw_config->irq = 0; sb_config->irq;
hw_config->io_base = sb_config->io_base;
*/
set_irq_hw(sb_config->irq);
sb_setmixer(DMA_NR, (1 << hw_config->dma) | (1 << sb_config->dma));
DEB(printf("SoundBlaster 16: IRQ %d DMA %d OK\n",
sb_config->irq, hw_config->dma));
/*
* dsp_showmessage(0xe3,99);
*/
sb16_dsp_ok = 1;
return 1;
}
void
sb16_dsp_interrupt(int unused)
{
int data;
data = inb(DSP_DATA_AVL16); /* Interrupt acknowledge */
if (intr_active)
switch (irq_mode) {
case IMODE_OUTPUT:
DMAbuf_outputintr(my_dev, 1);
break;
case IMODE_INPUT:
DMAbuf_inputintr(my_dev);
break;
default:
printf("SoundBlaster: Unexpected interrupt\n");
}
}
#endif