stand/common/misc.c

   1 /*-
   2  * Copyright (c) 1998 Michael Smith <msmith@freebsd.org>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <string.h>
  31 #include <stand.h>
  32 #include <bootstrap.h>
  33
  34 /*
  35  * Concatenate the (argc) elements of (argv) into a single string, and return
  36  * a copy of same.
  37  */
  38 char *
  39 unargv(int argc, char *argv[])
  40 {
  41     size_t      hlong;
  42     int         i;
  43     char        *cp;
  44
  45     for (i = 0, hlong = 0; i < argc; i++)
  46         hlong += strlen(argv[i]) + 2;
  47
  48     if(hlong == 0)
  49         return(NULL);
  50
  51     cp = malloc(hlong);
  52     cp[0] = 0;
  53     for (i = 0; i < argc; i++) {
  54         strcat(cp, argv[i]);
  55         if (i < (argc - 1))
  56           strcat(cp, " ");
  57     }
  58
  59     return(cp);
  60 }
  61
  62 /*
  63  * Get the length of a string in kernel space
  64  */
  65 size_t
  66 strlenout(vm_offset_t src)
  67 {
  68     char        c;
  69     size_t      len;
  70
  71     for (len = 0; ; len++) {
  72         archsw.arch_copyout(src++, &c, 1);
  73         if (c == 0)
  74             break;
  75     }
  76     return(len);
  77 }
  78
  79 /*
  80  * Make a duplicate copy of a string in kernel space
  81  */
  82 char *
  83 strdupout(vm_offset_t str)
  84 {
  85     char        *result, *cp;
  86
  87     result = malloc(strlenout(str) + 1);
  88     for (cp = result; ;cp++) {
  89         archsw.arch_copyout(str++, cp, 1);
  90         if (*cp == 0)
  91             break;
  92     }
  93     return(result);
  94 }
  95
  96 /* Zero a region in kernel space. */
  97 void
  98 kern_bzero(vm_offset_t dest, size_t len)
  99 {
 100         char buf[256];
 101         size_t chunk, resid;
 102
 103         bzero(buf, sizeof(buf));
 104         resid = len;
 105         while (resid > 0) {
 106                 chunk = min(sizeof(buf), resid);
 107                 archsw.arch_copyin(buf, dest, chunk);
 108                 resid -= chunk;
 109                 dest += chunk;
 110         }
 111 }
 112
 113 /*
 114  * Read the specified part of a file to kernel space.  Unlike regular
 115  * pread, the file pointer is advanced to the end of the read data,
 116  * and it just returns 0 if successful.
 117  */
 118 int
 119 kern_pread(readin_handle_t fd, vm_offset_t dest, size_t len, off_t off)
 120 {
 121
 122         if (VECTX_LSEEK(fd, off, SEEK_SET) == -1) {
 123 #ifdef DEBUG
 124                 printf("\nlseek failed\n");
 125 #endif
 126                 return (-1);
 127         }
 128         if ((size_t)archsw.arch_readin(fd, dest, len) != len) {
 129 #ifdef DEBUG
 130                 printf("\nreadin failed\n");
 131 #endif
 132                 return (-1);
 133         }
 134         return (0);
 135 }
 136
 137 /*
 138  * Read the specified part of a file to a malloced buffer.  The file
 139  * pointer is advanced to the end of the read data.
 140  */
 141 /* coverity[ -tainted_data_return ] */
 142 void *
 143 alloc_pread(readin_handle_t fd, off_t off, size_t len)
 144 {
 145         void *buf;
 146
 147         buf = malloc(len);
 148         if (buf == NULL) {
 149 #ifdef DEBUG
 150                 printf("\nmalloc(%d) failed\n", (int)len);
 151 #endif
 152                 errno = ENOMEM;
 153                 return (NULL);
 154         }
 155         if (VECTX_LSEEK(fd, off, SEEK_SET) == -1) {
 156 #ifdef DEBUG
 157                 printf("\nlseek failed\n");
 158 #endif
 159                 free(buf);
 160                 return (NULL);
 161         }
 162         if ((size_t)VECTX_READ(fd, buf, len) != len) {
 163 #ifdef DEBUG
 164                 printf("\nread failed\n");
 165 #endif
 166                 free(buf);
 167                 return (NULL);
 168         }
 169         return (buf);
 170 }
 171
 172 void
 173 dev_cleanup(void)
 174 {
 175     int         i;
 176
 177     /* Call cleanup routines */
 178     for (i = 0; devsw[i] != NULL; ++i)
 179         if (devsw[i]->dv_cleanup != NULL)
 180             (devsw[i]->dv_cleanup)();
 181 }