NetBSD/sys/arch/sparc/dev/obio.c

407 lines
9.0 KiB
C

/* $NetBSD: obio.c,v 1.6 1994/11/02 04:55:20 deraadt Exp $ */
/*
* Copyright (c) 1993, 1994 Theo de Raadt
* 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.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by Theo de Raadt.
* 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.
*/
#include <sys/param.h>
#include <sys/device.h>
#include <sys/malloc.h>
#ifdef DEBUG
#include <sys/proc.h>
#include <sys/syslog.h>
#endif
#include <vm/vm.h>
#include <machine/autoconf.h>
#include <machine/pmap.h>
#include <machine/oldmon.h>
#include <machine/cpu.h>
#include <machine/ctlreg.h>
#include <sparc/sparc/asm.h>
#include <sparc/sparc/vaddrs.h>
struct bus_softc {
struct device sc_dev; /* base device */
int nothing;
};
/* autoconfiguration driver */
static int busmatch(struct device *, struct cfdata *, void *);
static void obioattach(struct device *, struct device *, void *);
static void vmesattach(struct device *, struct device *, void *);
static void vmelattach(struct device *, struct device *, void *);
struct cfdriver obiocd = { NULL, "obio", busmatch, obioattach,
DV_DULL, sizeof(struct bus_softc)
};
struct cfdriver vmelcd = { NULL, "vmel", busmatch, vmelattach,
DV_DULL, sizeof(struct bus_softc)
};
struct cfdriver vmescd = { NULL, "vmes", busmatch, vmesattach,
DV_DULL, sizeof(struct bus_softc)
};
static void busattach(struct device *, struct device *, void *, int);
void * bus_map __P((void *, int, int));
void * bus_tmp __P((void *, int));
void bus_untmp __P((void));
int
busmatch(parent, cf, aux)
struct device *parent;
struct cfdata *cf;
void *aux;
{
register struct confargs *ca = aux;
register struct romaux *ra = &ca->ca_ra;
if (cputyp != CPU_SUN4)
return (0);
return (strcmp(cf->cf_driver->cd_name, ra->ra_name) == 0);
}
int
busprint(args, obio)
void *args;
char *obio;
{
register struct confargs *ca = args;
if (ca->ca_ra.ra_name == NULL)
ca->ca_ra.ra_name = "<unknown>";
if (obio)
printf("[%s at %s]", ca->ca_ra.ra_name, obio);
printf(" addr %x", ca->ca_ra.ra_paddr);
return (UNCONF);
}
void
busattach(parent, self, args, bustype)
struct device *parent, *self;
void *args;
int bustype;
{
register struct bus_softc *sc = (struct bus_softc *)self;
extern struct cfdata cfdata[];
register struct confargs *ca = args;
struct confargs oca;
register short *p;
struct cfdata *cf;
caddr_t tmp;
if (sc->sc_dev.dv_unit > 0) {
printf(" unsupported\n");
return;
}
printf("\n");
for (cf = cfdata; cf->cf_driver; cf++) {
if (cf->cf_fstate == FSTATE_FOUND)
continue;
for (p = cf->cf_parents; *p >= 0; p++)
if (self->dv_cfdata == &cfdata[*p]) {
oca.ca_ra.ra_iospace = -1;
oca.ca_ra.ra_paddr = (void *)cf->cf_loc[0];
oca.ca_ra.ra_len = 0;
tmp = NULL;
if (oca.ca_ra.ra_paddr)
tmp = bus_tmp(oca.ca_ra.ra_paddr,
bustype);
oca.ca_ra.ra_vaddr = tmp;
oca.ca_ra.ra_intr[0].int_pri = cf->cf_loc[1];
if (bustype == BUS_VME16 || bustype == BUS_VME32)
oca.ca_ra.ra_intr[0].int_vec = cf->cf_loc[2];
else
oca.ca_ra.ra_intr[0].int_vec = 0;
oca.ca_ra.ra_nintr = 1;
oca.ca_ra.ra_name = cf->cf_driver->cd_name;
oca.ca_ra.ra_bp = ca->ca_ra.ra_bp;
oca.ca_bustype = bustype;
if ((*cf->cf_driver->cd_match)(self, cf, &oca) == 0)
continue;
/*
* check if XXmatch routine replaced the
* temporary mapping with a real mapping.
*/
if (tmp == oca.ca_ra.ra_vaddr)
oca.ca_ra.ra_vaddr = NULL;
/*
* or if it has asked us to create a mapping..
* (which won't be seen on future XXmatch calls,
* so not as useful as it seems.)
*/
if (oca.ca_ra.ra_len)
oca.ca_ra.ra_vaddr =
bus_map(oca.ca_ra.ra_paddr,
oca.ca_ra.ra_len, oca.ca_bustype);
config_attach(self, cf, &oca, busprint);
}
}
bus_untmp();
}
void
obioattach(parent, self, args)
struct device *parent, *self;
void *args;
{
busattach(parent, self, args, BUS_OBIO);
}
struct intrhand **vmeints;
void
vmesattach(parent, self, args)
struct device *parent, *self;
void *args;
{
if (vmeints == NULL) {
vmeints = (struct intrhand **)malloc(256 *
sizeof(struct intrhand *), M_TEMP, M_NOWAIT);
bzero(vmeints, 256 * sizeof(struct intrhand *));
}
busattach(parent, self, args, BUS_VME16);
}
void
vmelattach(parent, self, args)
struct device *parent, *self;
void *args;
{
if (vmeints == NULL) {
vmeints = (struct intrhand **)malloc(256 *
sizeof(struct intrhand *), M_TEMP, M_NOWAIT);
bzero(vmeints, 256 * sizeof(struct intrhand *));
}
busattach(parent, self, args, BUS_VME32);
}
int pil_to_vme[] = {
-1, /* pil 0 */
-1, /* pil 1 */
1, /* pil 2 */
2, /* pil 3 */
-1, /* pil 4 */
3, /* pil 5 */
-1, /* pil 6 */
4, /* pil 7 */
-1, /* pil 8 */
5, /* pil 9 */
-1, /* pil 10 */
6, /* pil 11 */
-1, /* pil 12 */
7, /* pil 13 */
-1, /* pil 14 */
-1, /* pil 15 */
};
int
vmeintr(arg)
void *arg;
{
int level = (int)arg, vec;
struct intrhand *ih;
int i = 0;
vec = ldcontrolb(AC_VMEINTVEC | (pil_to_vme[level] << 1) | 1);
if (vec == -1) {
printf("vme: spurious interrupt\n");
return 0;
}
for (ih = vmeints[vec]; ih; ih = ih->ih_next)
if (ih->ih_fun)
i += (ih->ih_fun)(ih->ih_arg);
return (i);
}
void
vmeintr_establish(vec, level, ih)
int vec, level;
struct intrhand *ih;
{
struct intrhand *ihs;
if (vmeints[vec] == NULL)
vmeints[vec] = ih;
else {
for (ihs = vmeints[vec]; ihs->ih_next; ihs = ihs->ih_next)
;
ihs->ih_next = ih;
}
/* ensure the interrupt subsystem will call us at this level */
for (ihs = intrhand[level]; ihs; ihs = ihs->ih_next)
if (ihs->ih_fun == vmeintr)
return;
ihs = (struct intrhand *)malloc(sizeof(struct intrhand),
M_TEMP, M_NOWAIT);
if (ihs == NULL)
panic("vme_addirq");
bzero(ihs, sizeof *ihs);
ihs->ih_fun = vmeintr;
ihs->ih_arg = (void *)level;
intr_establish(level, ihs);
}
#define getpte(va) lda(va, ASI_PTE)
/*
* If we can find a mapping that was established by the rom, use it.
* Else, create a new mapping.
*/
void *
bus_map(pa, len, bustype)
void *pa;
int len;
int bustype;
{
u_long pf = (u_long)pa >> PGSHIFT;
u_long va, pte;
int pgtype;
switch (bt2pmt[bustype]) {
case PMAP_OBIO:
pgtype = PG_OBIO;
break;
case PMAP_VME32:
pgtype = PG_VME32;
break;
case PMAP_VME16:
pgtype = PG_VME16;
break;
}
if (len <= NBPG) {
for (va = OLDMON_STARTVADDR; va < OLDMON_ENDVADDR; va += NBPG) {
pte = getpte(va);
if ((pte & PG_V) != 0 && (pte & PG_TYPE) == pgtype &&
(pte & PG_PFNUM) == pf)
return ((void *)va);
}
}
return mapiodev(pa, len, bustype);
}
void *
bus_tmp(pa, bustype)
void *pa;
int bustype;
{
vm_offset_t addr = (vm_offset_t)pa & ~PGOFSET;
int pmtype = bt2pmt[bustype];
pmap_enter(kernel_pmap, TMPMAP_VA,
addr | pmtype | PMAP_NC,
VM_PROT_READ | VM_PROT_WRITE, 1);
return ((void *)TMPMAP_VA);
}
void
bus_untmp()
{
pmap_remove(kernel_pmap, TMPMAP_VA, TMPMAP_VA+NBPG);
}
void
wzero(b, l)
char *b;
int l;
{
register char *be = b + l;
register short *sp;
if (l <= 0)
return;
/* front, */
if ((u_long)b & 1)
*b++ = 0;
/* back, */
if (b != be && ((u_long)be & 1) != 0) {
be--;
*be = 0;
}
/* and middle. */
sp = (u_short *)b;
while (sp != (u_short *)be)
*sp++ = 0;
}
void
wcopy(b1, b2, l)
u_char *b1, *b2;
u_long l;
{
register u_short *sp;
register int bstore = 0;
register u_char *b1e;
if (l <= 0)
return;
/* front, */
if ((u_long)b1 & 1) {
*b2++ = *b1++;
l--;
}
/* middle, */
sp = (u_short *)b1;
b1e = b1 + l;
if (l & 1)
b1e--;
bstore = (u_long)b2 & 1;
while (sp < (u_short *)b1e) {
if (bstore) {
b2[1] = *sp & 0xff;
b2[0] = *sp >> 8;
} else
*((short *)b2) = *sp;
sp++;
b2 += 2;
}
/* and back. */
if (l & 1)
*b2 = *b1e;
}