289 lines
7.0 KiB
C
289 lines
7.0 KiB
C
/* $NetBSD: pcppi.c,v 1.9 2002/10/02 03:10:49 thorpej Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1996 Carnegie-Mellon University.
|
|
* All rights reserved.
|
|
*
|
|
* Author: Chris G. Demetriou
|
|
*
|
|
* Permission to use, copy, modify and distribute this software and
|
|
* its documentation is hereby granted, provided that both the copyright
|
|
* notice and this permission notice appear in all copies of the
|
|
* software, derivative works or modified versions, and any portions
|
|
* thereof, and that both notices appear in supporting documentation.
|
|
*
|
|
* CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
|
|
* CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND
|
|
* FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
|
|
*
|
|
* Carnegie Mellon requests users of this software to return to
|
|
*
|
|
* Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU
|
|
* School of Computer Science
|
|
* Carnegie Mellon University
|
|
* Pittsburgh PA 15213-3890
|
|
*
|
|
* any improvements or extensions that they make and grant Carnegie the
|
|
* rights to redistribute these changes.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: pcppi.c,v 1.9 2002/10/02 03:10:49 thorpej Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/callout.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/device.h>
|
|
#include <sys/errno.h>
|
|
|
|
#include <machine/bus.h>
|
|
|
|
#include <dev/isa/isareg.h>
|
|
#include <dev/isa/isavar.h>
|
|
#include <dev/isa/pcppireg.h>
|
|
#include <dev/isa/pcppivar.h>
|
|
|
|
#include <dev/ic/i8253reg.h>
|
|
|
|
#include "pckbd.h"
|
|
#if NPCKBD > 0
|
|
#include <dev/ic/pckbcvar.h>
|
|
#include <dev/pckbc/pckbdvar.h>
|
|
|
|
void pcppi_pckbd_bell __P((void *, u_int, u_int, u_int, int));
|
|
#endif
|
|
|
|
struct pcppi_softc {
|
|
struct device sc_dv;
|
|
|
|
bus_space_tag_t sc_iot;
|
|
bus_space_handle_t sc_ppi_ioh, sc_pit1_ioh;
|
|
|
|
struct callout sc_bell_ch;
|
|
|
|
int sc_bellactive, sc_bellpitch;
|
|
int sc_slp;
|
|
int sc_timeout;
|
|
};
|
|
|
|
int pcppi_match __P((struct device *, struct cfdata *, void *));
|
|
void pcppi_attach __P((struct device *, struct device *, void *));
|
|
|
|
CFATTACH_DECL(pcppi, sizeof(struct pcppi_softc),
|
|
pcppi_match, pcppi_attach, NULL, NULL);
|
|
|
|
static void pcppi_bell_stop __P((void*));
|
|
|
|
#define PCPPIPRI (PZERO - 1)
|
|
|
|
int
|
|
pcppi_match(parent, match, aux)
|
|
struct device *parent;
|
|
struct cfdata *match;
|
|
void *aux;
|
|
{
|
|
struct isa_attach_args *ia = aux;
|
|
bus_space_handle_t ppi_ioh, pit1_ioh;
|
|
int have_pit1, have_ppi, rv;
|
|
u_int8_t v, nv;
|
|
|
|
if (ISA_DIRECT_CONFIG(ia))
|
|
return (0);
|
|
|
|
/* If values are hardwired to something that they can't be, punt. */
|
|
if (ia->ia_nio < 1 ||
|
|
(ia->ia_io[0].ir_addr != ISACF_PORT_DEFAULT &&
|
|
ia->ia_io[0].ir_addr != IO_PPI))
|
|
return (0);
|
|
|
|
if (ia->ia_niomem > 0 &&
|
|
(ia->ia_iomem[0].ir_addr != ISACF_IOMEM_DEFAULT))
|
|
return (0);
|
|
|
|
if (ia->ia_nirq > 0 &&
|
|
(ia->ia_irq[0].ir_irq != ISACF_IRQ_DEFAULT))
|
|
return (0);
|
|
|
|
if (ia->ia_ndrq > 0 &&
|
|
(ia->ia_drq[0].ir_drq != ISACF_DRQ_DEFAULT))
|
|
return (0);
|
|
|
|
rv = 0;
|
|
have_pit1 = have_ppi = 0;
|
|
|
|
if (bus_space_map(ia->ia_iot, IO_TIMER1, 4, 0, &pit1_ioh))
|
|
goto lose;
|
|
have_pit1 = 1;
|
|
if (bus_space_map(ia->ia_iot, IO_PPI, 1, 0, &ppi_ioh))
|
|
goto lose;
|
|
have_ppi = 1;
|
|
|
|
/*
|
|
* Check for existence of PPI. Realistically, this is either going to
|
|
* be here or nothing is going to be here.
|
|
*
|
|
* We don't want to have any chance of changing speaker output (which
|
|
* this test might, if it crashes in the middle, or something;
|
|
* normally it's be to quick to produce anthing audible), but
|
|
* many "combo chip" mock-PPI's don't seem to support the top bit
|
|
* of Port B as a settable bit. The bottom bit has to be settable,
|
|
* since the speaker driver hardware still uses it.
|
|
*/
|
|
v = bus_space_read_1(ia->ia_iot, ppi_ioh, 0); /* XXX */
|
|
bus_space_write_1(ia->ia_iot, ppi_ioh, 0, v ^ 0x01); /* XXX */
|
|
nv = bus_space_read_1(ia->ia_iot, ppi_ioh, 0); /* XXX */
|
|
if (((nv ^ v) & 0x01) == 0x01)
|
|
rv = 1;
|
|
bus_space_write_1(ia->ia_iot, ppi_ioh, 0, v); /* XXX */
|
|
nv = bus_space_read_1(ia->ia_iot, ppi_ioh, 0); /* XXX */
|
|
if (((nv ^ v) & 0x01) != 0x00) {
|
|
rv = 0;
|
|
goto lose;
|
|
}
|
|
|
|
/*
|
|
* We assume that the programmable interval timer is there.
|
|
*/
|
|
|
|
lose:
|
|
if (have_pit1)
|
|
bus_space_unmap(ia->ia_iot, pit1_ioh, 4);
|
|
if (have_ppi)
|
|
bus_space_unmap(ia->ia_iot, ppi_ioh, 1);
|
|
if (rv) {
|
|
ia->ia_io[0].ir_addr = IO_PPI;
|
|
ia->ia_io[0].ir_size = 1;
|
|
ia->ia_nio = 1;
|
|
|
|
ia->ia_niomem = 0;
|
|
ia->ia_nirq = 0;
|
|
ia->ia_ndrq = 0;
|
|
}
|
|
return (rv);
|
|
}
|
|
|
|
void
|
|
pcppi_attach(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
struct pcppi_softc *sc = (struct pcppi_softc *)self;
|
|
struct isa_attach_args *ia = aux;
|
|
bus_space_tag_t iot;
|
|
struct pcppi_attach_args pa;
|
|
|
|
callout_init(&sc->sc_bell_ch);
|
|
|
|
sc->sc_iot = iot = ia->ia_iot;
|
|
|
|
if (bus_space_map(iot, IO_TIMER1, 4, 0, &sc->sc_pit1_ioh) ||
|
|
bus_space_map(iot, IO_PPI, 1, 0, &sc->sc_ppi_ioh))
|
|
panic("pcppi_attach: couldn't map");
|
|
|
|
printf("\n");
|
|
|
|
sc->sc_bellactive = sc->sc_bellpitch = sc->sc_slp = 0;
|
|
|
|
#if NPCKBD > 0
|
|
/* Provide a beeper for the PC Keyboard, if there isn't one already. */
|
|
pckbd_hookup_bell(pcppi_pckbd_bell, sc);
|
|
#endif
|
|
|
|
pa.pa_cookie = sc;
|
|
while (config_found(self, &pa, 0));
|
|
}
|
|
|
|
void
|
|
pcppi_bell(self, pitch, period, slp)
|
|
pcppi_tag_t self;
|
|
int pitch, period;
|
|
int slp;
|
|
{
|
|
struct pcppi_softc *sc = self;
|
|
int s1, s2;
|
|
|
|
s1 = spltty(); /* ??? */
|
|
if (sc->sc_bellactive) {
|
|
if (sc->sc_timeout) {
|
|
sc->sc_timeout = 0;
|
|
callout_stop(&sc->sc_bell_ch);
|
|
}
|
|
if (sc->sc_slp)
|
|
wakeup(pcppi_bell_stop);
|
|
}
|
|
if (pitch == 0 || period == 0) {
|
|
pcppi_bell_stop(sc);
|
|
sc->sc_bellpitch = 0;
|
|
splx(s1);
|
|
return;
|
|
}
|
|
if (!sc->sc_bellactive || sc->sc_bellpitch != pitch) {
|
|
s2 = splhigh();
|
|
bus_space_write_1(sc->sc_iot, sc->sc_pit1_ioh, TIMER_MODE,
|
|
TIMER_SEL2 | TIMER_16BIT | TIMER_SQWAVE);
|
|
bus_space_write_1(sc->sc_iot, sc->sc_pit1_ioh, TIMER_CNTR2,
|
|
TIMER_DIV(pitch) % 256);
|
|
bus_space_write_1(sc->sc_iot, sc->sc_pit1_ioh, TIMER_CNTR2,
|
|
TIMER_DIV(pitch) / 256);
|
|
splx(s2);
|
|
/* enable speaker */
|
|
bus_space_write_1(sc->sc_iot, sc->sc_ppi_ioh, 0,
|
|
bus_space_read_1(sc->sc_iot, sc->sc_ppi_ioh, 0)
|
|
| PIT_SPKR);
|
|
}
|
|
sc->sc_bellpitch = pitch;
|
|
|
|
sc->sc_bellactive = 1;
|
|
if (slp & PCPPI_BELL_POLL) {
|
|
delay((period * 1000000) / hz);
|
|
pcppi_bell_stop(sc);
|
|
} else {
|
|
sc->sc_timeout = 1;
|
|
callout_reset(&sc->sc_bell_ch, period, pcppi_bell_stop, sc);
|
|
if (slp & PCPPI_BELL_SLEEP) {
|
|
sc->sc_slp = 1;
|
|
tsleep(pcppi_bell_stop, PCPPIPRI | PCATCH, "bell", 0);
|
|
sc->sc_slp = 0;
|
|
}
|
|
}
|
|
splx(s1);
|
|
}
|
|
|
|
static void
|
|
pcppi_bell_stop(arg)
|
|
void *arg;
|
|
{
|
|
struct pcppi_softc *sc = arg;
|
|
int s;
|
|
|
|
s = spltty(); /* ??? */
|
|
sc->sc_timeout = 0;
|
|
|
|
/* disable bell */
|
|
bus_space_write_1(sc->sc_iot, sc->sc_ppi_ioh, 0,
|
|
bus_space_read_1(sc->sc_iot, sc->sc_ppi_ioh, 0)
|
|
& ~PIT_SPKR);
|
|
sc->sc_bellactive = 0;
|
|
if (sc->sc_slp)
|
|
wakeup(pcppi_bell_stop);
|
|
splx(s);
|
|
}
|
|
|
|
#if NPCKBD > 0
|
|
void
|
|
pcppi_pckbd_bell(arg, pitch, period, volume, poll)
|
|
void *arg;
|
|
u_int pitch, period, volume;
|
|
int poll;
|
|
{
|
|
|
|
/*
|
|
* Comes in as ms, goes out at ticks; volume ignored.
|
|
*/
|
|
pcppi_bell(arg, pitch, (period * hz) / 1000,
|
|
poll ? PCPPI_BELL_POLL : 0);
|
|
}
|
|
#endif /* NPCKBD > 0 */
|