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