527 lines
14 KiB
C
527 lines
14 KiB
C
/* $NetBSD: frodo.c,v 1.23 2005/12/24 20:07:03 perry Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1997, 1998, 1999 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Jason R. Thorpe.
|
|
*
|
|
* 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 the NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 1997 Michael Smith. All rights reserved.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
* Support for the "Frodo" (a.k.a. "Apollo Utility") chip found
|
|
* in HP Apollo 9000/4xx workstations.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: frodo.c,v 1.23 2005/12/24 20:07:03 perry Exp $");
|
|
|
|
#define _HP300_INTR_H_PRIVATE
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/intr.h>
|
|
#include <machine/hp300spu.h>
|
|
|
|
#include <hp300/dev/intiovar.h>
|
|
|
|
#include <hp300/dev/frodoreg.h>
|
|
#include <hp300/dev/frodovar.h>
|
|
|
|
/*
|
|
* Description of a Frodo interrupt handler.
|
|
*/
|
|
struct frodo_interhand {
|
|
int (*ih_fn)(void *);
|
|
void *ih_arg;
|
|
int ih_priority;
|
|
};
|
|
|
|
struct frodo_softc {
|
|
struct device sc_dev; /* generic device glue */
|
|
volatile uint8_t *sc_regs; /* register base */
|
|
struct frodo_interhand sc_intr[FRODO_NINTR]; /* interrupt handlers */
|
|
int sc_ipl;
|
|
void *sc_ih; /* out interrupt cookie */
|
|
int sc_refcnt; /* number of interrupt refs */
|
|
struct bus_space_tag sc_tag; /* bus space tag */
|
|
};
|
|
|
|
static int frodomatch(struct device *, struct cfdata *, void *);
|
|
static void frodoattach(struct device *, struct device *, void *);
|
|
|
|
static int frodoprint(void *, const char *);
|
|
static int frodosubmatch(struct device *, struct cfdata *, const int *, void *);
|
|
|
|
static int frodointr(void *);
|
|
|
|
static void frodo_imask(struct frodo_softc *, uint16_t, uint16_t);
|
|
|
|
CFATTACH_DECL(frodo, sizeof(struct frodo_softc),
|
|
frodomatch, frodoattach, NULL, NULL);
|
|
|
|
static const struct frodo_device frodo_subdevs[] = {
|
|
{ "dnkbd", FRODO_APCI_OFFSET(0), FRODO_INTR_APCI0 },
|
|
{ "com", FRODO_APCI_OFFSET(1), FRODO_INTR_APCI1 },
|
|
{ "com", FRODO_APCI_OFFSET(2), FRODO_INTR_APCI2 },
|
|
{ "com", FRODO_APCI_OFFSET(3), FRODO_INTR_APCI3 },
|
|
{ NULL, 0, 0 },
|
|
};
|
|
|
|
static int
|
|
frodomatch(struct device *parent, struct cfdata *match, void *aux)
|
|
{
|
|
struct intio_attach_args *ia = aux;
|
|
static int frodo_matched = 0;
|
|
|
|
/* only allow one instance */
|
|
if (frodo_matched)
|
|
return (0);
|
|
|
|
if (strcmp(ia->ia_modname, "frodo") != 0)
|
|
return (0);
|
|
|
|
if (badaddr((caddr_t)ia->ia_addr))
|
|
return (0);
|
|
|
|
frodo_matched = 1;
|
|
return (1);
|
|
}
|
|
|
|
static void
|
|
frodoattach(struct device *parent, struct device *self, void *aux)
|
|
{
|
|
struct frodo_softc *sc = (struct frodo_softc *)self;
|
|
struct intio_attach_args *ia = aux;
|
|
bus_space_tag_t bst = &sc->sc_tag;
|
|
const struct frodo_device *fd;
|
|
struct frodo_attach_args fa;
|
|
|
|
sc->sc_regs = (volatile uint8_t *)ia->ia_addr;
|
|
sc->sc_ipl = ia->ia_ipl;
|
|
|
|
if ((FRODO_READ(sc, FRODO_IISR) & FRODO_IISR_SERVICE) == 0)
|
|
printf(": service mode enabled");
|
|
printf("\n");
|
|
|
|
/* Initialize bus_space_tag_t for frodo */
|
|
frodo_init_bus_space(bst);
|
|
|
|
/* Clear all of the interrupt handlers. */
|
|
memset(sc->sc_intr, 0, sizeof(sc->sc_intr));
|
|
sc->sc_refcnt = 0;
|
|
|
|
/*
|
|
* Disable all of the interrupt lines; we reenable them
|
|
* as subdevices attach.
|
|
*/
|
|
frodo_imask(sc, 0, 0xffff);
|
|
|
|
/* Clear any pending interrupts. */
|
|
FRODO_WRITE(sc, FRODO_PIC_PU, 0xff);
|
|
FRODO_WRITE(sc, FRODO_PIC_PL, 0xff);
|
|
|
|
/* Set interrupt polarities. */
|
|
FRODO_WRITE(sc, FRODO_PIO_IPR, 0x10);
|
|
|
|
/* ...and configure for edge triggering. */
|
|
FRODO_WRITE(sc, FRODO_PIO_IELR, 0xcf);
|
|
|
|
/*
|
|
* We defer hooking up our interrupt handler until
|
|
* a subdevice hooks up theirs.
|
|
*/
|
|
sc->sc_ih = NULL;
|
|
|
|
/* ... and attach subdevices. */
|
|
for (fd = frodo_subdevs; fd->fd_name != NULL; fd++) {
|
|
/*
|
|
* Skip the first serial port if we're not a 425e;
|
|
* it's mapped to the DCA at select code 9 on all
|
|
* other models.
|
|
*/
|
|
if (fd->fd_offset == FRODO_APCI_OFFSET(1) &&
|
|
mmuid != MMUID_425_E)
|
|
continue;
|
|
fa.fa_name = fd->fd_name;
|
|
fa.fa_bst = bst;
|
|
fa.fa_base = FRODO_BASE;
|
|
fa.fa_offset = fd->fd_offset;
|
|
fa.fa_line = fd->fd_line;
|
|
config_found_sm_loc(self, "frodo", NULL, &fa, frodoprint,
|
|
frodosubmatch);
|
|
}
|
|
}
|
|
|
|
static int
|
|
frodosubmatch(struct device *parent, struct cfdata *cf,
|
|
const int *ldesc, void *aux)
|
|
{
|
|
struct frodo_attach_args *fa = aux;
|
|
|
|
if (cf->frodocf_offset != FRODO_UNKNOWN_OFFSET &&
|
|
cf->frodocf_offset != fa->fa_offset)
|
|
return (0);
|
|
|
|
return (config_match(parent, cf, aux));
|
|
}
|
|
|
|
static int
|
|
frodoprint(void *aux, const char *pnp)
|
|
{
|
|
struct frodo_attach_args *fa = aux;
|
|
|
|
if (pnp)
|
|
aprint_normal("%s at %s", fa->fa_name, pnp);
|
|
aprint_normal(" offset 0x%x", fa->fa_offset);
|
|
return (UNCONF);
|
|
}
|
|
|
|
void
|
|
frodo_intr_establish(struct device *frdev, int (*func)(void *), void *arg,
|
|
int line, int priority)
|
|
{
|
|
struct frodo_softc *sc = (struct frodo_softc *)frdev;
|
|
struct hp300_intrhand *ih = sc->sc_ih;
|
|
|
|
if (line < 0 || line >= FRODO_NINTR) {
|
|
printf("%s: bad interrupt line %d\n",
|
|
sc->sc_dev.dv_xname, line);
|
|
goto lose;
|
|
}
|
|
if (sc->sc_intr[line].ih_fn != NULL) {
|
|
printf("%s: interrupt line %d already used\n",
|
|
sc->sc_dev.dv_xname, line);
|
|
goto lose;
|
|
}
|
|
|
|
/* Install the handler. */
|
|
sc->sc_intr[line].ih_fn = func;
|
|
sc->sc_intr[line].ih_arg = arg;
|
|
sc->sc_intr[line].ih_priority = priority;
|
|
|
|
/*
|
|
* If this is the first one, establish the frodo
|
|
* interrupt handler. If not, reestablish at a
|
|
* higher priority if necessary.
|
|
*/
|
|
if (ih == NULL || ih->ih_priority < priority) {
|
|
if (ih != NULL)
|
|
intr_disestablish(ih);
|
|
sc->sc_ih = intr_establish(frodointr, sc, sc->sc_ipl, priority);
|
|
}
|
|
|
|
sc->sc_refcnt++;
|
|
|
|
/* Enable the interrupt line. */
|
|
frodo_imask(sc, (1 << line), 0);
|
|
return;
|
|
lose:
|
|
panic("frodo_intr_establish");
|
|
}
|
|
|
|
void
|
|
frodo_intr_disestablish(struct device *frdev, int line)
|
|
{
|
|
struct frodo_softc *sc = (struct frodo_softc *)frdev;
|
|
struct hp300_intrhand *ih = sc->sc_ih;
|
|
int newpri;
|
|
|
|
if (sc->sc_intr[line].ih_fn == NULL) {
|
|
printf("%s: no handler for line %d\n",
|
|
sc->sc_dev.dv_xname, line);
|
|
panic("frodo_intr_disestablish");
|
|
}
|
|
|
|
sc->sc_intr[line].ih_fn = NULL;
|
|
frodo_imask(sc, 0, (1 << line));
|
|
|
|
/* If this was the last, unhook ourselves. */
|
|
if (sc->sc_refcnt-- == 1) {
|
|
intr_disestablish(ih);
|
|
return;
|
|
}
|
|
|
|
/* Lower our priority, if appropriate. */
|
|
for (newpri = 0, line = 0; line < FRODO_NINTR; line++)
|
|
if (sc->sc_intr[line].ih_fn != NULL &&
|
|
sc->sc_intr[line].ih_priority > newpri)
|
|
newpri = sc->sc_intr[line].ih_priority;
|
|
|
|
if (newpri != ih->ih_priority) {
|
|
intr_disestablish(ih);
|
|
sc->sc_ih = intr_establish(frodointr, sc, sc->sc_ipl, newpri);
|
|
}
|
|
}
|
|
|
|
static int
|
|
frodointr(void *arg)
|
|
{
|
|
struct frodo_softc *sc = arg;
|
|
struct frodo_interhand *fih;
|
|
int line, taken = 0;
|
|
|
|
/* Any interrupts pending? */
|
|
if (FRODO_GETPEND(sc) == 0)
|
|
return (0);
|
|
|
|
do {
|
|
/*
|
|
* Get pending interrupt; this also clears it for us.
|
|
*/
|
|
line = FRODO_IPEND(sc);
|
|
fih = &sc->sc_intr[line];
|
|
if (fih->ih_fn == NULL ||
|
|
(*fih->ih_fn)(fih->ih_arg) == 0)
|
|
printf("%s: spurious interrupt on line %d\n",
|
|
sc->sc_dev.dv_xname, line);
|
|
if (taken++ > 100)
|
|
panic("frodointr: looping!");
|
|
} while (FRODO_GETPEND(sc) != 0);
|
|
|
|
return (1);
|
|
}
|
|
|
|
static void
|
|
frodo_imask(struct frodo_softc *sc, uint16_t set, uint16_t clear)
|
|
{
|
|
uint16_t imask;
|
|
|
|
imask = FRODO_GETMASK(sc);
|
|
|
|
imask |= set;
|
|
imask &= ~clear;
|
|
|
|
FRODO_SETMASK(sc, imask);
|
|
}
|
|
|
|
/*
|
|
* frodo chip specific bus_space(9) support functions.
|
|
*/
|
|
static uint8_t frodo_bus_space_read_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t);
|
|
static void frodo_bus_space_write_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, uint8_t);
|
|
|
|
static void frodo_bus_space_read_multi_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, uint8_t *, bus_size_t);
|
|
static void frodo_bus_space_write_multi_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, const uint8_t *, bus_size_t);
|
|
|
|
static void frodo_bus_space_read_region_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, uint8_t *, bus_size_t);
|
|
static void frodo_bus_space_write_region_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, const uint8_t *, bus_size_t);
|
|
|
|
static void frodo_bus_space_set_multi_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, uint8_t, bus_size_t);
|
|
|
|
static void frodo_bus_space_set_region_sparse_1(bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, uint8_t, bus_size_t);
|
|
|
|
/*
|
|
* frodo_init_bus_space():
|
|
* Initialize bus_space functions in bus_space_tag_t
|
|
* for frodo devices which have sparse address space.
|
|
*/
|
|
void
|
|
frodo_init_bus_space(bus_space_tag_t bst)
|
|
{
|
|
|
|
memset(bst, 0, sizeof(struct bus_space_tag));
|
|
bst->bustype = HP300_BUS_SPACE_INTIO;
|
|
|
|
bst->bsr1 = frodo_bus_space_read_sparse_1;
|
|
bst->bsw1 = frodo_bus_space_write_sparse_1;
|
|
|
|
bst->bsrm1 = frodo_bus_space_read_multi_sparse_1;
|
|
bst->bswm1 = frodo_bus_space_write_multi_sparse_1;
|
|
|
|
bst->bsrr1 = frodo_bus_space_read_region_sparse_1;
|
|
bst->bswr1 = frodo_bus_space_write_region_sparse_1;
|
|
|
|
bst->bssm1 = frodo_bus_space_set_multi_sparse_1;
|
|
|
|
bst->bssr1 = frodo_bus_space_set_region_sparse_1;
|
|
}
|
|
|
|
static uint8_t
|
|
frodo_bus_space_read_sparse_1(bus_space_tag_t bst, bus_space_handle_t bsh,
|
|
bus_size_t offset)
|
|
{
|
|
|
|
return *(volatile uint8_t *)(bsh + (offset << 2));
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_write_sparse_1(bus_space_tag_t bst, bus_space_handle_t bsh,
|
|
bus_size_t offset, uint8_t val)
|
|
{
|
|
|
|
*(volatile uint8_t *)(bsh + (offset << 2)) = val;
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_read_multi_sparse_1(bus_space_tag_t bst, bus_space_handle_t bsh,
|
|
bus_size_t offset, uint8_t *addr, bus_size_t len)
|
|
{
|
|
|
|
__asm volatile (
|
|
" movl %0,%%a0 ;\n"
|
|
" movl %1,%%a1 ;\n"
|
|
" movl %2,%%d0 ;\n"
|
|
"1: movb %%a0@,%%a1@+ ;\n"
|
|
" subql #1,%%d0 ;\n"
|
|
" jne 1b"
|
|
:
|
|
: "r" (bsh + (offset << 2)), "g" (addr), "g" (len)
|
|
: "%a0","%a1","%d0");
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_write_multi_sparse_1(bus_space_tag_t bst,
|
|
bus_space_handle_t bsh, bus_size_t offset, const uint8_t *addr,
|
|
bus_size_t len)
|
|
{
|
|
|
|
__asm volatile (
|
|
" movl %0,%%a0 ;\n"
|
|
" movl %1,%%a1 ;\n"
|
|
" movl %2,%%d0 ;\n"
|
|
"1: movb %%a1@+,%%a0@ ;\n"
|
|
" subql #1,%%d0 ;\n"
|
|
" jne 1b"
|
|
:
|
|
: "r" (bsh + (offset << 2)), "g" (addr), "g" (len)
|
|
: "%a0","%a1","%d0");
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_read_region_sparse_1(bus_space_tag_t bst,
|
|
bus_space_handle_t bsh, bus_size_t offset, uint8_t *addr, bus_size_t len)
|
|
{
|
|
__asm volatile (
|
|
" movl %0,%%a0 ;\n"
|
|
" movl %1,%%a1 ;\n"
|
|
" movl %2,%%d0 ;\n"
|
|
"1: movb %%a0@,%%a1@+ ;\n"
|
|
" addql #4,%%a0 ;\n"
|
|
" subql #1,%%d0 ;\n"
|
|
" jne 1b"
|
|
:
|
|
: "r" (bsh + (offset << 2)), "g" (addr), "g" (len)
|
|
: "%a0","%a1","%d0");
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_write_region_sparse_1(bus_space_tag_t bst,
|
|
bus_space_handle_t bsh, bus_size_t offset, const uint8_t *addr,
|
|
bus_size_t len)
|
|
{
|
|
|
|
__asm volatile (
|
|
" movl %0,%%a0 ;\n"
|
|
" movl %1,%%a1 ;\n"
|
|
" movl %2,%%d0 ;\n"
|
|
"1: movb %%a1@+,%%a0@ ;\n"
|
|
" addql #4,%%a0 ;\n"
|
|
" subql #1,%%d0 ;\n"
|
|
" jne 1b"
|
|
:
|
|
: "r" (bsh + (offset << 2)), "g" (addr), "g" (len)
|
|
: "%a0","%a1","%d0");
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_set_multi_sparse_1(bus_space_tag_t bst, bus_space_handle_t bsh,
|
|
bus_size_t offset, uint8_t val, bus_size_t count)
|
|
{
|
|
__asm volatile (
|
|
" movl %0,%%a0 ;\n"
|
|
" movl %1,%%d1 ;\n"
|
|
" movl %2,%%d0 ;\n"
|
|
"1: movb %%d1,%%a0@ ;\n"
|
|
" subql #1,%%d0 ;\n"
|
|
" jne 1b"
|
|
:
|
|
: "r" (bsh + (offset << 2)), "g" (val), "g" (count)
|
|
: "%a0","%d0","%d1");
|
|
}
|
|
|
|
static void
|
|
frodo_bus_space_set_region_sparse_1(bus_space_tag_t bst, bus_space_handle_t bsh,
|
|
bus_size_t offset, uint8_t val, bus_size_t count)
|
|
{
|
|
|
|
__asm volatile (
|
|
" movl %0,%%a0 ;\n"
|
|
" movl %1,%%d1 ;\n"
|
|
" movl %2,%%d0 ;\n"
|
|
"1: movb %%d1,%%a0@ ;\n"
|
|
" addql #4,%%a0 ;\n"
|
|
" subql #1,%%d0 ;\n"
|
|
" jne 1b"
|
|
:
|
|
: "r" (bsh + (offset << 2)), "g" (val), "g" (count)
|
|
: "%a0","%d0","%d1");
|
|
}
|