projects / dragonfly.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | history | HEAD
TRIM support
[dragonfly.git] / sbin / fdisk / fdisk.c
CommitLineData
984263bc
MD		 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.
1de703da 25 *
a570def4 26 * $FreeBSD: /repoman/r/ncvs/src/sbin/i386/fdisk/fdisk.c,v 1.36.2.14 2004/01/30 14:40:47 harti Exp $
fcadbd98 27 * $DragonFly: src/sbin/i386/fdisk/fdisk.c,v 1.16 2008/04/23 22:09:07 thomas Exp $
984263bc
MD		 28 */
29
bb9741ff
MD		 30#include <sys/types.h>
31#include <sys/diskslice.h>
6af3b87d 32#include <sys/diskmbr.h>
e0fb398b
T		 33#include <sys/ioctl_compat.h>
34#include <sys/sysctl.h>
984263bc
MD		 35#include <sys/stat.h>
36#include <ctype.h>
37#include <fcntl.h>
38#include <err.h>
d736a600 39#include <fstab.h>
984263bc
MD		 40#include <errno.h>
41#include <stdio.h>
42#include <stdlib.h>
43#include <string.h>
44#include <unistd.h>
45
46int iotest;
47
48#define LBUF 100
49static char lbuf[LBUF];
50
51#define MBRSIGOFF 510
52
53/*
54 *
55 * Ported to 386bsd by Julian Elischer Thu Oct 15 20:26:46 PDT 1992
56 *
57 * 14-Dec-89 Robert Baron (rvb) at Carnegie-Mellon University
58 * Copyright (c) 1989 Robert. V. Baron
59 * Created.
60 */
61
62#define Decimal(str, ans, tmp) if (decimal(str, &tmp, ans)) ans = tmp
63#define Hex(str, ans, tmp) if (hex(str, &tmp, ans)) ans = tmp
64#define String(str, ans, len) {char *z = ans; char **dflt = &z; if (string(str, dflt)) strncpy(ans, *dflt, len); }
65
66#define RoundCyl(x) ((((x) + cylsecs - 1) / cylsecs) * cylsecs)
67
68#define MAX_SEC_SIZE 2048 /* maximum section size that is supported */
69#define MIN_SEC_SIZE 512 /* the sector size to start sensing at */
70int secsize = 0; /* the sensed sector size */
71
72const char *disk;
73const char *disks[] =
74{
908eb1e8 75 "/dev/ad0", "/dev/da0", "/dev/vkd0", 0
984263bc
MD		 76};
77
5ded848a
MD		 78int cyls, sectors, heads, cylsecs;
79int64_t disksecs;
984263bc
MD		 80
81struct mboot
82{
83 unsigned char padding[2]; /* force the longs to be long aligned */
fca180e3
MD		 84 unsigned char *bootinst; /* boot code */
85 off_t bootinst_size;
984263bc
MD		 86 struct dos_partition parts[4];
87};
88struct mboot mboot = {{0}, NULL, 0};
89
90#define ACTIVE 0x80
91#define BOOT_MAGIC 0xAA55
92
93int dos_cyls;
94int dos_heads;
95int dos_sectors;
96int dos_cylsecs;
97
98#define DOSSECT(s,c) ((s & 0x3f) | ((c >> 2) & 0xc0))
99#define DOSCYL(c) (c & 0xff)
b13267a5 100#define MAXCYL 1023
984263bc
MD		 101static int partition = -1;
102
103
104#define MAX_ARGS 10
105
106static int current_line_number;
107
108static int geom_processed = 0;
109static int part_processed = 0;
110static int active_processed = 0;
111
112
113typedef struct cmd {
114 char cmd;
115 int n_args;
116 struct arg {
117 char argtype;
82675d28 118 long long arg_val;
984263bc
MD		 119 } args[MAX_ARGS];
120} CMD;
121
122
123static int B_flag = 0; /* replace boot code */
b13267a5 124static int C_flag = 0; /* use wrapped values for CHS */
e0fb398b 125static int E_flag = 0; /* Erase through TRIM */
b52f4e19 126static int I_flag = 0; /* use entire disk for DragonFly */
984263bc
MD		 127static int a_flag = 0; /* set active partition */
128static char *b_flag = NULL; /* path to boot code */
129static int i_flag = 0; /* replace partition data */
130static int u_flag = 0; /* update partition data */
53819cf0 131static int p_flag = 0; /* operate on a disk image file */
984263bc
MD		 132static int s_flag = 0; /* Print a summary and exit */
133static int t_flag = 0; /* test only */
134static char *f_flag = NULL; /* Read config info from file */
135static int v_flag = 0; /* Be verbose */
136
137struct part_type
138{
139 unsigned char type;
140 char *name;
141}part_types[] =
142{
143 {0x00, "unused"}
144 ,{0x01, "Primary DOS with 12 bit FAT"}
145 ,{0x02, "XENIX / filesystem"}
146 ,{0x03, "XENIX /usr filesystem"}
147 ,{0x04, "Primary DOS with 16 bit FAT (<= 32MB)"}
148 ,{0x05, "Extended DOS"}
149 ,{0x06, "Primary 'big' DOS (> 32MB)"}
150 ,{0x07, "OS/2 HPFS, NTFS, QNX-2 (16 bit) or Advanced UNIX"}
151 ,{0x08, "AIX filesystem"}
152 ,{0x09, "AIX boot partition or Coherent"}
153 ,{0x0A, "OS/2 Boot Manager or OPUS"}
154 ,{0x0B, "DOS or Windows 95 with 32 bit FAT"}
155 ,{0x0C, "DOS or Windows 95 with 32 bit FAT, LBA"}
156 ,{0x0E, "Primary 'big' DOS (> 32MB, LBA)"}
157 ,{0x0F, "Extended DOS, LBA"}
158 ,{0x10, "OPUS"}
8a8f3769
HP		 159 ,{0x11, "OS/2 BM: hidden DOS with 12-bit FAT"}
160 ,{0x12, "Compaq diagnostics"}
161 ,{0x14, "OS/2 BM: hidden DOS with 16-bit FAT (< 32MB)"}
162 ,{0x16, "OS/2 BM: hidden DOS with 16-bit FAT (>= 32MB)"}
163 ,{0x17, "OS/2 BM: hidden IFS (e.g. HPFS)"}
164 ,{0x18, "AST Windows swapfile"}
165 ,{0x24, "NEC DOS"}
984263bc 166 ,{0x39, "plan9"}
8a8f3769 167 ,{0x3C, "PartitionMagic recovery"}
984263bc 168 ,{0x40, "VENIX 286"}
8a8f3769
HP		 169 ,{0x41, "Linux/MINIX (sharing disk with DRDOS)"}
170 ,{0x42, "SFS or Linux swap (sharing disk with DRDOS)"}
171 ,{0x43, "Linux native (sharing disk with DRDOS)"}
984263bc
MD		 172 ,{0x4D, "QNX 4.2 Primary"}
173 ,{0x4E, "QNX 4.2 Secondary"}
174 ,{0x4F, "QNX 4.2 Tertiary"}
175 ,{0x50, "DM"}
176 ,{0x51, "DM"}
177 ,{0x52, "CP/M or Microport SysV/AT"}
8a8f3769
HP		 178 ,{0x53, "DM6 Aux3"}
179 ,{0x54, "DM6"}
180 ,{0x55, "EZ-Drive (disk manager)"}
984263bc 181 ,{0x56, "GB"}
8a8f3769 182 ,{0x5C, "Priam Edisk (disk manager)"} /* according to S. Widlake */
984263bc
MD		 183 ,{0x61, "Speed"}
184 ,{0x63, "ISC UNIX, other System V/386, GNU HURD or Mach"}
185 ,{0x64, "Novell Netware 2.xx"}
186 ,{0x65, "Novell Netware 3.xx"}
8a8f3769 187 ,{0x70, "DiskSecure Multi-Boot"}
984263bc 188 ,{0x75, "PCIX"}
8a8f3769
HP		 189 ,{0x77, "QNX4.x"}
190 ,{0x78, "QNX4.x 2nd part"}
191 ,{0x79, "QNX4.x 3rd part"}
984263bc
MD		 192 ,{0x80, "Minix 1.1 ... 1.4a"}
193 ,{0x81, "Minix 1.4b ... 1.5.10"}
194 ,{0x82, "Linux swap or Solaris x86"}
195 ,{0x83, "Linux filesystem"}
8a8f3769
HP		 196 ,{0x84, "OS/2 hidden C: drive"}
197 ,{0x85, "Linux extended"}
198 ,{0x86, "NTFS volume set??"}
199 ,{0x87, "NTFS volume set??"}
984263bc
MD		 200 ,{0x93, "Amoeba filesystem"}
201 ,{0x94, "Amoeba bad block table"}
202 ,{0x9F, "BSD/OS"}
203 ,{0xA0, "Suspend to Disk"}
b52f4e19 204 ,{0xA5, "DragonFly/FreeBSD/NetBSD/386BSD"}
984263bc
MD		 205 ,{0xA6, "OpenBSD"}
206 ,{0xA7, "NEXTSTEP"}
207 ,{0xA9, "NetBSD"}
8a8f3769 208 ,{0xAC, "IBM JFS"}
984263bc
MD		 209 ,{0xB7, "BSDI BSD/386 filesystem"}
210 ,{0xB8, "BSDI BSD/386 swap"}
8a8f3769
HP		 211 ,{0xBE, "Solaris x86 boot"}
212 ,{0xC1, "DRDOS/sec with 12-bit FAT"}
213 ,{0xC4, "DRDOS/sec with 16-bit FAT (< 32MB)"}
214 ,{0xC6, "DRDOS/sec with 16-bit FAT (>= 32MB)"}
215 ,{0xC7, "Syrinx"}
984263bc
MD		 216 ,{0xDB, "Concurrent CPM or C.DOS or CTOS"}
217 ,{0xE1, "Speed"}
218 ,{0xE3, "Speed"}
219 ,{0xE4, "Speed"}
8a8f3769
HP		 220 ,{0xEB, "BeOS file system"}
221 ,{0xEE, "EFI GPT"}
222 ,{0xEF, "EFI System Partition"}
984263bc
MD		 223 ,{0xF1, "Speed"}
224 ,{0xF2, "DOS 3.3+ Secondary"}
225 ,{0xF4, "Speed"}
8a8f3769 226 ,{0xFE, "SpeedStor >1024 cyl. or LANstep"}
984263bc
MD		 227 ,{0xFF, "BBT (Bad Blocks Table)"}
228};
229
230static void print_s0(int which);
231static void print_part(int i);
232static void init_sector0(unsigned long start);
233static void init_boot(void);
234static void change_part(int i);
235static void print_params();
236static void change_active(int which);
237static void change_code();
238static void get_params_to_use();
239static void dos(struct dos_partition *partp);
240static int open_disk(int u_flag);
e0fb398b 241static void erase_partition(int i);
984263bc
MD		 242static ssize_t read_disk(off_t sector, void *buf);
243static ssize_t write_disk(off_t sector, void *buf);
244static int get_params();
245static int read_s0();
246static int write_s0();
247static int ok(char *str);
248static int decimal(char *str, int *num, int deflt);
249static char *get_type(int type);
250static int read_config(char *config_file);
251static void reset_boot(void);
252static int sanitize_partition(struct dos_partition *);
253static void usage(void);
254#if 0
255static int hex(char *str, int *num, int deflt);
256static int string(char *str, char **ans);
257#endif
258
259
260int
261main(int argc, char *argv[])
262{
263 int c, i;
264
e0fb398b 265 while ((c = getopt(argc, argv, "BCEIab:f:p:istuv1234")) != -1)
984263bc
MD		 266 switch (c) {
267 case 'B':
268 B_flag = 1;
269 break;
b13267a5
MD		 270 case 'C':
271 C_flag = 1;
272 break;
e0fb398b
T		 273 case 'E':
274 E_flag = 1;
275 break;
984263bc
MD		 276 case 'I':
277 I_flag = 1;
278 break;
279 case 'a':
280 a_flag = 1;
281 break;
282 case 'b':
283 b_flag = optarg;
284 break;
285 case 'f':
286 f_flag = optarg;
287 break;
53819cf0
MD		 288 case 'p':
289 disk = optarg;
290 p_flag = 1;
291 break;
984263bc
MD		 292 case 'i':
293 i_flag = 1;
294 break;
295 case 's':
296 s_flag = 1;
297 break;
298 case 't':
299 t_flag = 1;
300 break;
301 case 'u':
302 u_flag = 1;
303 break;
304 case 'v':
305 v_flag = 1;
306 break;
307 case '1':
308 case '2':
309 case '3':
310 case '4':
311 partition = c - '0';
312 break;
313 default:
314 usage();
315 }
316 if (f_flag || i_flag)
317 u_flag = 1;
318 if (t_flag)
319 v_flag = 1;
320 argc -= optind;
321 argv += optind;
322
53819cf0 323 if (argc > 0) {
d736a600 324 disk = getdevpath(argv[0], 0);
984263bc
MD		 325 if (open_disk(u_flag) < 0)
326 err(1, "cannot open disk %s", disk);
53819cf0 327 } else if (disk == NULL) {
984263bc
MD		 328 int rv = 0;
329
330 for(i = 0; disks[i]; i++)
331 {
332 disk = disks[i];
333 rv = open_disk(u_flag);
334 if(rv != -2) break;
335 }
336 if(rv < 0)
337 err(1, "cannot open any disk");
53819cf0
MD		 338 } else {
339 if (open_disk(u_flag) < 0)
340 err(1, "cannot open disk %s", disk);
984263bc
MD		 341 }
342
343 /* (abu)use mboot.bootinst to probe for the sector size */
344 if ((mboot.bootinst = malloc(MAX_SEC_SIZE)) == NULL)
345 err(1, "cannot allocate buffer to determine disk sector size");
346 read_disk(0, mboot.bootinst);
347 free(mboot.bootinst);
348 mboot.bootinst = NULL;
349
350 if (s_flag)
351 {
352 int i;
353 struct dos_partition *partp;
354
355 if (read_s0())
356 err(1, "read_s0");
357 printf("%s: %d cyl %d hd %d sec\n", disk, dos_cyls, dos_heads,
358 dos_sectors);
359 printf("Part %11s %11s Type Flags\n", "Start", "Size");
360 for (i = 0; i < NDOSPART; i++) {
361 partp = ((struct dos_partition *) &mboot.parts) + i;
362 if (partp->dp_start == 0 && partp->dp_size == 0)
363 continue;
364 printf("%4d: %11lu %11lu 0x%02x 0x%02x\n", i + 1,
365 (u_long) partp->dp_start,
366 (u_long) partp->dp_size, partp->dp_typ,
367 partp->dp_flag);
368 }
369 exit(0);
370 }
371
372 printf("******* Working on device %s *******\n",disk);
373
374 if (I_flag)
375 {
376 struct dos_partition *partp;
377
378 read_s0();
379 reset_boot();
380 partp = (struct dos_partition *) (&mboot.parts[0]);
381 partp->dp_typ = DOSPTYP_386BSD;
382 partp->dp_flag = ACTIVE;
383 partp->dp_start = dos_sectors;
5ded848a
MD		 384 if (disksecs - dos_sectors > 0xFFFFFFFFU) {
385 printf("Warning: Ending logical block > 2TB, using max value\n");
386 partp->dp_size = 0xFFFFFFFFU;
387 } else {
388 partp->dp_size = (disksecs / dos_cylsecs) *
389 dos_cylsecs - dos_sectors;
390 }
984263bc
MD		 391 dos(partp);
392 if (v_flag)
393 print_s0(-1);
e0fb398b
T		 394
395 if (E_flag) {
396 /* Trim now if we're using the entire device */
397 erase_partition(0);
398 }
399
984263bc
MD		 400 if (!t_flag)
401 write_s0();
402 exit(0);
403 }
404 if (f_flag)
405 {
406 if (read_s0() || i_flag)
407 {
408 reset_boot();
409 }
410
411 if (!read_config(f_flag))
412 {
413 exit(1);
414 }
415 if (v_flag)
416 {
417 print_s0(-1);
418 }
419 if (!t_flag)
420 {
421 write_s0();
422 }
423 }
424 else
425 {
426 if(u_flag)
427 {
428 get_params_to_use();
429 }
430 else
431 {
432 print_params();
433 }
434
435 if (read_s0())
436 init_sector0(dos_sectors);
437
438 printf("Media sector size is %d\n", secsize);
439 printf("Warning: BIOS sector numbering starts with sector 1\n");
440 printf("Information from DOS bootblock is:\n");
441 if (partition == -1)
442 for (i = 1; i <= NDOSPART; i++)
443 change_part(i);
444 else
445 change_part(partition);
446
447 if (u_flag || a_flag)
448 change_active(partition);
449
450 if (B_flag)
451 change_code();
452
453 if (u_flag || a_flag || B_flag) {
454 if (!t_flag) {
455 printf("\nWe haven't changed the partition table yet. ");
456 printf("This is your last chance.\n");
457 }
458 print_s0(-1);
459 if (!t_flag) {
e0fb398b
T		 460 if (ok("Should we write new partition table?")) {
461 if (E_flag && u_flag) {
462 /*
463 * Trim now because we've committed to
464 * updating the partition.
465 */
466 if (partition == -1)
467 for (i = 0; i < NDOSPART; i++)
468 erase_partition(i);
469 else
470 erase_partition(partition);
471 }
984263bc 472 write_s0();
e0fb398b 473 }
984263bc
MD		 474 }
475 else
476 {
477 printf("\n-t flag specified -- partition table not written.\n");
478 }
479 }
480 }
481
482 exit(0);
483}
484
485static void
d2fd3c6a 486usage(void)
984263bc
MD		 487{
488 fprintf(stderr, "%s%s",
fcadbd98 489 "usage: fdisk [-BCIaistu] [-b bootcode] [-p diskimage] [-1234] [disk]\n",
fca180e3 490 " fdisk -f configfile [-itv] [disk]\n");
984263bc
MD		 491 exit(1);
492}
493
494static void
495print_s0(int which)
496{
d2fd3c6a 497 int i;
984263bc
MD		 498
499 print_params();
500 printf("Information from DOS bootblock is:\n");
501 if (which == -1)
502 for (i = 1; i <= NDOSPART; i++)
503 printf("%d: ", i), print_part(i);
504 else
505 print_part(which);
506}
507
508static struct dos_partition mtpart = { 0 };
509
510static void
511print_part(int i)
512{
513 struct dos_partition *partp;
514 u_int64_t part_mb;
515
516 partp = ((struct dos_partition *) &mboot.parts) + i - 1;
517
518 if (!bcmp(partp, &mtpart, sizeof (struct dos_partition))) {
519 printf("<UNUSED>\n");
520 return;
521 }
522 /*
523 * Be careful not to overflow.
524 */
525 part_mb = partp->dp_size;
526 part_mb *= secsize;
527 part_mb /= (1024 * 1024);
528 printf("sysid %d,(%s)\n", partp->dp_typ, get_type(partp->dp_typ));
a276dc6b 529 printf(" start %lu, size %lu (%jd Meg), flag %x%s\n",
984263bc 530 (u_long)partp->dp_start,
fca180e3 531 (u_long)partp->dp_size,
a276dc6b 532 (intmax_t)part_mb,
984263bc
MD		 533 partp->dp_flag,
534 partp->dp_flag == ACTIVE ? " (active)" : "");
535 printf("\tbeg: cyl %d/ head %d/ sector %d;\n\tend: cyl %d/ head %d/ sector %d\n"
536 ,DPCYL(partp->dp_scyl, partp->dp_ssect)
537 ,partp->dp_shd
538 ,DPSECT(partp->dp_ssect)
539 ,DPCYL(partp->dp_ecyl, partp->dp_esect)
540 ,partp->dp_ehd
541 ,DPSECT(partp->dp_esect));
542}
543
544
545static void
546init_boot(void)
547{
548 const char *fname;
549 int fd, n;
550 struct stat sb;
551
552 fname = b_flag ? b_flag : "/boot/mbr";
553 if ((fd = open(fname, O_RDONLY)) == -1 ||
554 fstat(fd, &sb) == -1)
555 err(1, "%s", fname);
556 if ((mboot.bootinst_size = sb.st_size) % secsize != 0)
557 errx(1, "%s: length must be a multiple of sector size", fname);
558 if (mboot.bootinst != NULL)
559 free(mboot.bootinst);
560 if ((mboot.bootinst = malloc(mboot.bootinst_size = sb.st_size)) == NULL)
561 errx(1, "%s: unable to allocate read buffer", fname);
562 if ((n = read(fd, mboot.bootinst, mboot.bootinst_size)) == -1 ||
563 close(fd))
564 err(1, "%s", fname);
565 if (n != mboot.bootinst_size)
566 errx(1, "%s: short read", fname);
567}
568
569
570static void
571init_sector0(unsigned long start)
572{
573struct dos_partition *partp = (struct dos_partition *) (&mboot.parts[3]);
574
575 init_boot();
576
577 partp->dp_typ = DOSPTYP_386BSD;
578 partp->dp_flag = ACTIVE;
579 start = ((start + dos_sectors - 1) / dos_sectors) * dos_sectors;
580 if(start == 0)
581 start = dos_sectors;
582 partp->dp_start = start;
5ded848a
MD		 583 if (disksecs - start > 0xFFFFFFFFU) {
584 printf("Warning: Ending logical block > 2TB, using max value\n");
585 partp->dp_size = 0xFFFFFFFFU;
586 } else {
587 partp->dp_size = (disksecs / dos_cylsecs) * dos_cylsecs - start;
588 }
984263bc
MD		 589
590 dos(partp);
591}
592
593static void
594change_part(int i)
595{
596struct dos_partition *partp = ((struct dos_partition *) &mboot.parts) + i - 1;
597
598 printf("The data for partition %d is:\n", i);
599 print_part(i);
600
601 if (u_flag && ok("Do you want to change it?")) {
602 int tmp;
603
604 if (i_flag) {
605 bzero((char *)partp, sizeof (struct dos_partition));
606 if (i == 4) {
607 init_sector0(1);
608 printf("\nThe static data for the DOS partition 4 has been reinitialized to:\n");
609 print_part(i);
610 }
611 }
612
613 do {
b52f4e19 614 Decimal("sysid (165=DragonFly)", partp->dp_typ, tmp);
984263bc
MD		 615 Decimal("start", partp->dp_start, tmp);
616 Decimal("size", partp->dp_size, tmp);
617 if (!sanitize_partition(partp)) {
618 warnx("ERROR: failed to adjust; setting sysid to 0");
619 partp->dp_typ = 0;
620 }
621
622 if (ok("Explicitly specify beg/end address ?"))
623 {
624 int tsec,tcyl,thd;
625 tcyl = DPCYL(partp->dp_scyl,partp->dp_ssect);
626 thd = partp->dp_shd;
627 tsec = DPSECT(partp->dp_ssect);
628 Decimal("beginning cylinder", tcyl, tmp);
629 Decimal("beginning head", thd, tmp);
630 Decimal("beginning sector", tsec, tmp);
b13267a5
MD		 631 if (tcyl > MAXCYL && C_flag == 0) {
632 printf("Warning: starting cylinder wraps, using all 1's\n");
633 partp->dp_scyl = -1;
634 partp->dp_ssect = -1;
635 partp->dp_shd = -1;
636 } else {
637 partp->dp_scyl = DOSCYL(tcyl);
638 partp->dp_ssect = DOSSECT(tsec,tcyl);
639 partp->dp_shd = thd;
640 }
984263bc
MD		 641
642 tcyl = DPCYL(partp->dp_ecyl,partp->dp_esect);
643 thd = partp->dp_ehd;
644 tsec = DPSECT(partp->dp_esect);
645 Decimal("ending cylinder", tcyl, tmp);
646 Decimal("ending head", thd, tmp);
647 Decimal("ending sector", tsec, tmp);
b13267a5
MD		 648 if (tcyl > MAXCYL && C_flag == 0) {
649 printf("Warning: ending cylinder wraps, using all 1's\n");
650 partp->dp_ecyl = -1;
651 partp->dp_esect = -1;
652 partp->dp_ehd = -1;
653 } else {
654 partp->dp_ecyl = DOSCYL(tcyl);
655 partp->dp_esect = DOSSECT(tsec,tcyl);
656 partp->dp_ehd = thd;
657 }
984263bc
MD		 658 } else
659 dos(partp);
660
661 print_part(i);
662 } while (!ok("Are we happy with this entry?"));
663 }
664}
665
666static void
b5744197 667print_params(void)
984263bc 668{
bb9741ff 669 printf("parameters extracted from device are:\n");
984263bc
MD		 670 printf("cylinders=%d heads=%d sectors/track=%d (%d blks/cyl)\n\n"
671 ,cyls,heads,sectors,cylsecs);
672 if((dos_sectors > 63) || (dos_cyls > 1023) || (dos_heads > 255))
673 printf("Figures below won't work with BIOS for partitions not in cyl 1\n");
674 printf("parameters to be used for BIOS calculations are:\n");
675 printf("cylinders=%d heads=%d sectors/track=%d (%d blks/cyl)\n\n"
676 ,dos_cyls,dos_heads,dos_sectors,dos_cylsecs);
677}
678
679static void
680change_active(int which)
681{
682 struct dos_partition *partp = &mboot.parts[0];
683 int active, i, new, tmp;
684
685 active = -1;
686 for (i = 0; i < NDOSPART; i++) {
687 if ((partp[i].dp_flag & ACTIVE) == 0)
688 continue;
689 printf("Partition %d is marked active\n", i + 1);
690 if (active == -1)
691 active = i + 1;
692 }
693 if (a_flag && which != -1)
694 active = which;
695 else if (active == -1)
696 active = 1;
697
698 if (!ok("Do you want to change the active partition?"))
699 return;
700setactive:
701 do {
702 new = active;
703 Decimal("active partition", new, tmp);
704 if (new < 1 || new > 4) {
705 printf("Active partition number must be in range 1-4."
706 " Try again.\n");
707 goto setactive;
708 }
709 active = new;
710 } while (!ok("Are you happy with this choice"));
711 for (i = 0; i < NDOSPART; i++)
712 partp[i].dp_flag = 0;
713 if (active > 0 && active <= NDOSPART)
714 partp[active-1].dp_flag = ACTIVE;
715}
716
717static void
b5744197 718change_code(void)
984263bc
MD		 719{
720 if (ok("Do you want to change the boot code?"))
721 init_boot();
722}
723
724void
b5744197 725get_params_to_use(void)
984263bc
MD		 726{
727 int tmp;
728 print_params();
729 if (ok("Do you want to change our idea of what BIOS thinks ?"))
730 {
731 do
732 {
733 Decimal("BIOS's idea of #cylinders", dos_cyls, tmp);
734 Decimal("BIOS's idea of #heads", dos_heads, tmp);
735 Decimal("BIOS's idea of #sectors", dos_sectors, tmp);
736 dos_cylsecs = dos_heads * dos_sectors;
737 print_params();
738 }
739 while(!ok("Are you happy with this choice"));
740 }
741}
742
743
744/***********************************************\
745* Change real numbers into strange dos numbers *
746\***********************************************/
747static void
d2fd3c6a 748dos(struct dos_partition *partp)
984263bc
MD		 749{
750 int cy, sec;
751 u_int32_t end;
752
753 if (partp->dp_typ == 0 && partp->dp_start == 0 && partp->dp_size == 0) {
754 memcpy(partp, &mtpart, sizeof(*partp));
755 return;
756 }
757
758 /* Start c/h/s. */
984263bc
MD		 759 cy = partp->dp_start / dos_cylsecs;
760 sec = partp->dp_start % dos_sectors + 1;
b13267a5
MD		 761 if (cy > MAXCYL && C_flag == 0) {
762 printf("Warning: starting cylinder wraps, using all 1's\n");
763 partp->dp_shd = -1;
764 partp->dp_scyl = -1;
765 partp->dp_ssect = -1;
766 } else {
767 partp->dp_shd = partp->dp_start % dos_cylsecs / dos_sectors;
768 partp->dp_scyl = DOSCYL(cy);
769 partp->dp_ssect = DOSSECT(sec, cy);
770 }
984263bc
MD		 771
772 /* End c/h/s. */
773 end = partp->dp_start + partp->dp_size - 1;
984263bc
MD		 774 cy = end / dos_cylsecs;
775 sec = end % dos_sectors + 1;
b13267a5
MD		 776 if (cy > MAXCYL && C_flag == 0) {
777 printf("Warning: ending cylinder wraps, using all 1's\n");
778 partp->dp_ehd = -1;
779 partp->dp_ecyl = -1;
780 partp->dp_esect = -1;
781 } else {
782 partp->dp_ehd = end % dos_cylsecs / dos_sectors;
783 partp->dp_ecyl = DOSCYL(cy);
784 partp->dp_esect = DOSSECT(sec, cy);
785 }
984263bc
MD		 786}
787
788int fd;
789
e0fb398b
T		 790static void
791erase_partition(int i)
792{
793 struct dos_partition *partp;
794 off_t ioarg[2];
795
796 char sysctl_name[64];
797 int trim_enabled = 0;
798 size_t olen = sizeof(trim_enabled);
799 char *dev_name = strdup(disk);
800
801 dev_name = strtok(dev_name + strlen("/dev/da"),"s");
802 sprintf(sysctl_name, "kern.cam.da.%s.trim_enabled", dev_name);
803 sysctlbyname(sysctl_name, &trim_enabled, &olen, NULL, 0);
804 if(errno == ENOENT) {
805 printf("Device:%s does not support the TRIM command\n", disk);
806 usage();
807 }
808 if(!trim_enabled) {
809 printf("Erase device option selected, but sysctl (%s) "
810 "is not enabled\n",sysctl_name);
811 usage();
812 }
813 partp = ((struct dos_partition *) &mboot.parts) + i;
814 printf("erase sectors:%u %u\n",
815 partp->dp_start,
816 partp->dp_size);
817
818 /* Trim the Device */
819 ioarg[0] = partp->dp_start;
820 ioarg[0] *=secsize;
821 ioarg[1] = partp->dp_size;
822 ioarg[1] *=secsize;
823
824 if (ioctl(fd, IOCTLTRIM, ioarg) < 0) {
825 printf("Device trim failed\n");
826 usage ();
827 }
828}
829
984263bc
MD		 830 /* Getting device status */
831
832static int
833open_disk(int u_flag)
834{
835 struct stat st;
836
837 if (stat(disk, &st) == -1) {
838 if (errno == ENOENT)
839 return -2;
840 warnx("can't get file status of %s", disk);
841 return -1;
842 }
53819cf0 843 if ( !(st.st_mode & S_IFCHR) && p_flag == 0 )
984263bc
MD		 844 warnx("device %s is not character special", disk);
845 if ((fd = open(disk,
846 a_flag || I_flag || B_flag || u_flag ? O_RDWR : O_RDONLY)) == -1) {
847 if(errno == ENXIO)
848 return -2;
849 warnx("can't open device %s", disk);
850 return -1;
851 }
53819cf0 852 if (get_params() == -1) {
984263bc
MD		 853 warnx("can't get disk parameters on %s", disk);
854 return -1;
855 }
856 return fd;
857}
858
859static ssize_t
860read_disk(off_t sector, void *buf)
861{
862 lseek(fd,(sector * 512), 0);
863 if( secsize == 0 )
864 for( secsize = MIN_SEC_SIZE; secsize <= MAX_SEC_SIZE; secsize *= 2 )
865 {
866 /* try the read */
867 int size = read(fd, buf, secsize);
868 if( size == secsize )
869 /* it worked so return */
870 return secsize;
871 }
872 else
873 return read( fd, buf, secsize );
874
875 /* we failed to read at any of the sizes */
876 return -1;
877}
878
879static ssize_t
880write_disk(off_t sector, void *buf)
881{
882 lseek(fd,(sector * 512), 0);
883 /* write out in the size that the read_disk found worked */
884 return write(fd, buf, secsize);
885}
886
887static int
b5744197 888get_params(void)
984263bc 889{
bb9741ff 890 struct partinfo partinfo; /* disk parameters */
53819cf0 891 struct stat st;
984263bc 892
8155d676
MD		 893 /*
894 * NOTE: When faking up the CHS for a file image (e.g. for USB),
895 * we must use max values. If we do not then an overflowed
896 * cylinder count will, by convention, set the CHS fields to
897 * all 1's. The heads and sectors in the CHS fields will then
898 * exceed the basic geometry which can cause BIOSes to brick.
899 */
bb9741ff 900 if (ioctl(fd, DIOCGPART, &partinfo) == -1) {
53819cf0
MD		 901 if (p_flag && fstat(fd, &st) == 0 && st.st_size) {
902 sectors = 63;
8155d676 903 heads = 255;
53819cf0
MD		 904 cylsecs = heads * sectors;
905 cyls = st.st_size / 512 / cylsecs;
906 } else {
bb9741ff
MD		 907 warnx("can't get disk parameters on %s; supplying dummy ones",
908 disk);
53819cf0 909 heads = 1;
53819cf0
MD		 910 cylsecs = heads * sectors;
911 }
912 } else {
bb9741ff
MD		 913 cyls = partinfo.d_ncylinders;
914 heads = partinfo.d_nheads;
915 sectors = partinfo.d_secpertrack;
53819cf0 916 cylsecs = heads * sectors;
f946e8c1 917 secsize = partinfo.media_blksize;
984263bc 918 }
53819cf0
MD		 919 dos_cyls = cyls;
920 dos_heads = heads;
921 dos_sectors = sectors;
922 dos_cylsecs = cylsecs;
5ded848a 923 disksecs = (int64_t)cyls * heads * sectors;
984263bc
MD		 924 return (disksecs);
925}
926\f
927
928static int
b5744197 929read_s0(void)
984263bc
MD		 930{
931 mboot.bootinst_size = secsize;
932 if (mboot.bootinst != NULL)
933 free(mboot.bootinst);
934 if ((mboot.bootinst = malloc(mboot.bootinst_size)) == NULL) {
935 warnx("unable to allocate buffer to read fdisk "
936 "partition table");
937 return -1;
938 }
939 if (read_disk(0, mboot.bootinst) == -1) {
940 warnx("can't read fdisk partition table");
941 return -1;
942 }
943 if (*(uint16_t *)&mboot.bootinst[MBRSIGOFF] != BOOT_MAGIC) {
944 warnx("invalid fdisk partition table found");
945 /* So should we initialize things */
946 return -1;
947 }
948 memcpy(mboot.parts, &mboot.bootinst[DOSPARTOFF], sizeof(mboot.parts));
949 return 0;
950}
951
952static int
b5744197 953write_s0(void)
984263bc
MD		 954{
955#ifdef NOT_NOW
956 int flag;
957#endif
958 int sector;
959
960 if (iotest) {
961 print_s0(-1);
962 return 0;
963 }
964 memcpy(&mboot.bootinst[DOSPARTOFF], mboot.parts, sizeof(mboot.parts));
965 /*
966 * write enable label sector before write (if necessary),
967 * disable after writing.
968 * needed if the disklabel protected area also protects
969 * sector 0. (e.g. empty disk)
970 */
971#ifdef NOT_NOW
972 flag = 1;
973 if (ioctl(fd, DIOCWLABEL, &flag) < 0)
974 warn("ioctl DIOCWLABEL");
975#endif
fca180e3 976 for(sector = 0; sector < mboot.bootinst_size / secsize; sector++)
984263bc
MD		 977 if (write_disk(sector,
978 &mboot.bootinst[sector * secsize]) == -1) {
979 warn("can't write fdisk partition table");
980 return -1;
981#ifdef NOT_NOW
982 flag = 0;
7cee7052 983 ioctl(fd, DIOCWLABEL, &flag);
984263bc
MD		 984#endif
985 }
986#ifdef NOT_NOW
987 flag = 0;
7cee7052 988 ioctl(fd, DIOCWLABEL, &flag);
984263bc
MD		 989#endif
990 return(0);
991}
992
993
994static int
d2fd3c6a 995ok(char *str)
984263bc
MD		 996{
997 printf("%s [n] ", str);
998 fflush(stdout);
999 if (fgets(lbuf, LBUF, stdin) == NULL)
1000 exit(1);
1001 lbuf[strlen(lbuf)-1] = 0;
1002
1003 if (*lbuf &&
1004 (!strcmp(lbuf, "yes") || !strcmp(lbuf, "YES") ||
1005 !strcmp(lbuf, "y") || !strcmp(lbuf, "Y")))
1006 return 1;
1007 else
1008 return 0;
1009}
1010
1011static int
1012decimal(char *str, int *num, int deflt)
1013{
1014int acc = 0, c;
1015char *cp;
1016
1017 while (1) {
1018 printf("Supply a decimal value for \"%s\" [%d] ", str, deflt);
1019 fflush(stdout);
1020 if (fgets(lbuf, LBUF, stdin) == NULL)
1021 exit(1);
1022 lbuf[strlen(lbuf)-1] = 0;
1023
1024 if (!*lbuf)
1025 return 0;
1026
1027 cp = lbuf;
1028 while ((c = *cp) && (c == ' ' || c == '\t')) cp++;
1029 if (!c)
1030 return 0;
1031 while ((c = *cp++)) {
1032 if (c <= '9' && c >= '0')
1033 acc = acc * 10 + c - '0';
1034 else
1035 break;
1036 }
1037 if (c == ' ' || c == '\t')
1038 while ((c = *cp) && (c == ' ' || c == '\t')) cp++;
1039 if (!c) {
1040 *num = acc;
1041 return 1;
1042 } else
1043 printf("%s is an invalid decimal number. Try again.\n",
1044 lbuf);
1045 }
1046
1047}
1048
1049#if 0
1050static int
1051hex(char *str, int *num, int deflt)
1052{
1053int acc = 0, c;
1054char *cp;
1055
1056 while (1) {
1057 printf("Supply a hex value for \"%s\" [%x] ", str, deflt);
1058 fgets(lbuf, LBUF, stdin);
1059 lbuf[strlen(lbuf)-1] = 0;
1060
1061 if (!*lbuf)
1062 return 0;
1063
1064 cp = lbuf;
1065 while ((c = *cp) && (c == ' ' || c == '\t')) cp++;
1066 if (!c)
1067 return 0;
1068 while ((c = *cp++)) {
1069 if (c <= '9' && c >= '0')
1070 acc = (acc << 4) + c - '0';
1071 else if (c <= 'f' && c >= 'a')
1072 acc = (acc << 4) + c - 'a' + 10;
1073 else if (c <= 'F' && c >= 'A')
1074 acc = (acc << 4) + c - 'A' + 10;
1075 else
1076 break;
1077 }
1078 if (c == ' ' || c == '\t')
1079 while ((c = *cp) && (c == ' ' || c == '\t')) cp++;
1080 if (!c) {
1081 *num = acc;
1082 return 1;
1083 } else
1084 printf("%s is an invalid hex number. Try again.\n",
1085 lbuf);
1086 }
1087
1088}
1089
1090static int
1091string(char *str, char **ans)
1092{
1093int c;
1094char *cp = lbuf;
1095
1096 while (1) {
1097 printf("Supply a string value for \"%s\" [%s] ", str, *ans);
1098 fgets(lbuf, LBUF, stdin);
1099 lbuf[strlen(lbuf)-1] = 0;
1100
1101 if (!*lbuf)
1102 return 0;
1103
1104 while ((c = *cp) && (c == ' ' || c == '\t')) cp++;
1105 if (c == '"') {
1106 c = *++cp;
1107 *ans = cp;
1108 while ((c = *cp) && c != '"') cp++;
1109 } else {
1110 *ans = cp;
1111 while ((c = *cp) && c != ' ' && c != '\t') cp++;
1112 }
1113
1114 if (c)
1115 *cp = 0;
1116 return 1;
1117 }
1118}
1119#endif
1120
1121static char *
1122get_type(int type)
1123{
1124 int numentries = (sizeof(part_types)/sizeof(struct part_type));
1125 int counter = 0;
1126 struct part_type *ptr = part_types;
1127
1128
1129 while(counter < numentries)
1130 {
1131 if(ptr->type == type)
1132 {
1133 return(ptr->name);
1134 }
1135 ptr++;
1136 counter++;
1137 }
1138 return("unknown");
1139}
1140
1141
1142static void
d2fd3c6a 1143parse_config_line(char *line, CMD *command)
984263bc
MD		 1144{
1145 char *cp, *end;
1146
1147 cp = line;
1148 while (1) /* dirty trick used to insure one exit point for this
1149 function */
1150 {
1151 memset(command, 0, sizeof(*command));
1152
1153 while (isspace(*cp)) ++cp;
1154 if (*cp == '\0' || *cp == '#')
1155 {
1156 break;
1157 }
1158 command->cmd = *cp++;
1159
1160 /*
1161 * Parse args
1162 */
1163 while (1)
1164 {
1165 while (isspace(*cp)) ++cp;
1166 if (*cp == '#')
1167 {
1168 break; /* found comment */
1169 }
1170 if (isalpha(*cp))
1171 {
1172 command->args[command->n_args].argtype = *cp++;
1173 }
1174 if (!isdigit(*cp))
1175 {
1176 break; /* assume end of line */
1177 }
1178 end = NULL;
82675d28 1179 command->args[command->n_args].arg_val = strtoll(cp, &end, 0);
984263bc
MD		 1180 if (cp == end)
1181 {
1182 break; /* couldn't parse number */
1183 }
1184 cp = end;
1185 command->n_args++;
1186 }
1187 break;
1188 }
1189}
1190
1191
1192static int
d2fd3c6a 1193process_geometry(CMD *command)
984263bc
MD		 1194{
1195 int status = 1, i;
1196
1197 while (1)
1198 {
1199 geom_processed = 1;
1200 if (part_processed)
1201 {
1202 warnx(
1203 "ERROR line %d: the geometry specification line must occur before\n\
1204 all partition specifications",
1205 current_line_number);
1206 status = 0;
1207 break;
1208 }
1209 if (command->n_args != 3)
1210 {
1211 warnx("ERROR line %d: incorrect number of geometry args",
1212 current_line_number);
1213 status = 0;
1214 break;
1215 }
1216 dos_cyls = -1;
1217 dos_heads = -1;
1218 dos_sectors = -1;
1219 for (i = 0; i < 3; ++i)
1220 {
1221 switch (command->args[i].argtype)
1222 {
1223 case 'c':
1224 dos_cyls = command->args[i].arg_val;
1225 break;
1226 case 'h':
1227 dos_heads = command->args[i].arg_val;
1228 break;
1229 case 's':
1230 dos_sectors = command->args[i].arg_val;
1231 break;
1232 default:
1233 warnx(
1234 "ERROR line %d: unknown geometry arg type: '%c' (0x%02x)",
1235 current_line_number, command->args[i].argtype,
1236 command->args[i].argtype);
1237 status = 0;
1238 break;
1239 }
1240 }
1241 if (status == 0)
1242 {
1243 break;
1244 }
1245
1246 dos_cylsecs = dos_heads * dos_sectors;
1247
1248 /*
1249 * Do sanity checks on parameter values
1250 */
1251 if (dos_cyls < 0)
1252 {
1253 warnx("ERROR line %d: number of cylinders not specified",
1254 current_line_number);
1255 status = 0;
1256 }
1257 if (dos_cyls == 0 || dos_cyls > 1024)
1258 {
1259 warnx(
1260 "WARNING line %d: number of cylinders (%d) may be out-of-range\n\
1261 (must be within 1-1024 for normal BIOS operation, unless the entire disk\n\
b52f4e19 1262 is dedicated to DragonFly)",
984263bc
MD		 1263 current_line_number, dos_cyls);
1264 }
1265
1266 if (dos_heads < 0)
1267 {
1268 warnx("ERROR line %d: number of heads not specified",
1269 current_line_number);
1270 status = 0;
1271 }
1272 else if (dos_heads < 1 || dos_heads > 256)
1273 {
1274 warnx("ERROR line %d: number of heads must be within (1-256)",
1275 current_line_number);
1276 status = 0;
1277 }
1278
1279 if (dos_sectors < 0)
1280 {
1281 warnx("ERROR line %d: number of sectors not specified",
1282 current_line_number);
1283 status = 0;
1284 }
1285 else if (dos_sectors < 1 || dos_sectors > 63)
1286 {
1287 warnx("ERROR line %d: number of sectors must be within (1-63)",
1288 current_line_number);
1289 status = 0;
1290 }
1291
1292 break;
1293 }
1294 return (status);
1295}
1296
1297
1298static int
d2fd3c6a 1299process_partition(CMD *command)
984263bc
MD		 1300{
1301 int status = 0, partition;
1302 u_int32_t prev_head_boundary, prev_cyl_boundary;
1303 u_int32_t adj_size, max_end;
1304 struct dos_partition *partp;
1305
1306 while (1)
1307 {
1308 part_processed = 1;
1309 if (command->n_args != 4)
1310 {
1311 warnx("ERROR line %d: incorrect number of partition args",
1312 current_line_number);
1313 break;
1314 }
1315 partition = command->args[0].arg_val;
1316 if (partition < 1 || partition > 4)
1317 {
1318 warnx("ERROR line %d: invalid partition number %d",
1319 current_line_number, partition);
1320 break;
1321 }
1322 partp = ((struct dos_partition *) &mboot.parts) + partition - 1;
1323 bzero((char *)partp, sizeof (struct dos_partition));
1324 partp->dp_typ = command->args[1].arg_val;
1325 partp->dp_start = command->args[2].arg_val;
1326 partp->dp_size = command->args[3].arg_val;
1327 max_end = partp->dp_start + partp->dp_size;
1328
1329 if (partp->dp_typ == 0)
1330 {
1331 /*
1332 * Get out, the partition is marked as unused.
1333 */
1334 /*
1335 * Insure that it's unused.
1336 */
1337 bzero((char *)partp, sizeof (struct dos_partition));
1338 status = 1;
1339 break;
1340 }
1341
1342 /*
1343 * Adjust start upwards, if necessary, to fall on an head boundary.
1344 */
1345 if (partp->dp_start % dos_sectors != 0)
1346 {
1347 prev_head_boundary = partp->dp_start / dos_sectors * dos_sectors;
1348 if (max_end < dos_sectors ||
1349 prev_head_boundary > max_end - dos_sectors)
1350 {
1351 /*
1352 * Can't go past end of partition
1353 */
1354 warnx(
1355 "ERROR line %d: unable to adjust start of partition %d to fall on\n\
1356 a head boundary",
1357 current_line_number, partition);
1358 break;
1359 }
1360 warnx(
1361 "WARNING: adjusting start offset of partition %d\n\
1362 from %u to %u, to fall on a head boundary",
1363 partition, (u_int)partp->dp_start,
1364 (u_int)(prev_head_boundary + dos_sectors));
1365 partp->dp_start = prev_head_boundary + dos_sectors;
1366 }
1367
1368 /*
1369 * Adjust size downwards, if necessary, to fall on a cylinder
1370 * boundary.
1371 */
1372 prev_cyl_boundary =
1373 ((partp->dp_start + partp->dp_size) / dos_cylsecs) * dos_cylsecs;
1374 if (prev_cyl_boundary > partp->dp_start)
1375 adj_size = prev_cyl_boundary - partp->dp_start;
1376 else
1377 {
1378 warnx(
1379 "ERROR: could not adjust partition to start on a head boundary\n\
1380 and end on a cylinder boundary.");
1381 return (0);
1382 }
1383 if (adj_size != partp->dp_size)
1384 {
1385 warnx(
1386 "WARNING: adjusting size of partition %d from %u to %u\n\
1387 to end on a cylinder boundary",
1388 partition, (u_int)partp->dp_size, (u_int)adj_size);
1389 partp->dp_size = adj_size;
1390 }
1391 if (partp->dp_size == 0)
1392 {
1393 warnx("ERROR line %d: size of partition %d is zero",
1394 current_line_number, partition);
1395 break;
1396 }
1397
1398 dos(partp);
1399 status = 1;
1400 break;
1401 }
1402 return (status);
1403}
1404
1405
1406static int
d2fd3c6a 1407process_active(CMD *command)
984263bc
MD		 1408{
1409 int status = 0, partition, i;
1410 struct dos_partition *partp;
1411
1412 while (1)
1413 {
1414 active_processed = 1;
1415 if (command->n_args != 1)
1416 {
1417 warnx("ERROR line %d: incorrect number of active args",
1418 current_line_number);
1419 status = 0;
1420 break;
1421 }
1422 partition = command->args[0].arg_val;
1423 if (partition < 1 || partition > 4)
1424 {
1425 warnx("ERROR line %d: invalid partition number %d",
1426 current_line_number, partition);
1427 break;
1428 }
1429 /*
1430 * Reset active partition
1431 */
1432 partp = ((struct dos_partition *) &mboot.parts);
1433 for (i = 0; i < NDOSPART; i++)
1434 partp[i].dp_flag = 0;
1435 partp[partition-1].dp_flag = ACTIVE;
1436
1437 status = 1;
1438 break;
1439 }
1440 return (status);
1441}
1442
1443
1444static int
d2fd3c6a 1445process_line(char *line)
984263bc
MD		 1446{
1447 CMD command;
1448 int status = 1;
1449
1450 while (1)
1451 {
1452 parse_config_line(line, &command);
1453 switch (command.cmd)
1454 {
1455 case 0:
1456 /*
1457 * Comment or blank line
1458 */
1459 break;
1460 case 'g':
1461 /*
1462 * Set geometry
1463 */
1464 status = process_geometry(&command);
1465 break;
1466 case 'p':
1467 status = process_partition(&command);
1468 break;
1469 case 'a':
1470 status = process_active(&command);
1471 break;
1472 default:
1473 status = 0;
1474 break;
1475 }
1476 break;
1477 }
1478 return (status);
1479}
1480
1481
1482static int
d2fd3c6a 1483read_config(char *config_file)
984263bc
MD		 1484{
1485 FILE *fp = NULL;
1486 int status = 1;
1487 char buf[1010];
1488
1489 while (1) /* dirty trick used to insure one exit point for this
1490 function */
1491 {
1492 if (strcmp(config_file, "-") != 0)
1493 {
1494 /*
1495 * We're not reading from stdin
1496 */
1497 if ((fp = fopen(config_file, "r")) == NULL)
1498 {
1499 status = 0;
1500 break;
1501 }
1502 }
1503 else
1504 {
1505 fp = stdin;
1506 }
1507 current_line_number = 0;
1508 while (!feof(fp))
1509 {
1510 if (fgets(buf, sizeof(buf), fp) == NULL)
1511 {
1512 break;
1513 }
1514 ++current_line_number;
1515 status = process_line(buf);
1516 if (status == 0)
1517 {
1518 break;
1519 }
1520 }
1521 break;
1522 }
1523 if (fp)
1524 {
1525 /*
1526 * It doesn't matter if we're reading from stdin, as we've reached EOF
1527 */
1528 fclose(fp);
1529 }
1530 return (status);
1531}
1532
1533
1534static void
1535reset_boot(void)
1536{
1537 int i;
1538 struct dos_partition *partp;
1539
1540 init_boot();
1541 for (i = 0; i < 4; ++i)
1542 {
1543 partp = ((struct dos_partition *) &mboot.parts) + i;
1544 bzero((char *)partp, sizeof (struct dos_partition));
1545 }
1546}
1547
1548static int
d2fd3c6a 1549sanitize_partition(struct dos_partition *partp)
984263bc
MD		 1550{
1551 u_int32_t prev_head_boundary, prev_cyl_boundary;
1552 u_int32_t max_end, size, start;
1553
1554 start = partp->dp_start;
1555 size = partp->dp_size;
1556 max_end = start + size;
1557 /* Only allow a zero size if the partition is being marked unused. */
1558 if (size == 0) {
1559 if (start == 0 && partp->dp_typ == 0)
1560 return (1);
1561 warnx("ERROR: size of partition is zero");
1562 return (0);
1563 }
1564 /* Return if no adjustment is necessary. */
1565 if (start % dos_sectors == 0 && (start + size) % dos_sectors == 0)
1566 return (1);
1567
c7928bfd
HP		 1568 if (start == 0) {
1569 warnx("WARNING: partition overlaps with partition table");
1570 if (ok("Correct this automatically?"))
1571 start = dos_sectors;
1572 }
984263bc
MD		 1573 if (start % dos_sectors != 0)
1574 warnx("WARNING: partition does not start on a head boundary");
1575 if ((start +size) % dos_sectors != 0)
1576 warnx("WARNING: partition does not end on a cylinder boundary");
1577 warnx("WARNING: this may confuse the BIOS or some operating systems");
1578 if (!ok("Correct this automatically?"))
1579 return (1);
1580
1581 /*
1582 * Adjust start upwards, if necessary, to fall on an head boundary.
1583 */
1584 if (start % dos_sectors != 0) {
1585 prev_head_boundary = start / dos_sectors * dos_sectors;
1586 if (max_end < dos_sectors ||
1587 prev_head_boundary >= max_end - dos_sectors) {
1588 /*
1589 * Can't go past end of partition
1590 */
1591 warnx(
1592 "ERROR: unable to adjust start of partition to fall on a head boundary");
1593 return (0);
1594 }
1595 start = prev_head_boundary + dos_sectors;
1596 }
1597
1598 /*
1599 * Adjust size downwards, if necessary, to fall on a cylinder
1600 * boundary.
1601 */
1602 prev_cyl_boundary = ((start + size) / dos_cylsecs) * dos_cylsecs;
1603 if (prev_cyl_boundary > start)
1604 size = prev_cyl_boundary - start;
1605 else {
1606 warnx("ERROR: could not adjust partition to start on a head boundary\n\
1607 and end on a cylinder boundary.");
1608 return (0);
1609 }
1610
1611 /* Finally, commit any changes to partp and return. */
1612 if (start != partp->dp_start) {
1613 warnx("WARNING: adjusting start offset of partition to %u",
1614 (u_int)start);
1615 partp->dp_start = start;
1616 }
1617 if (size != partp->dp_size) {
1618 warnx("WARNING: adjusting size of partition to %u", (u_int)size);
1619 partp->dp_size = size;
1620 }
1621
1622 return (1);
1623}
DragonFly Project GIT Source repo