Move bus_peek(), bus_mapin() here from autoconf.c so the latter

may be shared with the sun3x port.
1997-02-18 14:57:41 +00:00 · 1997-02-18 14:57:41 +00:00 · 48da5b3d44
commit 48da5b3d44
parent 42ae012452
1 changed files with 201 additions and 0 deletions
--- a/sys/arch/sun3/sun3/bus_subr.c
+++ b/sys/arch/sun3/sun3/bus_subr.c
@ -0,0 +1,201 @@
+/*	$NetBSD: bus_subr.c,v 1.1 1997/02/18 14:57:41 gwr 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/control.h>
+#include <machine/pte.h>
+#include <machine/pmap.h>
+#include <machine/machdep.h>
+#include <machine/mon.h>
+
+
+label_t *nofault;
+
+extern vm_offset_t tmp_vpages[];
+static const int bustype_to_ptetype[4] = {
+	PGT_OBMEM,
+	PGT_OBIO,
+	PGT_VME_D16,
+	PGT_VME_D32,
+};
+
+/*
+ * 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 off, pte, rv;
+	vm_offset_t pgva;
+	caddr_t va;
+
+	if (bustype & ~3)
+		return -1;
+
+	off = paddr & PGOFSET;
+	paddr -= off;
+	pte = PA_PGNUM(paddr);
+	pte |= bustype_to_ptetype[bustype];
+	pte |= (PG_VALID | PG_WRITE | PG_SYSTEM | PG_NC);
+
+	pgva = tmp_vpages[0];
+	va = (caddr_t)pgva + off;
+
+	/* All mappings in tmp_vpages are non-cached, so no flush. */
+	set_pte(pgva, pte);
+
+	/*
+	 * OK, try the access using one of the assembly routines
+	 * that will set pcb_onfault and catch any bus errors.
+	 */
+	switch (sz) {
+	case 1:
+		rv = peek_byte(va);
+		break;
+	case 2:
+		rv = peek_word(va);
+		break;
+	default:
+		printf(" bus_peek: invalid size=%d\n", sz);
+		rv = -1;
+	}
+
+	/* All mappings in tmp_vpages are non-cached, so no flush. */
+	set_pte(pgva, PG_INVAL);
+
+	return rv;
+}
+
+static const int bustype_to_pmaptype[4] = {
+	0,
+	PMAP_OBIO,
+	PMAP_VME16,
+	PMAP_VME32,
+};
+
+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 = bustype_to_pmaptype[bustype];
+	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	/* XXX */
+	/* This has a problem with wrap-around... */
+	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);
+}
+
+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);
+}
+
+/* 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);
+}