1*19c3b8c2SApple OSS Distributions /*
2*19c3b8c2SApple OSS Distributions * Copyright (c) 2004-2019 Apple Inc. All rights reserved.
3*19c3b8c2SApple OSS Distributions *
4*19c3b8c2SApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*19c3b8c2SApple OSS Distributions *
6*19c3b8c2SApple OSS Distributions * This file contains Original Code and/or Modifications of Original Code
7*19c3b8c2SApple OSS Distributions * as defined in and that are subject to the Apple Public Source License
8*19c3b8c2SApple OSS Distributions * Version 2.0 (the 'License'). You may not use this file except in
9*19c3b8c2SApple OSS Distributions * compliance with the License. The rights granted to you under the License
10*19c3b8c2SApple OSS Distributions * may not be used to create, or enable the creation or redistribution of,
11*19c3b8c2SApple OSS Distributions * unlawful or unlicensed copies of an Apple operating system, or to
12*19c3b8c2SApple OSS Distributions * circumvent, violate, or enable the circumvention or violation of, any
13*19c3b8c2SApple OSS Distributions * terms of an Apple operating system software license agreement.
14*19c3b8c2SApple OSS Distributions *
15*19c3b8c2SApple OSS Distributions * Please obtain a copy of the License at
16*19c3b8c2SApple OSS Distributions * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*19c3b8c2SApple OSS Distributions *
18*19c3b8c2SApple OSS Distributions * The Original Code and all software distributed under the License are
19*19c3b8c2SApple OSS Distributions * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*19c3b8c2SApple OSS Distributions * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*19c3b8c2SApple OSS Distributions * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*19c3b8c2SApple OSS Distributions * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*19c3b8c2SApple OSS Distributions * Please see the License for the specific language governing rights and
24*19c3b8c2SApple OSS Distributions * limitations under the License.
25*19c3b8c2SApple OSS Distributions *
26*19c3b8c2SApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*19c3b8c2SApple OSS Distributions */
28*19c3b8c2SApple OSS Distributions /*
29*19c3b8c2SApple OSS Distributions * Copyright (c) 1988 University of Utah.
30*19c3b8c2SApple OSS Distributions * Copyright (c) 1990, 1993
31*19c3b8c2SApple OSS Distributions * The Regents of the University of California. All rights reserved.
32*19c3b8c2SApple OSS Distributions *
33*19c3b8c2SApple OSS Distributions * This code is derived from software contributed to Berkeley by
34*19c3b8c2SApple OSS Distributions * the Systems Programming Group of the University of Utah Computer
35*19c3b8c2SApple OSS Distributions * Science Department.
36*19c3b8c2SApple OSS Distributions *
37*19c3b8c2SApple OSS Distributions * Redistribution and use in source and binary forms, with or without
38*19c3b8c2SApple OSS Distributions * modification, are permitted provided that the following conditions
39*19c3b8c2SApple OSS Distributions * are met:
40*19c3b8c2SApple OSS Distributions * 1. Redistributions of source code must retain the above copyright
41*19c3b8c2SApple OSS Distributions * notice, this list of conditions and the following disclaimer.
42*19c3b8c2SApple OSS Distributions * 2. Redistributions in binary form must reproduce the above copyright
43*19c3b8c2SApple OSS Distributions * notice, this list of conditions and the following disclaimer in the
44*19c3b8c2SApple OSS Distributions * documentation and/or other materials provided with the distribution.
45*19c3b8c2SApple OSS Distributions * 3. All advertising materials mentioning features or use of this software
46*19c3b8c2SApple OSS Distributions * must display the following acknowledgement:
47*19c3b8c2SApple OSS Distributions * This product includes software developed by the University of
48*19c3b8c2SApple OSS Distributions * California, Berkeley and its contributors.
49*19c3b8c2SApple OSS Distributions * 4. Neither the name of the University nor the names of its contributors
50*19c3b8c2SApple OSS Distributions * may be used to endorse or promote products derived from this software
51*19c3b8c2SApple OSS Distributions * without specific prior written permission.
52*19c3b8c2SApple OSS Distributions *
53*19c3b8c2SApple OSS Distributions * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
54*19c3b8c2SApple OSS Distributions * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
55*19c3b8c2SApple OSS Distributions * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
56*19c3b8c2SApple OSS Distributions * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
57*19c3b8c2SApple OSS Distributions * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
58*19c3b8c2SApple OSS Distributions * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
59*19c3b8c2SApple OSS Distributions * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
60*19c3b8c2SApple OSS Distributions * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
61*19c3b8c2SApple OSS Distributions * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
62*19c3b8c2SApple OSS Distributions * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
63*19c3b8c2SApple OSS Distributions * SUCH DAMAGE.
64*19c3b8c2SApple OSS Distributions *
65*19c3b8c2SApple OSS Distributions * from: Utah Hdr: vn.c 1.13 94/04/02
66*19c3b8c2SApple OSS Distributions *
67*19c3b8c2SApple OSS Distributions * from: @(#)vn.c 8.6 (Berkeley) 4/1/94
68*19c3b8c2SApple OSS Distributions * $FreeBSD: src/sys/dev/vn/vn.c,v 1.105.2.4 2001/11/18 07:11:00 dillon Exp $
69*19c3b8c2SApple OSS Distributions */
70*19c3b8c2SApple OSS Distributions
71*19c3b8c2SApple OSS Distributions /*
72*19c3b8c2SApple OSS Distributions * RAM disk driver.
73*19c3b8c2SApple OSS Distributions *
74*19c3b8c2SApple OSS Distributions * Block interface to a ramdisk.
75*19c3b8c2SApple OSS Distributions *
76*19c3b8c2SApple OSS Distributions */
77*19c3b8c2SApple OSS Distributions
78*19c3b8c2SApple OSS Distributions #include <sys/param.h>
79*19c3b8c2SApple OSS Distributions #include <sys/kernel.h>
80*19c3b8c2SApple OSS Distributions #include <sys/mount.h>
81*19c3b8c2SApple OSS Distributions #include <sys/namei.h>
82*19c3b8c2SApple OSS Distributions #include <sys/proc.h>
83*19c3b8c2SApple OSS Distributions #include <sys/buf.h>
84*19c3b8c2SApple OSS Distributions #include <sys/malloc.h>
85*19c3b8c2SApple OSS Distributions #include <sys/mount.h>
86*19c3b8c2SApple OSS Distributions #include <sys/fcntl.h>
87*19c3b8c2SApple OSS Distributions #include <sys/conf.h>
88*19c3b8c2SApple OSS Distributions #include <sys/disk.h>
89*19c3b8c2SApple OSS Distributions #include <sys/stat.h>
90*19c3b8c2SApple OSS Distributions #include <sys/vm.h>
91*19c3b8c2SApple OSS Distributions #include <sys/uio_internal.h>
92*19c3b8c2SApple OSS Distributions #include <libkern/libkern.h>
93*19c3b8c2SApple OSS Distributions
94*19c3b8c2SApple OSS Distributions #include <vm/pmap.h>
95*19c3b8c2SApple OSS Distributions #include <vm/vm_pager.h>
96*19c3b8c2SApple OSS Distributions #include <mach/memory_object_types.h>
97*19c3b8c2SApple OSS Distributions #include <kern/debug.h>
98*19c3b8c2SApple OSS Distributions
99*19c3b8c2SApple OSS Distributions #include <miscfs/devfs/devfs.h>
100*19c3b8c2SApple OSS Distributions
101*19c3b8c2SApple OSS Distributions
102*19c3b8c2SApple OSS Distributions void mdevinit(int the_cnt);
103*19c3b8c2SApple OSS Distributions
104*19c3b8c2SApple OSS Distributions static open_close_fcn_t mdevopen;
105*19c3b8c2SApple OSS Distributions static open_close_fcn_t mdevclose;
106*19c3b8c2SApple OSS Distributions static psize_fcn_t mdevsize;
107*19c3b8c2SApple OSS Distributions static strategy_fcn_t mdevstrategy;
108*19c3b8c2SApple OSS Distributions static int mdevbioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p);
109*19c3b8c2SApple OSS Distributions static int mdevcioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p);
110*19c3b8c2SApple OSS Distributions static int mdevrw(dev_t dev, struct uio *uio, int ioflag);
111*19c3b8c2SApple OSS Distributions
112*19c3b8c2SApple OSS Distributions #ifdef CONFIG_MEMDEV_INSECURE
113*19c3b8c2SApple OSS Distributions static char * nonspace(char *pos, char *end);
114*19c3b8c2SApple OSS Distributions static char * getspace(char *pos, char *end);
115*19c3b8c2SApple OSS Distributions static char * cvtnum(char *pos, char *end, uint64_t *num);
116*19c3b8c2SApple OSS Distributions #endif /* CONFIG_MEMDEV_INSECURE */
117*19c3b8c2SApple OSS Distributions
118*19c3b8c2SApple OSS Distributions extern void bcopy_phys(addr64_t from, addr64_t to, vm_size_t bytes);
119*19c3b8c2SApple OSS Distributions extern void mapping_set_mod(ppnum_t pn);
120*19c3b8c2SApple OSS Distributions extern ppnum_t pmap_find_phys(pmap_t pmap, addr64_t va);
121*19c3b8c2SApple OSS Distributions
122*19c3b8c2SApple OSS Distributions /*
123*19c3b8c2SApple OSS Distributions * Maximal number of memory devices.
124*19c3b8c2SApple OSS Distributions */
125*19c3b8c2SApple OSS Distributions #define NB_MAX_MDEVICES (16)
126*19c3b8c2SApple OSS Distributions
127*19c3b8c2SApple OSS Distributions /*
128*19c3b8c2SApple OSS Distributions * cdevsw
129*19c3b8c2SApple OSS Distributions * D_DISK we want to look like a disk
130*19c3b8c2SApple OSS Distributions * D_CANFREE We support B_FREEBUF
131*19c3b8c2SApple OSS Distributions */
132*19c3b8c2SApple OSS Distributions
133*19c3b8c2SApple OSS Distributions static const struct bdevsw mdevbdevsw = {
134*19c3b8c2SApple OSS Distributions .d_open = mdevopen,
135*19c3b8c2SApple OSS Distributions .d_close = mdevclose,
136*19c3b8c2SApple OSS Distributions .d_strategy = mdevstrategy,
137*19c3b8c2SApple OSS Distributions .d_ioctl = mdevbioctl,
138*19c3b8c2SApple OSS Distributions .d_dump = eno_dump,
139*19c3b8c2SApple OSS Distributions .d_psize = mdevsize,
140*19c3b8c2SApple OSS Distributions .d_type = D_DISK,
141*19c3b8c2SApple OSS Distributions };
142*19c3b8c2SApple OSS Distributions
143*19c3b8c2SApple OSS Distributions static const struct cdevsw mdevcdevsw = {
144*19c3b8c2SApple OSS Distributions .d_open = mdevopen,
145*19c3b8c2SApple OSS Distributions .d_close = mdevclose,
146*19c3b8c2SApple OSS Distributions .d_read = mdevrw,
147*19c3b8c2SApple OSS Distributions .d_write = mdevrw,
148*19c3b8c2SApple OSS Distributions .d_ioctl = mdevcioctl,
149*19c3b8c2SApple OSS Distributions .d_stop = eno_stop,
150*19c3b8c2SApple OSS Distributions .d_reset = eno_reset,
151*19c3b8c2SApple OSS Distributions .d_ttys = NULL,
152*19c3b8c2SApple OSS Distributions .d_select = eno_select,
153*19c3b8c2SApple OSS Distributions .d_mmap = eno_mmap,
154*19c3b8c2SApple OSS Distributions .d_strategy = eno_strat,
155*19c3b8c2SApple OSS Distributions .d_reserved_1 = eno_getc,
156*19c3b8c2SApple OSS Distributions .d_reserved_2 = eno_putc,
157*19c3b8c2SApple OSS Distributions .d_type = D_DISK,
158*19c3b8c2SApple OSS Distributions };
159*19c3b8c2SApple OSS Distributions
160*19c3b8c2SApple OSS Distributions struct mdev {
161*19c3b8c2SApple OSS Distributions uint64_t mdBase; /* base page number (pages are assumed to be 4K). Multiply by 4096 to find actual address */
162*19c3b8c2SApple OSS Distributions uint32_t mdSize; /* size in pages (pages are assumed to be 4K). Multiply by 4096 to find actual size. */
163*19c3b8c2SApple OSS Distributions int mdFlags; /* flags */
164*19c3b8c2SApple OSS Distributions int mdSecsize; /* sector size */
165*19c3b8c2SApple OSS Distributions int mdBDev; /* Block device number */
166*19c3b8c2SApple OSS Distributions int mdCDev; /* Character device number */
167*19c3b8c2SApple OSS Distributions void * mdbdevb;
168*19c3b8c2SApple OSS Distributions void * mdcdevb;
169*19c3b8c2SApple OSS Distributions } mdev[NB_MAX_MDEVICES];
170*19c3b8c2SApple OSS Distributions
171*19c3b8c2SApple OSS Distributions /* mdFlags */
172*19c3b8c2SApple OSS Distributions #define mdInited 0x01 /* This device defined */
173*19c3b8c2SApple OSS Distributions #define mdRO 0x02 /* This device is read-only */
174*19c3b8c2SApple OSS Distributions #define mdPhys 0x04 /* This device is in physical memory */
175*19c3b8c2SApple OSS Distributions
176*19c3b8c2SApple OSS Distributions int mdevBMajor = -1;
177*19c3b8c2SApple OSS Distributions int mdevCMajor = -1;
178*19c3b8c2SApple OSS Distributions
179*19c3b8c2SApple OSS Distributions static int mdevioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p, int is_char);
180*19c3b8c2SApple OSS Distributions dev_t mdevadd(int devid, uint64_t base, unsigned int size, int phys);
181*19c3b8c2SApple OSS Distributions dev_t mdevlookup(int devid);
182*19c3b8c2SApple OSS Distributions void mdevremoveall(void);
183*19c3b8c2SApple OSS Distributions int mdevgetrange(int devid, uint64_t *base, uint64_t *size);
184*19c3b8c2SApple OSS Distributions
185*19c3b8c2SApple OSS Distributions static int
mdevclose(__unused dev_t dev,__unused int flags,__unused int devtype,__unused struct proc * p)186*19c3b8c2SApple OSS Distributions mdevclose(__unused dev_t dev, __unused int flags,
187*19c3b8c2SApple OSS Distributions __unused int devtype, __unused struct proc *p)
188*19c3b8c2SApple OSS Distributions {
189*19c3b8c2SApple OSS Distributions return 0;
190*19c3b8c2SApple OSS Distributions }
191*19c3b8c2SApple OSS Distributions
192*19c3b8c2SApple OSS Distributions static int
mdevopen(dev_t dev,int flags,__unused int devtype,__unused struct proc * p)193*19c3b8c2SApple OSS Distributions mdevopen(dev_t dev, int flags, __unused int devtype, __unused struct proc *p)
194*19c3b8c2SApple OSS Distributions {
195*19c3b8c2SApple OSS Distributions int devid;
196*19c3b8c2SApple OSS Distributions
197*19c3b8c2SApple OSS Distributions devid = minor(dev); /* Get minor device number */
198*19c3b8c2SApple OSS Distributions
199*19c3b8c2SApple OSS Distributions if (devid >= NB_MAX_MDEVICES) {
200*19c3b8c2SApple OSS Distributions return ENXIO; /* Not valid */
201*19c3b8c2SApple OSS Distributions }
202*19c3b8c2SApple OSS Distributions if ((flags & FWRITE) && (mdev[devid].mdFlags & mdRO)) {
203*19c3b8c2SApple OSS Distributions return EACCES; /* Currently mounted RO */
204*19c3b8c2SApple OSS Distributions }
205*19c3b8c2SApple OSS Distributions return 0;
206*19c3b8c2SApple OSS Distributions }
207*19c3b8c2SApple OSS Distributions
208*19c3b8c2SApple OSS Distributions static int
mdevrw(dev_t dev,struct uio * uio,__unused int ioflag)209*19c3b8c2SApple OSS Distributions mdevrw(dev_t dev, struct uio *uio, __unused int ioflag)
210*19c3b8c2SApple OSS Distributions {
211*19c3b8c2SApple OSS Distributions int status;
212*19c3b8c2SApple OSS Distributions addr64_t mdata;
213*19c3b8c2SApple OSS Distributions int devid;
214*19c3b8c2SApple OSS Distributions enum uio_seg saveflag;
215*19c3b8c2SApple OSS Distributions int count;
216*19c3b8c2SApple OSS Distributions
217*19c3b8c2SApple OSS Distributions devid = minor(dev); /* Get minor device number */
218*19c3b8c2SApple OSS Distributions
219*19c3b8c2SApple OSS Distributions if (devid >= NB_MAX_MDEVICES) {
220*19c3b8c2SApple OSS Distributions return ENXIO; /* Not valid */
221*19c3b8c2SApple OSS Distributions }
222*19c3b8c2SApple OSS Distributions if (!(mdev[devid].mdFlags & mdInited)) {
223*19c3b8c2SApple OSS Distributions return ENXIO; /* Have we actually been defined yet? */
224*19c3b8c2SApple OSS Distributions }
225*19c3b8c2SApple OSS Distributions if (uio->uio_offset < 0) {
226*19c3b8c2SApple OSS Distributions return EINVAL; /* invalid offset */
227*19c3b8c2SApple OSS Distributions }
228*19c3b8c2SApple OSS Distributions if (uio_resid(uio) < 0) {
229*19c3b8c2SApple OSS Distributions return EINVAL;
230*19c3b8c2SApple OSS Distributions }
231*19c3b8c2SApple OSS Distributions mdata = ((addr64_t)mdev[devid].mdBase << 12) + uio->uio_offset; /* Point to the area in "file" */
232*19c3b8c2SApple OSS Distributions
233*19c3b8c2SApple OSS Distributions saveflag = uio->uio_segflg; /* Remember what the request is */
234*19c3b8c2SApple OSS Distributions #if LP64_DEBUG
235*19c3b8c2SApple OSS Distributions if (UIO_IS_USER_SPACE(uio) == 0 && UIO_IS_SYS_SPACE(uio) == 0) {
236*19c3b8c2SApple OSS Distributions panic("mdevrw - invalid uio_segflg");
237*19c3b8c2SApple OSS Distributions }
238*19c3b8c2SApple OSS Distributions #endif /* LP64_DEBUG */
239*19c3b8c2SApple OSS Distributions /* Make sure we are moving from physical ram if physical device */
240*19c3b8c2SApple OSS Distributions if (mdev[devid].mdFlags & mdPhys) {
241*19c3b8c2SApple OSS Distributions if (uio->uio_segflg == UIO_USERSPACE64) {
242*19c3b8c2SApple OSS Distributions uio->uio_segflg = UIO_PHYS_USERSPACE64;
243*19c3b8c2SApple OSS Distributions } else if (uio->uio_segflg == UIO_USERSPACE32) {
244*19c3b8c2SApple OSS Distributions uio->uio_segflg = UIO_PHYS_USERSPACE32;
245*19c3b8c2SApple OSS Distributions } else {
246*19c3b8c2SApple OSS Distributions uio->uio_segflg = UIO_PHYS_USERSPACE;
247*19c3b8c2SApple OSS Distributions }
248*19c3b8c2SApple OSS Distributions }
249*19c3b8c2SApple OSS Distributions
250*19c3b8c2SApple OSS Distributions if (uio->uio_offset > (mdev[devid].mdSize << 12)) {
251*19c3b8c2SApple OSS Distributions count = 0;
252*19c3b8c2SApple OSS Distributions } else {
253*19c3b8c2SApple OSS Distributions count = imin(uio_resid(uio), (mdev[devid].mdSize << 12) - uio->uio_offset);
254*19c3b8c2SApple OSS Distributions }
255*19c3b8c2SApple OSS Distributions
256*19c3b8c2SApple OSS Distributions status = uiomove64(mdata, count, uio); /* Move the data */
257*19c3b8c2SApple OSS Distributions uio->uio_segflg = saveflag; /* Restore the flag */
258*19c3b8c2SApple OSS Distributions
259*19c3b8c2SApple OSS Distributions return status;
260*19c3b8c2SApple OSS Distributions }
261*19c3b8c2SApple OSS Distributions
262*19c3b8c2SApple OSS Distributions static void
mdevstrategy(struct buf * bp)263*19c3b8c2SApple OSS Distributions mdevstrategy(struct buf *bp)
264*19c3b8c2SApple OSS Distributions {
265*19c3b8c2SApple OSS Distributions unsigned int left, lop, csize;
266*19c3b8c2SApple OSS Distributions vm_offset_t vaddr, blkoff;
267*19c3b8c2SApple OSS Distributions int devid;
268*19c3b8c2SApple OSS Distributions addr64_t paddr, fvaddr;
269*19c3b8c2SApple OSS Distributions ppnum_t pp;
270*19c3b8c2SApple OSS Distributions
271*19c3b8c2SApple OSS Distributions devid = minor(buf_device(bp)); /* Get minor device number */
272*19c3b8c2SApple OSS Distributions
273*19c3b8c2SApple OSS Distributions if ((mdev[devid].mdFlags & mdInited) == 0) { /* Have we actually been defined yet? */
274*19c3b8c2SApple OSS Distributions buf_seterror(bp, ENXIO);
275*19c3b8c2SApple OSS Distributions buf_biodone(bp);
276*19c3b8c2SApple OSS Distributions return;
277*19c3b8c2SApple OSS Distributions }
278*19c3b8c2SApple OSS Distributions
279*19c3b8c2SApple OSS Distributions buf_setresid(bp, buf_count(bp)); /* Set byte count */
280*19c3b8c2SApple OSS Distributions
281*19c3b8c2SApple OSS Distributions blkoff = buf_blkno(bp) * mdev[devid].mdSecsize; /* Get offset into file */
282*19c3b8c2SApple OSS Distributions
283*19c3b8c2SApple OSS Distributions /*
284*19c3b8c2SApple OSS Distributions * Note that reading past end is an error, but reading at end is an EOF. For these
285*19c3b8c2SApple OSS Distributions * we just return with resid == count.
286*19c3b8c2SApple OSS Distributions */
287*19c3b8c2SApple OSS Distributions
288*19c3b8c2SApple OSS Distributions if (blkoff >= (mdev[devid].mdSize << 12)) { /* Are they trying to read/write at/after end? */
289*19c3b8c2SApple OSS Distributions if (blkoff != (mdev[devid].mdSize << 12)) { /* Are we trying to read after EOF? */
290*19c3b8c2SApple OSS Distributions buf_seterror(bp, EINVAL); /* Yeah, this is an error */
291*19c3b8c2SApple OSS Distributions }
292*19c3b8c2SApple OSS Distributions buf_biodone(bp); /* Return */
293*19c3b8c2SApple OSS Distributions return;
294*19c3b8c2SApple OSS Distributions }
295*19c3b8c2SApple OSS Distributions
296*19c3b8c2SApple OSS Distributions if ((blkoff + buf_count(bp)) > (mdev[devid].mdSize << 12)) { /* Will this read go past end? */
297*19c3b8c2SApple OSS Distributions buf_setcount(bp, (uint32_t)((mdev[devid].mdSize << 12) - blkoff)); /* Yes, trim to max */
298*19c3b8c2SApple OSS Distributions }
299*19c3b8c2SApple OSS Distributions /*
300*19c3b8c2SApple OSS Distributions * make sure the buffer's data area is
301*19c3b8c2SApple OSS Distributions * accessible
302*19c3b8c2SApple OSS Distributions */
303*19c3b8c2SApple OSS Distributions if (buf_map(bp, (caddr_t *)&vaddr)) {
304*19c3b8c2SApple OSS Distributions panic("ramstrategy: buf_map failed");
305*19c3b8c2SApple OSS Distributions }
306*19c3b8c2SApple OSS Distributions
307*19c3b8c2SApple OSS Distributions fvaddr = (mdev[devid].mdBase << 12) + blkoff; /* Point to offset into ram disk */
308*19c3b8c2SApple OSS Distributions
309*19c3b8c2SApple OSS Distributions if (buf_flags(bp) & B_READ) { /* Is this a read? */
310*19c3b8c2SApple OSS Distributions if (!(mdev[devid].mdFlags & mdPhys)) { /* Physical mapped disk? */
311*19c3b8c2SApple OSS Distributions bcopy((void *)((uintptr_t)fvaddr),
312*19c3b8c2SApple OSS Distributions (void *)vaddr, (size_t)buf_count(bp)); /* This is virtual, just get the data */
313*19c3b8c2SApple OSS Distributions } else {
314*19c3b8c2SApple OSS Distributions left = buf_count(bp); /* Init the amount left to copy */
315*19c3b8c2SApple OSS Distributions while (left) { /* Go until it is all copied */
316*19c3b8c2SApple OSS Distributions lop = min((4096 - (vaddr & 4095)), (4096 - (fvaddr & 4095))); /* Get smallest amount left on sink and source */
317*19c3b8c2SApple OSS Distributions csize = min(lop, left); /* Don't move more than we need to */
318*19c3b8c2SApple OSS Distributions
319*19c3b8c2SApple OSS Distributions pp = pmap_find_phys(kernel_pmap, (addr64_t)((uintptr_t)vaddr)); /* Get the sink physical address */
320*19c3b8c2SApple OSS Distributions if (!pp) { /* Not found, what gives? */
321*19c3b8c2SApple OSS Distributions panic("mdevstrategy: sink address %016llX not mapped", (addr64_t)((uintptr_t)vaddr));
322*19c3b8c2SApple OSS Distributions }
323*19c3b8c2SApple OSS Distributions paddr = (addr64_t)(((addr64_t)pp << 12) | (addr64_t)(vaddr & 4095)); /* Get actual address */
324*19c3b8c2SApple OSS Distributions bcopy_phys(fvaddr, paddr, csize); /* Copy this on in */
325*19c3b8c2SApple OSS Distributions mapping_set_mod((ppnum_t)(paddr >> 12)); /* Make sure we know that it is modified */
326*19c3b8c2SApple OSS Distributions
327*19c3b8c2SApple OSS Distributions left = left - csize; /* Calculate what is left */
328*19c3b8c2SApple OSS Distributions vaddr = vaddr + csize; /* Move to next sink address */
329*19c3b8c2SApple OSS Distributions fvaddr = fvaddr + csize; /* Bump to next physical address */
330*19c3b8c2SApple OSS Distributions }
331*19c3b8c2SApple OSS Distributions }
332*19c3b8c2SApple OSS Distributions } else { /* This is a write */
333*19c3b8c2SApple OSS Distributions if (!(mdev[devid].mdFlags & mdPhys)) { /* Physical mapped disk? */
334*19c3b8c2SApple OSS Distributions bcopy((void *)vaddr, (void *)((uintptr_t)fvaddr),
335*19c3b8c2SApple OSS Distributions (size_t)buf_count(bp)); /* This is virtual, just put the data */
336*19c3b8c2SApple OSS Distributions } else {
337*19c3b8c2SApple OSS Distributions left = buf_count(bp); /* Init the amount left to copy */
338*19c3b8c2SApple OSS Distributions while (left) { /* Go until it is all copied */
339*19c3b8c2SApple OSS Distributions lop = min((4096 - (vaddr & 4095)), (4096 - (fvaddr & 4095))); /* Get smallest amount left on sink and source */
340*19c3b8c2SApple OSS Distributions csize = min(lop, left); /* Don't move more than we need to */
341*19c3b8c2SApple OSS Distributions
342*19c3b8c2SApple OSS Distributions pp = pmap_find_phys(kernel_pmap, (addr64_t)((uintptr_t)vaddr)); /* Get the source physical address */
343*19c3b8c2SApple OSS Distributions if (!pp) { /* Not found, what gives? */
344*19c3b8c2SApple OSS Distributions panic("mdevstrategy: source address %016llX not mapped", (addr64_t)((uintptr_t)vaddr));
345*19c3b8c2SApple OSS Distributions }
346*19c3b8c2SApple OSS Distributions paddr = (addr64_t)(((addr64_t)pp << 12) | (addr64_t)(vaddr & 4095)); /* Get actual address */
347*19c3b8c2SApple OSS Distributions
348*19c3b8c2SApple OSS Distributions bcopy_phys(paddr, fvaddr, csize); /* Move this on out */
349*19c3b8c2SApple OSS Distributions
350*19c3b8c2SApple OSS Distributions left = left - csize; /* Calculate what is left */
351*19c3b8c2SApple OSS Distributions vaddr = vaddr + csize; /* Move to next sink address */
352*19c3b8c2SApple OSS Distributions fvaddr = fvaddr + csize; /* Bump to next physical address */
353*19c3b8c2SApple OSS Distributions }
354*19c3b8c2SApple OSS Distributions }
355*19c3b8c2SApple OSS Distributions }
356*19c3b8c2SApple OSS Distributions /*
357*19c3b8c2SApple OSS Distributions * buf_unmap takes care of all the cases
358*19c3b8c2SApple OSS Distributions * it will unmap the buffer from kernel
359*19c3b8c2SApple OSS Distributions * virtual space if that was the state
360*19c3b8c2SApple OSS Distributions * when we mapped it.
361*19c3b8c2SApple OSS Distributions */
362*19c3b8c2SApple OSS Distributions buf_unmap(bp);
363*19c3b8c2SApple OSS Distributions
364*19c3b8c2SApple OSS Distributions buf_setresid(bp, 0); /* Nothing more to do */
365*19c3b8c2SApple OSS Distributions buf_biodone(bp); /* Say we've finished */
366*19c3b8c2SApple OSS Distributions }
367*19c3b8c2SApple OSS Distributions
368*19c3b8c2SApple OSS Distributions static int
mdevbioctl(dev_t dev,u_long cmd,caddr_t data,int flag,struct proc * p)369*19c3b8c2SApple OSS Distributions mdevbioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
370*19c3b8c2SApple OSS Distributions {
371*19c3b8c2SApple OSS Distributions return mdevioctl(dev, cmd, data, flag, p, 0);
372*19c3b8c2SApple OSS Distributions }
373*19c3b8c2SApple OSS Distributions
374*19c3b8c2SApple OSS Distributions static int
mdevcioctl(dev_t dev,u_long cmd,caddr_t data,int flag,struct proc * p)375*19c3b8c2SApple OSS Distributions mdevcioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
376*19c3b8c2SApple OSS Distributions {
377*19c3b8c2SApple OSS Distributions return mdevioctl(dev, cmd, data, flag, p, 1);
378*19c3b8c2SApple OSS Distributions }
379*19c3b8c2SApple OSS Distributions
380*19c3b8c2SApple OSS Distributions static int
mdevioctl(dev_t dev,u_long cmd,caddr_t data,__unused int flag,struct proc * p,int is_char)381*19c3b8c2SApple OSS Distributions mdevioctl(dev_t dev, u_long cmd, caddr_t data, __unused int flag,
382*19c3b8c2SApple OSS Distributions struct proc *p, int is_char)
383*19c3b8c2SApple OSS Distributions {
384*19c3b8c2SApple OSS Distributions int error;
385*19c3b8c2SApple OSS Distributions u_int32_t *f;
386*19c3b8c2SApple OSS Distributions u_int64_t *o;
387*19c3b8c2SApple OSS Distributions int devid;
388*19c3b8c2SApple OSS Distributions dk_memdev_info_t * memdev_info;
389*19c3b8c2SApple OSS Distributions
390*19c3b8c2SApple OSS Distributions devid = minor(dev); /* Get minor device number */
391*19c3b8c2SApple OSS Distributions
392*19c3b8c2SApple OSS Distributions if (devid >= NB_MAX_MDEVICES) {
393*19c3b8c2SApple OSS Distributions return ENXIO; /* Not valid */
394*19c3b8c2SApple OSS Distributions }
395*19c3b8c2SApple OSS Distributions error = proc_suser(p); /* Are we superman? */
396*19c3b8c2SApple OSS Distributions if (error) {
397*19c3b8c2SApple OSS Distributions return error; /* Nope... */
398*19c3b8c2SApple OSS Distributions }
399*19c3b8c2SApple OSS Distributions f = (u_int32_t*)data;
400*19c3b8c2SApple OSS Distributions o = (u_int64_t *)data;
401*19c3b8c2SApple OSS Distributions memdev_info = (dk_memdev_info_t *) data;
402*19c3b8c2SApple OSS Distributions
403*19c3b8c2SApple OSS Distributions switch (cmd) {
404*19c3b8c2SApple OSS Distributions case DKIOCGETMAXBLOCKCOUNTREAD:
405*19c3b8c2SApple OSS Distributions *o = 32;
406*19c3b8c2SApple OSS Distributions break;
407*19c3b8c2SApple OSS Distributions
408*19c3b8c2SApple OSS Distributions case DKIOCGETMAXBLOCKCOUNTWRITE:
409*19c3b8c2SApple OSS Distributions *o = 32;
410*19c3b8c2SApple OSS Distributions break;
411*19c3b8c2SApple OSS Distributions
412*19c3b8c2SApple OSS Distributions case DKIOCGETMAXSEGMENTCOUNTREAD:
413*19c3b8c2SApple OSS Distributions *o = 32;
414*19c3b8c2SApple OSS Distributions break;
415*19c3b8c2SApple OSS Distributions
416*19c3b8c2SApple OSS Distributions case DKIOCGETMAXSEGMENTCOUNTWRITE:
417*19c3b8c2SApple OSS Distributions *o = 32;
418*19c3b8c2SApple OSS Distributions break;
419*19c3b8c2SApple OSS Distributions
420*19c3b8c2SApple OSS Distributions case DKIOCGETBLOCKSIZE:
421*19c3b8c2SApple OSS Distributions *f = mdev[devid].mdSecsize;
422*19c3b8c2SApple OSS Distributions break;
423*19c3b8c2SApple OSS Distributions
424*19c3b8c2SApple OSS Distributions case DKIOCSETBLOCKSIZE:
425*19c3b8c2SApple OSS Distributions if (is_char) {
426*19c3b8c2SApple OSS Distributions return ENODEV; /* We can only do this for a block */
427*19c3b8c2SApple OSS Distributions }
428*19c3b8c2SApple OSS Distributions if (*f < DEV_BSIZE) {
429*19c3b8c2SApple OSS Distributions return EINVAL; /* Too short? */
430*19c3b8c2SApple OSS Distributions }
431*19c3b8c2SApple OSS Distributions mdev[devid].mdSecsize = *f; /* set the new block size */
432*19c3b8c2SApple OSS Distributions break;
433*19c3b8c2SApple OSS Distributions
434*19c3b8c2SApple OSS Distributions case DKIOCISWRITABLE:
435*19c3b8c2SApple OSS Distributions *f = 1;
436*19c3b8c2SApple OSS Distributions break;
437*19c3b8c2SApple OSS Distributions
438*19c3b8c2SApple OSS Distributions case DKIOCGETBLOCKCOUNT:
439*19c3b8c2SApple OSS Distributions if (!(mdev[devid].mdFlags & mdInited)) {
440*19c3b8c2SApple OSS Distributions return ENXIO;
441*19c3b8c2SApple OSS Distributions }
442*19c3b8c2SApple OSS Distributions *o = ((mdev[devid].mdSize << 12) + mdev[devid].mdSecsize - 1) / mdev[devid].mdSecsize;
443*19c3b8c2SApple OSS Distributions break;
444*19c3b8c2SApple OSS Distributions
445*19c3b8c2SApple OSS Distributions /*
446*19c3b8c2SApple OSS Distributions * We're interested in the following bits of information:
447*19c3b8c2SApple OSS Distributions * Are you a memory-backed device (always yes, in this case)?
448*19c3b8c2SApple OSS Distributions * Physical memory (mdPhys)?
449*19c3b8c2SApple OSS Distributions * What is your base page?
450*19c3b8c2SApple OSS Distributions * What is your size?
451*19c3b8c2SApple OSS Distributions */
452*19c3b8c2SApple OSS Distributions case DKIOCGETMEMDEVINFO:
453*19c3b8c2SApple OSS Distributions if (!(mdev[devid].mdFlags & mdInited)) {
454*19c3b8c2SApple OSS Distributions return ENXIO;
455*19c3b8c2SApple OSS Distributions }
456*19c3b8c2SApple OSS Distributions memdev_info->mi_mdev = TRUE;
457*19c3b8c2SApple OSS Distributions memdev_info->mi_phys = (mdev[devid].mdFlags & mdPhys) ? TRUE : FALSE;
458*19c3b8c2SApple OSS Distributions memdev_info->mi_base = (uint32_t)mdev[devid].mdBase;
459*19c3b8c2SApple OSS Distributions memdev_info->mi_size = mdev[devid].mdSize;
460*19c3b8c2SApple OSS Distributions break;
461*19c3b8c2SApple OSS Distributions
462*19c3b8c2SApple OSS Distributions default:
463*19c3b8c2SApple OSS Distributions error = ENOTTY;
464*19c3b8c2SApple OSS Distributions break;
465*19c3b8c2SApple OSS Distributions }
466*19c3b8c2SApple OSS Distributions return error;
467*19c3b8c2SApple OSS Distributions }
468*19c3b8c2SApple OSS Distributions
469*19c3b8c2SApple OSS Distributions
470*19c3b8c2SApple OSS Distributions static int
mdevsize(dev_t dev)471*19c3b8c2SApple OSS Distributions mdevsize(dev_t dev)
472*19c3b8c2SApple OSS Distributions {
473*19c3b8c2SApple OSS Distributions int devid;
474*19c3b8c2SApple OSS Distributions
475*19c3b8c2SApple OSS Distributions devid = minor(dev); /* Get minor device number */
476*19c3b8c2SApple OSS Distributions if (devid >= NB_MAX_MDEVICES) {
477*19c3b8c2SApple OSS Distributions return ENXIO; /* Not valid */
478*19c3b8c2SApple OSS Distributions }
479*19c3b8c2SApple OSS Distributions if ((mdev[devid].mdFlags & mdInited) == 0) {
480*19c3b8c2SApple OSS Distributions return -1; /* Not inited yet */
481*19c3b8c2SApple OSS Distributions }
482*19c3b8c2SApple OSS Distributions return mdev[devid].mdSecsize;
483*19c3b8c2SApple OSS Distributions }
484*19c3b8c2SApple OSS Distributions
485*19c3b8c2SApple OSS Distributions #include <pexpert/pexpert.h>
486*19c3b8c2SApple OSS Distributions
487*19c3b8c2SApple OSS Distributions void
mdevinit(__unused int the_cnt)488*19c3b8c2SApple OSS Distributions mdevinit(__unused int the_cnt)
489*19c3b8c2SApple OSS Distributions {
490*19c3b8c2SApple OSS Distributions #ifdef CONFIG_MEMDEV_INSECURE
491*19c3b8c2SApple OSS Distributions
492*19c3b8c2SApple OSS Distributions int devid, phys;
493*19c3b8c2SApple OSS Distributions uint64_t base;
494*19c3b8c2SApple OSS Distributions uint64_t size;
495*19c3b8c2SApple OSS Distributions char *ba, *lp;
496*19c3b8c2SApple OSS Distributions dev_t dev;
497*19c3b8c2SApple OSS Distributions
498*19c3b8c2SApple OSS Distributions
499*19c3b8c2SApple OSS Distributions ba = PE_boot_args(); /* Get the boot arguments */
500*19c3b8c2SApple OSS Distributions lp = ba + 256; /* Point to the end */
501*19c3b8c2SApple OSS Distributions
502*19c3b8c2SApple OSS Distributions while (1) { /* Step through, looking for our keywords */
503*19c3b8c2SApple OSS Distributions phys = 0; /* Assume virtual memory device */
504*19c3b8c2SApple OSS Distributions ba = nonspace(ba, lp); /* Find non-space */
505*19c3b8c2SApple OSS Distributions if (ba >= lp) {
506*19c3b8c2SApple OSS Distributions return; /* We are done if no more... */
507*19c3b8c2SApple OSS Distributions }
508*19c3b8c2SApple OSS Distributions if (((ba[0] != 'v') && (ba[0] != 'p'))
509*19c3b8c2SApple OSS Distributions || (ba[1] != 'm') || (ba[2] != 'd') || (ba[4] != '=')
510*19c3b8c2SApple OSS Distributions || (ba[3] < '0') || (ba[3] > 'f')
511*19c3b8c2SApple OSS Distributions || ((ba[3] > '9') && (ba[3] < 'a'))) { /* Is this of form "vmdx=" or "pmdx=" where x is hex digit? */
512*19c3b8c2SApple OSS Distributions ba = getspace(ba, lp); /* Find next white space or end */
513*19c3b8c2SApple OSS Distributions continue; /* Start looking for the next one */
514*19c3b8c2SApple OSS Distributions }
515*19c3b8c2SApple OSS Distributions
516*19c3b8c2SApple OSS Distributions if (ba[0] == 'p') {
517*19c3b8c2SApple OSS Distributions phys = 1; /* Set physical memory disk */
518*19c3b8c2SApple OSS Distributions }
519*19c3b8c2SApple OSS Distributions devid = ba[3] & 0xF; /* Assume digit */
520*19c3b8c2SApple OSS Distributions if (ba[3] > '9') {
521*19c3b8c2SApple OSS Distributions devid += 9; /* Adjust for hex digits */
522*19c3b8c2SApple OSS Distributions }
523*19c3b8c2SApple OSS Distributions ba = &ba[5]; /* Step past keyword */
524*19c3b8c2SApple OSS Distributions ba = cvtnum(ba, lp, &base); /* Convert base of memory disk */
525*19c3b8c2SApple OSS Distributions if (ba >= lp) {
526*19c3b8c2SApple OSS Distributions return; /* Malformed one at the end, leave */
527*19c3b8c2SApple OSS Distributions }
528*19c3b8c2SApple OSS Distributions if (ba[0] != '.') {
529*19c3b8c2SApple OSS Distributions continue; /* If not length separater, try next... */
530*19c3b8c2SApple OSS Distributions }
531*19c3b8c2SApple OSS Distributions if (base & 0xFFF) {
532*19c3b8c2SApple OSS Distributions continue; /* Only allow page aligned stuff */
533*19c3b8c2SApple OSS Distributions }
534*19c3b8c2SApple OSS Distributions ba++; /* Step past '.' */
535*19c3b8c2SApple OSS Distributions ba = cvtnum(ba, lp, &size); /* Try to convert it */
536*19c3b8c2SApple OSS Distributions if (!size || (size & 0xFFF)) {
537*19c3b8c2SApple OSS Distributions continue; /* Allow only non-zer page size multiples */
538*19c3b8c2SApple OSS Distributions }
539*19c3b8c2SApple OSS Distributions if (ba < lp) { /* If we are not at end, check end character */
540*19c3b8c2SApple OSS Distributions if ((ba[0] != ' ') && (ba[0] != 0)) {
541*19c3b8c2SApple OSS Distributions continue; /* End must be null or space */
542*19c3b8c2SApple OSS Distributions }
543*19c3b8c2SApple OSS Distributions }
544*19c3b8c2SApple OSS Distributions
545*19c3b8c2SApple OSS Distributions dev = mdevadd(devid, base >> 12, (unsigned)size >> 12, phys); /* Go add the device */
546*19c3b8c2SApple OSS Distributions }
547*19c3b8c2SApple OSS Distributions
548*19c3b8c2SApple OSS Distributions #endif /* CONFIG_MEMDEV_INSECURE */
549*19c3b8c2SApple OSS Distributions
550*19c3b8c2SApple OSS Distributions return;
551*19c3b8c2SApple OSS Distributions }
552*19c3b8c2SApple OSS Distributions
553*19c3b8c2SApple OSS Distributions #ifdef CONFIG_MEMDEV_INSECURE
554*19c3b8c2SApple OSS Distributions
555*19c3b8c2SApple OSS Distributions char *
nonspace(char * pos,char * end)556*19c3b8c2SApple OSS Distributions nonspace(char *pos, char *end) /* Find next non-space in string */
557*19c3b8c2SApple OSS Distributions {
558*19c3b8c2SApple OSS Distributions if (pos >= end) {
559*19c3b8c2SApple OSS Distributions return end; /* Don't go past end */
560*19c3b8c2SApple OSS Distributions }
561*19c3b8c2SApple OSS Distributions if (pos[0] == 0) {
562*19c3b8c2SApple OSS Distributions return end; /* If at null, make end */
563*19c3b8c2SApple OSS Distributions }
564*19c3b8c2SApple OSS Distributions while (1) { /* Keep going */
565*19c3b8c2SApple OSS Distributions if (pos[0] != ' ') {
566*19c3b8c2SApple OSS Distributions return pos; /* Leave if we found one */
567*19c3b8c2SApple OSS Distributions }
568*19c3b8c2SApple OSS Distributions pos++; /* Stop */
569*19c3b8c2SApple OSS Distributions if (pos >= end) {
570*19c3b8c2SApple OSS Distributions return end; /* Quit if we run off end */
571*19c3b8c2SApple OSS Distributions }
572*19c3b8c2SApple OSS Distributions }
573*19c3b8c2SApple OSS Distributions }
574*19c3b8c2SApple OSS Distributions
575*19c3b8c2SApple OSS Distributions char *
getspace(char * pos,char * end)576*19c3b8c2SApple OSS Distributions getspace(char *pos, char *end) /* Find next non-space in string */
577*19c3b8c2SApple OSS Distributions {
578*19c3b8c2SApple OSS Distributions while (1) { /* Keep going */
579*19c3b8c2SApple OSS Distributions if (pos >= end) {
580*19c3b8c2SApple OSS Distributions return end; /* Don't go past end */
581*19c3b8c2SApple OSS Distributions }
582*19c3b8c2SApple OSS Distributions if (pos[0] == 0) {
583*19c3b8c2SApple OSS Distributions return end; /* Leave if we hit null */
584*19c3b8c2SApple OSS Distributions }
585*19c3b8c2SApple OSS Distributions if (pos[0] == ' ') {
586*19c3b8c2SApple OSS Distributions return pos; /* Leave if we found one */
587*19c3b8c2SApple OSS Distributions }
588*19c3b8c2SApple OSS Distributions pos++; /* Stop */
589*19c3b8c2SApple OSS Distributions }
590*19c3b8c2SApple OSS Distributions }
591*19c3b8c2SApple OSS Distributions
592*19c3b8c2SApple OSS Distributions char *
cvtnum(char * pos,char * end,uint64_t * num)593*19c3b8c2SApple OSS Distributions cvtnum(char *pos, char *end, uint64_t *num) /* Convert to a number */
594*19c3b8c2SApple OSS Distributions {
595*19c3b8c2SApple OSS Distributions int rad, dig;
596*19c3b8c2SApple OSS Distributions
597*19c3b8c2SApple OSS Distributions *num = 0; /* Set answer to 0 to start */
598*19c3b8c2SApple OSS Distributions rad = 10;
599*19c3b8c2SApple OSS Distributions
600*19c3b8c2SApple OSS Distributions if (pos >= end) {
601*19c3b8c2SApple OSS Distributions return end; /* Don't go past end */
602*19c3b8c2SApple OSS Distributions }
603*19c3b8c2SApple OSS Distributions if (pos[0] == 0) {
604*19c3b8c2SApple OSS Distributions return end; /* If at null, make end */
605*19c3b8c2SApple OSS Distributions }
606*19c3b8c2SApple OSS Distributions if (pos[0] == '0' && ((pos[1] == 'x') || (pos[1] == 'x'))) { /* A hex constant? */
607*19c3b8c2SApple OSS Distributions rad = 16;
608*19c3b8c2SApple OSS Distributions pos += 2; /* Point to the number */
609*19c3b8c2SApple OSS Distributions }
610*19c3b8c2SApple OSS Distributions
611*19c3b8c2SApple OSS Distributions while (1) { /* Convert it */
612*19c3b8c2SApple OSS Distributions if (pos >= end) {
613*19c3b8c2SApple OSS Distributions return end; /* Don't go past end */
614*19c3b8c2SApple OSS Distributions }
615*19c3b8c2SApple OSS Distributions if (pos[0] == 0) {
616*19c3b8c2SApple OSS Distributions return end; /* If at null, make end */
617*19c3b8c2SApple OSS Distributions }
618*19c3b8c2SApple OSS Distributions if (pos[0] < '0') {
619*19c3b8c2SApple OSS Distributions return pos; /* Leave if non-digit */
620*19c3b8c2SApple OSS Distributions }
621*19c3b8c2SApple OSS Distributions dig = pos[0] & 0xF; /* Extract digit */
622*19c3b8c2SApple OSS Distributions if (pos[0] > '9') { /* Is it bigger than 9? */
623*19c3b8c2SApple OSS Distributions if (rad == 10) {
624*19c3b8c2SApple OSS Distributions return pos; /* Leave if not base 10 */
625*19c3b8c2SApple OSS Distributions }
626*19c3b8c2SApple OSS Distributions if (!(((pos[0] >= 'A') && (pos[0] <= 'F'))
627*19c3b8c2SApple OSS Distributions || ((pos[0] >= 'a') && (pos[0] <= 'f')))) {
628*19c3b8c2SApple OSS Distributions return pos; /* Leave if bogus char */
629*19c3b8c2SApple OSS Distributions }
630*19c3b8c2SApple OSS Distributions dig = dig + 9; /* Adjust for character */
631*19c3b8c2SApple OSS Distributions }
632*19c3b8c2SApple OSS Distributions *num = (*num * rad) + dig; /* Accumulate the number */
633*19c3b8c2SApple OSS Distributions pos++; /* Step on */
634*19c3b8c2SApple OSS Distributions }
635*19c3b8c2SApple OSS Distributions }
636*19c3b8c2SApple OSS Distributions
637*19c3b8c2SApple OSS Distributions #endif /* CONFIG_MEMDEV_INSECURE */
638*19c3b8c2SApple OSS Distributions
639*19c3b8c2SApple OSS Distributions dev_t
mdevadd(int devid,uint64_t base,unsigned int size,int phys)640*19c3b8c2SApple OSS Distributions mdevadd(int devid, uint64_t base, unsigned int size, int phys)
641*19c3b8c2SApple OSS Distributions {
642*19c3b8c2SApple OSS Distributions int i;
643*19c3b8c2SApple OSS Distributions
644*19c3b8c2SApple OSS Distributions if (devid < 0) {
645*19c3b8c2SApple OSS Distributions devid = -1;
646*19c3b8c2SApple OSS Distributions for (i = 0; i < NB_MAX_MDEVICES; i++) { /* Search all known memory devices */
647*19c3b8c2SApple OSS Distributions if (!(mdev[i].mdFlags & mdInited)) { /* Is this a free one? */
648*19c3b8c2SApple OSS Distributions if (devid < 0) {
649*19c3b8c2SApple OSS Distributions devid = i; /* Remember first free one */
650*19c3b8c2SApple OSS Distributions }
651*19c3b8c2SApple OSS Distributions continue; /* Skip check */
652*19c3b8c2SApple OSS Distributions }
653*19c3b8c2SApple OSS Distributions if (!(((base + size - 1) < mdev[i].mdBase) || ((mdev[i].mdBase + mdev[i].mdSize - 1) < base))) { /* Is there any overlap? */
654*19c3b8c2SApple OSS Distributions panic("mdevadd: attempt to add overlapping memory device at %016llX-%016llX", mdev[i].mdBase, mdev[i].mdBase + mdev[i].mdSize - 1);
655*19c3b8c2SApple OSS Distributions }
656*19c3b8c2SApple OSS Distributions }
657*19c3b8c2SApple OSS Distributions if (devid < 0) { /* Do we have free slots? */
658*19c3b8c2SApple OSS Distributions panic("mdevadd: attempt to add more than %d memory devices", NB_MAX_MDEVICES);
659*19c3b8c2SApple OSS Distributions }
660*19c3b8c2SApple OSS Distributions } else {
661*19c3b8c2SApple OSS Distributions if (devid >= NB_MAX_MDEVICES) { /* Giving us something bogus? */
662*19c3b8c2SApple OSS Distributions panic("mdevadd: attempt to explicitly add a bogus memory device: %08X", devid);
663*19c3b8c2SApple OSS Distributions }
664*19c3b8c2SApple OSS Distributions if (mdev[devid].mdFlags & mdInited) { /* Already there? */
665*19c3b8c2SApple OSS Distributions panic("mdevadd: attempt to explicitly add a previously defined memory device: %08X", devid);
666*19c3b8c2SApple OSS Distributions }
667*19c3b8c2SApple OSS Distributions }
668*19c3b8c2SApple OSS Distributions
669*19c3b8c2SApple OSS Distributions if (mdevBMajor < 0) { /* Have we gotten a major number yet? */
670*19c3b8c2SApple OSS Distributions mdevBMajor = bdevsw_add(-1, &mdevbdevsw); /* Add to the table and figure out a major number */
671*19c3b8c2SApple OSS Distributions if (mdevBMajor < 0) {
672*19c3b8c2SApple OSS Distributions printf("mdevadd: error - bdevsw_add() returned %d\n", mdevBMajor);
673*19c3b8c2SApple OSS Distributions return -1;
674*19c3b8c2SApple OSS Distributions }
675*19c3b8c2SApple OSS Distributions }
676*19c3b8c2SApple OSS Distributions
677*19c3b8c2SApple OSS Distributions if (mdevCMajor < 0) { /* Have we gotten a major number yet? */
678*19c3b8c2SApple OSS Distributions mdevCMajor = cdevsw_add_with_bdev(-1, &mdevcdevsw, mdevBMajor); /* Add to the table and figure out a major number */
679*19c3b8c2SApple OSS Distributions if (mdevCMajor < 0) {
680*19c3b8c2SApple OSS Distributions printf("ramdevice_init: error - cdevsw_add() returned %d\n", mdevCMajor);
681*19c3b8c2SApple OSS Distributions return -1;
682*19c3b8c2SApple OSS Distributions }
683*19c3b8c2SApple OSS Distributions }
684*19c3b8c2SApple OSS Distributions
685*19c3b8c2SApple OSS Distributions mdev[devid].mdBDev = makedev(mdevBMajor, devid); /* Get the device number */
686*19c3b8c2SApple OSS Distributions mdev[devid].mdbdevb = devfs_make_node(mdev[devid].mdBDev, DEVFS_BLOCK, /* Make the node */
687*19c3b8c2SApple OSS Distributions UID_ROOT, GID_OPERATOR,
688*19c3b8c2SApple OSS Distributions 0600, "md%d", devid);
689*19c3b8c2SApple OSS Distributions if (mdev[devid].mdbdevb == NULL) { /* Did we make one? */
690*19c3b8c2SApple OSS Distributions printf("mdevadd: devfs_make_node for block failed!\n");
691*19c3b8c2SApple OSS Distributions return -1; /* Nope... */
692*19c3b8c2SApple OSS Distributions }
693*19c3b8c2SApple OSS Distributions
694*19c3b8c2SApple OSS Distributions mdev[devid].mdCDev = makedev(mdevCMajor, devid); /* Get the device number */
695*19c3b8c2SApple OSS Distributions mdev[devid].mdcdevb = devfs_make_node(mdev[devid].mdCDev, DEVFS_CHAR, /* Make the node */
696*19c3b8c2SApple OSS Distributions UID_ROOT, GID_OPERATOR,
697*19c3b8c2SApple OSS Distributions 0600, "rmd%d", devid);
698*19c3b8c2SApple OSS Distributions if (mdev[devid].mdcdevb == NULL) { /* Did we make one? */
699*19c3b8c2SApple OSS Distributions printf("mdevadd: devfs_make_node for character failed!\n");
700*19c3b8c2SApple OSS Distributions return -1; /* Nope... */
701*19c3b8c2SApple OSS Distributions }
702*19c3b8c2SApple OSS Distributions
703*19c3b8c2SApple OSS Distributions mdev[devid].mdBase = base; /* Set the base address of ram disk */
704*19c3b8c2SApple OSS Distributions mdev[devid].mdSize = size; /* Set the length of the ram disk */
705*19c3b8c2SApple OSS Distributions mdev[devid].mdSecsize = DEV_BSIZE; /* Set starting block size */
706*19c3b8c2SApple OSS Distributions if (phys) {
707*19c3b8c2SApple OSS Distributions mdev[devid].mdFlags |= mdPhys; /* Show that we are in physical memory */
708*19c3b8c2SApple OSS Distributions }
709*19c3b8c2SApple OSS Distributions mdev[devid].mdFlags |= mdInited; /* Show we are all set up */
710*19c3b8c2SApple OSS Distributions printf("Added memory device md%x/rmd%x (%08X/%08X) at %016llX for %016llX\n",
711*19c3b8c2SApple OSS Distributions devid, devid, mdev[devid].mdBDev, mdev[devid].mdCDev, base << 12, (uint64_t)size << 12);
712*19c3b8c2SApple OSS Distributions return mdev[devid].mdBDev;
713*19c3b8c2SApple OSS Distributions }
714*19c3b8c2SApple OSS Distributions
715*19c3b8c2SApple OSS Distributions
716*19c3b8c2SApple OSS Distributions dev_t
mdevlookup(int devid)717*19c3b8c2SApple OSS Distributions mdevlookup(int devid)
718*19c3b8c2SApple OSS Distributions {
719*19c3b8c2SApple OSS Distributions if ((devid < 0) || (devid >= NB_MAX_MDEVICES)) {
720*19c3b8c2SApple OSS Distributions return -1; /* Filter any bogus requests */
721*19c3b8c2SApple OSS Distributions }
722*19c3b8c2SApple OSS Distributions if (!(mdev[devid].mdFlags & mdInited)) {
723*19c3b8c2SApple OSS Distributions return -1; /* This one hasn't been defined */
724*19c3b8c2SApple OSS Distributions }
725*19c3b8c2SApple OSS Distributions return mdev[devid].mdBDev; /* Return the device number */
726*19c3b8c2SApple OSS Distributions }
727*19c3b8c2SApple OSS Distributions
728*19c3b8c2SApple OSS Distributions void
mdevremoveall(void)729*19c3b8c2SApple OSS Distributions mdevremoveall(void)
730*19c3b8c2SApple OSS Distributions {
731*19c3b8c2SApple OSS Distributions int i;
732*19c3b8c2SApple OSS Distributions
733*19c3b8c2SApple OSS Distributions for (i = 0; i < NB_MAX_MDEVICES; i++) {
734*19c3b8c2SApple OSS Distributions if (!(mdev[i].mdFlags & mdInited)) {
735*19c3b8c2SApple OSS Distributions continue; /* Ignore unused mdevs */
736*19c3b8c2SApple OSS Distributions }
737*19c3b8c2SApple OSS Distributions devfs_remove(mdev[i].mdbdevb); /* Remove the block device */
738*19c3b8c2SApple OSS Distributions devfs_remove(mdev[i].mdcdevb); /* Remove the character device */
739*19c3b8c2SApple OSS Distributions
740*19c3b8c2SApple OSS Distributions mdev[i].mdBase = 0; /* Clear the mdev's storage */
741*19c3b8c2SApple OSS Distributions mdev[i].mdSize = 0;
742*19c3b8c2SApple OSS Distributions mdev[i].mdSecsize = 0;
743*19c3b8c2SApple OSS Distributions mdev[i].mdFlags = 0;
744*19c3b8c2SApple OSS Distributions mdev[i].mdBDev = 0;
745*19c3b8c2SApple OSS Distributions mdev[i].mdCDev = 0;
746*19c3b8c2SApple OSS Distributions mdev[i].mdbdevb = 0;
747*19c3b8c2SApple OSS Distributions mdev[i].mdcdevb = 0;
748*19c3b8c2SApple OSS Distributions }
749*19c3b8c2SApple OSS Distributions }
750*19c3b8c2SApple OSS Distributions
751*19c3b8c2SApple OSS Distributions int
mdevgetrange(int devid,uint64_t * base,uint64_t * size)752*19c3b8c2SApple OSS Distributions mdevgetrange(int devid, uint64_t *base, uint64_t *size)
753*19c3b8c2SApple OSS Distributions {
754*19c3b8c2SApple OSS Distributions assert(base);
755*19c3b8c2SApple OSS Distributions assert(size);
756*19c3b8c2SApple OSS Distributions
757*19c3b8c2SApple OSS Distributions /* filter invalid request */
758*19c3b8c2SApple OSS Distributions if ((devid < 0) || (devid >= NB_MAX_MDEVICES)) {
759*19c3b8c2SApple OSS Distributions return -1;
760*19c3b8c2SApple OSS Distributions }
761*19c3b8c2SApple OSS Distributions
762*19c3b8c2SApple OSS Distributions /* filter non-initialized memory devices */
763*19c3b8c2SApple OSS Distributions if ((mdev[devid].mdFlags & mdInited) == 0) {
764*19c3b8c2SApple OSS Distributions return -1;
765*19c3b8c2SApple OSS Distributions }
766*19c3b8c2SApple OSS Distributions
767*19c3b8c2SApple OSS Distributions *base = mdev[devid].mdBase << 12;
768*19c3b8c2SApple OSS Distributions *size = mdev[devid].mdSize << 12;
769*19c3b8c2SApple OSS Distributions
770*19c3b8c2SApple OSS Distributions /* make sure (base, size) is a valid range and will not overflow */
771*19c3b8c2SApple OSS Distributions assert(*size < (UINT64_MAX - *base));
772*19c3b8c2SApple OSS Distributions
773*19c3b8c2SApple OSS Distributions return 0;
774*19c3b8c2SApple OSS Distributions }
775