]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/powerpc/powerpc/mem.c
MFV r330102: ntp 4.2.8p11
[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 kmem_direct_mapped:     v = uio->uio_offset;
116
117                         off = uio->uio_offset & 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 (!pmap_dev_direct_mapped(v, cnt)) {
129                                 error = uiomove((void *)v, cnt, uio);
130                         } else {
131                                 m.phys_addr = trunc_page(v);
132                                 marr = &m;
133                                 error = uiomove_fromphys(&marr, off, cnt, uio);
134                         }
135                 }
136                 else if (dev2unit(dev) == CDEV_MINOR_KMEM) {
137                         va = uio->uio_offset;
138
139                         if ((va < VM_MIN_KERNEL_ADDRESS) || (va > virtual_end))
140                                 goto kmem_direct_mapped;
141
142                         va = trunc_page(uio->uio_offset);
143                         eva = round_page(uio->uio_offset
144                             + iov->iov_len);
145
146                         /* 
147                          * Make sure that all the pages are currently resident
148                          * so that we don't create any zero-fill pages.
149                          */
150
151                         for (; va < eva; va += PAGE_SIZE)
152                                 if (pmap_extract(kernel_pmap, va) == 0)
153                                         return (EFAULT);
154
155                         prot = (uio->uio_rw == UIO_READ)
156                             ? VM_PROT_READ : VM_PROT_WRITE;
157
158                         va = uio->uio_offset;
159                         if (kernacc((void *) va, iov->iov_len, prot)
160                             == FALSE)
161                                 return (EFAULT);
162
163                         error = uiomove((void *)va, iov->iov_len, uio);
164
165                         continue;
166                 }
167         }
168
169         return (error);
170 }
171
172 /*
173  * allow user processes to MMAP some memory sections
174  * instead of going through read/write
175  */
176 int
177 memmmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr,
178     int prot, vm_memattr_t *memattr)
179 {
180         int i;
181
182         if (dev2unit(dev) == CDEV_MINOR_MEM)
183                 *paddr = offset;
184         else
185                 return (EFAULT);
186
187         for (i = 0; i < mem_range_softc.mr_ndesc; i++) {
188                 if (!(mem_range_softc.mr_desc[i].mr_flags & MDF_ACTIVE))
189                         continue;
190
191                 if (offset >= mem_range_softc.mr_desc[i].mr_base &&
192                     offset < mem_range_softc.mr_desc[i].mr_base +
193                     mem_range_softc.mr_desc[i].mr_len) {
194                         switch (mem_range_softc.mr_desc[i].mr_flags &
195                             MDF_ATTRMASK) {
196                         case MDF_WRITEBACK:
197                                 *memattr = VM_MEMATTR_WRITE_BACK;
198                                 break;
199                         case MDF_WRITECOMBINE:
200                                 *memattr = VM_MEMATTR_WRITE_COMBINING;
201                                 break;
202                         case MDF_UNCACHEABLE:
203                                 *memattr = VM_MEMATTR_UNCACHEABLE;
204                                 break;
205                         case MDF_WRITETHROUGH:
206                                 *memattr = VM_MEMATTR_WRITE_THROUGH;
207                                 break;
208                         }
209
210                         break;
211                 }
212         }
213
214         return (0);
215 }
216
217 static void
218 ppc_mrinit(struct mem_range_softc *sc)
219 {
220         sc->mr_cap = 0;
221         sc->mr_ndesc = 8; /* XXX: Should be dynamically expandable */
222         sc->mr_desc = malloc(sc->mr_ndesc * sizeof(struct mem_range_desc),
223             M_MEMDESC, M_WAITOK | M_ZERO);
224 }
225
226 static int
227 ppc_mrset(struct mem_range_softc *sc, struct mem_range_desc *desc, int *arg)
228 {
229         int i;
230
231         switch(*arg) {
232         case MEMRANGE_SET_UPDATE:
233                 for (i = 0; i < sc->mr_ndesc; i++) {
234                         if (!sc->mr_desc[i].mr_len) {
235                                 sc->mr_desc[i] = *desc;
236                                 sc->mr_desc[i].mr_flags |= MDF_ACTIVE;
237                                 return (0);
238                         }
239                         if (sc->mr_desc[i].mr_base == desc->mr_base &&
240                             sc->mr_desc[i].mr_len == desc->mr_len)
241                                 return (EEXIST);
242                 }
243                 return (ENOSPC);
244         case MEMRANGE_SET_REMOVE:
245                 for (i = 0; i < sc->mr_ndesc; i++)
246                         if (sc->mr_desc[i].mr_base == desc->mr_base &&
247                             sc->mr_desc[i].mr_len == desc->mr_len) {
248                                 bzero(&sc->mr_desc[i], sizeof(sc->mr_desc[i]));
249                                 return (0);
250                         }
251                 return (ENOENT);
252         default:
253                 return (EOPNOTSUPP);
254         }
255
256         return (0);
257 }
258
259 /*
260  * Operations for changing memory attributes.
261  *
262  * This is basically just an ioctl shim for mem_range_attr_get
263  * and mem_range_attr_set.
264  */
265 /* ARGSUSED */
266 int 
267 memioctl(struct cdev *dev __unused, u_long cmd, caddr_t data, int flags,
268     struct thread *td)
269 {
270         int nd, error = 0;
271         struct mem_range_op *mo = (struct mem_range_op *)data;
272         struct mem_range_desc *md;
273         
274         /* is this for us? */
275         if ((cmd != MEMRANGE_GET) &&
276             (cmd != MEMRANGE_SET))
277                 return (ENOTTY);
278
279         /* any chance we can handle this? */
280         if (mem_range_softc.mr_op == NULL)
281                 return (EOPNOTSUPP);
282
283         /* do we have any descriptors? */
284         if (mem_range_softc.mr_ndesc == 0)
285                 return (ENXIO);
286
287         switch (cmd) {
288         case MEMRANGE_GET:
289                 nd = imin(mo->mo_arg[0], mem_range_softc.mr_ndesc);
290                 if (nd > 0) {
291                         md = (struct mem_range_desc *)
292                                 malloc(nd * sizeof(struct mem_range_desc),
293                                        M_MEMDESC, M_WAITOK);
294                         error = mem_range_attr_get(md, &nd);
295                         if (!error)
296                                 error = copyout(md, mo->mo_desc, 
297                                         nd * sizeof(struct mem_range_desc));
298                         free(md, M_MEMDESC);
299                 }
300                 else
301                         nd = mem_range_softc.mr_ndesc;
302                 mo->mo_arg[0] = nd;
303                 break;
304                 
305         case MEMRANGE_SET:
306                 md = (struct mem_range_desc *)malloc(sizeof(struct mem_range_desc),
307                                                     M_MEMDESC, M_WAITOK);
308                 error = copyin(mo->mo_desc, md, sizeof(struct mem_range_desc));
309                 /* clamp description string */
310                 md->mr_owner[sizeof(md->mr_owner) - 1] = 0;
311                 if (error == 0)
312                         error = mem_range_attr_set(md, &mo->mo_arg[0]);
313                 free(md, M_MEMDESC);
314                 break;
315         }
316         return (error);
317 }
318