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