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