1 /* 2 * Copyright (c) 2008 Luigi Rizzo 3 * Copyright (c) 1999 Robert Nordier 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 18 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS 19 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, 20 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT 21 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR 22 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 23 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE 24 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, 25 * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26 */ 27 28 #include <sys/cdefs.h> 29 __FBSDID("$FreeBSD$"); 30 31 #include <sys/param.h> 32 #include <sys/disklabel.h> 33 #include <sys/diskmbr.h> 34 #include <sys/stat.h> 35 36 #include <err.h> 37 #include <errno.h> 38 #include <fcntl.h> 39 #include <libgeom.h> 40 #include <paths.h> 41 #include <stdio.h> 42 #include <stdlib.h> 43 #include <string.h> 44 #include <unistd.h> 45 46 #define MBRSIZE 512 /* master boot record size */ 47 48 #define OFF_VERSION 0x1b0 /* offset: version number, only boot0version */ 49 #define OFF_SERIAL 0x1b8 /* offset: volume serial number */ 50 #define OFF_PTBL 0x1be /* offset: partition table */ 51 #define OFF_MAGIC 0x1fe /* offset: magic number */ 52 /* 53 * Offsets to the parameters of the 512-byte boot block. 54 * For historical reasons they are set as macros 55 */ 56 struct opt_offsets { 57 int opt; 58 int drive; 59 int flags; 60 int ticks; 61 }; 62 63 static struct opt_offsets b0_ofs[] = { 64 { 0x0, 0x0, 0x0, 0x0 }, /* no boot block */ 65 { 0x1b9, 0x1ba, 0x1bb, 0x1bc }, /* original block */ 66 { 0x1b5, 0x1b6, 0x1b7, 0x1bc }, /* NT_SERIAL block */ 67 }; 68 69 static int b0_ver; /* boot block version set by boot0bs */ 70 71 #define OFF_OPT (b0_ofs[b0_ver].opt) /* default boot option */ 72 #define OFF_DRIVE (b0_ofs[b0_ver].drive) /* setdrv drive */ 73 #define OFF_FLAGS (b0_ofs[b0_ver].flags) /* option flags */ 74 #define OFF_TICKS (b0_ofs[b0_ver].ticks) /* clock ticks */ 75 76 77 #define cv2(p) ((p)[0] | (p)[1] << 010) 78 79 #define mk2(p, x) \ 80 (p)[0] = (u_int8_t)(x), \ 81 (p)[1] = (u_int8_t)((x) >> 010) 82 83 static const struct { 84 const char *tok; 85 int def; 86 } opttbl[] = { 87 {"packet", 0}, 88 {"update", 1}, 89 {"setdrv", 0} 90 }; 91 static const int nopt = sizeof(opttbl) / sizeof(opttbl[0]); 92 93 static const char fmt0[] = "# flag start chs type" 94 " end chs offset size\n"; 95 96 static const char fmt1[] = "%d 0x%02x %4u:%3u:%2u 0x%02x" 97 " %4u:%3u:%2u %10u %10u\n"; 98 99 static int geom_class_available(const char *); 100 static int read_mbr(const char *, u_int8_t **, int); 101 static void write_mbr(const char *, int, u_int8_t *, int); 102 static void display_mbr(u_int8_t *); 103 static int boot0version(const u_int8_t *); 104 static int boot0bs(const u_int8_t *); 105 static void stropt(const char *, int *, int *); 106 static int argtoi(const char *, int, int, int); 107 static int set_bell(u_int8_t *, int, int); 108 static void usage(void); 109 110 static unsigned vol_id[5]; /* 4 plus 1 for flag */ 111 112 static int v_flag; 113 /* 114 * Boot manager installation/configuration utility. 115 */ 116 int 117 main(int argc, char *argv[]) 118 { 119 u_int8_t *mbr, *boot0; 120 int boot0_size, mbr_size; 121 const char *bpath, *fpath; 122 char *disk; 123 int B_flag, o_flag; 124 int d_arg, m_arg, s_arg, t_arg; 125 int o_and, o_or, o_e = -1; 126 int up, c; 127 128 bpath = "/boot/boot0"; 129 fpath = NULL; 130 B_flag = v_flag = o_flag = 0; 131 d_arg = m_arg = s_arg = t_arg = -1; 132 o_and = 0xff; 133 o_or = 0; 134 while ((c = getopt(argc, argv, "Bvb:d:e:f:i:m:o:s:t:")) != -1) 135 switch (c) { 136 case 'B': 137 B_flag = 1; 138 break; 139 case 'v': 140 v_flag = 1; 141 break; 142 case 'b': 143 bpath = optarg; 144 break; 145 case 'd': 146 d_arg = argtoi(optarg, 0, 0xff, 'd'); 147 break; 148 case 'e': 149 if (optarg[0] == '0' && optarg[1] == 'x') 150 sscanf(optarg, "0x%02x", &o_e); 151 else 152 o_e = optarg[0]; 153 break; 154 case 'f': 155 fpath = optarg; 156 break; 157 case 'i': 158 if (sscanf(optarg, "%02x%02x-%02x%02x", 159 vol_id, vol_id+1, vol_id+2, vol_id+3) == 4) 160 vol_id[4] = 1; 161 else 162 errx(1, "bad argument %s", optarg); 163 break; 164 case 'm': 165 m_arg = argtoi(optarg, 0, 0xf, 'm'); 166 break; 167 case 'o': 168 stropt(optarg, &o_and, &o_or); 169 o_flag = 1; 170 break; 171 case 's': 172 s_arg = argtoi(optarg, 1, 5, 's'); 173 break; 174 case 't': 175 t_arg = argtoi(optarg, 1, 0xffff, 't'); 176 break; 177 default: 178 usage(); 179 } 180 argc -= optind; 181 argv += optind; 182 if (argc != 1) 183 usage(); 184 disk = g_device_path(*argv); 185 if (disk == NULL) 186 errx(1, "Unable to get providername for %s\n", *argv); 187 up = B_flag || d_arg != -1 || m_arg != -1 || o_flag || s_arg != -1 188 || t_arg != -1; 189 190 /* open the disk and read in the existing mbr. Either here or 191 * when reading the block from disk, we do check for the version 192 * and abort if a suitable block is not found. 193 */ 194 mbr_size = read_mbr(disk, &mbr, !B_flag); 195 196 /* save the existing MBR if we are asked to do so */ 197 if (fpath) 198 write_mbr(fpath, O_CREAT | O_TRUNC, mbr, mbr_size); 199 200 /* 201 * If we are installing the boot loader, read it from disk and copy the 202 * slice table over from the existing MBR. If not, then point boot0 203 * back at the MBR we just read in. After this, boot0 is the data to 204 * write back to disk if we are going to do a write. 205 */ 206 if (B_flag) { 207 boot0_size = read_mbr(bpath, &boot0, 1); 208 memcpy(boot0 + OFF_PTBL, mbr + OFF_PTBL, 209 sizeof(struct dos_partition) * NDOSPART); 210 if (b0_ver == 2) /* volume serial number support */ 211 memcpy(boot0 + OFF_SERIAL, mbr + OFF_SERIAL, 4); 212 } else { 213 boot0 = mbr; 214 boot0_size = mbr_size; 215 } 216 217 /* set the drive */ 218 if (d_arg != -1) 219 boot0[OFF_DRIVE] = d_arg; 220 221 /* set various flags */ 222 if (m_arg != -1) { 223 boot0[OFF_FLAGS] &= 0xf0; 224 boot0[OFF_FLAGS] |= m_arg; 225 } 226 if (o_flag) { 227 boot0[OFF_FLAGS] &= o_and; 228 boot0[OFF_FLAGS] |= o_or; 229 } 230 231 /* set the default boot selection */ 232 if (s_arg != -1) 233 boot0[OFF_OPT] = s_arg - 1; 234 235 /* set the timeout */ 236 if (t_arg != -1) 237 mk2(boot0 + OFF_TICKS, t_arg); 238 239 /* set the bell char */ 240 if (o_e != -1 && set_bell(boot0, o_e, 0) != -1) 241 up = 1; 242 243 if (vol_id[4]) { 244 if (b0_ver != 2) 245 errx(1, "incompatible boot block, cannot set volume ID"); 246 boot0[OFF_SERIAL] = vol_id[0]; 247 boot0[OFF_SERIAL+1] = vol_id[1]; 248 boot0[OFF_SERIAL+2] = vol_id[2]; 249 boot0[OFF_SERIAL+3] = vol_id[3]; 250 up = 1; /* force update */ 251 } 252 /* write the MBR back to disk */ 253 if (up) 254 write_mbr(disk, 0, boot0, boot0_size); 255 256 /* display the MBR */ 257 if (v_flag) 258 display_mbr(boot0); 259 260 /* clean up */ 261 if (mbr != boot0) 262 free(boot0); 263 free(mbr); 264 free(disk); 265 266 return 0; 267 } 268 269 /* get or set the 'bell' character to be used in case of errors. 270 * Lookup for a certain code sequence, return -1 if not found. 271 */ 272 static int 273 set_bell(u_int8_t *mbr, int new_bell, int report) 274 { 275 /* lookup sequence: 0x100 means skip, 0x200 means done */ 276 static unsigned seq[] = 277 { 0xb0, 0x100, 0xe8, 0x100, 0x100, 0x30, 0xe4, 0x200 }; 278 int ofs, i, c; 279 for (ofs = 0x60; ofs < 0x180; ofs++) { /* search range */ 280 if (mbr[ofs] != seq[0]) /* search initial pattern */ 281 continue; 282 for (i=0;; i++) { 283 if (seq[i] == 0x200) { /* found */ 284 c = mbr[ofs+1]; 285 if (!report) 286 mbr[ofs+1] = c = new_bell; 287 else 288 printf(" bell=%c (0x%x)", 289 (c >= ' ' && c < 0x7f) ? c : ' ', c); 290 return c; 291 } 292 if (seq[i] != 0x100 && seq[i] != mbr[ofs+i]) 293 break; 294 } 295 } 296 warn("bell not found"); 297 return -1; 298 } 299 /* 300 * Read in the MBR of the disk. If it is boot0, then use the version to 301 * read in all of it if necessary. Use pointers to return a malloc'd 302 * buffer containing the MBR and then return its size. 303 */ 304 static int 305 read_mbr(const char *disk, u_int8_t **mbr, int check_version) 306 { 307 u_int8_t buf[MBRSIZE]; 308 int mbr_size, fd; 309 int ver; 310 ssize_t n; 311 312 if ((fd = open(disk, O_RDONLY)) == -1) 313 err(1, "open %s", disk); 314 if ((n = read(fd, buf, MBRSIZE)) == -1) 315 err(1, "read %s", disk); 316 if (n != MBRSIZE) 317 errx(1, "%s: short read", disk); 318 if (cv2(buf + OFF_MAGIC) != 0xaa55) 319 errx(1, "%s: bad magic", disk); 320 321 if (! (ver = boot0bs(buf))) { 322 if (check_version) 323 errx(1, "%s: unknown or incompatible boot code", disk); 324 } else if (boot0version(buf) == 0x101) { 325 mbr_size = 1024; 326 if ((*mbr = malloc(mbr_size)) == NULL) 327 errx(1, "%s: unable to allocate read buffer", disk); 328 if (lseek(fd, 0, SEEK_SET) == -1 || 329 (n = read(fd, *mbr, mbr_size)) == -1) 330 err(1, "%s", disk); 331 if (n != mbr_size) 332 errx(1, "%s: short read", disk); 333 return (mbr_size); 334 } 335 *mbr = malloc(sizeof(buf)); 336 memcpy(*mbr, buf, sizeof(buf)); 337 338 return sizeof(buf); 339 } 340 341 static int 342 geom_class_available(const char *name) 343 { 344 struct gclass *class; 345 struct gmesh mesh; 346 int error; 347 348 error = geom_gettree(&mesh); 349 if (error != 0) 350 errc(1, error, "Cannot get GEOM tree"); 351 352 LIST_FOREACH(class, &mesh.lg_class, lg_class) { 353 if (strcmp(class->lg_name, name) == 0) { 354 geom_deletetree(&mesh); 355 return (1); 356 } 357 } 358 359 geom_deletetree(&mesh); 360 return (0); 361 } 362 363 /* 364 * Write out the mbr to the specified file. 365 */ 366 static void 367 write_mbr(const char *fname, int flags, u_int8_t *mbr, int mbr_size) 368 { 369 struct gctl_req *grq; 370 const char *errmsg; 371 char *pname; 372 ssize_t n; 373 int fd; 374 375 fd = open(fname, O_WRONLY | flags, 0666); 376 if (fd != -1) { 377 n = write(fd, mbr, mbr_size); 378 close(fd); 379 if (n != mbr_size) 380 errx(1, "%s: short write", fname); 381 return; 382 } 383 384 /* 385 * If we're called to write to a backup file, don't try to 386 * write through GEOM. 387 */ 388 if (flags != 0) 389 err(1, "can't open file %s to write backup", fname); 390 391 /* Try open it read only. */ 392 fd = open(fname, O_RDONLY); 393 if (fd == -1) { 394 warn("error opening %s", fname); 395 return; 396 } 397 398 pname = g_providername(fd); 399 if (pname == NULL) { 400 warn("error getting providername for %s", fname); 401 return; 402 } 403 404 /* First check that GEOM_PART is available */ 405 if (geom_class_available("PART") != 0) { 406 grq = gctl_get_handle(); 407 gctl_ro_param(grq, "class", -1, "PART"); 408 gctl_ro_param(grq, "arg0", -1, pname); 409 gctl_ro_param(grq, "verb", -1, "bootcode"); 410 gctl_ro_param(grq, "bootcode", mbr_size, mbr); 411 gctl_ro_param(grq, "flags", -1, "C"); 412 errmsg = gctl_issue(grq); 413 if (errmsg != NULL && errmsg[0] != '\0') 414 errx(1, "GEOM_PART: write bootcode to %s failed: %s", 415 fname, errmsg); 416 gctl_free(grq); 417 } else if (geom_class_available("MBR") != 0) { 418 grq = gctl_get_handle(); 419 gctl_ro_param(grq, "verb", -1, "write MBR"); 420 gctl_ro_param(grq, "class", -1, "MBR"); 421 gctl_ro_param(grq, "geom", -1, pname); 422 gctl_ro_param(grq, "data", mbr_size, mbr); 423 errmsg = gctl_issue(grq); 424 if (errmsg != NULL) 425 err(1, "GEOM_MBR: write MBR to %s failed", fname); 426 gctl_free(grq); 427 } else 428 errx(1, "can't write MBR to %s", fname); 429 free(pname); 430 } 431 432 /* 433 * Outputs an informative dump of the data in the MBR to stdout. 434 */ 435 static void 436 display_mbr(u_int8_t *mbr) 437 { 438 struct dos_partition *part; 439 int i, version; 440 441 part = (struct dos_partition *)(mbr + DOSPARTOFF); 442 printf(fmt0); 443 for (i = 0; i < NDOSPART; i++) 444 if (part[i].dp_typ) 445 printf(fmt1, 1 + i, part[i].dp_flag, 446 part[i].dp_scyl + ((part[i].dp_ssect & 0xc0) << 2), 447 part[i].dp_shd, part[i].dp_ssect & 0x3f, part[i].dp_typ, 448 part[i].dp_ecyl + ((part[i].dp_esect & 0xc0) << 2), 449 part[i].dp_ehd, part[i].dp_esect & 0x3f, part[i].dp_start, 450 part[i].dp_size); 451 printf("\n"); 452 version = boot0version(mbr); 453 printf("version=%d.%d drive=0x%x mask=0x%x ticks=%u", 454 version >> 8, version & 0xff, mbr[OFF_DRIVE], 455 mbr[OFF_FLAGS] & 0xf, cv2(mbr + OFF_TICKS)); 456 set_bell(mbr, 0, 1); 457 printf("\noptions="); 458 for (i = 0; i < nopt; i++) { 459 if (i) 460 printf(","); 461 if (!(mbr[OFF_FLAGS] & 1 << (7 - i)) ^ opttbl[i].def) 462 printf("no"); 463 printf("%s", opttbl[i].tok); 464 } 465 printf("\n"); 466 if (b0_ver == 2) 467 printf("volume serial ID %02x%02x-%02x%02x\n", 468 mbr[OFF_SERIAL], mbr[OFF_SERIAL+1], 469 mbr[OFF_SERIAL+2], mbr[OFF_SERIAL+3]); 470 printf("default_selection=F%d (", mbr[OFF_OPT] + 1); 471 if (mbr[OFF_OPT] < 4) 472 printf("Slice %d", mbr[OFF_OPT] + 1); 473 else 474 printf("Drive 1"); 475 printf(")\n"); 476 } 477 478 /* 479 * Return the boot0 version with the minor revision in the low byte, and 480 * the major revision in the next higher byte. 481 */ 482 static int 483 boot0version(const u_int8_t *bs) 484 { 485 /* Check for old version, and return 0x100 if found. */ 486 int v = boot0bs(bs); 487 if (v != 0) 488 return v << 8; 489 490 /* We have a newer boot0, so extract the version number and return it. */ 491 return *(const int *)(bs + OFF_VERSION) & 0xffff; 492 } 493 494 /* descriptor of a pattern to match. 495 * Start from the first entry trying to match the chunk of bytes, 496 * if you hit an entry with len=0 terminate the search and report 497 * off as the version. Otherwise skip to the next block after len=0 498 * An entry with len=0, off=0 is the end marker. 499 */ 500 struct byte_pattern { 501 unsigned off; 502 unsigned len; 503 u_int8_t *key; 504 }; 505 506 /* 507 * Decide if we have valid boot0 boot code by looking for 508 * characteristic byte sequences at fixed offsets. 509 */ 510 static int 511 boot0bs(const u_int8_t *bs) 512 { 513 /* the initial code sequence */ 514 static u_int8_t id0[] = {0xfc, 0x31, 0xc0, 0x8e, 0xc0, 0x8e, 0xd8, 515 0x8e, 0xd0, 0xbc, 0x00, 0x7c }; 516 /* the drive id */ 517 static u_int8_t id1[] = {'D', 'r', 'i', 'v', 'e', ' '}; 518 static struct byte_pattern patterns[] = { 519 {0x0, sizeof(id0), id0}, 520 {0x1b2, sizeof(id1), id1}, 521 {1, 0, NULL}, 522 {0x0, sizeof(id0), id0}, /* version with NT support */ 523 {0x1ae, sizeof(id1), id1}, 524 {2, 0, NULL}, 525 {0, 0, NULL}, 526 }; 527 struct byte_pattern *p = patterns; 528 529 for (; p->off || p->len; p++) { 530 if (p->len == 0) 531 break; 532 if (!memcmp(bs + p->off, p->key, p->len)) /* match */ 533 continue; 534 while (p->len) /* skip to next block */ 535 p++; 536 } 537 b0_ver = p->off; /* XXX ugly side effect */ 538 return p->off; 539 } 540 541 /* 542 * Adjust "and" and "or" masks for a -o option argument. 543 */ 544 static void 545 stropt(const char *arg, int *xa, int *xo) 546 { 547 const char *q; 548 char *s, *s1; 549 int inv, i, x; 550 551 if (!(s = strdup(arg))) 552 err(1, NULL); 553 for (s1 = s; (q = strtok(s1, ",")); s1 = NULL) { 554 if ((inv = !strncmp(q, "no", 2))) 555 q += 2; 556 for (i = 0; i < nopt; i++) 557 if (!strcmp(q, opttbl[i].tok)) 558 break; 559 if (i == nopt) 560 errx(1, "%s: Unknown -o option", q); 561 if (opttbl[i].def) 562 inv ^= 1; 563 x = 1 << (7 - i); 564 if (inv) 565 *xa &= ~x; 566 else 567 *xo |= x; 568 } 569 free(s); 570 } 571 572 /* 573 * Convert and check an option argument. 574 */ 575 static int 576 argtoi(const char *arg, int lo, int hi, int opt) 577 { 578 char *s; 579 long x; 580 581 errno = 0; 582 x = strtol(arg, &s, 0); 583 if (errno || !*arg || *s || x < lo || x > hi) 584 errx(1, "%s: Bad argument to -%c option", arg, opt); 585 return x; 586 } 587 588 /* 589 * Display usage information. 590 */ 591 static void 592 usage(void) 593 { 594 fprintf(stderr, "%s\n%s\n", 595 "usage: boot0cfg [-Bv] [-b boot0] [-d drive] [-f file] [-m mask]", 596 " [-o options] [-s slice] [-t ticks] disk"); 597 exit(1); 598 } 599