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