294 lines
6.9 KiB
C
294 lines
6.9 KiB
C
/* $NetBSD: bus_subr.c,v 1.8 1997/06/10 19:36:53 veego Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1996 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Adam Glass and Gordon W. Ross.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
* bus_xxx support functions
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <vm/vm.h>
|
|
#include <vm/vm_kern.h>
|
|
#include <vm/vm_map.h>
|
|
|
|
#include <machine/autoconf.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/pte.h>
|
|
#include <machine/pmap.h>
|
|
#include <machine/machdep.h>
|
|
#include <machine/mon.h>
|
|
|
|
/*
|
|
* bus_scan:
|
|
* This function is passed to config_search() by the attach function
|
|
* for each of the "bus" drivers (obctl, obio, obmem, vmes, vmel).
|
|
* The purpose of this function is to copy the "locators" into our
|
|
* confargs structure, so child drivers may use the confargs both
|
|
* as match parameters and as temporary storage for the defaulted
|
|
* locator values determined in the child_match and preserved for
|
|
* the child_attach function. If the bus attach functions just
|
|
* used config_found, then we would not have an opportunity to
|
|
* setup the confargs for each child match and attach call.
|
|
*/
|
|
int bus_scan(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
struct confargs *ca = aux;
|
|
cfmatch_t mf;
|
|
|
|
#ifdef DIAGNOSTIC
|
|
if (cf->cf_fstate == FSTATE_STAR)
|
|
panic("bus_scan: FSTATE_STAR");
|
|
#endif
|
|
|
|
/*
|
|
* Copy the locators into our confargs.
|
|
* Our parent set ca->ca_bustype already.
|
|
*/
|
|
ca->ca_paddr = cf->cf_paddr;
|
|
ca->ca_intpri = cf->cf_intpri;
|
|
ca->ca_intvec = cf->cf_intvec;
|
|
|
|
/*
|
|
* Note that this allows the match function to save
|
|
* defaulted locators in the confargs that will be
|
|
* preserved for the related attach call.
|
|
* XXX - This is a hack...
|
|
*/
|
|
mf = cf->cf_attach->ca_match;
|
|
if ((*mf)(parent, cf, ca) > 0) {
|
|
config_attach(parent, cf, ca, bus_print);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* bus_print:
|
|
* Just print out the final (non-default) locators.
|
|
* The parent name is non-NULL when there was no match
|
|
* found by config_found().
|
|
*/
|
|
int
|
|
bus_print(args, name)
|
|
void *args;
|
|
const char *name;
|
|
{
|
|
struct confargs *ca = args;
|
|
|
|
if (name)
|
|
printf("%s:", name);
|
|
|
|
if (ca->ca_paddr != -1)
|
|
printf(" addr 0x%x", ca->ca_paddr);
|
|
if (ca->ca_intpri != -1)
|
|
printf(" ipl %d", ca->ca_intpri);
|
|
if (ca->ca_intvec != -1)
|
|
printf(" vect 0x%x", ca->ca_intvec);
|
|
|
|
return(UNCONF);
|
|
}
|
|
|
|
/****************************************************************/
|
|
/* support functions */
|
|
|
|
label_t *nofault;
|
|
|
|
/* These are defined in pmap.c */
|
|
extern vm_offset_t tmp_vpages[];
|
|
extern int tmp_vpages_inuse;
|
|
|
|
static const int bustype_to_patype[4] = {
|
|
0, /* OBMEM */
|
|
0, /* OBIO */
|
|
PMAP_VME16, /* VMED16 */
|
|
PMAP_VME32, /* VMED32 */
|
|
};
|
|
|
|
/*
|
|
* Read addr with size len (1,2,4) into val.
|
|
* If this generates a bus error, return -1
|
|
*
|
|
* Create a temporary mapping,
|
|
* Try the access using peek_*
|
|
* Clean up temp. mapping
|
|
*/
|
|
int
|
|
bus_peek(bustype, paddr, sz)
|
|
int bustype, paddr, sz;
|
|
{
|
|
int offset, rtn, s;
|
|
vm_offset_t va_page;
|
|
caddr_t va;
|
|
|
|
/* XXX - Must fix for VME support... */
|
|
if (bustype != OBIO && bustype != OBMEM)
|
|
return -1;
|
|
|
|
offset = paddr & ~(MMU_PAGE_MASK);
|
|
paddr = m68k_trunc_page(paddr);
|
|
paddr |= bustype_to_patype[bustype];
|
|
paddr |= PMAP_NC;
|
|
|
|
s = splimp();
|
|
if (tmp_vpages_inuse)
|
|
panic("bus_peek: temporary vpages are in use.");
|
|
tmp_vpages_inuse++;
|
|
|
|
va_page = tmp_vpages[1];
|
|
va = (caddr_t) va_page + offset;
|
|
|
|
pmap_enter(pmap_kernel(), va_page, paddr, (VM_PROT_READ|VM_PROT_WRITE),
|
|
TRUE);
|
|
|
|
switch (sz) {
|
|
case 1:
|
|
rtn = peek_byte(va);
|
|
break;
|
|
case 2:
|
|
rtn = peek_word(va);
|
|
break;
|
|
case 4:
|
|
rtn = peek_long(va);
|
|
break;
|
|
default:
|
|
printf(" bus_peek: invalid size=%d\n", sz);
|
|
rtn = -1;
|
|
}
|
|
|
|
pmap_remove(pmap_kernel(), va_page, va_page + NBPG);
|
|
--tmp_vpages_inuse;
|
|
splx(s);
|
|
|
|
return (rtn);
|
|
}
|
|
|
|
|
|
void *
|
|
bus_mapin(bustype, paddr, sz)
|
|
int bustype, paddr, sz;
|
|
{
|
|
int off, pa, pmt;
|
|
vm_offset_t va, retval;
|
|
|
|
if (bustype & ~3)
|
|
return (NULL);
|
|
|
|
off = paddr & PGOFSET;
|
|
pa = paddr - off;
|
|
sz += off;
|
|
sz = round_page(sz);
|
|
|
|
pmt = PMAP_NC; /* non-cached */
|
|
|
|
/* Get some kernel virtual address space. */
|
|
va = kmem_alloc_wait(kernel_map, sz);
|
|
if (va == 0)
|
|
panic("bus_mapin");
|
|
retval = va + off;
|
|
|
|
/* Map it to the specified bus. */
|
|
#if 0
|
|
/* This has a problem with wrap-around... (on the sun3x? -j) */
|
|
pmap_map((int)va, pa | pmt, pa + sz, VM_PROT_ALL);
|
|
#else
|
|
do {
|
|
pmap_enter(pmap_kernel(), va, pa | pmt, VM_PROT_ALL, FALSE);
|
|
va += NBPG;
|
|
pa += NBPG;
|
|
} while ((sz -= NBPG) > 0);
|
|
#endif
|
|
|
|
return ((void*)retval);
|
|
}
|
|
|
|
/* from hp300: badbaddr() */
|
|
int
|
|
peek_byte(addr)
|
|
register caddr_t addr;
|
|
{
|
|
label_t faultbuf;
|
|
register int x;
|
|
|
|
nofault = &faultbuf;
|
|
if (setjmp(&faultbuf)) {
|
|
nofault = NULL;
|
|
return(-1);
|
|
}
|
|
x = *(volatile u_char *)addr;
|
|
nofault = NULL;
|
|
return(x);
|
|
}
|
|
|
|
int
|
|
peek_word(addr)
|
|
register caddr_t addr;
|
|
{
|
|
label_t faultbuf;
|
|
register int x;
|
|
|
|
nofault = &faultbuf;
|
|
if (setjmp(&faultbuf)) {
|
|
nofault = NULL;
|
|
return(-1);
|
|
}
|
|
x = *(volatile u_short *)addr;
|
|
nofault = NULL;
|
|
return(x);
|
|
}
|
|
|
|
int
|
|
peek_long(addr)
|
|
register caddr_t addr;
|
|
{
|
|
label_t faultbuf;
|
|
register int x;
|
|
|
|
nofault = &faultbuf;
|
|
if (setjmp(&faultbuf)) {
|
|
nofault = NULL;
|
|
return(-1);
|
|
}
|
|
x = *(volatile int *)addr;
|
|
nofault = NULL;
|
|
return(x);
|
|
}
|