Home | History | Annotate | Line # | Download | only in dev
mm.c revision 1.16.2.1
      1  1.16.2.1       tls /*	$NetBSD: mm.c,v 1.16.2.1 2013/02/25 00:29:11 tls Exp $	*/
      2       1.1  christos 
      3       1.1  christos /*-
      4      1.14     rmind  * Copyright (c) 2002, 2008, 2010 The NetBSD Foundation, Inc.
      5       1.1  christos  * All rights reserved.
      6       1.1  christos  *
      7       1.1  christos  * This code is derived from software contributed to The NetBSD Foundation
      8      1.14     rmind  * by Christos Zoulas, Joerg Sonnenberger and Mindaugas Rasiukevicius.
      9       1.1  christos  *
     10       1.1  christos  * Redistribution and use in source and binary forms, with or without
     11       1.1  christos  * modification, are permitted provided that the following conditions
     12       1.1  christos  * are met:
     13       1.1  christos  * 1. Redistributions of source code must retain the above copyright
     14       1.1  christos  *    notice, this list of conditions and the following disclaimer.
     15       1.1  christos  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  christos  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  christos  *    documentation and/or other materials provided with the distribution.
     18       1.1  christos  *
     19       1.1  christos  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.1  christos  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.1  christos  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.1  christos  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.1  christos  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.1  christos  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.1  christos  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.1  christos  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.1  christos  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.1  christos  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.1  christos  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1  christos  */
     31       1.1  christos 
     32      1.14     rmind /*
     33      1.14     rmind  * Special /dev/{mem,kmem,zero,null} memory devices.
     34      1.14     rmind  */
     35       1.1  christos 
     36       1.1  christos #include <sys/cdefs.h>
     37  1.16.2.1       tls __KERNEL_RCSID(0, "$NetBSD: mm.c,v 1.16.2.1 2013/02/25 00:29:11 tls Exp $");
     38       1.1  christos 
     39      1.14     rmind #include "opt_compat_netbsd.h"
     40       1.1  christos 
     41       1.1  christos #include <sys/param.h>
     42       1.1  christos #include <sys/conf.h>
     43      1.14     rmind #include <sys/ioctl.h>
     44      1.14     rmind #include <sys/mman.h>
     45       1.1  christos #include <sys/uio.h>
     46      1.13     oster #include <sys/termios.h>
     47       1.2   gehenna 
     48      1.14     rmind #include <dev/mm.h>
     49      1.14     rmind 
     50      1.14     rmind #include <uvm/uvm_extern.h>
     51      1.14     rmind 
     52      1.14     rmind static void *		dev_zero_page	__read_mostly;
     53      1.14     rmind static kmutex_t		dev_mem_lock	__cacheline_aligned;
     54      1.14     rmind static vaddr_t		dev_mem_addr	__read_mostly;
     55      1.14     rmind 
     56      1.14     rmind static dev_type_read(mm_readwrite);
     57      1.14     rmind static dev_type_ioctl(mm_ioctl);
     58      1.14     rmind static dev_type_mmap(mm_mmap);
     59      1.14     rmind static dev_type_ioctl(mm_ioctl);
     60      1.14     rmind 
     61      1.14     rmind const struct cdevsw mem_cdevsw = {
     62      1.14     rmind #ifdef __HAVE_MM_MD_OPEN
     63      1.14     rmind 	mm_md_open,
     64      1.14     rmind #else
     65      1.14     rmind 	nullopen,
     66      1.14     rmind #endif
     67      1.14     rmind 	nullclose, mm_readwrite, mm_readwrite,
     68      1.14     rmind 	mm_ioctl, nostop, notty, nopoll, mm_mmap, nokqfilter,
     69      1.14     rmind 	D_MPSAFE
     70      1.14     rmind };
     71      1.14     rmind 
     72      1.14     rmind #ifdef pmax	/* XXX */
     73      1.14     rmind const struct cdevsw mem_ultrix_cdevsw = {
     74      1.14     rmind 	nullopen, nullclose, mm_readwrite, mm_readwrite, mm_ioctl,
     75      1.14     rmind 	nostop, notty, nopoll, mm_mmap, nokqfilter, D_MPSAFE
     76      1.14     rmind };
     77      1.14     rmind #endif
     78      1.14     rmind 
     79      1.14     rmind /*
     80      1.14     rmind  * mm_init: initialize memory device driver.
     81      1.14     rmind  */
     82      1.14     rmind void
     83      1.14     rmind mm_init(void)
     84      1.14     rmind {
     85      1.14     rmind 	vaddr_t pg;
     86      1.14     rmind 
     87      1.14     rmind 	mutex_init(&dev_mem_lock, MUTEX_DEFAULT, IPL_NONE);
     88      1.14     rmind 
     89      1.14     rmind 	/* Read-only zero-page. */
     90      1.14     rmind 	pg = uvm_km_alloc(kernel_map, PAGE_SIZE, 0, UVM_KMF_WIRED|UVM_KMF_ZERO);
     91      1.14     rmind 	KASSERT(pg != 0);
     92      1.14     rmind 	pmap_protect(pmap_kernel(), pg, pg + PAGE_SIZE, VM_PROT_READ);
     93      1.14     rmind 	pmap_update(pmap_kernel());
     94      1.14     rmind 	dev_zero_page = (void *)pg;
     95      1.14     rmind 
     96      1.14     rmind #ifndef __HAVE_MM_MD_CACHE_ALIASING
     97      1.14     rmind 	/* KVA for mappings during I/O. */
     98      1.14     rmind 	dev_mem_addr = uvm_km_alloc(kernel_map, PAGE_SIZE, 0,
     99      1.14     rmind 	    UVM_KMF_VAONLY|UVM_KMF_WAITVA);
    100      1.14     rmind 	KASSERT(dev_mem_addr != 0);
    101      1.14     rmind #else
    102      1.14     rmind 	dev_mem_addr = 0;
    103      1.14     rmind #endif
    104      1.14     rmind }
    105      1.14     rmind 
    106      1.14     rmind 
    107      1.14     rmind /*
    108      1.14     rmind  * dev_mem_getva: get a special virtual address.  If architecture requires,
    109      1.14     rmind  * allocate VA according to PA, which avoids cache-aliasing issues.  Use a
    110      1.14     rmind  * constant, general mapping address otherwise.
    111      1.14     rmind  */
    112      1.14     rmind static inline vaddr_t
    113      1.14     rmind dev_mem_getva(paddr_t pa)
    114      1.14     rmind {
    115      1.14     rmind #ifdef __HAVE_MM_MD_CACHE_ALIASING
    116  1.16.2.1       tls 	return uvm_km_alloc(kernel_map, PAGE_SIZE,
    117  1.16.2.1       tls 	    atop(pa) & uvmexp.colormask,
    118  1.16.2.1       tls 	    UVM_KMF_VAONLY | UVM_KMF_WAITVA | UVM_KMF_COLORMATCH);
    119      1.14     rmind #else
    120      1.14     rmind 	return dev_mem_addr;
    121      1.14     rmind #endif
    122      1.14     rmind }
    123      1.14     rmind 
    124      1.14     rmind static inline void
    125      1.14     rmind dev_mem_relva(paddr_t pa, vaddr_t va)
    126      1.14     rmind {
    127      1.14     rmind #ifdef __HAVE_MM_MD_CACHE_ALIASING
    128  1.16.2.1       tls 	uvm_km_free(kernel_map, va, PAGE_SIZE, UVM_KMF_VAONLY);
    129      1.14     rmind #else
    130      1.14     rmind 	KASSERT(dev_mem_addr == va);
    131      1.14     rmind #endif
    132      1.14     rmind }
    133      1.14     rmind 
    134      1.14     rmind /*
    135      1.14     rmind  * dev_kmem_readwrite: helper for DEV_MEM (/dev/mem) case of R/W.
    136      1.14     rmind  */
    137      1.14     rmind static int
    138      1.14     rmind dev_mem_readwrite(struct uio *uio, struct iovec *iov)
    139      1.14     rmind {
    140      1.14     rmind 	paddr_t paddr;
    141      1.14     rmind 	vaddr_t vaddr;
    142      1.14     rmind 	vm_prot_t prot;
    143      1.14     rmind 	size_t len, offset;
    144      1.14     rmind 	bool have_direct;
    145      1.14     rmind 	int error;
    146      1.14     rmind 
    147      1.14     rmind 	/* Check for wrap around. */
    148      1.14     rmind 	if ((intptr_t)uio->uio_offset != uio->uio_offset) {
    149      1.14     rmind 		return EFAULT;
    150      1.14     rmind 	}
    151      1.14     rmind 	paddr = uio->uio_offset & ~PAGE_MASK;
    152      1.14     rmind 	prot = (uio->uio_rw == UIO_WRITE) ? VM_PROT_WRITE : VM_PROT_READ;
    153      1.14     rmind 	error = mm_md_physacc(paddr, prot);
    154      1.14     rmind 	if (error) {
    155      1.14     rmind 		return error;
    156      1.14     rmind 	}
    157      1.14     rmind 	offset = uio->uio_offset & PAGE_MASK;
    158      1.14     rmind 	len = MIN(uio->uio_resid, PAGE_SIZE - offset);
    159      1.14     rmind 
    160      1.14     rmind #ifdef __HAVE_MM_MD_DIRECT_MAPPED_PHYS
    161      1.14     rmind 	/* Is physical address directly mapped?  Return VA. */
    162      1.14     rmind 	have_direct = mm_md_direct_mapped_phys(paddr, &vaddr);
    163      1.14     rmind #else
    164      1.15     joerg 	vaddr = 0;
    165      1.14     rmind 	have_direct = false;
    166      1.14     rmind #endif
    167      1.14     rmind 	if (!have_direct) {
    168      1.14     rmind 		/* Get a special virtual address. */
    169      1.14     rmind 		const vaddr_t va = dev_mem_getva(paddr);
    170      1.14     rmind 
    171      1.14     rmind 		/* Map selected KVA to physical address. */
    172      1.14     rmind 		mutex_enter(&dev_mem_lock);
    173      1.14     rmind 		pmap_kenter_pa(va, paddr, prot, 0);
    174      1.14     rmind 		pmap_update(pmap_kernel());
    175      1.14     rmind 
    176      1.14     rmind 		/* Perform I/O. */
    177      1.14     rmind 		vaddr = va + offset;
    178      1.14     rmind 		error = uiomove((void *)vaddr, len, uio);
    179      1.14     rmind 
    180      1.14     rmind 		/* Unmap, flush before unlock. */
    181      1.14     rmind 		pmap_kremove(va, PAGE_SIZE);
    182      1.14     rmind 		pmap_update(pmap_kernel());
    183      1.14     rmind 		mutex_exit(&dev_mem_lock);
    184      1.14     rmind 
    185      1.14     rmind 		/* "Release" the virtual address. */
    186      1.14     rmind 		dev_mem_relva(paddr, va);
    187      1.14     rmind 	} else {
    188      1.14     rmind 		/* Direct map, just perform I/O. */
    189      1.14     rmind 		vaddr += offset;
    190      1.14     rmind 		error = uiomove((void *)vaddr, len, uio);
    191      1.14     rmind 	}
    192      1.14     rmind 	return error;
    193      1.14     rmind }
    194      1.14     rmind 
    195      1.14     rmind /*
    196      1.14     rmind  * dev_kmem_readwrite: helper for DEV_KMEM (/dev/kmem) case of R/W.
    197      1.14     rmind  */
    198      1.14     rmind static int
    199      1.14     rmind dev_kmem_readwrite(struct uio *uio, struct iovec *iov)
    200      1.14     rmind {
    201      1.14     rmind 	void *addr;
    202      1.14     rmind 	size_t len, offset;
    203      1.14     rmind 	vm_prot_t prot;
    204      1.14     rmind 	int error;
    205      1.14     rmind 	bool md_kva;
    206      1.14     rmind 
    207      1.14     rmind 	/* Check for wrap around. */
    208      1.14     rmind 	addr = (void *)(intptr_t)uio->uio_offset;
    209      1.14     rmind 	if ((uintptr_t)addr != uio->uio_offset) {
    210      1.14     rmind 		return EFAULT;
    211      1.14     rmind 	}
    212      1.14     rmind 	/*
    213      1.14     rmind 	 * Handle non-page aligned offset.
    214      1.14     rmind 	 * Otherwise, we operate in page-by-page basis.
    215      1.14     rmind 	 */
    216      1.14     rmind 	offset = uio->uio_offset & PAGE_MASK;
    217      1.14     rmind 	len = MIN(uio->uio_resid, PAGE_SIZE - offset);
    218      1.14     rmind 	prot = (uio->uio_rw == UIO_WRITE) ? VM_PROT_WRITE : VM_PROT_READ;
    219      1.14     rmind 
    220      1.14     rmind 	md_kva = false;
    221      1.14     rmind 
    222      1.14     rmind #ifdef __HAVE_MM_MD_DIRECT_MAPPED_IO
    223      1.14     rmind 	paddr_t paddr;
    224      1.14     rmind 	/* MD case: is this is a directly mapped address? */
    225      1.14     rmind 	if (mm_md_direct_mapped_io(addr, &paddr)) {
    226      1.14     rmind 		/* If so, validate physical address. */
    227      1.14     rmind 		error = mm_md_physacc(paddr, prot);
    228      1.14     rmind 		if (error) {
    229      1.14     rmind 			return error;
    230      1.14     rmind 		}
    231      1.14     rmind 		md_kva = true;
    232      1.14     rmind 	}
    233      1.14     rmind #endif
    234      1.14     rmind 	if (!md_kva) {
    235      1.14     rmind 		bool checked = false;
    236      1.14     rmind 
    237      1.14     rmind #ifdef __HAVE_MM_MD_KERNACC
    238      1.14     rmind 		/* MD check for the address. */
    239      1.14     rmind 		error = mm_md_kernacc(addr, prot, &checked);
    240      1.14     rmind 		if (error) {
    241      1.14     rmind 			return error;
    242      1.14     rmind 		}
    243      1.14     rmind #endif
    244      1.14     rmind 		/* UVM check for the address (unless MD indicated to not). */
    245      1.14     rmind 		if (!checked && !uvm_kernacc(addr, len, prot)) {
    246      1.14     rmind 			return EFAULT;
    247      1.14     rmind 		}
    248      1.14     rmind 	}
    249      1.14     rmind 	error = uiomove(addr, len, uio);
    250      1.14     rmind 	return error;
    251      1.14     rmind }
    252      1.14     rmind 
    253      1.14     rmind /*
    254      1.14     rmind  * dev_zero_readwrite: helper for DEV_ZERO (/dev/null) case of R/W.
    255      1.14     rmind  */
    256      1.14     rmind static inline int
    257      1.14     rmind dev_zero_readwrite(struct uio *uio, struct iovec *iov)
    258      1.14     rmind {
    259      1.14     rmind 	size_t len;
    260      1.14     rmind 
    261      1.14     rmind 	/* Nothing to do for the write case. */
    262      1.14     rmind 	if (uio->uio_rw == UIO_WRITE) {
    263      1.14     rmind 		uio->uio_resid = 0;
    264      1.14     rmind 		return 0;
    265      1.14     rmind 	}
    266      1.14     rmind 	/*
    267      1.14     rmind 	 * Read in page-by-page basis, caller will continue.
    268      1.14     rmind 	 * Cut appropriately for a single/last-iteration cases.
    269      1.14     rmind 	 */
    270      1.14     rmind 	len = MIN(iov->iov_len, PAGE_SIZE);
    271      1.14     rmind 	return uiomove(dev_zero_page, len, uio);
    272      1.14     rmind }
    273       1.1  christos 
    274      1.14     rmind /*
    275      1.14     rmind  * mm_readwrite: general memory R/W function.
    276      1.14     rmind  */
    277      1.14     rmind static int
    278      1.14     rmind mm_readwrite(dev_t dev, struct uio *uio, int flags)
    279       1.1  christos {
    280      1.14     rmind 	struct iovec *iov;
    281      1.14     rmind 	int error;
    282      1.14     rmind 
    283      1.14     rmind #ifdef __HAVE_MM_MD_READWRITE
    284      1.14     rmind 	/* If defined - there are extra MD cases. */
    285       1.1  christos 	switch (minor(dev)) {
    286      1.14     rmind 	case DEV_MEM:
    287      1.14     rmind 	case DEV_KMEM:
    288      1.14     rmind 	case DEV_NULL:
    289      1.14     rmind 	case DEV_ZERO:
    290      1.14     rmind #if defined(COMPAT_16) && defined(__arm)
    291      1.14     rmind 	case _DEV_ZERO_oARM:
    292      1.14     rmind #endif
    293      1.14     rmind 		break;
    294       1.6  jdolecek 	default:
    295      1.14     rmind 		return mm_md_readwrite(dev, uio);
    296      1.14     rmind 	}
    297      1.14     rmind #endif
    298      1.14     rmind 	error = 0;
    299      1.14     rmind 	while (uio->uio_resid > 0 && error == 0) {
    300      1.14     rmind 		iov = uio->uio_iov;
    301      1.14     rmind 		if (iov->iov_len == 0) {
    302      1.14     rmind 			/* Processed; next I/O vector. */
    303      1.14     rmind 			uio->uio_iov++;
    304      1.14     rmind 			uio->uio_iovcnt--;
    305      1.14     rmind 			KASSERT(uio->uio_iovcnt >= 0);
    306      1.14     rmind 			continue;
    307      1.14     rmind 		}
    308      1.14     rmind 		/* Helper functions will process in page-by-page basis. */
    309      1.14     rmind 		switch (minor(dev)) {
    310      1.14     rmind 		case DEV_MEM:
    311      1.14     rmind 			error = dev_mem_readwrite(uio, iov);
    312      1.14     rmind 			break;
    313      1.14     rmind 		case DEV_KMEM:
    314      1.14     rmind 			error = dev_kmem_readwrite(uio, iov);
    315      1.14     rmind 			break;
    316      1.14     rmind 		case DEV_NULL:
    317      1.14     rmind 			if (uio->uio_rw == UIO_WRITE) {
    318      1.14     rmind 				uio->uio_resid = 0;
    319      1.14     rmind 			}
    320      1.14     rmind 			/* Break directly out of the loop. */
    321       1.1  christos 			return 0;
    322      1.14     rmind #if defined(COMPAT_16) && defined(__arm)
    323      1.14     rmind 		case _DEV_ZERO_oARM:
    324      1.14     rmind #endif
    325      1.14     rmind 		case DEV_ZERO:
    326      1.14     rmind 			error = dev_zero_readwrite(uio, iov);
    327      1.14     rmind 			break;
    328      1.14     rmind 		default:
    329      1.14     rmind 			error = ENXIO;
    330      1.14     rmind 			break;
    331       1.1  christos 		}
    332      1.14     rmind 	}
    333      1.14     rmind 	return error;
    334      1.14     rmind }
    335      1.14     rmind 
    336      1.14     rmind /*
    337      1.14     rmind  * mm_mmap: general mmap() handler.
    338      1.14     rmind  */
    339      1.14     rmind static paddr_t
    340      1.14     rmind mm_mmap(dev_t dev, off_t off, int acc)
    341      1.14     rmind {
    342      1.14     rmind 	vm_prot_t prot;
    343      1.14     rmind 
    344      1.14     rmind #ifdef __HAVE_MM_MD_MMAP
    345      1.14     rmind 	/* If defined - there are extra mmap() MD cases. */
    346      1.14     rmind 	switch (minor(dev)) {
    347      1.14     rmind 	case DEV_MEM:
    348      1.14     rmind 	case DEV_KMEM:
    349      1.14     rmind 	case DEV_NULL:
    350      1.14     rmind #if defined(COMPAT_16) && defined(__arm)
    351      1.14     rmind 	case _DEV_ZERO_oARM:
    352      1.14     rmind #endif
    353      1.14     rmind 	case DEV_ZERO:
    354      1.14     rmind 		break;
    355      1.14     rmind 	default:
    356      1.14     rmind 		return mm_md_mmap(dev, off, acc);
    357      1.14     rmind 	}
    358      1.14     rmind #endif
    359      1.14     rmind 	/*
    360      1.14     rmind 	 * /dev/null does not make sense, /dev/kmem is volatile and
    361      1.14     rmind 	 * /dev/zero is handled in mmap already.
    362      1.14     rmind 	 */
    363      1.14     rmind 	if (minor(dev) != DEV_MEM) {
    364      1.14     rmind 		return -1;
    365      1.14     rmind 	}
    366      1.14     rmind 
    367      1.14     rmind 	prot = 0;
    368      1.14     rmind 	if (acc & PROT_EXEC)
    369      1.14     rmind 		prot |= VM_PROT_EXECUTE;
    370      1.14     rmind 	if (acc & PROT_READ)
    371      1.14     rmind 		prot |= VM_PROT_READ;
    372      1.14     rmind 	if (acc & PROT_WRITE)
    373      1.14     rmind 		prot |= VM_PROT_WRITE;
    374      1.14     rmind 
    375      1.14     rmind 	/* Validate the physical address. */
    376      1.14     rmind 	if (mm_md_physacc(off, prot) != 0) {
    377      1.14     rmind 		return -1;
    378      1.14     rmind 	}
    379      1.14     rmind 	return off >> PGSHIFT;
    380      1.14     rmind }
    381      1.14     rmind 
    382      1.14     rmind static int
    383      1.14     rmind mm_ioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
    384      1.14     rmind {
    385      1.14     rmind 
    386      1.14     rmind 	switch (cmd) {
    387      1.14     rmind 	case FIONBIO:
    388      1.14     rmind 		/* We never block anyway. */
    389      1.14     rmind 		return 0;
    390      1.14     rmind 
    391      1.14     rmind 	case FIOSETOWN:
    392      1.14     rmind 	case FIOGETOWN:
    393      1.14     rmind 	case TIOCGPGRP:
    394      1.14     rmind 	case TIOCSPGRP:
    395      1.14     rmind 	case TIOCGETA:
    396      1.14     rmind 		return ENOTTY;
    397      1.14     rmind 
    398      1.14     rmind 	case FIOASYNC:
    399      1.14     rmind 		if ((*(int *)data) == 0) {
    400      1.14     rmind 			return 0;
    401      1.14     rmind 		}
    402      1.14     rmind 		/* FALLTHROUGH */
    403      1.14     rmind 	default:
    404       1.1  christos 		return EOPNOTSUPP;
    405       1.1  christos 	}
    406       1.1  christos }
    407