bsd/dev/memdev.c

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