407 lines
9.0 KiB
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;
|
|
}
|