Home | History | Annotate | Line # | Download | only in dev
iommu.c revision 1.115.16.1
      1  1.115.16.1   thorpej /*	$NetBSD: iommu.c,v 1.115.16.1 2021/05/13 00:47:28 thorpej Exp $	*/
      2        1.82       mrg 
      3        1.82       mrg /*
      4        1.82       mrg  * Copyright (c) 1999, 2000 Matthew R. Green
      5        1.82       mrg  * All rights reserved.
      6        1.82       mrg  *
      7        1.82       mrg  * Redistribution and use in source and binary forms, with or without
      8        1.82       mrg  * modification, are permitted provided that the following conditions
      9        1.82       mrg  * are met:
     10        1.82       mrg  * 1. Redistributions of source code must retain the above copyright
     11        1.82       mrg  *    notice, this list of conditions and the following disclaimer.
     12        1.82       mrg  * 2. Redistributions in binary form must reproduce the above copyright
     13        1.82       mrg  *    notice, this list of conditions and the following disclaimer in the
     14        1.82       mrg  *    documentation and/or other materials provided with the distribution.
     15        1.82       mrg  *
     16        1.82       mrg  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17        1.82       mrg  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18        1.82       mrg  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19        1.82       mrg  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20        1.82       mrg  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21        1.82       mrg  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22        1.82       mrg  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23        1.82       mrg  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24        1.82       mrg  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25        1.82       mrg  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26        1.82       mrg  * SUCH DAMAGE.
     27        1.82       mrg  */
     28         1.7       mrg 
     29         1.7       mrg /*
     30        1.48       eeh  * Copyright (c) 2001, 2002 Eduardo Horvath
     31         1.7       mrg  * All rights reserved.
     32         1.7       mrg  *
     33         1.7       mrg  * Redistribution and use in source and binary forms, with or without
     34         1.7       mrg  * modification, are permitted provided that the following conditions
     35         1.7       mrg  * are met:
     36         1.7       mrg  * 1. Redistributions of source code must retain the above copyright
     37         1.7       mrg  *    notice, this list of conditions and the following disclaimer.
     38         1.7       mrg  * 2. Redistributions in binary form must reproduce the above copyright
     39         1.7       mrg  *    notice, this list of conditions and the following disclaimer in the
     40         1.7       mrg  *    documentation and/or other materials provided with the distribution.
     41         1.7       mrg  * 3. The name of the author may not be used to endorse or promote products
     42         1.7       mrg  *    derived from this software without specific prior written permission.
     43         1.7       mrg  *
     44         1.7       mrg  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     45         1.7       mrg  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     46         1.7       mrg  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     47         1.7       mrg  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     48         1.7       mrg  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     49         1.7       mrg  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     50         1.7       mrg  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     51         1.7       mrg  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     52         1.7       mrg  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     53         1.7       mrg  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     54         1.7       mrg  * SUCH DAMAGE.
     55         1.7       mrg  */
     56         1.1       mrg 
     57         1.7       mrg /*
     58         1.7       mrg  * UltraSPARC IOMMU support; used by both the sbus and pci code.
     59         1.7       mrg  */
     60        1.66     lukem 
     61        1.66     lukem #include <sys/cdefs.h>
     62  1.115.16.1   thorpej __KERNEL_RCSID(0, "$NetBSD: iommu.c,v 1.115.16.1 2021/05/13 00:47:28 thorpej Exp $");
     63        1.66     lukem 
     64         1.4       mrg #include "opt_ddb.h"
     65         1.4       mrg 
     66         1.1       mrg #include <sys/param.h>
     67         1.1       mrg #include <sys/extent.h>
     68         1.1       mrg #include <sys/malloc.h>
     69         1.1       mrg #include <sys/systm.h>
     70         1.1       mrg #include <sys/device.h>
     71        1.41       chs #include <sys/proc.h>
     72        1.18       mrg 
     73       1.100  uebayasi #include <uvm/uvm.h>
     74         1.1       mrg 
     75       1.104    dyoung #include <sys/bus.h>
     76         1.1       mrg #include <sparc64/dev/iommureg.h>
     77         1.1       mrg #include <sparc64/dev/iommuvar.h>
     78         1.1       mrg 
     79         1.1       mrg #include <machine/autoconf.h>
     80         1.1       mrg #include <machine/cpu.h>
     81       1.110  nakayama #include <machine/hypervisor.h>
     82         1.1       mrg 
     83         1.1       mrg #ifdef DEBUG
     84        1.22       mrg #define IDB_BUSDMA	0x1
     85        1.22       mrg #define IDB_IOMMU	0x2
     86        1.22       mrg #define IDB_INFO	0x4
     87        1.36       eeh #define	IDB_SYNC	0x8
     88        1.10       mrg int iommudebug = 0x0;
     89         1.4       mrg #define DPRINTF(l, s)   do { if (iommudebug & l) printf s; } while (0)
     90        1.90  nakayama #define IOTTE_DEBUG(n)	(n)
     91         1.4       mrg #else
     92         1.4       mrg #define DPRINTF(l, s)
     93        1.90  nakayama #define IOTTE_DEBUG(n)	0
     94         1.1       mrg #endif
     95         1.1       mrg 
     96        1.55       eeh #define iommu_strbuf_flush(i, v) do {					\
     97        1.55       eeh 	if ((i)->sb_flush)						\
     98        1.55       eeh 		bus_space_write_8((i)->sb_is->is_bustag, (i)->sb_sb,	\
     99        1.50       eeh 			STRBUFREG(strbuf_pgflush), (v));		\
    100        1.42       eeh 	} while (0)
    101        1.42       eeh 
    102        1.78       cdi static	int iommu_strbuf_flush_done(struct strbuf_ctl *);
    103        1.85  nakayama static	void _iommu_dvmamap_sync(bus_dma_tag_t, bus_dmamap_t, bus_addr_t,
    104        1.85  nakayama 		bus_size_t, int);
    105       1.109     palle static void iommu_enter_sun4u(struct strbuf_ctl *sb, vaddr_t va, int64_t pa, int flags);
    106       1.109     palle static void iommu_enter_sun4v(struct strbuf_ctl *sb, vaddr_t va, int64_t pa, int flags);
    107       1.109     palle static void iommu_remove_sun4u(struct iommu_state *is, vaddr_t va, size_t len);
    108       1.109     palle static void iommu_remove_sun4v(struct iommu_state *is, vaddr_t va, size_t len);
    109        1.11       eeh 
    110         1.1       mrg /*
    111         1.1       mrg  * initialise the UltraSPARC IOMMU (SBUS or PCI):
    112         1.1       mrg  *	- allocate and setup the iotsb.
    113         1.1       mrg  *	- enable the IOMMU
    114         1.7       mrg  *	- initialise the streaming buffers (if they exist)
    115         1.1       mrg  *	- create a private DVMA map.
    116         1.1       mrg  */
    117         1.1       mrg void
    118        1.79       cdi iommu_init(char *name, struct iommu_state *is, int tsbsize, uint32_t iovabase)
    119         1.1       mrg {
    120        1.11       eeh 	psize_t size;
    121        1.11       eeh 	vaddr_t va;
    122        1.11       eeh 	paddr_t pa;
    123        1.58       chs 	struct vm_page *pg;
    124        1.58       chs 	struct pglist pglist;
    125         1.1       mrg 
    126       1.109     palle 	DPRINTF(IDB_INFO, ("iommu_init: tsbsize %x iovabase %x\n", tsbsize, iovabase));
    127       1.109     palle 
    128         1.1       mrg 	/*
    129         1.1       mrg 	 * Setup the iommu.
    130         1.1       mrg 	 *
    131        1.45       eeh 	 * The sun4u iommu is part of the SBUS or PCI controller so we will
    132        1.45       eeh 	 * deal with it here..
    133         1.1       mrg 	 *
    134        1.45       eeh 	 * For sysio and psycho/psycho+ the IOMMU address space always ends at
    135        1.45       eeh 	 * 0xffffe000, but the starting address depends on the size of the
    136        1.45       eeh 	 * map.  The map size is 1024 * 2 ^ is->is_tsbsize entries, where each
    137        1.45       eeh 	 * entry is 8 bytes.  The start of the map can be calculated by
    138        1.45       eeh 	 * (0xffffe000 << (8 + is->is_tsbsize)).
    139        1.45       eeh 	 *
    140        1.45       eeh 	 * But sabre and hummingbird use a different scheme that seems to
    141        1.45       eeh 	 * be hard-wired, so we read the start and size from the PROM and
    142        1.45       eeh 	 * just use those values.
    143         1.2       eeh 	 */
    144       1.108     palle 	if (strncmp(name, "pyro", 4) == 0) {
    145       1.108     palle 		is->is_cr = IOMMUREG_READ(is, iommu_cr);
    146       1.108     palle 		is->is_cr &= ~IOMMUCR_FIRE_BE;
    147       1.108     palle 		is->is_cr |= (IOMMUCR_FIRE_SE | IOMMUCR_FIRE_CM_EN |
    148       1.108     palle 		    IOMMUCR_FIRE_TE);
    149       1.108     palle 	} else
    150       1.108     palle 		is->is_cr = IOMMUCR_EN;
    151        1.11       eeh 	is->is_tsbsize = tsbsize;
    152        1.45       eeh 	if (iovabase == -1) {
    153        1.45       eeh 		is->is_dvmabase = IOTSB_VSTART(is->is_tsbsize);
    154        1.90  nakayama 		is->is_dvmaend = IOTSB_VEND - 1;
    155        1.45       eeh 	} else {
    156        1.45       eeh 		is->is_dvmabase = iovabase;
    157        1.90  nakayama 		is->is_dvmaend = iovabase + IOTSB_VSIZE(tsbsize) - 1;
    158        1.45       eeh 	}
    159        1.11       eeh 
    160        1.11       eeh 	/*
    161        1.15       eeh 	 * Allocate memory for I/O pagetables.  They need to be physically
    162        1.15       eeh 	 * contiguous.
    163        1.11       eeh 	 */
    164        1.11       eeh 
    165        1.64   thorpej 	size = PAGE_SIZE << is->is_tsbsize;
    166        1.11       eeh 	if (uvm_pglistalloc((psize_t)size, (paddr_t)0, (paddr_t)-1,
    167        1.64   thorpej 		(paddr_t)PAGE_SIZE, (paddr_t)0, &pglist, 1, 0) != 0)
    168        1.11       eeh 		panic("iommu_init: no memory");
    169        1.11       eeh 
    170        1.76      yamt 	va = uvm_km_alloc(kernel_map, size, 0, UVM_KMF_VAONLY);
    171        1.11       eeh 	if (va == 0)
    172        1.11       eeh 		panic("iommu_init: no memory");
    173        1.11       eeh 	is->is_tsb = (int64_t *)va;
    174        1.11       eeh 
    175        1.58       chs 	is->is_ptsb = VM_PAGE_TO_PHYS(TAILQ_FIRST(&pglist));
    176        1.11       eeh 
    177        1.11       eeh 	/* Map the pages */
    178        1.83        ad 	TAILQ_FOREACH(pg, &pglist, pageq.queue) {
    179        1.58       chs 		pa = VM_PAGE_TO_PHYS(pg);
    180        1.88    cegger 		pmap_kenter_pa(va, pa | PMAP_NVC,
    181        1.88    cegger 		    VM_PROT_READ | VM_PROT_WRITE, 0);
    182        1.64   thorpej 		va += PAGE_SIZE;
    183        1.11       eeh 	}
    184        1.38     chris 	pmap_update(pmap_kernel());
    185        1.58       chs 	memset(is->is_tsb, 0, size);
    186         1.1       mrg 
    187         1.1       mrg #ifdef DEBUG
    188       1.102       mrg 	if (iommudebug & IDB_INFO)
    189         1.1       mrg 	{
    190         1.1       mrg 		/* Probe the iommu */
    191       1.109     palle 		if (!CPU_ISSUN4V) {
    192       1.109     palle 			printf("iommu cr=%llx tsb=%llx\n",
    193       1.109     palle 			    (unsigned long long)bus_space_read_8(is->is_bustag,
    194        1.50       eeh 				is->is_iommu,
    195       1.103       mrg 				offsetof(struct iommureg, iommu_cr)),
    196       1.109     palle 			    (unsigned long long)bus_space_read_8(is->is_bustag,
    197        1.50       eeh 				is->is_iommu,
    198       1.103       mrg 				offsetof(struct iommureg, iommu_tsb)));
    199       1.109     palle 			printf("TSB base %p phys %llx\n", (void *)is->is_tsb,
    200       1.109     palle 			    (unsigned long long)is->is_ptsb);
    201       1.109     palle 			delay(1000000); /* 1 s */
    202       1.109     palle 		}
    203         1.1       mrg 	}
    204         1.1       mrg #endif
    205         1.1       mrg 
    206         1.1       mrg 	/*
    207         1.1       mrg 	 * Now all the hardware's working we need to allocate a dvma map.
    208         1.1       mrg 	 */
    209        1.98       mrg 	aprint_debug("DVMA map: %x to %x\n",
    210        1.11       eeh 		(unsigned int)is->is_dvmabase,
    211        1.45       eeh 		(unsigned int)is->is_dvmaend);
    212        1.98       mrg 	aprint_debug("IOTSB: %llx to %llx\n",
    213        1.47       eeh 		(unsigned long long)is->is_ptsb,
    214        1.90  nakayama 		(unsigned long long)(is->is_ptsb + size - 1));
    215         1.1       mrg 	is->is_dvmamap = extent_create(name,
    216        1.90  nakayama 	    is->is_dvmabase, is->is_dvmaend,
    217       1.106      para 	    0, 0, EX_NOWAIT);
    218       1.109     palle 	if (!is->is_dvmamap)
    219       1.109     palle 		panic("iommu_init: extent_create() failed");
    220       1.109     palle 
    221       1.107       mrg 	mutex_init(&is->is_lock, MUTEX_DEFAULT, IPL_HIGH);
    222       1.107       mrg 
    223       1.103       mrg 	/*
    224       1.103       mrg 	 * Set the TSB size.  The relevant bits were moved to the TSB
    225       1.103       mrg 	 * base register in the PCIe host bridges.
    226       1.103       mrg 	 */
    227       1.103       mrg 	if (is->is_flags & IOMMU_TSBSIZE_IN_PTSB)
    228       1.103       mrg 		is->is_ptsb |= is->is_tsbsize;
    229       1.103       mrg 	else
    230       1.103       mrg 		is->is_cr |= (is->is_tsbsize << 16);
    231       1.103       mrg 
    232       1.103       mrg 	/*
    233       1.103       mrg 	 * now actually start up the IOMMU
    234       1.103       mrg 	 */
    235       1.103       mrg 	iommu_reset(is);
    236         1.1       mrg }
    237         1.1       mrg 
    238         1.8       mrg /*
    239         1.8       mrg  * Streaming buffers don't exist on the UltraSPARC IIi; we should have
    240         1.8       mrg  * detected that already and disabled them.  If not, we will notice that
    241         1.8       mrg  * they aren't there when the STRBUF_EN bit does not remain.
    242         1.8       mrg  */
    243         1.1       mrg void
    244        1.78       cdi iommu_reset(struct iommu_state *is)
    245         1.1       mrg {
    246        1.45       eeh 	int i;
    247        1.55       eeh 	struct strbuf_ctl *sb;
    248         1.1       mrg 
    249       1.109     palle 	if (CPU_ISSUN4V)
    250       1.109     palle 		return;
    251       1.109     palle 
    252       1.103       mrg 	IOMMUREG_WRITE(is, iommu_tsb, is->is_ptsb);
    253        1.50       eeh 
    254        1.11       eeh 	/* Enable IOMMU in diagnostic mode */
    255       1.103       mrg 	IOMMUREG_WRITE(is, iommu_cr, is->is_cr|IOMMUCR_DE);
    256        1.11       eeh 
    257        1.58       chs 	for (i = 0; i < 2; i++) {
    258        1.55       eeh 		if ((sb = is->is_sb[i])) {
    259         1.5       mrg 
    260        1.45       eeh 			/* Enable diagnostics mode? */
    261        1.58       chs 			bus_space_write_8(is->is_bustag, is->is_sb[i]->sb_sb,
    262        1.50       eeh 				STRBUFREG(strbuf_ctl), STRBUF_EN);
    263        1.45       eeh 
    264       1.105  nakayama 			membar_Lookaside();
    265       1.103       mrg 
    266        1.45       eeh 			/* No streaming buffers? Disable them */
    267        1.58       chs 			if (bus_space_read_8(is->is_bustag,
    268        1.58       chs 				is->is_sb[i]->sb_sb,
    269        1.55       eeh 				STRBUFREG(strbuf_ctl)) == 0) {
    270        1.55       eeh 				is->is_sb[i]->sb_flush = NULL;
    271        1.55       eeh 			} else {
    272        1.58       chs 
    273        1.55       eeh 				/*
    274        1.55       eeh 				 * locate the pa of the flush buffer.
    275        1.55       eeh 				 */
    276       1.103       mrg 				if (pmap_extract(pmap_kernel(),
    277       1.103       mrg 				     (vaddr_t)is->is_sb[i]->sb_flush,
    278       1.103       mrg 				     &is->is_sb[i]->sb_flushpa) == FALSE)
    279       1.103       mrg 					is->is_sb[i]->sb_flush = NULL;
    280        1.55       eeh 			}
    281        1.45       eeh 		}
    282        1.42       eeh 	}
    283       1.103       mrg 
    284       1.103       mrg 	if (is->is_flags & IOMMU_FLUSH_CACHE)
    285       1.103       mrg 		IOMMUREG_WRITE(is, iommu_cache_invalidate, -1ULL);
    286         1.2       eeh }
    287         1.2       eeh 
    288         1.2       eeh /*
    289        1.58       chs  * Here are the iommu control routines.
    290         1.2       eeh  */
    291       1.109     palle 
    292  1.115.16.1   thorpej static void
    293        1.78       cdi iommu_enter(struct strbuf_ctl *sb, vaddr_t va, int64_t pa, int flags)
    294         1.2       eeh {
    295       1.109     palle 	DPRINTF(IDB_IOMMU, ("iommu_enter: va %lx pa %lx flags %x\n",
    296       1.109     palle 	    va, (long)pa, flags));
    297       1.109     palle 	if (!CPU_ISSUN4V)
    298       1.109     palle 		iommu_enter_sun4u(sb, va, pa, flags);
    299       1.109     palle 	else
    300       1.109     palle 		iommu_enter_sun4v(sb, va, pa, flags);
    301       1.109     palle }
    302       1.109     palle 
    303       1.109     palle 
    304       1.109     palle void
    305       1.109     palle iommu_enter_sun4u(struct strbuf_ctl *sb, vaddr_t va, int64_t pa, int flags)
    306       1.109     palle {
    307        1.55       eeh 	struct iommu_state *is = sb->sb_is;
    308        1.55       eeh 	int strbuf = (flags & BUS_DMA_STREAMING);
    309         1.2       eeh 	int64_t tte;
    310         1.2       eeh 
    311         1.2       eeh #ifdef DIAGNOSTIC
    312        1.45       eeh 	if (va < is->is_dvmabase || va > is->is_dvmaend)
    313        1.13       mrg 		panic("iommu_enter: va %#lx not in DVMA space", va);
    314         1.2       eeh #endif
    315         1.2       eeh 
    316        1.55       eeh 	/* Is the streamcache flush really needed? */
    317        1.91  nakayama 	if (sb->sb_flush)
    318        1.55       eeh 		iommu_strbuf_flush(sb, va);
    319        1.91  nakayama 	else
    320        1.55       eeh 		/* If we can't flush the strbuf don't enable it. */
    321        1.55       eeh 		strbuf = 0;
    322        1.55       eeh 
    323        1.58       chs 	tte = MAKEIOTTE(pa, !(flags & BUS_DMA_NOWRITE),
    324        1.55       eeh 		!(flags & BUS_DMA_NOCACHE), (strbuf));
    325        1.50       eeh #ifdef DEBUG
    326        1.50       eeh 	tte |= (flags & 0xff000LL)<<(4*8);
    327        1.50       eeh #endif
    328        1.58       chs 
    329         1.2       eeh 	is->is_tsb[IOTSBSLOT(va,is->is_tsbsize)] = tte;
    330        1.58       chs 	bus_space_write_8(is->is_bustag, is->is_iommu,
    331        1.50       eeh 		IOMMUREG(iommu_flush), va);
    332       1.103       mrg 	DPRINTF(IDB_IOMMU, ("iommu_enter: slot %d va %lx pa %lx "
    333       1.103       mrg 		"TSB[%lx]@%p=%lx\n", (int)IOTSBSLOT(va,is->is_tsbsize),
    334        1.50       eeh 		va, (long)pa, (u_long)IOTSBSLOT(va,is->is_tsbsize),
    335        1.50       eeh 		(void *)(u_long)&is->is_tsb[IOTSBSLOT(va,is->is_tsbsize)],
    336        1.50       eeh 		(u_long)tte));
    337        1.39       eeh }
    338        1.39       eeh 
    339       1.109     palle void
    340       1.109     palle iommu_enter_sun4v(struct strbuf_ctl *sb, vaddr_t va, int64_t pa, int flags)
    341       1.109     palle {
    342       1.109     palle 	struct iommu_state *is = sb->sb_is;
    343       1.109     palle 	u_int64_t tsbid = IOTSBSLOT(va, is->is_tsbsize);
    344       1.109     palle 	paddr_t page_list[1], addr;
    345       1.109     palle 	u_int64_t attr, nmapped;
    346       1.109     palle 	int err;
    347       1.109     palle 
    348       1.109     palle #ifdef DIAGNOSTIC
    349       1.109     palle 	if (va < is->is_dvmabase || (va + PAGE_MASK) > is->is_dvmaend)
    350       1.109     palle 		panic("viommu_enter: va %#lx not in DVMA space", va);
    351       1.109     palle #endif
    352       1.109     palle 
    353       1.109     palle 	attr = PCI_MAP_ATTR_READ | PCI_MAP_ATTR_WRITE;
    354       1.109     palle 	if (flags & BUS_DMA_READ)
    355       1.109     palle 		attr &= ~PCI_MAP_ATTR_READ;
    356       1.109     palle 	if (flags & BUS_DMA_WRITE)
    357       1.109     palle 		attr &= ~PCI_MAP_ATTR_WRITE;
    358       1.109     palle 
    359       1.109     palle 	page_list[0] = trunc_page(pa);
    360       1.109     palle 	if (!pmap_extract(pmap_kernel(), (vaddr_t)page_list, &addr))
    361       1.109     palle 		panic("viommu_enter: pmap_extract failed");
    362       1.109     palle 	err = hv_pci_iommu_map(is->is_devhandle, tsbid, 1, attr,
    363       1.109     palle 	    addr, &nmapped);
    364       1.109     palle 	if (err != H_EOK || nmapped != 1)
    365       1.109     palle 		panic("hv_pci_iommu_map: err=%d, nmapped=%lu", err, (long unsigned int)nmapped);
    366       1.109     palle }
    367       1.109     palle 
    368        1.39       eeh /*
    369        1.39       eeh  * Find the value of a DVMA address (debug routine).
    370        1.39       eeh  */
    371        1.39       eeh paddr_t
    372        1.78       cdi iommu_extract(struct iommu_state *is, vaddr_t dva)
    373        1.39       eeh {
    374        1.39       eeh 	int64_t tte = 0;
    375        1.58       chs 
    376        1.90  nakayama 	if (dva >= is->is_dvmabase && dva <= is->is_dvmaend)
    377        1.55       eeh 		tte = is->is_tsb[IOTSBSLOT(dva, is->is_tsbsize)];
    378        1.39       eeh 
    379        1.54       eeh 	if ((tte & IOTTE_V) == 0)
    380        1.39       eeh 		return ((paddr_t)-1L);
    381        1.54       eeh 	return (tte & IOTTE_PAMASK);
    382         1.2       eeh }
    383         1.2       eeh 
    384         1.2       eeh /*
    385         1.2       eeh  * iommu_remove: removes mappings created by iommu_enter
    386         1.2       eeh  *
    387         1.2       eeh  * Only demap from IOMMU if flag is set.
    388         1.8       mrg  *
    389         1.8       mrg  * XXX: this function needs better internal error checking.
    390         1.2       eeh  */
    391       1.109     palle 
    392  1.115.16.1   thorpej static void
    393        1.78       cdi iommu_remove(struct iommu_state *is, vaddr_t va, size_t len)
    394         1.2       eeh {
    395       1.109     palle 	DPRINTF(IDB_IOMMU, ("iommu_remove: va %lx len %zu\n", va, len));
    396       1.109     palle 	if (!CPU_ISSUN4V)
    397       1.109     palle 		iommu_remove_sun4u(is, va, len);
    398       1.109     palle 	else
    399       1.109     palle 		iommu_remove_sun4v(is, va, len);
    400       1.109     palle }
    401       1.109     palle 
    402       1.109     palle void
    403       1.109     palle iommu_remove_sun4u(struct iommu_state *is, vaddr_t va, size_t len)
    404       1.109     palle {
    405       1.109     palle 
    406       1.103       mrg 	int slot;
    407         1.2       eeh 
    408         1.2       eeh #ifdef DIAGNOSTIC
    409        1.45       eeh 	if (va < is->is_dvmabase || va > is->is_dvmaend)
    410        1.25       mrg 		panic("iommu_remove: va 0x%lx not in DVMA space", (u_long)va);
    411         1.2       eeh 	if ((long)(va + len) < (long)va)
    412        1.58       chs 		panic("iommu_remove: va 0x%lx + len 0x%lx wraps",
    413         1.2       eeh 		      (long) va, (long) len);
    414        1.58       chs 	if (len & ~0xfffffff)
    415        1.72       snj 		panic("iommu_remove: ridiculous len 0x%lx", (u_long)len);
    416         1.2       eeh #endif
    417         1.2       eeh 
    418         1.2       eeh 	va = trunc_page(va);
    419        1.22       mrg 	DPRINTF(IDB_IOMMU, ("iommu_remove: va %lx TSB[%lx]@%p\n",
    420        1.50       eeh 		va, (u_long)IOTSBSLOT(va, is->is_tsbsize),
    421        1.50       eeh 		&is->is_tsb[IOTSBSLOT(va, is->is_tsbsize)]));
    422         1.2       eeh 	while (len > 0) {
    423        1.50       eeh 		DPRINTF(IDB_IOMMU, ("iommu_remove: clearing TSB slot %d "
    424        1.50       eeh 			"for va %p size %lx\n",
    425        1.50       eeh 			(int)IOTSBSLOT(va,is->is_tsbsize), (void *)(u_long)va,
    426        1.50       eeh 			(u_long)len));
    427        1.64   thorpej 		if (len <= PAGE_SIZE)
    428        1.10       mrg 			len = 0;
    429        1.10       mrg 		else
    430        1.64   thorpej 			len -= PAGE_SIZE;
    431         1.8       mrg 
    432        1.99       mrg #if 0
    433        1.94  nakayama 		/*
    434        1.94  nakayama 		 * XXX Zero-ing the entry would not require RMW
    435        1.94  nakayama 		 *
    436        1.94  nakayama 		 * Disabling valid bit while a page is used by a device
    437        1.94  nakayama 		 * causes an uncorrectable DMA error.
    438        1.94  nakayama 		 * Workaround to avoid an uncorrectable DMA error is
    439        1.94  nakayama 		 * eliminating the next line, but the page is mapped
    440        1.94  nakayama 		 * until the next iommu_enter call.
    441        1.94  nakayama 		 */
    442        1.47       eeh 		is->is_tsb[IOTSBSLOT(va,is->is_tsbsize)] &= ~IOTTE_V;
    443       1.105  nakayama 		membar_StoreStore();
    444        1.99       mrg #endif
    445       1.103       mrg 		IOMMUREG_WRITE(is, iommu_flush, va);
    446       1.103       mrg 
    447       1.103       mrg 		/* Flush cache if necessary. */
    448       1.103       mrg 		slot = IOTSBSLOT(trunc_page(va), is->is_tsbsize);
    449       1.103       mrg 		if ((is->is_flags & IOMMU_FLUSH_CACHE) &&
    450       1.103       mrg 		    (len == 0 || (slot % 8) == 7))
    451       1.103       mrg 			IOMMUREG_WRITE(is, iommu_cache_flush,
    452       1.103       mrg 			    is->is_ptsb + slot * 8);
    453       1.103       mrg 
    454        1.64   thorpej 		va += PAGE_SIZE;
    455         1.2       eeh 	}
    456         1.2       eeh }
    457         1.2       eeh 
    458       1.109     palle void
    459       1.109     palle iommu_remove_sun4v(struct iommu_state *is, vaddr_t va, size_t len)
    460       1.109     palle {
    461       1.109     palle 	u_int64_t tsbid = IOTSBSLOT(va, is->is_tsbsize);
    462       1.109     palle 	u_int64_t ndemapped;
    463       1.109     palle 	int err;
    464       1.109     palle 
    465       1.109     palle #ifdef DIAGNOSTIC
    466       1.109     palle 	if (va < is->is_dvmabase || (va + PAGE_MASK) > is->is_dvmaend)
    467       1.109     palle 		panic("iommu_remove: va 0x%lx not in DVMA space", (u_long)va);
    468       1.109     palle 	if (va != trunc_page(va)) {
    469       1.109     palle 		printf("iommu_remove: unaligned va: %lx\n", va);
    470       1.109     palle 		va = trunc_page(va);
    471       1.109     palle 	}
    472       1.109     palle #endif
    473       1.109     palle 
    474       1.109     palle 	err = hv_pci_iommu_demap(is->is_devhandle, tsbid, 1, &ndemapped);
    475       1.109     palle 	if (err != H_EOK || ndemapped != 1)
    476       1.109     palle 		panic("hv_pci_iommu_unmap: err=%d", err);
    477       1.109     palle }
    478       1.109     palle 
    479        1.58       chs static int
    480        1.78       cdi iommu_strbuf_flush_done(struct strbuf_ctl *sb)
    481         1.2       eeh {
    482        1.55       eeh 	struct iommu_state *is = sb->sb_is;
    483         1.2       eeh 	struct timeval cur, flushtimeout;
    484         1.2       eeh 
    485         1.2       eeh #define BUMPTIME(t, usec) { \
    486         1.2       eeh 	register volatile struct timeval *tp = (t); \
    487         1.2       eeh 	register long us; \
    488         1.2       eeh  \
    489         1.2       eeh 	tp->tv_usec = us = tp->tv_usec + (usec); \
    490         1.2       eeh 	if (us >= 1000000) { \
    491         1.2       eeh 		tp->tv_usec = us - 1000000; \
    492         1.2       eeh 		tp->tv_sec++; \
    493         1.2       eeh 	} \
    494         1.2       eeh }
    495         1.5       mrg 
    496        1.55       eeh 	if (!sb->sb_flush)
    497         1.5       mrg 		return (0);
    498        1.58       chs 
    499         1.7       mrg 	/*
    500         1.7       mrg 	 * Streaming buffer flushes:
    501        1.58       chs 	 *
    502         1.7       mrg 	 *   1 Tell strbuf to flush by storing va to strbuf_pgflush.  If
    503         1.7       mrg 	 *     we're not on a cache line boundary (64-bits):
    504         1.7       mrg 	 *   2 Store 0 in flag
    505         1.7       mrg 	 *   3 Store pointer to flag in flushsync
    506         1.7       mrg 	 *   4 wait till flushsync becomes 0x1
    507         1.7       mrg 	 *
    508         1.7       mrg 	 * If it takes more than .5 sec, something
    509         1.7       mrg 	 * went wrong.
    510         1.7       mrg 	 */
    511         1.2       eeh 
    512        1.55       eeh 	*sb->sb_flush = 0;
    513        1.58       chs 	bus_space_write_8(is->is_bustag, sb->sb_sb,
    514        1.55       eeh 		STRBUFREG(strbuf_flushsync), sb->sb_flushpa);
    515         1.2       eeh 
    516        1.58       chs 	microtime(&flushtimeout);
    517         1.2       eeh 	cur = flushtimeout;
    518         1.2       eeh 	BUMPTIME(&flushtimeout, 500000); /* 1/2 sec */
    519        1.58       chs 
    520       1.103       mrg 	DPRINTF(IDB_IOMMU, ("%s: flush = %lx at va = %lx pa = %lx now="
    521       1.103       mrg 		"%"PRIx64":%"PRIx32" until = %"PRIx64":%"PRIx32"\n", __func__,
    522        1.58       chs 		(long)*sb->sb_flush, (long)sb->sb_flush, (long)sb->sb_flushpa,
    523        1.42       eeh 		cur.tv_sec, cur.tv_usec,
    524        1.42       eeh 		flushtimeout.tv_sec, flushtimeout.tv_usec));
    525        1.42       eeh 
    526         1.2       eeh 	/* Bypass non-coherent D$ */
    527        1.55       eeh 	while ((!ldxa(sb->sb_flushpa, ASI_PHYS_CACHED)) &&
    528        1.98       mrg 	       timercmp(&cur, &flushtimeout, <=))
    529         1.2       eeh 		microtime(&cur);
    530         1.2       eeh 
    531         1.2       eeh #ifdef DIAGNOSTIC
    532        1.55       eeh 	if (!ldxa(sb->sb_flushpa, ASI_PHYS_CACHED)) {
    533       1.103       mrg 		printf("%s: flush timeout %p, at %p\n", __func__,
    534        1.55       eeh 			(void *)(u_long)*sb->sb_flush,
    535        1.55       eeh 			(void *)(u_long)sb->sb_flushpa); /* panic? */
    536         1.2       eeh #ifdef DDB
    537         1.2       eeh 		Debugger();
    538         1.2       eeh #endif
    539         1.2       eeh 	}
    540         1.2       eeh #endif
    541       1.103       mrg 	DPRINTF(IDB_IOMMU, ("%s: flushed\n", __func__));
    542        1.55       eeh 	return (*sb->sb_flush);
    543         1.7       mrg }
    544         1.7       mrg 
    545         1.7       mrg /*
    546         1.7       mrg  * IOMMU DVMA operations, common to SBUS and PCI.
    547         1.7       mrg  */
    548         1.7       mrg int
    549        1.85  nakayama iommu_dvmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
    550        1.85  nakayama 	bus_size_t buflen, struct proc *p, int flags)
    551         1.7       mrg {
    552        1.85  nakayama 	struct strbuf_ctl *sb = (struct strbuf_ctl *)map->_dm_cookie;
    553        1.55       eeh 	struct iommu_state *is = sb->sb_is;
    554        1.91  nakayama 	int err, needsflush;
    555         1.7       mrg 	bus_size_t sgsize;
    556         1.7       mrg 	paddr_t curaddr;
    557        1.90  nakayama 	u_long dvmaddr, sgstart, sgend, bmask;
    558        1.71   tsutsui 	bus_size_t align, boundary, len;
    559         1.7       mrg 	vaddr_t vaddr = (vaddr_t)buf;
    560        1.40       eeh 	int seg;
    561        1.58       chs 	struct pmap *pmap;
    562       1.103       mrg 	int slot;
    563         1.7       mrg 
    564         1.7       mrg 	if (map->dm_nsegs) {
    565         1.7       mrg 		/* Already in use?? */
    566         1.7       mrg #ifdef DIAGNOSTIC
    567         1.7       mrg 		printf("iommu_dvmamap_load: map still in use\n");
    568         1.7       mrg #endif
    569         1.7       mrg 		bus_dmamap_unload(t, map);
    570         1.7       mrg 	}
    571        1.58       chs 
    572         1.7       mrg 	/*
    573         1.7       mrg 	 * Make sure that on error condition we return "no valid mappings".
    574         1.7       mrg 	 */
    575         1.7       mrg 	map->dm_nsegs = 0;
    576        1.96  nakayama 	KASSERT(map->dm_maxsegsz <= map->_dm_maxmaxsegsz);
    577        1.96  nakayama 
    578         1.7       mrg 	if (buflen > map->_dm_size) {
    579        1.22       mrg 		DPRINTF(IDB_BUSDMA,
    580         1.7       mrg 		    ("iommu_dvmamap_load(): error %d > %d -- "
    581        1.25       mrg 		     "map size exceeded!\n", (int)buflen, (int)map->_dm_size));
    582         1.7       mrg 		return (EINVAL);
    583         1.7       mrg 	}
    584         1.7       mrg 
    585         1.7       mrg 	sgsize = round_page(buflen + ((int)vaddr & PGOFSET));
    586        1.20       mrg 
    587         1.7       mrg 	/*
    588        1.21       eeh 	 * A boundary presented to bus_dmamem_alloc() takes precedence
    589        1.21       eeh 	 * over boundary in the map.
    590         1.7       mrg 	 */
    591        1.21       eeh 	if ((boundary = (map->dm_segs[0]._ds_boundary)) == 0)
    592        1.21       eeh 		boundary = map->_dm_boundary;
    593       1.114  riastrad 	align = uimax(map->dm_segs[0]._ds_align, PAGE_SIZE);
    594        1.58       chs 
    595        1.58       chs 	/*
    596        1.58       chs 	 * If our segment size is larger than the boundary we need to
    597        1.40       eeh 	 * split the transfer up int little pieces ourselves.
    598        1.40       eeh 	 */
    599       1.103       mrg 	KASSERT(is->is_dvmamap);
    600       1.107       mrg 	mutex_enter(&is->is_lock);
    601        1.58       chs 	err = extent_alloc(is->is_dvmamap, sgsize, align,
    602        1.71   tsutsui 	    (sgsize > boundary) ? 0 : boundary,
    603        1.71   tsutsui 	    EX_NOWAIT|EX_BOUNDZERO, &dvmaddr);
    604       1.107       mrg 	mutex_exit(&is->is_lock);
    605         1.7       mrg 
    606         1.7       mrg #ifdef DEBUG
    607        1.71   tsutsui 	if (err || (dvmaddr == (u_long)-1)) {
    608         1.7       mrg 		printf("iommu_dvmamap_load(): extent_alloc(%d, %x) failed!\n",
    609        1.25       mrg 		    (int)sgsize, flags);
    610        1.40       eeh #ifdef DDB
    611         1.7       mrg 		Debugger();
    612        1.40       eeh #endif
    613        1.58       chs 	}
    614        1.58       chs #endif
    615        1.11       eeh 	if (err != 0)
    616        1.11       eeh 		return (err);
    617        1.11       eeh 
    618        1.65  nakayama 	if (dvmaddr == (u_long)-1)
    619         1.7       mrg 		return (ENOMEM);
    620         1.7       mrg 
    621        1.40       eeh 	/* Set the active DVMA map */
    622        1.40       eeh 	map->_dm_dvmastart = dvmaddr;
    623        1.40       eeh 	map->_dm_dvmasize = sgsize;
    624        1.40       eeh 
    625        1.40       eeh 	/*
    626        1.40       eeh 	 * Now split the DVMA range into segments, not crossing
    627        1.40       eeh 	 * the boundary.
    628        1.40       eeh 	 */
    629        1.40       eeh 	seg = 0;
    630        1.40       eeh 	sgstart = dvmaddr + (vaddr & PGOFSET);
    631        1.40       eeh 	sgend = sgstart + buflen - 1;
    632        1.40       eeh 	map->dm_segs[seg].ds_addr = sgstart;
    633        1.71   tsutsui 	DPRINTF(IDB_INFO, ("iommu_dvmamap_load: boundary %lx boundary - 1 %lx "
    634        1.71   tsutsui 	    "~(boundary - 1) %lx\n", (long)boundary, (long)(boundary - 1),
    635        1.71   tsutsui 	    (long)~(boundary - 1)));
    636        1.90  nakayama 	bmask = ~(boundary - 1);
    637        1.96  nakayama 	while ((sgstart & bmask) != (sgend & bmask) ||
    638        1.96  nakayama 	       sgend - sgstart + 1 > map->dm_maxsegsz) {
    639        1.96  nakayama 		/* Oops. We crossed a boundary or large seg. Split the xfer. */
    640        1.96  nakayama 		len = map->dm_maxsegsz;
    641        1.96  nakayama 		if ((sgstart & bmask) != (sgend & bmask))
    642       1.114  riastrad 			len = uimin(len, boundary - (sgstart & (boundary - 1)));
    643        1.71   tsutsui 		map->dm_segs[seg].ds_len = len;
    644        1.40       eeh 		DPRINTF(IDB_INFO, ("iommu_dvmamap_load: "
    645        1.71   tsutsui 		    "seg %d start %lx size %lx\n", seg,
    646        1.71   tsutsui 		    (long)map->dm_segs[seg].ds_addr,
    647        1.71   tsutsui 		    (long)map->dm_segs[seg].ds_len));
    648        1.53       eeh 		if (++seg >= map->_dm_segcnt) {
    649        1.40       eeh 			/* Too many segments.  Fail the operation. */
    650        1.40       eeh 			DPRINTF(IDB_INFO, ("iommu_dvmamap_load: "
    651        1.71   tsutsui 			    "too many segments %d\n", seg));
    652       1.107       mrg 			mutex_enter(&is->is_lock);
    653        1.40       eeh 			err = extent_free(is->is_dvmamap,
    654        1.71   tsutsui 			    dvmaddr, sgsize, EX_NOWAIT);
    655        1.40       eeh 			map->_dm_dvmastart = 0;
    656        1.40       eeh 			map->_dm_dvmasize = 0;
    657       1.107       mrg 			mutex_exit(&is->is_lock);
    658        1.95  nakayama 			if (err != 0)
    659        1.95  nakayama 				printf("warning: %s: %" PRId64
    660        1.95  nakayama 				    " of DVMA space lost\n", __func__, sgsize);
    661        1.80       mrg 			return (EFBIG);
    662        1.40       eeh 		}
    663        1.71   tsutsui 		sgstart += len;
    664        1.40       eeh 		map->dm_segs[seg].ds_addr = sgstart;
    665        1.40       eeh 	}
    666        1.40       eeh 	map->dm_segs[seg].ds_len = sgend - sgstart + 1;
    667        1.40       eeh 	DPRINTF(IDB_INFO, ("iommu_dvmamap_load: "
    668        1.71   tsutsui 	    "seg %d start %lx size %lx\n", seg,
    669        1.71   tsutsui 	    (long)map->dm_segs[seg].ds_addr, (long)map->dm_segs[seg].ds_len));
    670        1.71   tsutsui 	map->dm_nsegs = seg + 1;
    671         1.7       mrg 	map->dm_mapsize = buflen;
    672         1.7       mrg 
    673         1.7       mrg 	if (p != NULL)
    674         1.7       mrg 		pmap = p->p_vmspace->vm_map.pmap;
    675         1.7       mrg 	else
    676         1.7       mrg 		pmap = pmap_kernel();
    677         1.7       mrg 
    678        1.91  nakayama 	needsflush = 0;
    679         1.7       mrg 	for (; buflen > 0; ) {
    680        1.58       chs 
    681         1.7       mrg 		/*
    682         1.7       mrg 		 * Get the physical address for this page.
    683         1.7       mrg 		 */
    684         1.7       mrg 		if (pmap_extract(pmap, (vaddr_t)vaddr, &curaddr) == FALSE) {
    685        1.74    petrov #ifdef DIAGNOSTIC
    686        1.74    petrov 			printf("iommu_dvmamap_load: pmap_extract failed %lx\n", vaddr);
    687        1.74    petrov #endif
    688         1.7       mrg 			bus_dmamap_unload(t, map);
    689         1.7       mrg 			return (-1);
    690         1.7       mrg 		}
    691         1.7       mrg 
    692         1.7       mrg 		/*
    693         1.7       mrg 		 * Compute the segment size, and adjust counts.
    694         1.7       mrg 		 */
    695        1.64   thorpej 		sgsize = PAGE_SIZE - ((u_long)vaddr & PGOFSET);
    696         1.7       mrg 		if (buflen < sgsize)
    697         1.7       mrg 			sgsize = buflen;
    698         1.7       mrg 
    699        1.22       mrg 		DPRINTF(IDB_BUSDMA,
    700        1.36       eeh 		    ("iommu_dvmamap_load: map %p loading va %p "
    701        1.71   tsutsui 		    "dva %lx at pa %lx\n",
    702        1.71   tsutsui 		    map, (void *)vaddr, (long)dvmaddr,
    703        1.87  nakayama 		    (long)trunc_page(curaddr)));
    704        1.55       eeh 		iommu_enter(sb, trunc_page(dvmaddr), trunc_page(curaddr),
    705        1.90  nakayama 		    flags | IOTTE_DEBUG(0x4000));
    706        1.91  nakayama 		needsflush = 1;
    707        1.58       chs 
    708         1.7       mrg 		vaddr += sgsize;
    709         1.7       mrg 		buflen -= sgsize;
    710       1.103       mrg 
    711       1.103       mrg 		/* Flush cache if necessary. */
    712       1.103       mrg 		slot = IOTSBSLOT(trunc_page(dvmaddr), is->is_tsbsize);
    713       1.103       mrg 		if ((is->is_flags & IOMMU_FLUSH_CACHE) &&
    714       1.103       mrg 		    (buflen <= 0 || (slot % 8) == 7))
    715       1.103       mrg 			IOMMUREG_WRITE(is, iommu_cache_flush,
    716       1.103       mrg 			    is->is_ptsb + slot * 8);
    717       1.103       mrg 
    718       1.103       mrg 		dvmaddr += PAGE_SIZE;
    719         1.7       mrg 	}
    720        1.91  nakayama 	if (needsflush)
    721        1.91  nakayama 		iommu_strbuf_flush_done(sb);
    722        1.45       eeh #ifdef DIAGNOSTIC
    723        1.45       eeh 	for (seg = 0; seg < map->dm_nsegs; seg++) {
    724        1.45       eeh 		if (map->dm_segs[seg].ds_addr < is->is_dvmabase ||
    725        1.45       eeh 			map->dm_segs[seg].ds_addr > is->is_dvmaend) {
    726        1.45       eeh 			printf("seg %d dvmaddr %lx out of range %x - %x\n",
    727        1.71   tsutsui 			    seg, (long)map->dm_segs[seg].ds_addr,
    728        1.71   tsutsui 			    is->is_dvmabase, is->is_dvmaend);
    729        1.57       chs #ifdef DDB
    730        1.45       eeh 			Debugger();
    731        1.57       chs #endif
    732        1.45       eeh 		}
    733        1.45       eeh 	}
    734        1.45       eeh #endif
    735         1.7       mrg 	return (0);
    736         1.7       mrg }
    737         1.7       mrg 
    738         1.7       mrg 
    739         1.7       mrg void
    740        1.85  nakayama iommu_dvmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
    741         1.7       mrg {
    742        1.85  nakayama 	struct strbuf_ctl *sb = (struct strbuf_ctl *)map->_dm_cookie;
    743        1.55       eeh 	struct iommu_state *is = sb->sb_is;
    744       1.107       mrg 	int error;
    745        1.70  christos 	bus_size_t sgsize = map->_dm_dvmasize;
    746         1.7       mrg 
    747        1.40       eeh 	/* Flush the iommu */
    748       1.113  christos 	if (!map->_dm_dvmastart)
    749       1.113  christos 		panic("%s: error dvmastart is zero!\n", __func__);
    750         1.7       mrg 
    751       1.115       mrg 	if (is->is_flags & IOMMU_SYNC_BEFORE_UNMAP) {
    752       1.115       mrg 
    753       1.115       mrg 		/* Flush the caches */
    754       1.115       mrg 		bus_dmamap_unload(t->_parent, map);
    755       1.115       mrg 
    756       1.115       mrg 		iommu_remove(is, map->_dm_dvmastart, map->_dm_dvmasize);
    757       1.115       mrg 
    758       1.115       mrg 	} else {
    759       1.115       mrg 
    760       1.115       mrg 		iommu_remove(is, map->_dm_dvmastart, map->_dm_dvmasize);
    761       1.115       mrg 
    762       1.115       mrg 		/* Flush the caches */
    763       1.115       mrg 		bus_dmamap_unload(t->_parent, map);
    764       1.115       mrg 	}
    765        1.23       eeh 
    766       1.107       mrg 	mutex_enter(&is->is_lock);
    767        1.58       chs 	error = extent_free(is->is_dvmamap, map->_dm_dvmastart,
    768        1.40       eeh 		map->_dm_dvmasize, EX_NOWAIT);
    769        1.43       eeh 	map->_dm_dvmastart = 0;
    770        1.43       eeh 	map->_dm_dvmasize = 0;
    771       1.107       mrg 	mutex_exit(&is->is_lock);
    772         1.7       mrg 	if (error != 0)
    773        1.95  nakayama 		printf("warning: %s: %" PRId64 " of DVMA space lost\n",
    774        1.95  nakayama 		    __func__, sgsize);
    775        1.40       eeh 
    776        1.40       eeh 	/* Clear the map */
    777         1.9       eeh }
    778         1.9       eeh 
    779         1.9       eeh 
    780         1.9       eeh int
    781        1.85  nakayama iommu_dvmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map,
    782        1.85  nakayama 	bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags)
    783         1.9       eeh {
    784        1.85  nakayama 	struct strbuf_ctl *sb = (struct strbuf_ctl *)map->_dm_cookie;
    785        1.55       eeh 	struct iommu_state *is = sb->sb_is;
    786        1.58       chs 	struct vm_page *pg;
    787       1.107       mrg 	int i, j;
    788        1.26    martin 	int left;
    789        1.91  nakayama 	int err, needsflush;
    790         1.9       eeh 	bus_size_t sgsize;
    791         1.9       eeh 	paddr_t pa;
    792        1.21       eeh 	bus_size_t boundary, align;
    793        1.90  nakayama 	u_long dvmaddr, sgstart, sgend, bmask;
    794        1.58       chs 	struct pglist *pglist;
    795        1.90  nakayama 	const int pagesz = PAGE_SIZE;
    796       1.103       mrg 	int slot;
    797        1.90  nakayama #ifdef DEBUG
    798        1.90  nakayama 	int npg = 0;
    799        1.90  nakayama #endif
    800         1.9       eeh 
    801         1.9       eeh 	if (map->dm_nsegs) {
    802         1.9       eeh 		/* Already in use?? */
    803         1.9       eeh #ifdef DIAGNOSTIC
    804         1.9       eeh 		printf("iommu_dvmamap_load_raw: map still in use\n");
    805         1.9       eeh #endif
    806         1.9       eeh 		bus_dmamap_unload(t, map);
    807         1.9       eeh 	}
    808        1.40       eeh 
    809        1.40       eeh 	/*
    810        1.40       eeh 	 * A boundary presented to bus_dmamem_alloc() takes precedence
    811        1.40       eeh 	 * over boundary in the map.
    812        1.40       eeh 	 */
    813        1.40       eeh 	if ((boundary = segs[0]._ds_boundary) == 0)
    814        1.40       eeh 		boundary = map->_dm_boundary;
    815        1.40       eeh 
    816       1.114  riastrad 	align = uimax(segs[0]._ds_align, pagesz);
    817        1.40       eeh 
    818         1.9       eeh 	/*
    819         1.9       eeh 	 * Make sure that on error condition we return "no valid mappings".
    820         1.9       eeh 	 */
    821         1.9       eeh 	map->dm_nsegs = 0;
    822        1.26    martin 	/* Count up the total number of pages we need */
    823        1.93  nakayama 	pa = trunc_page(segs[0].ds_addr);
    824        1.26    martin 	sgsize = 0;
    825        1.40       eeh 	left = size;
    826        1.93  nakayama 	for (i = 0; left > 0 && i < nsegs; i++) {
    827        1.26    martin 		if (round_page(pa) != round_page(segs[i].ds_addr))
    828        1.93  nakayama 			sgsize = round_page(sgsize) +
    829        1.93  nakayama 			    (segs[i].ds_addr & PGOFSET);
    830       1.114  riastrad 		sgsize += uimin(left, segs[i].ds_len);
    831        1.40       eeh 		left -= segs[i].ds_len;
    832        1.26    martin 		pa = segs[i].ds_addr + segs[i].ds_len;
    833        1.26    martin 	}
    834        1.93  nakayama 	sgsize = round_page(sgsize);
    835         1.9       eeh 
    836       1.107       mrg 	mutex_enter(&is->is_lock);
    837        1.58       chs 	/*
    838        1.58       chs 	 * If our segment size is larger than the boundary we need to
    839        1.45       eeh 	 * split the transfer up into little pieces ourselves.
    840         1.9       eeh 	 */
    841        1.40       eeh 	err = extent_alloc(is->is_dvmamap, sgsize, align,
    842        1.40       eeh 		(sgsize > boundary) ? 0 : boundary,
    843        1.40       eeh 		((flags & BUS_DMA_NOWAIT) == 0 ? EX_WAITOK : EX_NOWAIT) |
    844        1.54       eeh 		EX_BOUNDZERO, &dvmaddr);
    845       1.107       mrg 	mutex_exit(&is->is_lock);
    846         1.9       eeh 
    847         1.9       eeh 	if (err != 0)
    848         1.9       eeh 		return (err);
    849         1.9       eeh 
    850         1.9       eeh #ifdef DEBUG
    851        1.65  nakayama 	if (dvmaddr == (u_long)-1)
    852        1.58       chs 	{
    853         1.9       eeh 		printf("iommu_dvmamap_load_raw(): extent_alloc(%d, %x) failed!\n",
    854        1.25       mrg 		    (int)sgsize, flags);
    855        1.57       chs #ifdef DDB
    856         1.9       eeh 		Debugger();
    857        1.57       chs #endif
    858        1.58       chs 	}
    859        1.58       chs #endif
    860        1.65  nakayama 	if (dvmaddr == (u_long)-1)
    861         1.9       eeh 		return (ENOMEM);
    862         1.9       eeh 
    863        1.40       eeh 	/* Set the active DVMA map */
    864        1.40       eeh 	map->_dm_dvmastart = dvmaddr;
    865        1.40       eeh 	map->_dm_dvmasize = sgsize;
    866        1.40       eeh 
    867        1.90  nakayama 	bmask = ~(boundary - 1);
    868        1.58       chs 	if ((pglist = segs[0]._ds_mlist) == NULL) {
    869        1.92  nakayama 		u_long prev_va = 0UL, last_va = dvmaddr;
    870        1.45       eeh 		paddr_t prev_pa = 0;
    871        1.45       eeh 		int end = 0, offset;
    872        1.92  nakayama 		bus_size_t len = size;
    873        1.45       eeh 
    874        1.26    martin 		/*
    875        1.45       eeh 		 * This segs is made up of individual physical
    876        1.58       chs 		 *  segments, probably by _bus_dmamap_load_uio() or
    877        1.26    martin 		 * _bus_dmamap_load_mbuf().  Ignore the mlist and
    878        1.45       eeh 		 * load each one individually.
    879        1.26    martin 		 */
    880        1.45       eeh 		j = 0;
    881        1.91  nakayama 		needsflush = 0;
    882        1.45       eeh 		for (i = 0; i < nsegs ; i++) {
    883        1.40       eeh 
    884        1.45       eeh 			pa = segs[i].ds_addr;
    885        1.45       eeh 			offset = (pa & PGOFSET);
    886        1.45       eeh 			pa = trunc_page(pa);
    887        1.45       eeh 			dvmaddr = trunc_page(dvmaddr);
    888       1.114  riastrad 			left = uimin(len, segs[i].ds_len);
    889        1.45       eeh 
    890        1.45       eeh 			DPRINTF(IDB_INFO, ("iommu_dvmamap_load_raw: converting "
    891        1.58       chs 				"physseg %d start %lx size %lx\n", i,
    892        1.61    martin 				(long)segs[i].ds_addr, (long)segs[i].ds_len));
    893        1.26    martin 
    894        1.58       chs 			if ((pa == prev_pa) &&
    895        1.47       eeh 				((offset != 0) || (end != offset))) {
    896        1.45       eeh 				/* We can re-use this mapping */
    897        1.45       eeh 				dvmaddr = prev_va;
    898        1.45       eeh 			}
    899        1.29    martin 
    900        1.45       eeh 			sgstart = dvmaddr + offset;
    901        1.45       eeh 			sgend = sgstart + left - 1;
    902        1.26    martin 
    903        1.45       eeh 			/* Are the segments virtually adjacent? */
    904        1.58       chs 			if ((j > 0) && (end == offset) &&
    905        1.96  nakayama 			    ((offset == 0) || (pa == prev_pa)) &&
    906        1.96  nakayama 			    (map->dm_segs[j-1].ds_len + left <=
    907        1.96  nakayama 			     map->dm_maxsegsz)) {
    908        1.45       eeh 				/* Just append to the previous segment. */
    909        1.45       eeh 				map->dm_segs[--j].ds_len += left;
    910        1.93  nakayama 				/* Restore sgstart for boundary check */
    911        1.93  nakayama 				sgstart = map->dm_segs[j].ds_addr;
    912        1.45       eeh 				DPRINTF(IDB_INFO, ("iommu_dvmamap_load_raw: "
    913        1.45       eeh 					"appending seg %d start %lx size %lx\n", j,
    914        1.58       chs 					(long)map->dm_segs[j].ds_addr,
    915        1.61    martin 					(long)map->dm_segs[j].ds_len));
    916        1.45       eeh 			} else {
    917        1.53       eeh 				if (j >= map->_dm_segcnt) {
    918        1.92  nakayama 					iommu_remove(is, map->_dm_dvmastart,
    919        1.92  nakayama 					    last_va - map->_dm_dvmastart);
    920        1.92  nakayama 					goto fail;
    921        1.53       eeh 				}
    922        1.45       eeh 				map->dm_segs[j].ds_addr = sgstart;
    923        1.45       eeh 				map->dm_segs[j].ds_len = left;
    924        1.45       eeh 				DPRINTF(IDB_INFO, ("iommu_dvmamap_load_raw: "
    925        1.45       eeh 					"seg %d start %lx size %lx\n", j,
    926        1.48       eeh 					(long)map->dm_segs[j].ds_addr,
    927        1.61    martin 					(long)map->dm_segs[j].ds_len));
    928        1.40       eeh 			}
    929        1.45       eeh 			end = (offset + left) & PGOFSET;
    930        1.40       eeh 
    931        1.40       eeh 			/* Check for boundary issues */
    932        1.90  nakayama 			while ((sgstart & bmask) != (sgend & bmask)) {
    933        1.40       eeh 				/* Need a new segment. */
    934        1.40       eeh 				map->dm_segs[j].ds_len =
    935        1.53       eeh 					boundary - (sgstart & (boundary - 1));
    936        1.40       eeh 				DPRINTF(IDB_INFO, ("iommu_dvmamap_load_raw: "
    937        1.40       eeh 					"seg %d start %lx size %lx\n", j,
    938        1.58       chs 					(long)map->dm_segs[j].ds_addr,
    939        1.61    martin 					(long)map->dm_segs[j].ds_len));
    940        1.53       eeh 				if (++j >= map->_dm_segcnt) {
    941        1.92  nakayama 					iommu_remove(is, map->_dm_dvmastart,
    942        1.92  nakayama 					    last_va - map->_dm_dvmastart);
    943        1.92  nakayama 					goto fail;
    944        1.40       eeh 				}
    945        1.93  nakayama 				sgstart += map->dm_segs[j-1].ds_len;
    946        1.40       eeh 				map->dm_segs[j].ds_addr = sgstart;
    947        1.40       eeh 				map->dm_segs[j].ds_len = sgend - sgstart + 1;
    948        1.40       eeh 			}
    949        1.40       eeh 
    950        1.26    martin 			if (sgsize == 0)
    951        1.26    martin 				panic("iommu_dmamap_load_raw: size botch");
    952        1.40       eeh 
    953        1.45       eeh 			/* Now map a series of pages. */
    954        1.51       eeh 			while (dvmaddr <= sgend) {
    955        1.45       eeh 				DPRINTF(IDB_BUSDMA,
    956        1.45       eeh 					("iommu_dvmamap_load_raw: map %p "
    957        1.45       eeh 						"loading va %lx at pa %lx\n",
    958        1.45       eeh 						map, (long)dvmaddr,
    959        1.45       eeh 						(long)(pa)));
    960        1.45       eeh 				/* Enter it if we haven't before. */
    961        1.91  nakayama 				if (prev_va != dvmaddr) {
    962        1.55       eeh 					iommu_enter(sb, prev_va = dvmaddr,
    963        1.90  nakayama 					    prev_pa = pa,
    964        1.90  nakayama 					    flags | IOTTE_DEBUG(++npg << 12));
    965        1.91  nakayama 					needsflush = 1;
    966       1.103       mrg 
    967       1.103       mrg 					/* Flush cache if necessary. */
    968       1.103       mrg 					slot = IOTSBSLOT(trunc_page(dvmaddr), is->is_tsbsize);
    969       1.103       mrg 					if ((is->is_flags & IOMMU_FLUSH_CACHE) &&
    970       1.103       mrg 					    ((dvmaddr + pagesz) > sgend || (slot % 8) == 7))
    971       1.103       mrg 						IOMMUREG_WRITE(is, iommu_cache_flush,
    972       1.103       mrg 						    is->is_ptsb + slot * 8);
    973        1.91  nakayama 				}
    974       1.103       mrg 
    975        1.45       eeh 				dvmaddr += pagesz;
    976        1.45       eeh 				pa += pagesz;
    977        1.92  nakayama 				last_va = dvmaddr;
    978        1.45       eeh 			}
    979        1.45       eeh 
    980        1.92  nakayama 			len -= left;
    981        1.45       eeh 			++j;
    982        1.26    martin 		}
    983        1.91  nakayama 		if (needsflush)
    984        1.91  nakayama 			iommu_strbuf_flush_done(sb);
    985        1.45       eeh 
    986        1.92  nakayama 		map->dm_mapsize = size;
    987        1.45       eeh 		map->dm_nsegs = j;
    988        1.45       eeh #ifdef DIAGNOSTIC
    989        1.45       eeh 		{ int seg;
    990        1.45       eeh 	for (seg = 0; seg < map->dm_nsegs; seg++) {
    991        1.45       eeh 		if (map->dm_segs[seg].ds_addr < is->is_dvmabase ||
    992       1.103       mrg 		    map->dm_segs[seg].ds_addr > is->is_dvmaend) {
    993        1.45       eeh 			printf("seg %d dvmaddr %lx out of range %x - %x\n",
    994        1.58       chs 				seg, (long)map->dm_segs[seg].ds_addr,
    995        1.45       eeh 				is->is_dvmabase, is->is_dvmaend);
    996        1.57       chs #ifdef DDB
    997        1.45       eeh 			Debugger();
    998        1.57       chs #endif
    999        1.45       eeh 		}
   1000        1.45       eeh 	}
   1001        1.45       eeh 		}
   1002        1.45       eeh #endif
   1003        1.26    martin 		return (0);
   1004        1.26    martin 	}
   1005        1.58       chs 
   1006         1.9       eeh 	/*
   1007        1.40       eeh 	 * This was allocated with bus_dmamem_alloc.
   1008        1.58       chs 	 * The pages are on a `pglist'.
   1009         1.9       eeh 	 */
   1010        1.26    martin 	i = 0;
   1011        1.40       eeh 	sgstart = dvmaddr;
   1012        1.40       eeh 	sgend = sgstart + size - 1;
   1013        1.40       eeh 	map->dm_segs[i].ds_addr = sgstart;
   1014        1.90  nakayama 	while ((sgstart & bmask) != (sgend & bmask)) {
   1015        1.40       eeh 		/* Oops.  We crossed a boundary.  Split the xfer. */
   1016        1.53       eeh 		map->dm_segs[i].ds_len = boundary - (sgstart & (boundary - 1));
   1017        1.40       eeh 		DPRINTF(IDB_INFO, ("iommu_dvmamap_load_raw: "
   1018        1.40       eeh 			"seg %d start %lx size %lx\n", i,
   1019        1.48       eeh 			(long)map->dm_segs[i].ds_addr,
   1020        1.61    martin 			(long)map->dm_segs[i].ds_len));
   1021        1.53       eeh 		if (++i >= map->_dm_segcnt) {
   1022        1.40       eeh 			/* Too many segments.  Fail the operation. */
   1023        1.92  nakayama 			goto fail;
   1024        1.40       eeh 		}
   1025        1.93  nakayama 		sgstart += map->dm_segs[i-1].ds_len;
   1026        1.40       eeh 		map->dm_segs[i].ds_addr = sgstart;
   1027        1.40       eeh 	}
   1028        1.40       eeh 	DPRINTF(IDB_INFO, ("iommu_dvmamap_load_raw: "
   1029        1.40       eeh 			"seg %d start %lx size %lx\n", i,
   1030        1.61    martin 			(long)map->dm_segs[i].ds_addr, (long)map->dm_segs[i].ds_len));
   1031        1.40       eeh 	map->dm_segs[i].ds_len = sgend - sgstart + 1;
   1032         1.9       eeh 
   1033        1.91  nakayama 	needsflush = 0;
   1034        1.83        ad 	TAILQ_FOREACH(pg, pglist, pageq.queue) {
   1035         1.9       eeh 		if (sgsize == 0)
   1036         1.9       eeh 			panic("iommu_dmamap_load_raw: size botch");
   1037        1.58       chs 		pa = VM_PAGE_TO_PHYS(pg);
   1038         1.9       eeh 
   1039        1.22       mrg 		DPRINTF(IDB_BUSDMA,
   1040         1.9       eeh 		    ("iommu_dvmamap_load_raw: map %p loading va %lx at pa %lx\n",
   1041         1.9       eeh 		    map, (long)dvmaddr, (long)(pa)));
   1042        1.90  nakayama 		iommu_enter(sb, dvmaddr, pa, flags | IOTTE_DEBUG(0x8000));
   1043        1.91  nakayama 		needsflush = 1;
   1044        1.58       chs 
   1045       1.103       mrg 		sgsize -= pagesz;
   1046       1.103       mrg 
   1047       1.103       mrg 		/* Flush cache if necessary. */
   1048       1.103       mrg 		slot = IOTSBSLOT(trunc_page(dvmaddr), is->is_tsbsize);
   1049       1.103       mrg 		if ((is->is_flags & IOMMU_FLUSH_CACHE) &&
   1050       1.103       mrg 		    (sgsize == 0 || (slot % 8) == 7))
   1051       1.103       mrg 			IOMMUREG_WRITE(is, iommu_cache_flush,
   1052       1.103       mrg 			    is->is_ptsb + slot * 8);
   1053       1.103       mrg 
   1054       1.102       mrg 		dvmaddr += pagesz;
   1055         1.9       eeh 	}
   1056        1.91  nakayama 	if (needsflush)
   1057        1.91  nakayama 		iommu_strbuf_flush_done(sb);
   1058        1.40       eeh 	map->dm_mapsize = size;
   1059        1.40       eeh 	map->dm_nsegs = i+1;
   1060        1.45       eeh #ifdef DIAGNOSTIC
   1061        1.45       eeh 	{ int seg;
   1062        1.45       eeh 	for (seg = 0; seg < map->dm_nsegs; seg++) {
   1063        1.45       eeh 		if (map->dm_segs[seg].ds_addr < is->is_dvmabase ||
   1064        1.45       eeh 			map->dm_segs[seg].ds_addr > is->is_dvmaend) {
   1065        1.45       eeh 			printf("seg %d dvmaddr %lx out of range %x - %x\n",
   1066        1.58       chs 				seg, (long)map->dm_segs[seg].ds_addr,
   1067        1.45       eeh 				is->is_dvmabase, is->is_dvmaend);
   1068        1.57       chs #ifdef DDB
   1069        1.45       eeh 			Debugger();
   1070        1.57       chs #endif
   1071        1.45       eeh 		}
   1072        1.45       eeh 	}
   1073        1.45       eeh 	}
   1074        1.45       eeh #endif
   1075         1.9       eeh 	return (0);
   1076        1.92  nakayama 
   1077        1.92  nakayama fail:
   1078       1.107       mrg 	mutex_enter(&is->is_lock);
   1079        1.92  nakayama 	err = extent_free(is->is_dvmamap, map->_dm_dvmastart, sgsize,
   1080        1.92  nakayama 	    EX_NOWAIT);
   1081        1.92  nakayama 	map->_dm_dvmastart = 0;
   1082        1.92  nakayama 	map->_dm_dvmasize = 0;
   1083       1.107       mrg 	mutex_exit(&is->is_lock);
   1084        1.95  nakayama 	if (err != 0)
   1085        1.95  nakayama 		printf("warning: %s: %" PRId64 " of DVMA space lost\n",
   1086        1.95  nakayama 		    __func__, sgsize);
   1087        1.92  nakayama 	return (EFBIG);
   1088         1.7       mrg }
   1089         1.7       mrg 
   1090        1.67    petrov 
   1091        1.67    petrov /*
   1092        1.67    petrov  * Flush an individual dma segment, returns non-zero if the streaming buffers
   1093        1.67    petrov  * need flushing afterwards.
   1094        1.67    petrov  */
   1095        1.67    petrov static int
   1096        1.67    petrov iommu_dvmamap_sync_range(struct strbuf_ctl *sb, vaddr_t va, bus_size_t len)
   1097        1.67    petrov {
   1098        1.67    petrov 	vaddr_t vaend;
   1099        1.67    petrov 	struct iommu_state *is = sb->sb_is;
   1100        1.67    petrov 
   1101        1.67    petrov #ifdef DIAGNOSTIC
   1102        1.67    petrov 	if (va < is->is_dvmabase || va > is->is_dvmaend)
   1103        1.67    petrov 		panic("invalid va: %llx", (long long)va);
   1104        1.67    petrov #endif
   1105        1.67    petrov 
   1106        1.67    petrov 	if ((is->is_tsb[IOTSBSLOT(va, is->is_tsbsize)] & IOTTE_STREAM) == 0) {
   1107       1.103       mrg 		DPRINTF(IDB_SYNC,
   1108        1.67    petrov 			("iommu_dvmamap_sync_range: attempting to flush "
   1109        1.67    petrov 			 "non-streaming entry\n"));
   1110        1.67    petrov 		return (0);
   1111        1.67    petrov 	}
   1112        1.67    petrov 
   1113        1.90  nakayama 	vaend = round_page(va + len) - 1;
   1114        1.87  nakayama 	va = trunc_page(va);
   1115        1.67    petrov 
   1116        1.67    petrov #ifdef DIAGNOSTIC
   1117        1.67    petrov 	if (va < is->is_dvmabase || vaend > is->is_dvmaend)
   1118        1.67    petrov 		panic("invalid va range: %llx to %llx (%x to %x)",
   1119        1.67    petrov 		    (long long)va, (long long)vaend,
   1120        1.67    petrov 		    is->is_dvmabase,
   1121        1.67    petrov 		    is->is_dvmaend);
   1122        1.67    petrov #endif
   1123        1.67    petrov 
   1124        1.67    petrov 	for ( ; va <= vaend; va += PAGE_SIZE) {
   1125       1.103       mrg 		DPRINTF(IDB_SYNC,
   1126        1.67    petrov 		    ("iommu_dvmamap_sync_range: flushing va %p\n",
   1127        1.67    petrov 		    (void *)(u_long)va));
   1128        1.67    petrov 		iommu_strbuf_flush(sb, va);
   1129        1.67    petrov 	}
   1130        1.67    petrov 
   1131        1.67    petrov 	return (1);
   1132        1.67    petrov }
   1133        1.67    petrov 
   1134        1.85  nakayama static void
   1135        1.85  nakayama _iommu_dvmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
   1136        1.85  nakayama 	bus_size_t len, int ops)
   1137         1.7       mrg {
   1138        1.85  nakayama 	struct strbuf_ctl *sb = (struct strbuf_ctl *)map->_dm_cookie;
   1139        1.67    petrov 	bus_size_t count;
   1140        1.67    petrov 	int i, needsflush = 0;
   1141        1.63    petrov 
   1142        1.63    petrov 	if (!sb->sb_flush)
   1143        1.63    petrov 		return;
   1144         1.7       mrg 
   1145        1.67    petrov 	for (i = 0; i < map->dm_nsegs; i++) {
   1146        1.67    petrov 		if (offset < map->dm_segs[i].ds_len)
   1147        1.67    petrov 			break;
   1148        1.67    petrov 		offset -= map->dm_segs[i].ds_len;
   1149        1.67    petrov 	}
   1150        1.60    petrov 
   1151        1.67    petrov 	if (i == map->dm_nsegs)
   1152       1.103       mrg 		panic("%s: segment too short %llu", __func__,
   1153        1.68    martin 		    (unsigned long long)offset);
   1154        1.60    petrov 
   1155        1.62    petrov 	if (ops & (BUS_DMASYNC_PREREAD | BUS_DMASYNC_POSTWRITE)) {
   1156        1.60    petrov 		/* Nothing to do */;
   1157        1.60    petrov 	}
   1158        1.60    petrov 
   1159        1.62    petrov 	if (ops & (BUS_DMASYNC_POSTREAD | BUS_DMASYNC_PREWRITE)) {
   1160        1.67    petrov 
   1161        1.67    petrov 		for (; len > 0 && i < map->dm_nsegs; i++) {
   1162        1.67    petrov 			count = MIN(map->dm_segs[i].ds_len - offset, len);
   1163        1.67    petrov 			if (count > 0 &&
   1164        1.67    petrov 			    iommu_dvmamap_sync_range(sb,
   1165        1.67    petrov 				map->dm_segs[i].ds_addr + offset, count))
   1166        1.67    petrov 				needsflush = 1;
   1167        1.67    petrov 			offset = 0;
   1168        1.67    petrov 			len -= count;
   1169        1.67    petrov 		}
   1170        1.60    petrov #ifdef DIAGNOSTIC
   1171        1.67    petrov 		if (i == map->dm_nsegs && len > 0)
   1172       1.103       mrg 			panic("%s: leftover %llu", __func__,
   1173        1.73  nakayama 			    (unsigned long long)len);
   1174        1.60    petrov #endif
   1175        1.55       eeh 
   1176        1.67    petrov 		if (needsflush)
   1177        1.58       chs 			iommu_strbuf_flush_done(sb);
   1178         1.7       mrg 	}
   1179         1.7       mrg }
   1180         1.7       mrg 
   1181        1.85  nakayama void
   1182        1.85  nakayama iommu_dvmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
   1183        1.85  nakayama 	bus_size_t len, int ops)
   1184        1.85  nakayama {
   1185        1.85  nakayama 
   1186        1.89       jdc 	/* If len is 0, then there is nothing to do */
   1187        1.89       jdc 	if (len == 0)
   1188        1.89       jdc 		return;
   1189        1.89       jdc 
   1190        1.85  nakayama 	if (ops & (BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE)) {
   1191        1.85  nakayama 		/* Flush the CPU then the IOMMU */
   1192        1.85  nakayama 		bus_dmamap_sync(t->_parent, map, offset, len, ops);
   1193        1.85  nakayama 		_iommu_dvmamap_sync(t, map, offset, len, ops);
   1194        1.85  nakayama 	}
   1195        1.85  nakayama 	if (ops & (BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE)) {
   1196        1.85  nakayama 		/* Flush the IOMMU then the CPU */
   1197        1.85  nakayama 		_iommu_dvmamap_sync(t, map, offset, len, ops);
   1198        1.85  nakayama 		bus_dmamap_sync(t->_parent, map, offset, len, ops);
   1199        1.85  nakayama 	}
   1200        1.85  nakayama }
   1201        1.85  nakayama 
   1202         1.7       mrg int
   1203        1.85  nakayama iommu_dvmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment,
   1204        1.85  nakayama 	bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs,
   1205        1.85  nakayama 	int flags)
   1206         1.7       mrg {
   1207         1.7       mrg 
   1208        1.25       mrg 	DPRINTF(IDB_BUSDMA, ("iommu_dvmamem_alloc: sz %llx align %llx bound %llx "
   1209        1.25       mrg 	   "segp %p flags %d\n", (unsigned long long)size,
   1210        1.25       mrg 	   (unsigned long long)alignment, (unsigned long long)boundary,
   1211        1.25       mrg 	   segs, flags));
   1212         1.7       mrg 	return (bus_dmamem_alloc(t->_parent, size, alignment, boundary,
   1213        1.21       eeh 	    segs, nsegs, rsegs, flags|BUS_DMA_DVMA));
   1214         1.7       mrg }
   1215         1.7       mrg 
   1216         1.7       mrg void
   1217        1.85  nakayama iommu_dvmamem_free(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs)
   1218         1.7       mrg {
   1219         1.7       mrg 
   1220        1.22       mrg 	DPRINTF(IDB_BUSDMA, ("iommu_dvmamem_free: segp %p nsegs %d\n",
   1221         1.7       mrg 	    segs, nsegs));
   1222         1.7       mrg 	bus_dmamem_free(t->_parent, segs, nsegs);
   1223         1.7       mrg }
   1224         1.7       mrg 
   1225         1.7       mrg /*
   1226         1.7       mrg  * Map the DVMA mappings into the kernel pmap.
   1227         1.7       mrg  * Check the flags to see whether we're streaming or coherent.
   1228         1.7       mrg  */
   1229         1.7       mrg int
   1230        1.85  nakayama iommu_dvmamem_map(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs,
   1231        1.85  nakayama 	size_t size, void **kvap, int flags)
   1232         1.7       mrg {
   1233        1.58       chs 	struct vm_page *pg;
   1234         1.7       mrg 	vaddr_t va;
   1235         1.7       mrg 	bus_addr_t addr;
   1236        1.58       chs 	struct pglist *pglist;
   1237         1.8       mrg 	int cbit;
   1238        1.77      yamt 	const uvm_flag_t kmflags =
   1239        1.77      yamt 	    (flags & BUS_DMA_NOWAIT) != 0 ? UVM_KMF_NOWAIT : 0;
   1240         1.7       mrg 
   1241        1.22       mrg 	DPRINTF(IDB_BUSDMA, ("iommu_dvmamem_map: segp %p nsegs %d size %lx\n",
   1242         1.7       mrg 	    segs, nsegs, size));
   1243         1.7       mrg 
   1244         1.7       mrg 	/*
   1245         1.8       mrg 	 * Allocate some space in the kernel map, and then map these pages
   1246         1.8       mrg 	 * into this space.
   1247         1.7       mrg 	 */
   1248         1.8       mrg 	size = round_page(size);
   1249        1.77      yamt 	va = uvm_km_alloc(kernel_map, size, 0, UVM_KMF_VAONLY | kmflags);
   1250         1.8       mrg 	if (va == 0)
   1251         1.8       mrg 		return (ENOMEM);
   1252         1.7       mrg 
   1253        1.81  christos 	*kvap = (void *)va;
   1254         1.7       mrg 
   1255        1.58       chs 	/*
   1256         1.7       mrg 	 * digest flags:
   1257         1.7       mrg 	 */
   1258         1.7       mrg 	cbit = 0;
   1259         1.7       mrg 	if (flags & BUS_DMA_COHERENT)	/* Disable vcache */
   1260         1.7       mrg 		cbit |= PMAP_NVC;
   1261        1.97     skrll 	if (flags & BUS_DMA_NOCACHE)	/* side effects */
   1262         1.7       mrg 		cbit |= PMAP_NC;
   1263         1.7       mrg 
   1264         1.7       mrg 	/*
   1265         1.8       mrg 	 * Now take this and map it into the CPU.
   1266         1.7       mrg 	 */
   1267        1.58       chs 	pglist = segs[0]._ds_mlist;
   1268        1.83        ad 	TAILQ_FOREACH(pg, pglist, pageq.queue) {
   1269         1.8       mrg #ifdef DIAGNOSTIC
   1270         1.7       mrg 		if (size == 0)
   1271         1.7       mrg 			panic("iommu_dvmamem_map: size botch");
   1272         1.8       mrg #endif
   1273        1.58       chs 		addr = VM_PAGE_TO_PHYS(pg);
   1274        1.22       mrg 		DPRINTF(IDB_BUSDMA, ("iommu_dvmamem_map: "
   1275        1.25       mrg 		    "mapping va %lx at %llx\n", va, (unsigned long long)addr | cbit));
   1276        1.88    cegger 		pmap_kenter_pa(va, addr | cbit,
   1277        1.88    cegger 		    VM_PROT_READ | VM_PROT_WRITE, 0);
   1278         1.7       mrg 		va += PAGE_SIZE;
   1279         1.7       mrg 		size -= PAGE_SIZE;
   1280         1.7       mrg 	}
   1281        1.38     chris 	pmap_update(pmap_kernel());
   1282         1.7       mrg 	return (0);
   1283         1.7       mrg }
   1284         1.7       mrg 
   1285         1.7       mrg /*
   1286         1.7       mrg  * Unmap DVMA mappings from kernel
   1287         1.7       mrg  */
   1288         1.7       mrg void
   1289        1.85  nakayama iommu_dvmamem_unmap(bus_dma_tag_t t, void *kva, size_t size)
   1290         1.7       mrg {
   1291        1.58       chs 
   1292        1.22       mrg 	DPRINTF(IDB_BUSDMA, ("iommu_dvmamem_unmap: kvm %p size %lx\n",
   1293         1.7       mrg 	    kva, size));
   1294        1.58       chs 
   1295         1.7       mrg #ifdef DIAGNOSTIC
   1296         1.7       mrg 	if ((u_long)kva & PGOFSET)
   1297         1.7       mrg 		panic("iommu_dvmamem_unmap");
   1298         1.7       mrg #endif
   1299        1.58       chs 
   1300         1.7       mrg 	size = round_page(size);
   1301        1.58       chs 	pmap_kremove((vaddr_t)kva, size);
   1302        1.38     chris 	pmap_update(pmap_kernel());
   1303        1.76      yamt 	uvm_km_free(kernel_map, (vaddr_t)kva, size, UVM_KMF_VAONLY);
   1304         1.1       mrg }
   1305