Home | History | Annotate | Line # | Download | only in bad144
bad144.c revision 1.28.2.1
      1  1.28.2.1      yamt /*	$NetBSD: bad144.c,v 1.28.2.1 2012/04/17 00:09:45 yamt 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.26     lukem __COPYRIGHT("@(#) Copyright (c) 1980, 1986, 1988, 1993\
     35      1.26     lukem  The Regents of the University of California.  All rights reserved.");
     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.28.2.1      yamt __RCSID("$NetBSD: bad144.c,v 1.28.2.1 2012/04/17 00:09:45 yamt 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.28.2.1      yamt static int	fflag;
     80      1.19       wiz #endif
     81  1.28.2.1      yamt static int	add, copy, verbose, nflag;
     82  1.28.2.1      yamt static int	dups;
     83  1.28.2.1      yamt static int	badfile = -1;		/* copy of badsector table to use, -1 if any */
     84       1.1       cgd #define MAXSECSIZE	1024
     85  1.28.2.1      yamt static struct	dkbad curbad, oldbad;
     86       1.1       cgd #define	DKBAD_MAGIC	0x4321
     87       1.1       cgd 
     88  1.28.2.1      yamt static daddr_t	size;
     89  1.28.2.1      yamt static struct	disklabel *dp;
     90  1.28.2.1      yamt static struct	disklabel label;
     91  1.28.2.1      yamt static char	diskname[MAXPATHLEN];
     92  1.28.2.1      yamt 
     93  1.28.2.1      yamt static daddr_t	badsn(const struct bt_bad *);
     94  1.28.2.1      yamt static int	blkcopy(int, daddr_t, daddr_t);
     95  1.28.2.1      yamt static void	blkzero(int, daddr_t);
     96  1.28.2.1      yamt static int	checkold(void);
     97  1.28.2.1      yamt static int	compare(const void *, const void *);
     98  1.28.2.1      yamt static daddr_t	getold(int, struct dkbad *);
     99  1.28.2.1      yamt static void	shift(int, int, int);
    100  1.28.2.1      yamt __dead static void	usage(void);
    101      1.19       wiz 
    102      1.19       wiz #ifdef __vax__
    103      1.19       wiz #define OPTSTRING "01234acfvn"
    104      1.19       wiz #else
    105      1.19       wiz #define OPTSTRING "01234acvn"
    106      1.19       wiz #endif
    107      1.11     mikel 
    108      1.11     mikel int
    109      1.16       wiz main(int argc, char *argv[])
    110       1.1       cgd {
    111      1.11     mikel 	struct bt_bad *bt;
    112      1.18       wiz 	daddr_t	sn, bn[NBT_BAD];
    113      1.19       wiz 	int i, f, nbad, new, bad, errs, ch;
    114       1.1       cgd 
    115      1.19       wiz 	while ((ch = getopt(argc, argv, OPTSTRING)) != -1) {
    116      1.19       wiz 		switch (ch) {
    117      1.19       wiz 		case '0':
    118      1.19       wiz 		case '1':
    119      1.19       wiz 		case '2':
    120      1.19       wiz 		case '3':
    121      1.19       wiz 		case '4':
    122      1.19       wiz 			badfile = ch - '0';
    123      1.19       wiz 			break;
    124      1.19       wiz 		case 'a':
    125      1.19       wiz 			add = 1;
    126      1.19       wiz 			break;
    127      1.19       wiz 		case 'c':
    128      1.19       wiz 			copy = 1;
    129      1.19       wiz 			break;
    130      1.19       wiz #ifdef __vax__
    131      1.19       wiz 		case 'f':
    132      1.19       wiz 			fflag = 1;
    133      1.19       wiz 			break;
    134       1.1       cgd #endif
    135      1.19       wiz 		case 'n':
    136      1.19       wiz 			nflag = 1;
    137      1.19       wiz 			/* FALLTHROUGH */
    138      1.19       wiz 		case 'v':
    139      1.19       wiz 			verbose = 1;
    140      1.19       wiz 			break;
    141      1.19       wiz 		case '?':
    142      1.19       wiz 		default:
    143      1.19       wiz 			usage();
    144       1.1       cgd 		}
    145       1.1       cgd 	}
    146      1.19       wiz 
    147      1.19       wiz 	argc -= optind;
    148      1.19       wiz 	argv += optind;
    149      1.19       wiz 
    150       1.1       cgd 	if (argc < 1) {
    151      1.19       wiz 		usage();
    152       1.1       cgd 	}
    153      1.13     lukem 	f = opendisk(argv[0], argc == 1 ? O_RDONLY : O_RDWR, diskname,
    154      1.13     lukem 	    sizeof(diskname), 0);
    155       1.1       cgd 	if (f < 0)
    156      1.13     lukem 		err(4, "opendisk `%s'", diskname);
    157       1.1       cgd 	/* obtain label and adjust to fit */
    158      1.19       wiz 	dp = &label;
    159       1.1       cgd 	if (ioctl(f, DIOCGDINFO, dp) < 0)
    160      1.13     lukem 		err(4, "ioctl DIOCGDINFO `%s'", diskname);
    161       1.1       cgd 	if (dp->d_magic != DISKMAGIC || dp->d_magic2 != DISKMAGIC
    162      1.13     lukem 		/* dkcksum(lp) != 0 */ )
    163      1.13     lukem 		errx(1, "Bad pack magic number (pack is unlabeled)");
    164      1.19       wiz 	if (dp->d_secsize > MAXSECSIZE || dp->d_secsize == 0)
    165      1.13     lukem 		errx(7, "Disk sector size too large/small (%d)",
    166      1.13     lukem 		    dp->d_secsize);
    167      1.17       wiz #ifdef __i386__
    168      1.13     lukem 	if (dp->d_type == DTYPE_SCSI)
    169      1.13     lukem 		errx(1, "SCSI disks don't use bad144!");
    170       1.1       cgd 	/* are we inside a DOS partition? */
    171       1.1       cgd 	if (dp->d_partitions[0].p_offset) {
    172       1.1       cgd 		/* yes, rules change. assume bad tables at end of partition C,
    173       1.1       cgd 		   which maps all of DOS partition we are within -wfj */
    174       1.1       cgd 		size = dp->d_partitions[2].p_offset + dp->d_partitions[2].p_size;
    175      1.17       wiz 	}
    176       1.1       cgd #endif
    177       1.1       cgd 	size = dp->d_nsectors * dp->d_ntracks * dp->d_ncylinders;
    178       1.1       cgd 	argc--;
    179       1.1       cgd 	argv++;
    180       1.1       cgd 	if (argc == 0) {
    181       1.1       cgd 		sn = getold(f, &oldbad);
    182      1.20      fvdl 		printf("bad block information at sector %lld in %s:\n",
    183      1.25       apb 		    (long long)sn, diskname);
    184       1.1       cgd 		printf("cartridge serial number: %d(10)\n", oldbad.bt_csn);
    185       1.1       cgd 		switch (oldbad.bt_flag) {
    186       1.1       cgd 
    187       1.1       cgd 		case (u_short)-1:
    188       1.1       cgd 			printf("alignment cartridge\n");
    189       1.1       cgd 			break;
    190       1.1       cgd 
    191       1.1       cgd 		case DKBAD_MAGIC:
    192       1.1       cgd 			break;
    193       1.1       cgd 
    194       1.1       cgd 		default:
    195       1.1       cgd 			printf("bt_flag=%x(16)?\n", oldbad.bt_flag);
    196       1.1       cgd 			break;
    197       1.1       cgd 		}
    198       1.1       cgd 		bt = oldbad.bt_bad;
    199      1.18       wiz 		for (i = 0; i < NBT_BAD; i++) {
    200       1.1       cgd 			bad = (bt->bt_cyl<<16) + bt->bt_trksec;
    201       1.1       cgd 			if (bad < 0)
    202       1.1       cgd 				break;
    203      1.20      fvdl 			printf("sn=%lld, cn=%d, tn=%d, sn=%d\n",
    204      1.20      fvdl 			    (long long)badsn(bt),
    205       1.1       cgd 			    bt->bt_cyl, bt->bt_trksec>>8, bt->bt_trksec&0xff);
    206       1.1       cgd 			bt++;
    207       1.1       cgd 		}
    208      1.11     mikel 		(void) checkold();
    209       1.1       cgd 		exit(0);
    210       1.1       cgd 	}
    211       1.1       cgd 	if (add) {
    212       1.1       cgd 		/*
    213       1.1       cgd 		 * Read in the old badsector table.
    214       1.1       cgd 		 * Verify that it makes sense, and the bad sectors
    215       1.1       cgd 		 * are in order.  Copy the old table to the new one.
    216       1.1       cgd 		 */
    217       1.1       cgd 		(void) getold(f, &oldbad);
    218      1.11     mikel 		i = checkold();
    219       1.1       cgd 		if (verbose)
    220       1.1       cgd 			printf("Had %d bad sectors, adding %d\n", i, argc);
    221      1.18       wiz 		if (i + argc > NBT_BAD) {
    222       1.1       cgd 			printf("bad144: not enough room for %d more sectors\n",
    223       1.1       cgd 				argc);
    224      1.18       wiz 			printf("limited to %d by information format\n",
    225      1.18       wiz 			    NBT_BAD);
    226       1.1       cgd 			exit(1);
    227       1.1       cgd 		}
    228       1.1       cgd 		curbad = oldbad;
    229       1.1       cgd 	} else {
    230       1.1       cgd 		curbad.bt_csn = atoi(*argv++);
    231       1.1       cgd 		argc--;
    232       1.1       cgd 		curbad.bt_mbz = 0;
    233       1.1       cgd 		curbad.bt_flag = DKBAD_MAGIC;
    234      1.18       wiz 		if (argc > NBT_BAD) {
    235       1.1       cgd 			printf("bad144: too many bad sectors specified\n");
    236      1.18       wiz 			printf("limited to %d by information format\n",
    237      1.18       wiz 			    NBT_BAD);
    238       1.1       cgd 			exit(1);
    239       1.1       cgd 		}
    240       1.1       cgd 		i = 0;
    241       1.1       cgd 	}
    242       1.1       cgd 	errs = 0;
    243       1.1       cgd 	new = argc;
    244       1.1       cgd 	while (argc > 0) {
    245      1.17       wiz 		sn = atoi(*argv++);
    246       1.1       cgd 		argc--;
    247       1.1       cgd 		if (sn < 0 || sn >= size) {
    248      1.20      fvdl 			printf("%lld: out of range [0,%lld) for disk %s\n",
    249      1.20      fvdl 			    (long long)sn, (long long)size, dp->d_typename);
    250       1.1       cgd 			errs++;
    251       1.1       cgd 			continue;
    252       1.1       cgd 		}
    253       1.1       cgd 		bn[i] = sn;
    254       1.1       cgd 		curbad.bt_bad[i].bt_cyl = sn / (dp->d_nsectors*dp->d_ntracks);
    255       1.1       cgd 		sn %= (dp->d_nsectors*dp->d_ntracks);
    256       1.1       cgd 		curbad.bt_bad[i].bt_trksec =
    257       1.1       cgd 		    ((sn/dp->d_nsectors) << 8) + (sn%dp->d_nsectors);
    258       1.1       cgd 		i++;
    259       1.1       cgd 	}
    260       1.1       cgd 	if (errs)
    261       1.1       cgd 		exit(1);
    262       1.1       cgd 	nbad = i;
    263      1.18       wiz 	while (i < NBT_BAD) {
    264       1.1       cgd 		curbad.bt_bad[i].bt_trksec = -1;
    265       1.1       cgd 		curbad.bt_bad[i].bt_cyl = -1;
    266       1.1       cgd 		i++;
    267       1.1       cgd 	}
    268       1.1       cgd 	if (add) {
    269       1.1       cgd 		/*
    270       1.1       cgd 		 * Sort the new bad sectors into the list.
    271       1.1       cgd 		 * Then shuffle the replacement sectors so that
    272       1.1       cgd 		 * the previous bad sectors get the same replacement data.
    273       1.1       cgd 		 */
    274       1.1       cgd 		qsort((char *)curbad.bt_bad, nbad, sizeof (struct bt_bad),
    275       1.1       cgd 		    compare);
    276      1.13     lukem 		if (dups)
    277      1.19       wiz 			errx(3, "bad sectors have been duplicated; "
    278      1.19       wiz 			    "can't add existing sectors");
    279       1.1       cgd 		shift(f, nbad, nbad-new);
    280       1.1       cgd 	}
    281       1.1       cgd 	if (badfile == -1)
    282       1.1       cgd 		i = 0;
    283       1.1       cgd 	else
    284       1.1       cgd 		i = badfile * 2;
    285      1.27     lukem 	for (; i < 10 && i < (int)dp->d_nsectors; i += 2) {
    286      1.11     mikel 		if (lseek(f,
    287      1.12    kleink 		    (off_t)(dp->d_secsize * (size - dp->d_nsectors + i)),
    288      1.12    kleink 		    SEEK_SET) < 0)
    289      1.13     lukem 			err(4, "lseek");
    290       1.1       cgd 		if (verbose)
    291      1.20      fvdl 			printf("write badsect file at %lld\n",
    292      1.20      fvdl 				(long long)size - dp->d_nsectors + i);
    293       1.1       cgd 		if (nflag == 0 && write(f, (caddr_t)&curbad, sizeof(curbad)) !=
    294      1.13     lukem 		    sizeof(curbad))
    295      1.13     lukem 			err(4, "write bad sector file %d", i/2);
    296       1.1       cgd 		if (badfile != -1)
    297       1.1       cgd 			break;
    298       1.1       cgd 	}
    299      1.15      matt #ifdef __vax__
    300       1.1       cgd 	if (nflag == 0 && fflag)
    301       1.1       cgd 		for (i = nbad - new; i < nbad; i++)
    302       1.1       cgd 			format(f, bn[i]);
    303       1.1       cgd #endif
    304       1.1       cgd #ifdef DIOCSBAD
    305       1.1       cgd 	if (nflag == 0 && ioctl(f, DIOCSBAD, (caddr_t)&curbad) < 0)
    306      1.19       wiz 		warnx("Can't sync bad-sector file; reboot for changes "
    307      1.19       wiz 		    "to take effect");
    308       1.1       cgd #endif
    309       1.1       cgd 	if ((dp->d_flags & D_BADSECT) == 0 && nflag == 0) {
    310       1.1       cgd 		dp->d_flags |= D_BADSECT;
    311       1.1       cgd 		if (ioctl(f, DIOCWDINFO, dp) < 0) {
    312      1.13     lukem 			warn("label");
    313      1.13     lukem 			errx(1,
    314      1.13     lukem 			    "Can't write label to enable bad sector handling");
    315       1.1       cgd 		}
    316       1.1       cgd 	}
    317      1.19       wiz 	return (0);
    318       1.1       cgd }
    319       1.1       cgd 
    320  1.28.2.1      yamt static daddr_t
    321      1.16       wiz getold(int f, struct dkbad *bad)
    322       1.1       cgd {
    323      1.11     mikel 	int i;
    324       1.1       cgd 	daddr_t sn;
    325       1.1       cgd 
    326       1.1       cgd 	if (badfile == -1)
    327       1.1       cgd 		i = 0;
    328       1.1       cgd 	else
    329       1.1       cgd 		i = badfile * 2;
    330      1.27     lukem 	for (; i < 10 && i < (int)dp->d_nsectors; i += 2) {
    331       1.1       cgd 		sn = size - dp->d_nsectors + i;
    332      1.12    kleink 		if (lseek(f, (off_t)(sn * dp->d_secsize), SEEK_SET) < 0)
    333      1.13     lukem 			err(4, "lseek");
    334      1.27     lukem 		if ((size_t)read(f, (char *) bad, dp->d_secsize) == dp->d_secsize) {
    335       1.1       cgd 			if (i > 0)
    336       1.1       cgd 				printf("Using bad-sector file %d\n", i/2);
    337       1.1       cgd 			return(sn);
    338       1.1       cgd 		}
    339      1.20      fvdl 		warn("read bad sector file at sn %lld", (long long)sn);
    340       1.1       cgd 		if (badfile != -1)
    341       1.1       cgd 			break;
    342       1.1       cgd 	}
    343      1.24      elad 	errx(1, "%s: can't read bad block info", diskname);
    344       1.1       cgd 	/*NOTREACHED*/
    345       1.1       cgd }
    346       1.1       cgd 
    347  1.28.2.1      yamt static int
    348      1.16       wiz checkold(void)
    349       1.1       cgd {
    350      1.13     lukem 	int i;
    351      1.13     lukem 	struct bt_bad *bt;
    352       1.1       cgd 	daddr_t sn, lsn;
    353       1.1       cgd 	int errors = 0, warned = 0;
    354       1.1       cgd 
    355      1.13     lukem 	lsn = 0;
    356       1.1       cgd 	if (oldbad.bt_flag != DKBAD_MAGIC) {
    357      1.24      elad 		warnx("%s: bad flag in bad-sector table", diskname);
    358       1.1       cgd 		errors++;
    359       1.1       cgd 	}
    360       1.1       cgd 	if (oldbad.bt_mbz != 0) {
    361      1.24      elad 		warnx("%s: bad magic number", diskname);
    362       1.1       cgd 		errors++;
    363       1.1       cgd 	}
    364       1.1       cgd 	bt = oldbad.bt_bad;
    365      1.18       wiz 	for (i = 0; i < NBT_BAD; i++, bt++) {
    366       1.1       cgd 		if (bt->bt_cyl == 0xffff && bt->bt_trksec == 0xffff)
    367       1.1       cgd 			break;
    368       1.1       cgd 		if ((bt->bt_cyl >= dp->d_ncylinders) ||
    369       1.1       cgd 		    ((bt->bt_trksec >> 8) >= dp->d_ntracks) ||
    370       1.1       cgd 		    ((bt->bt_trksec & 0xff) >= dp->d_nsectors)) {
    371      1.19       wiz 			warnx("cyl/trk/sect out of range in existing entry: "
    372      1.20      fvdl 			    "sn=%lld, cn=%d, tn=%d, sn=%d",
    373      1.20      fvdl 			    (long long)badsn(bt), bt->bt_cyl, bt->bt_trksec>>8,
    374      1.13     lukem 			    bt->bt_trksec & 0xff);
    375       1.1       cgd 			errors++;
    376       1.1       cgd 		}
    377       1.1       cgd 		sn = (bt->bt_cyl * dp->d_ntracks +
    378       1.1       cgd 		    (bt->bt_trksec >> 8)) *
    379       1.1       cgd 		    dp->d_nsectors + (bt->bt_trksec & 0xff);
    380       1.1       cgd 		if (i > 0 && sn < lsn && !warned) {
    381      1.13     lukem 		    warnx("bad sector file is out of order");
    382       1.1       cgd 		    errors++;
    383       1.1       cgd 		    warned++;
    384       1.1       cgd 		}
    385       1.1       cgd 		if (i > 0 && sn == lsn) {
    386      1.20      fvdl 		    warnx("bad sector file contains duplicates (sn %lld)",
    387      1.20      fvdl 			(long long)sn);
    388       1.1       cgd 		    errors++;
    389       1.1       cgd 		}
    390       1.1       cgd 		lsn = sn;
    391       1.1       cgd 	}
    392       1.1       cgd 	if (errors)
    393       1.1       cgd 		exit(1);
    394       1.1       cgd 	return (i);
    395       1.1       cgd }
    396       1.1       cgd 
    397       1.1       cgd /*
    398       1.1       cgd  * Move the bad sector replacements
    399       1.1       cgd  * to make room for the new bad sectors.
    400       1.1       cgd  * new is the new number of bad sectors, old is the previous count.
    401       1.1       cgd  */
    402  1.28.2.1      yamt static void
    403      1.16       wiz shift(int f, int new, int old)
    404       1.1       cgd {
    405       1.1       cgd 	daddr_t repl;
    406       1.1       cgd 
    407       1.1       cgd 	/*
    408       1.1       cgd 	 * First replacement is last sector of second-to-last track.
    409       1.1       cgd 	 */
    410       1.1       cgd 	repl = size - dp->d_nsectors - 1;
    411       1.1       cgd 	new--; old--;
    412       1.1       cgd 	while (new >= 0 && new != old) {
    413       1.1       cgd 		if (old < 0 ||
    414       1.1       cgd 		    compare(&curbad.bt_bad[new], &oldbad.bt_bad[old]) > 0) {
    415       1.1       cgd 			/*
    416       1.1       cgd 			 * Insert new replacement here-- copy original
    417       1.1       cgd 			 * sector if requested and possible,
    418       1.1       cgd 			 * otherwise write a zero block.
    419       1.1       cgd 			 */
    420       1.1       cgd 			if (!copy ||
    421       1.1       cgd 			    !blkcopy(f, badsn(&curbad.bt_bad[new]), repl - new))
    422       1.1       cgd 				blkzero(f, repl - new);
    423       1.1       cgd 		} else {
    424       1.1       cgd 			if (blkcopy(f, repl - old, repl - new) == 0)
    425      1.20      fvdl 			    warnx("Can't copy replacement sector %lld to %lld",
    426      1.20      fvdl 				(long long)repl-old, (long long)repl-new);
    427       1.1       cgd 			old--;
    428       1.1       cgd 		}
    429       1.1       cgd 		new--;
    430       1.1       cgd 	}
    431       1.1       cgd }
    432       1.1       cgd 
    433  1.28.2.1      yamt static char *buf;
    434       1.1       cgd 
    435       1.1       cgd /*
    436       1.1       cgd  *  Copy disk sector s1 to s2.
    437       1.1       cgd  */
    438  1.28.2.1      yamt static int
    439      1.16       wiz blkcopy(int f, daddr_t s1, daddr_t s2)
    440       1.1       cgd {
    441      1.13     lukem 	int tries, n;
    442       1.1       cgd 
    443      1.28    plunky 	if (buf == NULL) {
    444       1.1       cgd 		buf = malloc((unsigned)dp->d_secsize);
    445      1.28    plunky 		if (buf == NULL)
    446      1.13     lukem 			errx(20, "Out of memory");
    447       1.1       cgd 	}
    448       1.1       cgd 	for (tries = 0; tries < RETRIES; tries++) {
    449      1.12    kleink 		if (lseek(f, (off_t)(dp->d_secsize * s1), SEEK_SET) < 0)
    450      1.13     lukem 			err(4, "lseek");
    451      1.27     lukem 		if ((size_t)(n = read(f, buf, dp->d_secsize)) == dp->d_secsize)
    452       1.1       cgd 			break;
    453       1.1       cgd 	}
    454      1.27     lukem 	if ((size_t)n != dp->d_secsize) {
    455       1.1       cgd 		if (n < 0)
    456      1.20      fvdl 			err(4, "can't read sector, %lld", (long long)s1);
    457      1.13     lukem 		else
    458      1.20      fvdl 			errx(4, "can't read sector, %lld", (long long)s1);
    459       1.1       cgd 		return(0);
    460       1.1       cgd 	}
    461      1.12    kleink 	if (lseek(f, (off_t)(dp->d_secsize * s2), SEEK_SET) < 0)
    462      1.13     lukem 		err(4, "lseek");
    463       1.1       cgd 	if (verbose)
    464      1.20      fvdl 		printf("copying %lld to %lld\n", (long long)s1, (long long)s2);
    465      1.27     lukem 	if (nflag == 0 && (size_t)write(f, buf, dp->d_secsize) != dp->d_secsize) {
    466      1.20      fvdl 		warn("can't write replacement sector, %lld", (long long)s2);
    467       1.1       cgd 		return(0);
    468       1.1       cgd 	}
    469       1.1       cgd 	return(1);
    470       1.1       cgd }
    471       1.1       cgd 
    472  1.28.2.1      yamt static void
    473      1.16       wiz blkzero(int f, daddr_t sn)
    474       1.1       cgd {
    475      1.18       wiz 	char *zbuf;
    476       1.1       cgd 
    477      1.19       wiz 	zbuf = calloc(1, (unsigned int)dp->d_secsize);
    478      1.19       wiz 	if (zbuf == NULL)
    479      1.19       wiz 		errx(20, "Out of memory");
    480      1.23  christos 	if (lseek(f, (off_t)(dp->d_secsize * sn), SEEK_SET) < 0) {
    481      1.23  christos 		free(zbuf);
    482      1.13     lukem 		err(4, "lseek");
    483      1.23  christos 	}
    484       1.1       cgd 	if (verbose)
    485      1.20      fvdl 		printf("zeroing %lld\n", (long long)sn);
    486      1.27     lukem 	if (nflag == 0 && (size_t)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.22  christos 	free(zbuf);
    490       1.1       cgd }
    491       1.1       cgd 
    492  1.28.2.1      yamt static 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.28.2.1      yamt static 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.1       cgd 
    540  1.28.2.1      yamt static int rp06format(struct formats *, struct disklabel *, daddr_t, char *, int);
    541  1.28.2.1      yamt static int hpupformat(struct formats *, struct disklabel *, daddr_t, char *, int);
    542  1.28.2.1      yamt 
    543  1.28.2.1      yamt static 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.28.2.1      yamt static 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.28.2.1      yamt static 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.28.2.1      yamt static 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.28.2.1      yamt static 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