xref: /netbsd-src/sys/arch/ia64/stand/common/misc.c (revision b1c86f5f087524e68db12794ee9c3e3da1ab17a0)
1 /*	$NetBSD: misc.c,v 1.5 2009/07/20 04:59:03 kiyohara Exp $	*/
2 
3 /*-
4  * Copyright (c) 1998 Michael Smith <msmith@freebsd.org>
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  */
28 
29 #include <sys/cdefs.h>
30 /* __FBSDID("$FreeBSD: src/sys/boot/common/misc.c,v 1.8.4.1 2004/09/03 19:25:40 iedowse Exp $"); */
31 
32 #include <lib/libsa/stand.h>
33 #include <lib/libsa/loadfile.h>
34 #include <bootstrap.h>
35 
36 /*
37  * Concatenate the (argc) elements of (argv) into a single string, and return
38  * a copy of same.
39  */
40 char *
41 unargv(int argc, char *argv[])
42 {
43     size_t	hlong;
44     int		i;
45     char	*cp;
46 
47     for (hlong = 0, i = 0, hlong = 0; i < argc; i++)
48 	hlong += strlen(argv[i]) + 2;
49 
50     if(hlong == 0)
51 	return(NULL);
52 
53     cp = alloc(hlong);
54     cp[0] = 0;
55     for (i = 0; i < argc; i++) {
56 	strcat(cp, argv[i]);
57 	if (i < (argc - 1))
58 	  strcat(cp, " ");
59     }
60 
61     return(cp);
62 }
63 
64 /*
65  * Get the length of a string in kernel space
66  */
67 size_t
68 strlenout(vaddr_t src)
69 {
70     char	c;
71     size_t	len;
72 
73     for (len = 0; ; len++) {
74 	archsw.arch_copyout(src++, &c, 1);
75 	if (c == 0)
76 	    break;
77     }
78     return(len);
79 }
80 
81 /*
82  * Make a duplicate copy of a string in kernel space
83  */
84 char *
85 strdupout(vaddr_t str)
86 {
87     char	*result, *cp;
88 
89     result = alloc(strlenout(str) + 1);
90     for (cp = result; ;cp++) {
91 	archsw.arch_copyout(str++, cp, 1);
92 	if (*cp == 0)
93 	    break;
94     }
95     return(result);
96 }
97 
98 /* Zero a region in kernel space. */
99 void
100 kern_bzero(vaddr_t dest, size_t len)
101 {
102 	char buf[256];
103 	size_t chunk, resid;
104 
105 	memset(buf, 0, sizeof(buf));
106 	resid = len;
107 	while (resid > 0) {
108 		chunk = min(sizeof(buf), resid);
109 		archsw.arch_copyin(buf, dest, chunk);
110 		resid -= chunk;
111 		dest += chunk;
112 	}
113 }
114 
115 /*
116  * Read the specified part of a file to kernel space.  Unlike regular
117  * pread, the file pointer is advanced to the end of the read data,
118  * and it just returns 0 if successful.
119  */
120 int
121 kern_pread(int fd, vaddr_t dest, size_t len, off_t off)
122 {
123 	ssize_t nread;
124 
125 	if (lseek(fd, off, SEEK_SET) == -1) {
126 		printf("\nlseek failed\n");
127 		return (-1);
128 	}
129 	nread = archsw.arch_readin(fd, dest, len);
130 	if (nread != len) {
131 		printf("\nreadin failed\n");
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 void *
142 alloc_pread(int fd, off_t off, size_t len)
143 {
144 	void *buf;
145 	ssize_t nread;
146 
147 	buf = alloc(len);
148 	if (buf == NULL) {
149 		printf("\nalloc(%d) failed\n", (int)len);
150 		return (NULL);
151 	}
152 	if (lseek(fd, off, SEEK_SET) == -1) {
153 		printf("\nlseek failed\n");
154 		free(buf);
155 		return (NULL);
156 	}
157 	nread = read(fd, buf, len);
158 	if (nread != len) {
159 		printf("\nread failed\n");
160 		free(buf);
161 		return (NULL);
162 	}
163 	return (buf);
164 }
165 
166 /*
167  * Display a region in traditional hexdump format.
168  */
169 void
170 hexdump(void *region, size_t len)
171 {
172     void *	line;
173     int		x, c;
174     char	lbuf[80];
175 #define emit(fmt, args...)	{sprintf(lbuf, fmt , ## args); pager_output(lbuf);}
176 
177     pager_open();
178     for (line = region; line < (region + len); line += 16) {
179 	emit("%08lx  ", (long) line);
180 
181 	for (x = 0; x < 16; x++) {
182 	    if ((line + x) < (region + len)) {
183 		emit("%02x ", *(u_int8_t *)(line + x));
184 	    } else {
185 		emit("-- ");
186 	    }
187 	    if (x == 7)
188 		emit(" ");
189 	}
190 	emit(" |");
191 	for (x = 0; x < 16; x++) {
192 	    if ((line + x) < (region + len)) {
193 		c = *(u_int8_t *)(line + x);
194 		if ((c < ' ') || (c > '~'))	/* !isprint(c) */
195 		    c = '.';
196 		emit("%c", c);
197 	    } else {
198 		emit(" ");
199 	    }
200 	}
201 	emit("|\n");
202     }
203     pager_close();
204 }
205 
206 void
207 dev_cleanup(void)
208 {
209 
210 }
211