Home | History | Annotate | Line # | Download | only in dev
ld.c revision 1.39.12.1
      1  1.39.12.1      tron /*	$NetBSD: ld.c,v 1.39.12.1 2006/03/31 09:45:17 tron 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.39.12.1      tron __KERNEL_RCSID(0, "$NetBSD: ld.c,v 1.39.12.1 2006/03/31 09:45:17 tron 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.37  christos 	char tbuf[9];
    105        1.1        ad 
    106        1.7        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0) {
    107       1.34    briggs 		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.35     perry 		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.37  christos 	format_bytes(tbuf, sizeof(tbuf), sc->sc_secperunit *
    144        1.1        ad 	    sc->sc_secsize);
    145       1.34    briggs 	aprint_normal("%s: %s, %d cyl, %d head, %d sec, %d bytes/sect x %"PRIu64" sectors\n",
    146       1.37  christos 	    sc->sc_dv.dv_xname, tbuf, 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.38      yamt 	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.37  christos ldadjqparam(struct ld_softc *sc, int xmax)
    166        1.3        ad {
    167       1.24   thorpej 	int s;
    168        1.7        ad 
    169        1.7        ad 	s = splbio();
    170       1.37  christos 	sc->sc_maxqueuecnt = xmax;
    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.13  drochner 	int s, bmaj, cmaj, i, mn;
    205        1.2        ad 
    206        1.7        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    207        1.7        ad 		return;
    208        1.7        ad 
    209        1.2        ad 	/* Wait for commands queued with the hardware to complete. */
    210        1.2        ad 	if (sc->sc_queuecnt != 0)
    211        1.7        ad 		if (tsleep(&sc->sc_queuecnt, PRIBIO, "lddtch", 30 * hz))
    212        1.7        ad 			printf("%s: not drained\n", sc->sc_dv.dv_xname);
    213        1.2        ad 
    214        1.2        ad 	/* Locate the major numbers. */
    215       1.16   gehenna 	bmaj = bdevsw_lookup_major(&ld_bdevsw);
    216       1.16   gehenna 	cmaj = cdevsw_lookup_major(&ld_cdevsw);
    217        1.2        ad 
    218        1.2        ad 	/* Kill off any queued buffers. */
    219        1.2        ad 	s = splbio();
    220       1.38      yamt 	bufq_drain(sc->sc_bufq);
    221       1.36      yamt 	splx(s);
    222       1.36      yamt 
    223       1.38      yamt 	bufq_free(sc->sc_bufq);
    224        1.2        ad 
    225        1.2        ad 	/* Nuke the vnodes for any open instances. */
    226       1.13  drochner 	for (i = 0; i < MAXPARTITIONS; i++) {
    227  1.39.12.1      tron 		mn = DISKMINOR(device_unit(&sc->sc_dv), i);
    228       1.13  drochner 		vdevgone(bmaj, mn, mn, VBLK);
    229       1.13  drochner 		vdevgone(cmaj, mn, mn, VCHR);
    230       1.13  drochner 	}
    231       1.13  drochner 
    232       1.30   thorpej 	/* Delete all of our wedges. */
    233       1.30   thorpej 	dkwedge_delall(&sc->sc_dk);
    234       1.30   thorpej 
    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.39  christos ldopen(dev_t dev, int flags, int fmt, struct lwp *l)
    276        1.1        ad {
    277        1.1        ad 	struct ld_softc *sc;
    278       1.30   thorpej 	int error, unit, part;
    279        1.1        ad 
    280        1.1        ad 	unit = DISKUNIT(dev);
    281       1.30   thorpej 	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.30   thorpej 
    287       1.30   thorpej 	if ((error = lockmgr(&sc->sc_dk.dk_openlock, LK_EXCLUSIVE, NULL)) != 0)
    288       1.30   thorpej 		return (error);
    289        1.1        ad 
    290       1.22   thorpej 	if (sc->sc_dk.dk_openmask == 0) {
    291       1.22   thorpej 		/* Load the partition info if not already loaded. */
    292       1.22   thorpej 		if ((sc->sc_flags & LDF_VLABEL) == 0)
    293       1.22   thorpej 			ldgetdisklabel(sc);
    294       1.22   thorpej 	}
    295        1.1        ad 
    296        1.1        ad 	/* Check that the partition exists. */
    297        1.1        ad 	if (part != RAW_PART && (part >= sc->sc_dk.dk_label->d_npartitions ||
    298        1.1        ad 	    sc->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
    299       1.30   thorpej 		error = ENXIO;
    300       1.30   thorpej 		goto bad1;
    301        1.1        ad 	}
    302        1.1        ad 
    303        1.1        ad 	/* Ensure only one open at a time. */
    304        1.1        ad 	switch (fmt) {
    305        1.1        ad 	case S_IFCHR:
    306        1.1        ad 		sc->sc_dk.dk_copenmask |= (1 << part);
    307        1.1        ad 		break;
    308        1.1        ad 	case S_IFBLK:
    309        1.1        ad 		sc->sc_dk.dk_bopenmask |= (1 << part);
    310        1.1        ad 		break;
    311        1.1        ad 	}
    312        1.1        ad 	sc->sc_dk.dk_openmask =
    313        1.1        ad 	    sc->sc_dk.dk_copenmask | sc->sc_dk.dk_bopenmask;
    314        1.1        ad 
    315       1.30   thorpej 	(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    316        1.1        ad 	return (0);
    317       1.30   thorpej 
    318       1.30   thorpej  bad1:
    319       1.30   thorpej 	(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    320       1.30   thorpej 	return (error);
    321        1.1        ad }
    322        1.1        ad 
    323        1.8     lukem /* ARGSUSED */
    324       1.29   thorpej static int
    325       1.39  christos ldclose(dev_t dev, int flags, int fmt, struct lwp *l)
    326        1.1        ad {
    327        1.1        ad 	struct ld_softc *sc;
    328       1.30   thorpej 	int error, part, unit;
    329        1.1        ad 
    330        1.1        ad 	unit = DISKUNIT(dev);
    331        1.1        ad 	part = DISKPART(dev);
    332        1.1        ad 	sc = device_lookup(&ld_cd, unit);
    333       1.30   thorpej 
    334       1.30   thorpej 	if ((error = lockmgr(&sc->sc_dk.dk_openlock, LK_EXCLUSIVE, NULL)) != 0)
    335       1.30   thorpej 		return (error);
    336        1.1        ad 
    337        1.1        ad 	switch (fmt) {
    338        1.1        ad 	case S_IFCHR:
    339        1.1        ad 		sc->sc_dk.dk_copenmask &= ~(1 << part);
    340        1.1        ad 		break;
    341        1.1        ad 	case S_IFBLK:
    342        1.1        ad 		sc->sc_dk.dk_bopenmask &= ~(1 << part);
    343        1.1        ad 		break;
    344        1.1        ad 	}
    345        1.1        ad 	sc->sc_dk.dk_openmask =
    346        1.1        ad 	    sc->sc_dk.dk_copenmask | sc->sc_dk.dk_bopenmask;
    347        1.1        ad 
    348       1.22   thorpej 	if (sc->sc_dk.dk_openmask == 0) {
    349       1.22   thorpej 		if (sc->sc_flush != NULL && (*sc->sc_flush)(sc) != 0)
    350        1.1        ad 			printf("%s: unable to flush cache\n",
    351        1.1        ad 			    sc->sc_dv.dv_xname);
    352       1.22   thorpej 		if ((sc->sc_flags & LDF_KLABEL) == 0)
    353       1.22   thorpej 			sc->sc_flags &= ~LDF_VLABEL;
    354       1.22   thorpej 	}
    355        1.1        ad 
    356       1.30   thorpej 	(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    357        1.1        ad 	return (0);
    358        1.1        ad }
    359        1.1        ad 
    360        1.8     lukem /* ARGSUSED */
    361       1.29   thorpej static int
    362        1.1        ad ldread(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_READ, ldminphys, uio));
    366        1.1        ad }
    367        1.1        ad 
    368        1.8     lukem /* ARGSUSED */
    369       1.29   thorpej static int
    370        1.1        ad ldwrite(dev_t dev, struct uio *uio, int ioflag)
    371        1.1        ad {
    372        1.1        ad 
    373        1.1        ad 	return (physio(ldstrategy, NULL, dev, B_WRITE, ldminphys, uio));
    374        1.1        ad }
    375        1.1        ad 
    376        1.8     lukem /* ARGSUSED */
    377       1.29   thorpej static int
    378       1.39  christos ldioctl(dev_t dev, u_long cmd, caddr_t addr, int32_t flag, struct lwp *l)
    379        1.1        ad {
    380        1.1        ad 	struct ld_softc *sc;
    381        1.1        ad 	int part, unit, error;
    382        1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    383        1.6    itojun 	struct disklabel newlabel;
    384        1.4      fvdl #endif
    385        1.6    itojun 	struct disklabel *lp;
    386        1.1        ad 
    387        1.1        ad 	unit = DISKUNIT(dev);
    388        1.1        ad 	part = DISKPART(dev);
    389        1.1        ad 	sc = device_lookup(&ld_cd, unit);
    390        1.1        ad 	error = 0;
    391        1.1        ad 
    392        1.1        ad 	switch (cmd) {
    393        1.1        ad 	case DIOCGDINFO:
    394        1.1        ad 		memcpy(addr, sc->sc_dk.dk_label, sizeof(struct disklabel));
    395        1.1        ad 		return (0);
    396        1.1        ad 
    397        1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    398        1.4      fvdl 	case ODIOCGDINFO:
    399        1.4      fvdl 		newlabel = *(sc->sc_dk.dk_label);
    400        1.4      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
    401        1.5      fvdl 			return ENOTTY;
    402        1.4      fvdl 		memcpy(addr, &newlabel, sizeof(struct olddisklabel));
    403        1.4      fvdl 		return (0);
    404        1.4      fvdl #endif
    405        1.4      fvdl 
    406        1.1        ad 	case DIOCGPART:
    407        1.1        ad 		((struct partinfo *)addr)->disklab = sc->sc_dk.dk_label;
    408        1.1        ad 		((struct partinfo *)addr)->part =
    409        1.1        ad 		    &sc->sc_dk.dk_label->d_partitions[part];
    410        1.1        ad 		break;
    411        1.1        ad 
    412        1.1        ad 	case DIOCWDINFO:
    413        1.1        ad 	case DIOCSDINFO:
    414        1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    415        1.4      fvdl 	case ODIOCWDINFO:
    416        1.4      fvdl 	case ODIOCSDINFO:
    417        1.4      fvdl 
    418        1.4      fvdl 		if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
    419        1.4      fvdl 			memset(&newlabel, 0, sizeof newlabel);
    420        1.4      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
    421        1.4      fvdl 			lp = &newlabel;
    422        1.4      fvdl 		} else
    423        1.4      fvdl #endif
    424        1.4      fvdl 		lp = (struct disklabel *)addr;
    425        1.4      fvdl 
    426        1.1        ad 		if ((flag & FWRITE) == 0)
    427        1.1        ad 			return (EBADF);
    428        1.1        ad 
    429       1.30   thorpej 		if ((error = lockmgr(&sc->sc_dk.dk_openlock, LK_EXCLUSIVE,
    430       1.31  jdolecek 				     NULL)) != 0)
    431        1.1        ad 			return (error);
    432        1.1        ad 		sc->sc_flags |= LDF_LABELLING;
    433        1.1        ad 
    434        1.1        ad 		error = setdisklabel(sc->sc_dk.dk_label,
    435        1.4      fvdl 		    lp, /*sc->sc_dk.dk_openmask : */0,
    436        1.1        ad 		    sc->sc_dk.dk_cpulabel);
    437        1.4      fvdl 		if (error == 0 && (cmd == DIOCWDINFO
    438        1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    439        1.4      fvdl 		    || cmd == ODIOCWDINFO
    440        1.4      fvdl #endif
    441        1.4      fvdl 		    ))
    442        1.1        ad 			error = writedisklabel(
    443       1.35     perry 			    MAKEDISKDEV(major(dev), DISKUNIT(dev), RAW_PART),
    444       1.35     perry 			    ldstrategy, sc->sc_dk.dk_label,
    445        1.1        ad 			    sc->sc_dk.dk_cpulabel);
    446        1.1        ad 
    447        1.1        ad 		sc->sc_flags &= ~LDF_LABELLING;
    448       1.30   thorpej 		(void) lockmgr(&sc->sc_dk.dk_openlock, LK_RELEASE, NULL);
    449        1.1        ad 		break;
    450        1.1        ad 
    451       1.22   thorpej 	case DIOCKLABEL:
    452       1.22   thorpej 		if ((flag & FWRITE) == 0)
    453       1.22   thorpej 			return (EBADF);
    454       1.22   thorpej 		if (*(int *)addr)
    455       1.22   thorpej 			sc->sc_flags |= LDF_KLABEL;
    456       1.22   thorpej 		else
    457       1.22   thorpej 			sc->sc_flags &= ~LDF_KLABEL;
    458       1.22   thorpej 		break;
    459       1.22   thorpej 
    460        1.1        ad 	case DIOCWLABEL:
    461        1.1        ad 		if ((flag & FWRITE) == 0)
    462        1.1        ad 			return (EBADF);
    463        1.1        ad 		if (*(int *)addr)
    464        1.1        ad 			sc->sc_flags |= LDF_WLABEL;
    465        1.1        ad 		else
    466        1.1        ad 			sc->sc_flags &= ~LDF_WLABEL;
    467        1.1        ad 		break;
    468        1.1        ad 
    469        1.1        ad 	case DIOCGDEFLABEL:
    470        1.1        ad 		ldgetdefaultlabel(sc, (struct disklabel *)addr);
    471        1.1        ad 		break;
    472        1.4      fvdl 
    473        1.4      fvdl #ifdef __HAVE_OLD_DISKLABEL
    474        1.4      fvdl 	case ODIOCGDEFLABEL:
    475        1.4      fvdl 		ldgetdefaultlabel(sc, &newlabel);
    476        1.4      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
    477        1.5      fvdl 			return ENOTTY;
    478        1.4      fvdl 		memcpy(addr, &newlabel, sizeof (struct olddisklabel));
    479        1.4      fvdl 		break;
    480        1.4      fvdl #endif
    481        1.1        ad 
    482       1.32   thorpej 	case DIOCCACHESYNC:
    483       1.32   thorpej 		/*
    484       1.32   thorpej 		 * XXX Do we really need to care about having a writable
    485       1.32   thorpej 		 * file descriptor here?
    486       1.32   thorpej 		 */
    487       1.32   thorpej 		if ((flag & FWRITE) == 0)
    488       1.32   thorpej 			error = EBADF;
    489       1.32   thorpej 		else if (sc->sc_flush)
    490       1.32   thorpej 			error = (*sc->sc_flush)(sc);
    491       1.32   thorpej 		else
    492       1.32   thorpej 			error = 0;	/* XXX Error out instead? */
    493       1.32   thorpej 		break;
    494       1.32   thorpej 
    495       1.30   thorpej 	case DIOCAWEDGE:
    496       1.30   thorpej 	    {
    497       1.30   thorpej 	    	struct dkwedge_info *dkw = (void *) addr;
    498       1.30   thorpej 
    499       1.30   thorpej 		if ((flag & FWRITE) == 0)
    500       1.30   thorpej 			return (EBADF);
    501       1.30   thorpej 
    502       1.30   thorpej 		/* If the ioctl happens here, the parent is us. */
    503       1.30   thorpej 		strcpy(dkw->dkw_parent, sc->sc_dv.dv_xname);
    504       1.30   thorpej 		return (dkwedge_add(dkw));
    505       1.30   thorpej 	    }
    506       1.35     perry 
    507       1.30   thorpej 	case DIOCDWEDGE:
    508       1.30   thorpej 	    {
    509       1.30   thorpej 	    	struct dkwedge_info *dkw = (void *) addr;
    510       1.30   thorpej 
    511       1.30   thorpej 		if ((flag & FWRITE) == 0)
    512       1.30   thorpej 			return (EBADF);
    513       1.30   thorpej 
    514       1.30   thorpej 		/* If the ioctl happens here, the parent is us. */
    515       1.30   thorpej 		strcpy(dkw->dkw_parent, sc->sc_dv.dv_xname);
    516       1.30   thorpej 		return (dkwedge_del(dkw));
    517       1.30   thorpej 	    }
    518       1.35     perry 
    519       1.30   thorpej 	case DIOCLWEDGES:
    520       1.30   thorpej 	    {
    521       1.30   thorpej 	    	struct dkwedge_list *dkwl = (void *) addr;
    522       1.30   thorpej 
    523       1.39  christos 		return (dkwedge_list(&sc->sc_dk, dkwl, l));
    524       1.30   thorpej 	    }
    525       1.30   thorpej 
    526        1.1        ad 	default:
    527        1.1        ad 		error = ENOTTY;
    528        1.1        ad 		break;
    529        1.1        ad 	}
    530        1.1        ad 
    531        1.1        ad 	return (error);
    532        1.1        ad }
    533        1.1        ad 
    534       1.29   thorpej static void
    535        1.1        ad ldstrategy(struct buf *bp)
    536        1.1        ad {
    537        1.1        ad 	struct ld_softc *sc;
    538       1.23   thorpej 	struct disklabel *lp;
    539       1.23   thorpej 	daddr_t blkno;
    540       1.23   thorpej 	int s, part;
    541        1.1        ad 
    542        1.1        ad 	sc = device_lookup(&ld_cd, DISKUNIT(bp->b_dev));
    543       1.23   thorpej 	part = DISKPART(bp->b_dev);
    544        1.1        ad 
    545        1.7        ad 	if ((sc->sc_flags & LDF_DETACH) != 0) {
    546        1.2        ad 		bp->b_error = EIO;
    547       1.23   thorpej 		goto bad;
    548        1.2        ad 	}
    549        1.2        ad 
    550        1.1        ad 	lp = sc->sc_dk.dk_label;
    551        1.1        ad 
    552        1.1        ad 	/*
    553        1.1        ad 	 * The transfer must be a whole number of blocks and the offset must
    554        1.1        ad 	 * not be negative.
    555        1.1        ad 	 */
    556        1.1        ad 	if ((bp->b_bcount % lp->d_secsize) != 0 || bp->b_blkno < 0) {
    557       1.23   thorpej 		bp->b_error = EINVAL;
    558       1.23   thorpej 		goto bad;
    559        1.1        ad 	}
    560        1.1        ad 
    561       1.23   thorpej 	/* If it's a null transfer, return immediately. */
    562       1.23   thorpej 	if (bp->b_bcount == 0)
    563       1.23   thorpej 		goto done;
    564        1.1        ad 
    565        1.1        ad 	/*
    566        1.1        ad 	 * Do bounds checking and adjust the transfer.  If error, process.
    567        1.1        ad 	 * If past the end of partition, just return.
    568        1.1        ad 	 */
    569        1.1        ad 	if (part != RAW_PART &&
    570       1.20   thorpej 	    bounds_check_with_label(&sc->sc_dk, bp,
    571        1.1        ad 	    (sc->sc_flags & (LDF_WLABEL | LDF_LABELLING)) != 0) <= 0) {
    572       1.23   thorpej 		goto done;
    573        1.1        ad 	}
    574        1.1        ad 
    575        1.1        ad 	/*
    576       1.23   thorpej 	 * Convert the block number to absolute and put it in terms
    577       1.23   thorpej 	 * of the device's logical block size.
    578        1.1        ad 	 */
    579       1.23   thorpej 	if (lp->d_secsize == DEV_BSIZE)
    580       1.23   thorpej 		blkno = bp->b_blkno;
    581       1.23   thorpej 	else if (lp->d_secsize > DEV_BSIZE)
    582       1.23   thorpej 		blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
    583        1.1        ad 	else
    584       1.23   thorpej 		blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
    585        1.1        ad 
    586       1.11   thorpej 	if (part != RAW_PART)
    587       1.23   thorpej 		blkno += lp->d_partitions[part].p_offset;
    588       1.23   thorpej 
    589       1.23   thorpej 	bp->b_rawblkno = blkno;
    590        1.1        ad 
    591        1.1        ad 	s = splbio();
    592       1.38      yamt 	BUFQ_PUT(sc->sc_bufq, bp);
    593       1.23   thorpej 	ldstart(sc);
    594        1.1        ad 	splx(s);
    595       1.23   thorpej 	return;
    596       1.23   thorpej 
    597       1.23   thorpej  bad:
    598       1.23   thorpej 	bp->b_flags |= B_ERROR;
    599       1.23   thorpej  done:
    600       1.23   thorpej 	bp->b_resid = bp->b_bcount;
    601       1.23   thorpej 	biodone(bp);
    602       1.23   thorpej }
    603       1.23   thorpej 
    604       1.23   thorpej static void
    605       1.23   thorpej ldstart(struct ld_softc *sc)
    606       1.23   thorpej {
    607       1.23   thorpej 	struct buf *bp;
    608       1.23   thorpej 	int error;
    609        1.1        ad 
    610       1.23   thorpej 	while (sc->sc_queuecnt < sc->sc_maxqueuecnt) {
    611       1.23   thorpej 		/* See if there is work to do. */
    612       1.38      yamt 		if ((bp = BUFQ_PEEK(sc->sc_bufq)) == NULL)
    613       1.23   thorpej 			break;
    614       1.23   thorpej 
    615       1.23   thorpej 		disk_busy(&sc->sc_dk);
    616       1.23   thorpej 		sc->sc_queuecnt++;
    617       1.23   thorpej 
    618       1.23   thorpej 		if (__predict_true((error = (*sc->sc_start)(sc, bp)) == 0)) {
    619       1.23   thorpej 			/*
    620       1.23   thorpej 			 * The back-end is running the job; remove it from
    621       1.23   thorpej 			 * the queue.
    622       1.23   thorpej 			 */
    623       1.38      yamt 			(void) BUFQ_GET(sc->sc_bufq);
    624       1.23   thorpej 		} else  {
    625       1.23   thorpej 			disk_unbusy(&sc->sc_dk, 0, (bp->b_flags & B_READ));
    626       1.23   thorpej 			sc->sc_queuecnt--;
    627       1.23   thorpej 			if (error == EAGAIN) {
    628       1.23   thorpej 				/*
    629       1.23   thorpej 				 * Temporary resource shortage in the
    630       1.23   thorpej 				 * back-end; just defer the job until
    631       1.23   thorpej 				 * later.
    632       1.23   thorpej 				 *
    633       1.23   thorpej 				 * XXX We might consider a watchdog timer
    634       1.23   thorpej 				 * XXX to make sure we are kicked into action.
    635       1.23   thorpej 				 */
    636       1.23   thorpej 				break;
    637       1.23   thorpej 			} else {
    638       1.38      yamt 				(void) BUFQ_GET(sc->sc_bufq);
    639       1.23   thorpej 				bp->b_error = error;
    640       1.23   thorpej 				bp->b_flags |= B_ERROR;
    641       1.23   thorpej 				bp->b_resid = bp->b_bcount;
    642       1.23   thorpej 				biodone(bp);
    643       1.23   thorpej 			}
    644       1.23   thorpej 		}
    645        1.1        ad 	}
    646        1.1        ad }
    647        1.1        ad 
    648        1.1        ad void
    649        1.1        ad lddone(struct ld_softc *sc, struct buf *bp)
    650        1.1        ad {
    651        1.1        ad 
    652        1.1        ad 	if ((bp->b_flags & B_ERROR) != 0) {
    653        1.1        ad 		diskerr(bp, "ld", "error", LOG_PRINTF, 0, sc->sc_dk.dk_label);
    654        1.1        ad 		printf("\n");
    655        1.1        ad 	}
    656        1.1        ad 
    657       1.18       mrg 	disk_unbusy(&sc->sc_dk, bp->b_bcount - bp->b_resid,
    658       1.18       mrg 	    (bp->b_flags & B_READ));
    659        1.1        ad #if NRND > 0
    660        1.1        ad 	rnd_add_uint32(&sc->sc_rnd_source, bp->b_rawblkno);
    661        1.1        ad #endif
    662        1.1        ad 	biodone(bp);
    663        1.1        ad 
    664        1.7        ad 	if (--sc->sc_queuecnt <= sc->sc_maxqueuecnt) {
    665       1.24   thorpej 		if ((sc->sc_flags & LDF_DRAIN) != 0) {
    666       1.24   thorpej 			sc->sc_flags &= ~LDF_DRAIN;
    667        1.7        ad 			wakeup(&sc->sc_queuecnt);
    668       1.24   thorpej 		}
    669       1.23   thorpej 		ldstart(sc);
    670        1.1        ad 	}
    671        1.1        ad }
    672        1.1        ad 
    673       1.29   thorpej static int
    674        1.1        ad ldsize(dev_t dev)
    675        1.1        ad {
    676        1.1        ad 	struct ld_softc *sc;
    677        1.1        ad 	int part, unit, omask, size;
    678        1.1        ad 
    679        1.1        ad 	unit = DISKUNIT(dev);
    680        1.1        ad 	if ((sc = device_lookup(&ld_cd, unit)) == NULL)
    681        1.1        ad 		return (ENODEV);
    682        1.1        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    683        1.1        ad 		return (ENODEV);
    684        1.1        ad 	part = DISKPART(dev);
    685        1.1        ad 
    686        1.1        ad 	omask = sc->sc_dk.dk_openmask & (1 << part);
    687        1.1        ad 
    688        1.1        ad 	if (omask == 0 && ldopen(dev, 0, S_IFBLK, NULL) != 0)
    689        1.1        ad 		return (-1);
    690        1.1        ad 	else if (sc->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
    691        1.1        ad 		size = -1;
    692        1.1        ad 	else
    693        1.1        ad 		size = sc->sc_dk.dk_label->d_partitions[part].p_size *
    694        1.1        ad 		    (sc->sc_dk.dk_label->d_secsize / DEV_BSIZE);
    695        1.1        ad 	if (omask == 0 && ldclose(dev, 0, S_IFBLK, NULL) != 0)
    696        1.1        ad 		return (-1);
    697        1.1        ad 
    698        1.1        ad 	return (size);
    699        1.1        ad }
    700        1.1        ad 
    701        1.1        ad /*
    702        1.1        ad  * Load the label information from the specified device.
    703        1.1        ad  */
    704        1.1        ad static void
    705        1.1        ad ldgetdisklabel(struct ld_softc *sc)
    706        1.1        ad {
    707        1.1        ad 	const char *errstring;
    708        1.1        ad 
    709        1.1        ad 	ldgetdefaultlabel(sc, sc->sc_dk.dk_label);
    710        1.1        ad 
    711        1.1        ad 	/* Call the generic disklabel extraction routine. */
    712  1.39.12.1      tron 	errstring = readdisklabel(MAKEDISKDEV(0, device_unit(&sc->sc_dv),
    713  1.39.12.1      tron 	    RAW_PART), ldstrategy, sc->sc_dk.dk_label, sc->sc_dk.dk_cpulabel);
    714        1.1        ad 	if (errstring != NULL)
    715        1.1        ad 		printf("%s: %s\n", sc->sc_dv.dv_xname, errstring);
    716       1.22   thorpej 
    717       1.22   thorpej 	/* In-core label now valid. */
    718       1.22   thorpej 	sc->sc_flags |= LDF_VLABEL;
    719        1.1        ad }
    720        1.1        ad 
    721        1.1        ad /*
    722        1.1        ad  * Construct a ficticious label.
    723        1.1        ad  */
    724        1.1        ad static void
    725        1.1        ad ldgetdefaultlabel(struct ld_softc *sc, struct disklabel *lp)
    726        1.1        ad {
    727        1.1        ad 
    728        1.1        ad 	memset(lp, 0, sizeof(struct disklabel));
    729        1.1        ad 
    730        1.1        ad 	lp->d_secsize = sc->sc_secsize;
    731        1.1        ad 	lp->d_ntracks = sc->sc_nheads;
    732        1.1        ad 	lp->d_nsectors = sc->sc_nsectors;
    733        1.1        ad 	lp->d_ncylinders = sc->sc_ncylinders;
    734        1.1        ad 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    735        1.1        ad 	lp->d_type = DTYPE_LD;
    736       1.21    itojun 	strlcpy(lp->d_typename, "unknown", sizeof(lp->d_typename));
    737       1.21    itojun 	strlcpy(lp->d_packname, "fictitious", sizeof(lp->d_packname));
    738        1.1        ad 	lp->d_secperunit = sc->sc_secperunit;
    739        1.1        ad 	lp->d_rpm = 7200;
    740        1.1        ad 	lp->d_interleave = 1;
    741        1.1        ad 	lp->d_flags = 0;
    742        1.1        ad 
    743        1.1        ad 	lp->d_partitions[RAW_PART].p_offset = 0;
    744        1.1        ad 	lp->d_partitions[RAW_PART].p_size =
    745        1.1        ad 	    lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
    746        1.1        ad 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    747        1.1        ad 	lp->d_npartitions = RAW_PART + 1;
    748        1.1        ad 
    749        1.1        ad 	lp->d_magic = DISKMAGIC;
    750        1.1        ad 	lp->d_magic2 = DISKMAGIC;
    751        1.1        ad 	lp->d_checksum = dkcksum(lp);
    752        1.1        ad }
    753        1.1        ad 
    754        1.1        ad /*
    755        1.1        ad  * Take a dump.
    756        1.1        ad  */
    757       1.29   thorpej static int
    758        1.1        ad lddump(dev_t dev, daddr_t blkno, caddr_t va, size_t size)
    759        1.1        ad {
    760        1.1        ad 	struct ld_softc *sc;
    761        1.1        ad 	struct disklabel *lp;
    762        1.1        ad 	int unit, part, nsects, sectoff, towrt, nblk, maxblkcnt, rv;
    763        1.1        ad 	static int dumping;
    764        1.1        ad 
    765        1.1        ad 	unit = DISKUNIT(dev);
    766        1.1        ad 	if ((sc = device_lookup(&ld_cd, unit)) == NULL)
    767        1.1        ad 		return (ENXIO);
    768        1.1        ad 	if ((sc->sc_flags & LDF_ENABLED) == 0)
    769        1.1        ad 		return (ENODEV);
    770        1.3        ad 	if (sc->sc_dump == NULL)
    771        1.3        ad 		return (ENXIO);
    772        1.3        ad 
    773        1.3        ad 	/* Check if recursive dump; if so, punt. */
    774        1.3        ad 	if (dumping)
    775        1.3        ad 		return (EFAULT);
    776        1.3        ad 	dumping = 1;
    777        1.1        ad 
    778        1.1        ad 	/* Convert to disk sectors.  Request must be a multiple of size. */
    779        1.3        ad 	part = DISKPART(dev);
    780        1.1        ad 	lp = sc->sc_dk.dk_label;
    781        1.1        ad 	if ((size % lp->d_secsize) != 0)
    782        1.1        ad 		return (EFAULT);
    783        1.1        ad 	towrt = size / lp->d_secsize;
    784        1.1        ad 	blkno = dbtob(blkno) / lp->d_secsize;	/* blkno in DEV_BSIZE units */
    785        1.1        ad 
    786        1.1        ad 	nsects = lp->d_partitions[part].p_size;
    787        1.1        ad 	sectoff = lp->d_partitions[part].p_offset;
    788        1.1        ad 
    789        1.1        ad 	/* Check transfer bounds against partition size. */
    790        1.1        ad 	if ((blkno < 0) || ((blkno + towrt) > nsects))
    791        1.1        ad 		return (EINVAL);
    792        1.1        ad 
    793        1.1        ad 	/* Offset block number to start of partition. */
    794        1.1        ad 	blkno += sectoff;
    795        1.1        ad 
    796        1.1        ad 	/* Start dumping and return when done. */
    797        1.3        ad 	maxblkcnt = sc->sc_maxxfer / sc->sc_secsize - 1;
    798        1.1        ad 	while (towrt > 0) {
    799        1.3        ad 		nblk = min(maxblkcnt, towrt);
    800        1.1        ad 
    801        1.1        ad 		if ((rv = (*sc->sc_dump)(sc, va, blkno, nblk)) != 0)
    802        1.1        ad 			return (rv);
    803        1.1        ad 
    804        1.1        ad 		towrt -= nblk;
    805        1.1        ad 		blkno += nblk;
    806        1.1        ad 		va += nblk * sc->sc_secsize;
    807        1.1        ad 	}
    808        1.1        ad 
    809        1.1        ad 	dumping = 0;
    810        1.1        ad 	return (0);
    811        1.1        ad }
    812        1.1        ad 
    813        1.1        ad /*
    814        1.1        ad  * Adjust the size of a transfer.
    815        1.1        ad  */
    816        1.1        ad static void
    817        1.1        ad ldminphys(struct buf *bp)
    818        1.1        ad {
    819        1.1        ad 	struct ld_softc *sc;
    820        1.1        ad 
    821        1.1        ad 	sc = device_lookup(&ld_cd, DISKUNIT(bp->b_dev));
    822        1.1        ad 
    823        1.1        ad 	if (bp->b_bcount > sc->sc_maxxfer)
    824        1.1        ad 		bp->b_bcount = sc->sc_maxxfer;
    825        1.1        ad 	minphys(bp);
    826        1.1        ad }
    827