TRIM support
[dragonfly.git] / sbin / fdisk / fdisk.c
1 /*
2  * Mach Operating System
3  * Copyright (c) 1992 Carnegie Mellon University
4  * All Rights Reserved.
5  *
6  * Permission to use, copy, modify and distribute this software and its
7  * documentation is hereby granted, provided that both the copyright
8  * notice and this permission notice appear in all copies of the
9  * software, derivative works or modified versions, and any portions
10  * thereof, and that both notices appear in supporting documentation.
11  *
12  * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
13  * CONDITION.  CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR
14  * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
15  *
16  * Carnegie Mellon requests users of this software to return to
17  *
18  *  Software Distribution Coordinator  or  Software.Distribution@CS.CMU.EDU
19  *  School of Computer Science
20  *  Carnegie Mellon University
21  *  Pittsburgh PA 15213-3890
22  *
23  * any improvements or extensions that they make and grant Carnegie Mellon
24  * the rights to redistribute these changes.
25  *
26  * $FreeBSD: /repoman/r/ncvs/src/sbin/i386/fdisk/fdisk.c,v 1.36.2.14 2004/01/30 14:40:47 harti Exp $
27  * $DragonFly: src/sbin/i386/fdisk/fdisk.c,v 1.16 2008/04/23 22:09:07 thomas Exp $
28  */
29
30 #include <sys/types.h>
31 #include <sys/diskslice.h>
32 #include <sys/diskmbr.h>
33 #include <sys/ioctl_compat.h>
34 #include <sys/sysctl.h>
35 #include <sys/stat.h>
36 #include <ctype.h>
37 #include <fcntl.h>
38 #include <err.h>
39 #include <fstab.h>
40 #include <errno.h>
41 #include <stdio.h>
42 #include <stdlib.h>
43 #include <string.h>
44 #include <unistd.h>
45
46 int iotest;
47
48 #define LBUF 100
49 static 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 */
70 int secsize = 0;                /* the sensed sector size */
71
72 const char *disk;
73 const char *disks[] =
74 {
75   "/dev/ad0", "/dev/da0", "/dev/vkd0", 0
76 };
77
78 int cyls, sectors, heads, cylsecs;
79 int64_t disksecs;
80
81 struct mboot
82 {
83         unsigned char padding[2]; /* force the longs to be long aligned */
84         unsigned char *bootinst;  /* boot code */
85         off_t bootinst_size;
86         struct  dos_partition parts[4];
87 };
88 struct mboot mboot = {{0}, NULL, 0};
89
90 #define ACTIVE 0x80
91 #define BOOT_MAGIC 0xAA55
92
93 int dos_cyls;
94 int dos_heads;
95 int dos_sectors;
96 int dos_cylsecs;
97
98 #define DOSSECT(s,c) ((s & 0x3f) | ((c >> 2) & 0xc0))
99 #define DOSCYL(c)       (c & 0xff)
100 #define MAXCYL          1023
101 static int partition = -1;
102
103
104 #define MAX_ARGS        10
105
106 static int      current_line_number;
107
108 static int      geom_processed = 0;
109 static int      part_processed = 0;
110 static int      active_processed = 0;
111
112
113 typedef struct cmd {
114     char                cmd;
115     int                 n_args;
116     struct arg {
117         char    argtype;
118         long long arg_val;
119     }                   args[MAX_ARGS];
120 } CMD;
121
122
123 static int B_flag  = 0;         /* replace boot code */
124 static int C_flag  = 0;         /* use wrapped values for CHS */
125 static int E_flag  = 0;         /* Erase through TRIM */
126 static int I_flag  = 0;         /* use entire disk for DragonFly */
127 static int a_flag  = 0;         /* set active partition */
128 static char *b_flag = NULL;     /* path to boot code */
129 static int i_flag  = 0;         /* replace partition data */
130 static int u_flag  = 0;         /* update partition data */
131 static int p_flag  = 0;         /* operate on a disk image file */
132 static int s_flag  = 0;         /* Print a summary and exit */
133 static int t_flag  = 0;         /* test only */
134 static char *f_flag = NULL;     /* Read config info from file */
135 static int v_flag  = 0;         /* Be verbose */
136
137 struct 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"}
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"}
166         ,{0x39, "plan9"}
167         ,{0x3C, "PartitionMagic recovery"}
168         ,{0x40, "VENIX 286"}
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)"}
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"}
178         ,{0x53, "DM6 Aux3"}
179         ,{0x54, "DM6"}
180         ,{0x55, "EZ-Drive (disk manager)"}
181         ,{0x56, "GB"}
182         ,{0x5C, "Priam Edisk (disk manager)"} /* according to S. Widlake */
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"}
187         ,{0x70, "DiskSecure Multi-Boot"}
188         ,{0x75, "PCIX"}
189         ,{0x77, "QNX4.x"}
190         ,{0x78, "QNX4.x 2nd part"}
191         ,{0x79, "QNX4.x 3rd part"}
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"}
196         ,{0x84, "OS/2 hidden C: drive"}
197         ,{0x85, "Linux extended"}
198         ,{0x86, "NTFS volume set??"}
199         ,{0x87, "NTFS volume set??"}
200         ,{0x93, "Amoeba filesystem"}
201         ,{0x94, "Amoeba bad block table"}
202         ,{0x9F, "BSD/OS"}
203         ,{0xA0, "Suspend to Disk"}
204         ,{0xA5, "DragonFly/FreeBSD/NetBSD/386BSD"}
205         ,{0xA6, "OpenBSD"}
206         ,{0xA7, "NEXTSTEP"}
207         ,{0xA9, "NetBSD"}
208         ,{0xAC, "IBM JFS"}
209         ,{0xB7, "BSDI BSD/386 filesystem"}
210         ,{0xB8, "BSDI BSD/386 swap"}
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"}
216         ,{0xDB, "Concurrent CPM or C.DOS or CTOS"}
217         ,{0xE1, "Speed"}
218         ,{0xE3, "Speed"}
219         ,{0xE4, "Speed"}
220         ,{0xEB, "BeOS file system"}
221         ,{0xEE, "EFI GPT"}
222         ,{0xEF, "EFI System Partition"}
223         ,{0xF1, "Speed"}
224         ,{0xF2, "DOS 3.3+ Secondary"}
225         ,{0xF4, "Speed"}
226         ,{0xFE, "SpeedStor >1024 cyl. or LANstep"}
227         ,{0xFF, "BBT (Bad Blocks Table)"}
228 };
229
230 static void print_s0(int which);
231 static void print_part(int i);
232 static void init_sector0(unsigned long start);
233 static void init_boot(void);
234 static void change_part(int i);
235 static void print_params();
236 static void change_active(int which);
237 static void change_code();
238 static void get_params_to_use();
239 static void dos(struct dos_partition *partp);
240 static int open_disk(int u_flag);
241 static void erase_partition(int i);
242 static ssize_t read_disk(off_t sector, void *buf);
243 static ssize_t write_disk(off_t sector, void *buf);
244 static int get_params();
245 static int read_s0();
246 static int write_s0();
247 static int ok(char *str);
248 static int decimal(char *str, int *num, int deflt);
249 static char *get_type(int type);
250 static int read_config(char *config_file);
251 static void reset_boot(void);
252 static int sanitize_partition(struct dos_partition *);
253 static void usage(void);
254 #if 0
255 static int hex(char *str, int *num, int deflt);
256 static int string(char *str, char **ans);
257 #endif
258
259
260 int
261 main(int argc, char *argv[])
262 {
263         int     c, i;
264
265         while ((c = getopt(argc, argv, "BCEIab:f:p:istuv1234")) != -1)
266                 switch (c) {
267                 case 'B':
268                         B_flag = 1;
269                         break;
270                 case 'C':
271                         C_flag = 1;
272                         break;
273                 case 'E':
274                         E_flag = 1;
275                         break;
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;
288                 case 'p':
289                         disk = optarg;
290                         p_flag = 1;
291                         break;
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
323         if (argc > 0) {
324                 disk = getdevpath(argv[0], 0);
325                 if (open_disk(u_flag) < 0)
326                         err(1, "cannot open disk %s", disk);
327         } else if (disk == NULL) {
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");
338         } else {
339                 if (open_disk(u_flag) < 0)
340                         err(1, "cannot open disk %s", disk);
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;
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                 }
391                 dos(partp);
392                 if (v_flag)
393                         print_s0(-1);
394
395                 if (E_flag) {
396                         /* Trim now if we're using the entire device */
397                         erase_partition(0);
398                 }
399
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)    {
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                         }
472                         write_s0();
473                     }
474                 }
475                 else
476                 {
477                     printf("\n-t flag specified -- partition table not written.\n");
478                 }
479             }
480         }
481
482         exit(0);
483 }
484
485 static void
486 usage(void)
487 {
488         fprintf(stderr, "%s%s",
489                 "usage: fdisk [-BCIaistu] [-b bootcode] [-p diskimage] [-1234] [disk]\n",
490                 "       fdisk -f configfile [-itv] [disk]\n");
491         exit(1);
492 }
493
494 static void
495 print_s0(int which)
496 {
497         int     i;
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
508 static struct dos_partition mtpart = { 0 };
509
510 static void
511 print_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));
529         printf("    start %lu, size %lu (%jd Meg), flag %x%s\n",
530                 (u_long)partp->dp_start,
531                 (u_long)partp->dp_size,
532                 (intmax_t)part_mb,
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
545 static void
546 init_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
570 static void
571 init_sector0(unsigned long start)
572 {
573 struct 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;
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         }
589
590         dos(partp);
591 }
592
593 static void
594 change_part(int i)
595 {
596 struct 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 {
614                 Decimal("sysid (165=DragonFly)", partp->dp_typ, tmp);
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);
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                         }
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);
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                         }
658                 } else
659                         dos(partp);
660
661                 print_part(i);
662         } while (!ok("Are we happy with this entry?"));
663     }
664 }
665
666 static void
667 print_params(void)
668 {
669         printf("parameters extracted from device are:\n");
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
679 static void
680 change_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;
700 setactive:
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
717 static void
718 change_code(void)
719 {
720         if (ok("Do you want to change the boot code?"))
721                 init_boot();
722 }
723
724 void
725 get_params_to_use(void)
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 \***********************************************/
747 static void
748 dos(struct dos_partition *partp)
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. */
759         cy = partp->dp_start / dos_cylsecs;
760         sec = partp->dp_start % dos_sectors + 1;
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         }
771
772         /* End c/h/s. */
773         end = partp->dp_start + partp->dp_size - 1;
774         cy = end / dos_cylsecs;
775         sec = end % dos_sectors + 1;
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         }
786 }
787
788 int fd;
789
790 static void
791 erase_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
830         /* Getting device status */
831
832 static int
833 open_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         }
843         if ( !(st.st_mode & S_IFCHR) && p_flag == 0 )
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         }
852         if (get_params() == -1) {
853                 warnx("can't get disk parameters on %s", disk);
854                 return -1;
855         }
856         return fd;
857 }
858
859 static ssize_t
860 read_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
879 static ssize_t
880 write_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
887 static int
888 get_params(void)
889 {
890     struct partinfo partinfo;   /* disk parameters */
891     struct stat st;
892
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      */
900     if (ioctl(fd, DIOCGPART, &partinfo) == -1) {
901         if (p_flag && fstat(fd, &st) == 0 && st.st_size) {
902             sectors = 63;
903             heads = 255;
904             cylsecs = heads * sectors;
905             cyls = st.st_size / 512 / cylsecs;
906         } else {
907             warnx("can't get disk parameters on %s; supplying dummy ones",
908                   disk);
909             heads = 1;
910             cylsecs = heads * sectors;
911         }
912     } else {
913         cyls = partinfo.d_ncylinders;
914         heads = partinfo.d_nheads;
915         sectors = partinfo.d_secpertrack;
916         cylsecs = heads * sectors;
917         secsize = partinfo.media_blksize;
918     }
919     dos_cyls = cyls;
920     dos_heads = heads;
921     dos_sectors = sectors;
922     dos_cylsecs = cylsecs;
923     disksecs = (int64_t)cyls * heads * sectors;
924     return (disksecs);
925 }
926 \f
927
928 static int
929 read_s0(void)
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
952 static int
953 write_s0(void)
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
976         for(sector = 0; sector < mboot.bootinst_size / secsize; sector++)
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;
983                         ioctl(fd, DIOCWLABEL, &flag);
984 #endif
985                 }
986 #ifdef NOT_NOW
987         flag = 0;
988         ioctl(fd, DIOCWLABEL, &flag);
989 #endif
990         return(0);
991 }
992
993
994 static int
995 ok(char *str)
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
1011 static int
1012 decimal(char *str, int *num, int deflt)
1013 {
1014 int acc = 0, c;
1015 char *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
1050 static int
1051 hex(char *str, int *num, int deflt)
1052 {
1053 int acc = 0, c;
1054 char *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
1090 static int
1091 string(char *str, char **ans)
1092 {
1093 int c;
1094 char *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
1121 static char *
1122 get_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
1142 static void
1143 parse_config_line(char *line, CMD *command)
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;
1179             command->args[command->n_args].arg_val = strtoll(cp, &end, 0);
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
1192 static int
1193 process_geometry(CMD *command)
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\
1262     is dedicated to DragonFly)",
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
1298 static int
1299 process_partition(CMD *command)
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
1406 static int
1407 process_active(CMD *command)
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
1444 static int
1445 process_line(char *line)
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
1482 static int
1483 read_config(char *config_file)
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
1534 static void
1535 reset_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
1548 static int
1549 sanitize_partition(struct dos_partition *partp)
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
1568     if (start == 0) {
1569             warnx("WARNING: partition overlaps with partition table");
1570             if (ok("Correct this automatically?"))
1571                     start = dos_sectors;
1572     }
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 }