fdisk.c revision 1.159 1 /* $NetBSD: fdisk.c,v 1.159 2020/05/24 21:02:12 wiz Exp $ */
2
3 /*
4 * Mach Operating System
5 * Copyright (c) 1992 Carnegie Mellon University
6 * All Rights Reserved.
7 *
8 * Permission to use, copy, modify and distribute this software and its
9 * documentation is hereby granted, provided that both the copyright
10 * notice and this permission notice appear in all copies of the
11 * software, derivative works or modified versions, and any portions
12 * thereof, and that both notices appear in supporting documentation.
13 *
14 * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
15 * CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR
16 * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
17 *
18 * Carnegie Mellon requests users of this software to return to
19 *
20 * Software Distribution Coordinator or Software.Distribution (at) CS.CMU.EDU
21 * School of Computer Science
22 * Carnegie Mellon University
23 * Pittsburgh PA 15213-3890
24 *
25 * any improvements or extensions that they make and grant Carnegie Mellon
26 * the rights to redistribute these changes.
27 */
28
29 /*
30 * 14-Dec-89 Robert Baron (rvb) at Carnegie-Mellon University
31 * Copyright (c) 1989 Robert. V. Baron
32 * Created.
33 */
34
35 #if HAVE_NBTOOL_CONFIG_H
36 #include "nbtool_config.h"
37 #endif
38
39 #include <sys/cdefs.h>
40
41 #ifndef lint
42 __RCSID("$NetBSD: fdisk.c,v 1.159 2020/05/24 21:02:12 wiz Exp $");
43 #endif /* not lint */
44
45 #define MBRPTYPENAMES
46 #include <sys/types.h>
47 #include <sys/param.h>
48 #include <sys/stat.h>
49 #include <ctype.h>
50 #include <err.h>
51 #include <errno.h>
52 #include <fcntl.h>
53 #include <paths.h>
54 #include <stdarg.h>
55 #include <stddef.h>
56 #include <stdio.h>
57 #include <stdlib.h>
58 #include <string.h>
59 #include <unistd.h>
60 #include <vis.h>
61 #include <zlib.h>
62
63 #if !HAVE_NBTOOL_CONFIG_H
64 #include <sys/disklabel.h>
65 #include <sys/disklabel_gpt.h>
66 #include <sys/bootblock.h>
67 #include <sys/ioctl.h>
68 #include <sys/sysctl.h>
69 #include <disktab.h>
70 #include <util.h>
71 #else
72 #include <nbinclude/sys/disklabel.h>
73 #include <nbinclude/sys/disklabel_gpt.h>
74 #include <nbinclude/sys/bootblock.h>
75 #include "../../include/disktab.h"
76 /* We enforce -F, so none of these possibly undefined items can be needed */
77 #define opendisk(path, fl, buf, buflen, cooked) (-1)
78 #endif /* HAVE_NBTOOL_CONFIG_H */
79
80 #ifndef DEFAULT_BOOTDIR
81 #define DEFAULT_BOOTDIR "/usr/mdec"
82 #endif
83
84 #define LE_MBR_MAGIC htole16(MBR_MAGIC)
85 #define LE_MBR_BS_MAGIC htole16(MBR_BS_MAGIC)
86
87 #ifdef BOOTSEL
88
89 #define DEFAULT_BOOTCODE "mbr"
90 #define DEFAULT_BOOTSELCODE "mbr_bootsel"
91 #define DEFAULT_BOOTEXTCODE "mbr_ext"
92
93 /* Scan values for the various keys we use, as returned by the BIOS */
94 #define SCAN_ENTER 0x1c
95 #define SCAN_F1 0x3b
96 #define SCAN_1 0x2
97
98
99 #define MAX_BIOS_DISKS 16 /* Going beyond F12 is hard though! */
100
101 /* We same the dflt 'boot partition' as a disk block, with some magic values. */
102 #define DEFAULT_ACTIVE (~(daddr_t)0)
103 #define DEFAULT_DISK(n) (DEFAULT_ACTIVE - MAX_BIOS_DISKS + (n))
104
105 #endif
106
107 #define GPT_TYPE(offs) ((offs) == GPT_HDR_BLKNO ? "primary" : "secondary")
108
109 #ifndef PRIdaddr
110 #define PRIdaddr PRId64
111 #endif
112
113 #ifndef _PATH_DEFDISK
114 #define _PATH_DEFDISK "/dev/rwd0d"
115 #endif
116
117 struct {
118 struct mbr_sector *ptn; /* array of pbrs */
119 daddr_t base; /* first sector of ext. ptn */
120 daddr_t limit; /* last sector of ext. ptn */
121 int num_ptn; /* number of contained partitions */
122 int ptn_id; /* entry in mbr */
123 int is_corrupt; /* 1 if extended chain illegal */
124 } ext;
125
126 #define LBUF 100
127 static char lbuf[LBUF];
128
129 static const char *disk = _PATH_DEFDISK;
130
131 static struct disklabel disklabel; /* disk parameters */
132
133 static struct mbr_sector mboot;
134
135 static const char *boot_dir = DEFAULT_BOOTDIR;
136 static char *boot_path = NULL; /* name of file we actually opened */
137
138 #ifdef BOOTSEL
139 #define BOOTSEL_OPTIONS "B"
140 #else
141 #define BOOTSEL_OPTIONS
142 #define change_part(e, p, id, st, sz, bm) change__part(e, p, id, st, sz)
143 #endif
144 #define OPTIONS BOOTSEL_OPTIONS "0123FSafgiIluvA:b:c:E:r:s:w:z:"
145
146 /*
147 * Disk geometry and partition alignment.
148 *
149 * Modern disks do not have a fixed geomery and will always give a 'faked'
150 * geometry that matches the ATA standard - max 16 heads and 256 sec/track.
151 * The ATA geometry allows access to 2^28 sectors (as does LBA mode).
152 *
153 * The BIOS calls originally used an 8bit register for cylinder, head and
154 * sector. Later 2 bits were stolen from the sector number and added to
155 * cylinder number. The BIOS will translate this faked geometry either to
156 * the geometry reported by the disk, or do LBA reads (possibly LBA48).
157 * BIOS CHS reads have all sorts of limits, but 2^24 is absolute.
158 * For historic reasons the BIOS geometry is the called the dos geometry!
159 *
160 * If you know the disks real geometry it is usually worth aligning
161 * disk partitions to cylinder boundaries (certainly traditional!).
162 * For 'mbr' disks this has always been done with the BIOS geometry.
163 * The first track (typically 63 sectors) is reserved because the first
164 * sector is used for boot code. Similarly the data partition in an
165 * extended partition will start one track in. If an extended partition
166 * starts at the beginning of the disk you lose 2 tracks.
167 *
168 * However non-magnetic media in particular has physical sectors that are
169 * not the same size as those reported, so has to do read modify write
170 * sequences for misaligned transfers. The alignment of partitions to
171 * cylinder boundaries makes this happen all the time.
172 *
173 * It is thus sensible to align partitions on a sensible sector boundary.
174 * For instance 1MB (2048 sectors).
175 * Common code can do this by using a geometry with 1 head and 2048
176 * sectors per track.
177 */
178
179 /* Disks reported geometry and overall size from device driver */
180 static unsigned int cylinders, sectors, heads;
181 static daddr_t disksectors;
182 #define cylindersectors (heads * sectors)
183
184 /* Geometry from the BIOS */
185 static unsigned int dos_cylinders;
186 static unsigned int dos_heads;
187 static unsigned int dos_sectors;
188 static daddr_t dos_disksectors;
189 #define dos_cylindersectors (dos_heads * dos_sectors)
190 #define dos_totalsectors (dos_heads * dos_sectors * dos_cylinders)
191
192 #define DOSSECT(s,c) (((s) & 0x3f) | (((c) >> 2) & 0xc0))
193 #define DOSCYL(c) ((c) & 0xff)
194 #define SEC_IN_1M (1024 * 1024 / secsize)
195 #define SEC_TO_MB(sec) ((unsigned int)(((sec) + SEC_IN_1M / 2) / SEC_IN_1M))
196 #define SEC_TO_CYL(sec) (((sec) + dos_cylindersectors/2) / dos_cylindersectors)
197
198 #define MAXCYL 1024 /* Usual limit is 1023 */
199 #define MAXHEAD 256 /* Usual limit is 255 */
200 #define MAXSECTOR 63
201 static int partition = -1;
202
203 /* Alignment of partition, and offset if first sector unusable */
204 static unsigned int ptn_alignment; /* default dos_cylindersectors */
205 static unsigned int ptn_0_offset; /* default dos_sectors */
206
207 static int fd = -1, wfd = -1, *rfd = &fd;
208 static char *disk_file = NULL;
209 static char *disk_type = NULL;
210
211 static int a_flag; /* set active partition */
212 static int i_flag; /* init bootcode */
213 static int I_flag; /* ignore errors */
214 static int u_flag; /* update partition data */
215 static int v_flag; /* more verbose */
216 static int sh_flag; /* Output data as shell defines */
217 static int f_flag; /* force --not interactive */
218 static int g_flag; /* preserve GPT headers */
219 static int s_flag; /* set id,offset,size */
220 static int b_flag; /* Set cyl, heads, secs (as c/h/s) */
221 static int B_flag; /* Edit/install bootselect code */
222 static int E_flag; /* extended partition number */
223 static int b_cyl, b_head, b_sec; /* b_flag values. */
224
225 #if !HAVE_NBTOOL_CONFIG_H
226 static int F_flag = 0;
227 #else
228 /* Tool - force 'file' mode to avoid unsupported functions and ioctls */
229 static int F_flag = 1;
230 #endif
231
232 static struct gpt_hdr gpt1, gpt2; /* GUID partition tables */
233
234 static struct mbr_sector bootcode[8192 / sizeof (struct mbr_sector)];
235 static ssize_t secsize = 512; /* sector size */
236 static char *iobuf; /* buffer for non 512 sector I/O */
237 static int bootsize; /* actual size of bootcode */
238 static int boot_installed; /* 1 if we've copied code into the mbr */
239
240 #if defined(USE_DISKLIST)
241 #include <machine/cpu.h>
242 static struct disklist *dl;
243 #endif
244
245
246 #define KNOWN_SYSIDS (sizeof(mbr_ptypes)/sizeof(mbr_ptypes[0]))
247
248 __dead static void usage(void);
249 static void print_s0(int);
250 static void print_part(struct mbr_sector *, int, daddr_t);
251 static void print_mbr_partition(struct mbr_sector *, int, daddr_t, daddr_t, int);
252 static void print_pbr(daddr_t, int, uint8_t);
253 static int is_all_zero(const unsigned char *, size_t);
254 static void printvis(int, const char *, const char *, size_t);
255 static int read_boot(const char *, void *, size_t, int);
256 static void init_sector0(int);
257 static void intuit_translated_geometry(void);
258 static void get_bios_geometry(void);
259 static void get_extended_ptn(void);
260 static void get_ptn_alignmemt(void);
261 #if defined(USE_DISKLIST)
262 static void get_diskname(const char *, char *, size_t);
263 #endif
264 static int change_part(int, int, int, daddr_t, daddr_t, char *);
265 static void print_geometry(void);
266 static int first_active(void);
267 static void change_active(int);
268 static void change_bios_geometry(void);
269 static void dos(int, unsigned char *, unsigned char *, unsigned char *);
270 static int open_disk(int);
271 static ssize_t read_disk(daddr_t, void *);
272 static ssize_t write_disk(daddr_t, void *);
273 static int get_params(void);
274 static int read_s0(daddr_t, struct mbr_sector *);
275 static int write_mbr(void);
276 static int read_gpt(daddr_t, struct gpt_hdr *);
277 static int delete_gpt(struct gpt_hdr *);
278 static int yesno(const char *, ...) __printflike(1, 2);
279 static int64_t decimal(const char *, int64_t, int, int64_t, int64_t);
280 #define DEC_SEC 1 /* asking for a sector number */
281 #define DEC_RND 2 /* round to end of first track */
282 #define DEC_RND_0 4 /* convert 0 to size of a track */
283 #define DEC_RND_DOWN 8 /* subtract 1 track */
284 #define DEC_RND_DOWN_2 16 /* subtract 2 tracks */
285 static int ptn_id(const char *, int *);
286 static int type_match(const void *, const void *);
287 static const char *get_type(int);
288 static int get_mapping(int, unsigned int *, unsigned int *, unsigned int *, unsigned long *);
289 #ifdef BOOTSEL
290 static daddr_t configure_bootsel(daddr_t);
291 static void install_bootsel(int);
292 static daddr_t get_default_boot(void);
293 static void set_default_boot(daddr_t);
294 static void string(const char *, int, char *);
295 #endif
296
297 static void
298 initvar_disk(const char **diskp)
299 {
300 #if !HAVE_NBTOOL_CONFIG_H
301 int mib[2];
302 size_t len;
303 char *root_device;
304
305 mib[0] = CTL_KERN;
306 mib[1] = KERN_ROOT_DEVICE;
307 if (sysctl(mib, 2, NULL, &len, NULL, 0) == -1 ||
308 (root_device = malloc(len)) == NULL ||
309 sysctl(mib, 2, root_device, &len, NULL, 0) == -1)
310 return;
311
312 *diskp = root_device;
313 #endif /* HAVE_NBTOOL_CONFIG_H */
314 }
315
316 static int
317 getnum(const char *str, int *num)
318 {
319 char *e;
320 long l;
321
322 errno = 0;
323 l = strtol(str, &e, 0);
324 if (str[0] == '\0' || *e != '\0')
325 return -1;
326 if (errno == ERANGE && (l == LONG_MAX || l == LONG_MIN))
327 return -1;
328 /* XXX: truncation */
329 *num = (int)l;
330 return 0;
331 }
332
333 /* [<sysid>][/[<start>][/[<size>][/[<bootmenu>]]]] */
334 static int
335 parse_s(char *arg, int *csysid, unsigned *cstart, unsigned *csize,
336 char **cbootmenu)
337 {
338 char *ptr;
339 int num;
340
341 if ((ptr = strchr(arg, '/')) != NULL)
342 *ptr++ = '\0';
343
344 if (*arg) {
345 if (getnum(arg, &num) == -1)
346 return -1;
347 *csysid = num;
348 }
349 if (ptr == NULL)
350 return 0;
351
352 arg = ptr;
353 if ((ptr = strchr(arg, '/')) != NULL)
354 *ptr++ = '\0';
355 if (*arg) {
356 if (getnum(arg, &num) == -1)
357 return -1;
358 *cstart = num;
359 }
360 if (ptr == NULL)
361 return 0;
362
363 arg = ptr;
364 if ((ptr = strchr(arg, '/')) != NULL)
365 *ptr++ = '\0';
366 if (*arg) {
367 if (getnum(arg, &num) == -1)
368 return -1;
369 *csize = num;
370 }
371 if (ptr != NULL && *ptr)
372 *cbootmenu = ptr;
373 return 0;
374 }
375
376 int
377 main(int argc, char *argv[])
378 {
379 struct stat sb;
380 int ch;
381 size_t len;
382 char *cp;
383 int n;
384 #ifdef BOOTSEL
385 daddr_t default_ptn; /* start sector of default ptn */
386 #endif
387 char *cbootmenu = 0;
388
389 int csysid; /* For the s_flag. */
390 unsigned int cstart, csize;
391 a_flag = u_flag = sh_flag = f_flag = s_flag = b_flag = 0;
392 i_flag = B_flag = 0;
393 v_flag = 0;
394 E_flag = 0;
395 csysid = -1;
396 cstart = csize = ~0;
397 while ((ch = getopt(argc, argv, OPTIONS)) != -1) {
398 switch (ch) {
399 case '0':
400 partition = 0;
401 break;
402 case '1':
403 partition = 1;
404 break;
405 case '2':
406 partition = 2;
407 break;
408 case '3':
409 partition = 3;
410 break;
411 case 'E': /* Extended partition number */
412 E_flag = 1;
413 partition = strtoul(optarg, &cp, 0);
414 if (*cp || partition < 0)
415 errx(1, "Bad partition number -E %s.", optarg);
416 break;
417 #ifdef BOOTSEL
418 case 'B': /* Bootselect parameters */
419 B_flag = 1;
420 break;
421 #endif
422 case 'F': /* device argument is really a file */
423 F_flag = 1;
424 break;
425 case 'S': /* Output as shell variables */
426 sh_flag = 1;
427 break;
428 case 'a': /* Set active partition */
429 a_flag = 1;
430 break;
431 case 'f': /* Non interactive */
432 f_flag = 1;
433 break;
434 case 'g': /* Preserve GPT headers */
435 g_flag = 1;
436 break;
437 case 'i': /* Always update bootcode */
438 i_flag = 1;
439 break;
440 case 'I': /* Ignore errors */
441 I_flag = 1;
442 break;
443 case 'l': /* List known partition types */
444 for (len = 0; len < KNOWN_SYSIDS; len++)
445 printf("%03d %s\n", mbr_ptypes[len].id,
446 mbr_ptypes[len].name);
447 return 0;
448 case 'u': /* Update partition details */
449 u_flag = 1;
450 break;
451 case 'v': /* Be verbose */
452 v_flag++;
453 break;
454 case 's': /* Partition details */
455 s_flag = 1;
456
457 if (parse_s(optarg, &csysid, &cstart, &csize,
458 &cbootmenu) == -1)
459 errx(1, "Bad argument to the -s flag.");
460 break;
461 case 'b': /* BIOS geometry */
462 b_flag = 1;
463 if (sscanf(optarg, "%d/%d/%d%n", &b_cyl, &b_head,
464 &b_sec, &n) != 3 || optarg[n] != 0)
465 errx(1, "Bad argument to the -b flag.");
466 if (b_cyl > MAXCYL)
467 b_cyl = MAXCYL;
468 break;
469 case 'A': /* Partition alignment[/offset] */
470 if (sscanf(optarg, "%u%n/%u%n", &ptn_alignment,
471 &n, &ptn_0_offset, &n) < 1
472 || optarg[n] != 0
473 || ptn_0_offset > ptn_alignment)
474 errx(1, "Bad argument to the -A flag.");
475 if (ptn_0_offset == 0)
476 ptn_0_offset = ptn_alignment;
477 break;
478 case 'c': /* file/directory containing boot code */
479 if (strchr(optarg, '/') != NULL &&
480 stat(optarg, &sb) == 0 &&
481 (sb.st_mode & S_IFMT) == S_IFDIR) {
482 boot_dir = optarg;
483 break;
484 }
485 bootsize = read_boot(optarg, bootcode,
486 sizeof bootcode, 1);
487 i_flag = 1;
488 break;
489 case 'r': /* read data from disk_file (not raw disk) */
490 rfd = &wfd;
491 /* FALLTHROUGH */
492 case 'w': /* write data to disk_file */
493 disk_file = optarg;
494 break;
495 case 't':
496 if (setdisktab(optarg) == -1)
497 errx(EXIT_FAILURE, "bad disktab");
498 break;
499 case 'T':
500 disk_type = optarg;
501 break;
502 case 'z':
503 secsize = atoi(optarg);
504 if (secsize <= 512)
505 out: errx(EXIT_FAILURE, "Invalid sector size %zd",
506 secsize);
507 for (ch = secsize; (ch & 1) == 0; ch >>= 1)
508 continue;
509 if (ch != 1)
510 goto out;
511 break;
512 default:
513 usage();
514 }
515 }
516 argc -= optind;
517 argv += optind;
518
519 if (disk_type != NULL && getdiskbyname(disk_type) == NULL)
520 errx(EXIT_FAILURE, "bad disktype");
521
522 if (sh_flag && (a_flag || i_flag || u_flag || f_flag || s_flag))
523 usage();
524
525 if (B_flag && f_flag) {
526 warnx("Bootselector may only be configured interactively");
527 usage();
528 }
529
530 if (f_flag && u_flag && !s_flag) {
531 warnx("Partition data not specified");
532 usage();
533 }
534
535 if (s_flag && partition == -1) {
536 warnx("-s flag requires a partition selected.");
537 usage();
538 }
539
540 if (argc > 1)
541 usage();
542
543 if (argc > 0)
544 disk = argv[0];
545 else if (!F_flag) {
546 /* Default to boot device */
547 initvar_disk(&disk);
548 }
549
550 if (!F_flag && stat(disk, &sb) == 0 && S_ISREG(sb.st_mode))
551 F_flag = 1;
552
553 if (open_disk(B_flag || a_flag || i_flag || u_flag) < 0)
554 exit(1);
555
556 if (secsize > 512) {
557 if ((iobuf = malloc(secsize)) == NULL)
558 err(EXIT_FAILURE, "Cannot allocate %zd buffer",
559 secsize);
560 }
561
562 if (read_s0(0, &mboot))
563 /* must have been a blank disk */
564 init_sector0(1);
565
566 read_gpt(GPT_HDR_BLKNO, &gpt1);
567 read_gpt(disksectors - 1, &gpt2);
568
569 if (b_flag) {
570 dos_cylinders = b_cyl;
571 dos_heads = b_head;
572 dos_sectors = b_sec;
573 } else {
574 get_bios_geometry();
575 }
576
577 if (ptn_alignment == 0)
578 get_ptn_alignmemt();
579
580 get_extended_ptn();
581
582 #ifdef BOOTSEL
583 default_ptn = get_default_boot();
584 #endif
585
586 if (E_flag && !u_flag && partition >= ext.num_ptn)
587 errx(1, "Extended partition %d is not defined.", partition);
588
589 /* Do the update stuff! */
590 if (u_flag) {
591 if (!f_flag && !b_flag)
592 change_bios_geometry();
593
594 if (s_flag)
595 change_part(E_flag, partition, csysid, cstart, csize,
596 cbootmenu);
597 else {
598 int part = partition, chg_ext = E_flag, prompt = 1;
599 do {
600 if (prompt) {
601 printf("\n");
602 print_s0(partition);
603 }
604 if (partition == -1)
605 part = ptn_id(
606 "Which partition do you want to change?",
607 &chg_ext);
608 if (part < 0)
609 break;
610 prompt = change_part(chg_ext, part, 0, 0, 0, 0);
611 } while (partition == -1);
612 }
613 } else {
614 if (!i_flag && !B_flag) {
615 print_geometry();
616 print_s0(partition);
617 }
618 }
619
620 if (a_flag && !E_flag)
621 change_active(partition);
622
623 #ifdef BOOTSEL
624 if (B_flag || u_flag || i_flag)
625 /* Ensure the mbr code supports this configuration */
626 install_bootsel(0);
627 if (B_flag)
628 default_ptn = configure_bootsel(default_ptn);
629 set_default_boot(default_ptn);
630 #else
631 if (i_flag)
632 init_sector0(0);
633 #endif
634
635 if (u_flag || a_flag || i_flag || B_flag) {
636 if (!f_flag) {
637 printf("\nWe haven't written the MBR back to disk "
638 "yet. This is your last chance.\n");
639 if (u_flag)
640 print_s0(-1);
641 if (gpt1.hdr_size != 0 || gpt2.hdr_size != 0)
642 printf("\nWARNING: The disk is carrying "
643 "GUID Partition Tables.\n"
644 " If you continue, "
645 "GPT headers will be deleted.\n\n");
646 if (yesno("Should we write new partition table?")) {
647 delete_gpt(&gpt1);
648 delete_gpt(&gpt2);
649 write_mbr();
650 }
651 } else {
652 if (delete_gpt(&gpt1) > 0)
653 warnx("Primary GPT header was deleted");
654 if (delete_gpt(&gpt2) > 0)
655 warnx("Secondary GPT header was deleted");
656 write_mbr();
657 }
658 }
659
660 exit(0);
661 }
662
663 static void
664 usage(void)
665 {
666 int indent = 7 + (int)strlen(getprogname()) + 1;
667
668 (void)fprintf(stderr, "usage: %s [-aBFfgIilSuv] "
669 "[-A ptn_alignment[/ptn_0_offset]] \\\n"
670 "%*s[-b cylinders/heads/sectors] \\\n"
671 "%*s[-0123 | -E num "
672 "[-s [id][/[start][/[size][/bootmenu]]]] \\\n"
673 "%*s[-t disktab] [-T disktype] \\\n"
674 "%*s[-c bootcode] "
675 "[-r|-w file] [-z sectorsize] [device]\n"
676 "\t-a change active partition\n"
677 "\t-f force - not interactive\n"
678 "\t-g preserve existing GPT headers\n"
679 "\t-i initialise MBR code\n"
680 "\t-I ignore errors about no space or overlapping partitions\n"
681 "\t-l list partition types\n"
682 "\t-u update partition data\n"
683 "\t-v verbose output, -v -v more verbose still\n"
684 "\t-B update bootselect options\n"
685 "\t-F treat device as a regular file\n"
686 "\t-S output as shell defines\n"
687 "\t-r and -w access 'file' for non-destructive testing\n",
688 getprogname(), indent, "", indent, "", indent, "", indent, "");
689 exit(1);
690 }
691
692 static daddr_t
693 ext_offset(int part)
694 {
695 daddr_t offset = ext.base;
696
697 if (part != 0)
698 offset += le32toh(ext.ptn[part - 1].mbr_parts[1].mbrp_start);
699 return offset;
700 }
701
702 static void
703 print_s0(int which)
704 {
705 int part;
706
707 if (which == -1) {
708 if (!sh_flag)
709 printf("Partition table:\n");
710 for (part = 0; part < MBR_PART_COUNT; part++) {
711 if (!sh_flag)
712 printf("%d: ", part);
713 print_part(&mboot, part, 0);
714 }
715 if (!sh_flag) {
716 if (ext.is_corrupt)
717 printf("Extended partition table is corrupt\n");
718 else
719 if (ext.num_ptn != 0)
720 printf("Extended partition table:\n");
721 }
722 for (part = 0; part < ext.num_ptn; part++) {
723 if (!sh_flag)
724 printf("E%d: ", part);
725 print_part(&ext.ptn[part], 0, ext_offset(part));
726 if (!sh_flag && v_flag >= 2) {
727 printf("link: ");
728 print_mbr_partition(&ext.ptn[part], 1,
729 ext_offset(part), ext.base, 0);
730 }
731 }
732 #ifdef BOOTSEL
733 if (!sh_flag && mboot.mbr_bootsel_magic == LE_MBR_BS_MAGIC) {
734 int tmo;
735
736 printf("Bootselector ");
737 if (mboot.mbr_bootsel.mbrbs_flags & MBR_BS_ACTIVE) {
738 printf("enabled");
739 tmo = le16toh(mboot.mbr_bootsel.mbrbs_timeo);
740 if (tmo == 0xffff)
741 printf(", infinite timeout");
742 else
743 printf(", timeout %d seconds",
744 (10 * tmo + 9) / 182);
745 } else
746 printf("disabled");
747 printf(".\n");
748 }
749 #endif
750 if (!sh_flag) {
751 int active = first_active();
752 if (active == MBR_PART_COUNT)
753 printf("No active partition.\n");
754 else
755 printf("First active partition: %d\n", active);
756 }
757 if (!sh_flag)
758 printf("Drive serial number: %"PRIu32" (0x%08x)\n",
759 le32toh(mboot.mbr_dsn),
760 le32toh(mboot.mbr_dsn));
761 return;
762 }
763
764 if (E_flag) {
765 if (!sh_flag)
766 printf("Extended partition E%d:\n", which);
767 if (which > ext.num_ptn)
768 printf("Undefined\n");
769 else
770 print_part(&ext.ptn[which], 0, ext_offset(which));
771 } else {
772 if (!sh_flag)
773 printf("Partition %d:\n", which);
774 print_part(&mboot, which, 0);
775 }
776 }
777
778 static void
779 print_part(struct mbr_sector *boot, int part, daddr_t offset)
780 {
781 struct mbr_partition *partp;
782 const char *e;
783
784 if (!sh_flag) {
785 print_mbr_partition(boot, part, offset, 0, 0);
786 return;
787 }
788
789 partp = &boot->mbr_parts[part];
790 if (boot != &mboot) {
791 part = boot - ext.ptn;
792 e = "E";
793 } else
794 e = "";
795
796 if (partp->mbrp_type == 0) {
797 printf("PART%s%dSIZE=0\n", e, part);
798 return;
799 }
800
801 printf("PART%s%dID=%d\n", e, part, partp->mbrp_type);
802 printf("PART%s%dSIZE=%u\n", e, part, le32toh(partp->mbrp_size));
803 printf("PART%s%dSTART=%"PRIdaddr"\n", e, part,
804 offset + le32toh(partp->mbrp_start));
805 printf("PART%s%dFLAG=0x%x\n", e, part, partp->mbrp_flag);
806 printf("PART%s%dBCYL=%d\n", e, part,
807 MBR_PCYL(partp->mbrp_scyl, partp->mbrp_ssect));
808 printf("PART%s%dBHEAD=%d\n", e, part, partp->mbrp_shd);
809 printf("PART%s%dBSEC=%d\n", e, part, MBR_PSECT(partp->mbrp_ssect));
810 printf("PART%s%dECYL=%d\n", e, part,
811 MBR_PCYL(partp->mbrp_ecyl, partp->mbrp_esect));
812 printf("PART%s%dEHEAD=%d\n", e, part, partp->mbrp_ehd);
813 printf("PART%s%dESEC=%d\n", e, part, MBR_PSECT(partp->mbrp_esect));
814 }
815
816 static void
817 pr_cyls(daddr_t sector, int is_end)
818 {
819 unsigned long cyl, head, sect;
820 cyl = sector / dos_cylindersectors;
821 sect = sector - cyl * dos_cylindersectors;
822 head = sect / dos_sectors;
823 sect -= head * dos_sectors;
824
825 printf("%lu", cyl);
826
827 if (is_end) {
828 if (head == dos_heads - 1 && sect == dos_sectors - 1)
829 return;
830 } else {
831 if (head == 0 && sect == 0)
832 return;
833 }
834
835 printf("/%lu/%lu", head, sect + 1);
836 }
837
838 static void
839 print_mbr_partition(struct mbr_sector *boot, int part,
840 daddr_t offset, daddr_t exoffset, int indent)
841 {
842 daddr_t start;
843 daddr_t size;
844 struct mbr_partition *partp = &boot->mbr_parts[part];
845 struct mbr_sector eboot;
846 int p;
847 static int dumped = 0;
848
849 if (partp->mbrp_type == 0 && v_flag < 2) {
850 printf("<UNUSED>\n");
851 return;
852 }
853
854 start = le32toh(partp->mbrp_start);
855 size = le32toh(partp->mbrp_size);
856 if (MBR_IS_EXTENDED(partp->mbrp_type))
857 start += exoffset;
858 else
859 start += offset;
860
861 printf("%s (sysid %d)\n", get_type(partp->mbrp_type), partp->mbrp_type);
862 #ifdef BOOTSEL
863 if (boot->mbr_bootsel_magic == LE_MBR_BS_MAGIC &&
864 boot->mbr_bootsel.mbrbs_nametab[part][0])
865 printf("%*s bootmenu: %s\n", indent, "",
866 boot->mbr_bootsel.mbrbs_nametab[part]);
867 #endif
868
869 printf("%*s start %"PRIdaddr", size %"PRIdaddr,
870 indent, "", start, size);
871 if (size != 0) {
872 printf(" (%u MB, Cyls ", SEC_TO_MB(size));
873 if (v_flag == 0 && le32toh(partp->mbrp_start) == ptn_0_offset)
874 pr_cyls(start - ptn_0_offset, 0);
875 else
876 pr_cyls(start, 0);
877 printf("-");
878 pr_cyls(start + size - 1, 1);
879 printf(")");
880 }
881
882 switch (partp->mbrp_flag) {
883 case 0:
884 break;
885 case MBR_PFLAG_ACTIVE:
886 printf(", Active");
887 break;
888 default:
889 printf(", flag 0x%x", partp->mbrp_flag);
890 break;
891 }
892 printf("\n");
893
894 if (v_flag) {
895 printf("%*s beg: cylinder %4d, head %3d, sector %2d\n",
896 indent, "",
897 MBR_PCYL(partp->mbrp_scyl, partp->mbrp_ssect),
898 partp->mbrp_shd, MBR_PSECT(partp->mbrp_ssect));
899 printf("%*s end: cylinder %4d, head %3d, sector %2d\n",
900 indent, "",
901 MBR_PCYL(partp->mbrp_ecyl, partp->mbrp_esect),
902 partp->mbrp_ehd, MBR_PSECT(partp->mbrp_esect));
903 }
904
905 if (partp->mbrp_type == 0 && start == 0 && v_flag < 3)
906 return;
907
908 if (! MBR_IS_EXTENDED(partp->mbrp_type))
909 print_pbr(start, indent + 8, partp->mbrp_type);
910
911 if (!MBR_IS_EXTENDED(partp->mbrp_type) ||
912 (v_flag <= 2 && !ext.is_corrupt))
913 return;
914
915 /*
916 * Recursive dump extended table,
917 * This is read from the disk - so is wrong during editing.
918 * Just ensure we only show it once.
919 */
920 if (dumped)
921 return;
922
923 printf("%*s Extended partition table:\n", indent, "");
924 indent += 4;
925 if (read_s0(start, &eboot) == -1)
926 return;
927 for (p = 0; p < MBR_PART_COUNT; p++) {
928 printf("%*s%d: ", indent, "", p);
929 print_mbr_partition(&eboot, p, start,
930 exoffset ? exoffset : start, indent);
931 }
932
933 if (exoffset == 0)
934 dumped = 1;
935 }
936
937 /* Print a line with a label and a vis-encoded string */
938 static void
939 printvis(int indent, const char *label, const char *buf, size_t size)
940 {
941 char *visbuf;
942
943 if ((visbuf = malloc(size * 4 + 1)) == NULL)
944 err(1, "Malloc failed");
945 strsvisx(visbuf, buf, size, VIS_TAB|VIS_NL|VIS_OCTAL, "\"");
946 printf("%*s%s: \"%s\"\n",
947 indent, "",
948 label, visbuf);
949 free(visbuf);
950 }
951
952 /* Check whether a buffer contains all bytes zero */
953 static int
954 is_all_zero(const unsigned char *p, size_t size)
955 {
956
957 while (size-- > 0) {
958 if (*p++ != 0)
959 return 0;
960 }
961 return 1;
962 }
963
964 /*
965 * Report on the contents of a PBR sector.
966 *
967 * We first perform several sanity checks. If vflag >= 2, we report all
968 * failing tests, but for smaller values of v_flag we stop after the
969 * first failing test. Tests are ordered in an attempt to get the most
970 * useful error message from the first failing test.
971 *
972 * If v_flag >= 2, we also report some decoded values from the PBR.
973 * These results may be meaningless, if the PBR doesn't follow common
974 * conventions.
975 *
976 * Trying to decode anything more than the magic number in the last
977 * two bytes is a layering violation, but it can be very useful in
978 * diagnosing boot failures.
979 */
980 static void
981 print_pbr(daddr_t sector, int indent, uint8_t part_type)
982 {
983 struct mbr_sector pboot;
984 unsigned char *p, *endp;
985 unsigned char val;
986 int ok;
987 int errcount = 0;
988
989 #define PBR_ERROR(...) \
990 do { \
991 ++errcount; \
992 printf("%*s%s: ", indent, "", \
993 (v_flag < 2 ? "PBR is not bootable" : "Not bootable")); \
994 printf(__VA_ARGS__); \
995 if (v_flag < 2) \
996 return; \
997 } while (/*CONSTCOND*/ 0)
998
999 if (v_flag >= 2) {
1000 printf("%*sInformation from PBR:\n",
1001 indent, "");
1002 indent += 4;
1003 }
1004
1005 if (read_disk(sector, &pboot) == -1) {
1006 PBR_ERROR("Sector %"PRIdaddr" is unreadable (%s)\n",
1007 sector, strerror(errno));
1008 return;
1009 }
1010
1011 /* all bytes identical? */
1012 p = (unsigned char *)&pboot;
1013 endp = p + sizeof(pboot);
1014 val = *p;
1015 ok = 0;
1016 for (; p < endp; p++) {
1017 if (*p != val) {
1018 ok = 1;
1019 break;
1020 }
1021 }
1022 if (! ok)
1023 PBR_ERROR("All bytes are identical (0x%02x)\n", val);
1024
1025 if (pboot.mbr_magic != LE_MBR_MAGIC)
1026 PBR_ERROR("Bad magic number (0x%04x)\n",
1027 le16toh(pboot.mbr_magic));
1028
1029 #if 0
1030 /* Some i386 OS might fail this test. All non-i386 will fail. */
1031 if (pboot.mbr_jmpboot[0] != 0xE9
1032 && pboot.mbr_jmpboot[0] != 0xEB) {
1033 PBR_ERROR("Does not begin with i386 JMP instruction"
1034 " (0x%02x 0x%02x0 0x%02x)\n",
1035 pboot.mbr_jmpboot[0], pboot.mbr_jmpboot[1],
1036 pboot.mbr_jmpboot[2]);
1037 }
1038 #endif
1039
1040 if (v_flag > 0 && errcount == 0)
1041 printf("%*sPBR appears to be bootable\n",
1042 indent, "");
1043 if (v_flag < 2)
1044 return;
1045
1046 if (! is_all_zero(pboot.mbr_oemname, sizeof(pboot.mbr_oemname))) {
1047 printvis(indent, "OEM name", (char *)pboot.mbr_oemname,
1048 sizeof(pboot.mbr_oemname));
1049 }
1050
1051 if (pboot.mbr_bpb.bpb16.bsBootSig == 0x29)
1052 printf("%*sBPB FAT16 boot signature found\n",
1053 indent, "");
1054 if (pboot.mbr_bpb.bpb32.bsBootSig == 0x29)
1055 printf("%*sBPB FAT32 boot signature found\n",
1056 indent, "");
1057
1058 #undef PBR_ERROR
1059 }
1060
1061 static int
1062 read_boot(const char *name, void *buf, size_t len, int err_exit)
1063 {
1064 int bfd, ret;
1065 struct stat st;
1066
1067 if (boot_path != NULL)
1068 free(boot_path);
1069 if (strchr(name, '/') == 0)
1070 asprintf(&boot_path, "%s/%s", boot_dir, name);
1071 else
1072 boot_path = strdup(name);
1073 if (boot_path == NULL)
1074 err(1, "Malloc failed");
1075
1076 if ((bfd = open(boot_path, O_RDONLY)) < 0 || fstat(bfd, &st) == -1) {
1077 warn("%s", boot_path);
1078 goto fail;
1079 }
1080
1081 if (st.st_size > (off_t)len) {
1082 warnx("%s: bootcode too large", boot_path);
1083 goto fail;
1084 }
1085 ret = st.st_size;
1086 if (ret < 0x200) {
1087 warnx("%s: bootcode too small", boot_path);
1088 goto fail;
1089 }
1090 if (read(bfd, buf, len) != ret) {
1091 warn("%s", boot_path);
1092 goto fail;
1093 }
1094
1095 /*
1096 * Do some sanity checking here
1097 */
1098 if (((struct mbr_sector *)buf)->mbr_magic != LE_MBR_MAGIC) {
1099 warnx("%s: invalid magic", boot_path);
1100 goto fail;
1101 }
1102
1103 close(bfd);
1104 ret = (ret + 0x1ff) & ~0x1ff;
1105 return ret;
1106
1107 fail:
1108 if (bfd >= 0)
1109 close(bfd);
1110 if (err_exit)
1111 exit(1);
1112 return 0;
1113 }
1114
1115 static void
1116 init_sector0(int zappart)
1117 {
1118 int i;
1119 int copy_size = offsetof(struct mbr_sector, mbr_dsn);
1120
1121 #ifdef DEFAULT_BOOTCODE
1122 if (bootsize == 0)
1123 bootsize = read_boot(DEFAULT_BOOTCODE, bootcode,
1124 sizeof bootcode, 0);
1125 #endif
1126 #ifdef BOOTSEL
1127 if (mboot.mbr_bootsel_magic == LE_MBR_BS_MAGIC
1128 && bootcode[0].mbr_bootsel_magic == LE_MBR_BS_MAGIC)
1129 copy_size = MBR_BS_OFFSET;
1130 #endif
1131
1132 if (bootsize != 0) {
1133 boot_installed = 1;
1134 memcpy(&mboot, bootcode, copy_size);
1135 mboot.mbr_bootsel_magic = bootcode[0].mbr_bootsel_magic;
1136 }
1137 mboot.mbr_magic = LE_MBR_MAGIC;
1138
1139 if (!zappart)
1140 return;
1141 for (i = 0; i < MBR_PART_COUNT; i++)
1142 memset(&mboot.mbr_parts[i], 0, sizeof(mboot.mbr_parts[i]));
1143 }
1144
1145 static void
1146 get_extended_ptn(void)
1147 {
1148 struct mbr_partition *mp;
1149 struct mbr_sector *boot;
1150 daddr_t offset;
1151 struct mbr_sector *nptn;
1152
1153 /* find first (there should only be one) extended partition */
1154 for (mp = mboot.mbr_parts; !MBR_IS_EXTENDED(mp->mbrp_type); mp++)
1155 if (mp >= &mboot.mbr_parts[MBR_PART_COUNT])
1156 return;
1157
1158 /*
1159 * The extended partition should be structured as a linked list
1160 * (even though it appears, at first glance, to be a tree).
1161 */
1162 ext.base = le32toh(mp->mbrp_start);
1163 ext.limit = ext.base + le32toh(mp->mbrp_size);
1164 ext.ptn_id = mp - mboot.mbr_parts;
1165 for (offset = 0;; offset = le32toh(boot->mbr_parts[1].mbrp_start)) {
1166 nptn = realloc(ext.ptn, (ext.num_ptn + 1) * sizeof *ext.ptn);
1167 if (nptn == NULL)
1168 err(1, "Malloc failed");
1169 ext.ptn = nptn;
1170 boot = ext.ptn + ext.num_ptn;
1171 if (read_s0(offset + ext.base, boot) == -1)
1172 break;
1173 /* expect p0 to be valid and p1 to be another extended ptn */
1174 if (MBR_IS_EXTENDED(boot->mbr_parts[0].mbrp_type))
1175 break;
1176 if (boot->mbr_parts[1].mbrp_type != 0 &&
1177 !MBR_IS_EXTENDED(boot->mbr_parts[1].mbrp_type))
1178 break;
1179 /* p2 and p3 should be unallocated */
1180 if (boot->mbr_parts[2].mbrp_type != 0 ||
1181 boot->mbr_parts[3].mbrp_type != 0)
1182 break;
1183 /* data ptn inside extended one */
1184 if (boot->mbr_parts[0].mbrp_type != 0 &&
1185 offset + le32toh(boot->mbr_parts[0].mbrp_start)
1186 + le32toh(boot->mbr_parts[0].mbrp_size) > ext.limit)
1187 break;
1188
1189 ext.num_ptn++;
1190
1191 if (boot->mbr_parts[1].mbrp_type == 0)
1192 /* end of extended partition chain */
1193 return;
1194 /* must be in sector order */
1195 if (offset >= le32toh(boot->mbr_parts[1].mbrp_start))
1196 break;
1197 }
1198
1199 warnx("Extended partition table is corrupt");
1200 ext.is_corrupt = 1;
1201 ext.num_ptn = 0;
1202 }
1203
1204 #if defined(USE_DISKLIST)
1205 static void
1206 get_diskname(const char *fullname, char *diskname, size_t size)
1207 {
1208 const char *p, *p2;
1209 size_t len;
1210
1211 p = strrchr(fullname, '/');
1212 if (p == NULL)
1213 p = fullname;
1214 else
1215 p++;
1216
1217 if (*p == 0) {
1218 strlcpy(diskname, fullname, size);
1219 return;
1220 }
1221
1222 if (*p == 'r')
1223 p++;
1224
1225 for (p2 = p; *p2 != 0; p2++)
1226 if (isdigit((unsigned char)*p2))
1227 break;
1228 if (*p2 == 0) {
1229 /* XXX invalid diskname? */
1230 strlcpy(diskname, fullname, size);
1231 return;
1232 }
1233 while (isdigit((unsigned char)*p2))
1234 p2++;
1235
1236 len = p2 - p;
1237 if (len > size) {
1238 /* XXX */
1239 strlcpy(diskname, fullname, size);
1240 return;
1241 }
1242
1243 memcpy(diskname, p, len);
1244 diskname[len] = 0;
1245 }
1246 #endif
1247
1248 static void
1249 get_ptn_alignmemt(void)
1250 {
1251 struct mbr_partition *partp = &mboot.mbr_parts[0];
1252 uint32_t ptn_0_base, ptn_0_limit;
1253
1254 /* Default to using 'traditional' cylinder alignment */
1255 ptn_alignment = dos_cylindersectors;
1256 ptn_0_offset = dos_sectors;
1257
1258 if (partp->mbrp_type != 0) {
1259 /* Try to copy alignment of first partition */
1260 ptn_0_base = le32toh(partp->mbrp_start);
1261 ptn_0_limit = ptn_0_base + le32toh(partp->mbrp_size);
1262 if (!(ptn_0_limit & 2047)) {
1263 /* Partition ends on a 1MB boundary, align to 1MB */
1264 ptn_alignment = 2048;
1265 if (ptn_0_base <= 2048
1266 && !(ptn_0_base & (ptn_0_base - 1))) {
1267 /* ptn_base is a power of 2, use it */
1268 ptn_0_offset = ptn_0_base;
1269 }
1270 }
1271 } else {
1272 /* Use 1MB alignment for large disks */
1273 if (disksectors > 2048 * 1024 * 128) {
1274 ptn_alignment = 2048;
1275 ptn_0_offset = 2048;
1276 }
1277 }
1278 }
1279
1280 static void
1281 get_bios_geometry(void)
1282 {
1283 #if defined(USE_DISKLIST)
1284 int mib[2], i;
1285 size_t len;
1286 struct biosdisk_info *bip;
1287 struct nativedisk_info *nip;
1288 char diskname[8];
1289
1290 mib[0] = CTL_MACHDEP;
1291 mib[1] = CPU_DISKINFO;
1292 if (sysctl(mib, 2, NULL, &len, NULL, 0) < 0) {
1293 goto out;
1294 }
1295 dl = (struct disklist *) malloc(len);
1296 if (dl == NULL)
1297 err(1, "Malloc failed");
1298 if (sysctl(mib, 2, dl, &len, NULL, 0) < 0) {
1299 free(dl);
1300 dl = 0;
1301 goto out;
1302 }
1303
1304 get_diskname(disk, diskname, sizeof diskname);
1305
1306 for (i = 0; i < dl->dl_nnativedisks; i++) {
1307 nip = &dl->dl_nativedisks[i];
1308 if (strcmp(diskname, nip->ni_devname))
1309 continue;
1310 /*
1311 * XXX listing possible matches is better. This is ok for
1312 * now because the user has a chance to change it later.
1313 * Also, if all the disks have the same parameters then we can
1314 * just use them, we don't need to know which disk is which.
1315 */
1316 if (nip->ni_nmatches != 0) {
1317 bip = &dl->dl_biosdisks[nip->ni_biosmatches[0]];
1318 dos_cylinders = bip->bi_cyl;
1319 dos_heads = bip->bi_head;
1320 dos_sectors = bip->bi_sec;
1321 if (bip->bi_lbasecs)
1322 dos_disksectors = bip->bi_lbasecs;
1323 return;
1324 }
1325 }
1326 out:
1327 #endif
1328 /* Allright, allright, make a stupid guess.. */
1329 intuit_translated_geometry();
1330 }
1331
1332 #ifdef BOOTSEL
1333 static daddr_t
1334 get_default_boot(void)
1335 {
1336 unsigned int id;
1337 int p;
1338
1339 if (mboot.mbr_bootsel_magic != LE_MBR_BS_MAGIC)
1340 /* default to first active partition */
1341 return DEFAULT_ACTIVE;
1342
1343 id = mboot.mbr_bootsel.mbrbs_defkey;
1344
1345 if (mboot.mbr_bootsel.mbrbs_flags & MBR_BS_ASCII) {
1346 /* Keycode is ascii */
1347 if (id == '\r')
1348 return DEFAULT_ACTIVE;
1349 /* '1'+ => allocated partition id, 'a'+ => disk 0+ */
1350 if (id >= 'a' && id < 'a' + MAX_BIOS_DISKS)
1351 return DEFAULT_DISK(id - 'a');
1352 id -= '1';
1353 } else {
1354 /* keycode is PS/2 keycode */
1355 if (id == SCAN_ENTER)
1356 return DEFAULT_ACTIVE;
1357 /* 1+ => allocated partition id, F1+ => disk 0+ */
1358 if (id >= SCAN_F1 && id < SCAN_F1 + MAX_BIOS_DISKS)
1359 return DEFAULT_DISK(id - SCAN_F1);
1360 id -= SCAN_1;
1361 }
1362
1363 /* Convert partition index to the invariant start sector number */
1364
1365 for (p = 0; p < MBR_PART_COUNT; p++) {
1366 if (mboot.mbr_parts[p].mbrp_type == 0)
1367 continue;
1368 if (mboot.mbr_bootsel.mbrbs_nametab[p][0] == 0)
1369 continue;
1370 if (id-- == 0)
1371 return le32toh(mboot.mbr_parts[p].mbrp_start);
1372 }
1373
1374 for (p = 0; p < ext.num_ptn; p++) {
1375 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
1376 continue;
1377 if (ext.ptn[p].mbr_bootsel.mbrbs_nametab[0][0] == 0)
1378 continue;
1379 if (id-- == 0)
1380 return ext_offset(p)
1381 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_start);
1382 }
1383
1384 return DEFAULT_ACTIVE;
1385 }
1386
1387 static void
1388 set_default_boot(daddr_t default_ptn)
1389 {
1390 int p;
1391 static const unsigned char key_list[] = { SCAN_ENTER, SCAN_F1, SCAN_1,
1392 '\r', 'a', '1' };
1393 const unsigned char *key = key_list;
1394
1395 if (mboot.mbr_bootsel_magic != LE_MBR_BS_MAGIC)
1396 /* sanity */
1397 return;
1398
1399 if (mboot.mbr_bootsel.mbrbs_flags & MBR_BS_ASCII)
1400 /* Use ascii values */
1401 key += 3;
1402
1403 if (default_ptn == DEFAULT_ACTIVE) {
1404 mboot.mbr_bootsel.mbrbs_defkey = key[0];
1405 return;
1406 }
1407
1408 if (default_ptn >= DEFAULT_DISK(0)
1409 && default_ptn < DEFAULT_DISK(MAX_BIOS_DISKS)) {
1410 mboot.mbr_bootsel.mbrbs_defkey = key[1]
1411 + default_ptn - DEFAULT_DISK(0);
1412 return;
1413 }
1414
1415 mboot.mbr_bootsel.mbrbs_defkey = key[2];
1416 for (p = 0; p < MBR_PART_COUNT; p++) {
1417 if (mboot.mbr_parts[p].mbrp_type == 0)
1418 continue;
1419 if (mboot.mbr_bootsel.mbrbs_nametab[p][0] == 0)
1420 continue;
1421 if (le32toh(mboot.mbr_parts[p].mbrp_start) == default_ptn)
1422 return;
1423 mboot.mbr_bootsel.mbrbs_defkey++;
1424 }
1425
1426 if (mboot.mbr_bootsel.mbrbs_flags & MBR_BS_EXTLBA) {
1427 for (p = 0; p < ext.num_ptn; p++) {
1428 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
1429 continue;
1430 if (ext.ptn[p].mbr_bootsel.mbrbs_nametab[0][0] == 0)
1431 continue;
1432 if (le32toh(ext.ptn[p].mbr_parts[0].mbrp_start) +
1433 ext_offset(p) == default_ptn)
1434 return;
1435 mboot.mbr_bootsel.mbrbs_defkey++;
1436 }
1437 }
1438
1439 /* Default to first active partition */
1440 mboot.mbr_bootsel.mbrbs_defkey = key[0];
1441 }
1442
1443 static void
1444 install_bootsel(int needed)
1445 {
1446 struct mbr_bootsel *mbs = &mboot.mbr_bootsel;
1447 int p;
1448 int ext13 = 0;
1449 const char *code;
1450
1451 needed |= MBR_BS_NEWMBR; /* need new bootsel code */
1452
1453 /* Work out which boot code we need for this configuration */
1454 for (p = 0; p < MBR_PART_COUNT; p++) {
1455 if (mboot.mbr_parts[p].mbrp_type == 0)
1456 continue;
1457 if (mboot.mbr_bootsel_magic != LE_MBR_BS_MAGIC)
1458 break;
1459 if (mbs->mbrbs_nametab[p][0] == 0)
1460 continue;
1461 needed |= MBR_BS_ACTIVE;
1462 if (le32toh(mboot.mbr_parts[p].mbrp_start) >= dos_totalsectors)
1463 ext13 = MBR_BS_EXTINT13;
1464 }
1465
1466 for (p = 0; p < ext.num_ptn; p++) {
1467 if (ext.ptn[p].mbr_bootsel_magic != LE_MBR_BS_MAGIC)
1468 continue;
1469 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
1470 continue;
1471 if (ext.ptn[p].mbr_bootsel.mbrbs_nametab[p][0] == 0)
1472 continue;
1473 needed |= MBR_BS_EXTLBA | MBR_BS_ACTIVE;
1474 }
1475
1476 if (B_flag)
1477 needed |= MBR_BS_ACTIVE;
1478
1479 /* Is the installed code good enough ? */
1480 if (!i_flag && (needed == 0 ||
1481 (mboot.mbr_bootsel_magic == LE_MBR_BS_MAGIC
1482 && (mbs->mbrbs_flags & needed) == needed))) {
1483 /* yes - just set flags */
1484 mbs->mbrbs_flags |= ext13;
1485 return;
1486 }
1487
1488 /* ok - we need to replace the bootcode */
1489
1490 if (f_flag && !(i_flag || B_flag)) {
1491 warnx("Installed bootfile doesn't support required options.");
1492 return;
1493 }
1494
1495 if (!f_flag && bootsize == 0 && !i_flag)
1496 /* Output an explanation for the 'update bootcode' prompt. */
1497 printf("\n%s\n",
1498 "Installed bootfile doesn't support required options.");
1499
1500 /* Were we told a specific file ? (which we have already read) */
1501 /* If so check that it supports what we need. */
1502 if (bootsize != 0 && needed != 0
1503 && (bootcode[0].mbr_bootsel_magic != LE_MBR_BS_MAGIC
1504 || ((bootcode[0].mbr_bootsel.mbrbs_flags & needed) != needed))) {
1505 /* No it doesn't... */
1506 if (f_flag)
1507 warnx("Bootfile %s doesn't support "
1508 "required bootsel options", boot_path );
1509 /* But install it anyway */
1510 else
1511 if (yesno("Bootfile %s doesn't support the required "
1512 "options,\ninstall default bootfile instead?",
1513 boot_path))
1514 bootsize = 0;
1515 }
1516
1517 if (bootsize == 0) {
1518 /* Get name of bootfile that supports the required facilities */
1519 code = DEFAULT_BOOTCODE;
1520 if (needed & MBR_BS_ACTIVE)
1521 code = DEFAULT_BOOTSELCODE;
1522 #ifdef DEFAULT_BOOTEXTCODE
1523 if (needed & MBR_BS_EXTLBA)
1524 code = DEFAULT_BOOTEXTCODE;
1525 #endif
1526
1527 bootsize = read_boot(code, bootcode, sizeof bootcode, 0);
1528 if (bootsize == 0)
1529 /* The old bootcode is better than no bootcode at all */
1530 return;
1531 if ((bootcode[0].mbr_bootsel.mbrbs_flags & needed) != needed)
1532 warnx("Default bootfile %s doesn't support required "
1533 "options. Got flags 0x%x, wanted 0x%x\n",
1534 boot_path, bootcode[0].mbr_bootsel.mbrbs_flags,
1535 needed);
1536 }
1537
1538 if (!f_flag && !yesno("Update the bootcode from %s?", boot_path))
1539 return;
1540
1541 init_sector0(0);
1542
1543 if (mboot.mbr_bootsel_magic == LE_MBR_BS_MAGIC)
1544 mbs->mbrbs_flags = bootcode[0].mbr_bootsel.mbrbs_flags | ext13;
1545 }
1546
1547 static daddr_t
1548 configure_bootsel(daddr_t default_ptn)
1549 {
1550 struct mbr_bootsel *mbs = &mboot.mbr_bootsel;
1551 int i, item, opt;
1552 int tmo;
1553 daddr_t *off;
1554 int num_bios_disks;
1555
1556 #if defined(USE_DISKLIST)
1557 if (dl != NULL) {
1558 num_bios_disks = dl->dl_nbiosdisks;
1559 if (num_bios_disks > MAX_BIOS_DISKS)
1560 num_bios_disks = MAX_BIOS_DISKS;
1561 } else
1562 #endif
1563 num_bios_disks = MAX_BIOS_DISKS;
1564
1565 printf("\nBoot selector configuration:\n");
1566
1567 /* The timeout value is in ticks, ~18.2 Hz. Avoid using floats.
1568 * Ticks are nearly 64k/3600 - so our long timers are sligtly out!
1569 * Newer bootcode always waits for 1 tick, so treats 0xffff
1570 * as wait forever.
1571 */
1572 tmo = le16toh(mbs->mbrbs_timeo);
1573 tmo = tmo == 0xffff ? -1 : (10 * tmo + 9) / 182;
1574 tmo = decimal("Timeout value (0 to 3600 seconds, -1 => never)",
1575 tmo, 0, -1, 3600);
1576 mbs->mbrbs_timeo = htole16(tmo == -1 ? 0xffff : (tmo * 182) / 10);
1577
1578 off = calloc(1 + MBR_PART_COUNT + ext.num_ptn + num_bios_disks, sizeof *off);
1579 if (off == NULL)
1580 err(1, "Malloc failed");
1581
1582 printf("Select the default boot option. Options are:\n\n");
1583 item = 0;
1584 opt = 0;
1585 off[opt] = DEFAULT_ACTIVE;
1586 printf("%d: The first active partition\n", opt);
1587 for (i = 0; i < MBR_PART_COUNT; i++) {
1588 if (mboot.mbr_parts[i].mbrp_type == 0)
1589 continue;
1590 if (mbs->mbrbs_nametab[i][0] == 0)
1591 continue;
1592 printf("%d: %s\n", ++opt, &mbs->mbrbs_nametab[i][0]);
1593 off[opt] = le32toh(mboot.mbr_parts[i].mbrp_start);
1594 if (off[opt] == default_ptn)
1595 item = opt;
1596 }
1597 if (mbs->mbrbs_flags & MBR_BS_EXTLBA) {
1598 for (i = 0; i < ext.num_ptn; i++) {
1599 if (ext.ptn[i].mbr_parts[0].mbrp_type == 0)
1600 continue;
1601 if (ext.ptn[i].mbr_bootsel.mbrbs_nametab[0][0] == 0)
1602 continue;
1603 printf("%d: %s\n",
1604 ++opt, ext.ptn[i].mbr_bootsel.mbrbs_nametab[0]);
1605 off[opt] = ext_offset(i) +
1606 le32toh(ext.ptn[i].mbr_parts[0].mbrp_start);
1607 if (off[opt] == default_ptn)
1608 item = opt;
1609 }
1610 }
1611 for (i = 0; i < num_bios_disks; i++) {
1612 printf("%d: Harddisk %d\n", ++opt, i);
1613 off[opt] = DEFAULT_DISK(i);
1614 if (DEFAULT_DISK(i) == default_ptn)
1615 item = opt;
1616 }
1617
1618 item = decimal("Default boot option", item, 0, 0, opt);
1619
1620 default_ptn = off[item];
1621 free(off);
1622 return default_ptn;
1623 }
1624 #endif /* BOOTSEL */
1625
1626
1627 /* Prerequisite: the disklabel parameters and master boot record must
1628 * have been read (i.e. dos_* and mboot are meaningful).
1629 * Specification: modifies dos_cylinders, dos_heads, dos_sectors, and
1630 * dos_cylindersectors to be consistent with what the
1631 * partition table is using, if we can find a geometry
1632 * which is consistent with all partition table entries.
1633 * We may get the number of cylinders slightly wrong (in
1634 * the conservative direction). The idea is to be able
1635 * to create a NetBSD partition on a disk we don't know
1636 * the translated geometry of.
1637 * This routine is only used for non-x86 systems or when we fail to
1638 * get the BIOS geometry from the kernel.
1639 */
1640 static void
1641 intuit_translated_geometry(void)
1642 {
1643 uint32_t xcylinders;
1644 int xheads = -1, xsectors = -1, i, j;
1645 unsigned int c1, h1, s1, c2, h2, s2;
1646 unsigned long a1, a2;
1647 uint64_t num, denom;
1648
1649 /*
1650 * The physical parameters may be invalid as bios geometry.
1651 * If we cannot determine the actual bios geometry, we are
1652 * better off picking a likely 'faked' geometry than leaving
1653 * the invalid physical one.
1654 */
1655
1656 if (dos_cylinders > MAXCYL || dos_heads > MAXHEAD ||
1657 dos_sectors > MAXSECTOR) {
1658 h1 = MAXHEAD - 1;
1659 c1 = MAXCYL - 1;
1660 #if defined(USE_DISKLIST)
1661 if (dl != NULL) {
1662 /* BIOS may use 256 heads or 1024 cylinders */
1663 for (i = 0; i < dl->dl_nbiosdisks; i++) {
1664 if (h1 < (unsigned int)dl->dl_biosdisks[i].bi_head)
1665 h1 = dl->dl_biosdisks[i].bi_head;
1666 if (c1 < (unsigned int)dl->dl_biosdisks[i].bi_cyl)
1667 c1 = dl->dl_biosdisks[i].bi_cyl;
1668 }
1669 }
1670 #endif
1671 dos_sectors = MAXSECTOR;
1672 dos_heads = h1;
1673 dos_cylinders = disklabel.d_secperunit / (MAXSECTOR * h1);
1674 if (dos_cylinders > c1)
1675 dos_cylinders = c1;
1676 }
1677
1678 /* Try to deduce the number of heads from two different mappings. */
1679 for (i = 0; i < MBR_PART_COUNT * 2 - 1; i++) {
1680 if (get_mapping(i, &c1, &h1, &s1, &a1) < 0)
1681 continue;
1682 a1 -= s1;
1683 for (j = i + 1; j < MBR_PART_COUNT * 2; j++) {
1684 if (get_mapping(j, &c2, &h2, &s2, &a2) < 0)
1685 continue;
1686 a2 -= s2;
1687 num = (uint64_t)h1 * a2 - (uint64_t)h2 * a1;
1688 denom = (uint64_t)c2 * a1 - (uint64_t)c1 * a2;
1689 if (denom != 0 && num != 0 && num % denom == 0) {
1690 xheads = num / denom;
1691 xsectors = a1 / (c1 * xheads + h1);
1692 break;
1693 }
1694 }
1695 if (xheads != -1)
1696 break;
1697 }
1698
1699 if (xheads == -1) {
1700 if (F_flag)
1701 return;
1702 warnx("Cannot determine the number of heads");
1703 return;
1704 }
1705
1706 if (xsectors == -1) {
1707 warnx("Cannot determine the number of sectors");
1708 return;
1709 }
1710
1711 /* Estimate the number of cylinders. */
1712 xcylinders = disklabel.d_secperunit / xheads / xsectors;
1713 if (disklabel.d_secperunit > xcylinders * xheads * xsectors)
1714 xcylinders++;
1715
1716 /*
1717 * Now verify consistency with each of the partition table entries.
1718 * Be willing to shove cylinders up a little bit to make things work,
1719 * but translation mismatches are fatal.
1720 */
1721 for (i = 0; i < MBR_PART_COUNT * 2; i++) {
1722 if (get_mapping(i, &c1, &h1, &s1, &a1) < 0)
1723 continue;
1724 if (c1 >= MAXCYL - 2)
1725 continue;
1726 if (xsectors * (c1 * xheads + h1) + s1 != a1)
1727 return;
1728 }
1729
1730
1731 /* Everything checks out.
1732 * Reset the geometry to use for further calculations.
1733 * But cylinders cannot be > 1024.
1734 */
1735 if (xcylinders > MAXCYL)
1736 dos_cylinders = MAXCYL;
1737 else
1738 dos_cylinders = xcylinders;
1739 dos_heads = xheads;
1740 dos_sectors = xsectors;
1741 }
1742
1743 /*
1744 * For the purposes of intuit_translated_geometry(), treat the partition
1745 * table as a list of eight mapping between (cylinder, head, sector)
1746 * triplets and absolute sectors. Get the relevant geometry triplet and
1747 * absolute sectors for a given entry, or return -1 if it isn't present.
1748 * Note: for simplicity, the returned sector is 0-based.
1749 */
1750 static int
1751 get_mapping(int i, unsigned int *cylinder, unsigned int *head, unsigned int *sector,
1752 unsigned long *absolute)
1753 {
1754 struct mbr_partition *part = &mboot.mbr_parts[i / 2];
1755
1756 if (part->mbrp_type == 0)
1757 return -1;
1758 if (i % 2 == 0) {
1759 *cylinder = MBR_PCYL(part->mbrp_scyl, part->mbrp_ssect);
1760 *head = part->mbrp_shd;
1761 *sector = MBR_PSECT(part->mbrp_ssect);
1762 *absolute = le32toh(part->mbrp_start);
1763 } else {
1764 *cylinder = MBR_PCYL(part->mbrp_ecyl, part->mbrp_esect);
1765 *head = part->mbrp_ehd;
1766 *sector = MBR_PSECT(part->mbrp_esect);
1767 *absolute = le32toh(part->mbrp_start)
1768 + le32toh(part->mbrp_size) - 1;
1769 }
1770 /* Sanity check the data against all zeroes */
1771 if ((*cylinder == 0) && (*sector == 0) && (*head == 0))
1772 return -1;
1773 /* sector numbers in the MBR partition table start at 1 */
1774 *sector = *sector - 1;
1775 /* Sanity check the data against max values */
1776 if ((((*cylinder * MAXHEAD) + *head) * MAXSECTOR + *sector) < *absolute)
1777 /* cannot be a CHS mapping */
1778 return -1;
1779 return 0;
1780 }
1781
1782 static void
1783 delete_ptn(int part)
1784 {
1785 if (part == ext.ptn_id) {
1786 /* forget all about the extended partition */
1787 free(ext.ptn);
1788 memset(&ext, 0, sizeof ext);
1789 }
1790
1791 mboot.mbr_parts[part].mbrp_type = 0;
1792 }
1793
1794 static void
1795 delete_ext_ptn(int part)
1796 {
1797
1798 if (part == 0) {
1799 ext.ptn[0].mbr_parts[0].mbrp_type = 0;
1800 return;
1801 }
1802 ext.ptn[part - 1].mbr_parts[1] = ext.ptn[part].mbr_parts[1];
1803 memmove(&ext.ptn[part], &ext.ptn[part + 1],
1804 (ext.num_ptn - part - 1) * sizeof ext.ptn[0]);
1805 ext.num_ptn--;
1806 }
1807
1808 static int
1809 add_ext_ptn(daddr_t start, daddr_t size)
1810 {
1811 int part;
1812 struct mbr_partition *partp;
1813 struct mbr_sector *nptn;
1814
1815 nptn = realloc(ext.ptn, (ext.num_ptn + 1) * sizeof *ext.ptn);
1816 if (!nptn)
1817 err(1, "realloc");
1818 ext.ptn = nptn;
1819 for (part = 0; part < ext.num_ptn; part++)
1820 if (ext_offset(part) > start)
1821 break;
1822 /* insert before 'part' - make space... */
1823 memmove(&ext.ptn[part + 1], &ext.ptn[part],
1824 (ext.num_ptn - part) * sizeof ext.ptn[0]);
1825 memset(&ext.ptn[part], 0, sizeof ext.ptn[0]);
1826 ext.ptn[part].mbr_magic = LE_MBR_MAGIC;
1827 /* we will be 'part' */
1828 if (part == 0) {
1829 /* link us to 'next' */
1830 partp = &ext.ptn[0].mbr_parts[1];
1831 /* offset will be fixed by caller */
1832 partp->mbrp_size = htole32(
1833 le32toh(ext.ptn[1].mbr_parts[0].mbrp_start) +
1834 le32toh(ext.ptn[1].mbr_parts[0].mbrp_size));
1835 } else {
1836 /* link us to prev's next */
1837 partp = &ext.ptn[part - 1].mbr_parts[1];
1838 ext.ptn[part].mbr_parts[1] = *partp;
1839 /* and prev onto us */
1840 partp->mbrp_start = htole32(start - ptn_0_offset - ext.base);
1841 partp->mbrp_size = htole32(size + ptn_0_offset);
1842 }
1843 partp->mbrp_type = 5; /* as used by win98 */
1844 partp->mbrp_flag = 0;
1845 /* wallop in some CHS values - win98 doesn't saturate them */
1846 dos(le32toh(partp->mbrp_start),
1847 &partp->mbrp_scyl, &partp->mbrp_shd, &partp->mbrp_ssect);
1848 dos(le32toh(partp->mbrp_start) + le32toh(partp->mbrp_size) - 1,
1849 &partp->mbrp_ecyl, &partp->mbrp_ehd, &partp->mbrp_esect);
1850 ext.num_ptn++;
1851
1852 return part;
1853 }
1854
1855 static const char *
1856 check_overlap(int part, int sysid, daddr_t start, daddr_t size, int fix)
1857 {
1858 int p;
1859 unsigned int p_s, p_e;
1860
1861 if (sysid != 0) {
1862 if (start == 0)
1863 return "Sector zero is reserved for the MBR";
1864 #if 0
1865 if (start < ptn_0_offset)
1866 /* This is just a convention, not a requirement */
1867 return "Track zero is reserved for the BIOS";
1868 #endif
1869 if (start + size > disksectors)
1870 return "Partition exceeds size of disk";
1871 for (p = 0; p < MBR_PART_COUNT; p++) {
1872 if (p == part || mboot.mbr_parts[p].mbrp_type == 0)
1873 continue;
1874 p_s = le32toh(mboot.mbr_parts[p].mbrp_start);
1875 p_e = p_s + le32toh(mboot.mbr_parts[p].mbrp_size);
1876 if (start + size <= p_s || start >= p_e)
1877 continue;
1878 if (f_flag) {
1879 if (fix)
1880 delete_ptn(p);
1881 return 0;
1882 }
1883 return "Overlaps another partition";
1884 }
1885 }
1886
1887 /* Are we trying to create an extended partition */
1888 if (!MBR_IS_EXTENDED(mboot.mbr_parts[part].mbrp_type)) {
1889 /* this wasn't the extended partition */
1890 if (!MBR_IS_EXTENDED(sysid))
1891 return 0;
1892 /* making an extended partition */
1893 if (ext.base != 0) {
1894 if (!f_flag)
1895 return "There cannot be 2 extended partitions";
1896 if (fix)
1897 delete_ptn(ext.ptn_id);
1898 }
1899 if (fix) {
1900 /* allocate a new extended partition */
1901 ext.ptn = calloc(1, sizeof ext.ptn[0]);
1902 if (ext.ptn == NULL)
1903 err(1, "Malloc failed");
1904 ext.ptn[0].mbr_magic = LE_MBR_MAGIC;
1905 ext.ptn_id = part;
1906 ext.base = start;
1907 ext.limit = start + size;
1908 ext.num_ptn = 1;
1909 }
1910 return 0;
1911 }
1912
1913 /* Check we haven't cut space allocated to an extended ptn */
1914
1915 if (!MBR_IS_EXTENDED(sysid)) {
1916 /* no longer an extended partition */
1917 if (fix) {
1918 /* Kill all memory of the extended partitions */
1919 delete_ptn(part);
1920 return 0;
1921 }
1922 if (ext.num_ptn == 0 ||
1923 (ext.num_ptn == 1 && ext.ptn[0].mbr_parts[0].mbrp_type == 0))
1924 /* nothing in extended partition */
1925 return 0;
1926 if (f_flag)
1927 return 0;
1928 if (yesno("Do you really want to delete all the extended partitions?"))
1929 return 0;
1930 return "Extended partition busy";
1931 }
1932
1933 if (le32toh(mboot.mbr_parts[part].mbrp_start) != ext.base)
1934 /* maybe impossible, but an extra sanity check */
1935 return 0;
1936
1937 for (p = ext.num_ptn; --p >= 0;) {
1938 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
1939 continue;
1940 p_s = ext_offset(p);
1941 p_e = p_s + le32toh(ext.ptn[p].mbr_parts[0].mbrp_start)
1942 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_size);
1943 if (p_s >= start && p_e <= start + size)
1944 continue;
1945 if (!f_flag)
1946 return "Extended partition outside main partition";
1947 if (fix)
1948 delete_ext_ptn(p);
1949 }
1950
1951 if (fix && start != ext.base) {
1952 /* The internal offsets need to be fixed up */
1953 for (p = 0; p < ext.num_ptn - 1; p++)
1954 ext.ptn[p].mbr_parts[1].mbrp_start = htole32(
1955 le32toh(ext.ptn[p].mbr_parts[1].mbrp_start)
1956 + ext.base - start);
1957 /* and maybe an empty partition at the start */
1958 if (ext.ptn[0].mbr_parts[0].mbrp_type == 0) {
1959 if (le32toh(ext.ptn[0].mbr_parts[1].mbrp_start) == 0) {
1960 /* don't need the empty slot */
1961 memmove(&ext.ptn[0], &ext.ptn[1],
1962 (ext.num_ptn - 1) * sizeof ext.ptn[0]);
1963 ext.num_ptn--;
1964 }
1965 } else {
1966 /* must create an empty slot */
1967 add_ext_ptn(start, ptn_0_offset);
1968 ext.ptn[0].mbr_parts[1].mbrp_start = htole32(ext.base
1969 - start);
1970 }
1971 }
1972 if (fix) {
1973 ext.base = start;
1974 ext.limit = start + size;
1975 }
1976 return 0;
1977 }
1978
1979 static const char *
1980 check_ext_overlap(int part, int sysid, daddr_t start, daddr_t size, int fix)
1981 {
1982 int p;
1983 unsigned int p_s, p_e;
1984
1985 if (sysid == 0)
1986 return 0;
1987
1988 if (MBR_IS_EXTENDED(sysid))
1989 return "Nested extended partitions are not allowed";
1990
1991 /* allow one track at start for extended partition header */
1992 start -= ptn_0_offset;
1993 size += ptn_0_offset;
1994 if (start < ext.base || start + size > ext.limit)
1995 return "Outside bounds of extended partition";
1996
1997 if (f_flag && !fix)
1998 return 0;
1999
2000 for (p = ext.num_ptn; --p >= 0;) {
2001 if (p == part || ext.ptn[p].mbr_parts[0].mbrp_type == 0)
2002 continue;
2003 p_s = ext_offset(p);
2004 p_e = p_s + le32toh(ext.ptn[p].mbr_parts[0].mbrp_start)
2005 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_size);
2006 if (p == 0)
2007 p_s += le32toh(ext.ptn[p].mbr_parts[0].mbrp_start)
2008 - ptn_0_offset;
2009 if (start < p_e && start + size > p_s) {
2010 if (!f_flag)
2011 return "Overlaps another extended partition";
2012 if (fix) {
2013 if (part == -1)
2014 delete_ext_ptn(p);
2015 else
2016 /* must not change numbering yet */
2017 ext.ptn[p].mbr_parts[0].mbrp_type = 0;
2018 }
2019 }
2020 }
2021 return 0;
2022 }
2023
2024 static int
2025 change_part(int extended, int part, int sysid, daddr_t start, daddr_t size,
2026 char *bootmenu)
2027 {
2028 struct mbr_partition *partp;
2029 struct mbr_sector *boot;
2030 daddr_t offset;
2031 const char *e;
2032 int upart = part;
2033 int p;
2034 int fl;
2035 daddr_t n_s, n_e;
2036 const char *errtext;
2037 #ifdef BOOTSEL
2038 char tmp_bootmenu[MBR_PART_COUNT * (MBR_BS_PARTNAMESIZE + 1)];
2039 int bootmenu_len = (extended ? MBR_PART_COUNT : 1) * (MBR_BS_PARTNAMESIZE + 1);
2040 #endif
2041
2042 if (extended) {
2043 if (part != -1 && part < ext.num_ptn) {
2044 boot = &ext.ptn[part];
2045 partp = &boot->mbr_parts[0];
2046 offset = ext_offset(part);
2047 } else {
2048 part = -1;
2049 boot = 0;
2050 partp = 0;
2051 offset = 0;
2052 }
2053 upart = 0;
2054 e = "E";
2055 } else {
2056 boot = &mboot;
2057 partp = &boot->mbr_parts[part];
2058 offset = 0;
2059 e = "";
2060 }
2061
2062 if (!f_flag && part != -1) {
2063 printf("The data for partition %s%d is:\n", e, part);
2064 print_part(boot, upart, offset);
2065 }
2066
2067 #ifdef BOOTSEL
2068 if (bootmenu != NULL)
2069 strlcpy(tmp_bootmenu, bootmenu, bootmenu_len);
2070 else
2071 if (boot != NULL && boot->mbr_bootsel_magic == LE_MBR_BS_MAGIC)
2072 strlcpy(tmp_bootmenu,
2073 boot->mbr_bootsel.mbrbs_nametab[upart],
2074 bootmenu_len);
2075 else
2076 tmp_bootmenu[0] = 0;
2077 #endif
2078
2079 if (partp != NULL) {
2080 if (!s_flag) {
2081 /* values not specified, default to current ones */
2082 sysid = partp->mbrp_type;
2083 start = offset + le32toh(partp->mbrp_start);
2084 size = le32toh(partp->mbrp_size);
2085 } else {
2086 if (sysid == -1)
2087 sysid = partp->mbrp_type;
2088 if (start == (daddr_t)0xffffffff) {
2089 start = offset + le32toh(partp->mbrp_start);
2090 if (start == 0)
2091 start = offset = ptn_0_offset;
2092 }
2093 if (size == (daddr_t)0xffffffff) {
2094 size = le32toh(partp->mbrp_size);
2095 if (size == 0)
2096 size = disksectors - start;
2097 }
2098 }
2099 }
2100
2101 /* creating a new partition, default to free space */
2102 if (!s_flag && sysid == 0 && extended) {
2103 /* non-extended partition */
2104 start = ext.base;
2105 for (p = 0; p < ext.num_ptn; p++) {
2106 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
2107 continue;
2108 n_s = ext_offset(p);
2109 if (n_s > start + ptn_0_offset)
2110 break;
2111 start = ext_offset(p)
2112 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_start)
2113 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_size);
2114 }
2115 if (ext.limit - start <= ptn_0_offset) {
2116 printf("No space in extended partition\n");
2117 return 0;
2118 }
2119 start += ptn_0_offset;
2120 }
2121
2122 if (!s_flag && sysid == 0 && !extended) {
2123 /* same for non-extended partition */
2124 /* first see if old start is free */
2125 if (start < ptn_0_offset)
2126 start = 0;
2127 for (p = 0; start != 0 && p < MBR_PART_COUNT; p++) {
2128 if (mboot.mbr_parts[p].mbrp_type == 0)
2129 continue;
2130 n_s = le32toh(mboot.mbr_parts[p].mbrp_start);
2131 if (start >= n_s &&
2132 start < n_s + le32toh(mboot.mbr_parts[p].mbrp_size))
2133 start = 0;
2134 }
2135 if (start == 0) {
2136 /* Look for first gap */
2137 start = ptn_0_offset;
2138 for (p = 0; p < MBR_PART_COUNT; p++) {
2139 if (mboot.mbr_parts[p].mbrp_type == 0)
2140 continue;
2141 n_s = le32toh(mboot.mbr_parts[p].mbrp_start);
2142 n_e = n_s + le32toh(mboot.mbr_parts[p].mbrp_size);
2143 if (start >= n_s && start < n_e) {
2144 start = n_e;
2145 p = -1;
2146 }
2147 }
2148 if (start >= disksectors && !I_flag) {
2149 printf("No free space\n");
2150 return 0;
2151 }
2152 }
2153 }
2154
2155 if (!f_flag) {
2156 /* request new values from user */
2157 if (sysid == 0)
2158 sysid = 169;
2159 sysid = decimal("sysid", sysid, 0, 0, 255);
2160 if (sysid == 0 && !v_flag) {
2161 start = 0;
2162 size = 0;
2163 #ifdef BOOTSEL
2164 tmp_bootmenu[0] = 0;
2165 #endif
2166 } else {
2167 daddr_t old = start;
2168 daddr_t lim = extended ? ext.limit : disksectors;
2169 start = decimal("start", start,
2170 DEC_SEC | DEC_RND_0 | (extended ? DEC_RND : 0),
2171 extended ? ext.base : 0, lim);
2172 /* Adjust 'size' so that end doesn't move when 'start'
2173 * is only changed slightly.
2174 */
2175 if (size > start - old)
2176 size -= start - old;
2177 else
2178 size = 0;
2179 /* Find end of available space from this start point */
2180 if (extended) {
2181 for (p = 0; p < ext.num_ptn; p++) {
2182 if (p == part)
2183 continue;
2184 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
2185 continue;
2186 n_s = ext_offset(p);
2187 if (n_s > start && n_s < lim)
2188 lim = n_s;
2189 if (start >= n_s && start < n_s
2190 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_start)
2191 + le32toh(ext.ptn[p].mbr_parts[0].mbrp_size)) {
2192 lim = start;
2193 break;
2194 }
2195 }
2196 } else {
2197 for (p = 0; p < MBR_PART_COUNT; p++) {
2198 if (p == part)
2199 continue;
2200 if (mboot.mbr_parts[p].mbrp_type == 0)
2201 continue;
2202 n_s = le32toh(mboot.mbr_parts[p].mbrp_start);
2203 if (n_s > start && n_s < lim)
2204 lim = n_s;
2205 if (start >= n_s && start < n_s
2206 + le32toh(mboot.mbr_parts[p].mbrp_size)) {
2207 lim = start;
2208 break;
2209 }
2210 }
2211 }
2212 lim -= start;
2213 if (lim == 0) {
2214 printf("Start sector already allocated\n");
2215 return 0;
2216 }
2217 if (size == 0 || size > lim)
2218 size = lim;
2219 fl = DEC_SEC;
2220 if (start % ptn_alignment == ptn_0_offset)
2221 fl |= DEC_RND_DOWN;
2222 if (start == 2 * ptn_0_offset)
2223 fl |= DEC_RND_DOWN | DEC_RND_DOWN_2;
2224 size = decimal("size", size, fl, 0, lim);
2225 #ifdef BOOTSEL
2226 #ifndef DEFAULT_BOOTEXTCODE
2227 if (!extended)
2228 #endif
2229 string("bootmenu", bootmenu_len, tmp_bootmenu);
2230 #endif
2231 }
2232 }
2233
2234 /*
2235 * Before we write these away, we must verify that nothing
2236 * untoward has been requested.
2237 */
2238
2239 if (extended)
2240 errtext = check_ext_overlap(part, sysid, start, size, 0);
2241 else
2242 errtext = check_overlap(part, sysid, start, size, 0);
2243 if (errtext != NULL && !I_flag) {
2244 if (f_flag)
2245 errx(2, "%s", errtext);
2246 printf("%s\n", errtext);
2247 return 0;
2248 }
2249
2250 /*
2251 * Before proceeding, delete any overlapped partitions.
2252 * This can only happen if '-f' was supplied on the command line.
2253 * Just hope the caller knows what they are doing.
2254 * This also fixes the base of each extended partition if the
2255 * partition itself has moved.
2256 */
2257 if (!I_flag) {
2258 if (extended)
2259 errtext = check_ext_overlap(part, sysid, start, size, 1);
2260 else
2261 errtext = check_overlap(part, sysid, start, size, 1);
2262 if (errtext)
2263 errx(1, "%s", errtext);
2264 }
2265
2266
2267 if (sysid == 0) {
2268 /* delete this partition - save info though */
2269 if (partp == NULL)
2270 /* must have been trying to create an extended ptn */
2271 return 0;
2272 if (start == 0 && size == 0)
2273 memset(partp, 0, sizeof *partp);
2274 #ifdef BOOTSEL
2275 if (boot->mbr_bootsel_magic == LE_MBR_BS_MAGIC)
2276 memset(boot->mbr_bootsel.mbrbs_nametab[upart], 0,
2277 sizeof boot->mbr_bootsel.mbrbs_nametab[0]);
2278 #endif
2279 if (extended)
2280 delete_ext_ptn(part);
2281 else
2282 delete_ptn(part);
2283 return 1;
2284 }
2285
2286
2287 if (extended) {
2288 if (part != -1)
2289 delete_ext_ptn(part);
2290 if (start == ext.base + ptn_0_offset)
2291 /* First one must have been free */
2292 part = 0;
2293 else
2294 part = add_ext_ptn(start, size);
2295
2296 /* These must be re-calculated because of the realloc */
2297 boot = &ext.ptn[part];
2298 partp = &boot->mbr_parts[0];
2299 offset = ext_offset(part);
2300 }
2301
2302 partp->mbrp_type = sysid;
2303 partp->mbrp_start = htole32( start - offset);
2304 partp->mbrp_size = htole32( size);
2305 dos(start, &partp->mbrp_scyl, &partp->mbrp_shd, &partp->mbrp_ssect);
2306 dos(start + size - 1,
2307 &partp->mbrp_ecyl, &partp->mbrp_ehd, &partp->mbrp_esect);
2308 #ifdef BOOTSEL
2309 if (extended) {
2310 boot->mbr_bootsel_magic = LE_MBR_BS_MAGIC;
2311 strncpy(boot->mbr_bootsel.mbrbs_nametab[upart], tmp_bootmenu,
2312 bootmenu_len);
2313 } else {
2314 /* We need to bootselect code installed in order to have
2315 * somewhere to safely write the menu tag.
2316 */
2317 if (boot->mbr_bootsel_magic != LE_MBR_BS_MAGIC) {
2318 if (f_flag ||
2319 yesno("The bootselect code is not installed, "
2320 "do you want to install it now?"))
2321 install_bootsel(MBR_BS_ACTIVE);
2322 }
2323 if (boot->mbr_bootsel_magic == LE_MBR_BS_MAGIC) {
2324 strncpy(boot->mbr_bootsel.mbrbs_nametab[upart],
2325 tmp_bootmenu, bootmenu_len);
2326 }
2327 }
2328 #endif
2329
2330 if (v_flag && !f_flag && yesno("Explicitly specify beg/end address?")) {
2331 /* this really isn't a good idea.... */
2332 int tsector, tcylinder, thead;
2333
2334 tcylinder = MBR_PCYL(partp->mbrp_scyl, partp->mbrp_ssect);
2335 thead = partp->mbrp_shd;
2336 tsector = MBR_PSECT(partp->mbrp_ssect);
2337 tcylinder = decimal("beginning cylinder",
2338 tcylinder, 0, 0, dos_cylinders - 1);
2339 thead = decimal("beginning head",
2340 thead, 0, 0, dos_heads - 1);
2341 tsector = decimal("beginning sector",
2342 tsector, 0, 1, dos_sectors);
2343 partp->mbrp_scyl = DOSCYL(tcylinder);
2344 partp->mbrp_shd = thead;
2345 partp->mbrp_ssect = DOSSECT(tsector, tcylinder);
2346
2347 tcylinder = MBR_PCYL(partp->mbrp_ecyl, partp->mbrp_esect);
2348 thead = partp->mbrp_ehd;
2349 tsector = MBR_PSECT(partp->mbrp_esect);
2350 tcylinder = decimal("ending cylinder",
2351 tcylinder, 0, 0, dos_cylinders - 1);
2352 thead = decimal("ending head",
2353 thead, 0, 0, dos_heads - 1);
2354 tsector = decimal("ending sector",
2355 tsector, 0, 1, dos_sectors);
2356 partp->mbrp_ecyl = DOSCYL(tcylinder);
2357 partp->mbrp_ehd = thead;
2358 partp->mbrp_esect = DOSSECT(tsector, tcylinder);
2359 }
2360
2361 /* If we had to mark an extended partition as deleted because
2362 * another request would have overlapped it, now is the time
2363 * to do the actual delete.
2364 */
2365 if (extended && f_flag) {
2366 for (p = ext.num_ptn; --p >= 0;)
2367 if (ext.ptn[p].mbr_parts[0].mbrp_type == 0)
2368 delete_ext_ptn(p);
2369 }
2370 return 1;
2371 }
2372
2373 static void
2374 print_geometry(void)
2375 {
2376
2377 if (sh_flag) {
2378 printf("DISK=%s\n", disk);
2379 printf("DLCYL=%d\nDLHEAD=%d\nDLSEC=%d\nDLSIZE=%"PRIdaddr"\n",
2380 cylinders, heads, sectors, disksectors);
2381 printf("BCYL=%d\nBHEAD=%d\nBSEC=%d\nBDLSIZE=%"PRIdaddr"\n",
2382 dos_cylinders, dos_heads, dos_sectors, dos_disksectors);
2383 printf("NUMEXTPTN=%d\n", ext.num_ptn);
2384 return;
2385 }
2386
2387 /* Not sh_flag */
2388 printf("Disk: %s\n", disk);
2389 printf("NetBSD disklabel disk geometry:\n");
2390 printf("cylinders: %d, heads: %d, sectors/track: %d "
2391 "(%d sectors/cylinder)\ntotal sectors: %"PRIdaddr", "
2392 "bytes/sector: %zd\n\n", cylinders, heads, sectors,
2393 cylindersectors, disksectors, secsize);
2394 printf("BIOS disk geometry:\n");
2395 printf("cylinders: %d, heads: %d, sectors/track: %d "
2396 "(%d sectors/cylinder)\ntotal sectors: %"PRIdaddr"\n\n",
2397 dos_cylinders, dos_heads, dos_sectors, dos_cylindersectors,
2398 dos_disksectors);
2399 printf("Partitions aligned to %d sector boundaries, offset %d\n\n",
2400 ptn_alignment, ptn_0_offset);
2401 }
2402
2403 /* Find the first active partition, else return MBR_PART_COUNT */
2404 static int
2405 first_active(void)
2406 {
2407 struct mbr_partition *partp = &mboot.mbr_parts[0];
2408 int part;
2409
2410 for (part = 0; part < MBR_PART_COUNT; part++)
2411 if (partp[part].mbrp_flag & MBR_PFLAG_ACTIVE)
2412 return part;
2413 return MBR_PART_COUNT;
2414 }
2415
2416 static void
2417 change_active(int which)
2418 {
2419 struct mbr_partition *partp;
2420 int part;
2421 int active = MBR_PART_COUNT;
2422
2423 partp = &mboot.mbr_parts[0];
2424
2425 if (a_flag && which != -1)
2426 active = which;
2427 else
2428 active = first_active();
2429 if (!f_flag) {
2430 if (yesno("Do you want to change the active partition?")) {
2431 printf ("Choosing %d will make no partition active.\n",
2432 MBR_PART_COUNT);
2433 do {
2434 active = decimal("active partition",
2435 active, 0, 0, MBR_PART_COUNT);
2436 } while (!yesno("Are you happy with this choice?"));
2437 } else
2438 return;
2439 } else
2440 if (active != MBR_PART_COUNT)
2441 printf ("Making partition %d active.\n", active);
2442
2443 for (part = 0; part < MBR_PART_COUNT; part++)
2444 partp[part].mbrp_flag &= ~MBR_PFLAG_ACTIVE;
2445 if (active < MBR_PART_COUNT)
2446 partp[active].mbrp_flag |= MBR_PFLAG_ACTIVE;
2447 }
2448
2449 static void
2450 change_bios_geometry(void)
2451 {
2452 print_geometry();
2453 if (!yesno("Do you want to change our idea of what BIOS thinks?"))
2454 return;
2455
2456 #if defined(USE_DISKLIST)
2457 if (dl != NULL) {
2458 struct biosdisk_info *bip;
2459 int i;
2460
2461 for (i = 0; i < dl->dl_nbiosdisks; i++) {
2462 if (i == 0)
2463 printf("\nGeometries of known disks:\n");
2464 bip = &dl->dl_biosdisks[i];
2465 printf("Disk %d: cylinders %u, heads %u, sectors %u"
2466 " (%"PRIdaddr" sectors, %dMB)\n",
2467 i, bip->bi_cyl, bip->bi_head, bip->bi_sec,
2468 bip->bi_lbasecs, SEC_TO_MB(bip->bi_lbasecs));
2469
2470 }
2471 printf("\n");
2472 }
2473 #endif
2474 do {
2475 dos_cylinders = decimal("BIOS's idea of #cylinders",
2476 dos_cylinders, 0, 0, MAXCYL);
2477 dos_heads = decimal("BIOS's idea of #heads",
2478 dos_heads, 0, 0, MAXHEAD);
2479 dos_sectors = decimal("BIOS's idea of #sectors",
2480 dos_sectors, 0, 1, MAXSECTOR);
2481 print_geometry();
2482 } while (!yesno("Are you happy with this choice?"));
2483 }
2484
2485
2486 /***********************************************\
2487 * Change real numbers into strange dos numbers *
2488 \***********************************************/
2489 static void
2490 dos(int sector, unsigned char *cylinderp, unsigned char *headp,
2491 unsigned char *sectorp)
2492 {
2493 int cylinder, head;
2494
2495 cylinder = sector / dos_cylindersectors;
2496 sector -= cylinder * dos_cylindersectors;
2497
2498 head = sector / dos_sectors;
2499 sector -= head * dos_sectors;
2500 if (cylinder > 1023)
2501 cylinder = 1023;
2502
2503 *cylinderp = DOSCYL(cylinder);
2504 *headp = head;
2505 *sectorp = DOSSECT(sector + 1, cylinder);
2506 }
2507
2508 static int
2509 open_disk(int update)
2510 {
2511 static char namebuf[MAXPATHLEN + 1];
2512 int flags = update && disk_file == NULL ? O_RDWR : O_RDONLY;
2513
2514 if (!F_flag) {
2515 fd = opendisk(disk, flags, namebuf, sizeof(namebuf), 0);
2516 if (fd < 0) {
2517 if (errno == ENODEV)
2518 warnx("%s is not a character device", namebuf);
2519 else
2520 warn("cannot opendisk %s", namebuf);
2521 return (-1);
2522 }
2523 disk = namebuf;
2524 } else {
2525 fd = open(disk, flags, 0);
2526 if (fd == -1) {
2527 warn("cannot open %s", disk);
2528 return -1;
2529 }
2530 }
2531
2532 if (get_params() == -1) {
2533 close(fd);
2534 fd = -1;
2535 return (-1);
2536 }
2537 if (disk_file != NULL) {
2538 /* for testing: read/write data from a disk file */
2539 wfd = open(disk_file, update ? O_RDWR|O_CREAT : O_RDONLY, 0777);
2540 if (wfd == -1) {
2541 warn("%s", disk_file);
2542 close(fd);
2543 fd = -1;
2544 return -1;
2545 }
2546 } else
2547 wfd = fd;
2548 return (0);
2549 }
2550
2551 static ssize_t
2552 read_disk(daddr_t sector, void *buf)
2553 {
2554 ssize_t nr;
2555
2556 if (*rfd == -1)
2557 errx(1, "read_disk(); fd == -1");
2558
2559 off_t offs = sector * (off_t)secsize;
2560 off_t mod = offs & (secsize - 1);
2561 off_t rnd = offs & ~(secsize - 1);
2562
2563 if (lseek(*rfd, rnd, SEEK_SET) == (off_t)-1)
2564 return -1;
2565
2566 if (secsize == 512)
2567 return read(*rfd, buf, 512);
2568
2569 if ((nr = read(*rfd, iobuf, secsize)) != secsize)
2570 return nr;
2571
2572 memcpy(buf, &iobuf[mod], 512);
2573
2574 return 512;
2575 }
2576
2577 static ssize_t
2578 write_disk(daddr_t sector, void *buf)
2579 {
2580 ssize_t nr;
2581
2582 if (wfd == -1)
2583 errx(1, "write_disk(); wfd == -1");
2584
2585 off_t offs = sector * (off_t)secsize;
2586 off_t mod = offs & (secsize - 1);
2587 off_t rnd = offs & ~(secsize - 1);
2588
2589 if (lseek(wfd, rnd, SEEK_SET) == (off_t)-1)
2590 return -1;
2591
2592 if (secsize == 512)
2593 return write(wfd, buf, 512);
2594
2595 if ((nr = read(wfd, iobuf, secsize)) != secsize)
2596 return nr;
2597
2598 if (lseek(wfd, rnd, SEEK_SET) == (off_t)-1)
2599 return -1;
2600
2601 memcpy(&iobuf[mod], buf, 512);
2602
2603 if ((nr = write(wfd, iobuf, secsize)) != secsize)
2604 return nr;
2605
2606 return 512;
2607 }
2608
2609 static void
2610 guess_geometry(daddr_t _sectors)
2611 {
2612 dos_sectors = MAXSECTOR;
2613 dos_heads = MAXHEAD - 1; /* some BIOS might use 256 */
2614 dos_cylinders = _sectors / (MAXSECTOR * (MAXHEAD - 1));
2615 if (dos_cylinders < 1)
2616 dos_cylinders = 1;
2617 else if (dos_cylinders > MAXCYL - 1)
2618 dos_cylinders = MAXCYL - 1;
2619 }
2620
2621 static int
2622 get_params(void)
2623 {
2624 if (disk_type != NULL) {
2625 struct disklabel *tmplabel;
2626
2627 if ((tmplabel = getdiskbyname(disk_type)) == NULL) {
2628 warn("%s: bad disktype", disk);
2629 return (-1);
2630 }
2631 disklabel = *tmplabel;
2632 } else if (F_flag) {
2633 struct stat st;
2634 if (fstat(fd, &st) == -1) {
2635 warn("%s: fstat", disk);
2636 return (-1);
2637 }
2638 if (st.st_size % 512 != 0) {
2639 warnx("%s size (%ju) is not divisible "
2640 "by sector size (%d)", disk, (uintmax_t)st.st_size,
2641 512);
2642 }
2643 disklabel.d_secperunit = st.st_size / 512;
2644 guess_geometry(disklabel.d_secperunit);
2645 disklabel.d_ncylinders = dos_cylinders;
2646 disklabel.d_ntracks = dos_heads;
2647 disklabel.d_secsize = 512;
2648 disklabel.d_nsectors = dos_sectors;
2649 }
2650 #if !HAVE_NBTOOL_CONFIG_H
2651 else if (ioctl(fd, DIOCGDEFLABEL, &disklabel) == -1) {
2652 warn("%s: DIOCGDEFLABEL", disk);
2653 if (ioctl(fd, DIOCGDINFO, &disklabel) == -1) {
2654 warn("%s: DIOCGDINFO", disk);
2655 return (-1);
2656 }
2657 }
2658 #endif
2659
2660 disksectors = disklabel.d_secperunit;
2661 cylinders = disklabel.d_ncylinders;
2662 heads = disklabel.d_ntracks;
2663 secsize = disklabel.d_secsize;
2664 sectors = disklabel.d_nsectors;
2665
2666 /* pick up some defaults for the BIOS sizes */
2667 if (sectors <= MAXSECTOR) {
2668 dos_cylinders = cylinders;
2669 dos_heads = heads;
2670 dos_sectors = sectors;
2671 } else {
2672 /* guess - has to better than the above */
2673 guess_geometry(disksectors);
2674 }
2675 dos_disksectors = disksectors;
2676
2677 return (0);
2678 }
2679
2680 #ifdef BOOTSEL
2681 /*
2682 * Rather unfortunately the bootsel 'magic' number is at the end of the
2683 * the structure, and there is no checksum. So when other operating
2684 * systems install mbr code by only writing the length of their code they
2685 * can overwrite part of the structure but keeping the magic number intact.
2686 * This code attempts to empirically detect this problem.
2687 */
2688 static int
2689 validate_bootsel(struct mbr_bootsel *mbs)
2690 {
2691 unsigned int key = mbs->mbrbs_defkey;
2692 unsigned int tmo;
2693 size_t i, j;
2694
2695 if (v_flag)
2696 return 0;
2697
2698 /*
2699 * Check default key is sane
2700 * - this is the most likely field to be stuffed
2701 * 16 disks and 16 bootable partitions seems enough!
2702 * (the keymap decode starts falling apart at that point)
2703 */
2704 if (mbs->mbrbs_flags & MBR_BS_ASCII) {
2705 if (key != 0 && !(key == '\r'
2706 || (key >= '1' && key < '1' + MAX_BIOS_DISKS)
2707 || (key >= 'a' && key < 'a' + MAX_BIOS_DISKS)))
2708 return 1;
2709 } else {
2710 if (key != 0 && !(key == SCAN_ENTER
2711 || (key >= SCAN_1 && key < SCAN_1 + MAX_BIOS_DISKS)
2712 || (key >= SCAN_F1 && key < SCAN_F1 + MAX_BIOS_DISKS)))
2713 return 1;
2714 }
2715
2716 /* Checking the flags will lead to breakage... */
2717
2718 /* Timeout value is expected to be a multiple of a second */
2719 tmo = htole16(mbs->mbrbs_timeo);
2720 if (tmo != 0 && tmo != 0xffff && tmo != (10 * tmo + 9) / 182 * 182 / 10)
2721 return 2;
2722
2723 /* Check the menu strings are printable */
2724 /* Unfortunately they aren't zero filled... */
2725 for (j = 0; j < __arraycount(mbs->mbrbs_nametab); ++j)
2726 for (i = 0; i < sizeof(mbs->mbrbs_nametab[j]); i++) {
2727 int c = (uint8_t)mbs->mbrbs_nametab[j][i];
2728 if (c == 0 || isprint(c))
2729 continue;
2730 return 3;
2731 }
2732
2733 return 0;
2734 }
2735 #endif
2736
2737 static int
2738 read_s0(daddr_t offset, struct mbr_sector *boot)
2739 {
2740 const char *tabletype = offset ? "extended" : "primary";
2741 #ifdef BOOTSEL
2742 static int reported;
2743 #endif
2744
2745 if (read_disk(offset, boot) == -1) {
2746 warn("Can't read %s partition table", tabletype);
2747 return -1;
2748 }
2749 if (boot->mbr_magic != LE_MBR_MAGIC) {
2750 if (F_flag && boot->mbr_magic == 0)
2751 return -1;
2752 warnx("%s partition table invalid, "
2753 "no magic in sector %"PRIdaddr, tabletype, offset);
2754 return -1;
2755
2756 }
2757 #ifdef BOOTSEL
2758 if (boot->mbr_bootsel_magic == LE_MBR_BS_MAGIC) {
2759 /* mbr_bootsel in new location */
2760 if (validate_bootsel(&boot->mbr_bootsel)) {
2761 warnx("removing corrupt bootsel information");
2762 boot->mbr_bootsel_magic = 0;
2763 }
2764 return 0;
2765 }
2766 if (boot->mbr_bootsel_magic != LE_MBR_MAGIC)
2767 return 0;
2768
2769 /* mbr_bootsel in old location */
2770 if (!reported)
2771 warnx("%s partition table: using old-style bootsel information",
2772 tabletype);
2773 reported = 1;
2774 if (validate_bootsel((void *)((uint8_t *)boot + MBR_BS_OFFSET + 4))) {
2775 warnx("%s bootsel information corrupt - ignoring", tabletype);
2776 return 0;
2777 }
2778 memmove((uint8_t *)boot + MBR_BS_OFFSET,
2779 (uint8_t *)boot + MBR_BS_OFFSET + 4,
2780 sizeof(struct mbr_bootsel));
2781 if ( ! (boot->mbr_bootsel.mbrbs_flags & MBR_BS_NEWMBR)) {
2782 /* old style default key */
2783 int id;
2784 /* F1..F4 => ptn 0..3, F5+ => disk 0+ */
2785 id = boot->mbr_bootsel.mbrbs_defkey;
2786 id -= SCAN_F1;
2787 if (id >= MBR_PART_COUNT)
2788 id -= MBR_PART_COUNT; /* Use number of disk */
2789 else if (mboot.mbr_parts[id].mbrp_type != 0)
2790 id = le32toh(boot->mbr_parts[id].mbrp_start);
2791 else
2792 id = DEFAULT_ACTIVE;
2793 boot->mbr_bootsel.mbrbs_defkey = id;
2794 }
2795 boot->mbr_bootsel_magic = LE_MBR_BS_MAGIC;
2796 /* highlight that new bootsel code is necessary */
2797 boot->mbr_bootsel.mbrbs_flags &= ~MBR_BS_NEWMBR;
2798 #endif /* BOOTSEL */
2799 return 0;
2800 }
2801
2802 static int
2803 write_mbr(void)
2804 {
2805 int flag, i;
2806 daddr_t offset;
2807 int rval = -1;
2808
2809 /*
2810 * write enable label sector before write (if necessary),
2811 * disable after writing.
2812 * needed if the disklabel protected area also protects
2813 * sector 0. (e.g. empty disk)
2814 */
2815 flag = 1;
2816 #if !HAVE_NBTOOL_CONFIG_H
2817 if (wfd == fd && F_flag == 0 && ioctl(wfd, DIOCWLABEL, &flag) < 0)
2818 warn("DIOCWLABEL");
2819 #endif
2820 if (write_disk(0, &mboot) == -1) {
2821 warn("Can't write fdisk partition table");
2822 goto protect_label;
2823 }
2824 if (boot_installed)
2825 for (i = bootsize; (i -= 0x200) > 0;)
2826 if (write_disk(i / 0x200, &bootcode[i / 0x200]) == -1) {
2827 warn("Can't write bootcode");
2828 goto protect_label;
2829 }
2830 for (offset = 0, i = 0; i < ext.num_ptn; i++) {
2831 if (write_disk(ext.base + offset, ext.ptn + i) == -1) {
2832 warn("Can't write %dth extended partition", i);
2833 goto protect_label;
2834 }
2835 offset = le32toh(ext.ptn[i].mbr_parts[1].mbrp_start);
2836 }
2837 rval = 0;
2838 protect_label:
2839 flag = 0;
2840 #if !HAVE_NBTOOL_CONFIG_H
2841 if (wfd == fd && F_flag == 0 && ioctl(wfd, DIOCWLABEL, &flag) < 0)
2842 warn("DIOCWLABEL");
2843 #endif
2844 return rval;
2845 }
2846
2847 static int
2848 yesno(const char *str, ...)
2849 {
2850 int ch, first;
2851 va_list ap;
2852
2853 va_start(ap, str);
2854 vprintf(str, ap);
2855 va_end(ap);
2856 printf(" [n] ");
2857
2858 first = ch = getchar();
2859 while (ch != '\n' && ch != EOF)
2860 ch = getchar();
2861 if (ch == EOF)
2862 errx(1, "EOF");
2863 return (first == 'y' || first == 'Y');
2864 }
2865
2866 static int64_t
2867 decimal(const char *prompt, int64_t dflt, int flags, int64_t minval, int64_t maxval)
2868 {
2869 int64_t acc = 0;
2870 int valid;
2871 int len;
2872 char *cp;
2873
2874 for (;;) {
2875 if (flags & DEC_SEC) {
2876 printf("%s: [%" PRId64 "..%" PRId64 "cyl default: %" PRId64 ", %" PRId64 "cyl, %uMB] ",
2877 prompt, SEC_TO_CYL(minval), SEC_TO_CYL(maxval),
2878 dflt, SEC_TO_CYL(dflt), SEC_TO_MB(dflt));
2879 } else
2880 printf("%s: [%" PRId64 "..%" PRId64 " default: %" PRId64 "] ",
2881 prompt, minval, maxval, dflt);
2882
2883 if (!fgets(lbuf, LBUF, stdin))
2884 errx(1, "EOF");
2885 cp = lbuf;
2886
2887 cp += strspn(cp, " \t");
2888 if (*cp == '\n')
2889 return dflt;
2890
2891 if (cp[0] == '$' && cp[1] == '\n')
2892 return maxval;
2893
2894 if (isdigit((unsigned char)*cp) || *cp == '-') {
2895 acc = strtoll(lbuf, &cp, 10);
2896 len = strcspn(cp, " \t\n");
2897 valid = 0;
2898 if (len != 0 && (flags & DEC_SEC)) {
2899 if (!strncasecmp(cp, "gb", len)) {
2900 acc *= 1024;
2901 valid = 1;
2902 }
2903 if (valid || !strncasecmp(cp, "mb", len)) {
2904 acc *= SEC_IN_1M;
2905 /* round to whole number of cylinders */
2906 acc += ptn_alignment / 2;
2907 acc /= ptn_alignment;
2908 valid = 1;
2909 }
2910 if (valid || !strncasecmp(cp, "cyl", len)) {
2911 acc *= ptn_alignment;
2912 /* adjustments for cylinder boundary */
2913 if (acc == 0 && flags & DEC_RND_0)
2914 acc += ptn_0_offset;
2915 if (flags & DEC_RND)
2916 acc += ptn_0_offset;
2917 if (flags & DEC_RND_DOWN)
2918 acc -= ptn_0_offset;
2919 if (flags & DEC_RND_DOWN_2)
2920 acc -= ptn_0_offset;
2921 cp += len;
2922 }
2923 }
2924 }
2925
2926 cp += strspn(cp, " \t");
2927 if (*cp != '\n') {
2928 lbuf[strlen(lbuf) - 1] = 0;
2929 printf("%s is not a valid %s number.\n", lbuf,
2930 flags & DEC_SEC ? "sector" : "decimal");
2931 continue;
2932 }
2933
2934 if (acc >= minval && acc <= maxval)
2935 return acc;
2936 printf("%" PRId64 " is not between %" PRId64 " and %" PRId64 ".\n", acc, minval, maxval);
2937 }
2938 }
2939
2940 static int
2941 ptn_id(const char *prompt, int *extended)
2942 {
2943 unsigned int acc = 0;
2944 char *cp;
2945
2946 for (;; printf("%s is not a valid partition number.\n", lbuf)) {
2947 printf("%s: [none] ", prompt);
2948
2949 if (!fgets(lbuf, LBUF, stdin))
2950 errx(1, "EOF");
2951 lbuf[strlen(lbuf)-1] = '\0';
2952 cp = lbuf;
2953
2954 cp += strspn(cp, " \t");
2955 *extended = 0;
2956 if (*cp == 0)
2957 return -1;
2958
2959 if (*cp == 'E' || *cp == 'e') {
2960 cp++;
2961 *extended = 1;
2962 }
2963
2964 acc = strtoul(cp, &cp, 10);
2965
2966 cp += strspn(cp, " \t");
2967 if (*cp != '\0')
2968 continue;
2969
2970 if (*extended || acc < MBR_PART_COUNT)
2971 return acc;
2972 }
2973 }
2974
2975 #ifdef BOOTSEL
2976 static void
2977 string(const char *prompt, int length, char *buf)
2978 {
2979 int len;
2980
2981 for (;;) {
2982 printf("%s: [%.*s] (space to clear)", prompt, length, buf);
2983
2984 if (!fgets(lbuf, LBUF, stdin))
2985 errx(1, "EOF");
2986 len = strlen(lbuf);
2987 if (len <= 1)
2988 /* unchanged if just <enter> */
2989 return;
2990 /* now strip trailing spaces, <space><enter> deletes string */
2991 do
2992 lbuf[--len] = 0;
2993 while (len != 0 && lbuf[len - 1] == ' ');
2994 if (len < length)
2995 break;
2996 printf("'%s' is longer than %d characters.\n",
2997 lbuf, length - 1);
2998 }
2999 strncpy(buf, lbuf, length);
3000 }
3001 #endif
3002
3003 static int
3004 type_match(const void *key, const void *item)
3005 {
3006 const int *idp = key;
3007 const struct mbr_ptype *ptr = item;
3008
3009 if (*idp < ptr->id)
3010 return (-1);
3011 if (*idp > ptr->id)
3012 return (1);
3013 return (0);
3014 }
3015
3016 static const char *
3017 get_type(int type)
3018 {
3019 struct mbr_ptype *ptr;
3020
3021 ptr = bsearch(&type, mbr_ptypes, KNOWN_SYSIDS,
3022 sizeof(mbr_ptypes[0]), type_match);
3023 if (ptr == 0)
3024 return ("unknown");
3025 return (ptr->name);
3026 }
3027
3028 static int
3029 read_gpt(daddr_t offset, struct gpt_hdr *gptp)
3030 {
3031 char buf[512];
3032 struct gpt_hdr *hdr = (void *)buf;
3033 const char *tabletype = GPT_TYPE(offset);
3034
3035 if (read_disk(offset, buf) == -1) {
3036 warn("Can't read %s GPT header", tabletype);
3037 return -1;
3038 }
3039 (void)memcpy(gptp, buf, GPT_HDR_SIZE);
3040
3041 /* GPT CRC should be calculated with CRC field preset to zero */
3042 hdr->hdr_crc_self = 0;
3043
3044 if (memcmp(gptp->hdr_sig, GPT_HDR_SIG, sizeof(gptp->hdr_sig))
3045 || gptp->hdr_lba_self != (uint64_t)offset
3046 || crc32(0, (void *)hdr, gptp->hdr_size) != gptp->hdr_crc_self) {
3047 /* not a GPT */
3048 (void)memset(gptp, 0, GPT_HDR_SIZE);
3049 }
3050
3051 if (v_flag && gptp->hdr_size != 0) {
3052 printf("Found %s GPT header CRC %"PRIu32" "
3053 "at sector %"PRIdaddr", backup at %"PRIdaddr"\n",
3054 tabletype, gptp->hdr_crc_self, offset, gptp->hdr_lba_alt);
3055 }
3056 return gptp->hdr_size;
3057
3058 }
3059
3060 static int
3061 delete_gpt(struct gpt_hdr *gptp)
3062 {
3063 char buf[512];
3064 struct gpt_hdr *hdr = (void *)buf;
3065
3066 if (g_flag)
3067 return 0; /* preserve existing GPT headers */
3068
3069 if (gptp->hdr_size == 0)
3070 return 0;
3071
3072 /* don't accidently overwrite something important */
3073 if (gptp->hdr_lba_self != GPT_HDR_BLKNO &&
3074 gptp->hdr_lba_self != (uint64_t)disksectors - 1) {
3075 warnx("given GPT header location doesn't seem correct");
3076 return -1;
3077 }
3078
3079 (void)memcpy(buf, gptp, GPT_HDR_SIZE);
3080 /*
3081 * Don't really delete GPT, just "disable" it, so it can
3082 * be recovered later in case of mistake or something
3083 */
3084 (void)memset(hdr->hdr_sig, 0, sizeof(gptp->hdr_sig));
3085 if (write_disk(gptp->hdr_lba_self, hdr) == -1) {
3086 warn("can't delete %s GPT header",
3087 GPT_TYPE(gptp->hdr_lba_self));
3088 return -1;
3089 }
3090 (void)memset(gptp, 0, GPT_HDR_SIZE);
3091 return 1;
3092 }
3093