Home | History | Annotate | Line # | Download | only in dev
ld.c revision 1.33.6.2
      1  1.33.6.2      yamt /*	$NetBSD: ld.c,v 1.33.6.2 2005/03/19 08:33:53 yamt Exp $	*/
      2       1.1        ad 
      3       1.1        ad /*-
      4       1.1        ad  * Copyright (c) 1998, 2000 The NetBSD Foundation, Inc.
      5       1.1        ad  * All rights reserved.
      6       1.1        ad  *
      7       1.1        ad  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1        ad  * by Andrew Doran and Charles M. Hannum.
      9       1.1        ad  *
     10       1.1        ad  * Redistribution and use in source and binary forms, with or without
     11       1.1        ad  * modification, are permitted provided that the following conditions
     12       1.1        ad  * are met:
     13       1.1        ad  * 1. Redistributions of source code must retain the above copyright
     14       1.1        ad  *    notice, this list of conditions and the following disclaimer.
     15       1.1        ad  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1        ad  *    notice, this list of conditions and the following disclaimer in the
     17       1.1        ad  *    documentation and/or other materials provided with the distribution.
     18       1.1        ad  * 3. All advertising materials mentioning features or use of this software
     19       1.1        ad  *    must display the following acknowledgement:
     20       1.1        ad  *        This product includes software developed by the NetBSD
     21       1.1        ad  *        Foundation, Inc. and its contributors.
     22       1.1        ad  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1        ad  *    contributors may be used to endorse or promote products derived
     24       1.1        ad  *    from this software without specific prior written permission.
     25       1.1        ad  *
     26       1.1        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1        ad  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1        ad  */
     38       1.1        ad 
     39       1.1        ad /*
     40       1.1        ad  * Disk driver for use by RAID controllers.
     41       1.1        ad  */
     42      1.12     lukem 
     43      1.12     lukem #include <sys/cdefs.h>
     44  1.33.6.2      yamt __KERNEL_RCSID(0, "$NetBSD: ld.c,v 1.33.6.2 2005/03/19 08:33:53 yamt Exp $");
     45       1.1        ad 
     46       1.1        ad #include "rnd.h"
     47       1.1        ad 
     48       1.1        ad #include <sys/param.h>
     49       1.1        ad #include <sys/systm.h>
     50       1.1        ad #include <sys/kernel.h>
     51       1.1        ad #include <sys/device.h>
     52       1.1        ad #include <sys/queue.h>
     53       1.1        ad #include <sys/proc.h>
     54       1.1        ad #include <sys/buf.h>
     55      1.33      yamt #include <sys/bufq.h>
     56       1.1        ad #include <sys/endian.h>
     57       1.1        ad #include <sys/disklabel.h>
     58       1.1        ad #include <sys/disk.h>
     59       1.1        ad #include <sys/dkio.h>
     60       1.1        ad #include <sys/stat.h>
     61       1.1        ad #include <sys/lock.h>
     62       1.1        ad #include <sys/conf.h>
     63       1.1        ad #include <sys/fcntl.h>
     64       1.2        ad #include <sys/vnode.h>
     65       1.1        ad #include <sys/syslog.h>
     66       1.1        ad #if NRND > 0
     67       1.1        ad #include <sys/rnd.h>
     68       1.1        ad #endif
     69       1.1        ad 
     70       1.1        ad #include <dev/ldvar.h>
     71       1.1        ad 
     72       1.1        ad static void	ldgetdefaultlabel(struct ld_softc *, struct disklabel *);
     73       1.1        ad static void	ldgetdisklabel(struct ld_softc *);
     74       1.1        ad static void	ldminphys(struct buf *bp);
     75       1.1        ad static void	ldshutdown(void *);
     76      1.23   thorpej static void	ldstart(struct ld_softc *);
     77       1.1        ad 
     78       1.1        ad extern struct	cfdriver ld_cd;
     79       1.1        ad 
     80      1.29   thorpej static dev_type_open(ldopen);
     81      1.29   thorpej static dev_type_close(ldclose);
     82      1.29   thorpej static dev_type_read(ldread);
     83      1.29   thorpej static dev_type_write(ldwrite);
     84      1.29   thorpej static dev_type_ioctl(ldioctl);
     85      1.29   thorpej static dev_type_strategy(ldstrategy);
     86      1.29   thorpej static dev_type_dump(lddump);
     87      1.29   thorpej static dev_type_size(ldsize);
     88      1.16   gehenna 
     89      1.16   gehenna const struct bdevsw ld_bdevsw = {
     90      1.16   gehenna 	ldopen, ldclose, ldstrategy, ldioctl, lddump, ldsize, D_DISK
     91      1.16   gehenna };
     92      1.16   gehenna 
     93      1.16   gehenna const struct cdevsw ld_cdevsw = {
     94      1.16   gehenna 	ldopen, ldclose, ldread, ldwrite, ldioctl,
     95      1.17  jdolecek 	nostop, notty, nopoll, nommap, nokqfilter, D_DISK
     96      1.16   gehenna };
     97      1.16   gehenna 
     98      1.30   thorpej static struct	dkdriver lddkdriver = { ldstrategy, ldminphys };
     99       1.1        ad static void	*ld_sdh;
    100       1.1        ad 
    101       1.1        ad void
    102       1.1        ad ldattach(struct ld_softc *sc)
    103       1.1        ad {
    104       1.1        ad 	char buf[9];
    105       1.1        ad 
    106       1.7        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0) {
    107  1.33.6.1      yamt 		aprint_normal("%s: disabled\n", sc->sc_dv.dv_xname);
    108       1.7        ad 		return;
    109       1.7        ad 	}
    110       1.7        ad 
    111       1.1        ad 	/* Initialise and attach the disk structure. */
    112       1.1        ad 	sc->sc_dk.dk_driver = &lddkdriver;
    113       1.1        ad 	sc->sc_dk.dk_name = sc->sc_dv.dv_xname;
    114       1.1        ad 	disk_attach(&sc->sc_dk);
    115       1.1        ad 
    116       1.1        ad 	if (sc->sc_maxxfer > MAXPHYS)
    117       1.1        ad 		sc->sc_maxxfer = MAXPHYS;
    118       1.9        ad 
    119      1.19   thorpej 	/* Build synthetic geometry if necessary. */
    120      1.19   thorpej 	if (sc->sc_nheads == 0 || sc->sc_nsectors == 0 ||
    121      1.19   thorpej 	    sc->sc_ncylinders == 0) {
    122      1.28       dbj 		uint64_t ncyl;
    123      1.28       dbj 
    124      1.19   thorpej 		if (sc->sc_secperunit <= 528 * 2048)		/* 528MB */
    125      1.19   thorpej 			sc->sc_nheads = 16;
    126      1.19   thorpej 		else if (sc->sc_secperunit <= 1024 * 2048)	/* 1GB */
    127      1.19   thorpej 			sc->sc_nheads = 32;
    128      1.19   thorpej 		else if (sc->sc_secperunit <= 21504 * 2048)	/* 21GB */
    129      1.19   thorpej 			sc->sc_nheads = 64;
    130      1.19   thorpej 		else if (sc->sc_secperunit <= 43008 * 2048)	/* 42GB */
    131      1.19   thorpej 			sc->sc_nheads = 128;
    132      1.19   thorpej 		else
    133      1.19   thorpej 			sc->sc_nheads = 255;
    134      1.19   thorpej 
    135      1.19   thorpej 		sc->sc_nsectors = 63;
    136      1.28       dbj 		sc->sc_ncylinders = INT_MAX;
    137  1.33.6.2      yamt 		ncyl = sc->sc_secperunit /
    138      1.19   thorpej 		    (sc->sc_nheads * sc->sc_nsectors);
    139      1.28       dbj 		if (ncyl < INT_MAX)
    140      1.28       dbj 			sc->sc_ncylinders = (int)ncyl;
    141      1.19   thorpej 	}
    142       1.1        ad 
    143      1.28       dbj 	format_bytes(buf, sizeof(buf), sc->sc_secperunit *
    144       1.1        ad 	    sc->sc_secsize);
    145  1.33.6.1      yamt 	aprint_normal("%s: %s, %d cyl, %d head, %d sec, %d bytes/sect x %"PRIu64" sectors\n",
    146       1.1        ad 	    sc->sc_dv.dv_xname, buf, sc->sc_ncylinders, sc->sc_nheads,
    147       1.1        ad 	    sc->sc_nsectors, sc->sc_secsize, sc->sc_secperunit);
    148       1.1        ad 
    149       1.1        ad #if NRND > 0
    150       1.1        ad 	/* Attach the device into the rnd source list. */
    151       1.1        ad 	rnd_attach_source(&sc->sc_rnd_source, sc->sc_dv.dv_xname,
    152       1.1        ad 	    RND_TYPE_DISK, 0);
    153       1.1        ad #endif
    154       1.1        ad 
    155       1.1        ad 	/* Set the `shutdownhook'. */
    156       1.1        ad 	if (ld_sdh == NULL)
    157       1.1        ad 		ld_sdh = shutdownhook_establish(ldshutdown, NULL);
    158      1.27       tls 	bufq_alloc(&sc->sc_bufq, BUFQ_DISK_DEFAULT_STRAT()|BUFQ_SORT_RAWBLOCK);
    159      1.30   thorpej 
    160      1.30   thorpej 	/* Discover wedges on this disk. */
    161      1.30   thorpej 	dkwedge_discover(&sc->sc_dk);
    162       1.1        ad }
    163       1.1        ad 
    164       1.3        ad int
    165       1.7        ad ldadjqparam(struct ld_softc *sc, int max)
    166       1.3        ad {
    167      1.24   thorpej 	int s;
    168       1.7        ad 
    169       1.7        ad 	s = splbio();
    170       1.7        ad 	sc->sc_maxqueuecnt = max;
    171       1.7        ad 	splx(s);
    172       1.7        ad 
    173      1.24   thorpej 	return (0);
    174       1.7        ad }
    175       1.7        ad 
    176       1.7        ad int
    177       1.7        ad ldbegindetach(struct ld_softc *sc, int flags)
    178       1.7        ad {
    179      1.24   thorpej 	int s, rv = 0;
    180       1.7        ad 
    181       1.7        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    182       1.7        ad 		return (0);
    183       1.3        ad 
    184       1.3        ad 	if ((flags & DETACH_FORCE) == 0 && sc->sc_dk.dk_openmask != 0)
    185       1.3        ad 		return (EBUSY);
    186       1.3        ad 
    187       1.3        ad 	s = splbio();
    188      1.24   thorpej 	sc->sc_maxqueuecnt = 0;
    189       1.7        ad 	sc->sc_flags |= LDF_DETACH;
    190      1.24   thorpej 	while (sc->sc_queuecnt > 0) {
    191      1.24   thorpej 		sc->sc_flags |= LDF_DRAIN;
    192      1.24   thorpej 		rv = tsleep(&sc->sc_queuecnt, PRIBIO, "lddrn", 0);
    193      1.24   thorpej 		if (rv)
    194      1.24   thorpej 			break;
    195      1.24   thorpej 	}
    196       1.3        ad 	splx(s);
    197       1.7        ad 
    198       1.7        ad 	return (rv);
    199       1.3        ad }
    200       1.3        ad 
    201       1.2        ad void
    202       1.7        ad ldenddetach(struct ld_softc *sc)
    203       1.2        ad {
    204       1.2        ad 	struct buf *bp;
    205      1.13  drochner 	int s, bmaj, cmaj, i, mn;
    206       1.2        ad 
    207       1.7        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    208       1.7        ad 		return;
    209       1.7        ad 
    210       1.2        ad 	/* Wait for commands queued with the hardware to complete. */
    211       1.2        ad 	if (sc->sc_queuecnt != 0)
    212       1.7        ad 		if (tsleep(&sc->sc_queuecnt, PRIBIO, "lddtch", 30 * hz))
    213       1.7        ad 			printf("%s: not drained\n", sc->sc_dv.dv_xname);
    214       1.2        ad 
    215       1.2        ad 	/* Locate the major numbers. */
    216      1.16   gehenna 	bmaj = bdevsw_lookup_major(&ld_bdevsw);
    217      1.16   gehenna 	cmaj = cdevsw_lookup_major(&ld_cdevsw);
    218       1.2        ad 
    219       1.2        ad 	/* Kill off any queued buffers. */
    220       1.2        ad 	s = splbio();
    221      1.14   hannken 	while ((bp = BUFQ_GET(&sc->sc_bufq)) != NULL) {
    222       1.2        ad 		bp->b_error = EIO;
    223       1.2        ad 		bp->b_flags |= B_ERROR;
    224       1.2        ad 		bp->b_resid = bp->b_bcount;
    225       1.2        ad 		biodone(bp);
    226       1.2        ad 	}
    227      1.15   hannken 	bufq_free(&sc->sc_bufq);
    228       1.2        ad 	splx(s);
    229       1.2        ad 
    230       1.2        ad 	/* Nuke the vnodes for any open instances. */
    231      1.13  drochner 	for (i = 0; i < MAXPARTITIONS; i++) {
    232      1.13  drochner 		mn = DISKMINOR(sc->sc_dv.dv_unit, i);
    233      1.13  drochner 		vdevgone(bmaj, mn, mn, VBLK);
    234      1.13  drochner 		vdevgone(cmaj, mn, mn, VCHR);
    235      1.13  drochner 	}
    236      1.13  drochner 
    237      1.30   thorpej 	/* Delete all of our wedges. */
    238      1.30   thorpej 	dkwedge_delall(&sc->sc_dk);
    239      1.30   thorpej 
    240       1.2        ad 	/* Detach from the disk list. */
    241       1.2        ad 	disk_detach(&sc->sc_dk);
    242       1.2        ad 
    243       1.2        ad #if NRND > 0
    244       1.2        ad 	/* Unhook the entropy source. */
    245       1.2        ad 	rnd_detach_source(&sc->sc_rnd_source);
    246       1.2        ad #endif
    247       1.2        ad 
    248      1.24   thorpej 	/*
    249      1.24   thorpej 	 * XXX We can't really flush the cache here, beceause the
    250      1.24   thorpej 	 * XXX device may already be non-existent from the controller's
    251      1.24   thorpej 	 * XXX perspective.
    252      1.24   thorpej 	 */
    253      1.24   thorpej #if 0
    254       1.2        ad 	/* Flush the device's cache. */
    255       1.2        ad 	if (sc->sc_flush != NULL)
    256       1.2        ad 		if ((*sc->sc_flush)(sc) != 0)
    257       1.2        ad 			printf("%s: unable to flush cache\n",
    258       1.2        ad 			    sc->sc_dv.dv_xname);
    259      1.24   thorpej #endif
    260       1.2        ad }
    261       1.2        ad 
    262       1.8     lukem /* ARGSUSED */
    263       1.1        ad static void
    264       1.1        ad ldshutdown(void *cookie)
    265       1.1        ad {
    266       1.1        ad 	struct ld_softc *sc;
    267       1.1        ad 	int i;
    268       1.1        ad 
    269       1.1        ad 	for (i = 0; i < ld_cd.cd_ndevs; i++) {
    270       1.1        ad 		if ((sc = device_lookup(&ld_cd, i)) == NULL)
    271       1.1        ad 			continue;
    272       1.1        ad 		if (sc->sc_flush != NULL && (*sc->sc_flush)(sc) != 0)
    273       1.1        ad 			printf("%s: unable to flush cache\n",
    274       1.1        ad 			    sc->sc_dv.dv_xname);
    275       1.1        ad 	}
    276       1.1        ad }
    277       1.1        ad 
    278       1.8     lukem /* ARGSUSED */
    279      1.29   thorpej static int
    280      1.26      fvdl ldopen(dev_t dev, int flags, int fmt, struct proc *p)
    281       1.1        ad {
    282       1.1        ad 	struct ld_softc *sc;
    283      1.30   thorpej 	int error, unit, part;
    284       1.1        ad 
    285       1.1        ad 	unit = DISKUNIT(dev);
    286      1.30   thorpej 	if ((sc = device_lookup(&ld_cd, unit)) == NULL)
    287       1.1        ad 		return (ENXIO);
    288       1.1        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    289       1.1        ad 		return (ENODEV);
    290       1.1        ad 	part = DISKPART(dev);
    291      1.30   thorpej 
    292      1.30   thorpej 	if ((error = lockmgr(&sc->sc_dk.dk_openlock, LK_EXCLUSIVE, NULL)) != 0)
    293      1.30   thorpej 		return (error);
    294       1.1        ad 
    295      1.22   thorpej 	if (sc->sc_dk.dk_openmask == 0) {
    296      1.22   thorpej 		/* Load the partition info if not already loaded. */
    297      1.22   thorpej 		if ((sc->sc_flags & LDF_VLABEL) == 0)
    298      1.22   thorpej 			ldgetdisklabel(sc);
    299      1.22   thorpej 	}
    300       1.1        ad 
    301       1.1        ad 	/* Check that the partition exists. */
    302       1.1        ad 	if (part != RAW_PART && (part >= sc->sc_dk.dk_label->d_npartitions ||
    303       1.1        ad 	    sc->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
    304      1.30   thorpej 		error = ENXIO;
    305      1.30   thorpej 		goto bad1;
    306       1.1        ad 	}
    307       1.1        ad 
    308       1.1        ad 	/* Ensure only one open at a time. */
    309       1.1        ad 	switch (fmt) {
    310       1.1        ad 	case S_IFCHR:
    311       1.1        ad 		sc->sc_dk.dk_copenmask |= (1 << part);
    312       1.1        ad 		break;
    313       1.1        ad 	case S_IFBLK:
    314       1.1        ad 		sc->sc_dk.dk_bopenmask |= (1 << part);
    315       1.1        ad 		break;
    316       1.1        ad 	}
    317       1.1        ad 	sc->sc_dk.dk_openmask =
    318       1.1        ad 	    sc->sc_dk.dk_copenmask | sc->sc_dk.dk_bopenmask;
    319       1.1        ad 
    320      1.30   thorpej 	(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    321       1.1        ad 	return (0);
    322      1.30   thorpej 
    323      1.30   thorpej  bad1:
    324      1.30   thorpej 	(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    325      1.30   thorpej 	return (error);
    326       1.1        ad }
    327       1.1        ad 
    328       1.8     lukem /* ARGSUSED */
    329      1.29   thorpej static int
    330      1.26      fvdl ldclose(dev_t dev, int flags, int fmt, struct proc *p)
    331       1.1        ad {
    332       1.1        ad 	struct ld_softc *sc;
    333      1.30   thorpej 	int error, part, unit;
    334       1.1        ad 
    335       1.1        ad 	unit = DISKUNIT(dev);
    336       1.1        ad 	part = DISKPART(dev);
    337       1.1        ad 	sc = device_lookup(&ld_cd, unit);
    338      1.30   thorpej 
    339      1.30   thorpej 	if ((error = lockmgr(&sc->sc_dk.dk_openlock, LK_EXCLUSIVE, NULL)) != 0)
    340      1.30   thorpej 		return (error);
    341       1.1        ad 
    342       1.1        ad 	switch (fmt) {
    343       1.1        ad 	case S_IFCHR:
    344       1.1        ad 		sc->sc_dk.dk_copenmask &= ~(1 << part);
    345       1.1        ad 		break;
    346       1.1        ad 	case S_IFBLK:
    347       1.1        ad 		sc->sc_dk.dk_bopenmask &= ~(1 << part);
    348       1.1        ad 		break;
    349       1.1        ad 	}
    350       1.1        ad 	sc->sc_dk.dk_openmask =
    351       1.1        ad 	    sc->sc_dk.dk_copenmask | sc->sc_dk.dk_bopenmask;
    352       1.1        ad 
    353      1.22   thorpej 	if (sc->sc_dk.dk_openmask == 0) {
    354      1.22   thorpej 		if (sc->sc_flush != NULL && (*sc->sc_flush)(sc) != 0)
    355       1.1        ad 			printf("%s: unable to flush cache\n",
    356       1.1        ad 			    sc->sc_dv.dv_xname);
    357      1.22   thorpej 		if ((sc->sc_flags & LDF_KLABEL) == 0)
    358      1.22   thorpej 			sc->sc_flags &= ~LDF_VLABEL;
    359      1.22   thorpej 	}
    360       1.1        ad 
    361      1.30   thorpej 	(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    362       1.1        ad 	return (0);
    363       1.1        ad }
    364       1.1        ad 
    365       1.8     lukem /* ARGSUSED */
    366      1.29   thorpej static int
    367       1.1        ad ldread(dev_t dev, struct uio *uio, int ioflag)
    368       1.1        ad {
    369       1.1        ad 
    370       1.1        ad 	return (physio(ldstrategy, NULL, dev, B_READ, ldminphys, uio));
    371       1.1        ad }
    372       1.1        ad 
    373       1.8     lukem /* ARGSUSED */
    374      1.29   thorpej static int
    375       1.1        ad ldwrite(dev_t dev, struct uio *uio, int ioflag)
    376       1.1        ad {
    377       1.1        ad 
    378       1.1        ad 	return (physio(ldstrategy, NULL, dev, B_WRITE, ldminphys, uio));
    379       1.1        ad }
    380       1.1        ad 
    381       1.8     lukem /* ARGSUSED */
    382      1.29   thorpej static int
    383      1.26      fvdl ldioctl(dev_t dev, u_long cmd, caddr_t addr, int32_t flag, struct proc *p)
    384       1.1        ad {
    385       1.1        ad 	struct ld_softc *sc;
    386       1.1        ad 	int part, unit, error;
    387       1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    388       1.6    itojun 	struct disklabel newlabel;
    389       1.4      fvdl #endif
    390       1.6    itojun 	struct disklabel *lp;
    391       1.1        ad 
    392       1.1        ad 	unit = DISKUNIT(dev);
    393       1.1        ad 	part = DISKPART(dev);
    394       1.1        ad 	sc = device_lookup(&ld_cd, unit);
    395       1.1        ad 	error = 0;
    396       1.1        ad 
    397       1.1        ad 	switch (cmd) {
    398       1.1        ad 	case DIOCGDINFO:
    399       1.1        ad 		memcpy(addr, sc->sc_dk.dk_label, sizeof(struct disklabel));
    400       1.1        ad 		return (0);
    401       1.1        ad 
    402       1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    403       1.4      fvdl 	case ODIOCGDINFO:
    404       1.4      fvdl 		newlabel = *(sc->sc_dk.dk_label);
    405       1.4      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
    406       1.5      fvdl 			return ENOTTY;
    407       1.4      fvdl 		memcpy(addr, &newlabel, sizeof(struct olddisklabel));
    408       1.4      fvdl 		return (0);
    409       1.4      fvdl #endif
    410       1.4      fvdl 
    411       1.1        ad 	case DIOCGPART:
    412       1.1        ad 		((struct partinfo *)addr)->disklab = sc->sc_dk.dk_label;
    413       1.1        ad 		((struct partinfo *)addr)->part =
    414       1.1        ad 		    &sc->sc_dk.dk_label->d_partitions[part];
    415       1.1        ad 		break;
    416       1.1        ad 
    417       1.1        ad 	case DIOCWDINFO:
    418       1.1        ad 	case DIOCSDINFO:
    419       1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    420       1.4      fvdl 	case ODIOCWDINFO:
    421       1.4      fvdl 	case ODIOCSDINFO:
    422       1.4      fvdl 
    423       1.4      fvdl 		if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
    424       1.4      fvdl 			memset(&newlabel, 0, sizeof newlabel);
    425       1.4      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
    426       1.4      fvdl 			lp = &newlabel;
    427       1.4      fvdl 		} else
    428       1.4      fvdl #endif
    429       1.4      fvdl 		lp = (struct disklabel *)addr;
    430       1.4      fvdl 
    431       1.1        ad 		if ((flag & FWRITE) == 0)
    432       1.1        ad 			return (EBADF);
    433       1.1        ad 
    434      1.30   thorpej 		if ((error = lockmgr(&sc->sc_dk.dk_openlock, LK_EXCLUSIVE,
    435      1.31  jdolecek 				     NULL)) != 0)
    436       1.1        ad 			return (error);
    437       1.1        ad 		sc->sc_flags |= LDF_LABELLING;
    438       1.1        ad 
    439       1.1        ad 		error = setdisklabel(sc->sc_dk.dk_label,
    440       1.4      fvdl 		    lp, /*sc->sc_dk.dk_openmask : */0,
    441       1.1        ad 		    sc->sc_dk.dk_cpulabel);
    442       1.4      fvdl 		if (error == 0 && (cmd == DIOCWDINFO
    443       1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    444       1.4      fvdl 		    || cmd == ODIOCWDINFO
    445       1.4      fvdl #endif
    446       1.4      fvdl 		    ))
    447       1.1        ad 			error = writedisklabel(
    448  1.33.6.2      yamt 			    MAKEDISKDEV(major(dev), DISKUNIT(dev), RAW_PART),
    449  1.33.6.2      yamt 			    ldstrategy, sc->sc_dk.dk_label,
    450       1.1        ad 			    sc->sc_dk.dk_cpulabel);
    451       1.1        ad 
    452       1.1        ad 		sc->sc_flags &= ~LDF_LABELLING;
    453      1.30   thorpej 		(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    454       1.1        ad 		break;
    455       1.1        ad 
    456      1.22   thorpej 	case DIOCKLABEL:
    457      1.22   thorpej 		if ((flag & FWRITE) == 0)
    458      1.22   thorpej 			return (EBADF);
    459      1.22   thorpej 		if (*(int *)addr)
    460      1.22   thorpej 			sc->sc_flags |= LDF_KLABEL;
    461      1.22   thorpej 		else
    462      1.22   thorpej 			sc->sc_flags &= ~LDF_KLABEL;
    463      1.22   thorpej 		break;
    464      1.22   thorpej 
    465       1.1        ad 	case DIOCWLABEL:
    466       1.1        ad 		if ((flag & FWRITE) == 0)
    467       1.1        ad 			return (EBADF);
    468       1.1        ad 		if (*(int *)addr)
    469       1.1        ad 			sc->sc_flags |= LDF_WLABEL;
    470       1.1        ad 		else
    471       1.1        ad 			sc->sc_flags &= ~LDF_WLABEL;
    472       1.1        ad 		break;
    473       1.1        ad 
    474       1.1        ad 	case DIOCGDEFLABEL:
    475       1.1        ad 		ldgetdefaultlabel(sc, (struct disklabel *)addr);
    476       1.1        ad 		break;
    477       1.4      fvdl 
    478       1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    479       1.4      fvdl 	case ODIOCGDEFLABEL:
    480       1.4      fvdl 		ldgetdefaultlabel(sc, &newlabel);
    481       1.4      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
    482       1.5      fvdl 			return ENOTTY;
    483       1.4      fvdl 		memcpy(addr, &newlabel, sizeof (struct olddisklabel));
    484       1.4      fvdl 		break;
    485       1.4      fvdl #endif
    486       1.1        ad 
    487      1.32   thorpej 	case DIOCCACHESYNC:
    488      1.32   thorpej 		/*
    489      1.32   thorpej 		 * XXX Do we really need to care about having a writable
    490      1.32   thorpej 		 * file descriptor here?
    491      1.32   thorpej 		 */
    492      1.32   thorpej 		if ((flag & FWRITE) == 0)
    493      1.32   thorpej 			error = EBADF;
    494      1.32   thorpej 		else if (sc->sc_flush)
    495      1.32   thorpej 			error = (*sc->sc_flush)(sc);
    496      1.32   thorpej 		else
    497      1.32   thorpej 			error = 0;	/* XXX Error out instead? */
    498      1.32   thorpej 		break;
    499      1.32   thorpej 
    500      1.30   thorpej 	case DIOCAWEDGE:
    501      1.30   thorpej 	    {
    502      1.30   thorpej 	    	struct dkwedge_info *dkw = (void *) addr;
    503      1.30   thorpej 
    504      1.30   thorpej 		if ((flag & FWRITE) == 0)
    505      1.30   thorpej 			return (EBADF);
    506      1.30   thorpej 
    507      1.30   thorpej 		/* If the ioctl happens here, the parent is us. */
    508      1.30   thorpej 		strcpy(dkw->dkw_parent, sc->sc_dv.dv_xname);
    509      1.30   thorpej 		return (dkwedge_add(dkw));
    510      1.30   thorpej 	    }
    511  1.33.6.2      yamt 
    512      1.30   thorpej 	case DIOCDWEDGE:
    513      1.30   thorpej 	    {
    514      1.30   thorpej 	    	struct dkwedge_info *dkw = (void *) addr;
    515      1.30   thorpej 
    516      1.30   thorpej 		if ((flag & FWRITE) == 0)
    517      1.30   thorpej 			return (EBADF);
    518      1.30   thorpej 
    519      1.30   thorpej 		/* If the ioctl happens here, the parent is us. */
    520      1.30   thorpej 		strcpy(dkw->dkw_parent, sc->sc_dv.dv_xname);
    521      1.30   thorpej 		return (dkwedge_del(dkw));
    522      1.30   thorpej 	    }
    523  1.33.6.2      yamt 
    524      1.30   thorpej 	case DIOCLWEDGES:
    525      1.30   thorpej 	    {
    526      1.30   thorpej 	    	struct dkwedge_list *dkwl = (void *) addr;
    527      1.30   thorpej 
    528      1.30   thorpej 		return (dkwedge_list(&sc->sc_dk, dkwl, p));
    529      1.30   thorpej 	    }
    530      1.30   thorpej 
    531       1.1        ad 	default:
    532       1.1        ad 		error = ENOTTY;
    533       1.1        ad 		break;
    534       1.1        ad 	}
    535       1.1        ad 
    536       1.1        ad 	return (error);
    537       1.1        ad }
    538       1.1        ad 
    539      1.29   thorpej static void
    540       1.1        ad ldstrategy(struct buf *bp)
    541       1.1        ad {
    542       1.1        ad 	struct ld_softc *sc;
    543      1.23   thorpej 	struct disklabel *lp;
    544      1.23   thorpej 	daddr_t blkno;
    545      1.23   thorpej 	int s, part;
    546       1.1        ad 
    547       1.1        ad 	sc = device_lookup(&ld_cd, DISKUNIT(bp->b_dev));
    548      1.23   thorpej 	part = DISKPART(bp->b_dev);
    549       1.1        ad 
    550       1.7        ad 	if ((sc->sc_flags & LDF_DETACH) != 0) {
    551       1.2        ad 		bp->b_error = EIO;
    552      1.23   thorpej 		goto bad;
    553       1.2        ad 	}
    554       1.2        ad 
    555       1.1        ad 	lp = sc->sc_dk.dk_label;
    556       1.1        ad 
    557       1.1        ad 	/*
    558       1.1        ad 	 * The transfer must be a whole number of blocks and the offset must
    559       1.1        ad 	 * not be negative.
    560       1.1        ad 	 */
    561       1.1        ad 	if ((bp->b_bcount % lp->d_secsize) != 0 || bp->b_blkno < 0) {
    562      1.23   thorpej 		bp->b_error = EINVAL;
    563      1.23   thorpej 		goto bad;
    564       1.1        ad 	}
    565       1.1        ad 
    566      1.23   thorpej 	/* If it's a null transfer, return immediately. */
    567      1.23   thorpej 	if (bp->b_bcount == 0)
    568      1.23   thorpej 		goto done;
    569       1.1        ad 
    570       1.1        ad 	/*
    571       1.1        ad 	 * Do bounds checking and adjust the transfer.  If error, process.
    572       1.1        ad 	 * If past the end of partition, just return.
    573       1.1        ad 	 */
    574       1.1        ad 	if (part != RAW_PART &&
    575      1.20   thorpej 	    bounds_check_with_label(&sc->sc_dk, bp,
    576       1.1        ad 	    (sc->sc_flags & (LDF_WLABEL | LDF_LABELLING)) != 0) <= 0) {
    577      1.23   thorpej 		goto done;
    578       1.1        ad 	}
    579       1.1        ad 
    580       1.1        ad 	/*
    581      1.23   thorpej 	 * Convert the block number to absolute and put it in terms
    582      1.23   thorpej 	 * of the device's logical block size.
    583       1.1        ad 	 */
    584      1.23   thorpej 	if (lp->d_secsize == DEV_BSIZE)
    585      1.23   thorpej 		blkno = bp->b_blkno;
    586      1.23   thorpej 	else if (lp->d_secsize > DEV_BSIZE)
    587      1.23   thorpej 		blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
    588       1.1        ad 	else
    589      1.23   thorpej 		blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
    590       1.1        ad 
    591      1.11   thorpej 	if (part != RAW_PART)
    592      1.23   thorpej 		blkno += lp->d_partitions[part].p_offset;
    593      1.23   thorpej 
    594      1.23   thorpej 	bp->b_rawblkno = blkno;
    595       1.1        ad 
    596       1.1        ad 	s = splbio();
    597      1.23   thorpej 	BUFQ_PUT(&sc->sc_bufq, bp);
    598      1.23   thorpej 	ldstart(sc);
    599       1.1        ad 	splx(s);
    600      1.23   thorpej 	return;
    601      1.23   thorpej 
    602      1.23   thorpej  bad:
    603      1.23   thorpej 	bp->b_flags |= B_ERROR;
    604      1.23   thorpej  done:
    605      1.23   thorpej 	bp->b_resid = bp->b_bcount;
    606      1.23   thorpej 	biodone(bp);
    607      1.23   thorpej }
    608      1.23   thorpej 
    609      1.23   thorpej static void
    610      1.23   thorpej ldstart(struct ld_softc *sc)
    611      1.23   thorpej {
    612      1.23   thorpej 	struct buf *bp;
    613      1.23   thorpej 	int error;
    614       1.1        ad 
    615      1.23   thorpej 	while (sc->sc_queuecnt < sc->sc_maxqueuecnt) {
    616      1.23   thorpej 		/* See if there is work to do. */
    617      1.23   thorpej 		if ((bp = BUFQ_PEEK(&sc->sc_bufq)) == NULL)
    618      1.23   thorpej 			break;
    619      1.23   thorpej 
    620      1.23   thorpej 		disk_busy(&sc->sc_dk);
    621      1.23   thorpej 		sc->sc_queuecnt++;
    622      1.23   thorpej 
    623      1.23   thorpej 		if (__predict_true((error = (*sc->sc_start)(sc, bp)) == 0)) {
    624      1.23   thorpej 			/*
    625      1.23   thorpej 			 * The back-end is running the job; remove it from
    626      1.23   thorpej 			 * the queue.
    627      1.23   thorpej 			 */
    628      1.23   thorpej 			(void) BUFQ_GET(&sc->sc_bufq);
    629      1.23   thorpej 		} else  {
    630      1.23   thorpej 			disk_unbusy(&sc->sc_dk, 0, (bp->b_flags & B_READ));
    631      1.23   thorpej 			sc->sc_queuecnt--;
    632      1.23   thorpej 			if (error == EAGAIN) {
    633      1.23   thorpej 				/*
    634      1.23   thorpej 				 * Temporary resource shortage in the
    635      1.23   thorpej 				 * back-end; just defer the job until
    636      1.23   thorpej 				 * later.
    637      1.23   thorpej 				 *
    638      1.23   thorpej 				 * XXX We might consider a watchdog timer
    639      1.23   thorpej 				 * XXX to make sure we are kicked into action.
    640      1.23   thorpej 				 */
    641      1.23   thorpej 				break;
    642      1.23   thorpej 			} else {
    643      1.23   thorpej 				(void) BUFQ_GET(&sc->sc_bufq);
    644      1.23   thorpej 				bp->b_error = error;
    645      1.23   thorpej 				bp->b_flags |= B_ERROR;
    646      1.23   thorpej 				bp->b_resid = bp->b_bcount;
    647      1.23   thorpej 				biodone(bp);
    648      1.23   thorpej 			}
    649      1.23   thorpej 		}
    650       1.1        ad 	}
    651       1.1        ad }
    652       1.1        ad 
    653       1.1        ad void
    654       1.1        ad lddone(struct ld_softc *sc, struct buf *bp)
    655       1.1        ad {
    656       1.1        ad 
    657       1.1        ad 	if ((bp->b_flags & B_ERROR) != 0) {
    658       1.1        ad 		diskerr(bp, "ld", "error", LOG_PRINTF, 0, sc->sc_dk.dk_label);
    659       1.1        ad 		printf("\n");
    660       1.1        ad 	}
    661       1.1        ad 
    662      1.18       mrg 	disk_unbusy(&sc->sc_dk, bp->b_bcount - bp->b_resid,
    663      1.18       mrg 	    (bp->b_flags & B_READ));
    664       1.1        ad #if NRND > 0
    665       1.1        ad 	rnd_add_uint32(&sc->sc_rnd_source, bp->b_rawblkno);
    666       1.1        ad #endif
    667       1.1        ad 	biodone(bp);
    668       1.1        ad 
    669       1.7        ad 	if (--sc->sc_queuecnt <= sc->sc_maxqueuecnt) {
    670      1.24   thorpej 		if ((sc->sc_flags & LDF_DRAIN) != 0) {
    671      1.24   thorpej 			sc->sc_flags &= ~LDF_DRAIN;
    672       1.7        ad 			wakeup(&sc->sc_queuecnt);
    673      1.24   thorpej 		}
    674      1.23   thorpej 		ldstart(sc);
    675       1.1        ad 	}
    676       1.1        ad }
    677       1.1        ad 
    678      1.29   thorpej static int
    679       1.1        ad ldsize(dev_t dev)
    680       1.1        ad {
    681       1.1        ad 	struct ld_softc *sc;
    682       1.1        ad 	int part, unit, omask, size;
    683       1.1        ad 
    684       1.1        ad 	unit = DISKUNIT(dev);
    685       1.1        ad 	if ((sc = device_lookup(&ld_cd, unit)) == NULL)
    686       1.1        ad 		return (ENODEV);
    687       1.1        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    688       1.1        ad 		return (ENODEV);
    689       1.1        ad 	part = DISKPART(dev);
    690       1.1        ad 
    691       1.1        ad 	omask = sc->sc_dk.dk_openmask & (1 << part);
    692       1.1        ad 
    693       1.1        ad 	if (omask == 0 && ldopen(dev, 0, S_IFBLK, NULL) != 0)
    694       1.1        ad 		return (-1);
    695       1.1        ad 	else if (sc->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
    696       1.1        ad 		size = -1;
    697       1.1        ad 	else
    698       1.1        ad 		size = sc->sc_dk.dk_label->d_partitions[part].p_size *
    699       1.1        ad 		    (sc->sc_dk.dk_label->d_secsize / DEV_BSIZE);
    700       1.1        ad 	if (omask == 0 && ldclose(dev, 0, S_IFBLK, NULL) != 0)
    701       1.1        ad 		return (-1);
    702       1.1        ad 
    703       1.1        ad 	return (size);
    704       1.1        ad }
    705       1.1        ad 
    706       1.1        ad /*
    707       1.1        ad  * Load the label information from the specified device.
    708       1.1        ad  */
    709       1.1        ad static void
    710       1.1        ad ldgetdisklabel(struct ld_softc *sc)
    711       1.1        ad {
    712       1.1        ad 	const char *errstring;
    713       1.1        ad 
    714       1.1        ad 	ldgetdefaultlabel(sc, sc->sc_dk.dk_label);
    715       1.1        ad 
    716       1.1        ad 	/* Call the generic disklabel extraction routine. */
    717       1.1        ad 	errstring = readdisklabel(MAKEDISKDEV(0, sc->sc_dv.dv_unit, RAW_PART),
    718       1.1        ad 	    ldstrategy, sc->sc_dk.dk_label, sc->sc_dk.dk_cpulabel);
    719       1.1        ad 	if (errstring != NULL)
    720       1.1        ad 		printf("%s: %s\n", sc->sc_dv.dv_xname, errstring);
    721      1.22   thorpej 
    722      1.22   thorpej 	/* In-core label now valid. */
    723      1.22   thorpej 	sc->sc_flags |= LDF_VLABEL;
    724       1.1        ad }
    725       1.1        ad 
    726       1.1        ad /*
    727       1.1        ad  * Construct a ficticious label.
    728       1.1        ad  */
    729       1.1        ad static void
    730       1.1        ad ldgetdefaultlabel(struct ld_softc *sc, struct disklabel *lp)
    731       1.1        ad {
    732       1.1        ad 
    733       1.1        ad 	memset(lp, 0, sizeof(struct disklabel));
    734       1.1        ad 
    735       1.1        ad 	lp->d_secsize = sc->sc_secsize;
    736       1.1        ad 	lp->d_ntracks = sc->sc_nheads;
    737       1.1        ad 	lp->d_nsectors = sc->sc_nsectors;
    738       1.1        ad 	lp->d_ncylinders = sc->sc_ncylinders;
    739       1.1        ad 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    740       1.1        ad 	lp->d_type = DTYPE_LD;
    741      1.21    itojun 	strlcpy(lp->d_typename, "unknown", sizeof(lp->d_typename));
    742      1.21    itojun 	strlcpy(lp->d_packname, "fictitious", sizeof(lp->d_packname));
    743       1.1        ad 	lp->d_secperunit = sc->sc_secperunit;
    744       1.1        ad 	lp->d_rpm = 7200;
    745       1.1        ad 	lp->d_interleave = 1;
    746       1.1        ad 	lp->d_flags = 0;
    747       1.1        ad 
    748       1.1        ad 	lp->d_partitions[RAW_PART].p_offset = 0;
    749       1.1        ad 	lp->d_partitions[RAW_PART].p_size =
    750       1.1        ad 	    lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
    751       1.1        ad 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    752       1.1        ad 	lp->d_npartitions = RAW_PART + 1;
    753       1.1        ad 
    754       1.1        ad 	lp->d_magic = DISKMAGIC;
    755       1.1        ad 	lp->d_magic2 = DISKMAGIC;
    756       1.1        ad 	lp->d_checksum = dkcksum(lp);
    757       1.1        ad }
    758       1.1        ad 
    759       1.1        ad /*
    760       1.1        ad  * Take a dump.
    761       1.1        ad  */
    762      1.29   thorpej static int
    763       1.1        ad lddump(dev_t dev, daddr_t blkno, caddr_t va, size_t size)
    764       1.1        ad {
    765       1.1        ad 	struct ld_softc *sc;
    766       1.1        ad 	struct disklabel *lp;
    767       1.1        ad 	int unit, part, nsects, sectoff, towrt, nblk, maxblkcnt, rv;
    768       1.1        ad 	static int dumping;
    769       1.1        ad 
    770       1.1        ad 	unit = DISKUNIT(dev);
    771       1.1        ad 	if ((sc = device_lookup(&ld_cd, unit)) == NULL)
    772       1.1        ad 		return (ENXIO);
    773       1.1        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    774       1.1        ad 		return (ENODEV);
    775       1.3        ad 	if (sc->sc_dump == NULL)
    776       1.3        ad 		return (ENXIO);
    777       1.3        ad 
    778       1.3        ad 	/* Check if recursive dump; if so, punt. */
    779       1.3        ad 	if (dumping)
    780       1.3        ad 		return (EFAULT);
    781       1.3        ad 	dumping = 1;
    782       1.1        ad 
    783       1.1        ad 	/* Convert to disk sectors.  Request must be a multiple of size. */
    784       1.3        ad 	part = DISKPART(dev);
    785       1.1        ad 	lp = sc->sc_dk.dk_label;
    786       1.1        ad 	if ((size % lp->d_secsize) != 0)
    787       1.1        ad 		return (EFAULT);
    788       1.1        ad 	towrt = size / lp->d_secsize;
    789       1.1        ad 	blkno = dbtob(blkno) / lp->d_secsize;	/* blkno in DEV_BSIZE units */
    790       1.1        ad 
    791       1.1        ad 	nsects = lp->d_partitions[part].p_size;
    792       1.1        ad 	sectoff = lp->d_partitions[part].p_offset;
    793       1.1        ad 
    794       1.1        ad 	/* Check transfer bounds against partition size. */
    795       1.1        ad 	if ((blkno < 0) || ((blkno + towrt) > nsects))
    796       1.1        ad 		return (EINVAL);
    797       1.1        ad 
    798       1.1        ad 	/* Offset block number to start of partition. */
    799       1.1        ad 	blkno += sectoff;
    800       1.1        ad 
    801       1.1        ad 	/* Start dumping and return when done. */
    802       1.3        ad 	maxblkcnt = sc->sc_maxxfer / sc->sc_secsize - 1;
    803       1.1        ad 	while (towrt > 0) {
    804       1.3        ad 		nblk = min(maxblkcnt, towrt);
    805       1.1        ad 
    806       1.1        ad 		if ((rv = (*sc->sc_dump)(sc, va, blkno, nblk)) != 0)
    807       1.1        ad 			return (rv);
    808       1.1        ad 
    809       1.1        ad 		towrt -= nblk;
    810       1.1        ad 		blkno += nblk;
    811       1.1        ad 		va += nblk * sc->sc_secsize;
    812       1.1        ad 	}
    813       1.1        ad 
    814       1.1        ad 	dumping = 0;
    815       1.1        ad 	return (0);
    816       1.1        ad }
    817       1.1        ad 
    818       1.1        ad /*
    819       1.1        ad  * Adjust the size of a transfer.
    820       1.1        ad  */
    821       1.1        ad static void
    822       1.1        ad ldminphys(struct buf *bp)
    823       1.1        ad {
    824       1.1        ad 	struct ld_softc *sc;
    825       1.1        ad 
    826       1.1        ad 	sc = device_lookup(&ld_cd, DISKUNIT(bp->b_dev));
    827       1.1        ad 
    828       1.1        ad 	if (bp->b_bcount > sc->sc_maxxfer)
    829       1.1        ad 		bp->b_bcount = sc->sc_maxxfer;
    830       1.1        ad 	minphys(bp);
    831       1.1        ad }
    832