1 |
|
|
/* $OpenBSD: vmboot.c,v 1.4 2017/08/29 21:10:20 deraadt Exp $ */ |
2 |
|
|
|
3 |
|
|
/* |
4 |
|
|
* Copyright (c) 2016 Reyk Floeter <reyk@openbsd.org> |
5 |
|
|
* |
6 |
|
|
* Permission to use, copy, modify, and distribute this software for any |
7 |
|
|
* purpose with or without fee is hereby granted, provided that the above |
8 |
|
|
* copyright notice and this permission notice appear in all copies. |
9 |
|
|
* |
10 |
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
11 |
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
12 |
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
13 |
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
14 |
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
15 |
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
16 |
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
17 |
|
|
*/ |
18 |
|
|
|
19 |
|
|
#include <sys/param.h> /* DEV_BSIZE roundup */ |
20 |
|
|
#include <sys/reboot.h> |
21 |
|
|
#include <sys/time.h> |
22 |
|
|
#include <sys/stat.h> |
23 |
|
|
#include <sys/disklabel.h> |
24 |
|
|
|
25 |
|
|
#include <ufs/ffs/fs.h> |
26 |
|
|
#include <ufs/ufs/dinode.h> |
27 |
|
|
#include <ufs/ufs/dir.h> |
28 |
|
|
|
29 |
|
|
#include <stdio.h> |
30 |
|
|
#include <unistd.h> |
31 |
|
|
#include <ctype.h> |
32 |
|
|
#include <fcntl.h> |
33 |
|
|
#include <err.h> |
34 |
|
|
#include <vis.h> |
35 |
|
|
|
36 |
|
|
#include "vmd.h" |
37 |
|
|
#include "vmboot.h" |
38 |
|
|
|
39 |
|
|
int vmboot_bootconf(char *, size_t, struct vmboot_params *); |
40 |
|
|
int vmboot_bootcmd(char *, struct vmboot_params *); |
41 |
|
|
int vmboot_bootargs(int argc, char **argv, struct vmboot_params *); |
42 |
|
|
uint32_t vmboot_bootdevice(const char *); |
43 |
|
|
|
44 |
|
|
int vmboot_strategy(void *, int, daddr32_t, size_t, void *, size_t *); |
45 |
|
|
off_t vmboot_findopenbsd(struct open_file *, off_t, struct disklabel *); |
46 |
|
|
void *vmboot_loadfile(struct open_file *, char *, size_t *); |
47 |
|
|
|
48 |
|
|
int |
49 |
|
|
vmboot_bootcmd(char *line, struct vmboot_params *bp) |
50 |
|
|
{ |
51 |
|
|
char *p, *args[16]; |
52 |
|
|
int ac = 0; |
53 |
|
|
char *last; |
54 |
|
|
|
55 |
|
|
for (args[0] = NULL, (p = strtok_r(line, " ", &last)); p; |
56 |
|
|
(p = strtok_r(NULL, " ", &last))) { |
57 |
|
|
if (ac < (int)(sizeof(args) / sizeof(args[0])) - 1) |
58 |
|
|
args[ac++] = p; |
59 |
|
|
} |
60 |
|
|
if (ac == 0) |
61 |
|
|
return (0); |
62 |
|
|
args[ac] = NULL; |
63 |
|
|
|
64 |
|
|
/* |
65 |
|
|
* Subset of boot.conf(8) options |
66 |
|
|
*/ |
67 |
|
|
if (strcmp("boot", args[0]) == 0) |
68 |
|
|
return (vmboot_bootargs(ac, args, bp)); |
69 |
|
|
else if (strcmp("set", args[0]) == 0) { |
70 |
|
|
if (ac < 3) |
71 |
|
|
return (-1); |
72 |
|
|
if (strcmp("device", args[1]) == 0) { |
73 |
|
|
if ((size_t)strnvis(bp->vbp_device, args[2], |
74 |
|
|
sizeof(bp->vbp_device), VIS_SAFE) >= |
75 |
|
|
sizeof(bp->vbp_device)) { |
76 |
|
|
log_warnx("invalid device name"); |
77 |
|
|
return (-1); |
78 |
|
|
} |
79 |
|
|
} else if (strcmp("image", args[1]) == 0) { |
80 |
|
|
if ((size_t)strnvis(bp->vbp_image, args[2], |
81 |
|
|
sizeof(bp->vbp_image), VIS_SAFE) >= |
82 |
|
|
sizeof(bp->vbp_image)) { |
83 |
|
|
log_warnx("invalid image name"); |
84 |
|
|
return (-1); |
85 |
|
|
} |
86 |
|
|
} |
87 |
|
|
} |
88 |
|
|
|
89 |
|
|
return (0); |
90 |
|
|
} |
91 |
|
|
|
92 |
|
|
int |
93 |
|
|
vmboot_bootargs(int ac, char **av, struct vmboot_params *bp) |
94 |
|
|
{ |
95 |
|
|
char *p; |
96 |
|
|
int ch; |
97 |
|
|
|
98 |
|
|
if (ac < 2) |
99 |
|
|
return (0); |
100 |
|
|
|
101 |
|
|
/* |
102 |
|
|
* Syntax is based on boot(8): boot "[hd0a[:/file]] [-asdc]" |
103 |
|
|
*/ |
104 |
|
|
if (*av[1] != '-') { |
105 |
|
|
if ((p = strchr(av[1], ':')) != NULL) { |
106 |
|
|
*p++ = '\0'; |
107 |
|
|
if (!strlen(p)) { |
108 |
|
|
log_warnx("invalid file syntax"); |
109 |
|
|
return (-1); |
110 |
|
|
} |
111 |
|
|
if ((size_t)strnvis(bp->vbp_device, av[1], |
112 |
|
|
sizeof(bp->vbp_device), VIS_SAFE) >= |
113 |
|
|
sizeof(bp->vbp_device)) { |
114 |
|
|
log_warnx("invalid device name"); |
115 |
|
|
return (-1); |
116 |
|
|
} |
117 |
|
|
} else { |
118 |
|
|
p = av[1]; |
119 |
|
|
} |
120 |
|
|
if ((size_t)strnvis(bp->vbp_image, p, |
121 |
|
|
sizeof(bp->vbp_image), VIS_SAFE) >= sizeof(bp->vbp_image)) { |
122 |
|
|
log_warnx("invalid image name"); |
123 |
|
|
return (-1); |
124 |
|
|
} |
125 |
|
|
ac--; |
126 |
|
|
av++; |
127 |
|
|
} |
128 |
|
|
|
129 |
|
|
optreset = optind = opterr = 1; |
130 |
|
|
while ((ch = getopt(ac, av, "acds")) != -1) { |
131 |
|
|
switch (ch) { |
132 |
|
|
case 'a': |
133 |
|
|
bp->vbp_howto |= RB_ASKNAME; |
134 |
|
|
break; |
135 |
|
|
case 'c': |
136 |
|
|
bp->vbp_howto |= RB_CONFIG; |
137 |
|
|
break; |
138 |
|
|
case 'd': |
139 |
|
|
bp->vbp_howto |= RB_KDB; |
140 |
|
|
break; |
141 |
|
|
case 's': |
142 |
|
|
bp->vbp_howto |= RB_SINGLE; |
143 |
|
|
break; |
144 |
|
|
default: |
145 |
|
|
log_warnx("invalid boot option: %c", ch); |
146 |
|
|
return (-1); |
147 |
|
|
} |
148 |
|
|
} |
149 |
|
|
|
150 |
|
|
return (0); |
151 |
|
|
} |
152 |
|
|
|
153 |
|
|
uint32_t |
154 |
|
|
vmboot_bootdevice(const char *word) |
155 |
|
|
{ |
156 |
|
|
uint32_t bootdev = 0; |
157 |
|
|
int disk, part; |
158 |
|
|
|
159 |
|
|
if (strlen(word) != strlen("hd0a")) { |
160 |
|
|
log_warnx("invalid boot device: %s", word); |
161 |
|
|
goto done; |
162 |
|
|
} |
163 |
|
|
|
164 |
|
|
if (strncmp("hd", word, 2) != 0) { |
165 |
|
|
log_warnx("unsupported boot device type: %s", word); |
166 |
|
|
goto done; |
167 |
|
|
} |
168 |
|
|
|
169 |
|
|
disk = (int)word[2]; |
170 |
|
|
part = (int)word[3]; |
171 |
|
|
|
172 |
|
|
if (!(isdigit(disk) && isalpha(part) && islower(part))) { |
173 |
|
|
log_warnx("invalid boot partition: %s", word); |
174 |
|
|
goto done; |
175 |
|
|
} |
176 |
|
|
|
177 |
|
|
disk -= '0'; |
178 |
|
|
part -= 'a'; |
179 |
|
|
|
180 |
|
|
if (disk != 0 || part > MAXPARTITIONS) { |
181 |
|
|
log_warnx("cannot boot from device: %s", word); |
182 |
|
|
goto done; |
183 |
|
|
} |
184 |
|
|
|
185 |
|
|
bootdev = MAKEBOOTDEV(0x4, 0, 0, disk, part); |
186 |
|
|
|
187 |
|
|
done: |
188 |
|
|
/* returns 0 on error */ |
189 |
|
|
return (bootdev); |
190 |
|
|
} |
191 |
|
|
|
192 |
|
|
int |
193 |
|
|
vmboot_bootconf(char *conf, size_t size, struct vmboot_params *bp) |
194 |
|
|
{ |
195 |
|
|
char buf[BUFSIZ]; |
196 |
|
|
FILE *fp; |
197 |
|
|
|
198 |
|
|
if ((fp = fmemopen(conf, size, "r")) == NULL) { |
199 |
|
|
log_debug("%s: failed to boot.conf memory stream", __func__); |
200 |
|
|
return (-1); |
201 |
|
|
} |
202 |
|
|
|
203 |
|
|
while (fgets(buf, sizeof(buf), fp) != NULL) { |
204 |
|
|
buf[strcspn(buf, "\n")] = '\0'; |
205 |
|
|
vmboot_bootcmd(buf, bp); |
206 |
|
|
} |
207 |
|
|
fclose(fp); |
208 |
|
|
|
209 |
|
|
if (strlen(bp->vbp_device)) |
210 |
|
|
log_debug("%s: set device %s", __func__, bp->vbp_device); |
211 |
|
|
if (strlen(bp->vbp_image)) |
212 |
|
|
log_debug("%s: set image %s", __func__, bp->vbp_image); |
213 |
|
|
if (bp->vbp_howto) { |
214 |
|
|
snprintf(buf, sizeof(buf), "boot -%s%s%s%s", |
215 |
|
|
(bp->vbp_howto & RB_ASKNAME) ? "a" : "", |
216 |
|
|
(bp->vbp_howto & RB_CONFIG) ? "c" : "", |
217 |
|
|
(bp->vbp_howto & RB_KDB) ? "d" : "", |
218 |
|
|
(bp->vbp_howto & RB_SINGLE) ? "s" : ""); |
219 |
|
|
log_debug("%s: %s", __func__, buf); |
220 |
|
|
} |
221 |
|
|
|
222 |
|
|
return (0); |
223 |
|
|
} |
224 |
|
|
|
225 |
|
|
|
226 |
|
|
/* |
227 |
|
|
* For ufs.c |
228 |
|
|
*/ |
229 |
|
|
|
230 |
|
|
struct devsw vmboot_devsw = { |
231 |
|
|
.dv_name = "vmboot", |
232 |
|
|
.dv_strategy = vmboot_strategy, |
233 |
|
|
/* other fields are not needed */ |
234 |
|
|
}; |
235 |
|
|
|
236 |
|
|
struct open_file vmboot_file = { |
237 |
|
|
.f_dev = &vmboot_devsw, |
238 |
|
|
.f_devdata = NULL |
239 |
|
|
}; |
240 |
|
|
|
241 |
|
|
int |
242 |
|
|
vmboot_strategy(void *devdata, int rw, |
243 |
|
|
daddr32_t blk, size_t size, void *buf, size_t *rsize) |
244 |
|
|
{ |
245 |
|
|
struct vmboot_params *vmboot = devdata; |
246 |
|
|
ssize_t rlen; |
247 |
|
|
|
248 |
|
|
if (vmboot->vbp_fd == -1) |
249 |
|
|
return (EIO); |
250 |
|
|
|
251 |
|
|
switch (rw) { |
252 |
|
|
case F_READ: |
253 |
|
|
rlen = pread(vmboot->vbp_fd, buf, size, |
254 |
|
|
(blk + vmboot->vbp_partoff) * DEV_BSIZE); |
255 |
|
|
if (rlen == -1) |
256 |
|
|
return (errno); |
257 |
|
|
*rsize = (size_t)rlen; |
258 |
|
|
break; |
259 |
|
|
case F_WRITE: |
260 |
|
|
rlen = pwrite(vmboot->vbp_fd, buf, size, |
261 |
|
|
(blk + vmboot->vbp_partoff) * DEV_BSIZE); |
262 |
|
|
if (rlen == -1) |
263 |
|
|
return (errno); |
264 |
|
|
*rsize = (size_t)rlen; |
265 |
|
|
break; |
266 |
|
|
default: |
267 |
|
|
return (EINVAL); |
268 |
|
|
} |
269 |
|
|
return (0); |
270 |
|
|
} |
271 |
|
|
|
272 |
|
|
/* |
273 |
|
|
* Based on findopenbsd() from biosdev.c that was partially written by me. |
274 |
|
|
*/ |
275 |
|
|
off_t |
276 |
|
|
vmboot_findopenbsd(struct open_file *f, off_t mbroff, struct disklabel *dl) |
277 |
|
|
{ |
278 |
|
|
struct dos_mbr mbr; |
279 |
|
|
struct dos_partition *dp; |
280 |
|
|
off_t mbr_eoff = DOSBBSECTOR, nextebr; |
281 |
|
|
int ret, i; |
282 |
|
|
static int maxebr = DOS_MAXEBR; |
283 |
|
|
size_t rsize; |
284 |
|
|
char buf[DEV_BSIZE], *msg; |
285 |
|
|
|
286 |
|
|
if (!maxebr--) { |
287 |
|
|
log_debug("%s: too many extended partitions", __func__); |
288 |
|
|
return (-1); |
289 |
|
|
} |
290 |
|
|
|
291 |
|
|
memset(&mbr, 0, sizeof(mbr)); |
292 |
|
|
ret = (f->f_dev->dv_strategy)(f->f_devdata, F_READ, |
293 |
|
|
mbroff, sizeof(mbr), &mbr, &rsize); |
294 |
|
|
if (ret != 0 || rsize != sizeof(mbr)) { |
295 |
|
|
log_debug("%s: failed to read MBR", __func__); |
296 |
|
|
return (-1); |
297 |
|
|
} |
298 |
|
|
|
299 |
|
|
if (mbr.dmbr_sign != DOSMBR_SIGNATURE) { |
300 |
|
|
log_debug("%s: bad MBR signature", __func__); |
301 |
|
|
return (-1); |
302 |
|
|
} |
303 |
|
|
|
304 |
|
|
/* Search for the first OpenBSD partition */ |
305 |
|
|
nextebr = 0; |
306 |
|
|
for (i = 0; i < NDOSPART; i++) { |
307 |
|
|
dp = &mbr.dmbr_parts[i]; |
308 |
|
|
if (!dp->dp_size) |
309 |
|
|
continue; |
310 |
|
|
|
311 |
|
|
if (dp->dp_typ == DOSPTYP_OPENBSD) { |
312 |
|
|
if (dp->dp_start > (dp->dp_start + mbroff)) |
313 |
|
|
continue; |
314 |
|
|
|
315 |
|
|
/* Load and parse the disk label */ |
316 |
|
|
ret = (f->f_dev->dv_strategy)(f->f_devdata, F_READ, |
317 |
|
|
dp->dp_start + mbroff + DOS_LABELSECTOR, |
318 |
|
|
sizeof(buf), buf, &rsize); |
319 |
|
|
if (ret != 0 || rsize != sizeof(buf)) { |
320 |
|
|
log_warn("could not load disk label"); |
321 |
|
|
return (-1); |
322 |
|
|
} |
323 |
|
|
if ((msg = getdisklabel(buf, dl)) != NULL) { |
324 |
|
|
log_warnx("%s", msg); |
325 |
|
|
return (-1); |
326 |
|
|
} |
327 |
|
|
|
328 |
|
|
return (dp->dp_start + mbroff); |
329 |
|
|
} |
330 |
|
|
|
331 |
|
|
if (!nextebr && (dp->dp_typ == DOSPTYP_EXTEND || |
332 |
|
|
dp->dp_typ == DOSPTYP_EXTENDL)) { |
333 |
|
|
nextebr = dp->dp_start + mbr_eoff; |
334 |
|
|
if (nextebr < dp->dp_start) |
335 |
|
|
nextebr = -1; |
336 |
|
|
if (mbr_eoff == DOSBBSECTOR) |
337 |
|
|
mbr_eoff = dp->dp_start; |
338 |
|
|
} |
339 |
|
|
} |
340 |
|
|
|
341 |
|
|
if (nextebr && nextebr != -1) { |
342 |
|
|
mbroff = nextebr; |
343 |
|
|
return (vmboot_findopenbsd(f, mbroff, dl)); |
344 |
|
|
} |
345 |
|
|
|
346 |
|
|
return (-1); |
347 |
|
|
} |
348 |
|
|
|
349 |
|
|
void * |
350 |
|
|
vmboot_loadfile(struct open_file *f, char *file, size_t *size) |
351 |
|
|
{ |
352 |
|
|
char *buf = NULL, *p = NULL; |
353 |
|
|
struct stat st; |
354 |
|
|
size_t rsize; |
355 |
|
|
int ret; |
356 |
|
|
|
357 |
|
|
*size = 0; |
358 |
|
|
|
359 |
|
|
if ((ret = ufs_open(file, f)) != 0) |
360 |
|
|
return (NULL); |
361 |
|
|
|
362 |
|
|
if ((ret = ufs_stat(f, &st)) != 0) { |
363 |
|
|
log_debug("%s: failed to stat %s", __func__, file); |
364 |
|
|
goto done; |
365 |
|
|
} |
366 |
|
|
|
367 |
|
|
if ((buf = calloc(1, roundup(st.st_size, DEV_BSIZE))) == NULL) { |
368 |
|
|
log_debug("%s: failed to allocate buffer", __func__); |
369 |
|
|
goto done; |
370 |
|
|
} |
371 |
|
|
|
372 |
|
|
if ((ret = ufs_read(f, buf, st.st_size, &rsize)) != 0) { |
373 |
|
|
log_debug("%s: failed to read %s", __func__, file); |
374 |
|
|
free(buf); |
375 |
|
|
goto done; |
376 |
|
|
} |
377 |
|
|
|
378 |
|
|
*size = st.st_size; |
379 |
|
|
p = buf; |
380 |
|
|
done: |
381 |
|
|
ufs_close(f); |
382 |
|
|
return (p); |
383 |
|
|
} |
384 |
|
|
|
385 |
|
|
FILE * |
386 |
|
|
vmboot_open(int kernel_fd, int disk_fd, struct vmboot_params *vmboot) |
387 |
|
|
{ |
388 |
|
|
char file[PATH_MAX]; |
389 |
|
|
char *buf = NULL; |
390 |
|
|
size_t size; |
391 |
|
|
FILE *fp = NULL; |
392 |
|
|
struct disklabel dl; |
393 |
|
|
|
394 |
|
|
memset(vmboot, 0, sizeof(*vmboot)); |
395 |
|
|
memset(&dl, 0, sizeof(dl)); |
396 |
|
|
|
397 |
|
|
/* First open kernel directly if specified by fd */ |
398 |
|
|
if (kernel_fd != -1) |
399 |
|
|
return (fdopen(kernel_fd, "r")); |
400 |
|
|
|
401 |
|
|
if (disk_fd == -1) |
402 |
|
|
return (NULL); |
403 |
|
|
|
404 |
|
|
vmboot->vbp_fd = disk_fd; |
405 |
|
|
vmboot_file.f_devdata = vmboot; |
406 |
|
|
|
407 |
|
|
if ((vmboot->vbp_partoff = |
408 |
|
|
vmboot_findopenbsd(&vmboot_file, 0, &dl)) == -1) { |
409 |
|
|
log_debug("%s: could not find openbsd partition", __func__); |
410 |
|
|
return (NULL); |
411 |
|
|
} |
412 |
|
|
|
413 |
|
|
/* Set the default kernel boot device and image path */ |
414 |
|
|
strlcpy(vmboot->vbp_device, VM_DEFAULT_DEVICE, |
415 |
|
|
sizeof(vmboot->vbp_device)); |
416 |
|
|
strlcpy(vmboot->vbp_image, VM_DEFAULT_KERNEL, |
417 |
|
|
sizeof(vmboot->vbp_image)); |
418 |
|
|
|
419 |
|
|
/* Try to parse boot.conf to overwrite the default kernel path */ |
420 |
|
|
strlcpy(file, VM_BOOT_CONF, sizeof(file)); |
421 |
|
|
if ((buf = vmboot_loadfile(&vmboot_file, file, &size)) != NULL) { |
422 |
|
|
if (vmboot_bootconf(buf, size, vmboot) == -1) { |
423 |
|
|
free(buf); |
424 |
|
|
return (NULL); |
425 |
|
|
} |
426 |
|
|
free(buf); |
427 |
|
|
} |
428 |
|
|
|
429 |
|
|
/* Parse boot device and find partition in disk label */ |
430 |
|
|
if ((vmboot->vbp_bootdev = |
431 |
|
|
vmboot_bootdevice(vmboot->vbp_device)) == 0) |
432 |
|
|
return (NULL); |
433 |
|
|
if (B_PARTITION(vmboot->vbp_bootdev) > dl.d_npartitions) { |
434 |
|
|
log_debug("%s: invalid boot partition: %s", |
435 |
|
|
__func__, vmboot->vbp_device); |
436 |
|
|
return (NULL); |
437 |
|
|
} |
438 |
|
|
vmboot->vbp_partoff = |
439 |
|
|
dl.d_partitions[B_PARTITION(vmboot->vbp_bootdev)].p_offset; |
440 |
|
|
|
441 |
|
|
/* Load the kernel */ |
442 |
|
|
if ((buf = vmboot_loadfile(&vmboot_file, |
443 |
|
|
vmboot->vbp_image, &size)) == NULL) { |
444 |
|
|
log_debug("%s: failed to open kernel %s:%s", __func__, |
445 |
|
|
vmboot->vbp_device, vmboot->vbp_image); |
446 |
|
|
return (NULL); |
447 |
|
|
} |
448 |
|
|
vmboot->vbp_arg = buf; |
449 |
|
|
|
450 |
|
|
if ((fp = fmemopen(buf, size, "r")) == NULL) { |
451 |
|
|
log_debug("%s: failed to open memory stream", __func__); |
452 |
|
|
free(buf); |
453 |
|
|
vmboot->vbp_arg = NULL; |
454 |
|
|
} else { |
455 |
|
|
log_debug("%s: kernel %s:%s", __func__, |
456 |
|
|
vmboot->vbp_device, vmboot->vbp_image); |
457 |
|
|
} |
458 |
|
|
|
459 |
|
|
return (fp); |
460 |
|
|
} |
461 |
|
|
|
462 |
|
|
void |
463 |
|
|
vmboot_close(FILE *fp, struct vmboot_params *vmboot) |
464 |
|
|
{ |
465 |
|
|
fclose(fp); |
466 |
|
|
free(vmboot->vbp_arg); |
467 |
|
|
} |