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

/*	$NetBSD: beep.c,v 1.16 2002/10/23 09:10:42 jdolecek 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>

__KERNEL_RCSID(0, "$NetBSD: beep.c,v 1.16 2002/10/23 09:10:42 jdolecek Exp $");

#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/beepvar.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_open;
	int sc_count;
	u_int sc_sound_cur0; 
	u_int sc_sound_end0; 
	u_int sc_sound_cur1; 
	u_int sc_sound_end1; 
	vaddr_t sc_buffer0;
	vaddr_t sc_buffer1;
};

int	beepprobe	(struct device *, struct cfdata *, void *);
void	beepattach	(struct device *, struct device *, void *);
int	beepintr	(void *arg);
void	beepdma		(struct beep_softc *sc, int buf);

static int sdma_channel;

CFATTACH_DECL(beep, sizeof(struct beep_softc),
    beepprobe, beepattach, NULL, NULL);

extern struct cfdriver beep_cd;

dev_type_open(beepopen);
dev_type_close(beepclose);
dev_type_ioctl(beepioctl);

const struct cdevsw beep_cdevsw = {
	beepopen, beepclose, noread, nowrite, beepioctl,
	nostop, notty, nopoll, nommap, nokqfilter,
};

int
beepprobe(struct device *parent, struct cfdata *cf, void *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(struct device *parent, struct device *self, void *aux)
{
	struct beep_softc *sc = (void *)self;
    
	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");
	if ((sc->sc_buffer0 & (NBPG -1)) != 0)
		panic("beep: Cannot allocate page aligned buffer");
	sc->sc_buffer1 = sc->sc_buffer0;

	(void) pmap_extract(pmap_kernel(), (vaddr_t)sc->sc_buffer0,
	    (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,
	    (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",
		    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_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_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_t dev, u_long 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(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(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 */