Home | History | Annotate | Line # | Download | only in bad144
bad144.c revision 1.24
      1  1.24      elad /*	$NetBSD: bad144.c,v 1.24 2006/10/08 14:52:14 elad Exp $	*/
      2  1.10     mikel 
      3   1.1       cgd /*
      4   1.6   mycroft  * Copyright (c) 1980, 1986, 1988, 1993
      5   1.6   mycroft  *	The Regents of the University of California.  All rights reserved.
      6   1.1       cgd  *
      7   1.1       cgd  * Redistribution and use in source and binary forms, with or without
      8   1.1       cgd  * modification, are permitted provided that the following conditions
      9   1.1       cgd  * are met:
     10   1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     11   1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     12   1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     14   1.1       cgd  *    documentation and/or other materials provided with the distribution.
     15  1.21       agc  * 3. Neither the name of the University nor the names of its contributors
     16   1.1       cgd  *    may be used to endorse or promote products derived from this software
     17   1.1       cgd  *    without specific prior written permission.
     18   1.1       cgd  *
     19   1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     20   1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21   1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22   1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     23   1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24   1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25   1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26   1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27   1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28   1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29   1.1       cgd  * SUCH DAMAGE.
     30   1.1       cgd  */
     31   1.1       cgd 
     32  1.13     lukem #include <sys/cdefs.h>
     33   1.1       cgd #ifndef lint
     34  1.13     lukem __COPYRIGHT("@(#) Copyright (c) 1980, 1986, 1988, 1993\n\
     35  1.13     lukem 	The Regents of the University of California.  All rights reserved.\n");
     36  1.11     mikel #endif /* not lint */
     37   1.1       cgd 
     38   1.1       cgd #ifndef lint
     39  1.11     mikel #if 0
     40  1.11     mikel static char sccsid[] = "@(#)bad144.c	8.2 (Berkeley) 4/27/95";
     41  1.11     mikel #else
     42  1.24      elad __RCSID("$NetBSD: bad144.c,v 1.24 2006/10/08 14:52:14 elad Exp $");
     43  1.11     mikel #endif
     44  1.11     mikel #endif /* not lint */
     45   1.1       cgd 
     46   1.1       cgd /*
     47   1.1       cgd  * bad144
     48   1.1       cgd  *
     49   1.1       cgd  * This program prints and/or initializes a bad block record for a pack,
     50   1.1       cgd  * in the format used by the DEC standard 144.
     51   1.1       cgd  * It can also add bad sector(s) to the record, moving the sector
     52   1.1       cgd  * replacements as necessary.
     53   1.1       cgd  *
     54   1.1       cgd  * It is preferable to write the bad information with a standard formatter,
     55   1.1       cgd  * but this program will do.
     56   1.1       cgd  *
     57   1.1       cgd  * RP06 sectors are marked as bad by inverting the format bit in the
     58   1.1       cgd  * header; on other drives the valid-sector bit is cleared.
     59   1.1       cgd  */
     60   1.1       cgd #include <sys/param.h>
     61   1.1       cgd #include <sys/dkbad.h>
     62   1.1       cgd #include <sys/ioctl.h>
     63   1.1       cgd #include <sys/file.h>
     64   1.1       cgd #include <sys/disklabel.h>
     65  1.14      fvdl #include <ufs/ufs/dinode.h>
     66   1.6   mycroft #include <ufs/ffs/fs.h>
     67   1.1       cgd 
     68  1.13     lukem #include <err.h>
     69  1.13     lukem #include <paths.h>
     70   1.1       cgd #include <stdio.h>
     71  1.11     mikel #include <stdlib.h>
     72   1.9       cgd #include <string.h>
     73  1.11     mikel #include <unistd.h>
     74  1.13     lukem #include <util.h>
     75   1.1       cgd 
     76   1.1       cgd #define RETRIES	10		/* number of retries on reading old sectors */
     77   1.1       cgd 
     78  1.19       wiz #ifdef __vax__
     79  1.19       wiz int	fflag;
     80  1.19       wiz #endif
     81  1.19       wiz int	add, copy, verbose, nflag;
     82   1.1       cgd int	dups;
     83   1.1       cgd int	badfile = -1;		/* copy of badsector table to use, -1 if any */
     84   1.1       cgd #define MAXSECSIZE	1024
     85   1.1       cgd struct	dkbad curbad, oldbad;
     86   1.1       cgd #define	DKBAD_MAGIC	0x4321
     87   1.1       cgd 
     88  1.11     mikel daddr_t	size;
     89   1.1       cgd struct	disklabel *dp;
     90  1.19       wiz struct	disklabel label;
     91  1.24      elad char	diskname[MAXPATHLEN];
     92   1.1       cgd 
     93  1.16       wiz daddr_t	badsn(const struct bt_bad *);
     94  1.16       wiz int	blkcopy(int, daddr_t, daddr_t);
     95  1.16       wiz void	blkzero(int, daddr_t);
     96  1.16       wiz int	checkold(void);
     97  1.16       wiz int	compare(const void *, const void *);
     98  1.16       wiz daddr_t	getold(int, struct dkbad *);
     99  1.16       wiz int	main(int, char **);
    100  1.16       wiz void	shift(int, int, int);
    101  1.19       wiz void	usage(void);
    102  1.19       wiz 
    103  1.19       wiz #ifdef __vax__
    104  1.19       wiz #define OPTSTRING "01234acfvn"
    105  1.19       wiz #else
    106  1.19       wiz #define OPTSTRING "01234acvn"
    107  1.19       wiz #endif
    108  1.11     mikel 
    109  1.11     mikel int
    110  1.16       wiz main(int argc, char *argv[])
    111   1.1       cgd {
    112  1.11     mikel 	struct bt_bad *bt;
    113  1.18       wiz 	daddr_t	sn, bn[NBT_BAD];
    114  1.19       wiz 	int i, f, nbad, new, bad, errs, ch;
    115   1.1       cgd 
    116  1.19       wiz 	while ((ch = getopt(argc, argv, OPTSTRING)) != -1) {
    117  1.19       wiz 		switch (ch) {
    118  1.19       wiz 		case '0':
    119  1.19       wiz 		case '1':
    120  1.19       wiz 		case '2':
    121  1.19       wiz 		case '3':
    122  1.19       wiz 		case '4':
    123  1.19       wiz 			badfile = ch - '0';
    124  1.19       wiz 			break;
    125  1.19       wiz 		case 'a':
    126  1.19       wiz 			add = 1;
    127  1.19       wiz 			break;
    128  1.19       wiz 		case 'c':
    129  1.19       wiz 			copy = 1;
    130  1.19       wiz 			break;
    131  1.19       wiz #ifdef __vax__
    132  1.19       wiz 		case 'f':
    133  1.19       wiz 			fflag = 1;
    134  1.19       wiz 			break;
    135   1.1       cgd #endif
    136  1.19       wiz 		case 'n':
    137  1.19       wiz 			nflag = 1;
    138  1.19       wiz 			/* FALLTHROUGH */
    139  1.19       wiz 		case 'v':
    140  1.19       wiz 			verbose = 1;
    141  1.19       wiz 			break;
    142  1.19       wiz 		case '?':
    143  1.19       wiz 		default:
    144  1.19       wiz 			usage();
    145   1.1       cgd 		}
    146   1.1       cgd 	}
    147  1.19       wiz 
    148  1.19       wiz 	argc -= optind;
    149  1.19       wiz 	argv += optind;
    150  1.19       wiz 
    151   1.1       cgd 	if (argc < 1) {
    152  1.19       wiz 		usage();
    153   1.1       cgd 	}
    154  1.13     lukem 	f = opendisk(argv[0], argc == 1 ? O_RDONLY : O_RDWR, diskname,
    155  1.13     lukem 	    sizeof(diskname), 0);
    156   1.1       cgd 	if (f < 0)
    157  1.13     lukem 		err(4, "opendisk `%s'", diskname);
    158   1.1       cgd 	/* obtain label and adjust to fit */
    159  1.19       wiz 	dp = &label;
    160   1.1       cgd 	if (ioctl(f, DIOCGDINFO, dp) < 0)
    161  1.13     lukem 		err(4, "ioctl DIOCGDINFO `%s'", diskname);
    162   1.1       cgd 	if (dp->d_magic != DISKMAGIC || dp->d_magic2 != DISKMAGIC
    163  1.13     lukem 		/* dkcksum(lp) != 0 */ )
    164  1.13     lukem 		errx(1, "Bad pack magic number (pack is unlabeled)");
    165  1.19       wiz 	if (dp->d_secsize > MAXSECSIZE || dp->d_secsize == 0)
    166  1.13     lukem 		errx(7, "Disk sector size too large/small (%d)",
    167  1.13     lukem 		    dp->d_secsize);
    168  1.17       wiz #ifdef __i386__
    169  1.13     lukem 	if (dp->d_type == DTYPE_SCSI)
    170  1.13     lukem 		errx(1, "SCSI disks don't use bad144!");
    171   1.1       cgd 	/* are we inside a DOS partition? */
    172   1.1       cgd 	if (dp->d_partitions[0].p_offset) {
    173   1.1       cgd 		/* yes, rules change. assume bad tables at end of partition C,
    174   1.1       cgd 		   which maps all of DOS partition we are within -wfj */
    175   1.1       cgd 		size = dp->d_partitions[2].p_offset + dp->d_partitions[2].p_size;
    176  1.17       wiz 	}
    177   1.1       cgd #endif
    178   1.1       cgd 	size = dp->d_nsectors * dp->d_ntracks * dp->d_ncylinders;
    179   1.1       cgd 	argc--;
    180   1.1       cgd 	argv++;
    181   1.1       cgd 	if (argc == 0) {
    182   1.1       cgd 		sn = getold(f, &oldbad);
    183  1.20      fvdl 		printf("bad block information at sector %lld in %s:\n",
    184  1.20      fvdl 		    (long long)sn, name);
    185   1.1       cgd 		printf("cartridge serial number: %d(10)\n", oldbad.bt_csn);
    186   1.1       cgd 		switch (oldbad.bt_flag) {
    187   1.1       cgd 
    188   1.1       cgd 		case (u_short)-1:
    189   1.1       cgd 			printf("alignment cartridge\n");
    190   1.1       cgd 			break;
    191   1.1       cgd 
    192   1.1       cgd 		case DKBAD_MAGIC:
    193   1.1       cgd 			break;
    194   1.1       cgd 
    195   1.1       cgd 		default:
    196   1.1       cgd 			printf("bt_flag=%x(16)?\n", oldbad.bt_flag);
    197   1.1       cgd 			break;
    198   1.1       cgd 		}
    199   1.1       cgd 		bt = oldbad.bt_bad;
    200  1.18       wiz 		for (i = 0; i < NBT_BAD; i++) {
    201   1.1       cgd 			bad = (bt->bt_cyl<<16) + bt->bt_trksec;
    202   1.1       cgd 			if (bad < 0)
    203   1.1       cgd 				break;
    204  1.20      fvdl 			printf("sn=%lld, cn=%d, tn=%d, sn=%d\n",
    205  1.20      fvdl 			    (long long)badsn(bt),
    206   1.1       cgd 			    bt->bt_cyl, bt->bt_trksec>>8, bt->bt_trksec&0xff);
    207   1.1       cgd 			bt++;
    208   1.1       cgd 		}
    209  1.11     mikel 		(void) checkold();
    210   1.1       cgd 		exit(0);
    211   1.1       cgd 	}
    212   1.1       cgd 	if (add) {
    213   1.1       cgd 		/*
    214   1.1       cgd 		 * Read in the old badsector table.
    215   1.1       cgd 		 * Verify that it makes sense, and the bad sectors
    216   1.1       cgd 		 * are in order.  Copy the old table to the new one.
    217   1.1       cgd 		 */
    218   1.1       cgd 		(void) getold(f, &oldbad);
    219  1.11     mikel 		i = checkold();
    220   1.1       cgd 		if (verbose)
    221   1.1       cgd 			printf("Had %d bad sectors, adding %d\n", i, argc);
    222  1.18       wiz 		if (i + argc > NBT_BAD) {
    223   1.1       cgd 			printf("bad144: not enough room for %d more sectors\n",
    224   1.1       cgd 				argc);
    225  1.18       wiz 			printf("limited to %d by information format\n",
    226  1.18       wiz 			    NBT_BAD);
    227   1.1       cgd 			exit(1);
    228   1.1       cgd 		}
    229   1.1       cgd 		curbad = oldbad;
    230   1.1       cgd 	} else {
    231   1.1       cgd 		curbad.bt_csn = atoi(*argv++);
    232   1.1       cgd 		argc--;
    233   1.1       cgd 		curbad.bt_mbz = 0;
    234   1.1       cgd 		curbad.bt_flag = DKBAD_MAGIC;
    235  1.18       wiz 		if (argc > NBT_BAD) {
    236   1.1       cgd 			printf("bad144: too many bad sectors specified\n");
    237  1.18       wiz 			printf("limited to %d by information format\n",
    238  1.18       wiz 			    NBT_BAD);
    239   1.1       cgd 			exit(1);
    240   1.1       cgd 		}
    241   1.1       cgd 		i = 0;
    242   1.1       cgd 	}
    243   1.1       cgd 	errs = 0;
    244   1.1       cgd 	new = argc;
    245   1.1       cgd 	while (argc > 0) {
    246  1.17       wiz 		sn = atoi(*argv++);
    247   1.1       cgd 		argc--;
    248   1.1       cgd 		if (sn < 0 || sn >= size) {
    249  1.20      fvdl 			printf("%lld: out of range [0,%lld) for disk %s\n",
    250  1.20      fvdl 			    (long long)sn, (long long)size, dp->d_typename);
    251   1.1       cgd 			errs++;
    252   1.1       cgd 			continue;
    253   1.1       cgd 		}
    254   1.1       cgd 		bn[i] = sn;
    255   1.1       cgd 		curbad.bt_bad[i].bt_cyl = sn / (dp->d_nsectors*dp->d_ntracks);
    256   1.1       cgd 		sn %= (dp->d_nsectors*dp->d_ntracks);
    257   1.1       cgd 		curbad.bt_bad[i].bt_trksec =
    258   1.1       cgd 		    ((sn/dp->d_nsectors) << 8) + (sn%dp->d_nsectors);
    259   1.1       cgd 		i++;
    260   1.1       cgd 	}
    261   1.1       cgd 	if (errs)
    262   1.1       cgd 		exit(1);
    263   1.1       cgd 	nbad = i;
    264  1.18       wiz 	while (i < NBT_BAD) {
    265   1.1       cgd 		curbad.bt_bad[i].bt_trksec = -1;
    266   1.1       cgd 		curbad.bt_bad[i].bt_cyl = -1;
    267   1.1       cgd 		i++;
    268   1.1       cgd 	}
    269   1.1       cgd 	if (add) {
    270   1.1       cgd 		/*
    271   1.1       cgd 		 * Sort the new bad sectors into the list.
    272   1.1       cgd 		 * Then shuffle the replacement sectors so that
    273   1.1       cgd 		 * the previous bad sectors get the same replacement data.
    274   1.1       cgd 		 */
    275   1.1       cgd 		qsort((char *)curbad.bt_bad, nbad, sizeof (struct bt_bad),
    276   1.1       cgd 		    compare);
    277  1.13     lukem 		if (dups)
    278  1.19       wiz 			errx(3, "bad sectors have been duplicated; "
    279  1.19       wiz 			    "can't add existing sectors");
    280   1.1       cgd 		shift(f, nbad, nbad-new);
    281   1.1       cgd 	}
    282   1.1       cgd 	if (badfile == -1)
    283   1.1       cgd 		i = 0;
    284   1.1       cgd 	else
    285   1.1       cgd 		i = badfile * 2;
    286   1.1       cgd 	for (; i < 10 && i < dp->d_nsectors; i += 2) {
    287  1.11     mikel 		if (lseek(f,
    288  1.12    kleink 		    (off_t)(dp->d_secsize * (size - dp->d_nsectors + i)),
    289  1.12    kleink 		    SEEK_SET) < 0)
    290  1.13     lukem 			err(4, "lseek");
    291   1.1       cgd 		if (verbose)
    292  1.20      fvdl 			printf("write badsect file at %lld\n",
    293  1.20      fvdl 				(long long)size - dp->d_nsectors + i);
    294   1.1       cgd 		if (nflag == 0 && write(f, (caddr_t)&curbad, sizeof(curbad)) !=
    295  1.13     lukem 		    sizeof(curbad))
    296  1.13     lukem 			err(4, "write bad sector file %d", i/2);
    297   1.1       cgd 		if (badfile != -1)
    298   1.1       cgd 			break;
    299   1.1       cgd 	}
    300  1.15      matt #ifdef __vax__
    301   1.1       cgd 	if (nflag == 0 && fflag)
    302   1.1       cgd 		for (i = nbad - new; i < nbad; i++)
    303   1.1       cgd 			format(f, bn[i]);
    304   1.1       cgd #endif
    305   1.1       cgd #ifdef DIOCSBAD
    306   1.1       cgd 	if (nflag == 0 && ioctl(f, DIOCSBAD, (caddr_t)&curbad) < 0)
    307  1.19       wiz 		warnx("Can't sync bad-sector file; reboot for changes "
    308  1.19       wiz 		    "to take effect");
    309   1.1       cgd #endif
    310   1.1       cgd 	if ((dp->d_flags & D_BADSECT) == 0 && nflag == 0) {
    311   1.1       cgd 		dp->d_flags |= D_BADSECT;
    312   1.1       cgd 		if (ioctl(f, DIOCWDINFO, dp) < 0) {
    313  1.13     lukem 			warn("label");
    314  1.13     lukem 			errx(1,
    315  1.13     lukem 			    "Can't write label to enable bad sector handling");
    316   1.1       cgd 		}
    317   1.1       cgd 	}
    318  1.19       wiz 	return (0);
    319   1.1       cgd }
    320   1.1       cgd 
    321   1.1       cgd daddr_t
    322  1.16       wiz getold(int f, struct dkbad *bad)
    323   1.1       cgd {
    324  1.11     mikel 	int i;
    325   1.1       cgd 	daddr_t sn;
    326   1.1       cgd 
    327   1.1       cgd 	if (badfile == -1)
    328   1.1       cgd 		i = 0;
    329   1.1       cgd 	else
    330   1.1       cgd 		i = badfile * 2;
    331   1.1       cgd 	for (; i < 10 && i < dp->d_nsectors; i += 2) {
    332   1.1       cgd 		sn = size - dp->d_nsectors + i;
    333  1.12    kleink 		if (lseek(f, (off_t)(sn * dp->d_secsize), SEEK_SET) < 0)
    334  1.13     lukem 			err(4, "lseek");
    335   1.1       cgd 		if (read(f, (char *) bad, dp->d_secsize) == dp->d_secsize) {
    336   1.1       cgd 			if (i > 0)
    337   1.1       cgd 				printf("Using bad-sector file %d\n", i/2);
    338   1.1       cgd 			return(sn);
    339   1.1       cgd 		}
    340  1.20      fvdl 		warn("read bad sector file at sn %lld", (long long)sn);
    341   1.1       cgd 		if (badfile != -1)
    342   1.1       cgd 			break;
    343   1.1       cgd 	}
    344  1.24      elad 	errx(1, "%s: can't read bad block info", diskname);
    345   1.1       cgd 	/*NOTREACHED*/
    346   1.1       cgd }
    347   1.1       cgd 
    348  1.11     mikel int
    349  1.16       wiz checkold(void)
    350   1.1       cgd {
    351  1.13     lukem 	int i;
    352  1.13     lukem 	struct bt_bad *bt;
    353   1.1       cgd 	daddr_t sn, lsn;
    354   1.1       cgd 	int errors = 0, warned = 0;
    355   1.1       cgd 
    356  1.13     lukem 	lsn = 0;
    357   1.1       cgd 	if (oldbad.bt_flag != DKBAD_MAGIC) {
    358  1.24      elad 		warnx("%s: bad flag in bad-sector table", diskname);
    359   1.1       cgd 		errors++;
    360   1.1       cgd 	}
    361   1.1       cgd 	if (oldbad.bt_mbz != 0) {
    362  1.24      elad 		warnx("%s: bad magic number", diskname);
    363   1.1       cgd 		errors++;
    364   1.1       cgd 	}
    365   1.1       cgd 	bt = oldbad.bt_bad;
    366  1.18       wiz 	for (i = 0; i < NBT_BAD; i++, bt++) {
    367   1.1       cgd 		if (bt->bt_cyl == 0xffff && bt->bt_trksec == 0xffff)
    368   1.1       cgd 			break;
    369   1.1       cgd 		if ((bt->bt_cyl >= dp->d_ncylinders) ||
    370   1.1       cgd 		    ((bt->bt_trksec >> 8) >= dp->d_ntracks) ||
    371   1.1       cgd 		    ((bt->bt_trksec & 0xff) >= dp->d_nsectors)) {
    372  1.19       wiz 			warnx("cyl/trk/sect out of range in existing entry: "
    373  1.20      fvdl 			    "sn=%lld, cn=%d, tn=%d, sn=%d",
    374  1.20      fvdl 			    (long long)badsn(bt), bt->bt_cyl, bt->bt_trksec>>8,
    375  1.13     lukem 			    bt->bt_trksec & 0xff);
    376   1.1       cgd 			errors++;
    377   1.1       cgd 		}
    378   1.1       cgd 		sn = (bt->bt_cyl * dp->d_ntracks +
    379   1.1       cgd 		    (bt->bt_trksec >> 8)) *
    380   1.1       cgd 		    dp->d_nsectors + (bt->bt_trksec & 0xff);
    381   1.1       cgd 		if (i > 0 && sn < lsn && !warned) {
    382  1.13     lukem 		    warnx("bad sector file is out of order");
    383   1.1       cgd 		    errors++;
    384   1.1       cgd 		    warned++;
    385   1.1       cgd 		}
    386   1.1       cgd 		if (i > 0 && sn == lsn) {
    387  1.20      fvdl 		    warnx("bad sector file contains duplicates (sn %lld)",
    388  1.20      fvdl 			(long long)sn);
    389   1.1       cgd 		    errors++;
    390   1.1       cgd 		}
    391   1.1       cgd 		lsn = sn;
    392   1.1       cgd 	}
    393   1.1       cgd 	if (errors)
    394   1.1       cgd 		exit(1);
    395   1.1       cgd 	return (i);
    396   1.1       cgd }
    397   1.1       cgd 
    398   1.1       cgd /*
    399   1.1       cgd  * Move the bad sector replacements
    400   1.1       cgd  * to make room for the new bad sectors.
    401   1.1       cgd  * new is the new number of bad sectors, old is the previous count.
    402   1.1       cgd  */
    403  1.11     mikel void
    404  1.16       wiz shift(int f, int new, int old)
    405   1.1       cgd {
    406   1.1       cgd 	daddr_t repl;
    407   1.1       cgd 
    408   1.1       cgd 	/*
    409   1.1       cgd 	 * First replacement is last sector of second-to-last track.
    410   1.1       cgd 	 */
    411   1.1       cgd 	repl = size - dp->d_nsectors - 1;
    412   1.1       cgd 	new--; old--;
    413   1.1       cgd 	while (new >= 0 && new != old) {
    414   1.1       cgd 		if (old < 0 ||
    415   1.1       cgd 		    compare(&curbad.bt_bad[new], &oldbad.bt_bad[old]) > 0) {
    416   1.1       cgd 			/*
    417   1.1       cgd 			 * Insert new replacement here-- copy original
    418   1.1       cgd 			 * sector if requested and possible,
    419   1.1       cgd 			 * otherwise write a zero block.
    420   1.1       cgd 			 */
    421   1.1       cgd 			if (!copy ||
    422   1.1       cgd 			    !blkcopy(f, badsn(&curbad.bt_bad[new]), repl - new))
    423   1.1       cgd 				blkzero(f, repl - new);
    424   1.1       cgd 		} else {
    425   1.1       cgd 			if (blkcopy(f, repl - old, repl - new) == 0)
    426  1.20      fvdl 			    warnx("Can't copy replacement sector %lld to %lld",
    427  1.20      fvdl 				(long long)repl-old, (long long)repl-new);
    428   1.1       cgd 			old--;
    429   1.1       cgd 		}
    430   1.1       cgd 		new--;
    431   1.1       cgd 	}
    432   1.1       cgd }
    433   1.1       cgd 
    434   1.1       cgd char *buf;
    435   1.1       cgd 
    436   1.1       cgd /*
    437   1.1       cgd  *  Copy disk sector s1 to s2.
    438   1.1       cgd  */
    439  1.11     mikel int
    440  1.16       wiz blkcopy(int f, daddr_t s1, daddr_t s2)
    441   1.1       cgd {
    442  1.13     lukem 	int tries, n;
    443   1.1       cgd 
    444   1.1       cgd 	if (buf == (char *)NULL) {
    445   1.1       cgd 		buf = malloc((unsigned)dp->d_secsize);
    446  1.13     lukem 		if (buf == (char *)NULL)
    447  1.13     lukem 			errx(20, "Out of memory");
    448   1.1       cgd 	}
    449   1.1       cgd 	for (tries = 0; tries < RETRIES; tries++) {
    450  1.12    kleink 		if (lseek(f, (off_t)(dp->d_secsize * s1), SEEK_SET) < 0)
    451  1.13     lukem 			err(4, "lseek");
    452   1.1       cgd 		if ((n = read(f, buf, dp->d_secsize)) == dp->d_secsize)
    453   1.1       cgd 			break;
    454   1.1       cgd 	}
    455   1.1       cgd 	if (n != dp->d_secsize) {
    456   1.1       cgd 		if (n < 0)
    457  1.20      fvdl 			err(4, "can't read sector, %lld", (long long)s1);
    458  1.13     lukem 		else
    459  1.20      fvdl 			errx(4, "can't read sector, %lld", (long long)s1);
    460   1.1       cgd 		return(0);
    461   1.1       cgd 	}
    462  1.12    kleink 	if (lseek(f, (off_t)(dp->d_secsize * s2), SEEK_SET) < 0)
    463  1.13     lukem 		err(4, "lseek");
    464   1.1       cgd 	if (verbose)
    465  1.20      fvdl 		printf("copying %lld to %lld\n", (long long)s1, (long long)s2);
    466   1.1       cgd 	if (nflag == 0 && write(f, buf, dp->d_secsize) != dp->d_secsize) {
    467  1.20      fvdl 		warn("can't write replacement sector, %lld", (long long)s2);
    468   1.1       cgd 		return(0);
    469   1.1       cgd 	}
    470   1.1       cgd 	return(1);
    471   1.1       cgd }
    472   1.1       cgd 
    473  1.11     mikel void
    474  1.16       wiz blkzero(int f, daddr_t sn)
    475   1.1       cgd {
    476  1.18       wiz 	char *zbuf;
    477   1.1       cgd 
    478  1.19       wiz 	zbuf = calloc(1, (unsigned int)dp->d_secsize);
    479  1.19       wiz 	if (zbuf == NULL)
    480  1.19       wiz 		errx(20, "Out of memory");
    481  1.23  christos 	if (lseek(f, (off_t)(dp->d_secsize * sn), SEEK_SET) < 0) {
    482  1.23  christos 		free(zbuf);
    483  1.13     lukem 		err(4, "lseek");
    484  1.23  christos 	}
    485   1.1       cgd 	if (verbose)
    486  1.20      fvdl 		printf("zeroing %lld\n", (long long)sn);
    487  1.13     lukem 	if (nflag == 0 && write(f, zbuf, dp->d_secsize) != dp->d_secsize)
    488  1.20      fvdl 		warn("can't write replacement sector, %lld",
    489  1.20      fvdl 		    (long long)sn);
    490  1.22  christos 	free(zbuf);
    491   1.1       cgd }
    492   1.1       cgd 
    493  1.11     mikel int
    494  1.16       wiz compare(const void *v1, const void *v2)
    495   1.1       cgd {
    496  1.11     mikel 	const struct bt_bad *b1 = v1;
    497  1.11     mikel 	const struct bt_bad *b2 = v2;
    498  1.11     mikel 
    499   1.1       cgd 	if (b1->bt_cyl > b2->bt_cyl)
    500   1.1       cgd 		return(1);
    501   1.1       cgd 	if (b1->bt_cyl < b2->bt_cyl)
    502   1.1       cgd 		return(-1);
    503   1.1       cgd 	if (b1->bt_trksec == b2->bt_trksec)
    504   1.1       cgd 		dups++;
    505   1.1       cgd 	return (b1->bt_trksec - b2->bt_trksec);
    506   1.1       cgd }
    507   1.1       cgd 
    508   1.1       cgd daddr_t
    509  1.16       wiz badsn(const struct bt_bad *bt)
    510   1.1       cgd {
    511  1.11     mikel 
    512  1.11     mikel 	return ((bt->bt_cyl * dp->d_ntracks
    513  1.11     mikel 		+ (bt->bt_trksec >> 8)) * dp->d_nsectors
    514  1.11     mikel 		+ (bt->bt_trksec & 0xff));
    515   1.1       cgd }
    516   1.1       cgd 
    517  1.15      matt #ifdef __vax__
    518   1.1       cgd 
    519   1.1       cgd struct rp06hdr {
    520   1.1       cgd 	short	h_cyl;
    521   1.1       cgd 	short	h_trksec;
    522   1.1       cgd 	short	h_key1;
    523   1.1       cgd 	short	h_key2;
    524   1.1       cgd 	char	h_data[512];
    525   1.1       cgd #define	RP06_FMT	010000		/* 1 == 16 bit, 0 == 18 bit */
    526   1.1       cgd };
    527   1.1       cgd 
    528   1.1       cgd /*
    529   1.1       cgd  * Most massbus and unibus drives
    530   1.1       cgd  * have headers of this form
    531   1.1       cgd  */
    532   1.1       cgd struct hpuphdr {
    533   1.1       cgd 	u_short	hpup_cyl;
    534   1.1       cgd 	u_char	hpup_sect;
    535   1.1       cgd 	u_char	hpup_track;
    536   1.1       cgd 	char	hpup_data[512];
    537   1.1       cgd #define	HPUP_OKSECT	0xc000		/* this normally means sector is good */
    538   1.1       cgd #define	HPUP_16BIT	0x1000		/* 1 == 16 bit format */
    539   1.1       cgd };
    540  1.18       wiz int rp06format(struct formats *, struct disklabel *, daddr_t, char *, int);
    541  1.18       wiz int hpupformat(struct formats *, struct disklabel *, daddr_t, char *, int);
    542   1.1       cgd 
    543   1.1       cgd struct	formats {
    544   1.1       cgd 	char	*f_name;		/* disk name */
    545   1.1       cgd 	int	f_bufsize;		/* size of sector + header */
    546   1.1       cgd 	int	f_bic;			/* value to bic in hpup_cyl */
    547   1.1       cgd 	int	(*f_routine)();		/* routine for special handling */
    548   1.1       cgd } formats[] = {
    549   1.1       cgd 	{ "rp06",	sizeof (struct rp06hdr), RP06_FMT,	rp06format },
    550   1.1       cgd 	{ "eagle",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    551   1.1       cgd 	{ "capricorn",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    552   1.1       cgd 	{ "rm03",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    553   1.1       cgd 	{ "rm05",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    554   1.1       cgd 	{ "9300",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    555   1.1       cgd 	{ "9766",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    556   1.1       cgd 	{ 0, 0, 0, 0 }
    557   1.1       cgd };
    558   1.1       cgd 
    559   1.1       cgd /*ARGSUSED*/
    560  1.11     mikel int
    561  1.18       wiz hpupformat(struct formats *fp, struct disklabel *dp, daddr_t blk, char *buf,
    562  1.18       wiz 	   int count)
    563   1.1       cgd {
    564   1.1       cgd 	struct hpuphdr *hdr = (struct hpuphdr *)buf;
    565   1.1       cgd 	int sect;
    566   1.1       cgd 
    567   1.1       cgd 	if (count < sizeof(struct hpuphdr)) {
    568   1.1       cgd 		hdr->hpup_cyl = (HPUP_OKSECT | HPUP_16BIT) |
    569   1.1       cgd 			(blk / (dp->d_nsectors * dp->d_ntracks));
    570   1.1       cgd 		sect = blk % (dp->d_nsectors * dp->d_ntracks);
    571   1.1       cgd 		hdr->hpup_track = (u_char)(sect / dp->d_nsectors);
    572   1.1       cgd 		hdr->hpup_sect = (u_char)(sect % dp->d_nsectors);
    573   1.1       cgd 	}
    574   1.1       cgd 	return (0);
    575   1.1       cgd }
    576   1.1       cgd 
    577   1.1       cgd /*ARGSUSED*/
    578  1.11     mikel int
    579  1.18       wiz rp06format(struct formats *fp, struct disklabel *dp, daddr_t blk, char *buf,
    580  1.18       wiz 	   int count)
    581   1.1       cgd {
    582   1.1       cgd 
    583   1.1       cgd 	if (count < sizeof(struct rp06hdr)) {
    584  1.13     lukem 		warnx("Can't read header on blk %d, can't reformat", blk);
    585   1.1       cgd 		return (-1);
    586   1.1       cgd 	}
    587   1.1       cgd 	return (0);
    588   1.1       cgd }
    589   1.1       cgd 
    590  1.11     mikel void
    591  1.18       wiz format(int fd, daddr_t blk)
    592   1.1       cgd {
    593  1.13     lukem 	struct formats *fp;
    594   1.1       cgd 	static char *buf;
    595   1.1       cgd 	static char bufsize;
    596   1.1       cgd 	struct format_op fop;
    597   1.1       cgd 	int n;
    598   1.1       cgd 
    599   1.1       cgd 	for (fp = formats; fp->f_name; fp++)
    600   1.1       cgd 		if (strcmp(dp->d_typename, fp->f_name) == 0)
    601   1.1       cgd 			break;
    602  1.13     lukem 	if (fp->f_name == 0)
    603  1.13     lukem 		errx(2, "don't know how to format %s disks", dp->d_typename);
    604   1.1       cgd 	if (buf && bufsize < fp->f_bufsize) {
    605   1.1       cgd 		free(buf);
    606   1.1       cgd 		buf = NULL;
    607   1.1       cgd 	}
    608   1.1       cgd 	if (buf == NULL)
    609   1.1       cgd 		buf = malloc((unsigned)fp->f_bufsize);
    610  1.13     lukem 	if (buf == NULL)
    611  1.13     lukem 		errx(3, "can't allocate sector buffer");
    612   1.1       cgd 	bufsize = fp->f_bufsize;
    613   1.1       cgd 	/*
    614   1.1       cgd 	 * Here we do the actual formatting.  All we really
    615   1.1       cgd 	 * do is rewrite the sector header and flag the bad sector
    616   1.1       cgd 	 * according to the format table description.  If a special
    617   1.1       cgd 	 * purpose format routine is specified, we allow it to
    618   1.1       cgd 	 * process the sector as well.
    619   1.1       cgd 	 */
    620   1.1       cgd 	if (verbose)
    621   1.1       cgd 		printf("format blk %d\n", blk);
    622  1.13     lukem 	memset((char *)&fop, 0, sizeof(fop));
    623   1.1       cgd 	fop.df_buf = buf;
    624   1.1       cgd 	fop.df_count = fp->f_bufsize;
    625   1.1       cgd 	fop.df_startblk = blk;
    626  1.13     lukem 	memset(buf, 0, fp->f_bufsize);
    627   1.1       cgd 	if (ioctl(fd, DIOCRFORMAT, &fop) < 0)
    628  1.13     lukem 		warn("read format");
    629   1.1       cgd 	if (fp->f_routine &&
    630   1.1       cgd 	    (*fp->f_routine)(fp, dp, blk, buf, fop.df_count) != 0)
    631   1.1       cgd 		return;
    632   1.1       cgd 	if (fp->f_bic) {
    633   1.1       cgd 		struct hpuphdr *xp = (struct hpuphdr *)buf;
    634   1.1       cgd 
    635   1.1       cgd 		xp->hpup_cyl &= ~fp->f_bic;
    636   1.1       cgd 	}
    637   1.1       cgd 	if (nflag)
    638   1.1       cgd 		return;
    639  1.13     lukem 	memset((char *)&fop, 0, sizeof(fop));
    640   1.1       cgd 	fop.df_buf = buf;
    641   1.1       cgd 	fop.df_count = fp->f_bufsize;
    642   1.1       cgd 	fop.df_startblk = blk;
    643   1.1       cgd 	if (ioctl(fd, DIOCWFORMAT, &fop) < 0)
    644  1.13     lukem 		err(4, "write format");
    645  1.13     lukem 	if (fop.df_count != fp->f_bufsize)
    646  1.13     lukem 		warn("write format %d", blk);
    647   1.1       cgd }
    648   1.1       cgd #endif
    649  1.19       wiz 
    650  1.19       wiz void
    651  1.19       wiz usage(void)
    652  1.19       wiz {
    653  1.19       wiz 
    654  1.19       wiz 	fprintf(stderr, "usage: bad144 [-%sv] disk [sno [bad ...]]\n"
    655  1.19       wiz 	    "to read or overwrite the bad-sector table, e.g.: bad144 hp0\n"
    656  1.19       wiz 	    "or bad144 -a [-c%sv] disk [bad ...]\n"
    657  1.19       wiz 	    "where options are:\n"
    658  1.19       wiz 	    "\t-a  add new bad sectors to the table\n"
    659  1.19       wiz 	    "\t-c  copy original sector to replacement\n"
    660  1.19       wiz 	    "%s"
    661  1.19       wiz 	    "\t-v  verbose mode\n",
    662  1.19       wiz #ifdef __vax__
    663  1.19       wiz 	    "f", "f", "\t-f  reformat listed sectors as bad\n"
    664  1.19       wiz #else
    665  1.19       wiz 	    "", "", ""
    666  1.19       wiz #endif
    667  1.19       wiz 	    );
    668  1.19       wiz 	exit(1);
    669  1.19       wiz }
    670