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