mm.c revision 1.13.16.3 1 1.13.16.3 rmind /* $NetBSD: mm.c,v 1.13.16.3 2010/04/25 21:08:45 rmind Exp $ */
2 1.1 christos
3 1.1 christos /*-
4 1.13.16.1 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.13.16.2 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.13.16.2 rmind /*
33 1.13.16.2 rmind * Special /dev/{mem,kmem,zero,null} memory devices.
34 1.13.16.2 rmind */
35 1.13.16.2 rmind
36 1.1 christos #include <sys/cdefs.h>
37 1.13.16.3 rmind __KERNEL_RCSID(0, "$NetBSD: mm.c,v 1.13.16.3 2010/04/25 21:08:45 rmind Exp $");
38 1.1 christos
39 1.13.16.1 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.1 christos #include <sys/ioctl.h>
44 1.13.16.1 rmind #include <sys/mman.h>
45 1.13.16.1 rmind #include <sys/uio.h>
46 1.13 oster #include <sys/termios.h>
47 1.2 gehenna
48 1.13.16.1 rmind #include <dev/mm.h>
49 1.13.16.1 rmind
50 1.13.16.1 rmind #include <uvm/uvm_extern.h>
51 1.1 christos
52 1.13.16.1 rmind static void * dev_zero_page;
53 1.13.16.1 rmind static kmutex_t dev_mem_lock;
54 1.13.16.1 rmind static vaddr_t dev_mem_addr;
55 1.13.16.1 rmind
56 1.13.16.1 rmind static dev_type_read(mm_readwrite);
57 1.13.16.1 rmind static dev_type_ioctl(mm_ioctl);
58 1.13.16.1 rmind static dev_type_mmap(mm_mmap);
59 1.13.16.1 rmind static dev_type_ioctl(mm_ioctl);
60 1.13.16.1 rmind
61 1.13.16.1 rmind const struct cdevsw mem_cdevsw = {
62 1.13.16.1 rmind #ifdef __HAVE_MM_MD_OPEN
63 1.13.16.1 rmind mm_md_open,
64 1.13.16.1 rmind #else
65 1.13.16.1 rmind nullopen,
66 1.13.16.1 rmind #endif
67 1.13.16.1 rmind nullclose, mm_readwrite, mm_readwrite,
68 1.13.16.1 rmind mm_ioctl, nostop, notty, nopoll, mm_mmap, nokqfilter,
69 1.13.16.1 rmind D_MPSAFE
70 1.13.16.1 rmind };
71 1.13.16.1 rmind
72 1.13.16.2 rmind #ifdef pmax /* XXX */
73 1.13.16.2 rmind const struct cdevsw mem_ultrix_cdevsw = {
74 1.13.16.2 rmind nullopen, nullclose, mm_readwrite, mm_readwrite, mm_ioctl,
75 1.13.16.2 rmind nostop, notty, nopoll, mm_mmap, nokqfilter, D_MPSAFE
76 1.13.16.2 rmind };
77 1.13.16.2 rmind #endif
78 1.13.16.2 rmind
79 1.13.16.2 rmind /*
80 1.13.16.2 rmind * mm_init: initialize memory device driver.
81 1.13.16.2 rmind */
82 1.13.16.1 rmind void
83 1.13.16.1 rmind mm_init(void)
84 1.1 christos {
85 1.13.16.1 rmind vaddr_t pg;
86 1.13.16.1 rmind
87 1.13.16.1 rmind mutex_init(&dev_mem_lock, MUTEX_DEFAULT, IPL_NONE);
88 1.13.16.1 rmind
89 1.13.16.2 rmind /* Read-only zero-page. */
90 1.13.16.1 rmind pg = uvm_km_alloc(kernel_map, PAGE_SIZE, 0, UVM_KMF_WIRED|UVM_KMF_ZERO);
91 1.13.16.1 rmind KASSERT(pg != 0);
92 1.13.16.1 rmind pmap_protect(pmap_kernel(), pg, pg + PAGE_SIZE, VM_PROT_READ);
93 1.13.16.1 rmind dev_zero_page = (void *)pg;
94 1.13.16.1 rmind
95 1.13.16.2 rmind #ifndef __HAVE_MM_MD_PREFER_VA
96 1.13.16.2 rmind /* KVA for mappings during I/O. */
97 1.13.16.3 rmind dev_mem_addr = uvm_km_alloc(kernel_map, PAGE_SIZE, 0,
98 1.13.16.3 rmind UVM_KMF_VAONLY|UVM_KMF_WAITVA);
99 1.13.16.1 rmind KASSERT(dev_mem_addr != 0);
100 1.13.16.2 rmind #endif
101 1.13.16.1 rmind }
102 1.13.16.1 rmind
103 1.13.16.2 rmind /*
104 1.13.16.2 rmind * dev_kmem_readwrite: helper for DEV_MEM (/dev/mem) case of R/W.
105 1.13.16.2 rmind */
106 1.13.16.1 rmind static int
107 1.13.16.1 rmind dev_mem_readwrite(struct uio *uio, struct iovec *iov)
108 1.13.16.1 rmind {
109 1.13.16.1 rmind paddr_t paddr;
110 1.13.16.1 rmind vaddr_t vaddr;
111 1.13.16.1 rmind vm_prot_t prot;
112 1.13.16.1 rmind size_t len, offset;
113 1.13.16.2 rmind bool have_direct;
114 1.13.16.1 rmind int error;
115 1.13.16.1 rmind
116 1.13.16.2 rmind /* Check for wrap around. */
117 1.13.16.1 rmind if ((intptr_t)uio->uio_offset != uio->uio_offset) {
118 1.13.16.1 rmind return EFAULT;
119 1.13.16.1 rmind }
120 1.13.16.1 rmind paddr = uio->uio_offset & ~PAGE_MASK;
121 1.13.16.2 rmind prot = (uio->uio_rw == UIO_WRITE) ? VM_PROT_WRITE : VM_PROT_READ;
122 1.13.16.1 rmind error = mm_md_physacc(paddr, prot);
123 1.13.16.1 rmind if (error) {
124 1.13.16.1 rmind return error;
125 1.13.16.1 rmind }
126 1.13.16.2 rmind offset = uio->uio_offset & PAGE_MASK;
127 1.13.16.2 rmind len = min(uio->uio_resid, PAGE_SIZE - offset);
128 1.13.16.1 rmind
129 1.13.16.1 rmind #ifdef __HAVE_MM_MD_DIRECT_MAPPED_PHYS
130 1.13.16.2 rmind /* Is physical address directly mapped? Return VA. */
131 1.13.16.1 rmind have_direct = mm_md_direct_mapped_phys(paddr, &vaddr);
132 1.13.16.1 rmind #else
133 1.13.16.1 rmind have_direct = false;
134 1.13.16.1 rmind #endif
135 1.13.16.1 rmind if (!have_direct) {
136 1.13.16.2 rmind #ifndef __HAVE_MM_MD_PREFER_VA
137 1.13.16.2 rmind const vaddr_t va = dev_mem_addr;
138 1.13.16.2 rmind #else
139 1.13.16.2 rmind /* Get a special virtual address. */
140 1.13.16.2 rmind const vaddr_t va = mm_md_getva(paddr);
141 1.13.16.2 rmind #endif
142 1.13.16.2 rmind /* Map selected KVA to physical address. */
143 1.13.16.1 rmind mutex_enter(&dev_mem_lock);
144 1.13.16.2 rmind pmap_kenter_pa(va, paddr, prot, 0);
145 1.13.16.1 rmind pmap_update(pmap_kernel());
146 1.13.16.1 rmind
147 1.13.16.2 rmind /* Perform I/O. */
148 1.13.16.2 rmind vaddr = va + offset;
149 1.13.16.1 rmind error = uiomove((void *)vaddr, len, uio);
150 1.13.16.1 rmind
151 1.13.16.2 rmind /* Unmap. Note: no need for pmap_update(). */
152 1.13.16.2 rmind pmap_kremove(va, PAGE_SIZE);
153 1.13.16.1 rmind mutex_exit(&dev_mem_lock);
154 1.13.16.2 rmind
155 1.13.16.2 rmind #ifdef __HAVE_MM_MD_PREFER_VA
156 1.13.16.2 rmind /* "Release" the virtual address. */
157 1.13.16.2 rmind mm_md_relva(va);
158 1.13.16.2 rmind #endif
159 1.13.16.1 rmind } else {
160 1.13.16.2 rmind /* Direct map, just perform I/O. */
161 1.13.16.2 rmind vaddr += offset;
162 1.13.16.1 rmind error = uiomove((void *)vaddr, len, uio);
163 1.13.16.1 rmind }
164 1.13.16.1 rmind return error;
165 1.13.16.1 rmind }
166 1.13.16.1 rmind
167 1.13.16.2 rmind /*
168 1.13.16.2 rmind * dev_kmem_readwrite: helper for DEV_KMEM (/dev/kmem) case of R/W.
169 1.13.16.2 rmind */
170 1.13.16.1 rmind static int
171 1.13.16.1 rmind dev_kmem_readwrite(struct uio *uio, struct iovec *iov)
172 1.13.16.1 rmind {
173 1.13.16.1 rmind void *addr;
174 1.13.16.1 rmind size_t len, offset;
175 1.13.16.1 rmind vm_prot_t prot;
176 1.13.16.1 rmind int error;
177 1.13.16.1 rmind bool md_kva;
178 1.13.16.1 rmind
179 1.13.16.2 rmind /* Check for wrap around. */
180 1.13.16.1 rmind addr = (void *)(intptr_t)uio->uio_offset;
181 1.13.16.1 rmind if ((uintptr_t)addr != uio->uio_offset) {
182 1.13.16.1 rmind return EFAULT;
183 1.13.16.1 rmind }
184 1.13.16.2 rmind /*
185 1.13.16.2 rmind * Handle non-page aligned offset.
186 1.13.16.2 rmind * Otherwise, we operate in page-by-page basis.
187 1.13.16.2 rmind */
188 1.13.16.1 rmind offset = uio->uio_offset & PAGE_MASK;
189 1.13.16.1 rmind len = min(uio->uio_resid, PAGE_SIZE - offset);
190 1.13.16.2 rmind prot = (uio->uio_rw == UIO_WRITE) ? VM_PROT_WRITE : VM_PROT_READ;
191 1.13.16.1 rmind
192 1.13.16.1 rmind md_kva = false;
193 1.13.16.1 rmind
194 1.13.16.1 rmind #ifdef __HAVE_MM_MD_DIRECT_MAPPED_IO
195 1.13.16.1 rmind paddr_t paddr;
196 1.13.16.2 rmind /* MD case: is this is a directly mapped address? */
197 1.13.16.1 rmind if (mm_md_direct_mapped_io(addr, &paddr)) {
198 1.13.16.2 rmind /* If so, validate physical address. */
199 1.13.16.1 rmind error = mm_md_physacc(paddr, prot);
200 1.13.16.2 rmind if (error) {
201 1.13.16.1 rmind return error;
202 1.13.16.2 rmind }
203 1.13.16.1 rmind md_kva = true;
204 1.13.16.1 rmind }
205 1.13.16.1 rmind #endif
206 1.13.16.2 rmind if (!md_kva) {
207 1.13.16.2 rmind bool checked = false;
208 1.13.16.1 rmind
209 1.13.16.1 rmind #ifdef __HAVE_MM_MD_KERNACC
210 1.13.16.2 rmind /* MD check for the address. */
211 1.13.16.2 rmind error = mm_md_kernacc(addr, prot, &checked);
212 1.13.16.2 rmind if (error) {
213 1.13.16.2 rmind return error;
214 1.13.16.2 rmind }
215 1.13.16.1 rmind #endif
216 1.13.16.2 rmind /* UVM check for the address (unless MD indicated to not). */
217 1.13.16.2 rmind if (!checked && !uvm_kernacc(addr, len, prot)) {
218 1.13.16.2 rmind return EFAULT;
219 1.13.16.2 rmind }
220 1.13.16.1 rmind }
221 1.13.16.1 rmind error = uiomove(addr, len, uio);
222 1.13.16.1 rmind return error;
223 1.13.16.1 rmind }
224 1.13.16.1 rmind
225 1.13.16.2 rmind /*
226 1.13.16.2 rmind * dev_zero_readwrite: helper for DEV_ZERO (/dev/null) case of R/W.
227 1.13.16.2 rmind */
228 1.13.16.2 rmind static inline int
229 1.13.16.1 rmind dev_zero_readwrite(struct uio *uio, struct iovec *iov)
230 1.13.16.1 rmind {
231 1.13.16.1 rmind size_t len;
232 1.13.16.1 rmind
233 1.13.16.2 rmind /* Nothing to do for the write case. */
234 1.13.16.1 rmind if (uio->uio_rw == UIO_WRITE) {
235 1.13.16.1 rmind uio->uio_resid = 0;
236 1.13.16.1 rmind return 0;
237 1.13.16.1 rmind }
238 1.13.16.2 rmind /*
239 1.13.16.2 rmind * Read in page-by-page basis, caller will continue.
240 1.13.16.2 rmind * Cut appropriately for a single/last-iteration cases.
241 1.13.16.2 rmind */
242 1.13.16.1 rmind len = min(iov->iov_len, PAGE_SIZE);
243 1.13.16.1 rmind return uiomove(dev_zero_page, len, uio);
244 1.13.16.1 rmind }
245 1.13.16.1 rmind
246 1.13.16.2 rmind /*
247 1.13.16.2 rmind * mm_readwrite: general memory R/W function.
248 1.13.16.2 rmind */
249 1.13.16.1 rmind static int
250 1.13.16.1 rmind mm_readwrite(dev_t dev, struct uio *uio, int flags)
251 1.13.16.1 rmind {
252 1.13.16.1 rmind struct iovec *iov;
253 1.13.16.1 rmind int error;
254 1.13.16.1 rmind
255 1.13.16.1 rmind #ifdef __HAVE_MM_MD_READWRITE
256 1.13.16.2 rmind /* If defined - there are extra MD cases. */
257 1.13.16.1 rmind switch (minor(dev)) {
258 1.13.16.1 rmind case DEV_MEM:
259 1.13.16.1 rmind case DEV_KMEM:
260 1.13.16.1 rmind case DEV_NULL:
261 1.13.16.1 rmind case DEV_ZERO:
262 1.13.16.1 rmind #if defined(COMPAT_16) && defined(__arm)
263 1.13.16.1 rmind case _DEV_ZERO_oARM:
264 1.13.16.1 rmind #endif
265 1.13.16.1 rmind break;
266 1.13.16.1 rmind default:
267 1.13.16.1 rmind return mm_md_readwrite(dev, uio);
268 1.13.16.1 rmind }
269 1.13.16.1 rmind #endif
270 1.13.16.1 rmind error = 0;
271 1.13.16.1 rmind while (uio->uio_resid > 0 && error == 0) {
272 1.13.16.1 rmind iov = uio->uio_iov;
273 1.13.16.1 rmind if (iov->iov_len == 0) {
274 1.13.16.2 rmind /* Processed; next I/O vector. */
275 1.13.16.2 rmind uio->uio_iov++;
276 1.13.16.2 rmind uio->uio_iovcnt--;
277 1.13.16.1 rmind KASSERT(uio->uio_iovcnt >= 0);
278 1.13.16.1 rmind continue;
279 1.13.16.1 rmind }
280 1.13.16.2 rmind /* Helper functions will process in page-by-page basis. */
281 1.13.16.1 rmind switch (minor(dev)) {
282 1.13.16.1 rmind case DEV_MEM:
283 1.13.16.1 rmind error = dev_mem_readwrite(uio, iov);
284 1.13.16.1 rmind break;
285 1.13.16.1 rmind case DEV_KMEM:
286 1.13.16.1 rmind error = dev_kmem_readwrite(uio, iov);
287 1.13.16.1 rmind break;
288 1.13.16.1 rmind case DEV_NULL:
289 1.13.16.1 rmind if (uio->uio_rw == UIO_WRITE) {
290 1.13.16.1 rmind uio->uio_resid = 0;
291 1.13.16.1 rmind }
292 1.13.16.1 rmind /* Break directly out of the loop. */
293 1.13.16.1 rmind return 0;
294 1.13.16.1 rmind #if defined(COMPAT_16) && defined(__arm)
295 1.13.16.1 rmind case _DEV_ZERO_oARM:
296 1.13.16.1 rmind #endif
297 1.13.16.1 rmind case DEV_ZERO:
298 1.13.16.1 rmind error = dev_zero_readwrite(uio, iov);
299 1.13.16.1 rmind break;
300 1.13.16.1 rmind default:
301 1.13.16.1 rmind error = ENXIO;
302 1.13.16.1 rmind break;
303 1.13.16.1 rmind }
304 1.13.16.1 rmind }
305 1.13.16.1 rmind return error;
306 1.13.16.1 rmind }
307 1.13.16.1 rmind
308 1.13.16.2 rmind /*
309 1.13.16.2 rmind * mm_mmap: general mmap() handler.
310 1.13.16.2 rmind */
311 1.13.16.1 rmind static paddr_t
312 1.13.16.1 rmind mm_mmap(dev_t dev, off_t off, int acc)
313 1.13.16.1 rmind {
314 1.13.16.1 rmind vm_prot_t prot;
315 1.13.16.1 rmind
316 1.13.16.1 rmind #ifdef __HAVE_MM_MD_MMAP
317 1.13.16.2 rmind /* If defined - there are extra mmap() MD cases. */
318 1.1 christos switch (minor(dev)) {
319 1.13.16.1 rmind case DEV_MEM:
320 1.13.16.1 rmind case DEV_KMEM:
321 1.13.16.1 rmind case DEV_NULL:
322 1.13.16.1 rmind #if defined(COMPAT_16) && defined(__arm)
323 1.13.16.1 rmind case _DEV_ZERO_oARM:
324 1.13.16.1 rmind #endif
325 1.13.16.1 rmind case DEV_ZERO:
326 1.13.16.1 rmind break;
327 1.6 jdolecek default:
328 1.13.16.1 rmind return mm_md_mmap(dev, off, acc);
329 1.13.16.1 rmind }
330 1.13.16.1 rmind #endif
331 1.13.16.1 rmind /*
332 1.13.16.1 rmind * /dev/null does not make sense, /dev/kmem is volatile and
333 1.13.16.1 rmind * /dev/zero is handled in mmap already.
334 1.13.16.1 rmind */
335 1.13.16.1 rmind if (minor(dev) != DEV_MEM) {
336 1.13.16.1 rmind return -1;
337 1.13.16.1 rmind }
338 1.13.16.1 rmind
339 1.13.16.1 rmind prot = 0;
340 1.13.16.1 rmind if (acc & PROT_EXEC)
341 1.13.16.1 rmind prot |= VM_PROT_EXECUTE;
342 1.13.16.1 rmind if (acc & PROT_READ)
343 1.13.16.1 rmind prot |= VM_PROT_READ;
344 1.13.16.1 rmind if (acc & PROT_WRITE)
345 1.13.16.1 rmind prot |= VM_PROT_WRITE;
346 1.13.16.1 rmind
347 1.13.16.2 rmind /* Validate the physical address. */
348 1.13.16.1 rmind if (mm_md_physacc(off, prot) != 0) {
349 1.13.16.1 rmind return -1;
350 1.13.16.1 rmind }
351 1.13.16.1 rmind return off >> PGSHIFT;
352 1.13.16.1 rmind }
353 1.13.16.1 rmind
354 1.13.16.1 rmind static int
355 1.13.16.1 rmind mm_ioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
356 1.13.16.1 rmind {
357 1.13.16.1 rmind
358 1.13.16.1 rmind switch (cmd) {
359 1.13.16.1 rmind case FIONBIO:
360 1.13.16.1 rmind /* We never block anyway. */
361 1.13.16.1 rmind return 0;
362 1.13.16.1 rmind
363 1.13.16.1 rmind case FIOSETOWN:
364 1.13.16.1 rmind case FIOGETOWN:
365 1.13.16.1 rmind case TIOCGPGRP:
366 1.13.16.1 rmind case TIOCSPGRP:
367 1.13.16.1 rmind case TIOCGETA:
368 1.13.16.1 rmind return ENOTTY;
369 1.13.16.1 rmind
370 1.13.16.1 rmind case FIOASYNC:
371 1.13.16.1 rmind if ((*(int *)data) == 0) {
372 1.1 christos return 0;
373 1.1 christos }
374 1.13.16.1 rmind /* FALLTHROUGH */
375 1.13.16.1 rmind default:
376 1.1 christos return EOPNOTSUPP;
377 1.1 christos }
378 1.1 christos }
379