Home | History | Annotate | Line # | Download | only in bad144
bad144.c revision 1.21
      1  1.21      agc /*	$NetBSD: bad144.c,v 1.21 2003/08/07 11:25:13 agc 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.21      agc __RCSID("$NetBSD: bad144.c,v 1.21 2003/08/07 11:25:13 agc 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.1      cgd char	name[BUFSIZ];
     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.13    lukem 	char diskname[MAXPATHLEN];
    116   1.1      cgd 
    117  1.19      wiz 	while ((ch = getopt(argc, argv, OPTSTRING)) != -1) {
    118  1.19      wiz 		switch (ch) {
    119  1.19      wiz 		case '0':
    120  1.19      wiz 		case '1':
    121  1.19      wiz 		case '2':
    122  1.19      wiz 		case '3':
    123  1.19      wiz 		case '4':
    124  1.19      wiz 			badfile = ch - '0';
    125  1.19      wiz 			break;
    126  1.19      wiz 		case 'a':
    127  1.19      wiz 			add = 1;
    128  1.19      wiz 			break;
    129  1.19      wiz 		case 'c':
    130  1.19      wiz 			copy = 1;
    131  1.19      wiz 			break;
    132  1.19      wiz #ifdef __vax__
    133  1.19      wiz 		case 'f':
    134  1.19      wiz 			fflag = 1;
    135  1.19      wiz 			break;
    136   1.1      cgd #endif
    137  1.19      wiz 		case 'n':
    138  1.19      wiz 			nflag = 1;
    139  1.19      wiz 			/* FALLTHROUGH */
    140  1.19      wiz 		case 'v':
    141  1.19      wiz 			verbose = 1;
    142  1.19      wiz 			break;
    143  1.19      wiz 		case '?':
    144  1.19      wiz 		default:
    145  1.19      wiz 			usage();
    146   1.1      cgd 		}
    147   1.1      cgd 	}
    148  1.19      wiz 
    149  1.19      wiz 	argc -= optind;
    150  1.19      wiz 	argv += optind;
    151  1.19      wiz 
    152   1.1      cgd 	if (argc < 1) {
    153  1.19      wiz 		usage();
    154   1.1      cgd 	}
    155  1.13    lukem 	f = opendisk(argv[0], argc == 1 ? O_RDONLY : O_RDWR, diskname,
    156  1.13    lukem 	    sizeof(diskname), 0);
    157   1.1      cgd 	if (f < 0)
    158  1.13    lukem 		err(4, "opendisk `%s'", diskname);
    159   1.1      cgd 	/* obtain label and adjust to fit */
    160  1.19      wiz 	dp = &label;
    161   1.1      cgd 	if (ioctl(f, DIOCGDINFO, dp) < 0)
    162  1.13    lukem 		err(4, "ioctl DIOCGDINFO `%s'", diskname);
    163   1.1      cgd 	if (dp->d_magic != DISKMAGIC || dp->d_magic2 != DISKMAGIC
    164  1.13    lukem 		/* dkcksum(lp) != 0 */ )
    165  1.13    lukem 		errx(1, "Bad pack magic number (pack is unlabeled)");
    166  1.19      wiz 	if (dp->d_secsize > MAXSECSIZE || dp->d_secsize == 0)
    167  1.13    lukem 		errx(7, "Disk sector size too large/small (%d)",
    168  1.13    lukem 		    dp->d_secsize);
    169  1.17      wiz #ifdef __i386__
    170  1.13    lukem 	if (dp->d_type == DTYPE_SCSI)
    171  1.13    lukem 		errx(1, "SCSI disks don't use bad144!");
    172   1.1      cgd 	/* are we inside a DOS partition? */
    173   1.1      cgd 	if (dp->d_partitions[0].p_offset) {
    174   1.1      cgd 		/* yes, rules change. assume bad tables at end of partition C,
    175   1.1      cgd 		   which maps all of DOS partition we are within -wfj */
    176   1.1      cgd 		size = dp->d_partitions[2].p_offset + dp->d_partitions[2].p_size;
    177  1.17      wiz 	}
    178   1.1      cgd #endif
    179   1.1      cgd 	size = dp->d_nsectors * dp->d_ntracks * dp->d_ncylinders;
    180   1.1      cgd 	argc--;
    181   1.1      cgd 	argv++;
    182   1.1      cgd 	if (argc == 0) {
    183   1.1      cgd 		sn = getold(f, &oldbad);
    184  1.20     fvdl 		printf("bad block information at sector %lld in %s:\n",
    185  1.20     fvdl 		    (long long)sn, name);
    186   1.1      cgd 		printf("cartridge serial number: %d(10)\n", oldbad.bt_csn);
    187   1.1      cgd 		switch (oldbad.bt_flag) {
    188   1.1      cgd 
    189   1.1      cgd 		case (u_short)-1:
    190   1.1      cgd 			printf("alignment cartridge\n");
    191   1.1      cgd 			break;
    192   1.1      cgd 
    193   1.1      cgd 		case DKBAD_MAGIC:
    194   1.1      cgd 			break;
    195   1.1      cgd 
    196   1.1      cgd 		default:
    197   1.1      cgd 			printf("bt_flag=%x(16)?\n", oldbad.bt_flag);
    198   1.1      cgd 			break;
    199   1.1      cgd 		}
    200   1.1      cgd 		bt = oldbad.bt_bad;
    201  1.18      wiz 		for (i = 0; i < NBT_BAD; i++) {
    202   1.1      cgd 			bad = (bt->bt_cyl<<16) + bt->bt_trksec;
    203   1.1      cgd 			if (bad < 0)
    204   1.1      cgd 				break;
    205  1.20     fvdl 			printf("sn=%lld, cn=%d, tn=%d, sn=%d\n",
    206  1.20     fvdl 			    (long long)badsn(bt),
    207   1.1      cgd 			    bt->bt_cyl, bt->bt_trksec>>8, bt->bt_trksec&0xff);
    208   1.1      cgd 			bt++;
    209   1.1      cgd 		}
    210  1.11    mikel 		(void) checkold();
    211   1.1      cgd 		exit(0);
    212   1.1      cgd 	}
    213   1.1      cgd 	if (add) {
    214   1.1      cgd 		/*
    215   1.1      cgd 		 * Read in the old badsector table.
    216   1.1      cgd 		 * Verify that it makes sense, and the bad sectors
    217   1.1      cgd 		 * are in order.  Copy the old table to the new one.
    218   1.1      cgd 		 */
    219   1.1      cgd 		(void) getold(f, &oldbad);
    220  1.11    mikel 		i = checkold();
    221   1.1      cgd 		if (verbose)
    222   1.1      cgd 			printf("Had %d bad sectors, adding %d\n", i, argc);
    223  1.18      wiz 		if (i + argc > NBT_BAD) {
    224   1.1      cgd 			printf("bad144: not enough room for %d more sectors\n",
    225   1.1      cgd 				argc);
    226  1.18      wiz 			printf("limited to %d by information format\n",
    227  1.18      wiz 			    NBT_BAD);
    228   1.1      cgd 			exit(1);
    229   1.1      cgd 		}
    230   1.1      cgd 		curbad = oldbad;
    231   1.1      cgd 	} else {
    232   1.1      cgd 		curbad.bt_csn = atoi(*argv++);
    233   1.1      cgd 		argc--;
    234   1.1      cgd 		curbad.bt_mbz = 0;
    235   1.1      cgd 		curbad.bt_flag = DKBAD_MAGIC;
    236  1.18      wiz 		if (argc > NBT_BAD) {
    237   1.1      cgd 			printf("bad144: too many bad sectors specified\n");
    238  1.18      wiz 			printf("limited to %d by information format\n",
    239  1.18      wiz 			    NBT_BAD);
    240   1.1      cgd 			exit(1);
    241   1.1      cgd 		}
    242   1.1      cgd 		i = 0;
    243   1.1      cgd 	}
    244   1.1      cgd 	errs = 0;
    245   1.1      cgd 	new = argc;
    246   1.1      cgd 	while (argc > 0) {
    247  1.17      wiz 		sn = atoi(*argv++);
    248   1.1      cgd 		argc--;
    249   1.1      cgd 		if (sn < 0 || sn >= size) {
    250  1.20     fvdl 			printf("%lld: out of range [0,%lld) for disk %s\n",
    251  1.20     fvdl 			    (long long)sn, (long long)size, dp->d_typename);
    252   1.1      cgd 			errs++;
    253   1.1      cgd 			continue;
    254   1.1      cgd 		}
    255   1.1      cgd 		bn[i] = sn;
    256   1.1      cgd 		curbad.bt_bad[i].bt_cyl = sn / (dp->d_nsectors*dp->d_ntracks);
    257   1.1      cgd 		sn %= (dp->d_nsectors*dp->d_ntracks);
    258   1.1      cgd 		curbad.bt_bad[i].bt_trksec =
    259   1.1      cgd 		    ((sn/dp->d_nsectors) << 8) + (sn%dp->d_nsectors);
    260   1.1      cgd 		i++;
    261   1.1      cgd 	}
    262   1.1      cgd 	if (errs)
    263   1.1      cgd 		exit(1);
    264   1.1      cgd 	nbad = i;
    265  1.18      wiz 	while (i < NBT_BAD) {
    266   1.1      cgd 		curbad.bt_bad[i].bt_trksec = -1;
    267   1.1      cgd 		curbad.bt_bad[i].bt_cyl = -1;
    268   1.1      cgd 		i++;
    269   1.1      cgd 	}
    270   1.1      cgd 	if (add) {
    271   1.1      cgd 		/*
    272   1.1      cgd 		 * Sort the new bad sectors into the list.
    273   1.1      cgd 		 * Then shuffle the replacement sectors so that
    274   1.1      cgd 		 * the previous bad sectors get the same replacement data.
    275   1.1      cgd 		 */
    276   1.1      cgd 		qsort((char *)curbad.bt_bad, nbad, sizeof (struct bt_bad),
    277   1.1      cgd 		    compare);
    278  1.13    lukem 		if (dups)
    279  1.19      wiz 			errx(3, "bad sectors have been duplicated; "
    280  1.19      wiz 			    "can't add existing sectors");
    281   1.1      cgd 		shift(f, nbad, nbad-new);
    282   1.1      cgd 	}
    283   1.1      cgd 	if (badfile == -1)
    284   1.1      cgd 		i = 0;
    285   1.1      cgd 	else
    286   1.1      cgd 		i = badfile * 2;
    287   1.1      cgd 	for (; i < 10 && i < dp->d_nsectors; i += 2) {
    288  1.11    mikel 		if (lseek(f,
    289  1.12   kleink 		    (off_t)(dp->d_secsize * (size - dp->d_nsectors + i)),
    290  1.12   kleink 		    SEEK_SET) < 0)
    291  1.13    lukem 			err(4, "lseek");
    292   1.1      cgd 		if (verbose)
    293  1.20     fvdl 			printf("write badsect file at %lld\n",
    294  1.20     fvdl 				(long long)size - dp->d_nsectors + i);
    295   1.1      cgd 		if (nflag == 0 && write(f, (caddr_t)&curbad, sizeof(curbad)) !=
    296  1.13    lukem 		    sizeof(curbad))
    297  1.13    lukem 			err(4, "write bad sector file %d", i/2);
    298   1.1      cgd 		if (badfile != -1)
    299   1.1      cgd 			break;
    300   1.1      cgd 	}
    301  1.15     matt #ifdef __vax__
    302   1.1      cgd 	if (nflag == 0 && fflag)
    303   1.1      cgd 		for (i = nbad - new; i < nbad; i++)
    304   1.1      cgd 			format(f, bn[i]);
    305   1.1      cgd #endif
    306   1.1      cgd #ifdef DIOCSBAD
    307   1.1      cgd 	if (nflag == 0 && ioctl(f, DIOCSBAD, (caddr_t)&curbad) < 0)
    308  1.19      wiz 		warnx("Can't sync bad-sector file; reboot for changes "
    309  1.19      wiz 		    "to take effect");
    310   1.1      cgd #endif
    311   1.1      cgd 	if ((dp->d_flags & D_BADSECT) == 0 && nflag == 0) {
    312   1.1      cgd 		dp->d_flags |= D_BADSECT;
    313   1.1      cgd 		if (ioctl(f, DIOCWDINFO, dp) < 0) {
    314  1.13    lukem 			warn("label");
    315  1.13    lukem 			errx(1,
    316  1.13    lukem 			    "Can't write label to enable bad sector handling");
    317   1.1      cgd 		}
    318   1.1      cgd 	}
    319  1.19      wiz 	return (0);
    320   1.1      cgd }
    321   1.1      cgd 
    322   1.1      cgd daddr_t
    323  1.16      wiz getold(int f, struct dkbad *bad)
    324   1.1      cgd {
    325  1.11    mikel 	int i;
    326   1.1      cgd 	daddr_t sn;
    327   1.1      cgd 
    328   1.1      cgd 	if (badfile == -1)
    329   1.1      cgd 		i = 0;
    330   1.1      cgd 	else
    331   1.1      cgd 		i = badfile * 2;
    332   1.1      cgd 	for (; i < 10 && i < dp->d_nsectors; i += 2) {
    333   1.1      cgd 		sn = size - dp->d_nsectors + i;
    334  1.12   kleink 		if (lseek(f, (off_t)(sn * dp->d_secsize), SEEK_SET) < 0)
    335  1.13    lukem 			err(4, "lseek");
    336   1.1      cgd 		if (read(f, (char *) bad, dp->d_secsize) == dp->d_secsize) {
    337   1.1      cgd 			if (i > 0)
    338   1.1      cgd 				printf("Using bad-sector file %d\n", i/2);
    339   1.1      cgd 			return(sn);
    340   1.1      cgd 		}
    341  1.20     fvdl 		warn("read bad sector file at sn %lld", (long long)sn);
    342   1.1      cgd 		if (badfile != -1)
    343   1.1      cgd 			break;
    344   1.1      cgd 	}
    345  1.13    lukem 	errx(1, "%s: can't read bad block info", name);
    346   1.1      cgd 	/*NOTREACHED*/
    347   1.1      cgd }
    348   1.1      cgd 
    349  1.11    mikel int
    350  1.16      wiz checkold(void)
    351   1.1      cgd {
    352  1.13    lukem 	int i;
    353  1.13    lukem 	struct bt_bad *bt;
    354   1.1      cgd 	daddr_t sn, lsn;
    355   1.1      cgd 	int errors = 0, warned = 0;
    356   1.1      cgd 
    357  1.13    lukem 	lsn = 0;
    358   1.1      cgd 	if (oldbad.bt_flag != DKBAD_MAGIC) {
    359  1.13    lukem 		warnx("%s: bad flag in bad-sector table", name);
    360   1.1      cgd 		errors++;
    361   1.1      cgd 	}
    362   1.1      cgd 	if (oldbad.bt_mbz != 0) {
    363  1.13    lukem 		warnx("%s: bad magic number", name);
    364   1.1      cgd 		errors++;
    365   1.1      cgd 	}
    366   1.1      cgd 	bt = oldbad.bt_bad;
    367  1.18      wiz 	for (i = 0; i < NBT_BAD; i++, bt++) {
    368   1.1      cgd 		if (bt->bt_cyl == 0xffff && bt->bt_trksec == 0xffff)
    369   1.1      cgd 			break;
    370   1.1      cgd 		if ((bt->bt_cyl >= dp->d_ncylinders) ||
    371   1.1      cgd 		    ((bt->bt_trksec >> 8) >= dp->d_ntracks) ||
    372   1.1      cgd 		    ((bt->bt_trksec & 0xff) >= dp->d_nsectors)) {
    373  1.19      wiz 			warnx("cyl/trk/sect out of range in existing entry: "
    374  1.20     fvdl 			    "sn=%lld, cn=%d, tn=%d, sn=%d",
    375  1.20     fvdl 			    (long long)badsn(bt), bt->bt_cyl, bt->bt_trksec>>8,
    376  1.13    lukem 			    bt->bt_trksec & 0xff);
    377   1.1      cgd 			errors++;
    378   1.1      cgd 		}
    379   1.1      cgd 		sn = (bt->bt_cyl * dp->d_ntracks +
    380   1.1      cgd 		    (bt->bt_trksec >> 8)) *
    381   1.1      cgd 		    dp->d_nsectors + (bt->bt_trksec & 0xff);
    382   1.1      cgd 		if (i > 0 && sn < lsn && !warned) {
    383  1.13    lukem 		    warnx("bad sector file is out of order");
    384   1.1      cgd 		    errors++;
    385   1.1      cgd 		    warned++;
    386   1.1      cgd 		}
    387   1.1      cgd 		if (i > 0 && sn == lsn) {
    388  1.20     fvdl 		    warnx("bad sector file contains duplicates (sn %lld)",
    389  1.20     fvdl 			(long long)sn);
    390   1.1      cgd 		    errors++;
    391   1.1      cgd 		}
    392   1.1      cgd 		lsn = sn;
    393   1.1      cgd 	}
    394   1.1      cgd 	if (errors)
    395   1.1      cgd 		exit(1);
    396   1.1      cgd 	return (i);
    397   1.1      cgd }
    398   1.1      cgd 
    399   1.1      cgd /*
    400   1.1      cgd  * Move the bad sector replacements
    401   1.1      cgd  * to make room for the new bad sectors.
    402   1.1      cgd  * new is the new number of bad sectors, old is the previous count.
    403   1.1      cgd  */
    404  1.11    mikel void
    405  1.16      wiz shift(int f, int new, int old)
    406   1.1      cgd {
    407   1.1      cgd 	daddr_t repl;
    408   1.1      cgd 
    409   1.1      cgd 	/*
    410   1.1      cgd 	 * First replacement is last sector of second-to-last track.
    411   1.1      cgd 	 */
    412   1.1      cgd 	repl = size - dp->d_nsectors - 1;
    413   1.1      cgd 	new--; old--;
    414   1.1      cgd 	while (new >= 0 && new != old) {
    415   1.1      cgd 		if (old < 0 ||
    416   1.1      cgd 		    compare(&curbad.bt_bad[new], &oldbad.bt_bad[old]) > 0) {
    417   1.1      cgd 			/*
    418   1.1      cgd 			 * Insert new replacement here-- copy original
    419   1.1      cgd 			 * sector if requested and possible,
    420   1.1      cgd 			 * otherwise write a zero block.
    421   1.1      cgd 			 */
    422   1.1      cgd 			if (!copy ||
    423   1.1      cgd 			    !blkcopy(f, badsn(&curbad.bt_bad[new]), repl - new))
    424   1.1      cgd 				blkzero(f, repl - new);
    425   1.1      cgd 		} else {
    426   1.1      cgd 			if (blkcopy(f, repl - old, repl - new) == 0)
    427  1.20     fvdl 			    warnx("Can't copy replacement sector %lld to %lld",
    428  1.20     fvdl 				(long long)repl-old, (long long)repl-new);
    429   1.1      cgd 			old--;
    430   1.1      cgd 		}
    431   1.1      cgd 		new--;
    432   1.1      cgd 	}
    433   1.1      cgd }
    434   1.1      cgd 
    435   1.1      cgd char *buf;
    436   1.1      cgd 
    437   1.1      cgd /*
    438   1.1      cgd  *  Copy disk sector s1 to s2.
    439   1.1      cgd  */
    440  1.11    mikel int
    441  1.16      wiz blkcopy(int f, daddr_t s1, daddr_t s2)
    442   1.1      cgd {
    443  1.13    lukem 	int tries, n;
    444   1.1      cgd 
    445   1.1      cgd 	if (buf == (char *)NULL) {
    446   1.1      cgd 		buf = malloc((unsigned)dp->d_secsize);
    447  1.13    lukem 		if (buf == (char *)NULL)
    448  1.13    lukem 			errx(20, "Out of memory");
    449   1.1      cgd 	}
    450   1.1      cgd 	for (tries = 0; tries < RETRIES; tries++) {
    451  1.12   kleink 		if (lseek(f, (off_t)(dp->d_secsize * s1), SEEK_SET) < 0)
    452  1.13    lukem 			err(4, "lseek");
    453   1.1      cgd 		if ((n = read(f, buf, dp->d_secsize)) == dp->d_secsize)
    454   1.1      cgd 			break;
    455   1.1      cgd 	}
    456   1.1      cgd 	if (n != dp->d_secsize) {
    457   1.1      cgd 		if (n < 0)
    458  1.20     fvdl 			err(4, "can't read sector, %lld", (long long)s1);
    459  1.13    lukem 		else
    460  1.20     fvdl 			errx(4, "can't read sector, %lld", (long long)s1);
    461   1.1      cgd 		return(0);
    462   1.1      cgd 	}
    463  1.12   kleink 	if (lseek(f, (off_t)(dp->d_secsize * s2), SEEK_SET) < 0)
    464  1.13    lukem 		err(4, "lseek");
    465   1.1      cgd 	if (verbose)
    466  1.20     fvdl 		printf("copying %lld to %lld\n", (long long)s1, (long long)s2);
    467   1.1      cgd 	if (nflag == 0 && write(f, buf, dp->d_secsize) != dp->d_secsize) {
    468  1.20     fvdl 		warn("can't write replacement sector, %lld", (long long)s2);
    469   1.1      cgd 		return(0);
    470   1.1      cgd 	}
    471   1.1      cgd 	return(1);
    472   1.1      cgd }
    473   1.1      cgd 
    474  1.11    mikel void
    475  1.16      wiz blkzero(int f, daddr_t sn)
    476   1.1      cgd {
    477  1.18      wiz 	char *zbuf;
    478   1.1      cgd 
    479  1.19      wiz 	zbuf = calloc(1, (unsigned int)dp->d_secsize);
    480  1.19      wiz 	if (zbuf == NULL)
    481  1.19      wiz 		errx(20, "Out of memory");
    482  1.12   kleink 	if (lseek(f, (off_t)(dp->d_secsize * sn), SEEK_SET) < 0)
    483  1.13    lukem 		err(4, "lseek");
    484   1.1      cgd 	if (verbose)
    485  1.20     fvdl 		printf("zeroing %lld\n", (long long)sn);
    486  1.13    lukem 	if (nflag == 0 && write(f, zbuf, dp->d_secsize) != dp->d_secsize)
    487  1.20     fvdl 		warn("can't write replacement sector, %lld",
    488  1.20     fvdl 		    (long long)sn);
    489   1.1      cgd }
    490   1.1      cgd 
    491  1.11    mikel int
    492  1.16      wiz compare(const void *v1, const void *v2)
    493   1.1      cgd {
    494  1.11    mikel 	const struct bt_bad *b1 = v1;
    495  1.11    mikel 	const struct bt_bad *b2 = v2;
    496  1.11    mikel 
    497   1.1      cgd 	if (b1->bt_cyl > b2->bt_cyl)
    498   1.1      cgd 		return(1);
    499   1.1      cgd 	if (b1->bt_cyl < b2->bt_cyl)
    500   1.1      cgd 		return(-1);
    501   1.1      cgd 	if (b1->bt_trksec == b2->bt_trksec)
    502   1.1      cgd 		dups++;
    503   1.1      cgd 	return (b1->bt_trksec - b2->bt_trksec);
    504   1.1      cgd }
    505   1.1      cgd 
    506   1.1      cgd daddr_t
    507  1.16      wiz badsn(const struct bt_bad *bt)
    508   1.1      cgd {
    509  1.11    mikel 
    510  1.11    mikel 	return ((bt->bt_cyl * dp->d_ntracks
    511  1.11    mikel 		+ (bt->bt_trksec >> 8)) * dp->d_nsectors
    512  1.11    mikel 		+ (bt->bt_trksec & 0xff));
    513   1.1      cgd }
    514   1.1      cgd 
    515  1.15     matt #ifdef __vax__
    516   1.1      cgd 
    517   1.1      cgd struct rp06hdr {
    518   1.1      cgd 	short	h_cyl;
    519   1.1      cgd 	short	h_trksec;
    520   1.1      cgd 	short	h_key1;
    521   1.1      cgd 	short	h_key2;
    522   1.1      cgd 	char	h_data[512];
    523   1.1      cgd #define	RP06_FMT	010000		/* 1 == 16 bit, 0 == 18 bit */
    524   1.1      cgd };
    525   1.1      cgd 
    526   1.1      cgd /*
    527   1.1      cgd  * Most massbus and unibus drives
    528   1.1      cgd  * have headers of this form
    529   1.1      cgd  */
    530   1.1      cgd struct hpuphdr {
    531   1.1      cgd 	u_short	hpup_cyl;
    532   1.1      cgd 	u_char	hpup_sect;
    533   1.1      cgd 	u_char	hpup_track;
    534   1.1      cgd 	char	hpup_data[512];
    535   1.1      cgd #define	HPUP_OKSECT	0xc000		/* this normally means sector is good */
    536   1.1      cgd #define	HPUP_16BIT	0x1000		/* 1 == 16 bit format */
    537   1.1      cgd };
    538  1.18      wiz int rp06format(struct formats *, struct disklabel *, daddr_t, char *, int);
    539  1.18      wiz int hpupformat(struct formats *, struct disklabel *, daddr_t, char *, int);
    540   1.1      cgd 
    541   1.1      cgd struct	formats {
    542   1.1      cgd 	char	*f_name;		/* disk name */
    543   1.1      cgd 	int	f_bufsize;		/* size of sector + header */
    544   1.1      cgd 	int	f_bic;			/* value to bic in hpup_cyl */
    545   1.1      cgd 	int	(*f_routine)();		/* routine for special handling */
    546   1.1      cgd } formats[] = {
    547   1.1      cgd 	{ "rp06",	sizeof (struct rp06hdr), RP06_FMT,	rp06format },
    548   1.1      cgd 	{ "eagle",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    549   1.1      cgd 	{ "capricorn",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    550   1.1      cgd 	{ "rm03",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    551   1.1      cgd 	{ "rm05",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    552   1.1      cgd 	{ "9300",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    553   1.1      cgd 	{ "9766",	sizeof (struct hpuphdr), HPUP_OKSECT,	hpupformat },
    554   1.1      cgd 	{ 0, 0, 0, 0 }
    555   1.1      cgd };
    556   1.1      cgd 
    557   1.1      cgd /*ARGSUSED*/
    558  1.11    mikel int
    559  1.18      wiz hpupformat(struct formats *fp, struct disklabel *dp, daddr_t blk, char *buf,
    560  1.18      wiz 	   int count)
    561   1.1      cgd {
    562   1.1      cgd 	struct hpuphdr *hdr = (struct hpuphdr *)buf;
    563   1.1      cgd 	int sect;
    564   1.1      cgd 
    565   1.1      cgd 	if (count < sizeof(struct hpuphdr)) {
    566   1.1      cgd 		hdr->hpup_cyl = (HPUP_OKSECT | HPUP_16BIT) |
    567   1.1      cgd 			(blk / (dp->d_nsectors * dp->d_ntracks));
    568   1.1      cgd 		sect = blk % (dp->d_nsectors * dp->d_ntracks);
    569   1.1      cgd 		hdr->hpup_track = (u_char)(sect / dp->d_nsectors);
    570   1.1      cgd 		hdr->hpup_sect = (u_char)(sect % dp->d_nsectors);
    571   1.1      cgd 	}
    572   1.1      cgd 	return (0);
    573   1.1      cgd }
    574   1.1      cgd 
    575   1.1      cgd /*ARGSUSED*/
    576  1.11    mikel int
    577  1.18      wiz rp06format(struct formats *fp, struct disklabel *dp, daddr_t blk, char *buf,
    578  1.18      wiz 	   int count)
    579   1.1      cgd {
    580   1.1      cgd 
    581   1.1      cgd 	if (count < sizeof(struct rp06hdr)) {
    582  1.13    lukem 		warnx("Can't read header on blk %d, can't reformat", blk);
    583   1.1      cgd 		return (-1);
    584   1.1      cgd 	}
    585   1.1      cgd 	return (0);
    586   1.1      cgd }
    587   1.1      cgd 
    588  1.11    mikel void
    589  1.18      wiz format(int fd, daddr_t blk)
    590   1.1      cgd {
    591  1.13    lukem 	struct formats *fp;
    592   1.1      cgd 	static char *buf;
    593   1.1      cgd 	static char bufsize;
    594   1.1      cgd 	struct format_op fop;
    595   1.1      cgd 	int n;
    596   1.1      cgd 
    597   1.1      cgd 	for (fp = formats; fp->f_name; fp++)
    598   1.1      cgd 		if (strcmp(dp->d_typename, fp->f_name) == 0)
    599   1.1      cgd 			break;
    600  1.13    lukem 	if (fp->f_name == 0)
    601  1.13    lukem 		errx(2, "don't know how to format %s disks", dp->d_typename);
    602   1.1      cgd 	if (buf && bufsize < fp->f_bufsize) {
    603   1.1      cgd 		free(buf);
    604   1.1      cgd 		buf = NULL;
    605   1.1      cgd 	}
    606   1.1      cgd 	if (buf == NULL)
    607   1.1      cgd 		buf = malloc((unsigned)fp->f_bufsize);
    608  1.13    lukem 	if (buf == NULL)
    609  1.13    lukem 		errx(3, "can't allocate sector buffer");
    610   1.1      cgd 	bufsize = fp->f_bufsize;
    611   1.1      cgd 	/*
    612   1.1      cgd 	 * Here we do the actual formatting.  All we really
    613   1.1      cgd 	 * do is rewrite the sector header and flag the bad sector
    614   1.1      cgd 	 * according to the format table description.  If a special
    615   1.1      cgd 	 * purpose format routine is specified, we allow it to
    616   1.1      cgd 	 * process the sector as well.
    617   1.1      cgd 	 */
    618   1.1      cgd 	if (verbose)
    619   1.1      cgd 		printf("format blk %d\n", blk);
    620  1.13    lukem 	memset((char *)&fop, 0, sizeof(fop));
    621   1.1      cgd 	fop.df_buf = buf;
    622   1.1      cgd 	fop.df_count = fp->f_bufsize;
    623   1.1      cgd 	fop.df_startblk = blk;
    624  1.13    lukem 	memset(buf, 0, fp->f_bufsize);
    625   1.1      cgd 	if (ioctl(fd, DIOCRFORMAT, &fop) < 0)
    626  1.13    lukem 		warn("read format");
    627   1.1      cgd 	if (fp->f_routine &&
    628   1.1      cgd 	    (*fp->f_routine)(fp, dp, blk, buf, fop.df_count) != 0)
    629   1.1      cgd 		return;
    630   1.1      cgd 	if (fp->f_bic) {
    631   1.1      cgd 		struct hpuphdr *xp = (struct hpuphdr *)buf;
    632   1.1      cgd 
    633   1.1      cgd 		xp->hpup_cyl &= ~fp->f_bic;
    634   1.1      cgd 	}
    635   1.1      cgd 	if (nflag)
    636   1.1      cgd 		return;
    637  1.13    lukem 	memset((char *)&fop, 0, sizeof(fop));
    638   1.1      cgd 	fop.df_buf = buf;
    639   1.1      cgd 	fop.df_count = fp->f_bufsize;
    640   1.1      cgd 	fop.df_startblk = blk;
    641   1.1      cgd 	if (ioctl(fd, DIOCWFORMAT, &fop) < 0)
    642  1.13    lukem 		err(4, "write format");
    643  1.13    lukem 	if (fop.df_count != fp->f_bufsize)
    644  1.13    lukem 		warn("write format %d", blk);
    645   1.1      cgd }
    646   1.1      cgd #endif
    647  1.19      wiz 
    648  1.19      wiz void
    649  1.19      wiz usage(void)
    650  1.19      wiz {
    651  1.19      wiz 
    652  1.19      wiz 	fprintf(stderr, "usage: bad144 [-%sv] disk [sno [bad ...]]\n"
    653  1.19      wiz 	    "to read or overwrite the bad-sector table, e.g.: bad144 hp0\n"
    654  1.19      wiz 	    "or bad144 -a [-c%sv] disk [bad ...]\n"
    655  1.19      wiz 	    "where options are:\n"
    656  1.19      wiz 	    "\t-a  add new bad sectors to the table\n"
    657  1.19      wiz 	    "\t-c  copy original sector to replacement\n"
    658  1.19      wiz 	    "%s"
    659  1.19      wiz 	    "\t-v  verbose mode\n",
    660  1.19      wiz #ifdef __vax__
    661  1.19      wiz 	    "f", "f", "\t-f  reformat listed sectors as bad\n"
    662  1.19      wiz #else
    663  1.19      wiz 	    "", "", ""
    664  1.19      wiz #endif
    665  1.19      wiz 	    );
    666  1.19      wiz 	exit(1);
    667  1.19      wiz }
    668