Home | History | Annotate | Line # | Download | only in dev
dksubr.c revision 1.110
      1  1.110   mlelstv /* $NetBSD: dksubr.c,v 1.110 2019/10/05 05:28:44 mlelstv Exp $ */
      2    1.1     elric 
      3    1.1     elric /*-
      4   1.34        ad  * Copyright (c) 1996, 1997, 1998, 1999, 2002, 2008 The NetBSD Foundation, Inc.
      5    1.1     elric  * All rights reserved.
      6    1.1     elric  *
      7    1.1     elric  * This code is derived from software contributed to The NetBSD Foundation
      8    1.1     elric  * by Jason R. Thorpe and Roland C. Dowdeswell.
      9    1.1     elric  *
     10    1.1     elric  * Redistribution and use in source and binary forms, with or without
     11    1.1     elric  * modification, are permitted provided that the following conditions
     12    1.1     elric  * are met:
     13    1.1     elric  * 1. Redistributions of source code must retain the above copyright
     14    1.1     elric  *    notice, this list of conditions and the following disclaimer.
     15    1.1     elric  * 2. Redistributions in binary form must reproduce the above copyright
     16    1.1     elric  *    notice, this list of conditions and the following disclaimer in the
     17    1.1     elric  *    documentation and/or other materials provided with the distribution.
     18    1.1     elric  *
     19    1.1     elric  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20    1.1     elric  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21    1.1     elric  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22    1.1     elric  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23    1.1     elric  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24    1.1     elric  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25    1.1     elric  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26    1.1     elric  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27    1.1     elric  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28    1.1     elric  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29    1.1     elric  * POSSIBILITY OF SUCH DAMAGE.
     30    1.1     elric  */
     31   1.10     lukem 
     32   1.10     lukem #include <sys/cdefs.h>
     33  1.110   mlelstv __KERNEL_RCSID(0, "$NetBSD: dksubr.c,v 1.110 2019/10/05 05:28:44 mlelstv Exp $");
     34    1.1     elric 
     35    1.1     elric #include <sys/param.h>
     36    1.1     elric #include <sys/systm.h>
     37    1.1     elric #include <sys/stat.h>
     38    1.1     elric #include <sys/proc.h>
     39    1.1     elric #include <sys/ioctl.h>
     40    1.1     elric #include <sys/device.h>
     41    1.1     elric #include <sys/disk.h>
     42    1.1     elric #include <sys/disklabel.h>
     43   1.14      yamt #include <sys/buf.h>
     44   1.14      yamt #include <sys/bufq.h>
     45    1.1     elric #include <sys/vnode.h>
     46    1.1     elric #include <sys/fcntl.h>
     47    1.1     elric #include <sys/namei.h>
     48   1.49  pgoyette #include <sys/module.h>
     49   1.60   mlelstv #include <sys/syslog.h>
     50    1.1     elric 
     51    1.1     elric #include <dev/dkvar.h>
     52   1.51   hannken #include <miscfs/specfs/specdev.h> /* for v_rdev */
     53    1.1     elric 
     54   1.44     elric int	dkdebug = 0;
     55    1.1     elric 
     56    1.1     elric #ifdef DEBUG
     57    1.1     elric #define DKDB_FOLLOW	0x1
     58    1.1     elric #define DKDB_INIT	0x2
     59    1.1     elric #define DKDB_VNODE	0x4
     60   1.77  christos #define DKDB_DUMP	0x8
     61    1.1     elric 
     62    1.1     elric #define IFDEBUG(x,y)		if (dkdebug & (x)) y
     63    1.1     elric #define DPRINTF(x,y)		IFDEBUG(x, printf y)
     64    1.1     elric #define DPRINTF_FOLLOW(y)	DPRINTF(DKDB_FOLLOW, y)
     65    1.1     elric #else
     66    1.1     elric #define IFDEBUG(x,y)
     67    1.1     elric #define DPRINTF(x,y)
     68    1.1     elric #define DPRINTF_FOLLOW(y)
     69    1.1     elric #endif
     70    1.1     elric 
     71   1.77  christos #define DKF_READYFORDUMP	(DKF_INITED|DKF_TAKEDUMP)
     72   1.77  christos 
     73   1.49  pgoyette static int dk_subr_modcmd(modcmd_t, void *);
     74   1.49  pgoyette 
     75    1.1     elric #define DKLABELDEV(dev)	\
     76    1.1     elric 	(MAKEDISKDEV(major((dev)), DISKUNIT((dev)), RAW_PART))
     77    1.1     elric 
     78   1.60   mlelstv static void	dk_makedisklabel(struct dk_softc *);
     79   1.71   mlelstv static int	dk_translate(struct dk_softc *, struct buf *);
     80   1.74   mlelstv static void	dk_done1(struct dk_softc *, struct buf *, bool);
     81    1.1     elric 
     82    1.1     elric void
     83   1.60   mlelstv dk_init(struct dk_softc *dksc, device_t dev, int dtype)
     84    1.1     elric {
     85    1.1     elric 
     86    1.1     elric 	memset(dksc, 0x0, sizeof(*dksc));
     87   1.60   mlelstv 	dksc->sc_dtype = dtype;
     88   1.60   mlelstv 	dksc->sc_dev = dev;
     89   1.60   mlelstv 
     90   1.62   mlelstv 	strlcpy(dksc->sc_xname, device_xname(dev), DK_XNAME_SIZE);
     91    1.1     elric 	dksc->sc_dkdev.dk_name = dksc->sc_xname;
     92    1.1     elric }
     93    1.1     elric 
     94   1.60   mlelstv void
     95   1.60   mlelstv dk_attach(struct dk_softc *dksc)
     96   1.60   mlelstv {
     97   1.84   mlelstv 	KASSERT(dksc->sc_dev != NULL);
     98   1.84   mlelstv 
     99   1.74   mlelstv 	mutex_init(&dksc->sc_iolock, MUTEX_DEFAULT, IPL_VM);
    100   1.77  christos 	dksc->sc_flags |= DKF_READYFORDUMP;
    101   1.61   mlelstv #ifdef DIAGNOSTIC
    102   1.61   mlelstv 	dksc->sc_flags |= DKF_WARNLABEL | DKF_LABELSANITY;
    103   1.61   mlelstv #endif
    104   1.76   mlelstv 
    105   1.97  jdolecek 	if ((dksc->sc_flags & DKF_NO_RND) == 0) {
    106   1.97  jdolecek 		/* Attach the device into the rnd source list. */
    107   1.97  jdolecek 		rnd_attach_source(&dksc->sc_rnd_source, dksc->sc_xname,
    108   1.97  jdolecek 		    RND_TYPE_DISK, RND_FLAG_DEFAULT);
    109   1.97  jdolecek 	}
    110   1.60   mlelstv }
    111   1.60   mlelstv 
    112   1.60   mlelstv void
    113   1.60   mlelstv dk_detach(struct dk_softc *dksc)
    114   1.60   mlelstv {
    115   1.97  jdolecek 	if ((dksc->sc_flags & DKF_NO_RND) == 0) {
    116   1.97  jdolecek 		/* Unhook the entropy source. */
    117   1.97  jdolecek 		rnd_detach_source(&dksc->sc_rnd_source);
    118   1.97  jdolecek 	}
    119   1.76   mlelstv 
    120   1.77  christos 	dksc->sc_flags &= ~DKF_READYFORDUMP;
    121   1.71   mlelstv 	mutex_destroy(&dksc->sc_iolock);
    122   1.60   mlelstv }
    123   1.60   mlelstv 
    124    1.1     elric /* ARGSUSED */
    125    1.1     elric int
    126   1.60   mlelstv dk_open(struct dk_softc *dksc, dev_t dev,
    127   1.27  christos     int flags, int fmt, struct lwp *l)
    128    1.1     elric {
    129   1.92   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    130    1.1     elric 	struct	disklabel *lp = dksc->sc_dkdev.dk_label;
    131    1.1     elric 	int	part = DISKPART(dev);
    132    1.1     elric 	int	pmask = 1 << part;
    133    1.1     elric 	int	ret = 0;
    134   1.16      yamt 	struct disk *dk = &dksc->sc_dkdev;
    135    1.1     elric 
    136   1.77  christos 	DPRINTF_FOLLOW(("%s(%s, %p, 0x%"PRIx64", 0x%x)\n", __func__,
    137   1.60   mlelstv 	    dksc->sc_xname, dksc, dev, flags));
    138    1.1     elric 
    139   1.30        ad 	mutex_enter(&dk->dk_openlock);
    140   1.16      yamt 
    141   1.16      yamt 	/*
    142   1.16      yamt 	 * If there are wedges, and this is not RAW_PART, then we
    143   1.16      yamt 	 * need to fail.
    144   1.16      yamt 	 */
    145   1.16      yamt 	if (dk->dk_nwedges != 0 && part != RAW_PART) {
    146   1.16      yamt 		ret = EBUSY;
    147   1.16      yamt 		goto done;
    148   1.16      yamt 	}
    149   1.16      yamt 
    150  1.110   mlelstv 	/* If no dkdriver attached, bail */
    151  1.110   mlelstv 	if (dkd == NULL) {
    152  1.110   mlelstv 		ret = ENXIO;
    153  1.110   mlelstv 		goto done;
    154  1.110   mlelstv 	}
    155  1.110   mlelstv 
    156    1.1     elric 	/*
    157   1.92   mlelstv 	 * initialize driver for the first opener
    158   1.92   mlelstv 	 */
    159   1.92   mlelstv 	if (dk->dk_openmask == 0 && dkd->d_firstopen != NULL) {
    160   1.92   mlelstv 		ret = (*dkd->d_firstopen)(dksc->sc_dev, dev, flags, fmt);
    161   1.92   mlelstv 		if (ret)
    162   1.92   mlelstv 			goto done;
    163   1.92   mlelstv 	}
    164   1.92   mlelstv 
    165   1.92   mlelstv 	/*
    166    1.1     elric 	 * If we're init'ed and there are no other open partitions then
    167    1.1     elric 	 * update the in-core disklabel.
    168    1.1     elric 	 */
    169   1.16      yamt 	if ((dksc->sc_flags & DKF_INITED)) {
    170   1.60   mlelstv 		if ((dksc->sc_flags & DKF_VLABEL) == 0) {
    171   1.60   mlelstv 			dksc->sc_flags |= DKF_VLABEL;
    172   1.60   mlelstv 			dk_getdisklabel(dksc, dev);
    173   1.16      yamt 		}
    174   1.16      yamt 	}
    175    1.1     elric 
    176    1.1     elric 	/* Fail if we can't find the partition. */
    177   1.60   mlelstv 	if (part != RAW_PART &&
    178   1.60   mlelstv 	    ((dksc->sc_flags & DKF_VLABEL) == 0 ||
    179   1.60   mlelstv 	     part >= lp->d_npartitions ||
    180   1.60   mlelstv 	     lp->d_partitions[part].p_fstype == FS_UNUSED)) {
    181    1.1     elric 		ret = ENXIO;
    182    1.1     elric 		goto done;
    183    1.1     elric 	}
    184    1.1     elric 
    185    1.1     elric 	/* Mark our unit as open. */
    186    1.1     elric 	switch (fmt) {
    187    1.1     elric 	case S_IFCHR:
    188   1.16      yamt 		dk->dk_copenmask |= pmask;
    189    1.1     elric 		break;
    190    1.1     elric 	case S_IFBLK:
    191   1.16      yamt 		dk->dk_bopenmask |= pmask;
    192    1.1     elric 		break;
    193    1.1     elric 	}
    194    1.1     elric 
    195   1.16      yamt 	dk->dk_openmask = dk->dk_copenmask | dk->dk_bopenmask;
    196    1.1     elric 
    197    1.1     elric done:
    198   1.30        ad 	mutex_exit(&dk->dk_openlock);
    199    1.1     elric 	return ret;
    200    1.1     elric }
    201    1.1     elric 
    202    1.1     elric /* ARGSUSED */
    203    1.1     elric int
    204   1.60   mlelstv dk_close(struct dk_softc *dksc, dev_t dev,
    205   1.27  christos     int flags, int fmt, struct lwp *l)
    206    1.1     elric {
    207   1.60   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    208    1.1     elric 	int	part = DISKPART(dev);
    209    1.1     elric 	int	pmask = 1 << part;
    210   1.16      yamt 	struct disk *dk = &dksc->sc_dkdev;
    211    1.1     elric 
    212   1.77  christos 	DPRINTF_FOLLOW(("%s(%s, %p, 0x%"PRIx64", 0x%x)\n", __func__,
    213   1.60   mlelstv 	    dksc->sc_xname, dksc, dev, flags));
    214    1.1     elric 
    215   1.30        ad 	mutex_enter(&dk->dk_openlock);
    216    1.1     elric 
    217    1.1     elric 	switch (fmt) {
    218    1.1     elric 	case S_IFCHR:
    219   1.16      yamt 		dk->dk_copenmask &= ~pmask;
    220    1.1     elric 		break;
    221    1.1     elric 	case S_IFBLK:
    222   1.16      yamt 		dk->dk_bopenmask &= ~pmask;
    223    1.1     elric 		break;
    224    1.1     elric 	}
    225   1.16      yamt 	dk->dk_openmask = dk->dk_copenmask | dk->dk_bopenmask;
    226    1.1     elric 
    227   1.60   mlelstv 	if (dk->dk_openmask == 0) {
    228   1.60   mlelstv 		if (dkd->d_lastclose != NULL)
    229   1.60   mlelstv 			(*dkd->d_lastclose)(dksc->sc_dev);
    230   1.64   mlelstv 		if ((dksc->sc_flags & DKF_KLABEL) == 0)
    231   1.64   mlelstv 			dksc->sc_flags &= ~DKF_VLABEL;
    232   1.60   mlelstv 	}
    233   1.60   mlelstv 
    234   1.30        ad 	mutex_exit(&dk->dk_openlock);
    235    1.1     elric 	return 0;
    236    1.1     elric }
    237    1.1     elric 
    238   1.71   mlelstv static int
    239   1.71   mlelstv dk_translate(struct dk_softc *dksc, struct buf *bp)
    240    1.1     elric {
    241   1.71   mlelstv 	int	part;
    242    1.1     elric 	int	wlabel;
    243   1.18      yamt 	daddr_t	blkno;
    244   1.55   mlelstv 	struct disklabel *lp;
    245   1.55   mlelstv 	struct disk *dk;
    246   1.55   mlelstv 	uint64_t numsecs;
    247   1.55   mlelstv 	unsigned secsize;
    248    1.1     elric 
    249   1.55   mlelstv 	lp = dksc->sc_dkdev.dk_label;
    250   1.55   mlelstv 	dk = &dksc->sc_dkdev;
    251   1.55   mlelstv 
    252   1.55   mlelstv 	part = DISKPART(bp->b_dev);
    253   1.55   mlelstv 	numsecs = dk->dk_geom.dg_secperunit;
    254   1.55   mlelstv 	secsize = dk->dk_geom.dg_secsize;
    255    1.1     elric 
    256   1.55   mlelstv 	/*
    257   1.55   mlelstv 	 * The transfer must be a whole number of blocks and the offset must
    258   1.55   mlelstv 	 * not be negative.
    259   1.67     skrll 	 */
    260   1.72   mlelstv 	if ((bp->b_bcount % secsize) != 0 || bp->b_blkno < 0) {
    261   1.72   mlelstv 		bp->b_error = EINVAL;
    262   1.72   mlelstv 		goto done;
    263   1.72   mlelstv 	}
    264   1.55   mlelstv 
    265    1.1     elric 	/* If there is nothing to do, then we are done */
    266   1.71   mlelstv 	if (bp->b_bcount == 0)
    267   1.72   mlelstv 		goto done;
    268    1.1     elric 
    269    1.1     elric 	wlabel = dksc->sc_flags & (DKF_WLABEL|DKF_LABELLING);
    270   1.55   mlelstv 	if (part == RAW_PART) {
    271   1.82   mlelstv 		uint64_t numblocks = btodb(numsecs * secsize);
    272   1.82   mlelstv 		if (bounds_check_with_mediasize(bp, DEV_BSIZE, numblocks) <= 0)
    273   1.72   mlelstv 			goto done;
    274   1.55   mlelstv 	} else {
    275   1.71   mlelstv 		if (bounds_check_with_label(&dksc->sc_dkdev, bp, wlabel) <= 0)
    276   1.72   mlelstv 			goto done;
    277    1.1     elric 	}
    278    1.1     elric 
    279   1.67     skrll 	/*
    280   1.66   mlelstv 	 * Convert the block number to absolute and put it in terms
    281   1.66   mlelstv 	 * of the device's logical block size.
    282   1.66   mlelstv 	 */
    283   1.66   mlelstv 	if (secsize >= DEV_BSIZE)
    284   1.66   mlelstv 		blkno = bp->b_blkno / (secsize / DEV_BSIZE);
    285   1.66   mlelstv 	else
    286   1.66   mlelstv 		blkno = bp->b_blkno * (DEV_BSIZE / secsize);
    287   1.66   mlelstv 
    288   1.55   mlelstv 	if (part != RAW_PART)
    289   1.55   mlelstv 		blkno += lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
    290   1.18      yamt 	bp->b_rawblkno = blkno;
    291   1.18      yamt 
    292   1.71   mlelstv 	return -1;
    293   1.72   mlelstv 
    294   1.72   mlelstv done:
    295   1.72   mlelstv 	bp->b_resid = bp->b_bcount;
    296   1.72   mlelstv 	return bp->b_error;
    297   1.71   mlelstv }
    298   1.71   mlelstv 
    299   1.85   mlelstv static int
    300   1.85   mlelstv dk_strategy1(struct dk_softc *dksc, struct buf *bp)
    301   1.71   mlelstv {
    302   1.71   mlelstv 	int error;
    303   1.71   mlelstv 
    304   1.77  christos 	DPRINTF_FOLLOW(("%s(%s, %p, %p)\n", __func__,
    305   1.71   mlelstv 	    dksc->sc_xname, dksc, bp));
    306   1.71   mlelstv 
    307   1.71   mlelstv 	if (!(dksc->sc_flags & DKF_INITED)) {
    308   1.77  christos 		DPRINTF_FOLLOW(("%s: not inited\n", __func__));
    309   1.89   mlelstv 		bp->b_error = ENXIO;
    310   1.89   mlelstv 		bp->b_resid = bp->b_bcount;
    311   1.71   mlelstv 		biodone(bp);
    312   1.85   mlelstv 		return 1;
    313   1.71   mlelstv 	}
    314   1.71   mlelstv 
    315   1.71   mlelstv 	error = dk_translate(dksc, bp);
    316   1.71   mlelstv 	if (error >= 0) {
    317   1.71   mlelstv 		biodone(bp);
    318   1.85   mlelstv 		return 1;
    319   1.85   mlelstv 	}
    320   1.85   mlelstv 
    321   1.85   mlelstv 	return 0;
    322   1.85   mlelstv }
    323   1.85   mlelstv 
    324   1.85   mlelstv void
    325   1.85   mlelstv dk_strategy(struct dk_softc *dksc, struct buf *bp)
    326   1.85   mlelstv {
    327   1.85   mlelstv 	int error;
    328   1.85   mlelstv 
    329   1.85   mlelstv 	error = dk_strategy1(dksc, bp);
    330   1.85   mlelstv 	if (error)
    331   1.71   mlelstv 		return;
    332   1.71   mlelstv 
    333    1.1     elric 	/*
    334   1.71   mlelstv 	 * Queue buffer and start unit
    335    1.1     elric 	 */
    336   1.71   mlelstv 	dk_start(dksc, bp);
    337   1.71   mlelstv }
    338   1.71   mlelstv 
    339   1.85   mlelstv int
    340   1.85   mlelstv dk_strategy_defer(struct dk_softc *dksc, struct buf *bp)
    341   1.85   mlelstv {
    342   1.85   mlelstv 	int error;
    343   1.85   mlelstv 
    344   1.85   mlelstv 	error = dk_strategy1(dksc, bp);
    345   1.85   mlelstv 	if (error)
    346   1.85   mlelstv 		return error;
    347   1.85   mlelstv 
    348   1.85   mlelstv 	/*
    349   1.85   mlelstv 	 * Queue buffer only
    350   1.85   mlelstv 	 */
    351   1.85   mlelstv 	mutex_enter(&dksc->sc_iolock);
    352   1.96   mlelstv 	disk_wait(&dksc->sc_dkdev);
    353   1.85   mlelstv 	bufq_put(dksc->sc_bufq, bp);
    354   1.85   mlelstv 	mutex_exit(&dksc->sc_iolock);
    355   1.85   mlelstv 
    356   1.85   mlelstv 	return 0;
    357   1.85   mlelstv }
    358   1.85   mlelstv 
    359   1.85   mlelstv int
    360   1.85   mlelstv dk_strategy_pending(struct dk_softc *dksc)
    361   1.85   mlelstv {
    362   1.85   mlelstv 	struct buf *bp;
    363   1.85   mlelstv 
    364   1.85   mlelstv 	if (!(dksc->sc_flags & DKF_INITED)) {
    365   1.85   mlelstv 		DPRINTF_FOLLOW(("%s: not inited\n", __func__));
    366   1.85   mlelstv 		return 0;
    367   1.85   mlelstv 	}
    368   1.85   mlelstv 
    369   1.85   mlelstv 	mutex_enter(&dksc->sc_iolock);
    370   1.85   mlelstv 	bp = bufq_peek(dksc->sc_bufq);
    371   1.85   mlelstv 	mutex_exit(&dksc->sc_iolock);
    372   1.85   mlelstv 
    373   1.85   mlelstv 	return bp != NULL;
    374   1.85   mlelstv }
    375   1.85   mlelstv 
    376   1.71   mlelstv void
    377   1.71   mlelstv dk_start(struct dk_softc *dksc, struct buf *bp)
    378   1.71   mlelstv {
    379   1.71   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    380   1.71   mlelstv 	int error;
    381   1.71   mlelstv 
    382   1.84   mlelstv 	if (!(dksc->sc_flags & DKF_INITED)) {
    383   1.84   mlelstv 		DPRINTF_FOLLOW(("%s: not inited\n", __func__));
    384   1.84   mlelstv 		return;
    385   1.84   mlelstv 	}
    386   1.84   mlelstv 
    387   1.71   mlelstv 	mutex_enter(&dksc->sc_iolock);
    388   1.71   mlelstv 
    389   1.96   mlelstv 	if (bp != NULL) {
    390  1.109  jmcneill 		bp->b_ci = curcpu();
    391   1.96   mlelstv 		disk_wait(&dksc->sc_dkdev);
    392   1.71   mlelstv 		bufq_put(dksc->sc_bufq, bp);
    393   1.96   mlelstv 	}
    394   1.71   mlelstv 
    395   1.94   mlelstv 	/*
    396   1.94   mlelstv 	 * If another thread is running the queue, increment
    397   1.94   mlelstv 	 * busy counter to 2 so that the queue is retried,
    398   1.94   mlelstv 	 * because the driver may now accept additional
    399   1.94   mlelstv 	 * requests.
    400   1.94   mlelstv 	 */
    401   1.94   mlelstv 	if (dksc->sc_busy < 2)
    402   1.94   mlelstv 		dksc->sc_busy++;
    403   1.94   mlelstv 	if (dksc->sc_busy > 1)
    404   1.75   mlelstv 		goto done;
    405   1.75   mlelstv 
    406   1.74   mlelstv 	/*
    407   1.74   mlelstv 	 * Peeking at the buffer queue and committing the operation
    408   1.74   mlelstv 	 * only after success isn't atomic.
    409   1.74   mlelstv 	 *
    410   1.74   mlelstv 	 * So when a diskstart fails, the buffer is saved
    411   1.74   mlelstv 	 * and tried again before the next buffer is fetched.
    412   1.91  jdolecek 	 * dk_drain() handles flushing of a saved buffer.
    413   1.74   mlelstv 	 *
    414   1.74   mlelstv 	 * This keeps order of I/O operations, unlike bufq_put.
    415   1.74   mlelstv 	 */
    416   1.74   mlelstv 
    417   1.94   mlelstv 	while (dksc->sc_busy > 0) {
    418   1.91  jdolecek 
    419   1.94   mlelstv 		bp = dksc->sc_deferred;
    420   1.94   mlelstv 		dksc->sc_deferred = NULL;
    421   1.91  jdolecek 
    422   1.94   mlelstv 		if (bp == NULL)
    423   1.94   mlelstv 			bp = bufq_get(dksc->sc_bufq);
    424   1.71   mlelstv 
    425   1.94   mlelstv 		while (bp != NULL) {
    426   1.94   mlelstv 
    427   1.94   mlelstv 			disk_busy(&dksc->sc_dkdev);
    428   1.94   mlelstv 			mutex_exit(&dksc->sc_iolock);
    429   1.94   mlelstv 			error = dkd->d_diskstart(dksc->sc_dev, bp);
    430   1.94   mlelstv 			mutex_enter(&dksc->sc_iolock);
    431   1.94   mlelstv 			if (error == EAGAIN) {
    432  1.101  jdolecek 				KASSERT(dksc->sc_deferred == NULL);
    433   1.94   mlelstv 				dksc->sc_deferred = bp;
    434   1.94   mlelstv 				disk_unbusy(&dksc->sc_dkdev, 0, (bp->b_flags & B_READ));
    435   1.96   mlelstv 				disk_wait(&dksc->sc_dkdev);
    436   1.94   mlelstv 				break;
    437   1.94   mlelstv 			}
    438   1.94   mlelstv 
    439   1.94   mlelstv 			if (error != 0) {
    440   1.94   mlelstv 				bp->b_error = error;
    441   1.94   mlelstv 				bp->b_resid = bp->b_bcount;
    442   1.94   mlelstv 				dk_done1(dksc, bp, false);
    443   1.94   mlelstv 			}
    444   1.71   mlelstv 
    445   1.94   mlelstv 			bp = bufq_get(dksc->sc_bufq);
    446   1.71   mlelstv 		}
    447   1.91  jdolecek 
    448   1.94   mlelstv 		dksc->sc_busy--;
    449   1.71   mlelstv 	}
    450   1.75   mlelstv done:
    451   1.71   mlelstv 	mutex_exit(&dksc->sc_iolock);
    452    1.1     elric }
    453    1.1     elric 
    454   1.74   mlelstv static void
    455   1.74   mlelstv dk_done1(struct dk_softc *dksc, struct buf *bp, bool lock)
    456   1.60   mlelstv {
    457   1.60   mlelstv 	struct disk *dk = &dksc->sc_dkdev;
    458   1.60   mlelstv 
    459   1.60   mlelstv 	if (bp->b_error != 0) {
    460   1.68   mlelstv 		struct cfdriver *cd = device_cfdriver(dksc->sc_dev);
    461   1.68   mlelstv 
    462   1.68   mlelstv 		diskerr(bp, cd->cd_name, "error", LOG_PRINTF, 0,
    463   1.60   mlelstv 			dk->dk_label);
    464   1.60   mlelstv 		printf("\n");
    465   1.60   mlelstv 	}
    466   1.60   mlelstv 
    467   1.74   mlelstv 	if (lock)
    468   1.74   mlelstv 		mutex_enter(&dksc->sc_iolock);
    469   1.60   mlelstv 	disk_unbusy(dk, bp->b_bcount - bp->b_resid, (bp->b_flags & B_READ));
    470   1.71   mlelstv 
    471   1.97  jdolecek 	if ((dksc->sc_flags & DKF_NO_RND) == 0)
    472   1.97  jdolecek 		rnd_add_uint32(&dksc->sc_rnd_source, bp->b_rawblkno);
    473  1.104    bouyer 	if (lock)
    474  1.104    bouyer 		mutex_exit(&dksc->sc_iolock);
    475   1.71   mlelstv 
    476   1.60   mlelstv 	biodone(bp);
    477   1.60   mlelstv }
    478   1.60   mlelstv 
    479   1.74   mlelstv void
    480   1.74   mlelstv dk_done(struct dk_softc *dksc, struct buf *bp)
    481   1.74   mlelstv {
    482   1.74   mlelstv 	dk_done1(dksc, bp, true);
    483   1.74   mlelstv }
    484   1.74   mlelstv 
    485   1.74   mlelstv void
    486   1.74   mlelstv dk_drain(struct dk_softc *dksc)
    487   1.74   mlelstv {
    488   1.74   mlelstv 	struct buf *bp;
    489   1.74   mlelstv 
    490   1.74   mlelstv 	mutex_enter(&dksc->sc_iolock);
    491   1.91  jdolecek 	bp = dksc->sc_deferred;
    492   1.91  jdolecek 	dksc->sc_deferred = NULL;
    493   1.91  jdolecek 	if (bp != NULL) {
    494   1.74   mlelstv 		bp->b_error = EIO;
    495   1.74   mlelstv 		bp->b_resid = bp->b_bcount;
    496   1.74   mlelstv 		biodone(bp);
    497   1.74   mlelstv 	}
    498   1.74   mlelstv 	bufq_drain(dksc->sc_bufq);
    499   1.74   mlelstv 	mutex_exit(&dksc->sc_iolock);
    500   1.74   mlelstv }
    501   1.74   mlelstv 
    502    1.1     elric int
    503   1.71   mlelstv dk_discard(struct dk_softc *dksc, dev_t dev, off_t pos, off_t len)
    504   1.71   mlelstv {
    505   1.71   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    506   1.71   mlelstv 	unsigned secsize = dksc->sc_dkdev.dk_geom.dg_secsize;
    507   1.71   mlelstv 	struct buf tmp, *bp = &tmp;
    508   1.99      maya 	int maxsz;
    509   1.99      maya 	int error = 0;
    510   1.99      maya 
    511   1.99      maya 	KASSERT(len >= 0);
    512   1.71   mlelstv 
    513   1.77  christos 	DPRINTF_FOLLOW(("%s(%s, %p, 0x"PRIx64", %jd, %jd)\n", __func__,
    514   1.71   mlelstv 	    dksc->sc_xname, dksc, (intmax_t)pos, (intmax_t)len));
    515   1.71   mlelstv 
    516   1.71   mlelstv 	if (!(dksc->sc_flags & DKF_INITED)) {
    517   1.77  christos 		DPRINTF_FOLLOW(("%s: not inited\n", __func__));
    518   1.71   mlelstv 		return ENXIO;
    519   1.71   mlelstv 	}
    520   1.71   mlelstv 
    521   1.98   mlelstv 	if (secsize == 0 || (pos % secsize) != 0 || (len % secsize) != 0)
    522   1.71   mlelstv 		return EINVAL;
    523   1.71   mlelstv 
    524   1.98   mlelstv 	/* largest value that b_bcount can store */
    525   1.98   mlelstv 	maxsz = rounddown(INT_MAX, secsize);
    526   1.71   mlelstv 
    527   1.98   mlelstv 	while (len > 0) {
    528   1.98   mlelstv 		/* enough data to please the bounds checking code */
    529   1.98   mlelstv 		bp->b_dev = dev;
    530   1.98   mlelstv 		bp->b_blkno = (daddr_t)(pos / secsize);
    531  1.103  riastrad 		bp->b_bcount = uimin(len, maxsz);
    532   1.98   mlelstv 		bp->b_flags = B_WRITE;
    533   1.98   mlelstv 
    534   1.98   mlelstv 		error = dk_translate(dksc, bp);
    535   1.98   mlelstv 		if (error >= 0)
    536   1.98   mlelstv 			break;
    537   1.98   mlelstv 
    538   1.98   mlelstv 		error = dkd->d_discard(dksc->sc_dev,
    539   1.98   mlelstv 			(off_t)bp->b_rawblkno * secsize,
    540   1.98   mlelstv 			(off_t)bp->b_bcount);
    541   1.98   mlelstv 		if (error)
    542   1.98   mlelstv 			break;
    543   1.71   mlelstv 
    544   1.98   mlelstv 		pos += bp->b_bcount;
    545   1.98   mlelstv 		len -= bp->b_bcount;
    546   1.98   mlelstv 	}
    547   1.71   mlelstv 
    548   1.71   mlelstv 	return error;
    549   1.71   mlelstv }
    550   1.71   mlelstv 
    551   1.71   mlelstv int
    552   1.60   mlelstv dk_size(struct dk_softc *dksc, dev_t dev)
    553    1.1     elric {
    554   1.60   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    555    1.1     elric 	struct	disklabel *lp;
    556    1.1     elric 	int	is_open;
    557    1.1     elric 	int	part;
    558    1.1     elric 	int	size;
    559    1.1     elric 
    560    1.1     elric 	if ((dksc->sc_flags & DKF_INITED) == 0)
    561    1.1     elric 		return -1;
    562    1.1     elric 
    563    1.1     elric 	part = DISKPART(dev);
    564    1.1     elric 	is_open = dksc->sc_dkdev.dk_openmask & (1 << part);
    565    1.1     elric 
    566   1.60   mlelstv 	if (!is_open && dkd->d_open(dev, 0, S_IFBLK, curlwp))
    567    1.1     elric 		return -1;
    568    1.1     elric 
    569    1.1     elric 	lp = dksc->sc_dkdev.dk_label;
    570    1.1     elric 	if (lp->d_partitions[part].p_fstype != FS_SWAP)
    571    1.1     elric 		size = -1;
    572    1.1     elric 	else
    573    1.1     elric 		size = lp->d_partitions[part].p_size *
    574    1.1     elric 		    (lp->d_secsize / DEV_BSIZE);
    575    1.1     elric 
    576   1.60   mlelstv 	if (!is_open && dkd->d_close(dev, 0, S_IFBLK, curlwp))
    577   1.59   mlelstv 		return -1;
    578    1.1     elric 
    579    1.1     elric 	return size;
    580    1.1     elric }
    581    1.1     elric 
    582    1.1     elric int
    583   1.60   mlelstv dk_ioctl(struct dk_softc *dksc, dev_t dev,
    584   1.28  christos 	    u_long cmd, void *data, int flag, struct lwp *l)
    585    1.1     elric {
    586   1.60   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    587    1.1     elric 	struct	disklabel *lp;
    588   1.57  christos 	struct	disk *dk = &dksc->sc_dkdev;
    589    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    590    1.1     elric 	struct	disklabel newlabel;
    591    1.1     elric #endif
    592   1.57  christos 	int	error;
    593    1.1     elric 
    594   1.77  christos 	DPRINTF_FOLLOW(("%s(%s, %p, 0x%"PRIx64", 0x%lx)\n", __func__,
    595   1.60   mlelstv 	    dksc->sc_xname, dksc, dev, cmd));
    596    1.1     elric 
    597    1.1     elric 	/* ensure that the pseudo disk is open for writes for these commands */
    598    1.1     elric 	switch (cmd) {
    599    1.1     elric 	case DIOCSDINFO:
    600    1.1     elric 	case DIOCWDINFO:
    601    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    602    1.1     elric 	case ODIOCSDINFO:
    603    1.1     elric 	case ODIOCWDINFO:
    604    1.1     elric #endif
    605   1.69   mlelstv 	case DIOCKLABEL:
    606    1.1     elric 	case DIOCWLABEL:
    607   1.43     elric 	case DIOCAWEDGE:
    608   1.70   mlelstv 	case DIOCDWEDGE:
    609   1.69   mlelstv 	case DIOCSSTRATEGY:
    610    1.1     elric 		if ((flag & FWRITE) == 0)
    611    1.1     elric 			return EBADF;
    612    1.1     elric 	}
    613    1.1     elric 
    614    1.1     elric 	/* ensure that the pseudo-disk is initialized for these */
    615    1.1     elric 	switch (cmd) {
    616    1.1     elric 	case DIOCGDINFO:
    617    1.1     elric 	case DIOCSDINFO:
    618    1.1     elric 	case DIOCWDINFO:
    619   1.83  christos 	case DIOCGPARTINFO:
    620   1.60   mlelstv 	case DIOCKLABEL:
    621    1.1     elric 	case DIOCWLABEL:
    622    1.1     elric 	case DIOCGDEFLABEL:
    623   1.43     elric 	case DIOCAWEDGE:
    624   1.43     elric 	case DIOCDWEDGE:
    625   1.43     elric 	case DIOCLWEDGES:
    626   1.54   mlelstv 	case DIOCMWEDGES:
    627  1.107    martin 	case DIOCRMWEDGES:
    628   1.43     elric 	case DIOCCACHESYNC:
    629    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    630    1.1     elric 	case ODIOCGDINFO:
    631    1.1     elric 	case ODIOCSDINFO:
    632    1.1     elric 	case ODIOCWDINFO:
    633    1.1     elric 	case ODIOCGDEFLABEL:
    634    1.1     elric #endif
    635    1.1     elric 		if ((dksc->sc_flags & DKF_INITED) == 0)
    636    1.1     elric 			return ENXIO;
    637    1.1     elric 	}
    638    1.1     elric 
    639   1.58  christos 	error = disk_ioctl(dk, dev, cmd, data, flag, l);
    640   1.57  christos 	if (error != EPASSTHROUGH)
    641   1.57  christos 		return error;
    642   1.57  christos 	else
    643   1.57  christos 		error = 0;
    644   1.57  christos 
    645    1.1     elric 	switch (cmd) {
    646    1.1     elric 	case DIOCWDINFO:
    647    1.1     elric 	case DIOCSDINFO:
    648    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    649    1.1     elric 	case ODIOCWDINFO:
    650    1.1     elric 	case ODIOCSDINFO:
    651    1.1     elric #endif
    652    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    653    1.1     elric 		if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
    654    1.1     elric 			memset(&newlabel, 0, sizeof newlabel);
    655    1.1     elric 			memcpy(&newlabel, data, sizeof (struct olddisklabel));
    656    1.1     elric 			lp = &newlabel;
    657    1.1     elric 		} else
    658    1.1     elric #endif
    659    1.1     elric 		lp = (struct disklabel *)data;
    660    1.1     elric 
    661   1.30        ad 		mutex_enter(&dk->dk_openlock);
    662    1.1     elric 		dksc->sc_flags |= DKF_LABELLING;
    663    1.1     elric 
    664    1.1     elric 		error = setdisklabel(dksc->sc_dkdev.dk_label,
    665    1.1     elric 		    lp, 0, dksc->sc_dkdev.dk_cpulabel);
    666    1.1     elric 		if (error == 0) {
    667    1.1     elric 			if (cmd == DIOCWDINFO
    668    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    669    1.1     elric 			    || cmd == ODIOCWDINFO
    670    1.1     elric #endif
    671    1.1     elric 			   )
    672    1.1     elric 				error = writedisklabel(DKLABELDEV(dev),
    673   1.60   mlelstv 				    dkd->d_strategy, dksc->sc_dkdev.dk_label,
    674    1.1     elric 				    dksc->sc_dkdev.dk_cpulabel);
    675    1.1     elric 		}
    676    1.1     elric 
    677    1.1     elric 		dksc->sc_flags &= ~DKF_LABELLING;
    678   1.30        ad 		mutex_exit(&dk->dk_openlock);
    679    1.1     elric 		break;
    680    1.1     elric 
    681   1.60   mlelstv 	case DIOCKLABEL:
    682   1.60   mlelstv 		if (*(int *)data != 0)
    683   1.60   mlelstv 			dksc->sc_flags |= DKF_KLABEL;
    684   1.60   mlelstv 		else
    685   1.60   mlelstv 			dksc->sc_flags &= ~DKF_KLABEL;
    686   1.60   mlelstv 		break;
    687   1.60   mlelstv 
    688    1.1     elric 	case DIOCWLABEL:
    689    1.1     elric 		if (*(int *)data != 0)
    690    1.1     elric 			dksc->sc_flags |= DKF_WLABEL;
    691    1.1     elric 		else
    692    1.1     elric 			dksc->sc_flags &= ~DKF_WLABEL;
    693    1.1     elric 		break;
    694    1.1     elric 
    695    1.1     elric 	case DIOCGDEFLABEL:
    696   1.60   mlelstv 		dk_getdefaultlabel(dksc, (struct disklabel *)data);
    697    1.1     elric 		break;
    698    1.1     elric 
    699    1.1     elric #ifdef __HAVE_OLD_DISKLABEL
    700    1.1     elric 	case ODIOCGDEFLABEL:
    701   1.60   mlelstv 		dk_getdefaultlabel(dksc, &newlabel);
    702    1.1     elric 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
    703    1.1     elric 			return ENOTTY;
    704    1.1     elric 		memcpy(data, &newlabel, sizeof (struct olddisklabel));
    705    1.1     elric 		break;
    706    1.1     elric #endif
    707    1.1     elric 
    708   1.21      yamt 	case DIOCGSTRATEGY:
    709   1.21      yamt 	    {
    710   1.21      yamt 		struct disk_strategy *dks = (void *)data;
    711   1.21      yamt 
    712   1.71   mlelstv 		mutex_enter(&dksc->sc_iolock);
    713   1.87   mlelstv 		if (dksc->sc_bufq != NULL)
    714   1.88  christos 			strlcpy(dks->dks_name,
    715   1.88  christos 			    bufq_getstrategyname(dksc->sc_bufq),
    716   1.87   mlelstv 			    sizeof(dks->dks_name));
    717   1.87   mlelstv 		else
    718   1.87   mlelstv 			error = EINVAL;
    719   1.71   mlelstv 		mutex_exit(&dksc->sc_iolock);
    720   1.21      yamt 		dks->dks_paramlen = 0;
    721   1.88  christos 		break;
    722   1.21      yamt 	    }
    723   1.67     skrll 
    724   1.21      yamt 	case DIOCSSTRATEGY:
    725   1.21      yamt 	    {
    726   1.21      yamt 		struct disk_strategy *dks = (void *)data;
    727   1.21      yamt 		struct bufq_state *new;
    728   1.21      yamt 		struct bufq_state *old;
    729   1.21      yamt 
    730   1.21      yamt 		if (dks->dks_param != NULL) {
    731   1.21      yamt 			return EINVAL;
    732   1.21      yamt 		}
    733   1.21      yamt 		dks->dks_name[sizeof(dks->dks_name) - 1] = 0; /* ensure term */
    734   1.21      yamt 		error = bufq_alloc(&new, dks->dks_name,
    735   1.21      yamt 		    BUFQ_EXACT|BUFQ_SORT_RAWBLOCK);
    736   1.21      yamt 		if (error) {
    737   1.21      yamt 			return error;
    738   1.21      yamt 		}
    739   1.71   mlelstv 		mutex_enter(&dksc->sc_iolock);
    740   1.21      yamt 		old = dksc->sc_bufq;
    741   1.88  christos 		if (old)
    742   1.88  christos 			bufq_move(new, old);
    743   1.21      yamt 		dksc->sc_bufq = new;
    744   1.71   mlelstv 		mutex_exit(&dksc->sc_iolock);
    745   1.88  christos 		if (old)
    746   1.88  christos 			bufq_free(old);
    747   1.88  christos 		break;
    748   1.21      yamt 	    }
    749   1.21      yamt 
    750    1.1     elric 	default:
    751    1.1     elric 		error = ENOTTY;
    752    1.1     elric 	}
    753    1.1     elric 
    754    1.1     elric 	return error;
    755    1.1     elric }
    756    1.1     elric 
    757    1.1     elric /*
    758    1.1     elric  * dk_dump dumps all of physical memory into the partition specified.
    759    1.1     elric  * This requires substantially more framework than {s,w}ddump, and hence
    760    1.1     elric  * is probably much more fragile.
    761    1.1     elric  *
    762    1.1     elric  */
    763    1.1     elric 
    764    1.1     elric #define DKFF_READYFORDUMP(x)	(((x) & DKF_READYFORDUMP) == DKF_READYFORDUMP)
    765    1.1     elric static volatile int	dk_dumping = 0;
    766    1.1     elric 
    767    1.1     elric /* ARGSUSED */
    768    1.1     elric int
    769   1.60   mlelstv dk_dump(struct dk_softc *dksc, dev_t dev,
    770   1.60   mlelstv     daddr_t blkno, void *vav, size_t size)
    771    1.1     elric {
    772   1.60   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    773  1.102   mlelstv 	struct disk_geom *dg = &dksc->sc_dkdev.dk_geom;
    774   1.60   mlelstv 	char *va = vav;
    775   1.60   mlelstv 	struct disklabel *lp;
    776   1.77  christos 	struct partition *p;
    777  1.102   mlelstv 	int part, towrt, maxblkcnt, nblk;
    778   1.60   mlelstv 	int maxxfer, rv = 0;
    779    1.1     elric 
    780    1.1     elric 	/*
    781    1.1     elric 	 * ensure that we consider this device to be safe for dumping,
    782    1.1     elric 	 * and that the device is configured.
    783    1.1     elric 	 */
    784   1.77  christos 	if (!DKFF_READYFORDUMP(dksc->sc_flags)) {
    785   1.78  christos 		DPRINTF(DKDB_DUMP, ("%s: bad dump flags 0x%x\n", __func__,
    786   1.77  christos 		    dksc->sc_flags));
    787    1.1     elric 		return ENXIO;
    788   1.77  christos 	}
    789    1.1     elric 
    790    1.1     elric 	/* ensure that we are not already dumping */
    791    1.1     elric 	if (dk_dumping)
    792    1.1     elric 		return EFAULT;
    793    1.1     elric 	dk_dumping = 1;
    794    1.1     elric 
    795   1.77  christos 	if (dkd->d_dumpblocks == NULL) {
    796   1.78  christos 		DPRINTF(DKDB_DUMP, ("%s: no dumpblocks\n", __func__));
    797   1.60   mlelstv 		return ENXIO;
    798   1.77  christos 	}
    799   1.60   mlelstv 
    800   1.60   mlelstv 	/* device specific max transfer size */
    801   1.60   mlelstv 	maxxfer = MAXPHYS;
    802   1.60   mlelstv 	if (dkd->d_iosize != NULL)
    803   1.60   mlelstv 		(*dkd->d_iosize)(dksc->sc_dev, &maxxfer);
    804   1.60   mlelstv 
    805   1.60   mlelstv 	/* Convert to disk sectors.  Request must be a multiple of size. */
    806   1.60   mlelstv 	part = DISKPART(dev);
    807   1.60   mlelstv 	lp = dksc->sc_dkdev.dk_label;
    808   1.77  christos 	if ((size % lp->d_secsize) != 0) {
    809   1.78  christos 		DPRINTF(DKDB_DUMP, ("%s: odd size %zu\n", __func__, size));
    810   1.77  christos 		return EFAULT;
    811   1.77  christos 	}
    812   1.60   mlelstv 	towrt = size / lp->d_secsize;
    813   1.60   mlelstv 	blkno = dbtob(blkno) / lp->d_secsize;   /* blkno in secsize units */
    814   1.60   mlelstv 
    815   1.77  christos 	p = &lp->d_partitions[part];
    816  1.102   mlelstv 	if (part == RAW_PART) {
    817  1.102   mlelstv 		if (p->p_fstype != FS_UNUSED) {
    818  1.102   mlelstv 			DPRINTF(DKDB_DUMP, ("%s: bad fstype %d\n", __func__,
    819  1.102   mlelstv 			    p->p_fstype));
    820  1.102   mlelstv 			return ENXIO;
    821  1.102   mlelstv 		}
    822  1.108      maya 		/* Check whether dump goes to a wedge */
    823  1.102   mlelstv 		if (dksc->sc_dkdev.dk_nwedges == 0) {
    824  1.102   mlelstv 			DPRINTF(DKDB_DUMP, ("%s: dump to raw\n", __func__));
    825  1.102   mlelstv 			return ENXIO;
    826  1.102   mlelstv 		}
    827  1.102   mlelstv 		/* Check transfer bounds against media size */
    828  1.102   mlelstv 		if (blkno < 0 || (blkno + towrt) > dg->dg_secperunit) {
    829  1.102   mlelstv 			DPRINTF(DKDB_DUMP, ("%s: out of bounds blkno=%jd, towrt=%d, "
    830  1.102   mlelstv 			    "nsects=%jd\n", __func__, (intmax_t)blkno, towrt, dg->dg_secperunit));
    831  1.102   mlelstv 			return EINVAL;
    832  1.102   mlelstv 		}
    833  1.102   mlelstv 	} else {
    834  1.102   mlelstv 		int nsects, sectoff;
    835  1.102   mlelstv 
    836  1.102   mlelstv 		if (p->p_fstype != FS_SWAP) {
    837  1.102   mlelstv 			DPRINTF(DKDB_DUMP, ("%s: bad fstype %d\n", __func__,
    838  1.102   mlelstv 			    p->p_fstype));
    839  1.102   mlelstv 			return ENXIO;
    840  1.102   mlelstv 		}
    841  1.102   mlelstv 		nsects = p->p_size;
    842  1.102   mlelstv 		sectoff = p->p_offset;
    843  1.102   mlelstv 
    844  1.102   mlelstv 		/* Check transfer bounds against partition size. */
    845  1.102   mlelstv 		if ((blkno < 0) || ((blkno + towrt) > nsects)) {
    846  1.102   mlelstv 			DPRINTF(DKDB_DUMP, ("%s: out of bounds blkno=%jd, towrt=%d, "
    847  1.102   mlelstv 			    "nsects=%d\n", __func__, (intmax_t)blkno, towrt, nsects));
    848  1.102   mlelstv 			return EINVAL;
    849  1.102   mlelstv 		}
    850   1.60   mlelstv 
    851  1.102   mlelstv 		/* Offset block number to start of partition. */
    852  1.102   mlelstv 		blkno += sectoff;
    853   1.77  christos 	}
    854   1.60   mlelstv 
    855   1.60   mlelstv 	/* Start dumping and return when done. */
    856   1.60   mlelstv 	maxblkcnt = howmany(maxxfer, lp->d_secsize);
    857   1.60   mlelstv 	while (towrt > 0) {
    858  1.103  riastrad 		nblk = uimin(maxblkcnt, towrt);
    859   1.60   mlelstv 
    860   1.77  christos 		if ((rv = (*dkd->d_dumpblocks)(dksc->sc_dev, va, blkno, nblk))
    861   1.77  christos 		    != 0) {
    862   1.78  christos 			DPRINTF(DKDB_DUMP, ("%s: dumpblocks %d\n", __func__,
    863   1.77  christos 			    rv));
    864   1.77  christos 			return rv;
    865   1.77  christos 		}
    866   1.60   mlelstv 
    867   1.60   mlelstv 		towrt -= nblk;
    868   1.60   mlelstv 		blkno += nblk;
    869   1.60   mlelstv 		va += nblk * lp->d_secsize;
    870   1.60   mlelstv 	}
    871    1.1     elric 
    872    1.1     elric 	dk_dumping = 0;
    873    1.1     elric 
    874   1.60   mlelstv 	return 0;
    875    1.1     elric }
    876    1.1     elric 
    877    1.1     elric /* ARGSUSED */
    878    1.1     elric void
    879   1.63  christos dk_getdefaultlabel(struct dk_softc *dksc, struct disklabel *lp)
    880    1.1     elric {
    881   1.93   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    882   1.47  christos 	struct disk_geom *dg = &dksc->sc_dkdev.dk_geom;
    883    1.4     elric 
    884    1.4     elric 	memset(lp, 0, sizeof(*lp));
    885    1.1     elric 
    886   1.52   mlelstv 	if (dg->dg_secperunit > UINT32_MAX)
    887   1.52   mlelstv 		lp->d_secperunit = UINT32_MAX;
    888   1.52   mlelstv 	else
    889   1.52   mlelstv 		lp->d_secperunit = dg->dg_secperunit;
    890   1.47  christos 	lp->d_secsize = dg->dg_secsize;
    891   1.47  christos 	lp->d_nsectors = dg->dg_nsectors;
    892   1.47  christos 	lp->d_ntracks = dg->dg_ntracks;
    893   1.47  christos 	lp->d_ncylinders = dg->dg_ncylinders;
    894    1.1     elric 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    895    1.1     elric 
    896   1.63  christos 	strlcpy(lp->d_typename, dksc->sc_xname, sizeof(lp->d_typename));
    897   1.60   mlelstv 	lp->d_type = dksc->sc_dtype;
    898   1.63  christos 	strlcpy(lp->d_packname, "fictitious", sizeof(lp->d_packname));
    899    1.1     elric 	lp->d_rpm = 3600;
    900    1.1     elric 	lp->d_interleave = 1;
    901    1.1     elric 	lp->d_flags = 0;
    902    1.1     elric 
    903    1.1     elric 	lp->d_partitions[RAW_PART].p_offset = 0;
    904   1.52   mlelstv 	lp->d_partitions[RAW_PART].p_size = lp->d_secperunit;
    905    1.1     elric 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    906    1.1     elric 	lp->d_npartitions = RAW_PART + 1;
    907    1.1     elric 
    908    1.1     elric 	lp->d_magic = DISKMAGIC;
    909    1.1     elric 	lp->d_magic2 = DISKMAGIC;
    910   1.93   mlelstv 
    911   1.93   mlelstv 	if (dkd->d_label)
    912   1.93   mlelstv 		dkd->d_label(dksc->sc_dev, lp);
    913   1.93   mlelstv 
    914   1.93   mlelstv 	lp->d_checksum = dkcksum(lp);
    915    1.1     elric }
    916    1.1     elric 
    917    1.1     elric /* ARGSUSED */
    918    1.1     elric void
    919   1.60   mlelstv dk_getdisklabel(struct dk_softc *dksc, dev_t dev)
    920    1.1     elric {
    921   1.60   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    922    1.1     elric 	struct	 disklabel *lp = dksc->sc_dkdev.dk_label;
    923    1.1     elric 	struct	 cpu_disklabel *clp = dksc->sc_dkdev.dk_cpulabel;
    924   1.60   mlelstv 	struct   disk_geom *dg = &dksc->sc_dkdev.dk_geom;
    925    1.1     elric 	struct	 partition *pp;
    926  1.105  jdolecek 	int	 i, lpratio, dgratio;
    927    1.5       dsl 	const char	*errstring;
    928    1.1     elric 
    929    1.1     elric 	memset(clp, 0x0, sizeof(*clp));
    930   1.60   mlelstv 	dk_getdefaultlabel(dksc, lp);
    931   1.60   mlelstv 	errstring = readdisklabel(DKLABELDEV(dev), dkd->d_strategy,
    932    1.1     elric 	    dksc->sc_dkdev.dk_label, dksc->sc_dkdev.dk_cpulabel);
    933    1.1     elric 	if (errstring) {
    934   1.60   mlelstv 		dk_makedisklabel(dksc);
    935    1.1     elric 		if (dksc->sc_flags & DKF_WARNLABEL)
    936    1.1     elric 			printf("%s: %s\n", dksc->sc_xname, errstring);
    937    1.1     elric 		return;
    938    1.1     elric 	}
    939    1.1     elric 
    940    1.1     elric 	if ((dksc->sc_flags & DKF_LABELSANITY) == 0)
    941    1.1     elric 		return;
    942    1.1     elric 
    943  1.105  jdolecek 	/* Convert sector counts to multiple of DEV_BSIZE for comparison */
    944  1.105  jdolecek 	lpratio = dgratio = 1;
    945  1.105  jdolecek 	if (lp->d_secsize > DEV_BSIZE)
    946  1.105  jdolecek 		lpratio = lp->d_secsize / DEV_BSIZE;
    947  1.106  jdolecek 	if (dg->dg_secsize > DEV_BSIZE)
    948  1.105  jdolecek 		dgratio = dg->dg_secsize / DEV_BSIZE;
    949  1.105  jdolecek 
    950    1.1     elric 	/* Sanity check */
    951  1.105  jdolecek 	if ((uint64_t)lp->d_secperunit * lpratio > dg->dg_secperunit * dgratio)
    952  1.105  jdolecek 		printf("WARNING: %s: "
    953  1.105  jdolecek 		    "total unit size in disklabel (%" PRIu64 ") "
    954  1.105  jdolecek 		    "!= the size of %s (%" PRIu64 ")\n", dksc->sc_xname,
    955  1.105  jdolecek 		    (uint64_t)lp->d_secperunit * lpratio, dksc->sc_xname,
    956  1.105  jdolecek 		    dg->dg_secperunit * dgratio);
    957   1.95   mlelstv 	else if (lp->d_secperunit < UINT32_MAX &&
    958  1.105  jdolecek 	    (uint64_t)lp->d_secperunit * lpratio < dg->dg_secperunit * dgratio)
    959  1.105  jdolecek 		printf("%s: %" PRIu64 " trailing sectors not covered"
    960  1.105  jdolecek 		    " by disklabel\n", dksc->sc_xname,
    961  1.105  jdolecek 		    (dg->dg_secperunit * dgratio)
    962  1.105  jdolecek 		    - (lp->d_secperunit * lpratio));
    963    1.1     elric 
    964    1.1     elric 	for (i=0; i < lp->d_npartitions; i++) {
    965  1.105  jdolecek 		uint64_t pend;
    966  1.105  jdolecek 
    967    1.1     elric 		pp = &lp->d_partitions[i];
    968  1.105  jdolecek 		pend = pp->p_offset + pp->p_size;
    969  1.105  jdolecek 		if (pend * lpratio > dg->dg_secperunit * dgratio)
    970    1.1     elric 			printf("WARNING: %s: end of partition `%c' exceeds "
    971  1.105  jdolecek 			    "the size of %s (%" PRIu64 ")\n", dksc->sc_xname,
    972   1.60   mlelstv 			    'a' + i, dksc->sc_xname,
    973  1.105  jdolecek 			    dg->dg_secperunit * dgratio);
    974    1.1     elric 	}
    975    1.1     elric }
    976    1.1     elric 
    977  1.100   mlelstv /*
    978  1.100   mlelstv  * Heuristic to conjure a disklabel if reading a disklabel failed.
    979  1.100   mlelstv  *
    980  1.100   mlelstv  * This is to allow the raw partition to be used for a filesystem
    981  1.100   mlelstv  * without caring about the write protected label sector.
    982  1.100   mlelstv  *
    983  1.100   mlelstv  * If the driver provides it's own callback, use that instead.
    984  1.100   mlelstv  */
    985    1.1     elric /* ARGSUSED */
    986   1.13   thorpej static void
    987   1.60   mlelstv dk_makedisklabel(struct dk_softc *dksc)
    988    1.1     elric {
    989  1.100   mlelstv 	const struct dkdriver *dkd = dksc->sc_dkdev.dk_driver;
    990  1.100   mlelstv 	struct  disklabel *lp = dksc->sc_dkdev.dk_label;
    991    1.1     elric 
    992   1.63  christos 	strlcpy(lp->d_packname, "default label", sizeof(lp->d_packname));
    993  1.100   mlelstv 
    994  1.100   mlelstv 	if (dkd->d_label)
    995  1.100   mlelstv 		dkd->d_label(dksc->sc_dev, lp);
    996  1.100   mlelstv 	else
    997  1.100   mlelstv 		lp->d_partitions[RAW_PART].p_fstype = FS_BSDFFS;
    998  1.100   mlelstv 
    999    1.1     elric 	lp->d_checksum = dkcksum(lp);
   1000    1.1     elric }
   1001    1.1     elric 
   1002    1.1     elric /* This function is taken from ccd.c:1.76  --rcd */
   1003    1.1     elric 
   1004    1.1     elric /*
   1005    1.1     elric  * XXX this function looks too generic for dksubr.c, shouldn't we
   1006    1.1     elric  *     put it somewhere better?
   1007    1.1     elric  */
   1008    1.1     elric 
   1009    1.1     elric /*
   1010    1.1     elric  * Lookup the provided name in the filesystem.  If the file exists,
   1011    1.1     elric  * is a valid block device, and isn't being used by anyone else,
   1012    1.1     elric  * set *vpp to the file's vnode.
   1013    1.1     elric  */
   1014    1.1     elric int
   1015   1.42  dholland dk_lookup(struct pathbuf *pb, struct lwp *l, struct vnode **vpp)
   1016    1.1     elric {
   1017    1.1     elric 	struct nameidata nd;
   1018    1.1     elric 	struct vnode *vp;
   1019   1.24  christos 	int     error;
   1020    1.1     elric 
   1021   1.24  christos 	if (l == NULL)
   1022   1.24  christos 		return ESRCH;	/* Is ESRCH the best choice? */
   1023   1.24  christos 
   1024   1.42  dholland 	NDINIT(&nd, LOOKUP, FOLLOW, pb);
   1025   1.24  christos 	if ((error = vn_open(&nd, FREAD | FWRITE, 0)) != 0) {
   1026    1.1     elric 		DPRINTF((DKDB_FOLLOW|DKDB_INIT),
   1027   1.77  christos 		    ("%s: vn_open error = %d\n", __func__, error));
   1028   1.24  christos 		return error;
   1029    1.1     elric 	}
   1030   1.24  christos 
   1031    1.1     elric 	vp = nd.ni_vp;
   1032   1.51   hannken 	if (vp->v_type != VBLK) {
   1033   1.51   hannken 		error = ENOTBLK;
   1034   1.24  christos 		goto out;
   1035    1.1     elric 	}
   1036    1.1     elric 
   1037   1.51   hannken 	/* Reopen as anonymous vnode to protect against forced unmount. */
   1038   1.51   hannken 	if ((error = bdevvp(vp->v_rdev, vpp)) != 0)
   1039   1.24  christos 		goto out;
   1040   1.51   hannken 	VOP_UNLOCK(vp);
   1041   1.51   hannken 	if ((error = vn_close(vp, FREAD | FWRITE, l->l_cred)) != 0) {
   1042   1.51   hannken 		vrele(*vpp);
   1043   1.51   hannken 		return error;
   1044   1.51   hannken 	}
   1045   1.51   hannken 	if ((error = VOP_OPEN(*vpp, FREAD | FWRITE, l->l_cred)) != 0) {
   1046   1.51   hannken 		vrele(*vpp);
   1047   1.51   hannken 		return error;
   1048   1.24  christos 	}
   1049   1.51   hannken 	mutex_enter((*vpp)->v_interlock);
   1050   1.51   hannken 	(*vpp)->v_writecount++;
   1051   1.51   hannken 	mutex_exit((*vpp)->v_interlock);
   1052   1.24  christos 
   1053   1.51   hannken 	IFDEBUG(DKDB_VNODE, vprint("dk_lookup: vnode info", *vpp));
   1054    1.1     elric 
   1055   1.24  christos 	return 0;
   1056   1.24  christos out:
   1057   1.41   hannken 	VOP_UNLOCK(vp);
   1058   1.35        ad 	(void) vn_close(vp, FREAD | FWRITE, l->l_cred);
   1059   1.24  christos 	return error;
   1060    1.1     elric }
   1061   1.49  pgoyette 
   1062   1.49  pgoyette MODULE(MODULE_CLASS_MISC, dk_subr, NULL);
   1063   1.49  pgoyette 
   1064   1.49  pgoyette static int
   1065   1.49  pgoyette dk_subr_modcmd(modcmd_t cmd, void *arg)
   1066   1.49  pgoyette {
   1067   1.49  pgoyette 	switch (cmd) {
   1068   1.49  pgoyette 	case MODULE_CMD_INIT:
   1069   1.49  pgoyette 	case MODULE_CMD_FINI:
   1070   1.49  pgoyette 		return 0;
   1071   1.49  pgoyette 	case MODULE_CMD_STAT:
   1072   1.49  pgoyette 	case MODULE_CMD_AUTOUNLOAD:
   1073   1.49  pgoyette 	default:
   1074   1.49  pgoyette 		return ENOTTY;
   1075   1.49  pgoyette 	}
   1076   1.49  pgoyette }
   1077