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