NetBSD/sys/arch/arm/iomd/beep.c

364 lines
8.8 KiB
C

/* $NetBSD: beep.c,v 1.4 2001/11/27 01:03:52 thorpej 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
*
*/
/*
* To use the driver, open /dev/beep and write lines.
* Each write will generate a beep
*
*/
#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/intr.h>
#include <arm/arm32/katelib.h>
#include <machine/pmap.h>
#include <machine/beep.h>
#include <arm/mainbus/mainbus.h>
#include <arm/iomd/vidc.h>
#include <arm/iomd/waveform.h>
#include <arm/iomd/iomdreg.h>
#include <arm/iomd/iomdvar.h>
#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) {
case ARM7500_IOC_ID:
case ARM7500FE_IOC_ID:
sdma_channel = IRQ_SDMA;
return(1);
case RPC600_IOMD_ID:
sdma_channel = IRQ_DMASCH0;
return(1);
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(pmap_kernel(), (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(pmap_kernel(), (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));
/* 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;
sc->sc_ih.ih_name = "dma snd ch 0";
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);*/
/* 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);
}
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 */