Home | History | Annotate | Line # | Download | only in kern
subr_disk_mbr.c revision 1.6.4.3
      1  1.6.4.3   yamt /*	$NetBSD: subr_disk_mbr.c,v 1.6.4.3 2007/02/26 09:11:14 yamt Exp $	*/
      2      1.1    dsl 
      3      1.1    dsl /*
      4      1.1    dsl  * Copyright (c) 1982, 1986, 1988 Regents of the University of California.
      5      1.1    dsl  * All rights reserved.
      6      1.1    dsl  *
      7      1.1    dsl  * Redistribution and use in source and binary forms, with or without
      8      1.1    dsl  * modification, are permitted provided that the following conditions
      9      1.1    dsl  * are met:
     10      1.1    dsl  * 1. Redistributions of source code must retain the above copyright
     11      1.1    dsl  *    notice, this list of conditions and the following disclaimer.
     12      1.1    dsl  * 2. Redistributions in binary form must reproduce the above copyright
     13      1.1    dsl  *    notice, this list of conditions and the following disclaimer in the
     14      1.1    dsl  *    documentation and/or other materials provided with the distribution.
     15      1.2    agc  * 3. Neither the name of the University nor the names of its contributors
     16      1.1    dsl  *    may be used to endorse or promote products derived from this software
     17      1.1    dsl  *    without specific prior written permission.
     18      1.1    dsl  *
     19      1.1    dsl  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     20      1.1    dsl  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21      1.1    dsl  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22      1.1    dsl  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     23      1.1    dsl  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24      1.1    dsl  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25      1.1    dsl  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26      1.1    dsl  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27      1.1    dsl  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28      1.1    dsl  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29      1.1    dsl  * SUCH DAMAGE.
     30      1.1    dsl  *
     31      1.1    dsl  *	@(#)ufs_disksubr.c	7.16 (Berkeley) 5/4/91
     32      1.1    dsl  */
     33      1.1    dsl 
     34      1.1    dsl /*
     35      1.1    dsl  * Code to find a NetBSD label on a disk that contains an i386 style MBR.
     36      1.1    dsl  * The first NetBSD label found in the 2nd sector of a NetBSD partition
     37      1.3    dsl  * is used.
     38      1.3    dsl  * If we don't find a label searching the MBR, we look at the start of the
     39      1.3    dsl  * disk, if that fails then a label is faked up from the MBR.
     40      1.1    dsl  *
     41      1.1    dsl  * If there isn't a disklabel or anything in the MBR then partition a
     42      1.1    dsl  * is set to cover the whole disk.
     43      1.1    dsl  * Useful for files that contain single filesystems (etc).
     44      1.1    dsl  *
     45      1.1    dsl  * This code will read host endian netbsd labels from little endian MBR.
     46      1.1    dsl  *
     47      1.1    dsl  * Based on the i386 disksubr.c
     48      1.1    dsl  *
     49      1.3    dsl  * Since the mbr only has 32bit fields for sector addresses, we do the same.
     50      1.3    dsl  *
     51      1.1    dsl  * XXX There are potential problems writing labels to disks where there
     52      1.1    dsl  * is only space for 8 netbsd partitions but this code has been compiled
     53      1.1    dsl  * with MAXPARTITIONS=16.
     54      1.1    dsl  */
     55      1.1    dsl 
     56      1.1    dsl #include <sys/cdefs.h>
     57  1.6.4.3   yamt __KERNEL_RCSID(0, "$NetBSD: subr_disk_mbr.c,v 1.6.4.3 2007/02/26 09:11:14 yamt Exp $");
     58      1.1    dsl 
     59      1.1    dsl #include <sys/param.h>
     60      1.1    dsl #include <sys/systm.h>
     61      1.1    dsl #include <sys/buf.h>
     62      1.1    dsl #include <sys/disklabel.h>
     63      1.1    dsl #include <sys/disk.h>
     64      1.1    dsl #include <sys/syslog.h>
     65      1.1    dsl 
     66      1.1    dsl #include "opt_mbr.h"
     67      1.1    dsl 
     68  1.6.4.1   yamt typedef struct mbr_partition mbr_partition_t;
     69  1.6.4.1   yamt 
     70  1.6.4.1   yamt /*
     71  1.6.4.1   yamt  * We allocate a buffer 2 sectors large, and look in both....
     72  1.6.4.1   yamt  * That means we find labels written by other ports with different offsets.
     73  1.6.4.1   yamt  * LABELSECTOR and LABELOFFSET are only used if the disk doesn't have a label.
     74  1.6.4.1   yamt  */
     75  1.6.4.1   yamt #if LABELSECTOR > 1 || LABELOFFSET > 512
     76  1.6.4.1   yamt #error Invalid LABELSECTOR or LABELOFFSET
     77  1.6.4.1   yamt #endif
     78  1.6.4.1   yamt 
     79      1.1    dsl #define MBR_LABELSECTOR	1
     80      1.1    dsl 
     81      1.1    dsl #define SCAN_CONTINUE	0
     82      1.1    dsl #define SCAN_FOUND	1
     83      1.1    dsl #define SCAN_ERROR	2
     84      1.1    dsl 
     85      1.1    dsl typedef struct mbr_args {
     86      1.1    dsl 	struct disklabel *lp;
     87      1.1    dsl 	void		(*strat)(struct buf *);
     88      1.1    dsl 	struct buf	*bp;
     89      1.1    dsl 	const char	*msg;
     90      1.1    dsl 	int		error;
     91      1.3    dsl 	int		written;	/* number of times we wrote label */
     92  1.6.4.1   yamt 	int		found_mbr;	/* set if disk has a valid mbr */
     93      1.3    dsl 	uint		label_sector;	/* where we found the label */
     94  1.6.4.1   yamt 	int		action;
     95      1.1    dsl #define READ_LABEL	1
     96      1.3    dsl #define UPDATE_LABEL	2
     97      1.3    dsl #define WRITE_LABEL	3
     98  1.6.4.1   yamt } mbr_args_t;
     99  1.6.4.1   yamt 
    100  1.6.4.1   yamt static int validate_label(mbr_args_t *, uint);
    101  1.6.4.1   yamt static int look_netbsd_part(mbr_args_t *, mbr_partition_t *, int, uint);
    102  1.6.4.1   yamt static int write_netbsd_label(mbr_args_t *, mbr_partition_t *, int, uint);
    103      1.1    dsl 
    104      1.1    dsl static int
    105  1.6.4.1   yamt read_sector(mbr_args_t *a, uint sector, int count)
    106      1.1    dsl {
    107      1.1    dsl 	struct buf *bp = a->bp;
    108      1.1    dsl 	int error;
    109      1.1    dsl 
    110      1.1    dsl 	bp->b_blkno = sector;
    111  1.6.4.1   yamt 	bp->b_bcount = count * a->lp->d_secsize;
    112      1.1    dsl 	bp->b_flags = (bp->b_flags & ~(B_WRITE | B_DONE)) | B_READ;
    113      1.1    dsl 	bp->b_cylinder = sector / a->lp->d_secpercyl;
    114      1.1    dsl 	(*a->strat)(bp);
    115      1.1    dsl 	error = biowait(bp);
    116      1.1    dsl 	if (error != 0)
    117      1.1    dsl 		a->error = error;
    118      1.1    dsl 	return error;
    119      1.1    dsl }
    120      1.1    dsl 
    121      1.6  perry /*
    122      1.1    dsl  * Scan MBR for partitions, call 'action' routine for each.
    123      1.1    dsl  */
    124      1.1    dsl 
    125      1.1    dsl static int
    126  1.6.4.1   yamt scan_mbr(mbr_args_t *a, int (*actn)(mbr_args_t *, mbr_partition_t *, int, uint))
    127      1.1    dsl {
    128  1.6.4.1   yamt 	mbr_partition_t ptns[MBR_PART_COUNT];
    129  1.6.4.1   yamt 	mbr_partition_t *dp;
    130      1.4  lukem 	struct mbr_sector *mbr;
    131      1.1    dsl 	uint ext_base, this_ext, next_ext;
    132      1.1    dsl 	int rval;
    133      1.1    dsl 	int i;
    134  1.6.4.1   yamt 	int j;
    135      1.1    dsl #ifdef COMPAT_386BSD_MBRPART
    136      1.1    dsl 	int dp_386bsd = -1;
    137  1.6.4.1   yamt 	int ap_386bsd = -1;
    138      1.1    dsl #endif
    139      1.1    dsl 
    140      1.1    dsl 	ext_base = 0;
    141      1.1    dsl 	this_ext = 0;
    142      1.1    dsl 	for (;;) {
    143  1.6.4.1   yamt 		if (read_sector(a, this_ext, 1)) {
    144      1.1    dsl 			a->msg = "dos partition I/O error";
    145      1.1    dsl 			return SCAN_ERROR;
    146      1.1    dsl 		}
    147      1.1    dsl 
    148      1.1    dsl 		/* Note: Magic number is little-endian. */
    149      1.1    dsl 		mbr = (void *)a->bp->b_data;
    150      1.4  lukem 		if (mbr->mbr_magic != htole16(MBR_MAGIC))
    151      1.3    dsl 			return SCAN_CONTINUE;
    152      1.1    dsl 
    153      1.1    dsl 		/* Copy data out of buffer so action can use bp */
    154      1.1    dsl 		memcpy(ptns, &mbr->mbr_parts, sizeof ptns);
    155      1.1    dsl 
    156  1.6.4.1   yamt 		/* Look for drivers and skip them */
    157  1.6.4.1   yamt 		if (ext_base == 0 && ptns[0].mbrp_type == MBR_PTYPE_DM6_DDO) {
    158  1.6.4.1   yamt 			/* We've found a DM6 DDO partition type (used by
    159  1.6.4.1   yamt 			 * the Ontrack Disk Manager drivers).
    160  1.6.4.1   yamt 			 *
    161  1.6.4.1   yamt 			 * Ensure that there are no other partitions in the
    162  1.6.4.1   yamt 			 * MBR and jump to the real partition table (stored
    163  1.6.4.1   yamt 			 * in the first sector of the second track). */
    164  1.6.4.3   yamt 			bool ok = true;
    165  1.6.4.1   yamt 
    166  1.6.4.1   yamt 			for (i = 1; i < MBR_PART_COUNT; i++)
    167  1.6.4.1   yamt 				if (ptns[i].mbrp_type != MBR_PTYPE_UNUSED)
    168  1.6.4.3   yamt 					ok = false;
    169  1.6.4.1   yamt 
    170  1.6.4.1   yamt 			if (ok) {
    171  1.6.4.1   yamt 				this_ext = le32toh(a->lp->d_secpercyl /
    172  1.6.4.1   yamt 				    a->lp->d_ntracks);
    173  1.6.4.1   yamt 				continue;
    174  1.6.4.1   yamt 			}
    175  1.6.4.1   yamt 		}
    176  1.6.4.1   yamt 
    177      1.1    dsl 		/* look for NetBSD partition */
    178      1.1    dsl 		next_ext = 0;
    179      1.1    dsl 		dp = ptns;
    180  1.6.4.1   yamt 		j = 0;
    181      1.4  lukem 		for (i = 0; i < MBR_PART_COUNT; i++, dp++) {
    182  1.6.4.1   yamt 			if (dp->mbrp_type == MBR_PTYPE_UNUSED)
    183      1.1    dsl 				continue;
    184  1.6.4.1   yamt 			/* Check end of partition is inside disk limits */
    185  1.6.4.1   yamt 			if ((uint64_t)ext_base + le32toh(dp->mbrp_start) +
    186  1.6.4.1   yamt 			    le32toh(dp->mbrp_size) > a->lp->d_secperunit) {
    187  1.6.4.1   yamt 				/* This mbr doesn't look good.... */
    188  1.6.4.1   yamt 				a->msg = "mbr partition exceeds disk size";
    189  1.6.4.1   yamt 				/* ...but don't report this as an error (yet) */
    190  1.6.4.1   yamt 				return SCAN_CONTINUE;
    191  1.6.4.1   yamt 			}
    192  1.6.4.1   yamt 			a->found_mbr = 1;
    193      1.4  lukem 			if (MBR_IS_EXTENDED(dp->mbrp_type)) {
    194      1.1    dsl 				next_ext = le32toh(dp->mbrp_start);
    195      1.1    dsl 				continue;
    196      1.1    dsl 			}
    197      1.1    dsl #ifdef COMPAT_386BSD_MBRPART
    198      1.4  lukem 			if (dp->mbrp_type == MBR_PTYPE_386BSD) {
    199      1.1    dsl 				/*
    200      1.1    dsl 				 * If more than one matches, take last,
    201      1.1    dsl 				 * as NetBSD install tool does.
    202      1.1    dsl 				 */
    203  1.6.4.1   yamt 				if (this_ext == 0) {
    204      1.1    dsl 					dp_386bsd = i;
    205  1.6.4.1   yamt 					ap_386bsd = j;
    206  1.6.4.1   yamt 				}
    207      1.1    dsl 				continue;
    208      1.1    dsl 			}
    209      1.1    dsl #endif
    210  1.6.4.1   yamt 			rval = (*actn)(a, dp, j, this_ext);
    211      1.1    dsl 			if (rval != SCAN_CONTINUE)
    212      1.1    dsl 				return rval;
    213  1.6.4.1   yamt 			j++;
    214      1.1    dsl 		}
    215      1.1    dsl 		if (next_ext == 0)
    216      1.1    dsl 			break;
    217      1.1    dsl 		if (ext_base == 0) {
    218      1.1    dsl 			ext_base = next_ext;
    219      1.1    dsl 			next_ext = 0;
    220      1.1    dsl 		}
    221      1.1    dsl 		next_ext += ext_base;
    222      1.1    dsl 		if (next_ext <= this_ext)
    223      1.1    dsl 			break;
    224      1.1    dsl 		this_ext = next_ext;
    225      1.1    dsl 	}
    226      1.1    dsl #ifdef COMPAT_386BSD_MBRPART
    227      1.1    dsl 	if (this_ext == 0 && dp_386bsd != -1)
    228  1.6.4.1   yamt 		return (*actn)(a, &ptns[dp_386bsd], ap_386bsd, 0);
    229      1.1    dsl #endif
    230      1.1    dsl 	return SCAN_CONTINUE;
    231      1.1    dsl }
    232      1.1    dsl 
    233      1.1    dsl /*
    234      1.1    dsl  * Attempt to read a disk label from a device
    235      1.1    dsl  * using the indicated strategy routine.
    236      1.1    dsl  * The label must be partly set up before this:
    237      1.1    dsl  * secpercyl, secsize and anything required for a block i/o read
    238      1.1    dsl  * operation in the driver's strategy/start routines
    239      1.1    dsl  * must be filled in before calling us.
    240      1.1    dsl  *
    241      1.1    dsl  * If dos partition table requested, attempt to load it and
    242      1.1    dsl  * find disklabel inside a DOS partition. Also, if bad block
    243      1.1    dsl  * table needed, attempt to extract it as well. Return buffer
    244      1.1    dsl  * for use in signalling errors if requested.
    245      1.1    dsl  *
    246      1.1    dsl  * Returns null on success and an error string on failure.
    247      1.1    dsl  */
    248      1.1    dsl const char *
    249  1.6.4.1   yamt readdisklabel(dev_t dev, void (*strat)(struct buf *), struct disklabel *lp,
    250  1.6.4.1   yamt     struct cpu_disklabel *osdep)
    251      1.1    dsl {
    252      1.1    dsl 	struct dkbad *bdp;
    253      1.1    dsl 	int rval;
    254      1.1    dsl 	int i;
    255      1.1    dsl 	mbr_args_t a;
    256      1.1    dsl 
    257      1.3    dsl 	memset(&a, 0, sizeof a);
    258      1.1    dsl 	a.lp = lp;
    259      1.1    dsl 	a.strat = strat;
    260  1.6.4.1   yamt 	a.action = READ_LABEL;
    261      1.1    dsl 
    262      1.1    dsl 	/* minimal requirements for architypal disk label */
    263      1.1    dsl 	if (lp->d_secsize == 0)
    264      1.1    dsl 		lp->d_secsize = DEV_BSIZE;
    265      1.1    dsl 	if (lp->d_secperunit == 0)
    266      1.1    dsl 		lp->d_secperunit = 0x1fffffff;
    267      1.1    dsl 	lp->d_npartitions = RAW_PART + 1;
    268      1.1    dsl 	for (i = 0; i < RAW_PART; i++) {
    269      1.1    dsl 		lp->d_partitions[i].p_size = 0;
    270      1.1    dsl 		lp->d_partitions[i].p_offset = 0;
    271      1.1    dsl 	}
    272      1.1    dsl 	if (lp->d_partitions[RAW_PART].p_size == 0)
    273  1.6.4.1   yamt 		lp->d_partitions[RAW_PART].p_size = lp->d_secperunit;
    274      1.1    dsl 	lp->d_partitions[RAW_PART].p_offset = 0;
    275      1.1    dsl 
    276      1.1    dsl 	/*
    277      1.1    dsl 	 * Set partition 'a' to be the whole disk.
    278      1.1    dsl 	 * Cleared if we find an mbr or a netbsd label.
    279      1.1    dsl 	 */
    280      1.1    dsl 	lp->d_partitions[0].p_size = lp->d_partitions[RAW_PART].p_size;
    281      1.1    dsl 	lp->d_partitions[0].p_fstype = FS_BSDFFS;
    282      1.1    dsl 
    283      1.1    dsl 	/* get a buffer and initialize it */
    284  1.6.4.1   yamt 	a.bp = geteblk(2 * (int)lp->d_secsize);
    285      1.1    dsl 	a.bp->b_dev = dev;
    286      1.1    dsl 
    287      1.1    dsl 	if (osdep)
    288      1.1    dsl 		/*
    289      1.1    dsl 		 * Scan mbr searching for netbsd partition and saving
    290      1.1    dsl 		 * bios partition information to use if the netbsd one
    291      1.1    dsl 		 * is absent.
    292      1.1    dsl 		 */
    293      1.1    dsl 		rval = scan_mbr(&a, look_netbsd_part);
    294      1.1    dsl 	else
    295      1.1    dsl 		rval = SCAN_CONTINUE;
    296      1.1    dsl 
    297      1.3    dsl 	if (rval == SCAN_CONTINUE) {
    298      1.1    dsl 		/* Look at start of disk */
    299  1.6.4.1   yamt 		rval = validate_label(&a, 0);
    300      1.1    dsl 	}
    301      1.1    dsl 
    302      1.3    dsl #if 0
    303      1.3    dsl 	/*
    304      1.3    dsl 	 * Save sector where we found the label for the 'don't overwrite
    305      1.3    dsl 	 * the label' check in bounds_check_with_label.
    306      1.3    dsl 	 */
    307      1.3    dsl 	if (rval == SCAN_FOUND)
    308      1.3    dsl 		xxx->label_sector = a.label_sector;
    309      1.3    dsl #endif
    310      1.3    dsl 
    311      1.1    dsl 	/* Obtain bad sector table if requested and present */
    312      1.1    dsl 	if (rval == SCAN_FOUND && osdep && (lp->d_flags & D_BADSECT)) {
    313      1.1    dsl 		struct dkbad *db;
    314      1.1    dsl 		int blkno;
    315      1.1    dsl 
    316      1.1    dsl 		bdp = &osdep->bad;
    317      1.1    dsl 		i = 0;
    318      1.1    dsl 		rval = SCAN_ERROR;
    319      1.1    dsl 		do {
    320      1.1    dsl 			/* read a bad sector table */
    321      1.1    dsl 			blkno = lp->d_secperunit - lp->d_nsectors + i;
    322      1.1    dsl 			if (lp->d_secsize > DEV_BSIZE)
    323      1.1    dsl 				blkno *= lp->d_secsize / DEV_BSIZE;
    324      1.1    dsl 			else
    325      1.1    dsl 				blkno /= DEV_BSIZE / lp->d_secsize;
    326      1.1    dsl 			/* if successful, validate, otherwise try another */
    327  1.6.4.1   yamt 			if (read_sector(&a, blkno, 1)) {
    328      1.1    dsl 				a.msg = "bad sector table I/O error";
    329      1.1    dsl 				continue;
    330      1.1    dsl 			}
    331      1.1    dsl 			db = (struct dkbad *)(a.bp->b_data);
    332      1.1    dsl #define DKBAD_MAGIC 0x4321
    333      1.1    dsl 			if (db->bt_mbz != 0 || db->bt_flag != DKBAD_MAGIC) {
    334      1.1    dsl 				a.msg = "bad sector table corrupted";
    335      1.1    dsl 				continue;
    336      1.1    dsl 			}
    337      1.1    dsl 			rval = SCAN_FOUND;
    338      1.1    dsl 			*bdp = *db;
    339      1.1    dsl 			break;
    340      1.1    dsl 		} while ((a.bp->b_flags & B_ERROR) && (i += 2) < 10 &&
    341      1.1    dsl 			i < lp->d_nsectors);
    342      1.1    dsl 	}
    343      1.1    dsl 
    344      1.1    dsl 	brelse(a.bp);
    345  1.6.4.1   yamt 	if (rval == SCAN_ERROR || rval == SCAN_CONTINUE)
    346  1.6.4.1   yamt 		return a.msg;
    347  1.6.4.1   yamt 	return NULL;
    348      1.1    dsl }
    349      1.1    dsl 
    350      1.1    dsl static int
    351  1.6.4.1   yamt look_netbsd_part(mbr_args_t *a, mbr_partition_t *dp, int slot, uint ext_base)
    352      1.1    dsl {
    353      1.1    dsl 	struct partition *pp;
    354      1.1    dsl 	int ptn_base = ext_base + le32toh(dp->mbrp_start);
    355      1.1    dsl 	int rval;
    356      1.1    dsl 
    357      1.1    dsl 	if (
    358      1.1    dsl #ifdef COMPAT_386BSD_MBRPART
    359      1.4  lukem 	    dp->mbrp_type == MBR_PTYPE_386BSD ||
    360      1.1    dsl #endif
    361      1.4  lukem 	    dp->mbrp_type == MBR_PTYPE_NETBSD) {
    362  1.6.4.1   yamt 		rval = validate_label(a, ptn_base);
    363      1.1    dsl 
    364  1.6.4.1   yamt #if RAW_PART == 3
    365      1.1    dsl 		/* Put actual location where we found the label into ptn 2 */
    366  1.6.4.1   yamt 		if (rval == SCAN_FOUND || a->lp->d_partitions[2].p_size == 0) {
    367      1.1    dsl 			a->lp->d_partitions[2].p_size = le32toh(dp->mbrp_size);
    368      1.1    dsl 			a->lp->d_partitions[2].p_offset = ptn_base;
    369      1.1    dsl 		}
    370  1.6.4.1   yamt #endif
    371      1.1    dsl 
    372      1.1    dsl 		/* If we got a netbsd label look no further */
    373      1.1    dsl 		if (rval == SCAN_FOUND)
    374      1.1    dsl 			return rval;
    375      1.1    dsl 	}
    376      1.1    dsl 
    377      1.1    dsl 	/* Install main partitions into e..h and extended into i+ */
    378      1.1    dsl 	if (ext_base == 0)
    379      1.1    dsl 		slot += 4;
    380      1.1    dsl 	else {
    381      1.4  lukem 		slot = 4 + MBR_PART_COUNT;
    382      1.1    dsl 		pp = &a->lp->d_partitions[slot];
    383      1.1    dsl 		for (; slot < MAXPARTITIONS; pp++, slot++) {
    384      1.1    dsl 			/* This gets called twice - avoid duplicates */
    385      1.1    dsl 			if (pp->p_offset == ptn_base &&
    386      1.1    dsl 			    pp->p_size == le32toh(dp->mbrp_size))
    387      1.1    dsl 				break;
    388      1.1    dsl 			if (pp->p_size == 0)
    389      1.1    dsl 				break;
    390      1.1    dsl 		}
    391      1.1    dsl 	}
    392      1.1    dsl 
    393      1.1    dsl 	if (slot < MAXPARTITIONS) {
    394      1.1    dsl 		/* Stop 'a' being the entire disk */
    395      1.1    dsl 		a->lp->d_partitions[0].p_size = 0;
    396      1.1    dsl 		a->lp->d_partitions[0].p_fstype = 0;
    397      1.1    dsl 
    398      1.1    dsl 		/* save partition info */
    399      1.1    dsl 		pp = &a->lp->d_partitions[slot];
    400      1.1    dsl 		pp->p_offset = ptn_base;
    401      1.1    dsl 		pp->p_size = le32toh(dp->mbrp_size);
    402      1.4  lukem 		pp->p_fstype = xlat_mbr_fstype(dp->mbrp_type);
    403      1.1    dsl 
    404      1.1    dsl 		if (slot >= a->lp->d_npartitions)
    405      1.1    dsl 			a->lp->d_npartitions = slot + 1;
    406      1.1    dsl 	}
    407      1.1    dsl 
    408      1.1    dsl 	return SCAN_CONTINUE;
    409      1.1    dsl }
    410      1.1    dsl 
    411      1.1    dsl 
    412      1.1    dsl static int
    413  1.6.4.1   yamt validate_label(mbr_args_t *a, uint label_sector)
    414      1.1    dsl {
    415      1.3    dsl 	struct disklabel *dlp;
    416  1.6.4.1   yamt 	char *dlp_lim, *dlp_byte;
    417      1.1    dsl 	int error;
    418      1.1    dsl 
    419      1.1    dsl 	/* Next, dig out disk label */
    420  1.6.4.1   yamt 	if (read_sector(a, label_sector, 2)) {
    421      1.3    dsl 		a->msg = "disk label read failed";
    422      1.1    dsl 		return SCAN_ERROR;
    423      1.1    dsl 	}
    424      1.1    dsl 
    425      1.1    dsl 	/* Locate disk label within block and validate */
    426      1.1    dsl 	/*
    427      1.1    dsl 	 * XXX (dsl) This search may be a waste of time, a lot of other i386
    428      1.1    dsl 	 * code assumes the label is at offset LABELOFFSET (=0) in the sector.
    429      1.1    dsl 	 *
    430      1.3    dsl 	 * If we want to support disks from other netbsd ports, then the
    431      1.1    dsl 	 * code should also allow for a shorter label nearer the end of
    432      1.1    dsl 	 * the disk sector, and (IIRC) labels within 8k of the disk start.
    433      1.1    dsl 	 */
    434      1.3    dsl 	dlp = (void *)a->bp->b_data;
    435  1.6.4.1   yamt 	dlp_lim = a->bp->b_data + a->bp->b_bcount - sizeof *dlp;
    436  1.6.4.1   yamt 	for (;; dlp = (void *)((char *)dlp + sizeof(long))) {
    437  1.6.4.1   yamt 		if ((char *)dlp > dlp_lim) {
    438  1.6.4.1   yamt 			if (a->action != WRITE_LABEL)
    439      1.3    dsl 				return SCAN_CONTINUE;
    440  1.6.4.1   yamt 			/* Write at arch. dependant default location */
    441  1.6.4.1   yamt 			dlp_byte = a->bp->b_data + LABELOFFSET;
    442  1.6.4.1   yamt 			if (label_sector)
    443  1.6.4.1   yamt 				dlp_byte += MBR_LABELSECTOR * a->lp->d_secsize;
    444  1.6.4.1   yamt 			else
    445  1.6.4.1   yamt 				dlp_byte += LABELSECTOR * a->lp->d_secsize;
    446  1.6.4.1   yamt 			dlp = (void *)dlp_byte;
    447      1.1    dsl 			break;
    448      1.1    dsl 		}
    449  1.6.4.1   yamt 		if (dlp->d_magic != DISKMAGIC || dlp->d_magic2 != DISKMAGIC)
    450  1.6.4.1   yamt 			continue;
    451  1.6.4.1   yamt 		if (dlp->d_npartitions > MAXPARTITIONS || dkcksum(dlp) != 0) {
    452  1.6.4.1   yamt 			a->msg = "disk label corrupted";
    453  1.6.4.1   yamt 			continue;
    454  1.6.4.1   yamt 		}
    455  1.6.4.1   yamt 		break;
    456      1.3    dsl 	}
    457      1.3    dsl 
    458  1.6.4.1   yamt 	switch (a->action) {
    459      1.3    dsl 	case READ_LABEL:
    460      1.3    dsl 		*a->lp = *dlp;
    461      1.3    dsl 		a->label_sector = label_sector;
    462      1.1    dsl 		return SCAN_FOUND;
    463      1.3    dsl 	case UPDATE_LABEL:
    464      1.3    dsl 	case WRITE_LABEL:
    465      1.3    dsl 		*dlp = *a->lp;
    466      1.3    dsl 		a->bp->b_flags &= ~(B_READ|B_DONE);
    467      1.3    dsl 		a->bp->b_flags |= B_WRITE;
    468      1.3    dsl 		(*a->strat)(a->bp);
    469      1.3    dsl 		error = biowait(a->bp);
    470      1.3    dsl 		if (error != 0) {
    471      1.3    dsl 			a->error = error;
    472      1.3    dsl 			a->msg = "disk label write failed";
    473      1.3    dsl 			return SCAN_ERROR;
    474      1.3    dsl 		}
    475      1.3    dsl 		a->written++;
    476      1.3    dsl 		/* Write label to all mbr partitions */
    477      1.3    dsl 		return SCAN_CONTINUE;
    478      1.3    dsl 	default:
    479      1.3    dsl 		return SCAN_ERROR;
    480      1.1    dsl 	}
    481      1.1    dsl }
    482      1.1    dsl 
    483      1.1    dsl /*
    484      1.1    dsl  * Check new disk label for sensibility
    485      1.1    dsl  * before setting it.
    486      1.1    dsl  */
    487      1.1    dsl int
    488  1.6.4.1   yamt setdisklabel(struct disklabel *olp, struct disklabel *nlp, u_long openmask,
    489  1.6.4.1   yamt     struct cpu_disklabel *osdep)
    490      1.1    dsl {
    491      1.1    dsl 	int i;
    492      1.1    dsl 	struct partition *opp, *npp;
    493      1.1    dsl 
    494      1.1    dsl 	/* sanity clause */
    495      1.1    dsl 	if (nlp->d_secpercyl == 0 || nlp->d_secsize == 0
    496      1.1    dsl 		|| (nlp->d_secsize % DEV_BSIZE) != 0)
    497      1.1    dsl 			return (EINVAL);
    498      1.1    dsl 
    499      1.1    dsl 	/* special case to allow disklabel to be invalidated */
    500      1.1    dsl 	if (nlp->d_magic == 0xffffffff) {
    501      1.1    dsl 		*olp = *nlp;
    502      1.1    dsl 		return (0);
    503      1.1    dsl 	}
    504      1.1    dsl 
    505      1.1    dsl 	if (nlp->d_magic != DISKMAGIC || nlp->d_magic2 != DISKMAGIC ||
    506      1.1    dsl 	    dkcksum(nlp) != 0)
    507      1.1    dsl 		return (EINVAL);
    508      1.1    dsl 
    509      1.1    dsl 	/* XXX missing check if other dos partitions will be overwritten */
    510      1.1    dsl 
    511      1.1    dsl 	while (openmask != 0) {
    512      1.1    dsl 		i = ffs(openmask) - 1;
    513      1.1    dsl 		openmask &= ~(1 << i);
    514      1.1    dsl 		if (i > nlp->d_npartitions)
    515      1.1    dsl 			return (EBUSY);
    516      1.1    dsl 		opp = &olp->d_partitions[i];
    517      1.1    dsl 		npp = &nlp->d_partitions[i];
    518      1.1    dsl 		/*
    519      1.1    dsl 		 * Copy internally-set partition information
    520      1.1    dsl 		 * if new label doesn't include it.		XXX
    521      1.1    dsl 		 */
    522      1.1    dsl 		if (npp->p_fstype == FS_UNUSED && opp->p_fstype != FS_UNUSED) {
    523      1.1    dsl 			*npp = *opp;
    524      1.1    dsl 			continue;
    525      1.1    dsl 		}
    526      1.1    dsl 		if (npp->p_offset != opp->p_offset || npp->p_size < opp->p_size)
    527      1.1    dsl 			return (EBUSY);
    528      1.1    dsl 	}
    529      1.1    dsl  	nlp->d_checksum = 0;
    530      1.1    dsl  	nlp->d_checksum = dkcksum(nlp);
    531      1.1    dsl 	*olp = *nlp;
    532      1.1    dsl 	return (0);
    533      1.1    dsl }
    534      1.1    dsl 
    535      1.1    dsl 
    536      1.1    dsl /*
    537      1.1    dsl  * Write disk label back to device after modification.
    538      1.1    dsl  */
    539      1.1    dsl int
    540  1.6.4.1   yamt writedisklabel(dev_t dev, void (*strat)(struct buf *), struct disklabel *lp,
    541  1.6.4.1   yamt     struct cpu_disklabel *osdep)
    542      1.1    dsl {
    543      1.1    dsl 	mbr_args_t a;
    544      1.1    dsl 
    545      1.3    dsl 	memset(&a, 0, sizeof a);
    546      1.1    dsl 	a.lp = lp;
    547      1.1    dsl 	a.strat = strat;
    548      1.1    dsl 
    549      1.1    dsl 	/* get a buffer and initialize it */
    550  1.6.4.1   yamt 	a.bp = geteblk(2 * (int)lp->d_secsize);
    551      1.1    dsl 	a.bp->b_dev = dev;
    552      1.1    dsl 
    553  1.6.4.1   yamt 	/* osdep => we expect an mbr with label in netbsd ptn */
    554  1.6.4.1   yamt 	a.action = osdep != NULL ? WRITE_LABEL : UPDATE_LABEL;
    555      1.3    dsl 
    556  1.6.4.1   yamt 	/* Write/update the label to every netbsd mbr partition */
    557  1.6.4.1   yamt 	scan_mbr(&a, write_netbsd_label);
    558  1.6.4.1   yamt 
    559  1.6.4.1   yamt 	/* Old write the label at the start of the volume on disks that
    560  1.6.4.1   yamt 	 * don't have a valid mbr (always update an existing one) */
    561  1.6.4.1   yamt 	a.action = a.found_mbr ? UPDATE_LABEL : WRITE_LABEL;
    562  1.6.4.1   yamt 	validate_label(&a, 0);
    563      1.1    dsl 
    564      1.3    dsl 	if (a.written == 0 && a.error == 0)
    565      1.1    dsl 		a.error = ESRCH;
    566      1.1    dsl 
    567      1.1    dsl 	brelse(a.bp);
    568      1.1    dsl 	return a.error;
    569      1.1    dsl }
    570      1.1    dsl 
    571      1.1    dsl static int
    572  1.6.4.1   yamt write_netbsd_label(mbr_args_t *a, mbr_partition_t *dp, int slot, uint ext_base)
    573      1.1    dsl {
    574      1.1    dsl 	int ptn_base = ext_base + le32toh(dp->mbrp_start);
    575      1.1    dsl 
    576      1.4  lukem 	if (dp->mbrp_type != MBR_PTYPE_NETBSD)
    577      1.1    dsl 		return SCAN_CONTINUE;
    578      1.1    dsl 
    579  1.6.4.1   yamt 	return validate_label(a, ptn_base);
    580      1.1    dsl }
    581