1144 lines
27 KiB
C
1144 lines
27 KiB
C
/* $NetBSD: vme_machdep.c,v 1.22 2000/01/11 12:59:47 pk Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1997, 1998 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Paul Kranenburg.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/extent.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/errno.h>
|
|
|
|
#include <sys/proc.h>
|
|
#include <sys/user.h>
|
|
#include <sys/syslog.h>
|
|
|
|
#include <vm/vm.h>
|
|
|
|
#define _SPARC_BUS_DMA_PRIVATE
|
|
#include <machine/bus.h>
|
|
#include <sparc/sparc/iommuvar.h>
|
|
#include <machine/autoconf.h>
|
|
#include <machine/pmap.h>
|
|
#include <machine/oldmon.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/ctlreg.h>
|
|
|
|
#include <dev/vme/vmereg.h>
|
|
#include <dev/vme/vmevar.h>
|
|
|
|
#include <sparc/sparc/asm.h>
|
|
#include <sparc/sparc/vaddrs.h>
|
|
#include <sparc/sparc/cpuvar.h>
|
|
#include <sparc/dev/vmereg.h>
|
|
|
|
struct sparcvme_softc {
|
|
struct device sc_dev; /* base device */
|
|
bus_space_tag_t sc_bustag;
|
|
bus_dma_tag_t sc_dmatag;
|
|
struct vmebusreg *sc_reg; /* VME control registers */
|
|
struct vmebusvec *sc_vec; /* VME interrupt vector */
|
|
struct rom_range *sc_range; /* ROM range property */
|
|
int sc_nrange;
|
|
volatile u_int32_t *sc_ioctags; /* VME IO-cache tag registers */
|
|
volatile u_int32_t *sc_iocflush;/* VME IO-cache flush registers */
|
|
int (*sc_vmeintr) __P((void *));
|
|
};
|
|
struct sparcvme_softc *sparcvme_sc;/*XXX*/
|
|
|
|
/* autoconfiguration driver */
|
|
static int vmematch_iommu __P((struct device *, struct cfdata *, void *));
|
|
static void vmeattach_iommu __P((struct device *, struct device *, void *));
|
|
static int vmematch_mainbus __P((struct device *, struct cfdata *, void *));
|
|
static void vmeattach_mainbus __P((struct device *, struct device *, void *));
|
|
#if defined(SUN4)
|
|
int vmeintr4 __P((void *));
|
|
#endif
|
|
#if defined(SUN4M)
|
|
int vmeintr4m __P((void *));
|
|
static int sparc_vme_error __P((void));
|
|
#endif
|
|
|
|
|
|
static int sparc_vme_probe __P((void *, vme_addr_t, vme_size_t,
|
|
vme_am_t, vme_datasize_t,
|
|
int (*) __P((void *, bus_space_tag_t, bus_space_handle_t)), void *));
|
|
static int sparc_vme_map __P((void *, vme_addr_t, vme_size_t, vme_am_t,
|
|
vme_datasize_t, vme_swap_t,
|
|
bus_space_tag_t *, bus_space_handle_t *,
|
|
vme_mapresc_t *));
|
|
static void sparc_vme_unmap __P((void *, vme_mapresc_t));
|
|
static int sparc_vme_intr_map __P((void *, int, int, vme_intr_handle_t *));
|
|
static void * sparc_vme_intr_establish __P((void *, vme_intr_handle_t, int,
|
|
int (*) __P((void *)), void *));
|
|
static void sparc_vme_intr_disestablish __P((void *, void *));
|
|
|
|
static int vmebus_translate __P((struct sparcvme_softc *, vme_am_t,
|
|
vme_addr_t, bus_type_t *, bus_addr_t *));
|
|
#if defined(SUN4M)
|
|
static void sparc_vme4m_barrier __P(( bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, bus_size_t, int));
|
|
|
|
#endif
|
|
|
|
/*
|
|
* DMA functions.
|
|
*/
|
|
#if defined(SUN4)
|
|
static int sparc_vme4_dmamap_load __P((bus_dma_tag_t, bus_dmamap_t, void *,
|
|
bus_size_t, struct proc *, int));
|
|
static void sparc_vme4_dmamap_unload __P((bus_dma_tag_t, bus_dmamap_t));
|
|
static void sparc_vme4_dmamap_sync __P((bus_dma_tag_t, bus_dmamap_t,
|
|
bus_addr_t, bus_size_t, int));
|
|
|
|
static int sparc_vme4_dmamem_alloc __P((bus_dma_tag_t, bus_size_t,
|
|
bus_size_t, bus_size_t, bus_dma_segment_t *,
|
|
int, int *, int));
|
|
static void sparc_vme4_dmamem_free __P((bus_dma_tag_t,
|
|
bus_dma_segment_t *, int));
|
|
#endif
|
|
|
|
#if defined(SUN4M)
|
|
static int sparc_vme4m_dmamap_create __P((bus_dma_tag_t, bus_size_t, int,
|
|
bus_size_t, bus_size_t, int, bus_dmamap_t *));
|
|
|
|
static int sparc_vme4m_dmamap_load __P((bus_dma_tag_t, bus_dmamap_t, void *,
|
|
bus_size_t, struct proc *, int));
|
|
static void sparc_vme4m_dmamap_unload __P((bus_dma_tag_t, bus_dmamap_t));
|
|
static void sparc_vme4m_dmamap_sync __P((bus_dma_tag_t, bus_dmamap_t,
|
|
bus_addr_t, bus_size_t, int));
|
|
|
|
static int sparc_vme4m_dmamem_alloc __P((bus_dma_tag_t, bus_size_t,
|
|
bus_size_t, bus_size_t, bus_dma_segment_t *,
|
|
int, int *, int));
|
|
static void sparc_vme4m_dmamem_free __P((bus_dma_tag_t,
|
|
bus_dma_segment_t *, int));
|
|
#endif
|
|
|
|
static int sparc_vme_dmamem_map __P((bus_dma_tag_t, bus_dma_segment_t *,
|
|
int, size_t, caddr_t *, int));
|
|
#if 0
|
|
static void sparc_vme_dmamap_destroy __P((bus_dma_tag_t, bus_dmamap_t));
|
|
static void sparc_vme_dmamem_unmap __P((bus_dma_tag_t, caddr_t, size_t));
|
|
static int sparc_vme_dmamem_mmap __P((bus_dma_tag_t,
|
|
bus_dma_segment_t *, int, int, int, int));
|
|
#endif
|
|
|
|
int sparc_vme_mmap_cookie __P((vme_addr_t, vme_am_t, bus_space_handle_t *));
|
|
|
|
struct cfattach vme_mainbus_ca = {
|
|
sizeof(struct sparcvme_softc), vmematch_mainbus, vmeattach_mainbus
|
|
};
|
|
|
|
struct cfattach vme_iommu_ca = {
|
|
sizeof(struct sparcvme_softc), vmematch_iommu, vmeattach_iommu
|
|
};
|
|
|
|
int (*vmeerr_handler) __P((void));
|
|
|
|
#define VMEMOD_D32 0x40 /* ??? */
|
|
|
|
/* If the PROM does not provide the `ranges' property, we make up our own */
|
|
struct rom_range vmebus_translations[] = {
|
|
#define _DS (VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA)
|
|
{ VME_AM_A16|_DS, 0, PMAP_VME16, 0xffff0000, 0 },
|
|
{ VME_AM_A24|_DS, 0, PMAP_VME16, 0xff000000, 0 },
|
|
{ VME_AM_A32|_DS, 0, PMAP_VME16, 0x00000000, 0 },
|
|
{ VME_AM_A16|VMEMOD_D32|_DS, 0, PMAP_VME32, 0xffff0000, 0 },
|
|
{ VME_AM_A24|VMEMOD_D32|_DS, 0, PMAP_VME32, 0xff000000, 0 },
|
|
{ VME_AM_A32|VMEMOD_D32|_DS, 0, PMAP_VME32, 0x00000000, 0 }
|
|
#undef _DS
|
|
};
|
|
|
|
/*
|
|
* DMA on sun4 VME devices use the last MB of virtual space, which
|
|
* is mapped by hardware onto the first MB of VME space.
|
|
*/
|
|
struct extent *vme_dvmamap;
|
|
|
|
struct sparc_bus_space_tag sparc_vme_bus_tag = {
|
|
NULL, /* cookie */
|
|
NULL, /* parent bus tag */
|
|
NULL, /* bus_map */
|
|
NULL, /* bus_unmap */
|
|
NULL, /* bus_subregion */
|
|
NULL /* barrier */
|
|
};
|
|
|
|
struct vme_chipset_tag sparc_vme_chipset_tag = {
|
|
NULL,
|
|
sparc_vme_map,
|
|
sparc_vme_unmap,
|
|
sparc_vme_probe,
|
|
sparc_vme_intr_map,
|
|
sparc_vme_intr_establish,
|
|
sparc_vme_intr_disestablish,
|
|
0, 0, 0 /* bus specific DMA stuff */
|
|
};
|
|
|
|
|
|
#if defined(SUN4)
|
|
struct sparc_bus_dma_tag sparc_vme4_dma_tag = {
|
|
NULL, /* cookie */
|
|
_bus_dmamap_create,
|
|
_bus_dmamap_destroy,
|
|
sparc_vme4_dmamap_load,
|
|
_bus_dmamap_load_mbuf,
|
|
_bus_dmamap_load_uio,
|
|
_bus_dmamap_load_raw,
|
|
sparc_vme4_dmamap_unload,
|
|
sparc_vme4_dmamap_sync,
|
|
|
|
sparc_vme4_dmamem_alloc,
|
|
sparc_vme4_dmamem_free,
|
|
sparc_vme_dmamem_map,
|
|
_bus_dmamem_unmap,
|
|
_bus_dmamem_mmap
|
|
};
|
|
#endif
|
|
|
|
#if defined(SUN4M)
|
|
struct sparc_bus_dma_tag sparc_vme4m_dma_tag = {
|
|
NULL, /* cookie */
|
|
sparc_vme4m_dmamap_create,
|
|
_bus_dmamap_destroy,
|
|
sparc_vme4m_dmamap_load,
|
|
_bus_dmamap_load_mbuf,
|
|
_bus_dmamap_load_uio,
|
|
_bus_dmamap_load_raw,
|
|
sparc_vme4m_dmamap_unload,
|
|
sparc_vme4m_dmamap_sync,
|
|
|
|
sparc_vme4m_dmamem_alloc,
|
|
sparc_vme4m_dmamem_free,
|
|
sparc_vme_dmamem_map,
|
|
_bus_dmamem_unmap,
|
|
_bus_dmamem_mmap
|
|
};
|
|
#endif
|
|
|
|
|
|
int
|
|
vmematch_mainbus(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
struct mainbus_attach_args *ma = aux;
|
|
|
|
if (!CPU_ISSUN4)
|
|
return (0);
|
|
|
|
return (strcmp("vme", ma->ma_name) == 0);
|
|
}
|
|
|
|
int
|
|
vmematch_iommu(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
struct iommu_attach_args *ia = aux;
|
|
|
|
return (strcmp("vme", ia->iom_name) == 0);
|
|
}
|
|
|
|
|
|
void
|
|
vmeattach_mainbus(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
#if defined(SUN4)
|
|
struct mainbus_attach_args *ma = aux;
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)self;
|
|
struct vmebus_attach_args vba;
|
|
|
|
if (self->dv_unit > 0) {
|
|
printf(" unsupported\n");
|
|
return;
|
|
}
|
|
|
|
sc->sc_bustag = ma->ma_bustag;
|
|
sc->sc_dmatag = ma->ma_dmatag;
|
|
|
|
/* VME interrupt entry point */
|
|
sc->sc_vmeintr = vmeintr4;
|
|
|
|
/*XXX*/ sparc_vme_chipset_tag.cookie = self;
|
|
/*XXX*/ sparc_vme4_dma_tag._cookie = self;
|
|
|
|
#if 0
|
|
sparc_vme_bus_tag.parent = ma->ma_bustag;
|
|
vba.vba_bustag = &sparc_vme_bus_tag;
|
|
#endif
|
|
vba.va_vct = &sparc_vme_chipset_tag;
|
|
vba.va_bdt = &sparc_vme4_dma_tag;
|
|
vba.va_slaveconfig = 0;
|
|
|
|
/* Fall back to our own `range' construction */
|
|
sc->sc_range = vmebus_translations;
|
|
sc->sc_nrange =
|
|
sizeof(vmebus_translations)/sizeof(vmebus_translations[0]);
|
|
|
|
vme_dvmamap = extent_create("vmedvma", VME4_DVMA_BASE, VME4_DVMA_END,
|
|
M_DEVBUF, 0, 0, EX_NOWAIT);
|
|
if (vme_dvmamap == NULL)
|
|
panic("vme: unable to allocate DVMA map");
|
|
|
|
printf("\n");
|
|
(void)config_found(self, &vba, 0);
|
|
|
|
#endif
|
|
return;
|
|
}
|
|
|
|
/* sun4m vmebus */
|
|
void
|
|
vmeattach_iommu(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
#if defined(SUN4M)
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)self;
|
|
struct iommu_attach_args *ia = aux;
|
|
struct vmebus_attach_args vba;
|
|
bus_space_handle_t bh;
|
|
int node;
|
|
int cline;
|
|
|
|
if (self->dv_unit > 0) {
|
|
printf(" unsupported\n");
|
|
return;
|
|
}
|
|
|
|
sc->sc_bustag = ia->iom_bustag;
|
|
sc->sc_dmatag = ia->iom_dmatag;
|
|
|
|
/* VME interrupt entry point */
|
|
sc->sc_vmeintr = vmeintr4m;
|
|
|
|
/*XXX*/ sparc_vme_chipset_tag.cookie = self;
|
|
/*XXX*/ sparc_vme4m_dma_tag._cookie = self;
|
|
sparc_vme_bus_tag.sparc_bus_barrier = sparc_vme4m_barrier;
|
|
|
|
#if 0
|
|
vba.vba_bustag = &sparc_vme_bus_tag;
|
|
#endif
|
|
vba.va_vct = &sparc_vme_chipset_tag;
|
|
vba.va_bdt = &sparc_vme4m_dma_tag;
|
|
vba.va_slaveconfig = 0;
|
|
|
|
node = ia->iom_node;
|
|
|
|
/*
|
|
* Map VME control space
|
|
*/
|
|
if (ia->iom_nreg < 2) {
|
|
printf("%s: only %d register sets\n", self->dv_xname,
|
|
ia->iom_nreg);
|
|
return;
|
|
}
|
|
|
|
if (bus_space_map2(ia->iom_bustag,
|
|
(bus_type_t)ia->iom_reg[0].ior_iospace,
|
|
(bus_addr_t)ia->iom_reg[0].ior_pa,
|
|
(bus_size_t)ia->iom_reg[0].ior_size,
|
|
BUS_SPACE_MAP_LINEAR,
|
|
0, &bh) != 0) {
|
|
panic("%s: can't map vmebusreg", self->dv_xname);
|
|
}
|
|
sc->sc_reg = (struct vmebusreg *)bh;
|
|
|
|
if (bus_space_map2(ia->iom_bustag,
|
|
(bus_type_t)ia->iom_reg[1].ior_iospace,
|
|
(bus_addr_t)ia->iom_reg[1].ior_pa,
|
|
(bus_size_t)ia->iom_reg[1].ior_size,
|
|
BUS_SPACE_MAP_LINEAR,
|
|
0, &bh) != 0) {
|
|
panic("%s: can't map vmebusvec", self->dv_xname);
|
|
}
|
|
sc->sc_vec = (struct vmebusvec *)bh;
|
|
|
|
/*
|
|
* Map VME IO cache tags and flush control.
|
|
*/
|
|
if (bus_space_map2(ia->iom_bustag,
|
|
(bus_type_t)ia->iom_reg[1].ior_iospace,
|
|
(bus_addr_t)ia->iom_reg[1].ior_pa + VME_IOC_TAGOFFSET,
|
|
VME_IOC_SIZE,
|
|
BUS_SPACE_MAP_LINEAR,
|
|
0, &bh) != 0) {
|
|
panic("%s: can't map IOC tags", self->dv_xname);
|
|
}
|
|
sc->sc_ioctags = (u_int32_t *)bh;
|
|
|
|
if (bus_space_map2(ia->iom_bustag,
|
|
(bus_type_t)ia->iom_reg[1].ior_iospace,
|
|
(bus_addr_t)ia->iom_reg[1].ior_pa+VME_IOC_FLUSHOFFSET,
|
|
VME_IOC_SIZE,
|
|
BUS_SPACE_MAP_LINEAR,
|
|
0, &bh) != 0) {
|
|
panic("%s: can't map IOC flush registers", self->dv_xname);
|
|
}
|
|
sc->sc_iocflush = (u_int32_t *)bh;
|
|
|
|
/*XXX*/ sparc_vme_bus_tag.cookie = sc->sc_reg;
|
|
|
|
/*
|
|
* Get "range" property.
|
|
*/
|
|
if (getprop(node, "ranges", sizeof(struct rom_range),
|
|
&sc->sc_nrange, (void **)&sc->sc_range) != 0) {
|
|
panic("%s: can't get ranges property", self->dv_xname);
|
|
}
|
|
|
|
sparcvme_sc = sc;
|
|
vmeerr_handler = sparc_vme_error;
|
|
|
|
/*
|
|
* Invalidate all IO-cache entries.
|
|
*/
|
|
for (cline = VME_IOC_SIZE/VME_IOC_LINESZ; cline > 0;) {
|
|
sc->sc_ioctags[--cline] = 0;
|
|
}
|
|
|
|
/* Enable IO-cache */
|
|
sc->sc_reg->vmebus_cr |= VMEBUS_CR_C;
|
|
|
|
printf(": version 0x%x\n",
|
|
sc->sc_reg->vmebus_cr & VMEBUS_CR_IMPL);
|
|
|
|
(void)config_found(self, &vba, 0);
|
|
#endif
|
|
}
|
|
|
|
#if defined(SUN4M)
|
|
static int
|
|
sparc_vme_error()
|
|
{
|
|
struct sparcvme_softc *sc = sparcvme_sc;
|
|
u_int32_t afsr, afpa;
|
|
char bits[64];
|
|
|
|
afsr = sc->sc_reg->vmebus_afsr;
|
|
afpa = sc->sc_reg->vmebus_afar;
|
|
printf("VME error:\n\tAFSR %s\n",
|
|
bitmask_snprintf(afsr, VMEBUS_AFSR_BITS, bits, sizeof(bits)));
|
|
printf("\taddress: 0x%x%x\n", afsr, afpa);
|
|
return (0);
|
|
}
|
|
#endif
|
|
|
|
int
|
|
vmebus_translate(sc, mod, addr, btp, bap)
|
|
struct sparcvme_softc *sc;
|
|
vme_am_t mod;
|
|
vme_addr_t addr;
|
|
bus_type_t *btp;
|
|
bus_addr_t *bap;
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < sc->sc_nrange; i++) {
|
|
|
|
if (sc->sc_range[i].cspace != mod)
|
|
continue;
|
|
|
|
/* We've found the connection to the parent bus */
|
|
*bap = sc->sc_range[i].poffset + addr;
|
|
*btp = sc->sc_range[i].pspace;
|
|
return (0);
|
|
}
|
|
return (ENOENT);
|
|
}
|
|
|
|
struct vmeprobe_myarg {
|
|
int (*cb) __P((void *, bus_space_tag_t, bus_space_handle_t));
|
|
void *cbarg;
|
|
bus_space_tag_t tag;
|
|
int res; /* backwards */
|
|
};
|
|
|
|
static int vmeprobe_mycb __P((void *, void *));
|
|
static int
|
|
vmeprobe_mycb(bh, arg)
|
|
void *bh, *arg;
|
|
{
|
|
struct vmeprobe_myarg *a = arg;
|
|
|
|
a->res = (*a->cb)(a->cbarg, a->tag, (bus_space_handle_t)bh);
|
|
return (!a->res);
|
|
}
|
|
|
|
int
|
|
sparc_vme_probe(cookie, addr, len, mod, datasize, callback, arg)
|
|
void *cookie;
|
|
vme_addr_t addr;
|
|
vme_size_t len;
|
|
vme_am_t mod;
|
|
vme_datasize_t datasize;
|
|
int (*callback) __P((void *, bus_space_tag_t, bus_space_handle_t));
|
|
void *arg;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)cookie;
|
|
bus_type_t iospace;
|
|
bus_addr_t paddr;
|
|
bus_size_t size;
|
|
struct vmeprobe_myarg myarg;
|
|
int res, i;
|
|
|
|
if (vmebus_translate(sc, mod, addr, &iospace, &paddr) != 0)
|
|
return (EINVAL);
|
|
|
|
size = (datasize == VME_D8 ? 1 : (datasize == VME_D16 ? 2 : 4));
|
|
|
|
if (callback) {
|
|
myarg.cb = callback;
|
|
myarg.cbarg = arg;
|
|
myarg.tag = sc->sc_bustag;
|
|
myarg.res = 0;
|
|
res = bus_space_probe(sc->sc_bustag, iospace, paddr, size, 0,
|
|
0, vmeprobe_mycb, &myarg);
|
|
return (res ? 0 : (myarg.res ? myarg.res : EIO));
|
|
}
|
|
|
|
for (i = 0; i < len / size; i++) {
|
|
myarg.res = 0;
|
|
res = bus_space_probe(sc->sc_bustag, iospace, paddr, size, 0,
|
|
0, 0, 0);
|
|
if (res == 0)
|
|
return (EIO);
|
|
paddr += size;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
sparc_vme_map(cookie, addr, size, mod, datasize, swap, tp, hp, rp)
|
|
void *cookie;
|
|
vme_addr_t addr;
|
|
vme_size_t size;
|
|
vme_am_t mod;
|
|
vme_datasize_t datasize;
|
|
bus_space_tag_t *tp;
|
|
bus_space_handle_t *hp;
|
|
vme_mapresc_t *rp;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)cookie;
|
|
bus_type_t iospace;
|
|
bus_addr_t paddr;
|
|
int error;
|
|
|
|
error = vmebus_translate(sc, mod, addr, &iospace, &paddr);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
*tp = sc->sc_bustag;
|
|
return (bus_space_map2(sc->sc_bustag, iospace, paddr, size, 0, 0, hp));
|
|
}
|
|
|
|
int
|
|
sparc_vme_mmap_cookie(addr, mod, hp)
|
|
vme_addr_t addr;
|
|
vme_am_t mod;
|
|
bus_space_handle_t *hp;
|
|
{
|
|
struct sparcvme_softc *sc = sparcvme_sc;
|
|
bus_type_t iospace;
|
|
bus_addr_t paddr;
|
|
int error;
|
|
|
|
error = vmebus_translate(sc, mod, addr, &iospace, &paddr);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
return (bus_space_mmap(sc->sc_bustag, iospace, paddr, 0, hp));
|
|
}
|
|
|
|
#if defined(SUN4M)
|
|
void
|
|
sparc_vme4m_barrier(t, h, offset, size, flags)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t offset;
|
|
bus_size_t size;
|
|
int flags;
|
|
{
|
|
struct vmebusreg *vbp = (struct vmebusreg *)t->cookie;
|
|
|
|
/* Read async fault status to flush write-buffers */
|
|
(*(volatile int *)&vbp->vmebus_afsr);
|
|
}
|
|
#endif
|
|
|
|
|
|
|
|
/*
|
|
* VME Interrupt Priority Level to sparc Processor Interrupt Level.
|
|
*/
|
|
static int vme_ipl_to_pil[] = {
|
|
0,
|
|
2,
|
|
3,
|
|
5,
|
|
7,
|
|
9,
|
|
11,
|
|
13
|
|
};
|
|
|
|
|
|
/*
|
|
* All VME device interrupts go through vmeintr(). This function reads
|
|
* the VME vector from the bus, then dispatches the device interrupt
|
|
* handler. All handlers for devices that map to the same Processor
|
|
* Interrupt Level (according to the table above) are on a linked list
|
|
* of `sparc_vme_intr_handle' structures. The head of which is passed
|
|
* down as the argument to `vmeintr(void *arg)'.
|
|
*/
|
|
struct sparc_vme_intr_handle {
|
|
struct intrhand ih;
|
|
struct sparc_vme_intr_handle *next;
|
|
int vec; /* VME interrupt vector */
|
|
int pri; /* VME interrupt priority */
|
|
struct sparcvme_softc *sc;/*XXX*/
|
|
};
|
|
|
|
#if defined(SUN4)
|
|
int
|
|
vmeintr4(arg)
|
|
void *arg;
|
|
{
|
|
struct sparc_vme_intr_handle *ihp = (vme_intr_handle_t)arg;
|
|
int level, vec;
|
|
int i = 0;
|
|
|
|
level = (ihp->pri << 1) | 1;
|
|
|
|
vec = ldcontrolb((caddr_t)(AC_VMEINTVEC | level));
|
|
|
|
if (vec == -1) {
|
|
printf("vme: spurious interrupt\n");
|
|
return 1; /* XXX - pretend we handled it, for now */
|
|
}
|
|
|
|
for (; ihp; ihp = ihp->next)
|
|
if (ihp->vec == vec && ihp->ih.ih_fun)
|
|
i += (ihp->ih.ih_fun)(ihp->ih.ih_arg);
|
|
return (i);
|
|
}
|
|
#endif
|
|
|
|
#if defined(SUN4M)
|
|
int
|
|
vmeintr4m(arg)
|
|
void *arg;
|
|
{
|
|
struct sparc_vme_intr_handle *ihp = (vme_intr_handle_t)arg;
|
|
int level, vec;
|
|
int i = 0;
|
|
|
|
level = (ihp->pri << 1) | 1;
|
|
|
|
#if 0
|
|
int pending;
|
|
|
|
/* Flush VME <=> Sbus write buffers */
|
|
(*(volatile int *)&ihp->sc->sc_reg->vmebus_afsr);
|
|
|
|
pending = *((int*)ICR_SI_PEND);
|
|
if ((pending & SINTR_VME(ihp->pri)) == 0) {
|
|
printf("vmeintr: non pending at pri %x(p 0x%x)\n",
|
|
ihp->pri, pending);
|
|
return (0);
|
|
}
|
|
#endif
|
|
#if 0
|
|
/* Why gives this a bus timeout sometimes? */
|
|
vec = ihp->sc->sc_vec->vmebusvec[level];
|
|
#else
|
|
/* so, arrange to catch the fault... */
|
|
{
|
|
extern struct user *proc0paddr;
|
|
extern int fkbyte __P((caddr_t, struct pcb *));
|
|
caddr_t addr = (caddr_t)&ihp->sc->sc_vec->vmebusvec[level];
|
|
struct pcb *xpcb;
|
|
u_long saveonfault;
|
|
int s;
|
|
|
|
s = splhigh();
|
|
if (curproc == NULL)
|
|
xpcb = (struct pcb *)proc0paddr;
|
|
else
|
|
xpcb = &curproc->p_addr->u_pcb;
|
|
|
|
saveonfault = (u_long)xpcb->pcb_onfault;
|
|
vec = fkbyte(addr, xpcb);
|
|
xpcb->pcb_onfault = (caddr_t)saveonfault;
|
|
|
|
splx(s);
|
|
}
|
|
#endif
|
|
|
|
if (vec == -1) {
|
|
printf("vme: spurious interrupt: ");
|
|
printf("SI: 0x%x, VME AFSR: 0x%x, VME AFAR 0x%x\n",
|
|
*((int*)ICR_SI_PEND),
|
|
ihp->sc->sc_reg->vmebus_afsr,
|
|
ihp->sc->sc_reg->vmebus_afar);
|
|
return (1); /* XXX - pretend we handled it, for now */
|
|
}
|
|
|
|
for (; ihp; ihp = ihp->next)
|
|
if (ihp->vec == vec && ihp->ih.ih_fun)
|
|
i += (ihp->ih.ih_fun)(ihp->ih.ih_arg);
|
|
return (i);
|
|
}
|
|
#endif
|
|
|
|
int
|
|
sparc_vme_intr_map(cookie, level, vec, ihp)
|
|
void *cookie;
|
|
int level;
|
|
int vec;
|
|
vme_intr_handle_t *ihp;
|
|
{
|
|
struct sparc_vme_intr_handle *ih;
|
|
|
|
ih = (vme_intr_handle_t)
|
|
malloc(sizeof(struct sparc_vme_intr_handle), M_DEVBUF, M_NOWAIT);
|
|
ih->pri = level;
|
|
ih->vec = vec;
|
|
ih->sc = cookie;/*XXX*/
|
|
*ihp = ih;
|
|
return (0);
|
|
}
|
|
|
|
void *
|
|
sparc_vme_intr_establish(cookie, vih, pri, func, arg)
|
|
void *cookie;
|
|
vme_intr_handle_t vih;
|
|
int pri;
|
|
int (*func) __P((void *));
|
|
void *arg;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)cookie;
|
|
struct sparc_vme_intr_handle *svih =
|
|
(struct sparc_vme_intr_handle *)vih;
|
|
struct intrhand *ih;
|
|
int level;
|
|
|
|
/* XXX pri == svih->pri ??? */
|
|
|
|
/* Translate VME priority to processor IPL */
|
|
level = vme_ipl_to_pil[svih->pri];
|
|
|
|
svih->ih.ih_fun = func;
|
|
svih->ih.ih_arg = arg;
|
|
svih->next = NULL;
|
|
|
|
/* ensure the interrupt subsystem will call us at this level */
|
|
for (ih = intrhand[level]; ih != NULL; ih = ih->ih_next)
|
|
if (ih->ih_fun == sc->sc_vmeintr)
|
|
break;
|
|
|
|
if (ih == NULL) {
|
|
ih = (struct intrhand *)
|
|
malloc(sizeof(struct intrhand), M_DEVBUF, M_NOWAIT);
|
|
if (ih == NULL)
|
|
panic("vme_addirq");
|
|
bzero(ih, sizeof *ih);
|
|
ih->ih_fun = sc->sc_vmeintr;
|
|
ih->ih_arg = vih;
|
|
intr_establish(level, ih);
|
|
} else {
|
|
svih->next = (vme_intr_handle_t)ih->ih_arg;
|
|
ih->ih_arg = vih;
|
|
}
|
|
return (NULL);
|
|
}
|
|
|
|
void
|
|
sparc_vme_unmap(cookie, resc)
|
|
void * cookie;
|
|
vme_mapresc_t resc;
|
|
{
|
|
/* Not implemented */
|
|
panic("sparc_vme_unmap");
|
|
}
|
|
|
|
void
|
|
sparc_vme_intr_disestablish(cookie, a)
|
|
void *cookie;
|
|
void *a;
|
|
{
|
|
/* Not implemented */
|
|
panic("sparc_vme_intr_disestablish");
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* VME DMA functions.
|
|
*/
|
|
|
|
#if defined(SUN4)
|
|
int
|
|
sparc_vme4_dmamap_load(t, map, buf, buflen, p, flags)
|
|
bus_dma_tag_t t;
|
|
bus_dmamap_t map;
|
|
void *buf;
|
|
bus_size_t buflen;
|
|
struct proc *p;
|
|
int flags;
|
|
{
|
|
bus_addr_t dvmaddr;
|
|
bus_size_t sgsize;
|
|
vaddr_t vaddr;
|
|
pmap_t pmap;
|
|
int pagesz = PAGE_SIZE;
|
|
int error;
|
|
|
|
error = extent_alloc(vme_dvmamap, round_page(buflen), NBPG,
|
|
map->_dm_boundary,
|
|
(flags & BUS_DMA_NOWAIT) == 0
|
|
? EX_WAITOK
|
|
: EX_NOWAIT,
|
|
(u_long *)&dvmaddr);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
vaddr = (vaddr_t)buf;
|
|
map->dm_mapsize = buflen;
|
|
map->dm_nsegs = 1;
|
|
map->dm_segs[0].ds_addr = dvmaddr + (vaddr & PGOFSET);
|
|
map->dm_segs[0].ds_len = buflen;
|
|
|
|
pmap = (p == NULL) ? pmap_kernel() : p->p_vmspace->vm_map.pmap;
|
|
|
|
for (; buflen > 0; ) {
|
|
paddr_t pa;
|
|
/*
|
|
* Get the physical address for this page.
|
|
*/
|
|
(void) pmap_extract(pmap, vaddr, &pa);
|
|
|
|
/*
|
|
* Compute the segment size, and adjust counts.
|
|
*/
|
|
sgsize = pagesz - ((u_long)vaddr & (pagesz - 1));
|
|
if (buflen < sgsize)
|
|
sgsize = buflen;
|
|
|
|
#ifdef notyet
|
|
if (have_iocache)
|
|
curaddr |= PG_IOC;
|
|
#endif
|
|
pmap_enter(pmap_kernel(), dvmaddr,
|
|
(pa & ~(pagesz-1)) | PMAP_NC,
|
|
VM_PROT_READ|VM_PROT_WRITE, PMAP_WIRED);
|
|
|
|
dvmaddr += pagesz;
|
|
vaddr += sgsize;
|
|
buflen -= sgsize;
|
|
}
|
|
|
|
/* Adjust DVMA address to VME view */
|
|
map->dm_segs[0].ds_addr -= VME4_DVMA_BASE;
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
sparc_vme4_dmamap_unload(t, map)
|
|
bus_dma_tag_t t;
|
|
bus_dmamap_t map;
|
|
{
|
|
bus_addr_t addr;
|
|
bus_size_t len;
|
|
|
|
/* Go from VME to CPU view */
|
|
map->dm_segs[0].ds_addr += VME4_DVMA_BASE;
|
|
|
|
addr = map->dm_segs[0].ds_addr & ~PGOFSET;
|
|
len = round_page(map->dm_segs[0].ds_len);
|
|
|
|
/* Remove double-mapping in DVMA space */
|
|
pmap_remove(pmap_kernel(), addr, addr + len);
|
|
|
|
/* Release DVMA space */
|
|
if (extent_free(vme_dvmamap, addr, len, EX_NOWAIT) != 0)
|
|
printf("warning: %ld of DVMA space lost\n", len);
|
|
|
|
/* Mark the mappings as invalid. */
|
|
map->dm_mapsize = 0;
|
|
map->dm_nsegs = 0;
|
|
}
|
|
|
|
int
|
|
sparc_vme4_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags)
|
|
bus_dma_tag_t t;
|
|
bus_size_t size, alignment, boundary;
|
|
bus_dma_segment_t *segs;
|
|
int nsegs;
|
|
int *rsegs;
|
|
int flags;
|
|
{
|
|
bus_addr_t dvmaddr;
|
|
struct pglist *mlist;
|
|
vm_page_t m;
|
|
paddr_t pa;
|
|
int error;
|
|
|
|
size = round_page(size);
|
|
error = _bus_dmamem_alloc_common(t, size, alignment, boundary,
|
|
segs, nsegs, rsegs, flags);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
if (extent_alloc(vme_dvmamap, size, alignment, boundary,
|
|
(flags & BUS_DMA_NOWAIT) == 0 ? EX_WAITOK : EX_NOWAIT,
|
|
(u_long *)&dvmaddr) != 0)
|
|
return (ENOMEM);
|
|
|
|
/*
|
|
* Compute the location, size, and number of segments actually
|
|
* returned by the VM code.
|
|
*/
|
|
segs[0].ds_addr = dvmaddr - VME4_DVMA_BASE;
|
|
segs[0].ds_len = size;
|
|
*rsegs = 1;
|
|
|
|
/* Map memory into DVMA space */
|
|
mlist = segs[0]._ds_mlist;
|
|
for (m = TAILQ_FIRST(mlist); m != NULL; m = TAILQ_NEXT(m,pageq)) {
|
|
pa = VM_PAGE_TO_PHYS(m);
|
|
|
|
#ifdef notyet
|
|
if (have_iocache)
|
|
pa |= PG_IOC;
|
|
#endif
|
|
pmap_enter(pmap_kernel(), dvmaddr, pa | PMAP_NC,
|
|
VM_PROT_READ|VM_PROT_WRITE, PMAP_WIRED);
|
|
dvmaddr += PAGE_SIZE;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
sparc_vme4_dmamem_free(t, segs, nsegs)
|
|
bus_dma_tag_t t;
|
|
bus_dma_segment_t *segs;
|
|
int nsegs;
|
|
{
|
|
bus_addr_t addr;
|
|
bus_size_t len;
|
|
|
|
addr = segs[0].ds_addr + VME4_DVMA_BASE;
|
|
len = round_page(segs[0].ds_len);
|
|
|
|
/* Remove DVMA kernel map */
|
|
pmap_remove(pmap_kernel(), addr, addr + len);
|
|
|
|
/* Release DVMA address range */
|
|
if (extent_free(vme_dvmamap, addr, len, EX_NOWAIT) != 0)
|
|
printf("warning: %ld of DVMA space lost\n", len);
|
|
|
|
/*
|
|
* Return the list of pages back to the VM system.
|
|
*/
|
|
_bus_dmamem_free_common(t, segs, nsegs);
|
|
}
|
|
|
|
void
|
|
sparc_vme4_dmamap_sync(t, map, offset, len, ops)
|
|
bus_dma_tag_t t;
|
|
bus_dmamap_t map;
|
|
bus_addr_t offset;
|
|
bus_size_t len;
|
|
int ops;
|
|
{
|
|
|
|
/*
|
|
* XXX Should perform cache flushes as necessary (e.g. 4/200 W/B).
|
|
* Currently the cache is flushed in bus_dma_load()...
|
|
*/
|
|
}
|
|
#endif /* SUN4 */
|
|
|
|
#if defined(SUN4M)
|
|
static int
|
|
sparc_vme4m_dmamap_create (t, size, nsegments, maxsegsz, boundary, flags, dmamp)
|
|
bus_dma_tag_t t;
|
|
bus_size_t size;
|
|
int nsegments;
|
|
bus_size_t maxsegsz;
|
|
bus_size_t boundary;
|
|
int flags;
|
|
bus_dmamap_t *dmamp;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)t->_cookie;
|
|
int error;
|
|
|
|
/* XXX - todo: allocate DVMA addresses from assigned ranges:
|
|
upper 8MB for A32 space; upper 1MB for A24 space */
|
|
error = bus_dmamap_create(sc->sc_dmatag, size, nsegments, maxsegsz,
|
|
boundary, flags, dmamp);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
#if 0
|
|
/* VME DVMA addresses must always be 8K aligned */
|
|
(*dmamp)->_dm_align = 8192;
|
|
#endif
|
|
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
sparc_vme4m_dmamap_load(t, map, buf, buflen, p, flags)
|
|
bus_dma_tag_t t;
|
|
bus_dmamap_t map;
|
|
void *buf;
|
|
bus_size_t buflen;
|
|
struct proc *p;
|
|
int flags;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)t->_cookie;
|
|
volatile u_int32_t *ioctags;
|
|
int error;
|
|
|
|
buflen = (buflen + VME_IOC_PAGESZ - 1) & ~(VME_IOC_PAGESZ - 1);
|
|
error = bus_dmamap_load(sc->sc_dmatag, map, buf, buflen, p, flags);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
/* allocate IO cache entries for this range */
|
|
ioctags = sc->sc_ioctags + VME_IOC_LINE(map->dm_segs[0].ds_addr);
|
|
for (;buflen > 0;) {
|
|
*ioctags = VME_IOC_IC | VME_IOC_W;
|
|
ioctags += VME_IOC_LINESZ/sizeof(*ioctags);
|
|
buflen -= VME_IOC_PAGESZ;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
|
|
void
|
|
sparc_vme4m_dmamap_unload(t, map)
|
|
bus_dma_tag_t t;
|
|
bus_dmamap_t map;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)t->_cookie;
|
|
volatile u_int32_t *flushregs;
|
|
int len;
|
|
|
|
/* Flush VME IO cache */
|
|
len = map->dm_segs[0].ds_len;
|
|
flushregs = sc->sc_iocflush + VME_IOC_LINE(map->dm_segs[0].ds_addr);
|
|
for (;len > 0;) {
|
|
*flushregs = 0;
|
|
flushregs += VME_IOC_LINESZ/sizeof(*flushregs);
|
|
len -= VME_IOC_PAGESZ;
|
|
}
|
|
/* Read a tag to synchronize the IOC flushes */
|
|
(*sc->sc_ioctags);
|
|
|
|
bus_dmamap_unload(sc->sc_dmatag, map);
|
|
}
|
|
|
|
int
|
|
sparc_vme4m_dmamem_alloc(t, size, alignmnt, boundary, segs, nsegs, rsegs, flags)
|
|
bus_dma_tag_t t;
|
|
bus_size_t size, alignmnt, boundary;
|
|
bus_dma_segment_t *segs;
|
|
int nsegs;
|
|
int *rsegs;
|
|
int flags;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)t->_cookie;
|
|
int error;
|
|
|
|
error = bus_dmamem_alloc(sc->sc_dmatag, size, alignmnt, boundary,
|
|
segs, nsegs, rsegs, flags);
|
|
if (error != 0)
|
|
return (error);
|
|
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
sparc_vme4m_dmamem_free(t, segs, nsegs)
|
|
bus_dma_tag_t t;
|
|
bus_dma_segment_t *segs;
|
|
int nsegs;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)t->_cookie;
|
|
|
|
bus_dmamem_free(sc->sc_dmatag, segs, nsegs);
|
|
}
|
|
|
|
void
|
|
sparc_vme4m_dmamap_sync(t, map, offset, len, ops)
|
|
bus_dma_tag_t t;
|
|
bus_dmamap_t map;
|
|
bus_addr_t offset;
|
|
bus_size_t len;
|
|
int ops;
|
|
{
|
|
|
|
/*
|
|
* XXX Should perform cache flushes as necessary.
|
|
*/
|
|
}
|
|
#endif /* SUN4M */
|
|
|
|
int
|
|
sparc_vme_dmamem_map(t, segs, nsegs, size, kvap, flags)
|
|
bus_dma_tag_t t;
|
|
bus_dma_segment_t *segs;
|
|
int nsegs;
|
|
size_t size;
|
|
caddr_t *kvap;
|
|
int flags;
|
|
{
|
|
struct sparcvme_softc *sc = (struct sparcvme_softc *)t->_cookie;
|
|
|
|
return (bus_dmamem_map(sc->sc_dmatag, segs, nsegs, size, kvap, flags));
|
|
}
|