Home | History | Annotate | Line # | Download | only in mvme
      1 /*	$NetBSD: mvmebus.c,v 1.24 2021/08/07 16:19:13 thorpej 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.24 2021/08/07 16:19:13 thorpej 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[];
     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, CFARGS_NONE);
    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 	mr = malloc(sizeof(*mr), M_DEVBUF, M_WAITOK);
    279 
    280 	/* Record the range's details */
    281 	mr->mr_am = am;
    282 	mr->mr_datasize = datasize;
    283 	mr->mr_addr = vmeaddr;
    284 	mr->mr_size = len;
    285 	mr->mr_handle = *handle;
    286 	mr->mr_range = i;
    287 
    288 	*tag = sc->sc_bust;
    289 	*resc = (vme_mapresc_t *) mr;
    290 
    291 	return (0);
    292 }
    293 
    294 /* ARGSUSED */
    295 void
    296 mvmebus_unmap(void *vsc, vme_mapresc_t resc)
    297 {
    298 	struct mvmebus_softc *sc = vsc;
    299 	struct mvmebus_mapresc *mr = (struct mvmebus_mapresc *) resc;
    300 
    301 	bus_space_unmap(sc->sc_bust, mr->mr_handle, mr->mr_size);
    302 
    303 	free(mr, M_DEVBUF);
    304 }
    305 
    306 int
    307 mvmebus_probe(void *vsc, vme_addr_t vmeaddr, vme_size_t len, vme_am_t am, vme_datasize_t datasize, int (*callback)(void *, bus_space_tag_t, bus_space_handle_t), void *arg)
    308 {
    309 	bus_space_tag_t tag;
    310 	bus_space_handle_t handle;
    311 	vme_mapresc_t resc;
    312 	vme_size_t offs;
    313 	int rv;
    314 
    315 	/* Get a temporary mapping to the VMEbus range */
    316 	rv = mvmebus_map(vsc, vmeaddr, len, am, datasize, 0,
    317 	    &tag, &handle, &resc);
    318 	if (rv)
    319 		return (rv);
    320 
    321 	if (callback)
    322 		rv = (*callback) (arg, tag, handle);
    323 	else
    324 		for (offs = 0; offs < len && rv == 0;) {
    325 			switch (datasize) {
    326 			case VME_D8:
    327 				rv = bus_space_peek_1(tag, handle, offs, NULL);
    328 				offs += 1;
    329 				break;
    330 
    331 			case VME_D16:
    332 				rv = bus_space_peek_2(tag, handle, offs, NULL);
    333 				offs += 2;
    334 				break;
    335 
    336 			case VME_D32:
    337 				rv = bus_space_peek_4(tag, handle, offs, NULL);
    338 				offs += 4;
    339 				break;
    340 			}
    341 		}
    342 
    343 	mvmebus_unmap(vsc, resc);
    344 
    345 	return (rv);
    346 }
    347 
    348 /* ARGSUSED */
    349 int
    350 mvmebus_intmap(void *vsc, int level, int vector, vme_intr_handle_t *handlep)
    351 {
    352 
    353 	if (level < 1 || level > 7 || vector < 0x80 || vector > 0xff)
    354 		return (EINVAL);
    355 
    356 	/* This is rather gross */
    357 	*handlep = (void *) (int) ((level << 8) | vector);
    358 	return (0);
    359 }
    360 
    361 /* ARGSUSED */
    362 const struct evcnt *
    363 mvmebus_intr_evcnt(void *vsc, vme_intr_handle_t handle)
    364 {
    365 	struct mvmebus_softc *sc = vsc;
    366 
    367 	return (&sc->sc_evcnt[(((int) handle) >> 8) - 1]);
    368 }
    369 
    370 void *
    371 mvmebus_intr_establish(void *vsc, vme_intr_handle_t handle, int prior, int (*func)(void *), void *arg)
    372 {
    373 	struct mvmebus_softc *sc;
    374 	int level, vector, first;
    375 
    376 	sc = vsc;
    377 
    378 	/* Extract the interrupt's level and vector */
    379 	level = ((int) handle) >> 8;
    380 	vector = ((int) handle) & 0xff;
    381 
    382 #ifdef DIAGNOSTIC
    383 	if (vector < 0 || vector > 0xff) {
    384 		printf("%s: Illegal vector offset: 0x%x\n",
    385 		    device_xname(sc->sc_dev), vector);
    386 		panic("mvmebus_intr_establish");
    387 	}
    388 	if (level < 1 || level > 7) {
    389 		printf("%s: Illegal interrupt level: %d\n",
    390 		    device_xname(sc->sc_dev), level);
    391 		panic("mvmebus_intr_establish");
    392 	}
    393 #endif
    394 
    395 	first = (sc->sc_irqref[level]++ == 0);
    396 
    397 	(*sc->sc_intr_establish)(sc->sc_chip, prior, level, vector, first,
    398 	    func, arg, &sc->sc_evcnt[level - 1]);
    399 
    400 	return ((void *) handle);
    401 }
    402 
    403 void
    404 mvmebus_intr_disestablish(void *vsc, vme_intr_handle_t handle)
    405 {
    406 	struct mvmebus_softc *sc;
    407 	int level, vector, last;
    408 
    409 	sc = vsc;
    410 
    411 	/* Extract the interrupt's level and vector */
    412 	level = ((int) handle) >> 8;
    413 	vector = ((int) handle) & 0xff;
    414 
    415 #ifdef DIAGNOSTIC
    416 	if (vector < 0 || vector > 0xff) {
    417 		printf("%s: Illegal vector offset: 0x%x\n",
    418 		    device_xname(sc->sc_dev), vector);
    419 		panic("mvmebus_intr_disestablish");
    420 	}
    421 	if (level < 1 || level > 7) {
    422 		printf("%s: Illegal interrupt level: %d\n",
    423 		    device_xname(sc->sc_dev), level);
    424 		panic("mvmebus_intr_disestablish");
    425 	}
    426 	if (sc->sc_irqref[level] == 0) {
    427 		printf("%s: VMEirq#%d: Reference count already zero!\n",
    428 		    device_xname(sc->sc_dev), level);
    429 		panic("mvmebus_intr_disestablish");
    430 	}
    431 #endif
    432 
    433 	last = (--(sc->sc_irqref[level]) == 0);
    434 
    435 	(*sc->sc_intr_disestablish)(sc->sc_chip, level, vector, last,
    436 	    &sc->sc_evcnt[level - 1]);
    437 }
    438 
    439 #ifdef DIAGNOSTIC
    440 /* ARGSUSED */
    441 int
    442 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)
    443 {
    444 
    445 	panic("Must use vme_dmamap_create() in place of bus_dmamap_create()");
    446 	return (0);	/* Shutup the compiler */
    447 }
    448 
    449 /* ARGSUSED */
    450 void
    451 mvmebus_dummy_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map)
    452 {
    453 
    454 	panic("Must use vme_dmamap_destroy() in place of bus_dmamap_destroy()");
    455 }
    456 #endif
    457 
    458 /* ARGSUSED */
    459 int
    460 mvmebus_dmamap_create(
    461 	void *vsc,
    462 	vme_size_t len,
    463 	vme_am_t am,
    464 	vme_datasize_t datasize,
    465 	vme_swap_t swap,
    466 	int nsegs,
    467 	vme_size_t segsz,
    468 	vme_addr_t bound,
    469 	int flags,
    470 	bus_dmamap_t *mapp)
    471 {
    472 	struct mvmebus_softc *sc = vsc;
    473 	struct mvmebus_dmamap *vmap;
    474 	struct mvmebus_range *vr;
    475 	vme_am_t cap, as;
    476 	int i, rv;
    477 
    478 	cap = MVMEBUS_AM2CAP(am);
    479 	as = am & VME_AM_ADRSIZEMASK;
    480 
    481 	/*
    482 	 * Verify that we even stand a chance of satisfying
    483 	 * the VMEbus address space and datasize requested.
    484 	 */
    485 	for (i = 0, vr = sc->sc_slaves; i < sc->sc_nslaves; i++, vr++) {
    486 		if (vr->vr_am == MVMEBUS_AM_DISABLED)
    487 			continue;
    488 
    489 		if (as == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    490 		    cap == (vr->vr_am & cap) && datasize <= vr->vr_datasize &&
    491 		    len <= (vr->vr_vmeend - vr->vr_vmestart))
    492 			break;
    493 	}
    494 
    495 	if (i == sc->sc_nslaves)
    496 		return (EINVAL);
    497 
    498 	if ((vmap = malloc(sizeof(*vmap), M_DMAMAP,
    499 	    (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL)
    500 		return (ENOMEM);
    501 
    502 
    503 	rv = bus_dmamap_create(sc->sc_dmat, len, nsegs, segsz,
    504 	    bound, flags, mapp);
    505 	if (rv != 0) {
    506 		free(vmap, M_DMAMAP);
    507 		return (rv);
    508 	}
    509 
    510 	vmap->vm_am = am;
    511 	vmap->vm_datasize = datasize;
    512 	vmap->vm_swap = swap;
    513 	vmap->vm_slave = vr;
    514 
    515 	(*mapp)->_dm_cookie = vmap;
    516 
    517 	return (0);
    518 }
    519 
    520 void
    521 mvmebus_dmamap_destroy(void *vsc, bus_dmamap_t map)
    522 {
    523 	struct mvmebus_softc *sc = vsc;
    524 
    525 	free(map->_dm_cookie, M_DMAMAP);
    526 	bus_dmamap_destroy(sc->sc_dmat, map);
    527 }
    528 
    529 static int
    530 mvmebus_dmamap_load_common(struct mvmebus_softc *sc, bus_dmamap_t map)
    531 {
    532 	struct mvmebus_dmamap *vmap = map->_dm_cookie;
    533 	struct mvmebus_range *vr = vmap->vm_slave;
    534 	bus_dma_segment_t *ds;
    535 	vme_am_t cap, am;
    536 	int i;
    537 
    538 	cap = MVMEBUS_AM2CAP(vmap->vm_am);
    539 	am = vmap->vm_am & VME_AM_ADRSIZEMASK;
    540 
    541 	/*
    542 	 * Traverse the list of segments which make up this map, and
    543 	 * convert the CPU-relative addresses therein to VMEbus addresses.
    544 	 */
    545 	for (ds = &map->dm_segs[0]; ds < &map->dm_segs[map->dm_nsegs]; ds++) {
    546 		/*
    547 		 * First, see if this map's slave image can access the
    548 		 * segment, otherwise we have to waste time scanning all
    549 		 * the slave images.
    550 		 */
    551 		vr = vmap->vm_slave;
    552 		if (am == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    553 		    cap == (vr->vr_am & cap) &&
    554 		    vmap->vm_datasize <= vr->vr_datasize &&
    555 		    ds->_ds_cpuaddr >= vr->vr_locstart &&
    556 		    ds->ds_len <= (vr->vr_vmeend - vr->vr_vmestart))
    557 			goto found;
    558 
    559 		for (i = 0, vr = sc->sc_slaves; i < sc->sc_nslaves; i++, vr++) {
    560 			if (vr->vr_am == MVMEBUS_AM_DISABLED)
    561 				continue;
    562 
    563 			/*
    564 			 * Filter out any slave images which don't have the
    565 			 * same VMEbus address modifier and datasize as
    566 			 * this DMA map, and those which don't cover the
    567 			 * physical address region containing the segment.
    568 			 */
    569 			if (vr != vmap->vm_slave &&
    570 			    am == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    571 			    cap == (vr->vr_am & cap) &&
    572 			    vmap->vm_datasize <= vr->vr_datasize &&
    573 			    ds->_ds_cpuaddr >= vr->vr_locstart &&
    574 			    ds->ds_len <= (vr->vr_vmeend - vr->vr_vmestart))
    575 				break;
    576 		}
    577 
    578 		/*
    579 		 * Did we find an applicable slave image which covers this
    580 		 * segment?
    581 		 */
    582 		if (i == sc->sc_nslaves) {
    583 			/*
    584 			 * XXX TODO:
    585 			 *
    586 			 * Bounce this segment via a bounce buffer allocated
    587 			 * from this DMA map.
    588 			 */
    589 			printf("mvmebus_dmamap_load_common: bounce needed!\n");
    590 			return (EINVAL);
    591 		}
    592 
    593 found:
    594 		/*
    595 		 * Generate the VMEbus address of this segment
    596 		 */
    597 		ds->ds_addr = (ds->_ds_cpuaddr - vr->vr_locstart) +
    598 		    vr->vr_vmestart;
    599 	}
    600 
    601 	return (0);
    602 }
    603 
    604 int
    605 mvmebus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf, bus_size_t buflen, struct proc *p, int flags)
    606 {
    607 	struct mvmebus_softc *sc = t->_cookie;
    608 	int rv;
    609 
    610 	rv = bus_dmamap_load(sc->sc_dmat, map, buf, buflen, p, flags);
    611 	if (rv != 0)
    612 		return rv;
    613 
    614 	return mvmebus_dmamap_load_common(sc, map);
    615 }
    616 
    617 int
    618 mvmebus_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map, struct mbuf *chain, int flags)
    619 {
    620 	struct mvmebus_softc *sc = t->_cookie;
    621 	int rv;
    622 
    623 	rv = bus_dmamap_load_mbuf(sc->sc_dmat, map, chain, flags);
    624 	if (rv != 0)
    625 		return rv;
    626 
    627 	return mvmebus_dmamap_load_common(sc, map);
    628 }
    629 
    630 int
    631 mvmebus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio, int flags)
    632 {
    633 	struct mvmebus_softc *sc = t->_cookie;
    634 	int rv;
    635 
    636 	rv = bus_dmamap_load_uio(sc->sc_dmat, map, uio, flags);
    637 	if (rv != 0)
    638 		return rv;
    639 
    640 	return mvmebus_dmamap_load_common(sc, map);
    641 }
    642 
    643 int
    644 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)
    645 {
    646 	struct mvmebus_softc *sc = t->_cookie;
    647 	int rv;
    648 
    649 	/*
    650 	 * mvmebus_dmamem_alloc() will ensure that the physical memory
    651 	 * backing these segments is 100% accessible in at least one
    652 	 * of the board's VMEbus slave images.
    653 	 */
    654 	rv = bus_dmamap_load_raw(sc->sc_dmat, map, segs, nsegs, size, flags);
    655 	if (rv != 0)
    656 		return rv;
    657 
    658 	return mvmebus_dmamap_load_common(sc, map);
    659 }
    660 
    661 void
    662 mvmebus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
    663 {
    664 	struct mvmebus_softc *sc = t->_cookie;
    665 
    666 	/* XXX Deal with bounce buffers */
    667 
    668 	bus_dmamap_unload(sc->sc_dmat, map);
    669 }
    670 
    671 void
    672 mvmebus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset, bus_size_t len, int ops)
    673 {
    674 	struct mvmebus_softc *sc = t->_cookie;
    675 
    676 	/* XXX Bounce buffers */
    677 
    678 	bus_dmamap_sync(sc->sc_dmat, map, offset, len, ops);
    679 }
    680 
    681 #ifdef DIAGNOSTIC
    682 /* ARGSUSED */
    683 int
    684 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)
    685 {
    686 
    687 	panic("Must use vme_dmamem_alloc() in place of bus_dmamem_alloc()");
    688 }
    689 
    690 /* ARGSUSED */
    691 void
    692 mvmebus_dummy_dmamem_free(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs)
    693 {
    694 
    695 	panic("Must use vme_dmamem_free() in place of bus_dmamem_free()");
    696 }
    697 #endif
    698 
    699 /* ARGSUSED */
    700 int
    701 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)
    702 {
    703 	extern paddr_t avail_start;
    704 	struct mvmebus_softc *sc = vsc;
    705 	struct mvmebus_range *vr;
    706 	bus_addr_t low, high;
    707 	bus_size_t bound;
    708 	vme_am_t cap;
    709 	int i;
    710 
    711 	cap = MVMEBUS_AM2CAP(am);
    712 	am &= VME_AM_ADRSIZEMASK;
    713 
    714 	/*
    715 	 * Find a slave mapping in the requested VMEbus address space.
    716 	 */
    717 	for (i = 0, vr = sc->sc_slaves; i < sc->sc_nslaves; i++, vr++) {
    718 		if (vr->vr_am == MVMEBUS_AM_DISABLED)
    719 			continue;
    720 
    721 		if (i == 0 && (flags & BUS_DMA_ONBOARD_RAM) != 0)
    722 			continue;
    723 
    724 		if (am == (vr->vr_am & VME_AM_ADRSIZEMASK) &&
    725 		    cap == (vr->vr_am & cap) && datasize <= vr->vr_datasize &&
    726 		    len <= (vr->vr_vmeend - vr->vr_vmestart))
    727 			break;
    728 	}
    729 	if (i == sc->sc_nslaves)
    730 		return (EINVAL);
    731 
    732 	/*
    733 	 * Set up the constraints so we can allocate physical memory which
    734 	 * is visible in the requested address space
    735 	 */
    736 	low = uimax(vr->vr_locstart, avail_start);
    737 	high = vr->vr_locstart + (vr->vr_vmeend - vr->vr_vmestart) + 1;
    738 	bound = (bus_size_t) vr->vr_mask + 1;
    739 
    740 	/*
    741 	 * Allocate physical memory.
    742 	 *
    743 	 * Note: This fills in the segments with CPU-relative physical
    744 	 * addresses. A further call to bus_dmamap_load_raw() (with a
    745 	 * DMA map which specifies the same VMEbus address space and
    746 	 * constraints as the call to here) must be made. The segments
    747 	 * of the DMA map will then contain VMEbus-relative physical
    748 	 * addresses of the memory allocated here.
    749 	 */
    750 	return _bus_dmamem_alloc_common(sc->sc_dmat, low, high,
    751 	    len, 0, bound, segs, nsegs, rsegs, flags);
    752 }
    753 
    754 void
    755 mvmebus_dmamem_free(void *vsc, bus_dma_segment_t *segs, int nsegs)
    756 {
    757 	struct mvmebus_softc *sc = vsc;
    758 
    759 	bus_dmamem_free(sc->sc_dmat, segs, nsegs);
    760 }
    761 
    762 int
    763 mvmebus_dmamem_map(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs, size_t size, void **kvap, int flags)
    764 {
    765 	struct mvmebus_softc *sc = t->_cookie;
    766 
    767 	return bus_dmamem_map(sc->sc_dmat, segs, nsegs, size, kvap, flags);
    768 }
    769 
    770 void
    771 mvmebus_dmamem_unmap(bus_dma_tag_t t, void *kva, size_t size)
    772 {
    773 	struct mvmebus_softc *sc = t->_cookie;
    774 
    775 	bus_dmamem_unmap(sc->sc_dmat, kva, size);
    776 }
    777 
    778 paddr_t
    779 mvmebus_dmamem_mmap(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs, off_t offset, int prot, int flags)
    780 {
    781 	struct mvmebus_softc *sc = t->_cookie;
    782 
    783 	return bus_dmamem_mmap(sc->sc_dmat, segs, nsegs, offset, prot, flags);
    784 }
    785 
    786 #ifdef DEBUG
    787 static const char *
    788 mvmebus_mod_string(vme_addr_t addr, vme_size_t len, vme_am_t am, vme_datasize_t ds)
    789 {
    790 	static const char *mode[] = {"BLT64)", "DATA)", "PROG)", "BLT32)"};
    791 	static const char *dsiz[] = {"(", "(D8,", "(D16,", "(D16-D8,",
    792 	"(D32,", "(D32,D8,", "(D32-D16,", "(D32-D8,"};
    793 	static const char *adrfmt[] = { "A32:%08x-%08x ", "USR:%08x-%08x ",
    794 	    "A16:%04x-%04x ", "A24:%06x-%06x " };
    795 	static char mstring[40];
    796 
    797 	snprintf(mstring, sizeof(mstring),
    798 	    adrfmt[(am & VME_AM_ADRSIZEMASK) >> VME_AM_ADRSIZESHIFT],
    799 	    addr, addr + len - 1);
    800 	strlcat(mstring, dsiz[ds & 0x7], sizeof(mstring));
    801 
    802 	if (MVMEBUS_AM_HAS_CAP(am)) {
    803 		if (am & MVMEBUS_AM_CAP_DATA)
    804 			strlcat(mstring, "D", sizeof(mstring));
    805 		if (am & MVMEBUS_AM_CAP_PROG)
    806 			strlcat(mstring, "P", sizeof(mstring));
    807 		if (am & MVMEBUS_AM_CAP_USER)
    808 			strlcat(mstring, "U", sizeof(mstring));
    809 		if (am & MVMEBUS_AM_CAP_SUPER)
    810 			strlcat(mstring, "S", sizeof(mstring));
    811 		if (am & MVMEBUS_AM_CAP_BLK)
    812 			strlcat(mstring, "B", sizeof(mstring));
    813 		if (am & MVMEBUS_AM_CAP_BLKD64)
    814 			strlcat(mstring, "6", sizeof(mstring));
    815 		strlcat(mstring, ")", sizeof(mstring));
    816 	} else {
    817 		strlcat(mstring, ((am & VME_AM_PRIVMASK) == VME_AM_USER) ?
    818 		    "USER," : "SUPER,", sizeof(mstring));
    819 		strlcat(mstring, mode[am & VME_AM_MODEMASK], sizeof(mstring));
    820 	}
    821 
    822 	return (mstring);
    823 }
    824 #endif
    825