1 /* 2 * Mach Operating System 3 * Copyright (c) 1992 Carnegie Mellon University 4 * All Rights Reserved. 5 * 6 * Permission to use, copy, modify and distribute this software and its 7 * documentation is hereby granted, provided that both the copyright 8 * notice and this permission notice appear in all copies of the 9 * software, derivative works or modified versions, and any portions 10 * thereof, and that both notices appear in supporting documentation. 11 * 12 * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS" 13 * CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR 14 * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE. 15 * 16 * Carnegie Mellon requests users of this software to return to 17 * 18 * Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU 19 * School of Computer Science 20 * Carnegie Mellon University 21 * Pittsburgh PA 15213-3890 22 * 23 * any improvements or extensions that they make and grant Carnegie Mellon 24 * the rights to redistribute these changes. 25 */ 26 27 #ifndef lint 28 static const char rcsid[] = 29 "$FreeBSD$"; 30 #endif /* not lint */ 31 32 #include <sys/disklabel.h> 33 #include <sys/param.h> 34 #include <sys/stat.h> 35 #include <sys/mount.h> 36 #include <ctype.h> 37 #include <fcntl.h> 38 #include <err.h> 39 #include <errno.h> 40 #include <paths.h> 41 #include <regex.h> 42 #include <stdio.h> 43 #include <stdlib.h> 44 #include <string.h> 45 #include <unistd.h> 46 47 int iotest; 48 49 #define LBUF 100 50 static char lbuf[LBUF]; 51 52 #define MBRSIGOFF 510 53 54 /* 55 * 56 * Ported to 386bsd by Julian Elischer Thu Oct 15 20:26:46 PDT 1992 57 * 58 * 14-Dec-89 Robert Baron (rvb) at Carnegie-Mellon University 59 * Copyright (c) 1989 Robert. V. Baron 60 * Created. 61 */ 62 63 #define Decimal(str, ans, tmp) if (decimal(str, &tmp, ans)) ans = tmp 64 65 #define RoundCyl(x) ((((x) + cylsecs - 1) / cylsecs) * cylsecs) 66 67 #define MAX_SEC_SIZE 2048 /* maximum section size that is supported */ 68 #define MIN_SEC_SIZE 512 /* the sector size to start sensing at */ 69 static int secsize = 0; /* the sensed sector size */ 70 71 static char *disk; 72 73 static struct disklabel disklabel; /* disk parameters */ 74 75 static int cyls, sectors, heads, cylsecs, disksecs; 76 77 struct mboot { 78 unsigned char padding[2]; /* force the longs to be long aligned */ 79 unsigned char *bootinst; /* boot code */ 80 off_t bootinst_size; 81 struct dos_partition parts[4]; 82 }; 83 84 static struct mboot mboot; 85 static int fd; 86 87 #define ACTIVE 0x80 88 #define BOOT_MAGIC 0xAA55 89 90 static uint dos_cyls; 91 static uint dos_heads; 92 static uint dos_sectors; 93 static uint dos_cylsecs; 94 95 #define DOSSECT(s,c) ((s & 0x3f) | ((c >> 2) & 0xc0)) 96 #define DOSCYL(c) (c & 0xff) 97 98 #define MAX_ARGS 10 99 100 static int current_line_number; 101 102 static int geom_processed = 0; 103 static int part_processed = 0; 104 static int active_processed = 0; 105 106 typedef struct cmd { 107 char cmd; 108 int n_args; 109 struct arg { 110 char argtype; 111 int arg_val; 112 } args[MAX_ARGS]; 113 } CMD; 114 115 static int B_flag = 0; /* replace boot code */ 116 static int I_flag = 0; /* use entire disk for FreeBSD */ 117 static int a_flag = 0; /* set active partition */ 118 static char *b_flag = NULL; /* path to boot code */ 119 static int i_flag = 0; /* replace partition data */ 120 static int u_flag = 0; /* update partition data */ 121 static int s_flag = 0; /* Print a summary and exit */ 122 static int t_flag = 0; /* test only */ 123 static char *f_flag = NULL; /* Read config info from file */ 124 static int v_flag = 0; /* Be verbose */ 125 126 static struct part_type 127 { 128 unsigned char type; 129 const char *name; 130 } part_types[] = { 131 {0x00, "unused"} 132 ,{0x01, "Primary DOS with 12 bit FAT"} 133 ,{0x02, "XENIX / filesystem"} 134 ,{0x03, "XENIX /usr filesystem"} 135 ,{0x04, "Primary DOS with 16 bit FAT (< 32MB)"} 136 ,{0x05, "Extended DOS"} 137 ,{0x06, "Primary 'big' DOS (>= 32MB)"} 138 ,{0x07, "OS/2 HPFS, NTFS, QNX-2 (16 bit) or Advanced UNIX"} 139 ,{0x08, "AIX filesystem or SplitDrive"} 140 ,{0x09, "AIX boot partition or Coherent"} 141 ,{0x0A, "OS/2 Boot Manager, OPUS or Coherent swap"} 142 ,{0x0B, "DOS or Windows 95 with 32 bit FAT"} 143 ,{0x0C, "DOS or Windows 95 with 32 bit FAT (LBA)"} 144 ,{0x0E, "Primary 'big' DOS (>= 32MB, LBA)"} 145 ,{0x0F, "Extended DOS (LBA)"} 146 ,{0x10, "OPUS"} 147 ,{0x11, "OS/2 BM: hidden DOS with 12-bit FAT"} 148 ,{0x12, "Compaq diagnostics"} 149 ,{0x14, "OS/2 BM: hidden DOS with 16-bit FAT (< 32MB)"} 150 ,{0x16, "OS/2 BM: hidden DOS with 16-bit FAT (>= 32MB)"} 151 ,{0x17, "OS/2 BM: hidden IFS (e.g. HPFS)"} 152 ,{0x18, "AST Windows swapfile"} 153 ,{0x24, "NEC DOS"} 154 ,{0x3C, "PartitionMagic recovery"} 155 ,{0x39, "plan9"} 156 ,{0x40, "VENIX 286"} 157 ,{0x41, "Linux/MINIX (sharing disk with DRDOS)"} 158 ,{0x42, "SFS or Linux swap (sharing disk with DRDOS)"} 159 ,{0x43, "Linux native (sharing disk with DRDOS)"} 160 ,{0x4D, "QNX 4.2 Primary"} 161 ,{0x4E, "QNX 4.2 Secondary"} 162 ,{0x4F, "QNX 4.2 Tertiary"} 163 ,{0x50, "DM (disk manager)"} 164 ,{0x51, "DM6 Aux1 (or Novell)"} 165 ,{0x52, "CP/M or Microport SysV/AT"} 166 ,{0x53, "DM6 Aux3"} 167 ,{0x54, "DM6"} 168 ,{0x55, "EZ-Drive (disk manager)"} 169 ,{0x56, "Golden Bow (disk manager)"} 170 ,{0x5c, "Priam Edisk (disk manager)"} /* according to S. Widlake */ 171 ,{0x61, "SpeedStor"} 172 ,{0x63, "System V/386 (such as ISC UNIX), GNU HURD or Mach"} 173 ,{0x64, "Novell Netware/286 2.xx"} 174 ,{0x65, "Novell Netware/386 3.xx"} 175 ,{0x70, "DiskSecure Multi-Boot"} 176 ,{0x75, "PCIX"} 177 ,{0x77, "QNX4.x"} 178 ,{0x78, "QNX4.x 2nd part"} 179 ,{0x79, "QNX4.x 3rd part"} 180 ,{0x80, "Minix until 1.4a"} 181 ,{0x81, "Minix since 1.4b, early Linux partition or Mitac disk manager"} 182 ,{0x82, "Linux swap or Solaris x86"} 183 ,{0x83, "Linux native"} 184 ,{0x84, "OS/2 hidden C: drive"} 185 ,{0x85, "Linux extended"} 186 ,{0x86, "NTFS volume set??"} 187 ,{0x87, "NTFS volume set??"} 188 ,{0x93, "Amoeba filesystem"} 189 ,{0x94, "Amoeba bad block table"} 190 ,{0x9F, "BSD/OS"} 191 ,{0xA0, "Suspend to Disk"} 192 ,{0xA5, "FreeBSD/NetBSD/386BSD"} 193 ,{0xA6, "OpenBSD"} 194 ,{0xA7, "NeXTSTEP"} 195 ,{0xA9, "NetBSD"} 196 ,{0xAC, "IBM JFS"} 197 ,{0xB7, "BSDI BSD/386 filesystem"} 198 ,{0xB8, "BSDI BSD/386 swap"} 199 ,{0xC1, "DRDOS/sec with 12-bit FAT"} 200 ,{0xC4, "DRDOS/sec with 16-bit FAT (< 32MB)"} 201 ,{0xC6, "DRDOS/sec with 16-bit FAT (>= 32MB)"} 202 ,{0xC7, "Syrinx"} 203 ,{0xDB, "CP/M, Concurrent CP/M, Concurrent DOS or CTOS"} 204 ,{0xE1, "DOS access or SpeedStor with 12-bit FAT extended partition"} 205 ,{0xE3, "DOS R/O or SpeedStor"} 206 ,{0xE4, "SpeedStor with 16-bit FAT extended partition < 1024 cyl."} 207 ,{0xEB, "BeOS filesystem"} 208 ,{0xEE, "EFI GPT"} 209 ,{0xEF, "EFI System Partition"} 210 ,{0xF1, "SpeedStor"} 211 ,{0xF2, "DOS 3.3+ Secondary"} 212 ,{0xF4, "SpeedStor large partition"} 213 ,{0xFE, "SpeedStor >1024 cyl. or LANstep"} 214 ,{0xFF, "Xenix bad blocks table"} 215 }; 216 217 static void print_s0(int which); 218 static void print_part(int i); 219 static void init_sector0(unsigned long start); 220 static void init_boot(void); 221 static void change_part(int i); 222 static void print_params(void); 223 static void change_active(int which); 224 static void change_code(void); 225 static void get_params_to_use(void); 226 static char *get_rootdisk(void); 227 static void dos(struct dos_partition *partp); 228 static int open_disk(int flag); 229 static ssize_t read_disk(off_t sector, void *buf); 230 static ssize_t write_disk(off_t sector, void *buf); 231 static int get_params(void); 232 static int read_s0(void); 233 static int write_s0(void); 234 static int ok(const char *str); 235 static int decimal(const char *str, int *num, int deflt); 236 static const char *get_type(int type); 237 static int read_config(char *config_file); 238 static void reset_boot(void); 239 static int sanitize_partition(struct dos_partition *); 240 static void usage(void); 241 242 int 243 main(int argc, char *argv[]) 244 { 245 struct stat sb; 246 int c, i; 247 int partition = -1; 248 struct dos_partition *partp; 249 250 while ((c = getopt(argc, argv, "BIab:f:istuv1234")) != -1) 251 switch (c) { 252 case 'B': 253 B_flag = 1; 254 break; 255 case 'I': 256 I_flag = 1; 257 break; 258 case 'a': 259 a_flag = 1; 260 break; 261 case 'b': 262 b_flag = optarg; 263 break; 264 case 'f': 265 f_flag = optarg; 266 break; 267 case 'i': 268 i_flag = 1; 269 break; 270 case 's': 271 s_flag = 1; 272 break; 273 case 't': 274 t_flag = 1; 275 break; 276 case 'u': 277 u_flag = 1; 278 break; 279 case 'v': 280 v_flag = 1; 281 break; 282 case '1': 283 case '2': 284 case '3': 285 case '4': 286 partition = c - '0'; 287 break; 288 default: 289 usage(); 290 } 291 if (f_flag || i_flag) 292 u_flag = 1; 293 if (t_flag) 294 v_flag = 1; 295 argc -= optind; 296 argv += optind; 297 298 if (argc == 0) { 299 disk = get_rootdisk(); 300 } else { 301 if (stat(argv[0], &sb) == 0) { 302 /* OK, full pathname given */ 303 disk = argv[0]; 304 } else if (errno == ENOENT) { 305 /* Try prepending "/dev" */ 306 asprintf(&disk, "%s%s", _PATH_DEV, argv[0]); 307 if (disk == NULL) 308 errx(1, "out of memory"); 309 } else { 310 /* other stat error, let it fail below */ 311 disk = argv[0]; 312 } 313 } 314 if (open_disk(u_flag) < 0) 315 err(1, "cannot open disk %s", disk); 316 317 /* (abu)use mboot.bootinst to probe for the sector size */ 318 if ((mboot.bootinst = malloc(MAX_SEC_SIZE)) == NULL) 319 err(1, "cannot allocate buffer to determine disk sector size"); 320 read_disk(0, mboot.bootinst); 321 free(mboot.bootinst); 322 mboot.bootinst = NULL; 323 324 if (s_flag) { 325 if (read_s0()) 326 err(1, "read_s0"); 327 printf("%s: %d cyl %d hd %d sec\n", disk, dos_cyls, dos_heads, 328 dos_sectors); 329 printf("Part %11s %11s Type Flags\n", "Start", "Size"); 330 for (i = 0; i < NDOSPART; i++) { 331 partp = ((struct dos_partition *) &mboot.parts) + i; 332 if (partp->dp_start == 0 && partp->dp_size == 0) 333 continue; 334 printf("%4d: %11lu %11lu 0x%02x 0x%02x\n", i + 1, 335 (u_long) partp->dp_start, 336 (u_long) partp->dp_size, partp->dp_typ, 337 partp->dp_flag); 338 } 339 exit(0); 340 } 341 342 printf("******* Working on device %s *******\n",disk); 343 344 if (I_flag) { 345 read_s0(); 346 reset_boot(); 347 partp = (struct dos_partition *) (&mboot.parts[0]); 348 partp->dp_typ = DOSPTYP_386BSD; 349 partp->dp_flag = ACTIVE; 350 partp->dp_start = dos_sectors; 351 partp->dp_size = (disksecs / dos_cylsecs) * dos_cylsecs - 352 dos_sectors; 353 dos(partp); 354 if (v_flag) 355 print_s0(-1); 356 if (!t_flag) 357 write_s0(); 358 exit(0); 359 } 360 if (f_flag) { 361 if (read_s0() || i_flag) 362 reset_boot(); 363 if (!read_config(f_flag)) 364 exit(1); 365 if (v_flag) 366 print_s0(-1); 367 if (!t_flag) 368 write_s0(); 369 } else { 370 if(u_flag) 371 get_params_to_use(); 372 else 373 print_params(); 374 375 if (read_s0()) 376 init_sector0(dos_sectors); 377 378 printf("Media sector size is %d\n", secsize); 379 printf("Warning: BIOS sector numbering starts with sector 1\n"); 380 printf("Information from DOS bootblock is:\n"); 381 if (partition == -1) 382 for (i = 1; i <= NDOSPART; i++) 383 change_part(i); 384 else 385 change_part(partition); 386 387 if (u_flag || a_flag) 388 change_active(partition); 389 390 if (B_flag) 391 change_code(); 392 393 if (u_flag || a_flag || B_flag) { 394 if (!t_flag) { 395 printf("\nWe haven't changed the partition table yet. "); 396 printf("This is your last chance.\n"); 397 } 398 print_s0(-1); 399 if (!t_flag) { 400 if (ok("Should we write new partition table?")) 401 write_s0(); 402 } else { 403 printf("\n-t flag specified -- partition table not written.\n"); 404 } 405 } 406 } 407 408 exit(0); 409 } 410 411 static void 412 usage() 413 { 414 fprintf(stderr, "%s%s", 415 "usage: fdisk [-BIaistu] [-b bootcode] [-1234] [disk]\n", 416 " fdisk -f configfile [-itv] [disk]\n"); 417 exit(1); 418 } 419 420 static void 421 print_s0(int which) 422 { 423 int i; 424 425 print_params(); 426 printf("Information from DOS bootblock is:\n"); 427 if (which == -1) 428 for (i = 1; i <= NDOSPART; i++) 429 printf("%d: ", i), print_part(i); 430 else 431 print_part(which); 432 } 433 434 static struct dos_partition mtpart; 435 436 static void 437 print_part(int i) 438 { 439 struct dos_partition *partp; 440 u_int64_t part_mb; 441 442 partp = ((struct dos_partition *) &mboot.parts) + i - 1; 443 444 if (!bcmp(partp, &mtpart, sizeof (struct dos_partition))) { 445 printf("<UNUSED>\n"); 446 return; 447 } 448 /* 449 * Be careful not to overflow. 450 */ 451 part_mb = partp->dp_size; 452 part_mb *= secsize; 453 part_mb /= (1024 * 1024); 454 printf("sysid %d (%#04x),(%s)\n", partp->dp_typ, partp->dp_typ, 455 get_type(partp->dp_typ)); 456 printf(" start %lu, size %lu (%qd Meg), flag %x%s\n", 457 (u_long)partp->dp_start, 458 (u_long)partp->dp_size, 459 part_mb, 460 partp->dp_flag, 461 partp->dp_flag == ACTIVE ? " (active)" : ""); 462 printf("\tbeg: cyl %d/ head %d/ sector %d;\n\tend: cyl %d/ head %d/ sector %d\n" 463 ,DPCYL(partp->dp_scyl, partp->dp_ssect) 464 ,partp->dp_shd 465 ,DPSECT(partp->dp_ssect) 466 ,DPCYL(partp->dp_ecyl, partp->dp_esect) 467 ,partp->dp_ehd 468 ,DPSECT(partp->dp_esect)); 469 } 470 471 472 static void 473 init_boot(void) 474 { 475 #ifndef __ia64__ 476 const char *fname; 477 int fdesc, n; 478 struct stat sb; 479 480 fname = b_flag ? b_flag : "/boot/mbr"; 481 if ((fdesc = open(fname, O_RDONLY)) == -1 || 482 fstat(fdesc, &sb) == -1) 483 err(1, "%s", fname); 484 if ((mboot.bootinst_size = sb.st_size) % secsize != 0) 485 errx(1, "%s: length must be a multiple of sector size", fname); 486 if (mboot.bootinst != NULL) 487 free(mboot.bootinst); 488 if ((mboot.bootinst = malloc(mboot.bootinst_size = sb.st_size)) == NULL) 489 errx(1, "%s: unable to allocate read buffer", fname); 490 if ((n = read(fdesc, mboot.bootinst, mboot.bootinst_size)) == -1 || 491 close(fdesc)) 492 err(1, "%s", fname); 493 if (n != mboot.bootinst_size) 494 errx(1, "%s: short read", fname); 495 #else 496 if (mboot.bootinst != NULL) 497 free(mboot.bootinst); 498 mboot.bootinst_size = secsize; 499 if ((mboot.bootinst = malloc(mboot.bootinst_size)) == NULL) 500 errx(1, "unable to allocate boot block buffer"); 501 memset(mboot.bootinst, 0, mboot.bootinst_size); 502 *(uint16_t *)&mboot.bootinst[MBRSIGOFF] = BOOT_MAGIC; 503 #endif 504 } 505 506 507 static void 508 init_sector0(unsigned long start) 509 { 510 struct dos_partition *partp = (struct dos_partition *) (&mboot.parts[3]); 511 512 init_boot(); 513 514 partp->dp_typ = DOSPTYP_386BSD; 515 partp->dp_flag = ACTIVE; 516 start = ((start + dos_sectors - 1) / dos_sectors) * dos_sectors; 517 if(start == 0) 518 start = dos_sectors; 519 partp->dp_start = start; 520 partp->dp_size = (disksecs / dos_cylsecs) * dos_cylsecs - start; 521 522 dos(partp); 523 } 524 525 static void 526 change_part(int i) 527 { 528 struct dos_partition *partp = ((struct dos_partition *) &mboot.parts) + i - 1; 529 530 printf("The data for partition %d is:\n", i); 531 print_part(i); 532 533 if (u_flag && ok("Do you want to change it?")) { 534 int tmp; 535 536 if (i_flag) { 537 bzero((char *)partp, sizeof (struct dos_partition)); 538 if (i == 4) { 539 init_sector0(1); 540 printf("\nThe static data for the DOS partition 4 has been reinitialized to:\n"); 541 print_part(i); 542 } 543 } 544 545 do { 546 Decimal("sysid (165=FreeBSD)", partp->dp_typ, tmp); 547 Decimal("start", partp->dp_start, tmp); 548 Decimal("size", partp->dp_size, tmp); 549 if (!sanitize_partition(partp)) { 550 warnx("ERROR: failed to adjust; setting sysid to 0"); 551 partp->dp_typ = 0; 552 } 553 554 if (ok("Explicitly specify beg/end address ?")) 555 { 556 int tsec,tcyl,thd; 557 tcyl = DPCYL(partp->dp_scyl,partp->dp_ssect); 558 thd = partp->dp_shd; 559 tsec = DPSECT(partp->dp_ssect); 560 Decimal("beginning cylinder", tcyl, tmp); 561 Decimal("beginning head", thd, tmp); 562 Decimal("beginning sector", tsec, tmp); 563 partp->dp_scyl = DOSCYL(tcyl); 564 partp->dp_ssect = DOSSECT(tsec,tcyl); 565 partp->dp_shd = thd; 566 567 tcyl = DPCYL(partp->dp_ecyl,partp->dp_esect); 568 thd = partp->dp_ehd; 569 tsec = DPSECT(partp->dp_esect); 570 Decimal("ending cylinder", tcyl, tmp); 571 Decimal("ending head", thd, tmp); 572 Decimal("ending sector", tsec, tmp); 573 partp->dp_ecyl = DOSCYL(tcyl); 574 partp->dp_esect = DOSSECT(tsec,tcyl); 575 partp->dp_ehd = thd; 576 } else 577 dos(partp); 578 579 print_part(i); 580 } while (!ok("Are we happy with this entry?")); 581 } 582 } 583 584 static void 585 print_params() 586 { 587 printf("parameters extracted from in-core disklabel are:\n"); 588 printf("cylinders=%d heads=%d sectors/track=%d (%d blks/cyl)\n\n" 589 ,cyls,heads,sectors,cylsecs); 590 if((dos_sectors > 63) || (dos_cyls > 1023) || (dos_heads > 255)) 591 printf("Figures below won't work with BIOS for partitions not in cyl 1\n"); 592 printf("parameters to be used for BIOS calculations are:\n"); 593 printf("cylinders=%d heads=%d sectors/track=%d (%d blks/cyl)\n\n" 594 ,dos_cyls,dos_heads,dos_sectors,dos_cylsecs); 595 } 596 597 static void 598 change_active(int which) 599 { 600 struct dos_partition *partp = &mboot.parts[0]; 601 int active, i, new, tmp; 602 603 active = -1; 604 for (i = 0; i < NDOSPART; i++) { 605 if ((partp[i].dp_flag & ACTIVE) == 0) 606 continue; 607 printf("Partition %d is marked active\n", i + 1); 608 if (active == -1) 609 active = i + 1; 610 } 611 if (a_flag && which != -1) 612 active = which; 613 else if (active == -1) 614 active = 1; 615 616 if (!ok("Do you want to change the active partition?")) 617 return; 618 setactive: 619 do { 620 new = active; 621 Decimal("active partition", new, tmp); 622 if (new < 1 || new > 4) { 623 printf("Active partition number must be in range 1-4." 624 " Try again.\n"); 625 goto setactive; 626 } 627 active = new; 628 } while (!ok("Are you happy with this choice")); 629 for (i = 0; i < NDOSPART; i++) 630 partp[i].dp_flag = 0; 631 if (active > 0 && active <= NDOSPART) 632 partp[active-1].dp_flag = ACTIVE; 633 } 634 635 static void 636 change_code() 637 { 638 if (ok("Do you want to change the boot code?")) 639 init_boot(); 640 } 641 642 void 643 get_params_to_use() 644 { 645 int tmp; 646 print_params(); 647 if (ok("Do you want to change our idea of what BIOS thinks ?")) 648 { 649 do 650 { 651 Decimal("BIOS's idea of #cylinders", dos_cyls, tmp); 652 Decimal("BIOS's idea of #heads", dos_heads, tmp); 653 Decimal("BIOS's idea of #sectors", dos_sectors, tmp); 654 dos_cylsecs = dos_heads * dos_sectors; 655 print_params(); 656 } 657 while(!ok("Are you happy with this choice")); 658 } 659 } 660 661 662 /***********************************************\ 663 * Change real numbers into strange dos numbers * 664 \***********************************************/ 665 static void 666 dos(struct dos_partition *partp) 667 { 668 int cy, sec; 669 u_int32_t end; 670 671 if (partp->dp_typ == 0 && partp->dp_start == 0 && partp->dp_size == 0) { 672 memcpy(partp, &mtpart, sizeof(*partp)); 673 return; 674 } 675 676 /* Start c/h/s. */ 677 partp->dp_shd = partp->dp_start % dos_cylsecs / dos_sectors; 678 cy = partp->dp_start / dos_cylsecs; 679 sec = partp->dp_start % dos_sectors + 1; 680 partp->dp_scyl = DOSCYL(cy); 681 partp->dp_ssect = DOSSECT(sec, cy); 682 683 /* End c/h/s. */ 684 end = partp->dp_start + partp->dp_size - 1; 685 partp->dp_ehd = end % dos_cylsecs / dos_sectors; 686 cy = end / dos_cylsecs; 687 sec = end % dos_sectors + 1; 688 partp->dp_ecyl = DOSCYL(cy); 689 partp->dp_esect = DOSSECT(sec, cy); 690 } 691 692 static int 693 open_disk(int flag) 694 { 695 struct stat st; 696 697 if (stat(disk, &st) == -1) { 698 if (errno == ENOENT) 699 return -2; 700 warnx("can't get file status of %s", disk); 701 return -1; 702 } 703 if ( !(st.st_mode & S_IFCHR) ) 704 warnx("device %s is not character special", disk); 705 if ((fd = open(disk, 706 a_flag || I_flag || B_flag || flag ? O_RDWR : O_RDONLY)) == -1) { 707 if(errno == ENXIO) 708 return -2; 709 warnx("can't open device %s", disk); 710 return -1; 711 } 712 if (get_params() == -1) { 713 warnx("can't get disk parameters on %s", disk); 714 return -1; 715 } 716 return fd; 717 } 718 719 static ssize_t 720 read_disk(off_t sector, void *buf) 721 { 722 lseek(fd,(sector * 512), 0); 723 if( secsize == 0 ) 724 for( secsize = MIN_SEC_SIZE; secsize <= MAX_SEC_SIZE; secsize *= 2 ) 725 { 726 /* try the read */ 727 int size = read(fd, buf, secsize); 728 if( size == secsize ) 729 /* it worked so return */ 730 return secsize; 731 } 732 else 733 return read( fd, buf, secsize ); 734 735 /* we failed to read at any of the sizes */ 736 return -1; 737 } 738 739 static ssize_t 740 write_disk(off_t sector, void *buf) 741 { 742 lseek(fd,(sector * 512), 0); 743 /* write out in the size that the read_disk found worked */ 744 return write(fd, buf, secsize); 745 } 746 747 static int 748 get_params() 749 { 750 751 if (ioctl(fd, DIOCGDINFO, &disklabel) == -1) { 752 warnx("can't get disk parameters on %s; supplying dummy ones", disk); 753 dos_cyls = cyls = 1; 754 dos_heads = heads = 1; 755 dos_sectors = sectors = 1; 756 dos_cylsecs = cylsecs = heads * sectors; 757 disksecs = cyls * heads * sectors; 758 return disksecs; 759 } 760 761 dos_cyls = cyls = disklabel.d_ncylinders; 762 dos_heads = heads = disklabel.d_ntracks; 763 dos_sectors = sectors = disklabel.d_nsectors; 764 dos_cylsecs = cylsecs = heads * sectors; 765 disksecs = cyls * heads * sectors; 766 767 return (disksecs); 768 } 769 770 771 static int 772 read_s0() 773 { 774 mboot.bootinst_size = secsize; 775 if (mboot.bootinst != NULL) 776 free(mboot.bootinst); 777 if ((mboot.bootinst = malloc(mboot.bootinst_size)) == NULL) { 778 warnx("unable to allocate buffer to read fdisk " 779 "partition table"); 780 return -1; 781 } 782 if (read_disk(0, mboot.bootinst) == -1) { 783 warnx("can't read fdisk partition table"); 784 return -1; 785 } 786 if (*(uint16_t *)&mboot.bootinst[MBRSIGOFF] != BOOT_MAGIC) { 787 warnx("invalid fdisk partition table found"); 788 /* So should we initialize things */ 789 return -1; 790 } 791 memcpy(mboot.parts, &mboot.bootinst[DOSPARTOFF], sizeof(mboot.parts)); 792 return 0; 793 } 794 795 static int 796 write_s0() 797 { 798 int sector; 799 800 if (iotest) { 801 print_s0(-1); 802 return 0; 803 } 804 memcpy(&mboot.bootinst[DOSPARTOFF], mboot.parts, sizeof(mboot.parts)); 805 /* 806 * write enable label sector before write (if necessary), 807 * disable after writing. 808 * needed if the disklabel protected area also protects 809 * sector 0. (e.g. empty disk) 810 */ 811 for(sector = 0; sector < mboot.bootinst_size / secsize; sector++) 812 if (write_disk(sector, 813 &mboot.bootinst[sector * secsize]) == -1) { 814 warn("can't write fdisk partition table"); 815 return -1; 816 } 817 return(0); 818 } 819 820 821 static int 822 ok(const char *str) 823 { 824 printf("%s [n] ", str); 825 fflush(stdout); 826 if (fgets(lbuf, LBUF, stdin) == NULL) 827 exit(1); 828 lbuf[strlen(lbuf)-1] = 0; 829 830 if (*lbuf && 831 (!strcmp(lbuf, "yes") || !strcmp(lbuf, "YES") || 832 !strcmp(lbuf, "y") || !strcmp(lbuf, "Y"))) 833 return 1; 834 else 835 return 0; 836 } 837 838 static int 839 decimal(const char *str, int *num, int deflt) 840 { 841 int acc = 0, c; 842 char *cp; 843 844 while (1) { 845 printf("Supply a decimal value for \"%s\" [%d] ", str, deflt); 846 fflush(stdout); 847 if (fgets(lbuf, LBUF, stdin) == NULL) 848 exit(1); 849 lbuf[strlen(lbuf)-1] = 0; 850 851 if (!*lbuf) 852 return 0; 853 854 cp = lbuf; 855 while ((c = *cp) && (c == ' ' || c == '\t')) cp++; 856 if (!c) 857 return 0; 858 while ((c = *cp++)) { 859 if (c <= '9' && c >= '0') 860 acc = acc * 10 + c - '0'; 861 else 862 break; 863 } 864 if (c == ' ' || c == '\t') 865 while ((c = *cp) && (c == ' ' || c == '\t')) cp++; 866 if (!c) { 867 *num = acc; 868 return 1; 869 } else 870 printf("%s is an invalid decimal number. Try again.\n", 871 lbuf); 872 } 873 874 } 875 876 static const char * 877 get_type(int type) 878 { 879 int numentries = (sizeof(part_types)/sizeof(struct part_type)); 880 int counter = 0; 881 struct part_type *ptr = part_types; 882 883 884 while(counter < numentries) { 885 if(ptr->type == type) 886 return(ptr->name); 887 ptr++; 888 counter++; 889 } 890 return("unknown"); 891 } 892 893 894 static void 895 parse_config_line(char *line, CMD *command) 896 { 897 char *cp, *end; 898 899 cp = line; 900 while (1) { 901 memset(command, 0, sizeof(*command)); 902 903 while (isspace(*cp)) ++cp; 904 if (*cp == '\0' || *cp == '#') 905 break; 906 command->cmd = *cp++; 907 908 /* 909 * Parse args 910 */ 911 while (1) { 912 while (isspace(*cp)) ++cp; 913 if (*cp == '#') 914 break; /* found comment */ 915 if (isalpha(*cp)) 916 command->args[command->n_args].argtype = *cp++; 917 if (!isdigit(*cp)) 918 break; /* assume end of line */ 919 end = NULL; 920 command->args[command->n_args].arg_val = strtol(cp, &end, 0); 921 if (cp == end) 922 break; /* couldn't parse number */ 923 cp = end; 924 command->n_args++; 925 } 926 break; 927 } 928 } 929 930 931 static int 932 process_geometry(CMD *command) 933 { 934 int status = 1, i; 935 936 while (1) { 937 geom_processed = 1; 938 if (part_processed) { 939 warnx( 940 "ERROR line %d: the geometry specification line must occur before\n\ 941 all partition specifications", 942 current_line_number); 943 status = 0; 944 break; 945 } 946 if (command->n_args != 3) { 947 warnx("ERROR line %d: incorrect number of geometry args", 948 current_line_number); 949 status = 0; 950 break; 951 } 952 dos_cyls = 0; 953 dos_heads = 0; 954 dos_sectors = 0; 955 for (i = 0; i < 3; ++i) { 956 switch (command->args[i].argtype) { 957 case 'c': 958 dos_cyls = command->args[i].arg_val; 959 break; 960 case 'h': 961 dos_heads = command->args[i].arg_val; 962 break; 963 case 's': 964 dos_sectors = command->args[i].arg_val; 965 break; 966 default: 967 warnx( 968 "ERROR line %d: unknown geometry arg type: '%c' (0x%02x)", 969 current_line_number, command->args[i].argtype, 970 command->args[i].argtype); 971 status = 0; 972 break; 973 } 974 } 975 if (status == 0) 976 break; 977 978 dos_cylsecs = dos_heads * dos_sectors; 979 980 /* 981 * Do sanity checks on parameter values 982 */ 983 if (dos_cyls == 0) { 984 warnx("ERROR line %d: number of cylinders not specified", 985 current_line_number); 986 status = 0; 987 } 988 if (dos_cyls > 1024) { 989 warnx( 990 "WARNING line %d: number of cylinders (%d) may be out-of-range\n\ 991 (must be within 1-1024 for normal BIOS operation, unless the entire disk\n\ 992 is dedicated to FreeBSD)", 993 current_line_number, dos_cyls); 994 } 995 996 if (dos_heads == 0) { 997 warnx("ERROR line %d: number of heads not specified", 998 current_line_number); 999 status = 0; 1000 } else if (dos_heads > 256) { 1001 warnx("ERROR line %d: number of heads must be within (1-256)", 1002 current_line_number); 1003 status = 0; 1004 } 1005 1006 if (dos_sectors == 0) { 1007 warnx("ERROR line %d: number of sectors not specified", 1008 current_line_number); 1009 status = 0; 1010 } else if (dos_sectors > 63) { 1011 warnx("ERROR line %d: number of sectors must be within (1-63)", 1012 current_line_number); 1013 status = 0; 1014 } 1015 1016 break; 1017 } 1018 return (status); 1019 } 1020 1021 1022 static int 1023 process_partition(CMD *command) 1024 { 1025 int status = 0, partition; 1026 u_int32_t prev_head_boundary, prev_cyl_boundary; 1027 u_int32_t adj_size, max_end; 1028 struct dos_partition *partp; 1029 1030 while (1) { 1031 part_processed = 1; 1032 if (command->n_args != 4) { 1033 warnx("ERROR line %d: incorrect number of partition args", 1034 current_line_number); 1035 break; 1036 } 1037 partition = command->args[0].arg_val; 1038 if (partition < 1 || partition > 4) { 1039 warnx("ERROR line %d: invalid partition number %d", 1040 current_line_number, partition); 1041 break; 1042 } 1043 partp = ((struct dos_partition *) &mboot.parts) + partition - 1; 1044 bzero((char *)partp, sizeof (struct dos_partition)); 1045 partp->dp_typ = command->args[1].arg_val; 1046 partp->dp_start = command->args[2].arg_val; 1047 partp->dp_size = command->args[3].arg_val; 1048 max_end = partp->dp_start + partp->dp_size; 1049 1050 if (partp->dp_typ == 0) { 1051 /* 1052 * Get out, the partition is marked as unused. 1053 */ 1054 /* 1055 * Insure that it's unused. 1056 */ 1057 bzero((char *)partp, sizeof (struct dos_partition)); 1058 status = 1; 1059 break; 1060 } 1061 1062 /* 1063 * Adjust start upwards, if necessary, to fall on an head boundary. 1064 */ 1065 if (partp->dp_start % dos_sectors != 0) { 1066 prev_head_boundary = partp->dp_start / dos_sectors * dos_sectors; 1067 if (max_end < dos_sectors || 1068 prev_head_boundary > max_end - dos_sectors) { 1069 /* 1070 * Can't go past end of partition 1071 */ 1072 warnx( 1073 "ERROR line %d: unable to adjust start of partition %d to fall on\n\ 1074 a head boundary", 1075 current_line_number, partition); 1076 break; 1077 } 1078 warnx( 1079 "WARNING: adjusting start offset of partition %d\n\ 1080 from %u to %u, to fall on a head boundary", 1081 partition, (u_int)partp->dp_start, 1082 (u_int)(prev_head_boundary + dos_sectors)); 1083 partp->dp_start = prev_head_boundary + dos_sectors; 1084 } 1085 1086 /* 1087 * Adjust size downwards, if necessary, to fall on a cylinder 1088 * boundary. 1089 */ 1090 prev_cyl_boundary = 1091 ((partp->dp_start + partp->dp_size) / dos_cylsecs) * dos_cylsecs; 1092 if (prev_cyl_boundary > partp->dp_start) 1093 adj_size = prev_cyl_boundary - partp->dp_start; 1094 else { 1095 warnx( 1096 "ERROR: could not adjust partition to start on a head boundary\n\ 1097 and end on a cylinder boundary."); 1098 return (0); 1099 } 1100 if (adj_size != partp->dp_size) { 1101 warnx( 1102 "WARNING: adjusting size of partition %d from %u to %u\n\ 1103 to end on a cylinder boundary", 1104 partition, (u_int)partp->dp_size, (u_int)adj_size); 1105 partp->dp_size = adj_size; 1106 } 1107 if (partp->dp_size == 0) { 1108 warnx("ERROR line %d: size of partition %d is zero", 1109 current_line_number, partition); 1110 break; 1111 } 1112 1113 dos(partp); 1114 status = 1; 1115 break; 1116 } 1117 return (status); 1118 } 1119 1120 1121 static int 1122 process_active(CMD *command) 1123 { 1124 int status = 0, partition, i; 1125 struct dos_partition *partp; 1126 1127 while (1) { 1128 active_processed = 1; 1129 if (command->n_args != 1) { 1130 warnx("ERROR line %d: incorrect number of active args", 1131 current_line_number); 1132 status = 0; 1133 break; 1134 } 1135 partition = command->args[0].arg_val; 1136 if (partition < 1 || partition > 4) { 1137 warnx("ERROR line %d: invalid partition number %d", 1138 current_line_number, partition); 1139 break; 1140 } 1141 /* 1142 * Reset active partition 1143 */ 1144 partp = ((struct dos_partition *) &mboot.parts); 1145 for (i = 0; i < NDOSPART; i++) 1146 partp[i].dp_flag = 0; 1147 partp[partition-1].dp_flag = ACTIVE; 1148 1149 status = 1; 1150 break; 1151 } 1152 return (status); 1153 } 1154 1155 1156 static int 1157 process_line(char *line) 1158 { 1159 CMD command; 1160 int status = 1; 1161 1162 while (1) { 1163 parse_config_line(line, &command); 1164 switch (command.cmd) { 1165 case 0: 1166 /* 1167 * Comment or blank line 1168 */ 1169 break; 1170 case 'g': 1171 /* 1172 * Set geometry 1173 */ 1174 status = process_geometry(&command); 1175 break; 1176 case 'p': 1177 status = process_partition(&command); 1178 break; 1179 case 'a': 1180 status = process_active(&command); 1181 break; 1182 default: 1183 status = 0; 1184 break; 1185 } 1186 break; 1187 } 1188 return (status); 1189 } 1190 1191 1192 static int 1193 read_config(char *config_file) 1194 { 1195 FILE *fp = NULL; 1196 int status = 1; 1197 char buf[1010]; 1198 1199 while (1) { 1200 if (strcmp(config_file, "-") != 0) { 1201 /* 1202 * We're not reading from stdin 1203 */ 1204 if ((fp = fopen(config_file, "r")) == NULL) { 1205 status = 0; 1206 break; 1207 } 1208 } else { 1209 fp = stdin; 1210 } 1211 current_line_number = 0; 1212 while (!feof(fp)) { 1213 if (fgets(buf, sizeof(buf), fp) == NULL) 1214 break; 1215 ++current_line_number; 1216 status = process_line(buf); 1217 if (status == 0) 1218 break; 1219 } 1220 break; 1221 } 1222 if (fp) { 1223 /* 1224 * It doesn't matter if we're reading from stdin, as we've reached EOF 1225 */ 1226 fclose(fp); 1227 } 1228 return (status); 1229 } 1230 1231 1232 static void 1233 reset_boot(void) 1234 { 1235 int i; 1236 struct dos_partition *partp; 1237 1238 init_boot(); 1239 for (i = 0; i < 4; ++i) { 1240 partp = ((struct dos_partition *) &mboot.parts) + i; 1241 bzero((char *)partp, sizeof (struct dos_partition)); 1242 } 1243 } 1244 1245 static int 1246 sanitize_partition(struct dos_partition *partp) 1247 { 1248 u_int32_t prev_head_boundary, prev_cyl_boundary; 1249 u_int32_t max_end, size, start; 1250 1251 start = partp->dp_start; 1252 size = partp->dp_size; 1253 max_end = start + size; 1254 /* Only allow a zero size if the partition is being marked unused. */ 1255 if (size == 0) { 1256 if (start == 0 && partp->dp_typ == 0) 1257 return (1); 1258 warnx("ERROR: size of partition is zero"); 1259 return (0); 1260 } 1261 /* Return if no adjustment is necessary. */ 1262 if (start % dos_sectors == 0 && (start + size) % dos_sectors == 0) 1263 return (1); 1264 1265 if (start % dos_sectors != 0) 1266 warnx("WARNING: partition does not start on a head boundary"); 1267 if ((start +size) % dos_sectors != 0) 1268 warnx("WARNING: partition does not end on a cylinder boundary"); 1269 warnx("WARNING: this may confuse the BIOS or some operating systems"); 1270 if (!ok("Correct this automatically?")) 1271 return (1); 1272 1273 /* 1274 * Adjust start upwards, if necessary, to fall on an head boundary. 1275 */ 1276 if (start % dos_sectors != 0) { 1277 prev_head_boundary = start / dos_sectors * dos_sectors; 1278 if (max_end < dos_sectors || 1279 prev_head_boundary >= max_end - dos_sectors) { 1280 /* 1281 * Can't go past end of partition 1282 */ 1283 warnx( 1284 "ERROR: unable to adjust start of partition to fall on a head boundary"); 1285 return (0); 1286 } 1287 start = prev_head_boundary + dos_sectors; 1288 } 1289 1290 /* 1291 * Adjust size downwards, if necessary, to fall on a cylinder 1292 * boundary. 1293 */ 1294 prev_cyl_boundary = ((start + size) / dos_cylsecs) * dos_cylsecs; 1295 if (prev_cyl_boundary > start) 1296 size = prev_cyl_boundary - start; 1297 else { 1298 warnx("ERROR: could not adjust partition to start on a head boundary\n\ 1299 and end on a cylinder boundary."); 1300 return (0); 1301 } 1302 1303 /* Finally, commit any changes to partp and return. */ 1304 if (start != partp->dp_start) { 1305 warnx("WARNING: adjusting start offset of partition to %u", 1306 (u_int)start); 1307 partp->dp_start = start; 1308 } 1309 if (size != partp->dp_size) { 1310 warnx("WARNING: adjusting size of partition to %u", (u_int)size); 1311 partp->dp_size = size; 1312 } 1313 1314 return (1); 1315 } 1316 1317 /* 1318 * Try figuring out the root device's canonical disk name. 1319 * The following choices are considered: 1320 * /dev/ad0s1a => /dev/ad0 1321 * /dev/da0a => /dev/da0 1322 * /dev/vinum/root => /dev/vinum/root 1323 */ 1324 static char * 1325 get_rootdisk(void) 1326 { 1327 struct statfs rootfs; 1328 regex_t re; 1329 #define NMATCHES 2 1330 regmatch_t rm[NMATCHES]; 1331 char *s; 1332 int rv; 1333 1334 if (statfs("/", &rootfs) == -1) 1335 err(1, "statfs(\"/\")"); 1336 1337 if ((rv = regcomp(&re, "^(/dev/.*)(\\d+(s\\d+)?[a-h])?$", 1338 REG_EXTENDED)) != 0) 1339 errx(1, "regcomp() failed (%d)", rv); 1340 if ((rv = regexec(&re, rootfs.f_mntfromname, NMATCHES, rm, 0)) != 0) 1341 errx(1, 1342 "mounted root fs resource doesn't match expectations (regexec returned %d)", 1343 rv); 1344 if ((s = malloc(rm[1].rm_eo - rm[1].rm_so + 1)) == NULL) 1345 errx(1, "out of memory"); 1346 memcpy(s, rootfs.f_mntfromname + rm[1].rm_so, 1347 rm[1].rm_eo - rm[1].rm_so); 1348 s[rm[1].rm_eo - rm[1].rm_so] = 0; 1349 1350 return s; 1351 } 1352