]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/powerpc/powerpc/mem.c
MFV r353143 (phillip):
[FreeBSD/FreeBSD.git] / sys / powerpc / powerpc / mem.c
1 /*-
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright (c) 1988 University of Utah.
5  * Copyright (c) 1982, 1986, 1990 The Regents of the University of California.
6  * All rights reserved.
7  *
8  * This code is derived from software contributed to Berkeley by
9  * the Systems Programming Group of the University of Utah Computer
10  * Science Department, and code derived from software contributed to
11  * Berkeley by William Jolitz.
12  *
13  * Redistribution and use in source and binary forms, with or without
14  * modification, are permitted provided that the following conditions
15  * are met:
16  * 1. Redistributions of source code must retain the above copyright
17  *    notice, this list of conditions and the following disclaimer.
18  * 2. Redistributions in binary form must reproduce the above copyright
19  *    notice, this list of conditions and the following disclaimer in the
20  *    documentation and/or other materials provided with the distribution.
21  * 3. Neither the name of the University nor the names of its contributors
22  *    may be used to endorse or promote products derived from this software
23  *    without specific prior written permission.
24  *
25  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
26  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
27  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
28  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
29  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
30  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
31  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
33  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
34  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35  * SUCH DAMAGE.
36  *
37  *      from: Utah $Hdr: mem.c 1.13 89/10/08$
38  *      from: @(#)mem.c 7.2 (Berkeley) 5/9/91
39  */
40
41 #include <sys/cdefs.h>
42 __FBSDID("$FreeBSD$");
43
44 /*
45  * Memory special file
46  */
47
48 #include <sys/param.h>
49 #include <sys/conf.h>
50 #include <sys/fcntl.h>
51 #include <sys/kernel.h>
52 #include <sys/lock.h>
53 #include <sys/ioccom.h>
54 #include <sys/malloc.h>
55 #include <sys/memrange.h>
56 #include <sys/module.h>
57 #include <sys/mutex.h>
58 #include <sys/proc.h>
59 #include <sys/msgbuf.h>
60 #include <sys/systm.h>
61 #include <sys/signalvar.h>
62 #include <sys/uio.h>
63
64 #include <machine/md_var.h>
65 #include <machine/vmparam.h>
66
67 #include <vm/vm.h>
68 #include <vm/pmap.h>
69 #include <vm/vm_extern.h>
70 #include <vm/vm_page.h>
71
72 #include <machine/memdev.h>
73
74 static void ppc_mrinit(struct mem_range_softc *);
75 static int ppc_mrset(struct mem_range_softc *, struct mem_range_desc *, int *);
76
77 MALLOC_DEFINE(M_MEMDESC, "memdesc", "memory range descriptors");
78
79 static struct mem_range_ops ppc_mem_range_ops = {
80         ppc_mrinit,
81         ppc_mrset,
82         NULL,
83         NULL
84 };
85 struct mem_range_softc mem_range_softc = {
86         &ppc_mem_range_ops,
87         0, 0, NULL
88 }; 
89
90 /* ARGSUSED */
91 int
92 memrw(struct cdev *dev, struct uio *uio, int flags)
93 {
94         struct iovec *iov;
95         int error = 0;
96         vm_offset_t va, eva, off, v;
97         vm_prot_t prot;
98         struct vm_page m;
99         vm_page_t marr;
100         vm_size_t cnt;
101
102         cnt = 0;
103         error = 0;
104
105         while (uio->uio_resid > 0 && !error) {
106                 iov = uio->uio_iov;
107                 if (iov->iov_len == 0) {
108                         uio->uio_iov++;
109                         uio->uio_iovcnt--;
110                         if (uio->uio_iovcnt < 0)
111                                 panic("memrw");
112                         continue;
113                 }
114                 if (dev2unit(dev) == CDEV_MINOR_MEM) {
115                         v = uio->uio_offset;
116
117 kmem_direct_mapped:     off = v & PAGE_MASK;
118                         cnt = PAGE_SIZE - ((vm_offset_t)iov->iov_base &
119                             PAGE_MASK);
120                         cnt = min(cnt, PAGE_SIZE - off);
121                         cnt = min(cnt, iov->iov_len);
122
123                         if (mem_valid(v, cnt)) {
124                                 error = EFAULT;
125                                 break;
126                         }
127         
128                         if (hw_direct_map && !pmap_dev_direct_mapped(v, cnt)) {
129                                 error = uiomove((void *)PHYS_TO_DMAP(v), cnt,
130                                     uio);
131                         } else {
132                                 m.phys_addr = trunc_page(v);
133                                 marr = &m;
134                                 error = uiomove_fromphys(&marr, off, cnt, uio);
135                         }
136                 }
137                 else if (dev2unit(dev) == CDEV_MINOR_KMEM) {
138                         va = uio->uio_offset;
139
140                         if ((va < VM_MIN_KERNEL_ADDRESS) || (va > virtual_end)) {
141                                 v = DMAP_TO_PHYS(va);
142                                 goto kmem_direct_mapped;
143                         }
144
145                         va = trunc_page(uio->uio_offset);
146                         eva = round_page(uio->uio_offset
147                             + iov->iov_len);
148
149                         /* 
150                          * Make sure that all the pages are currently resident
151                          * so that we don't create any zero-fill pages.
152                          */
153
154                         for (; va < eva; va += PAGE_SIZE)
155                                 if (pmap_extract(kernel_pmap, va) == 0)
156                                         return (EFAULT);
157
158                         prot = (uio->uio_rw == UIO_READ)
159                             ? VM_PROT_READ : VM_PROT_WRITE;
160
161                         va = uio->uio_offset;
162                         if (kernacc((void *) va, iov->iov_len, prot)
163                             == FALSE)
164                                 return (EFAULT);
165
166                         error = uiomove((void *)va, iov->iov_len, uio);
167
168                         continue;
169                 }
170         }
171
172         return (error);
173 }
174
175 /*
176  * allow user processes to MMAP some memory sections
177  * instead of going through read/write
178  */
179 int
180 memmmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr,
181     int prot, vm_memattr_t *memattr)
182 {
183         int i;
184
185         if (dev2unit(dev) == CDEV_MINOR_MEM)
186                 *paddr = offset;
187         else
188                 return (EFAULT);
189
190         for (i = 0; i < mem_range_softc.mr_ndesc; i++) {
191                 if (!(mem_range_softc.mr_desc[i].mr_flags & MDF_ACTIVE))
192                         continue;
193
194                 if (offset >= mem_range_softc.mr_desc[i].mr_base &&
195                     offset < mem_range_softc.mr_desc[i].mr_base +
196                     mem_range_softc.mr_desc[i].mr_len) {
197                         switch (mem_range_softc.mr_desc[i].mr_flags &
198                             MDF_ATTRMASK) {
199                         case MDF_WRITEBACK:
200                                 *memattr = VM_MEMATTR_WRITE_BACK;
201                                 break;
202                         case MDF_WRITECOMBINE:
203                                 *memattr = VM_MEMATTR_WRITE_COMBINING;
204                                 break;
205                         case MDF_UNCACHEABLE:
206                                 *memattr = VM_MEMATTR_UNCACHEABLE;
207                                 break;
208                         case MDF_WRITETHROUGH:
209                                 *memattr = VM_MEMATTR_WRITE_THROUGH;
210                                 break;
211                         }
212
213                         break;
214                 }
215         }
216
217         return (0);
218 }
219
220 static void
221 ppc_mrinit(struct mem_range_softc *sc)
222 {
223         sc->mr_cap = 0;
224         sc->mr_ndesc = 8; /* XXX: Should be dynamically expandable */
225         sc->mr_desc = malloc(sc->mr_ndesc * sizeof(struct mem_range_desc),
226             M_MEMDESC, M_WAITOK | M_ZERO);
227 }
228
229 static int
230 ppc_mrset(struct mem_range_softc *sc, struct mem_range_desc *desc, int *arg)
231 {
232         int i;
233
234         switch(*arg) {
235         case MEMRANGE_SET_UPDATE:
236                 for (i = 0; i < sc->mr_ndesc; i++) {
237                         if (!sc->mr_desc[i].mr_len) {
238                                 sc->mr_desc[i] = *desc;
239                                 sc->mr_desc[i].mr_flags |= MDF_ACTIVE;
240                                 return (0);
241                         }
242                         if (sc->mr_desc[i].mr_base == desc->mr_base &&
243                             sc->mr_desc[i].mr_len == desc->mr_len)
244                                 return (EEXIST);
245                 }
246                 return (ENOSPC);
247         case MEMRANGE_SET_REMOVE:
248                 for (i = 0; i < sc->mr_ndesc; i++)
249                         if (sc->mr_desc[i].mr_base == desc->mr_base &&
250                             sc->mr_desc[i].mr_len == desc->mr_len) {
251                                 bzero(&sc->mr_desc[i], sizeof(sc->mr_desc[i]));
252                                 return (0);
253                         }
254                 return (ENOENT);
255         default:
256                 return (EOPNOTSUPP);
257         }
258
259         return (0);
260 }
261
262 /*
263  * Operations for changing memory attributes.
264  *
265  * This is basically just an ioctl shim for mem_range_attr_get
266  * and mem_range_attr_set.
267  */
268 /* ARGSUSED */
269 int 
270 memioctl(struct cdev *dev __unused, u_long cmd, caddr_t data, int flags,
271     struct thread *td)
272 {
273         int nd, error = 0;
274         struct mem_range_op *mo = (struct mem_range_op *)data;
275         struct mem_range_desc *md;
276         
277         /* is this for us? */
278         if ((cmd != MEMRANGE_GET) &&
279             (cmd != MEMRANGE_SET))
280                 return (ENOTTY);
281
282         /* any chance we can handle this? */
283         if (mem_range_softc.mr_op == NULL)
284                 return (EOPNOTSUPP);
285
286         /* do we have any descriptors? */
287         if (mem_range_softc.mr_ndesc == 0)
288                 return (ENXIO);
289
290         switch (cmd) {
291         case MEMRANGE_GET:
292                 nd = imin(mo->mo_arg[0], mem_range_softc.mr_ndesc);
293                 if (nd > 0) {
294                         md = (struct mem_range_desc *)
295                                 malloc(nd * sizeof(struct mem_range_desc),
296                                        M_MEMDESC, M_WAITOK);
297                         error = mem_range_attr_get(md, &nd);
298                         if (!error)
299                                 error = copyout(md, mo->mo_desc, 
300                                         nd * sizeof(struct mem_range_desc));
301                         free(md, M_MEMDESC);
302                 }
303                 else
304                         nd = mem_range_softc.mr_ndesc;
305                 mo->mo_arg[0] = nd;
306                 break;
307                 
308         case MEMRANGE_SET:
309                 md = (struct mem_range_desc *)malloc(sizeof(struct mem_range_desc),
310                                                     M_MEMDESC, M_WAITOK);
311                 error = copyin(mo->mo_desc, md, sizeof(struct mem_range_desc));
312                 /* clamp description string */
313                 md->mr_owner[sizeof(md->mr_owner) - 1] = 0;
314                 if (error == 0)
315                         error = mem_range_attr_set(md, &mo->mo_arg[0]);
316                 free(md, M_MEMDESC);
317                 break;
318         }
319         return (error);
320 }
321