Home | History | Annotate | Line # | Download | only in mvme
mvmebus.c revision 1.15
      1 /*	$NetBSD: mvmebus.c,v 1.15 2009/03/14 15:36:19 dsl Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2000, 2002 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Steve C. Woodford.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: mvmebus.c,v 1.15 2009/03/14 15:36:19 dsl Exp $");
     34 
     35 #include <sys/param.h>
     36 #include <sys/kernel.h>
     37 #include <sys/systm.h>
     38 #include <sys/device.h>
     39 #include <sys/malloc.h>
     40 #include <sys/kcore.h>
     41 
     42 #include <sys/cpu.h>
     43 #include <sys/bus.h>
     44 
     45 #include <dev/vme/vmereg.h>
     46 #include <dev/vme/vmevar.h>
     47 
     48 #include <dev/mvme/mvmebus.h>
     49 
     50 #ifdef DIAGNOSTIC
     51 int	mvmebus_dummy_dmamap_create(bus_dma_tag_t, bus_size_t, int, bus_size_t,
     52 	    bus_size_t, int, bus_dmamap_t *);
     53 void	mvmebus_dummy_dmamap_destroy(bus_dma_tag_t, bus_dmamap_t);
     54 int	mvmebus_dummy_dmamem_alloc(bus_dma_tag_t, bus_size_t, bus_size_t,
     55 	    bus_size_t, bus_dma_segment_t *, int, int *, int);
     56 void	mvmebus_dummy_dmamem_free(bus_dma_tag_t, bus_dma_segment_t *, int);
     57 #endif
     58 
     59 #ifdef DEBUG
     60 static const char *mvmebus_mod_string(vme_addr_t, vme_size_t,
     61 	    vme_am_t, vme_datasize_t);
     62 #endif
     63 
     64 static void mvmebus_offboard_ram(struct mvmebus_softc *);
     65 static int mvmebus_dmamap_load_common(struct mvmebus_softc *, bus_dmamap_t);
     66 
     67 vme_am_t	_mvmebus_am_cap[] = {
     68 	MVMEBUS_AM_CAP_BLKD64 | MVMEBUS_AM_CAP_USER,
     69 	MVMEBUS_AM_CAP_DATA   | MVMEBUS_AM_CAP_USER,
     70 	MVMEBUS_AM_CAP_PROG   | MVMEBUS_AM_CAP_USER,
     71 	MVMEBUS_AM_CAP_BLK    | MVMEBUS_AM_CAP_USER,
     72 	MVMEBUS_AM_CAP_BLKD64 | MVMEBUS_AM_CAP_SUPER,
     73 	MVMEBUS_AM_CAP_DATA   | MVMEBUS_AM_CAP_SUPER,
     74 	MVMEBUS_AM_CAP_PROG   | MVMEBUS_AM_CAP_SUPER,
     75 	MVMEBUS_AM_CAP_BLK    | MVMEBUS_AM_CAP_SUPER
     76 };
     77 
     78 const char *mvmebus_irq_name[] = {
     79 	"vmeirq0", "vmeirq1", "vmeirq2", "vmeirq3",
     80 	"vmeirq4", "vmeirq5", "vmeirq6", "vmeirq7"
     81 };
     82 
     83 extern phys_ram_seg_t mem_clusters[0];
     84 extern int mem_cluster_cnt;
     85 
     86 
     87 static void
     88 mvmebus_offboard_ram(struct mvmebus_softc *sc)
     89 {
     90 	struct mvmebus_range *svr, *mvr;
     91 	vme_addr_t start, end, size;
     92 	int i;
     93 
     94 	/*
     95 	 * If we have any offboard RAM (i.e. a VMEbus RAM board) then
     96 	 * we need to record its details since it's effectively another
     97 	 * VMEbus slave image as far as we're concerned.
     98 	 * The chip-specific backend will have reserved sc->sc_slaves[0]
     99 	 * for exactly this purpose.
    100 	 */
    101 	svr = sc->sc_slaves;
    102 	if (mem_cluster_cnt < 2) {
    103 		svr->vr_am = MVMEBUS_AM_DISABLED;
    104 		return;
    105 	}
    106 
    107 	start = mem_clusters[1].start;
    108 	size = mem_clusters[1].size - 1;
    109 	end = start + size;
    110 
    111 	/*
    112 	 * Figure out which VMEbus master image the RAM is
    113 	 * visible through. This will tell us the address
    114 	 * modifier and datasizes it uses, as well as allowing
    115 	 * us to calculate its `real' VMEbus address.
    116 	 *
    117 	 * XXX FIXME: This is broken if the RAM is mapped through
    118 	 * a translated address space. For example, on mvme167 it's
    119 	 * perfectly legal to set up the following A32 mapping:
    120 	 *
    121 	 *  vr_locaddr  == 0x80000000
    122 	 *  vr_vmestart == 0x10000000
    123 	 *  vr_vmeend   == 0x10ffffff
    124 	 *
    125 	 * In this case, RAM at VMEbus address 0x10800000 will appear at local
    126 	 * address 0x80800000, but we need to set the slave vr_vmestart to
    127 	 * 0x10800000.
    128 	 */
    129 	for (i = 0, mvr = sc->sc_masters; i < sc->sc_nmasters; i++, mvr++) {
    130 		vme_addr_t vstart = mvr->vr_locstart + mvr->vr_vmestart;
    131 
    132 		if (start >= vstart &&
    133 		    end <= vstart + (mvr->vr_vmeend - mvr->vr_vmestart))
    134 			break;
    135 	}
    136 	if (i == sc->sc_nmasters) {
    137 		svr->vr_am = MVMEBUS_AM_DISABLED;
    138 #ifdef DEBUG
    139 		printf("%s: No VMEbus master mapping for offboard RAM!\n",
    140 		    device_xname(&sc->sc_dev));
    141 #endif
    142 		return;
    143 	}
    144 
    145 	svr->vr_locstart = start;
    146 	svr->vr_vmestart = start & mvr->vr_mask;
    147 	svr->vr_vmeend = svr->vr_vmestart + size;
    148 	svr->vr_datasize = mvr->vr_datasize;
    149 	svr->vr_mask = mvr->vr_mask;
    150 	svr->vr_am = mvr->vr_am & VME_AM_ADRSIZEMASK;
    151 	svr->vr_am |= MVMEBUS_AM_CAP_DATA  | MVMEBUS_AM_CAP_PROG |
    152 		      MVMEBUS_AM_CAP_SUPER | MVMEBUS_AM_CAP_USER;
    153 }
    154 
    155 void
    156 mvmebus_attach(struct mvmebus_softc *sc)
    157 {
    158 	struct vmebus_attach_args vaa;
    159 	int i;
    160 
    161 	/* Zap the IRQ reference counts */
    162 	for (i = 0; i < 8; i++)
    163 		sc->sc_irqref[i] = 0;
    164 
    165 	/* If there's offboard RAM, get its VMEbus slave attributes */
    166 	mvmebus_offboard_ram(sc);
    167 
    168 #ifdef DEBUG
    169 	for (i = 0; i < sc->sc_nmasters; i++) {
    170 		struct mvmebus_range *vr = &sc->sc_masters[i];
    171 		if (vr->vr_am == MVMEBUS_AM_DISABLED) {
    172 			printf("%s: Master#%d: disabled\n",
    173 			    device_xname(&sc->sc_dev), i);
    174 			continue;
    175 		}
    176 		printf("%s: Master#%d: 0x%08lx -> %s\n",
    177 		    device_xname(&sc->sc_dev), i,
    178 		    vr->vr_locstart + (vr->vr_vmestart & vr->vr_mask),
    179 		    mvmebus_mod_string(vr->vr_vmestart,
    180 			(vr->vr_vmeend - vr->vr_vmestart) + 1,
    181 			vr->vr_am, vr->vr_datasize));
    182 	}
    183 
    184 	for (i = 0; i < sc->sc_nslaves; i++) {
    185 		struct mvmebus_range *vr = &sc->sc_slaves[i];
    186 		if (vr->vr_am == MVMEBUS_AM_DISABLED) {
    187 			printf("%s:  Slave#%d: disabled\n",
    188 			    device_xname(&sc->sc_dev), i);
    189 			continue;
    190 		}
    191 		printf("%s:  Slave#%d: 0x%08lx -> %s\n",
    192 		    device_xname(&sc->sc_dev), i, vr->vr_locstart,
    193 		    mvmebus_mod_string(vr->vr_vmestart,
    194 			(vr->vr_vmeend - vr->vr_vmestart) + 1,
    195 			vr->vr_am, vr->vr_datasize));
    196 	}
    197 #endif
    198 
    199 	sc->sc_vct.cookie = sc;
    200 	sc->sc_vct.vct_probe = mvmebus_probe;
    201 	sc->sc_vct.vct_map = mvmebus_map;
    202 	sc->sc_vct.vct_unmap = mvmebus_unmap;
    203 	sc->sc_vct.vct_int_map = mvmebus_intmap;
    204 	sc->sc_vct.vct_int_evcnt = mvmebus_intr_evcnt;
    205 	sc->sc_vct.vct_int_establish = mvmebus_intr_establish;
    206 	sc->sc_vct.vct_int_disestablish = mvmebus_intr_disestablish;
    207 	sc->sc_vct.vct_dmamap_create = mvmebus_dmamap_create;
    208 	sc->sc_vct.vct_dmamap_destroy = mvmebus_dmamap_destroy;
    209 	sc->sc_vct.vct_dmamem_alloc = mvmebus_dmamem_alloc;
    210 	sc->sc_vct.vct_dmamem_free = mvmebus_dmamem_free;
    211 
    212 	sc->sc_mvmedmat._cookie = sc;
    213 	sc->sc_mvmedmat._dmamap_load = mvmebus_dmamap_load;
    214 	sc->sc_mvmedmat._dmamap_load_mbuf = mvmebus_dmamap_load_mbuf;
    215 	sc->sc_mvmedmat._dmamap_load_uio = mvmebus_dmamap_load_uio;
    216 	sc->sc_mvmedmat._dmamap_load_raw = mvmebus_dmamap_load_raw;
    217 	sc->sc_mvmedmat._dmamap_unload = mvmebus_dmamap_unload;
    218 	sc->sc_mvmedmat._dmamap_sync = mvmebus_dmamap_sync;
    219 	sc->sc_mvmedmat._dmamem_map = mvmebus_dmamem_map;
    220 	sc->sc_mvmedmat._dmamem_unmap = mvmebus_dmamem_unmap;
    221 	sc->sc_mvmedmat._dmamem_mmap = mvmebus_dmamem_mmap;
    222 
    223 #ifdef DIAGNOSTIC
    224 	sc->sc_mvmedmat._dmamap_create = mvmebus_dummy_dmamap_create;
    225 	sc->sc_mvmedmat._dmamap_destroy = mvmebus_dummy_dmamap_destroy;
    226 	sc->sc_mvmedmat._dmamem_alloc = mvmebus_dummy_dmamem_alloc;
    227 	sc->sc_mvmedmat._dmamem_free = mvmebus_dummy_dmamem_free;
    228 #else
    229 	sc->sc_mvmedmat._dmamap_create = NULL;
    230 	sc->sc_mvmedmat._dmamap_destroy = NULL;
    231 	sc->sc_mvmedmat._dmamem_alloc = NULL;
    232 	sc->sc_mvmedmat._dmamem_free = NULL;
    233 #endif
    234 
    235 	vaa.va_vct = &sc->sc_vct;
    236 	vaa.va_bdt = &sc->sc_mvmedmat;
    237 	vaa.va_slaveconfig = NULL;
    238 
    239 	config_found(&sc->sc_dev, &vaa, 0);
    240 }
    241 
    242 int
    243 mvmebus_map(void *vsc, vme_addr_t vmeaddr, vme_size_t len, vme_am_t am, vme_datasize_t datasize, vme_swap_t swap, bus_space_tag_t *tag, bus_space_handle_t *handle, vme_mapresc_t *resc)
    244 {
    245 	struct mvmebus_softc *sc;
    246 	struct mvmebus_mapresc *mr;
    247 	struct mvmebus_range *vr;
    248 	vme_addr_t end;
    249 	vme_am_t cap, as;
    250 	paddr_t paddr;
    251 	int rv, i;
    252 
    253 	sc = vsc;
    254 	end = (vmeaddr + len) - 1;
    255 	paddr = 0;
    256 	vr = sc->sc_masters;
    257 	cap = MVMEBUS_AM2CAP(am);
    258 	as = am & VME_AM_ADRSIZEMASK;
    259 
    260 	for (i = 0; i < sc->sc_nmasters && paddr == 0; i++, vr++) {
    261 		if (vr->vr_am == MVMEBUS_AM_DISABLED)
    262 			continue;
    263 
    264 		if (cap == (vr->vr_am & cap) &&
    265 		    as == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    266 		    datasize <= vr->vr_datasize &&
    267 		    vmeaddr >= vr->vr_vmestart && end < vr->vr_vmeend)
    268 			paddr = vr->vr_locstart + (vmeaddr & vr->vr_mask);
    269 	}
    270 	if (paddr == 0)
    271 		return (ENOMEM);
    272 
    273 	rv = bus_space_map(sc->sc_bust, paddr, len, 0, handle);
    274 	if (rv != 0)
    275 		return (rv);
    276 
    277 	/* Allocate space for the resource tag */
    278 	if ((mr = malloc(sizeof(*mr), M_DEVBUF, M_NOWAIT)) == NULL) {
    279 		bus_space_unmap(sc->sc_bust, *handle, len);
    280 		return (ENOMEM);
    281 	}
    282 
    283 	/* Record the range's details */
    284 	mr->mr_am = am;
    285 	mr->mr_datasize = datasize;
    286 	mr->mr_addr = vmeaddr;
    287 	mr->mr_size = len;
    288 	mr->mr_handle = *handle;
    289 	mr->mr_range = i;
    290 
    291 	*tag = sc->sc_bust;
    292 	*resc = (vme_mapresc_t *) mr;
    293 
    294 	return (0);
    295 }
    296 
    297 /* ARGSUSED */
    298 void
    299 mvmebus_unmap(void *vsc, vme_mapresc_t resc)
    300 {
    301 	struct mvmebus_softc *sc = vsc;
    302 	struct mvmebus_mapresc *mr = (struct mvmebus_mapresc *) resc;
    303 
    304 	bus_space_unmap(sc->sc_bust, mr->mr_handle, mr->mr_size);
    305 
    306 	free(mr, M_DEVBUF);
    307 }
    308 
    309 int
    310 mvmebus_probe(vsc, vmeaddr, len, am, datasize, callback, arg)
    311 	void *vsc;
    312 	vme_addr_t vmeaddr;
    313 	vme_size_t len;
    314 	vme_am_t am;
    315 	vme_datasize_t datasize;
    316 	int (*callback)(void *, bus_space_tag_t, bus_space_handle_t);
    317 	void *arg;
    318 {
    319 	bus_space_tag_t tag;
    320 	bus_space_handle_t handle;
    321 	vme_mapresc_t resc;
    322 	vme_size_t offs;
    323 	int rv;
    324 
    325 	/* Get a temporary mapping to the VMEbus range */
    326 	rv = mvmebus_map(vsc, vmeaddr, len, am, datasize, 0,
    327 	    &tag, &handle, &resc);
    328 	if (rv)
    329 		return (rv);
    330 
    331 	if (callback)
    332 		rv = (*callback) (arg, tag, handle);
    333 	else
    334 		for (offs = 0; offs < len && rv == 0;) {
    335 			switch (datasize) {
    336 			case VME_D8:
    337 				rv = bus_space_peek_1(tag, handle, offs, NULL);
    338 				offs += 1;
    339 				break;
    340 
    341 			case VME_D16:
    342 				rv = bus_space_peek_2(tag, handle, offs, NULL);
    343 				offs += 2;
    344 				break;
    345 
    346 			case VME_D32:
    347 				rv = bus_space_peek_4(tag, handle, offs, NULL);
    348 				offs += 4;
    349 				break;
    350 			}
    351 		}
    352 
    353 	mvmebus_unmap(vsc, resc);
    354 
    355 	return (rv);
    356 }
    357 
    358 /* ARGSUSED */
    359 int
    360 mvmebus_intmap(vsc, level, vector, handlep)
    361 	void *vsc;
    362 	int level, vector;
    363 	vme_intr_handle_t *handlep;
    364 {
    365 
    366 	if (level < 1 || level > 7 || vector < 0x80 || vector > 0xff)
    367 		return (EINVAL);
    368 
    369 	/* This is rather gross */
    370 	*handlep = (void *) (int) ((level << 8) | vector);
    371 	return (0);
    372 }
    373 
    374 /* ARGSUSED */
    375 const struct evcnt *
    376 mvmebus_intr_evcnt(void *vsc, vme_intr_handle_t handle)
    377 {
    378 	struct mvmebus_softc *sc = vsc;
    379 
    380 	return (&sc->sc_evcnt[(((int) handle) >> 8) - 1]);
    381 }
    382 
    383 void *
    384 mvmebus_intr_establish(vsc, handle, prior, func, arg)
    385 	void *vsc;
    386 	vme_intr_handle_t handle;
    387 	int prior;
    388 	int (*func)(void *);
    389 	void *arg;
    390 {
    391 	struct mvmebus_softc *sc;
    392 	int level, vector, first;
    393 
    394 	sc = vsc;
    395 
    396 	/* Extract the interrupt's level and vector */
    397 	level = ((int) handle) >> 8;
    398 	vector = ((int) handle) & 0xff;
    399 
    400 #ifdef DIAGNOSTIC
    401 	if (vector < 0 || vector > 0xff) {
    402 		printf("%s: Illegal vector offset: 0x%x\n",
    403 		    device_xname(&sc->sc_dev), vector);
    404 		panic("mvmebus_intr_establish");
    405 	}
    406 	if (level < 1 || level > 7) {
    407 		printf("%s: Illegal interrupt level: %d\n",
    408 		    device_xname(&sc->sc_dev), level);
    409 		panic("mvmebus_intr_establish");
    410 	}
    411 #endif
    412 
    413 	first = (sc->sc_irqref[level]++ == 0);
    414 
    415 	(*sc->sc_intr_establish)(sc->sc_chip, prior, level, vector, first,
    416 	    func, arg, &sc->sc_evcnt[level - 1]);
    417 
    418 	return ((void *) handle);
    419 }
    420 
    421 void
    422 mvmebus_intr_disestablish(void *vsc, vme_intr_handle_t handle)
    423 {
    424 	struct mvmebus_softc *sc;
    425 	int level, vector, last;
    426 
    427 	sc = vsc;
    428 
    429 	/* Extract the interrupt's level and vector */
    430 	level = ((int) handle) >> 8;
    431 	vector = ((int) handle) & 0xff;
    432 
    433 #ifdef DIAGNOSTIC
    434 	if (vector < 0 || vector > 0xff) {
    435 		printf("%s: Illegal vector offset: 0x%x\n",
    436 		    device_xname(&sc->sc_dev), vector);
    437 		panic("mvmebus_intr_disestablish");
    438 	}
    439 	if (level < 1 || level > 7) {
    440 		printf("%s: Illegal interrupt level: %d\n",
    441 		    device_xname(&sc->sc_dev), level);
    442 		panic("mvmebus_intr_disestablish");
    443 	}
    444 	if (sc->sc_irqref[level] == 0) {
    445 		printf("%s: VMEirq#%d: Reference count already zero!\n",
    446 		    device_xname(&sc->sc_dev), level);
    447 		panic("mvmebus_intr_disestablish");
    448 	}
    449 #endif
    450 
    451 	last = (--(sc->sc_irqref[level]) == 0);
    452 
    453 	(*sc->sc_intr_disestablish)(sc->sc_chip, level, vector, last,
    454 	    &sc->sc_evcnt[level - 1]);
    455 }
    456 
    457 #ifdef DIAGNOSTIC
    458 /* ARGSUSED */
    459 int
    460 mvmebus_dummy_dmamap_create(bus_dma_tag_t t, bus_size_t size, int nsegs, bus_size_t maxsegsz, bus_size_t boundary, int flags, bus_dmamap_t *dmamp)
    461 {
    462 
    463 	panic("Must use vme_dmamap_create() in place of bus_dmamap_create()");
    464 	return (0);	/* Shutup the compiler */
    465 }
    466 
    467 /* ARGSUSED */
    468 void
    469 mvmebus_dummy_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map)
    470 {
    471 
    472 	panic("Must use vme_dmamap_destroy() in place of bus_dmamap_destroy()");
    473 }
    474 #endif
    475 
    476 /* ARGSUSED */
    477 int
    478 mvmebus_dmamap_create(vsc, len, am, datasize, swap, nsegs,
    479     segsz, bound, flags, mapp)
    480 	void *vsc;
    481 	vme_size_t len;
    482 	vme_am_t am;
    483 	vme_datasize_t datasize;
    484 	vme_swap_t swap;
    485 	int nsegs;
    486 	vme_size_t segsz;
    487 	vme_addr_t bound;
    488 	int flags;
    489 	bus_dmamap_t *mapp;
    490 {
    491 	struct mvmebus_softc *sc = vsc;
    492 	struct mvmebus_dmamap *vmap;
    493 	struct mvmebus_range *vr;
    494 	vme_am_t cap, as;
    495 	int i, rv;
    496 
    497 	cap = MVMEBUS_AM2CAP(am);
    498 	as = am & VME_AM_ADRSIZEMASK;
    499 
    500 	/*
    501 	 * Verify that we even stand a chance of satisfying
    502 	 * the VMEbus address space and datasize requested.
    503 	 */
    504 	for (i = 0, vr = sc->sc_slaves; i < sc->sc_nslaves; i++, vr++) {
    505 		if (vr->vr_am == MVMEBUS_AM_DISABLED)
    506 			continue;
    507 
    508 		if (as == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    509 		    cap == (vr->vr_am & cap) && datasize <= vr->vr_datasize &&
    510 		    len <= (vr->vr_vmeend - vr->vr_vmestart))
    511 			break;
    512 	}
    513 
    514 	if (i == sc->sc_nslaves)
    515 		return (EINVAL);
    516 
    517 	if ((vmap = malloc(sizeof(*vmap), M_DMAMAP,
    518 	    (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL)
    519 		return (ENOMEM);
    520 
    521 
    522 	rv = bus_dmamap_create(sc->sc_dmat, len, nsegs, segsz,
    523 	    bound, flags, mapp);
    524 	if (rv != 0) {
    525 		free(vmap, M_DMAMAP);
    526 		return (rv);
    527 	}
    528 
    529 	vmap->vm_am = am;
    530 	vmap->vm_datasize = datasize;
    531 	vmap->vm_swap = swap;
    532 	vmap->vm_slave = vr;
    533 
    534 	(*mapp)->_dm_cookie = vmap;
    535 
    536 	return (0);
    537 }
    538 
    539 void
    540 mvmebus_dmamap_destroy(void *vsc, bus_dmamap_t map)
    541 {
    542 	struct mvmebus_softc *sc = vsc;
    543 
    544 	free(map->_dm_cookie, M_DMAMAP);
    545 	bus_dmamap_destroy(sc->sc_dmat, map);
    546 }
    547 
    548 static int
    549 mvmebus_dmamap_load_common(struct mvmebus_softc *sc, bus_dmamap_t map)
    550 {
    551 	struct mvmebus_dmamap *vmap = map->_dm_cookie;
    552 	struct mvmebus_range *vr = vmap->vm_slave;
    553 	bus_dma_segment_t *ds;
    554 	vme_am_t cap, am;
    555 	int i;
    556 
    557 	cap = MVMEBUS_AM2CAP(vmap->vm_am);
    558 	am = vmap->vm_am & VME_AM_ADRSIZEMASK;
    559 
    560 	/*
    561 	 * Traverse the list of segments which make up this map, and
    562 	 * convert the CPU-relative addresses therein to VMEbus addresses.
    563 	 */
    564 	for (ds = &map->dm_segs[0]; ds < &map->dm_segs[map->dm_nsegs]; ds++) {
    565 		/*
    566 		 * First, see if this map's slave image can access the
    567 		 * segment, otherwise we have to waste time scanning all
    568 		 * the slave images.
    569 		 */
    570 		vr = vmap->vm_slave;
    571 		if (am == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    572 		    cap == (vr->vr_am & cap) &&
    573 		    vmap->vm_datasize <= vr->vr_datasize &&
    574 		    ds->_ds_cpuaddr >= vr->vr_locstart &&
    575 		    ds->ds_len <= (vr->vr_vmeend - vr->vr_vmestart))
    576 			goto found;
    577 
    578 		for (i = 0, vr = sc->sc_slaves; i < sc->sc_nslaves; i++, vr++) {
    579 			if (vr->vr_am == MVMEBUS_AM_DISABLED)
    580 				continue;
    581 
    582 			/*
    583 			 * Filter out any slave images which don't have the
    584 			 * same VMEbus address modifier and datasize as
    585 			 * this DMA map, and those which don't cover the
    586 			 * physical address region containing the segment.
    587 			 */
    588 			if (vr != vmap->vm_slave &&
    589 			    am == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    590 			    cap == (vr->vr_am & cap) &&
    591 			    vmap->vm_datasize <= vr->vr_datasize &&
    592 			    ds->_ds_cpuaddr >= vr->vr_locstart &&
    593 			    ds->ds_len <= (vr->vr_vmeend - vr->vr_vmestart))
    594 				break;
    595 		}
    596 
    597 		/*
    598 		 * Did we find an applicable slave image which covers this
    599 		 * segment?
    600 		 */
    601 		if (i == sc->sc_nslaves) {
    602 			/*
    603 			 * XXX TODO:
    604 			 *
    605 			 * Bounce this segment via a bounce buffer allocated
    606 			 * from this DMA map.
    607 			 */
    608 			printf("mvmebus_dmamap_load_common: bounce needed!\n");
    609 			return (EINVAL);
    610 		}
    611 
    612 found:
    613 		/*
    614 		 * Generate the VMEbus address of this segment
    615 		 */
    616 		ds->ds_addr = (ds->_ds_cpuaddr - vr->vr_locstart) +
    617 		    vr->vr_vmestart;
    618 	}
    619 
    620 	return (0);
    621 }
    622 
    623 int
    624 mvmebus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf, bus_size_t buflen, struct proc *p, int flags)
    625 {
    626 	struct mvmebus_softc *sc = t->_cookie;
    627 	int rv;
    628 
    629 	rv = bus_dmamap_load(sc->sc_dmat, map, buf, buflen, p, flags);
    630 	if (rv != 0)
    631 		return rv;
    632 
    633 	return mvmebus_dmamap_load_common(sc, map);
    634 }
    635 
    636 int
    637 mvmebus_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map, struct mbuf *chain, int flags)
    638 {
    639 	struct mvmebus_softc *sc = t->_cookie;
    640 	int rv;
    641 
    642 	rv = bus_dmamap_load_mbuf(sc->sc_dmat, map, chain, flags);
    643 	if (rv != 0)
    644 		return rv;
    645 
    646 	return mvmebus_dmamap_load_common(sc, map);
    647 }
    648 
    649 int
    650 mvmebus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio, int flags)
    651 {
    652 	struct mvmebus_softc *sc = t->_cookie;
    653 	int rv;
    654 
    655 	rv = bus_dmamap_load_uio(sc->sc_dmat, map, uio, flags);
    656 	if (rv != 0)
    657 		return rv;
    658 
    659 	return mvmebus_dmamap_load_common(sc, map);
    660 }
    661 
    662 int
    663 mvmebus_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map, bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags)
    664 {
    665 	struct mvmebus_softc *sc = t->_cookie;
    666 	int rv;
    667 
    668 	/*
    669 	 * mvmebus_dmamem_alloc() will ensure that the physical memory
    670 	 * backing these segments is 100% accessible in at least one
    671 	 * of the board's VMEbus slave images.
    672 	 */
    673 	rv = bus_dmamap_load_raw(sc->sc_dmat, map, segs, nsegs, size, flags);
    674 	if (rv != 0)
    675 		return rv;
    676 
    677 	return mvmebus_dmamap_load_common(sc, map);
    678 }
    679 
    680 void
    681 mvmebus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
    682 {
    683 	struct mvmebus_softc *sc = t->_cookie;
    684 
    685 	/* XXX Deal with bounce buffers */
    686 
    687 	bus_dmamap_unload(sc->sc_dmat, map);
    688 }
    689 
    690 void
    691 mvmebus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset, bus_size_t len, int ops)
    692 {
    693 	struct mvmebus_softc *sc = t->_cookie;
    694 
    695 	/* XXX Bounce buffers */
    696 
    697 	bus_dmamap_sync(sc->sc_dmat, map, offset, len, ops);
    698 }
    699 
    700 #ifdef DIAGNOSTIC
    701 /* ARGSUSED */
    702 int
    703 mvmebus_dummy_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t align, bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs, int flags)
    704 {
    705 
    706 	panic("Must use vme_dmamem_alloc() in place of bus_dmamem_alloc()");
    707 }
    708 
    709 /* ARGSUSED */
    710 void
    711 mvmebus_dummy_dmamem_free(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs)
    712 {
    713 
    714 	panic("Must use vme_dmamem_free() in place of bus_dmamem_free()");
    715 }
    716 #endif
    717 
    718 /* ARGSUSED */
    719 int
    720 mvmebus_dmamem_alloc(void *vsc, vme_size_t len, vme_am_t am, vme_datasize_t datasize, vme_swap_t swap, bus_dma_segment_t *segs, int nsegs, int *rsegs, int flags)
    721 {
    722 	extern paddr_t avail_start;
    723 	struct mvmebus_softc *sc = vsc;
    724 	struct mvmebus_range *vr;
    725 	bus_addr_t low, high;
    726 	bus_size_t bound;
    727 	vme_am_t cap;
    728 	int i;
    729 
    730 	cap = MVMEBUS_AM2CAP(am);
    731 	am &= VME_AM_ADRSIZEMASK;
    732 
    733 	/*
    734 	 * Find a slave mapping in the requested VMEbus address space.
    735 	 */
    736 	for (i = 0, vr = sc->sc_slaves; i < sc->sc_nslaves; i++, vr++) {
    737 		if (vr->vr_am == MVMEBUS_AM_DISABLED)
    738 			continue;
    739 
    740 		if (i == 0 && (flags & BUS_DMA_ONBOARD_RAM) != 0)
    741 			continue;
    742 
    743 		if (am == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    744 		    cap == (vr->vr_am & cap) && datasize <= vr->vr_datasize &&
    745 		    len <= (vr->vr_vmeend - vr->vr_vmestart))
    746 			break;
    747 	}
    748 	if (i == sc->sc_nslaves)
    749 		return (EINVAL);
    750 
    751 	/*
    752 	 * Set up the constraints so we can allocate physical memory which
    753 	 * is visible in the requested address space
    754 	 */
    755 	low = max(vr->vr_locstart, avail_start);
    756 	high = vr->vr_locstart + (vr->vr_vmeend - vr->vr_vmestart) + 1;
    757 	bound = (bus_size_t) vr->vr_mask + 1;
    758 
    759 	/*
    760 	 * Allocate physical memory.
    761 	 *
    762 	 * Note: This fills in the segments with CPU-relative physical
    763 	 * addresses. A further call to bus_dmamap_load_raw() (with a
    764 	 * DMA map which specifies the same VMEbus address space and
    765 	 * constraints as the call to here) must be made. The segments
    766 	 * of the DMA map will then contain VMEbus-relative physical
    767 	 * addresses of the memory allocated here.
    768 	 */
    769 	return _bus_dmamem_alloc_common(sc->sc_dmat, low, high,
    770 	    len, 0, bound, segs, nsegs, rsegs, flags);
    771 }
    772 
    773 void
    774 mvmebus_dmamem_free(void *vsc, bus_dma_segment_t *segs, int nsegs)
    775 {
    776 	struct mvmebus_softc *sc = vsc;
    777 
    778 	bus_dmamem_free(sc->sc_dmat, segs, nsegs);
    779 }
    780 
    781 int
    782 mvmebus_dmamem_map(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs, size_t size, void **kvap, int flags)
    783 {
    784 	struct mvmebus_softc *sc = t->_cookie;
    785 
    786 	return bus_dmamem_map(sc->sc_dmat, segs, nsegs, size, kvap, flags);
    787 }
    788 
    789 void
    790 mvmebus_dmamem_unmap(bus_dma_tag_t t, void *kva, size_t size)
    791 {
    792 	struct mvmebus_softc *sc = t->_cookie;
    793 
    794 	bus_dmamem_unmap(sc->sc_dmat, kva, size);
    795 }
    796 
    797 paddr_t
    798 mvmebus_dmamem_mmap(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs, off_t offset, int prot, int flags)
    799 {
    800 	struct mvmebus_softc *sc = t->_cookie;
    801 
    802 	return bus_dmamem_mmap(sc->sc_dmat, segs, nsegs, offset, prot, flags);
    803 }
    804 
    805 #ifdef DEBUG
    806 static const char *
    807 mvmebus_mod_string(vme_addr_t addr, vme_size_t len, vme_am_t am, vme_datasize_t ds)
    808 {
    809 	static const char *mode[] = {"BLT64)", "DATA)", "PROG)", "BLT32)"};
    810 	static const char *dsiz[] = {"(", "(D8,", "(D16,", "(D16-D8,",
    811 	"(D32,", "(D32,D8,", "(D32-D16,", "(D32-D8,"};
    812 	static const char *adrfmt[] = { "A32:%08x-%08x ", "USR:%08x-%08x ",
    813 	    "A16:%04x-%04x ", "A24:%06x-%06x " };
    814 	static char mstring[40];
    815 
    816 	snprintf(mstring, sizeof(mstring),
    817 	    adrfmt[(am & VME_AM_ADRSIZEMASK) >> VME_AM_ADRSIZESHIFT],
    818 	    addr, addr + len - 1);
    819 	strlcat(mstring, dsiz[ds & 0x7], sizeof(mstring));
    820 
    821 	if (MVMEBUS_AM_HAS_CAP(am)) {
    822 		if (am & MVMEBUS_AM_CAP_DATA)
    823 			strlcat(mstring, "D", sizeof(mstring));
    824 		if (am & MVMEBUS_AM_CAP_PROG)
    825 			strlcat(mstring, "P", sizeof(mstring));
    826 		if (am & MVMEBUS_AM_CAP_USER)
    827 			strlcat(mstring, "U", sizeof(mstring));
    828 		if (am & MVMEBUS_AM_CAP_SUPER)
    829 			strlcat(mstring, "S", sizeof(mstring));
    830 		if (am & MVMEBUS_AM_CAP_BLK)
    831 			strlcat(mstring, "B", sizeof(mstring));
    832 		if (am & MVMEBUS_AM_CAP_BLKD64)
    833 			strlcat(mstring, "6", sizeof(mstring));
    834 		strlcat(mstring, ")", sizeof(mstring));
    835 	} else {
    836 		strlcat(mstring, ((am & VME_AM_PRIVMASK) == VME_AM_USER) ?
    837 		    "USER," : "SUPER,", sizeof(mstring));
    838 		strlcat(mstring, mode[am & VME_AM_MODEMASK], sizeof(mstring));
    839 	}
    840 
    841 	return (mstring);
    842 }
    843 #endif
    844