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