sys/boot/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(int fd, vm_offset_t dest, size_t len, off_t off)
 120 {
 121         ssize_t nread;
 122
 123         if (lseek(fd, off, SEEK_SET) == -1) {
 124 #ifdef DEBUG
 125                 printf("\nlseek failed\n");
 126 #endif
 127                 return (-1);
 128         }
 129         nread = archsw.arch_readin(fd, dest, len);
 130         if (nread != len) {
 131 #ifdef DEBUG
 132                 printf("\nreadin failed\n");
 133 #endif
 134                 return (-1);
 135         }
 136         return (0);
 137 }
 138
 139 /*
 140  * Read the specified part of a file to a malloced buffer.  The file
 141  * pointer is advanced to the end of the read data.
 142  */
 143 void *
 144 alloc_pread(int fd, off_t off, size_t len)
 145 {
 146         void *buf;
 147         ssize_t nread;
 148
 149         buf = malloc(len);
 150         if (buf == NULL) {
 151 #ifdef DEBUG
 152                 printf("\nmalloc(%d) failed\n", (int)len);
 153 #endif
 154                 return (NULL);
 155         }
 156         if (lseek(fd, off, SEEK_SET) == -1) {
 157 #ifdef DEBUG
 158                 printf("\nlseek failed\n");
 159 #endif
 160                 free(buf);
 161                 return (NULL);
 162         }
 163         nread = read(fd, buf, len);
 164         if (nread != len) {
 165 #ifdef DEBUG
 166                 printf("\nread failed\n");
 167 #endif
 168                 free(buf);
 169                 return (NULL);
 170         }
 171         return (buf);
 172 }
 173
 174 /*
 175  * Display a region in traditional hexdump format.
 176  */
 177 void
 178 hexdump(caddr_t region, size_t len)
 179 {
 180     caddr_t     line;
 181     int         x, c;
 182     char        lbuf[80];
 183 #define emit(fmt, args...)      {sprintf(lbuf, fmt , ## args); pager_output(lbuf);}
 184
 185     pager_open();
 186     for (line = region; line < (region + len); line += 16) {
 187         emit("%08lx  ", (long) line);
 188
 189         for (x = 0; x < 16; x++) {
 190             if ((line + x) < (region + len)) {
 191                 emit("%02x ", *(u_int8_t *)(line + x));
 192             } else {
 193                 emit("-- ");
 194             }
 195             if (x == 7)
 196                 emit(" ");
 197         }
 198         emit(" |");
 199         for (x = 0; x < 16; x++) {
 200             if ((line + x) < (region + len)) {
 201                 c = *(u_int8_t *)(line + x);
 202                 if ((c < ' ') || (c > '~'))     /* !isprint(c) */
 203                     c = '.';
 204                 emit("%c", c);
 205             } else {
 206                 emit(" ");
 207             }
 208         }
 209         emit("|\n");
 210     }
 211     pager_close();
 212 }
 213
 214 void
 215 dev_cleanup(void)
 216 {
 217     int         i;
 218
 219     /* Call cleanup routines */
 220     for (i = 0; devsw[i] != NULL; ++i)
 221         if (devsw[i]->dv_cleanup != NULL)
 222             (devsw[i]->dv_cleanup)();
 223 }