412 lines
9.9 KiB
C
412 lines
9.9 KiB
C
/* $NetBSD: beep.c,v 1.23 2001/02/27 20:23:12 reinoud Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1995 Mark Brinicombe
|
|
*
|
|
* 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 Mark Brinicombe.
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
* Simple beep sounds using VIDC
|
|
*
|
|
* Added support for digital serial sound interface with
|
|
* NS LMC1982 for RC7500
|
|
*/
|
|
|
|
/*
|
|
* To use the driver, open /dev/beep and write lines.
|
|
* Each write will generate a beep
|
|
*
|
|
*/
|
|
|
|
#include "opt_cputypes.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/device.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/time.h>
|
|
#include <sys/errno.h>
|
|
|
|
#include <uvm/uvm_extern.h>
|
|
|
|
#include <machine/irqhandler.h>
|
|
#include <machine/katelib.h>
|
|
#include <machine/vidc.h>
|
|
#include <machine/pmap.h>
|
|
#include <machine/beep.h>
|
|
#include <arm/mainbus/mainbus.h>
|
|
#include <arm32/vidc/waveform.h>
|
|
#include <arm32/iomd/iomdreg.h>
|
|
#include <arm32/iomd/iomdvar.h>
|
|
#ifdef RC7500
|
|
#include <arm32/vidc/lmc1982.h>
|
|
#endif
|
|
|
|
#include "beep.h"
|
|
#include "locators.h"
|
|
|
|
struct beep_softc {
|
|
struct device sc_device;
|
|
irqhandler_t sc_ih;
|
|
int sc_iobase;
|
|
int sc_open;
|
|
int sc_count;
|
|
u_int sc_sound_cur0;
|
|
u_int sc_sound_end0;
|
|
u_int sc_sound_cur1;
|
|
u_int sc_sound_end1;
|
|
vm_offset_t sc_buffer0;
|
|
vm_offset_t sc_buffer1;
|
|
};
|
|
|
|
int beepprobe __P((struct device *parent, struct cfdata *cf, void *aux));
|
|
void beepattach __P((struct device *parent, struct device *self, void *aux));
|
|
int beepopen __P((dev_t, int, int, struct proc *));
|
|
int beepclose __P((dev_t, int, int, struct proc *));
|
|
int beepintr __P((void *arg));
|
|
void beepdma __P((struct beep_softc *sc, int buf));
|
|
|
|
static int sdma_channel;
|
|
|
|
struct cfattach beep_ca = {
|
|
sizeof(struct beep_softc), beepprobe, beepattach
|
|
};
|
|
|
|
extern struct cfdriver beep_cd;
|
|
|
|
int
|
|
beepprobe(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
/* struct mainbus_attach_args *mb = aux;*/
|
|
int id;
|
|
|
|
/* Make sure we have an IOMD we understand */
|
|
id = IOMD_ID;
|
|
|
|
/* So far I only know about this IOMD */
|
|
switch (id) {
|
|
#ifdef CPU_ARM7500
|
|
case ARM7500_IOC_ID:
|
|
case ARM7500FE_IOC_ID:
|
|
sdma_channel = IRQ_SDMA;
|
|
return(1);
|
|
#else
|
|
case RPC600_IOMD_ID:
|
|
sdma_channel = IRQ_DMASCH0;
|
|
return(1);
|
|
#endif
|
|
default:
|
|
printf("beep: Unknown IOMD id=%04x\n", id);
|
|
break;
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
|
|
void
|
|
beepattach(parent, self, aux)
|
|
struct device *parent;
|
|
struct device *self;
|
|
void *aux;
|
|
{
|
|
struct beep_softc *sc = (void *)self;
|
|
struct mainbus_attach_args *mb = aux;
|
|
|
|
sc->sc_iobase = mb->mb_iobase;
|
|
sc->sc_open = 0;
|
|
sc->sc_count = 0;
|
|
|
|
sc->sc_buffer0 = uvm_km_zalloc(kernel_map, NBPG);
|
|
if (sc->sc_buffer0 == 0)
|
|
panic("beep: Cannot allocate buffer memory\n");
|
|
if ((sc->sc_buffer0 & (NBPG -1)) != 0)
|
|
panic("beep: Cannot allocate page aligned buffer\n");
|
|
sc->sc_buffer1 = sc->sc_buffer0;
|
|
|
|
(void) pmap_extract(kernel_pmap, (vaddr_t)sc->sc_buffer0 & PG_FRAME,
|
|
(paddr_t *)&sc->sc_sound_cur0);
|
|
sc->sc_sound_end0 = (sc->sc_sound_cur0 + NBPG - 16) | 0x00000000;
|
|
(void) pmap_extract(kernel_pmap, (vaddr_t)sc->sc_buffer1 & PG_FRAME,
|
|
(paddr_t *)&sc->sc_sound_cur1);
|
|
sc->sc_sound_end1 = (sc->sc_sound_cur1 + NBPG - 16) | 0x00000000;
|
|
|
|
bcopy(beep_waveform, (void *)sc->sc_buffer0, sizeof(beep_waveform));
|
|
|
|
#ifdef RC7500
|
|
/*
|
|
* Convert 8-bit data in 2's complement. We should really
|
|
* need to convert 8 bits to 16 bits.
|
|
*/
|
|
conv_jap((char *)sc->sc_buffer0, sizeof(beep_waveform));
|
|
#endif
|
|
|
|
/* Reset the sound DMA channel */
|
|
IOMD_WRITE_WORD(IOMD_SD0CURA, sc->sc_sound_cur0);
|
|
IOMD_WRITE_WORD(IOMD_SD0ENDA, sc->sc_sound_end0 | 0xc0000000);
|
|
IOMD_WRITE_WORD(IOMD_SD0CURB, sc->sc_sound_cur1);
|
|
IOMD_WRITE_WORD(IOMD_SD0ENDB, sc->sc_sound_end1 | 0xc0000000);
|
|
|
|
IOMD_WRITE_BYTE(IOMD_SD0CR, 0x90);
|
|
|
|
/* Install an IRQ handler */
|
|
sc->sc_ih.ih_func = beepintr;
|
|
sc->sc_ih.ih_arg = sc;
|
|
sc->sc_ih.ih_level = IPL_AUDIO;
|
|
#ifdef RC7500
|
|
sc->sc_ih.ih_name = "serial snd dma";
|
|
#else
|
|
sc->sc_ih.ih_name = "dma snd ch 0";
|
|
#endif
|
|
|
|
if (irq_claim(sdma_channel, &sc->sc_ih))
|
|
panic("Cannot claim IRQ %d for beep%d\n", sdma_channel, parent->dv_unit);
|
|
|
|
disable_irq(sdma_channel);
|
|
|
|
/* printf(" [ buf0=%08x:%08x->%08x buf1=%08x:%08x->%08x ]",
|
|
(u_int)sc->sc_buffer0, sc->sc_sound_cur0, sc->sc_sound_end0,
|
|
(u_int)sc->sc_buffer1, sc->sc_sound_cur1, sc->sc_sound_end1);*/
|
|
printf("\n");
|
|
|
|
/* Set sample rate to 32us */
|
|
WriteWord(vidc_base, VIDC_SFR | 32);
|
|
/* WriteWord(vidc_base, VIDC_SCR | 0x05);*/
|
|
|
|
#ifndef RC7500
|
|
/* Set the stereo postions to centred for all channels */
|
|
WriteWord(vidc_base, VIDC_SIR0 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR1 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR2 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR3 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR4 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR5 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR6 | SIR_CENTRE);
|
|
WriteWord(vidc_base, VIDC_SIR7 | SIR_CENTRE);
|
|
#endif
|
|
|
|
#ifdef RC7500
|
|
/*
|
|
* Enable serial sound. The digital serial sound interface
|
|
* consists of 16 bits sample on each channel. The waveform
|
|
* data used to generate beep sound is a 8-bits sample. I
|
|
* really don't care, since it's just beep sound.
|
|
*/
|
|
outl(vidc_base, VIDC_SCR | 0x03);
|
|
|
|
/*
|
|
* Video LCD and Serial Sound Mux control. - Japanese format.
|
|
*/
|
|
IOMD_WRITE_BYTE(IOMD_VIDMUX, 0x02);
|
|
|
|
volume_ctl(VINPUTSEL, VIN1);
|
|
volume_ctl(VLOUD, 0);
|
|
volume_ctl(VBASS, VDBM0);
|
|
volume_ctl(VTREB, VDBM0);
|
|
volume_ctl(VLEFT, 24);
|
|
volume_ctl(VRIGHT, 24);
|
|
volume_ctl(VMODE, VSTEREO);
|
|
volume_ctl(VDIN, 0);
|
|
#endif
|
|
}
|
|
|
|
|
|
int
|
|
beepopen(dev, flag, mode, p)
|
|
dev_t dev;
|
|
int flag;
|
|
int mode;
|
|
struct proc *p;
|
|
{
|
|
struct beep_softc *sc;
|
|
int unit = minor(dev);
|
|
int s;
|
|
|
|
if (unit >= beep_cd.cd_ndevs)
|
|
return(ENXIO);
|
|
|
|
sc = beep_cd.cd_devs[unit];
|
|
if (!sc) return(ENXIO);
|
|
|
|
/* HACK hack hack */
|
|
s = splhigh();
|
|
if (sc->sc_open) {
|
|
(void)splx(s);
|
|
return(EBUSY);
|
|
}
|
|
|
|
++sc->sc_open;
|
|
(void)splx(s);
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
int
|
|
beepclose(dev, flag, mode, p)
|
|
dev_t dev;
|
|
int flag;
|
|
int mode;
|
|
struct proc *p;
|
|
{
|
|
int unit = minor(dev);
|
|
struct beep_softc *sc = beep_cd.cd_devs[unit];
|
|
int s;
|
|
|
|
if (sc->sc_open == 0) return(ENXIO);
|
|
|
|
/* HACK hack hack */
|
|
s = splhigh();
|
|
--sc->sc_open;
|
|
(void)splx(s);
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
void
|
|
beep_generate(void)
|
|
{
|
|
struct beep_softc *sc = beep_cd.cd_devs[0];
|
|
/* int status;*/
|
|
|
|
if (sc == NULL) return;
|
|
|
|
if (sc->sc_count > 0) {
|
|
/* printf("beep: active\n");*/
|
|
return;
|
|
}
|
|
/* printf("beep: generate ");*/
|
|
++sc->sc_count;
|
|
|
|
/* status = IOMD_READ_BYTE(IOMD_SD0ST);
|
|
printf("st=%02x\n", status);*/
|
|
IOMD_WRITE_BYTE(IOMD_SD0CR, 0x90);
|
|
IOMD_WRITE_BYTE(IOMD_SD0CR, 0x30);
|
|
beepdma(sc, 0);
|
|
}
|
|
|
|
|
|
int
|
|
beepioctl(dev, cmd, data, flag, p)
|
|
dev_t dev;
|
|
int cmd;
|
|
caddr_t data;
|
|
int flag;
|
|
struct proc *p;
|
|
{
|
|
struct beep_softc *sc = beep_cd.cd_devs[minor(dev)];
|
|
int rate;
|
|
struct wavebuffer *wave = (struct wavebuffer *)data;
|
|
|
|
switch (cmd) {
|
|
case BEEP_GENERATE:
|
|
beep_generate();
|
|
break;
|
|
|
|
case BEEP_SETRATE:
|
|
rate = *(int *)data;
|
|
|
|
if (rate < 3 || rate > 255)
|
|
return(EINVAL);
|
|
|
|
WriteWord(vidc_base, VIDC_SFR | rate);
|
|
break;
|
|
|
|
case BEEP_SET:
|
|
/* printf("set %08x\n", (u_int)data);
|
|
printf("set %08x %08x\n", (u_int)wave->addr, wave->size);*/
|
|
if (wave->size < 16 || wave->size > NBPG)
|
|
return(ENXIO);
|
|
copyin(wave->addr, (char *)sc->sc_buffer0, wave->size);
|
|
sc->sc_sound_end0 = (sc->sc_sound_cur0 + wave->size - 16);
|
|
sc->sc_sound_end1 = (sc->sc_sound_cur1 + wave->size - 16);
|
|
break;
|
|
|
|
default:
|
|
return(ENXIO);
|
|
break;
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
int
|
|
beepintr(arg)
|
|
void *arg;
|
|
{
|
|
struct beep_softc *sc = arg;
|
|
/* IOMD_WRITE_BYTE(IOMD_DMARQ, 0x10);*/
|
|
--sc->sc_count;
|
|
if (sc->sc_count <= 0) {
|
|
IOMD_WRITE_WORD(IOMD_SD0CURB, sc->sc_sound_cur1);
|
|
IOMD_WRITE_WORD(IOMD_SD0ENDB, sc->sc_sound_end1 | (1 << 30));
|
|
disable_irq(sdma_channel);
|
|
/* printf("stop:st=%02x\n", IOMD_READ_BYTE(IOMD_SD0ST));*/
|
|
return(1);
|
|
}
|
|
|
|
beepdma(sc, sc->sc_count & 1);
|
|
return(1); /* Claim the interrupt */
|
|
}
|
|
|
|
|
|
void
|
|
beepdma(sc, buf)
|
|
struct beep_softc *sc;
|
|
int buf;
|
|
{
|
|
int status;
|
|
/* printf("beep:dma %d", buf); */
|
|
status = IOMD_READ_BYTE(IOMD_SD0ST);
|
|
/* printf("st=%02x\n", status);*/
|
|
|
|
if (buf == 0) {
|
|
IOMD_WRITE_WORD(IOMD_SD0CURA, sc->sc_sound_cur0);
|
|
IOMD_WRITE_WORD(IOMD_SD0ENDA, sc->sc_sound_end0);
|
|
IOMD_WRITE_WORD(IOMD_SD0CURB, sc->sc_sound_cur1);
|
|
IOMD_WRITE_WORD(IOMD_SD0ENDB, sc->sc_sound_end1 | (1 << 30));
|
|
}
|
|
|
|
if (buf == 1) {
|
|
IOMD_WRITE_WORD(IOMD_SD0CURB, sc->sc_sound_cur1);
|
|
IOMD_WRITE_WORD(IOMD_SD0ENDB, sc->sc_sound_end1 | (1 << 30));
|
|
}
|
|
|
|
/* status = IOMD_READ_BYTE(IOMD_SD0ST);
|
|
printf("st=%02x\n", status);*/
|
|
|
|
enable_irq(sdma_channel);
|
|
}
|
|
|
|
/* End of beep.c */
|