Home | History | Annotate | Line # | Download | only in dev
ccd.c revision 1.166.2.3
      1  1.166.2.3  pgoyette /*	$NetBSD: ccd.c,v 1.166.2.3 2017/04/26 02:53:10 pgoyette Exp $	*/
      2       1.11   thorpej 
      3       1.28   thorpej /*-
      4      1.133        ad  * Copyright (c) 1996, 1997, 1998, 1999, 2007, 2009 The NetBSD Foundation, Inc.
      5       1.11   thorpej  * All rights reserved.
      6       1.11   thorpej  *
      7       1.28   thorpej  * This code is derived from software contributed to The NetBSD Foundation
      8      1.133        ad  * by Jason R. Thorpe, and by Andrew Doran.
      9       1.28   thorpej  *
     10       1.11   thorpej  * Redistribution and use in source and binary forms, with or without
     11       1.11   thorpej  * modification, are permitted provided that the following conditions
     12       1.11   thorpej  * are met:
     13       1.11   thorpej  * 1. Redistributions of source code must retain the above copyright
     14       1.11   thorpej  *    notice, this list of conditions and the following disclaimer.
     15       1.11   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.11   thorpej  *    notice, this list of conditions and the following disclaimer in the
     17       1.11   thorpej  *    documentation and/or other materials provided with the distribution.
     18       1.11   thorpej  *
     19       1.28   thorpej  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.28   thorpej  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.28   thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.45       jtc  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.45       jtc  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.28   thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.28   thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.28   thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.28   thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.28   thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.28   thorpej  * POSSIBILITY OF SUCH DAMAGE.
     30       1.11   thorpej  */
     31        1.2       cgd 
     32        1.1   hpeyerl /*
     33      1.138     rmind  * Copyright (c) 1988 University of Utah.
     34        1.3   hpeyerl  * Copyright (c) 1990, 1993
     35        1.3   hpeyerl  *	The Regents of the University of California.  All rights reserved.
     36        1.1   hpeyerl  *
     37        1.1   hpeyerl  * This code is derived from software contributed to Berkeley by
     38        1.1   hpeyerl  * the Systems Programming Group of the University of Utah Computer
     39        1.1   hpeyerl  * Science Department.
     40        1.1   hpeyerl  *
     41        1.1   hpeyerl  * Redistribution and use in source and binary forms, with or without
     42        1.1   hpeyerl  * modification, are permitted provided that the following conditions
     43        1.1   hpeyerl  * are met:
     44        1.1   hpeyerl  * 1. Redistributions of source code must retain the above copyright
     45        1.1   hpeyerl  *    notice, this list of conditions and the following disclaimer.
     46        1.1   hpeyerl  * 2. Redistributions in binary form must reproduce the above copyright
     47        1.1   hpeyerl  *    notice, this list of conditions and the following disclaimer in the
     48        1.1   hpeyerl  *    documentation and/or other materials provided with the distribution.
     49       1.91       agc  * 3. Neither the name of the University nor the names of its contributors
     50       1.91       agc  *    may be used to endorse or promote products derived from this software
     51       1.91       agc  *    without specific prior written permission.
     52       1.91       agc  *
     53       1.91       agc  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     54       1.91       agc  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     55       1.91       agc  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     56       1.91       agc  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     57       1.91       agc  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     58       1.91       agc  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     59       1.91       agc  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     60       1.91       agc  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     61       1.91       agc  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     62       1.91       agc  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     63       1.91       agc  * SUCH DAMAGE.
     64       1.91       agc  *
     65       1.91       agc  * from: Utah $Hdr: cd.c 1.6 90/11/28$
     66       1.91       agc  *
     67       1.91       agc  *	@(#)cd.c	8.2 (Berkeley) 11/16/93
     68       1.91       agc  */
     69       1.91       agc 
     70       1.91       agc /*
     71        1.1   hpeyerl  * "Concatenated" disk driver.
     72       1.11   thorpej  *
     73      1.133        ad  * Notes on concurrency:
     74      1.133        ad  *
     75      1.133        ad  * => sc_dvlock serializes access to the device nodes, excluding block I/O.
     76      1.133        ad  *
     77      1.133        ad  * => sc_iolock serializes access to (sc_flags & CCDF_INITED), disk stats,
     78      1.133        ad  *    sc_stop, sc_bufq and b_resid from master buffers.
     79      1.133        ad  *
     80      1.133        ad  * => a combination of CCDF_INITED, sc_inflight, and sc_iolock is used to
     81      1.133        ad  *    serialize I/O and configuration changes.
     82      1.133        ad  *
     83      1.133        ad  * => the in-core disk label does not change while the device is open.
     84      1.133        ad  *
     85      1.133        ad  * On memory consumption: ccd fans out I/O requests and so needs to
     86      1.133        ad  * allocate memory.  If the system is desperately low on memory, we
     87      1.133        ad  * single thread I/O.
     88        1.1   hpeyerl  */
     89       1.74     lukem 
     90       1.74     lukem #include <sys/cdefs.h>
     91  1.166.2.3  pgoyette __KERNEL_RCSID(0, "$NetBSD: ccd.c,v 1.166.2.3 2017/04/26 02:53:10 pgoyette Exp $");
     92      1.152  sborrill 
     93      1.152  sborrill #if defined(_KERNEL_OPT)
     94      1.152  sborrill #include "opt_compat_netbsd.h"
     95      1.152  sborrill #endif
     96        1.1   hpeyerl 
     97        1.1   hpeyerl #include <sys/param.h>
     98        1.1   hpeyerl #include <sys/systm.h>
     99      1.133        ad #include <sys/kernel.h>
    100        1.3   hpeyerl #include <sys/proc.h>
    101        1.1   hpeyerl #include <sys/errno.h>
    102        1.1   hpeyerl #include <sys/buf.h>
    103      1.133        ad #include <sys/kmem.h>
    104       1.63   thorpej #include <sys/pool.h>
    105      1.140    jruoho #include <sys/module.h>
    106       1.11   thorpej #include <sys/namei.h>
    107        1.3   hpeyerl #include <sys/stat.h>
    108        1.3   hpeyerl #include <sys/ioctl.h>
    109        1.3   hpeyerl #include <sys/disklabel.h>
    110       1.11   thorpej #include <sys/device.h>
    111       1.11   thorpej #include <sys/disk.h>
    112       1.11   thorpej #include <sys/syslog.h>
    113        1.3   hpeyerl #include <sys/fcntl.h>
    114       1.11   thorpej #include <sys/vnode.h>
    115       1.31  christos #include <sys/conf.h>
    116      1.117        ad #include <sys/mutex.h>
    117       1.56   thorpej #include <sys/queue.h>
    118      1.110      elad #include <sys/kauth.h>
    119      1.133        ad #include <sys/kthread.h>
    120      1.133        ad #include <sys/bufq.h>
    121      1.144  christos #include <sys/sysctl.h>
    122        1.1   hpeyerl 
    123      1.135  uebayasi #include <uvm/uvm_extern.h>
    124      1.135  uebayasi 
    125        1.1   hpeyerl #include <dev/ccdvar.h>
    126      1.113  christos #include <dev/dkvar.h>
    127        1.1   hpeyerl 
    128      1.149   hannken #include <miscfs/specfs/specdev.h> /* for v_rdev */
    129      1.149   hannken 
    130      1.165  christos #include "ioconf.h"
    131      1.165  christos 
    132       1.11   thorpej #if defined(CCDDEBUG) && !defined(DEBUG)
    133       1.11   thorpej #define DEBUG
    134       1.11   thorpej #endif
    135       1.11   thorpej 
    136        1.1   hpeyerl #ifdef DEBUG
    137        1.3   hpeyerl #define CCDB_FOLLOW	0x01
    138        1.3   hpeyerl #define CCDB_INIT	0x02
    139        1.3   hpeyerl #define CCDB_IO		0x04
    140       1.11   thorpej #define CCDB_LABEL	0x08
    141       1.11   thorpej #define CCDB_VNODE	0x10
    142       1.24   thorpej int ccddebug = 0x00;
    143        1.1   hpeyerl #endif
    144        1.1   hpeyerl 
    145        1.6       cgd #define	ccdunit(x)	DISKUNIT(x)
    146        1.6       cgd 
    147        1.6       cgd struct ccdbuf {
    148        1.6       cgd 	struct buf	cb_buf;		/* new I/O buf */
    149        1.6       cgd 	struct buf	*cb_obp;	/* ptr. to original I/O buf */
    150       1.59   thorpej 	struct ccd_softc *cb_sc;	/* pointer to ccd softc */
    151        1.6       cgd 	int		cb_comp;	/* target component */
    152       1.56   thorpej 	SIMPLEQ_ENTRY(ccdbuf) cb_q;	/* fifo of component buffers */
    153       1.38   thorpej };
    154       1.24   thorpej 
    155       1.63   thorpej /* component buffer pool */
    156      1.133        ad static pool_cache_t ccd_cache;
    157       1.63   thorpej 
    158      1.133        ad #define	CCD_GETBUF()		pool_cache_get(ccd_cache, PR_WAITOK)
    159      1.133        ad #define	CCD_PUTBUF(cbp)		pool_cache_put(ccd_cache, cbp)
    160        1.1   hpeyerl 
    161       1.11   thorpej #define CCDLABELDEV(dev)	\
    162       1.11   thorpej 	(MAKEDISKDEV(major((dev)), ccdunit((dev)), RAW_PART))
    163        1.1   hpeyerl 
    164       1.11   thorpej /* called by main() at boot time */
    165      1.159  christos void	ccddetach(void);
    166       1.11   thorpej 
    167       1.11   thorpej /* called by biodone() at interrupt time */
    168       1.97   thorpej static void	ccdiodone(struct buf *);
    169       1.11   thorpej 
    170       1.97   thorpej static void	ccdinterleave(struct ccd_softc *);
    171       1.97   thorpej static int	ccdinit(struct ccd_softc *, char **, struct vnode **,
    172      1.107  christos 		    struct lwp *);
    173       1.97   thorpej static struct ccdbuf *ccdbuffer(struct ccd_softc *, struct buf *,
    174      1.118  christos 		    daddr_t, void *, long);
    175       1.97   thorpej static void	ccdgetdefaultlabel(struct ccd_softc *, struct disklabel *);
    176       1.97   thorpej static void	ccdgetdisklabel(dev_t);
    177       1.97   thorpej static void	ccdmakedisklabel(struct ccd_softc *);
    178      1.133        ad static void	ccdstart(struct ccd_softc *);
    179      1.133        ad static void	ccdthread(void *);
    180       1.97   thorpej 
    181       1.97   thorpej static dev_type_open(ccdopen);
    182       1.97   thorpej static dev_type_close(ccdclose);
    183       1.97   thorpej static dev_type_read(ccdread);
    184       1.97   thorpej static dev_type_write(ccdwrite);
    185       1.97   thorpej static dev_type_ioctl(ccdioctl);
    186       1.97   thorpej static dev_type_strategy(ccdstrategy);
    187       1.97   thorpej static dev_type_size(ccdsize);
    188       1.78   gehenna 
    189       1.78   gehenna const struct bdevsw ccd_bdevsw = {
    190      1.133        ad 	.d_open = ccdopen,
    191      1.133        ad 	.d_close = ccdclose,
    192      1.133        ad 	.d_strategy = ccdstrategy,
    193      1.133        ad 	.d_ioctl = ccdioctl,
    194      1.133        ad 	.d_dump = nodump,
    195      1.133        ad 	.d_psize = ccdsize,
    196      1.150  dholland 	.d_discard = nodiscard,
    197      1.133        ad 	.d_flag = D_DISK | D_MPSAFE
    198       1.78   gehenna };
    199       1.78   gehenna 
    200       1.78   gehenna const struct cdevsw ccd_cdevsw = {
    201      1.133        ad 	.d_open = ccdopen,
    202      1.133        ad 	.d_close = ccdclose,
    203      1.133        ad 	.d_read = ccdread,
    204      1.133        ad 	.d_write = ccdwrite,
    205      1.133        ad 	.d_ioctl = ccdioctl,
    206      1.133        ad 	.d_stop = nostop,
    207      1.133        ad 	.d_tty = notty,
    208      1.133        ad 	.d_poll = nopoll,
    209      1.133        ad 	.d_mmap = nommap,
    210      1.133        ad 	.d_kqfilter = nokqfilter,
    211      1.151  dholland 	.d_discard = nodiscard,
    212      1.133        ad 	.d_flag = D_DISK | D_MPSAFE
    213       1.78   gehenna };
    214        1.3   hpeyerl 
    215       1.11   thorpej #ifdef DEBUG
    216       1.97   thorpej static	void printiinfo(struct ccdiinfo *);
    217       1.11   thorpej #endif
    218       1.11   thorpej 
    219      1.144  christos static LIST_HEAD(, ccd_softc) ccds = LIST_HEAD_INITIALIZER(ccds);
    220      1.144  christos static kmutex_t ccd_lock;
    221      1.158  christos static size_t ccd_nactive = 0;
    222      1.144  christos 
    223      1.144  christos static struct ccd_softc *
    224      1.144  christos ccdcreate(int unit) {
    225      1.144  christos 	struct ccd_softc *sc = kmem_zalloc(sizeof(*sc), KM_SLEEP);
    226      1.144  christos 	if (sc == NULL) {
    227      1.144  christos #ifdef DIAGNOSTIC
    228      1.144  christos 		printf("%s: out of memory\n", __func__);
    229      1.144  christos #endif
    230      1.144  christos 		return NULL;
    231      1.144  christos 	}
    232      1.144  christos 	/* Initialize per-softc structures. */
    233      1.144  christos 	snprintf(sc->sc_xname, sizeof(sc->sc_xname), "ccd%d", unit);
    234      1.163  christos 	sc->sc_unit = unit;
    235      1.144  christos 	mutex_init(&sc->sc_dvlock, MUTEX_DEFAULT, IPL_NONE);
    236      1.144  christos 	sc->sc_iolock = mutex_obj_alloc(MUTEX_DEFAULT, IPL_NONE);
    237      1.144  christos 	cv_init(&sc->sc_stop, "ccdstop");
    238      1.144  christos 	cv_init(&sc->sc_push, "ccdthr");
    239      1.144  christos 	disk_init(&sc->sc_dkdev, sc->sc_xname, NULL); /* XXX */
    240      1.144  christos 	return sc;
    241      1.144  christos }
    242      1.144  christos 
    243      1.144  christos static void
    244      1.144  christos ccddestroy(struct ccd_softc *sc) {
    245      1.144  christos 	mutex_obj_free(sc->sc_iolock);
    246      1.148     joerg 	mutex_exit(&sc->sc_dvlock);
    247      1.144  christos 	mutex_destroy(&sc->sc_dvlock);
    248      1.144  christos 	cv_destroy(&sc->sc_stop);
    249      1.144  christos 	cv_destroy(&sc->sc_push);
    250      1.144  christos 	disk_destroy(&sc->sc_dkdev);
    251      1.144  christos 	kmem_free(sc, sizeof(*sc));
    252      1.144  christos }
    253      1.144  christos 
    254      1.144  christos static struct ccd_softc *
    255      1.158  christos ccdget(int unit, int make) {
    256      1.144  christos 	struct ccd_softc *sc;
    257      1.144  christos 	if (unit < 0) {
    258      1.144  christos #ifdef DIAGNOSTIC
    259      1.144  christos 		panic("%s: unit %d!", __func__, unit);
    260      1.144  christos #endif
    261      1.144  christos 		return NULL;
    262      1.144  christos 	}
    263      1.144  christos 	mutex_enter(&ccd_lock);
    264      1.144  christos 	LIST_FOREACH(sc, &ccds, sc_link) {
    265      1.144  christos 		if (sc->sc_unit == unit) {
    266      1.144  christos 			mutex_exit(&ccd_lock);
    267      1.144  christos 			return sc;
    268      1.144  christos 		}
    269      1.144  christos 	}
    270      1.144  christos 	mutex_exit(&ccd_lock);
    271      1.158  christos 	if (!make)
    272      1.158  christos 		return NULL;
    273      1.144  christos 	if ((sc = ccdcreate(unit)) == NULL)
    274      1.144  christos 		return NULL;
    275      1.144  christos 	mutex_enter(&ccd_lock);
    276      1.144  christos 	LIST_INSERT_HEAD(&ccds, sc, sc_link);
    277      1.158  christos 	ccd_nactive++;
    278      1.144  christos 	mutex_exit(&ccd_lock);
    279      1.144  christos 	return sc;
    280      1.144  christos }
    281      1.144  christos 
    282      1.164     skrll static void
    283      1.144  christos ccdput(struct ccd_softc *sc) {
    284      1.144  christos 	mutex_enter(&ccd_lock);
    285      1.144  christos 	LIST_REMOVE(sc, sc_link);
    286      1.158  christos 	ccd_nactive--;
    287      1.144  christos 	mutex_exit(&ccd_lock);
    288      1.144  christos 	ccddestroy(sc);
    289      1.144  christos }
    290        1.1   hpeyerl 
    291        1.3   hpeyerl /*
    292       1.11   thorpej  * Called by main() during pseudo-device attachment.  All we need
    293       1.11   thorpej  * to do is allocate enough space for devices to be configured later.
    294        1.1   hpeyerl  */
    295        1.1   hpeyerl void
    296       1.97   thorpej ccdattach(int num)
    297        1.3   hpeyerl {
    298      1.144  christos 	mutex_init(&ccd_lock, MUTEX_DEFAULT, IPL_NONE);
    299       1.57   thorpej 
    300       1.63   thorpej 	/* Initialize the component buffer pool. */
    301      1.133        ad 	ccd_cache = pool_cache_init(sizeof(struct ccdbuf), 0,
    302      1.133        ad 	    0, 0, "ccdbuf", NULL, IPL_BIO, NULL, NULL, NULL);
    303        1.1   hpeyerl }
    304        1.1   hpeyerl 
    305      1.159  christos void
    306      1.159  christos ccddetach(void)
    307      1.159  christos {
    308      1.159  christos 	pool_cache_destroy(ccd_cache);
    309      1.159  christos 	mutex_destroy(&ccd_lock);
    310      1.159  christos }
    311      1.159  christos 
    312       1.11   thorpej static int
    313       1.97   thorpej ccdinit(struct ccd_softc *cs, char **cpaths, struct vnode **vpp,
    314      1.107  christos     struct lwp *l)
    315        1.1   hpeyerl {
    316       1.68  augustss 	struct ccdcinfo *ci = NULL;
    317       1.68  augustss 	int ix;
    318       1.11   thorpej 	struct ccdgeom *ccg = &cs->sc_geom;
    319      1.111  christos 	char *tmppath;
    320       1.67     enami 	int error, path_alloced;
    321      1.143  christos 	uint64_t psize, minsize;
    322      1.143  christos 	unsigned secsize, maxsecsize;
    323      1.156   jnemeth 	struct disk_geom *dg;
    324        1.1   hpeyerl 
    325        1.1   hpeyerl #ifdef DEBUG
    326        1.3   hpeyerl 	if (ccddebug & (CCDB_FOLLOW|CCDB_INIT))
    327       1.59   thorpej 		printf("%s: ccdinit\n", cs->sc_xname);
    328        1.1   hpeyerl #endif
    329       1.11   thorpej 
    330       1.11   thorpej 	/* Allocate space for the component info. */
    331      1.133        ad 	cs->sc_cinfo = kmem_alloc(cs->sc_nccdisks * sizeof(*cs->sc_cinfo),
    332      1.133        ad 	    KM_SLEEP);
    333      1.133        ad 	tmppath = kmem_alloc(MAXPATHLEN, KM_SLEEP);
    334      1.111  christos 
    335       1.57   thorpej 	cs->sc_size = 0;
    336       1.57   thorpej 
    337        1.1   hpeyerl 	/*
    338        1.1   hpeyerl 	 * Verify that each component piece exists and record
    339        1.1   hpeyerl 	 * relevant information about it.
    340        1.1   hpeyerl 	 */
    341       1.11   thorpej 	maxsecsize = 0;
    342        1.1   hpeyerl 	minsize = 0;
    343       1.67     enami 	for (ix = 0, path_alloced = 0; ix < cs->sc_nccdisks; ix++) {
    344        1.1   hpeyerl 		ci = &cs->sc_cinfo[ix];
    345       1.57   thorpej 		ci->ci_vp = vpp[ix];
    346       1.11   thorpej 
    347       1.11   thorpej 		/*
    348       1.11   thorpej 		 * Copy in the pathname of the component.
    349       1.11   thorpej 		 */
    350      1.141     joerg 		memset(tmppath, 0, MAXPATHLEN);	/* sanity */
    351       1.29  christos 		error = copyinstr(cpaths[ix], tmppath,
    352       1.29  christos 		    MAXPATHLEN, &ci->ci_pathlen);
    353      1.133        ad 		if (ci->ci_pathlen == 0)
    354      1.133        ad 			error = EINVAL;
    355       1.29  christos 		if (error) {
    356       1.11   thorpej #ifdef DEBUG
    357       1.11   thorpej 			if (ccddebug & (CCDB_FOLLOW|CCDB_INIT))
    358       1.35  christos 				printf("%s: can't copy path, error = %d\n",
    359       1.23   thorpej 				    cs->sc_xname, error);
    360       1.11   thorpej #endif
    361       1.67     enami 			goto out;
    362       1.11   thorpej 		}
    363      1.133        ad 		ci->ci_path = kmem_alloc(ci->ci_pathlen, KM_SLEEP);
    364       1.72   thorpej 		memcpy(ci->ci_path, tmppath, ci->ci_pathlen);
    365       1.67     enami 		path_alloced++;
    366       1.11   thorpej 
    367       1.11   thorpej 		/*
    368       1.11   thorpej 		 * XXX: Cache the component's dev_t.
    369       1.11   thorpej 		 */
    370      1.149   hannken 		ci->ci_dev = vpp[ix]->v_rdev;
    371       1.11   thorpej 
    372        1.3   hpeyerl 		/*
    373       1.11   thorpej 		 * Get partition information for the component.
    374        1.3   hpeyerl 		 */
    375      1.143  christos 		error = getdisksize(vpp[ix], &psize, &secsize);
    376       1.29  christos 		if (error) {
    377       1.11   thorpej #ifdef DEBUG
    378       1.11   thorpej 			if (ccddebug & (CCDB_FOLLOW|CCDB_INIT))
    379      1.143  christos 				 printf("%s: %s: disksize failed, error = %d\n",
    380       1.23   thorpej 				     cs->sc_xname, ci->ci_path, error);
    381       1.11   thorpej #endif
    382       1.67     enami 			goto out;
    383       1.11   thorpej 		}
    384       1.69     enami 
    385       1.11   thorpej 		/*
    386       1.11   thorpej 		 * Calculate the size, truncating to an interleave
    387       1.11   thorpej 		 * boundary if necessary.
    388       1.11   thorpej 		 */
    389      1.143  christos 		maxsecsize = secsize > maxsecsize ? secsize : maxsecsize;
    390        1.1   hpeyerl 		if (cs->sc_ileave > 1)
    391      1.143  christos 			psize -= psize % cs->sc_ileave;
    392       1.11   thorpej 
    393      1.143  christos 		if (psize == 0) {
    394       1.11   thorpej #ifdef DEBUG
    395       1.11   thorpej 			if (ccddebug & (CCDB_FOLLOW|CCDB_INIT))
    396       1.35  christos 				printf("%s: %s: size == 0\n",
    397       1.23   thorpej 				    cs->sc_xname, ci->ci_path);
    398       1.11   thorpej #endif
    399       1.67     enami 			error = ENODEV;
    400       1.67     enami 			goto out;
    401        1.3   hpeyerl 		}
    402       1.11   thorpej 
    403      1.143  christos 		if (minsize == 0 || psize < minsize)
    404      1.143  christos 			minsize = psize;
    405      1.143  christos 		ci->ci_size = psize;
    406      1.143  christos 		cs->sc_size += psize;
    407        1.1   hpeyerl 	}
    408       1.11   thorpej 
    409       1.11   thorpej 	/*
    410       1.11   thorpej 	 * Don't allow the interleave to be smaller than
    411       1.11   thorpej 	 * the biggest component sector.
    412       1.11   thorpej 	 */
    413       1.11   thorpej 	if ((cs->sc_ileave > 0) &&
    414       1.11   thorpej 	    (cs->sc_ileave < (maxsecsize / DEV_BSIZE))) {
    415       1.11   thorpej #ifdef DEBUG
    416       1.11   thorpej 		if (ccddebug & (CCDB_FOLLOW|CCDB_INIT))
    417       1.35  christos 			printf("%s: interleave must be at least %d\n",
    418       1.23   thorpej 			    cs->sc_xname, (maxsecsize / DEV_BSIZE));
    419       1.11   thorpej #endif
    420       1.67     enami 		error = EINVAL;
    421       1.67     enami 		goto out;
    422       1.11   thorpej 	}
    423       1.11   thorpej 
    424        1.1   hpeyerl 	/*
    425        1.1   hpeyerl 	 * If uniform interleave is desired set all sizes to that of
    426        1.1   hpeyerl 	 * the smallest component.
    427        1.1   hpeyerl 	 */
    428       1.57   thorpej 	if (cs->sc_flags & CCDF_UNIFORM) {
    429        1.1   hpeyerl 		for (ci = cs->sc_cinfo;
    430        1.1   hpeyerl 		     ci < &cs->sc_cinfo[cs->sc_nccdisks]; ci++)
    431        1.1   hpeyerl 			ci->ci_size = minsize;
    432       1.24   thorpej 
    433       1.53   thorpej 		cs->sc_size = cs->sc_nccdisks * minsize;
    434        1.1   hpeyerl 	}
    435       1.11   thorpej 
    436       1.11   thorpej 	/*
    437       1.11   thorpej 	 * Construct the interleave table.
    438       1.11   thorpej 	 */
    439       1.57   thorpej 	ccdinterleave(cs);
    440       1.11   thorpej 
    441        1.1   hpeyerl 	/*
    442       1.11   thorpej 	 * Create pseudo-geometry based on 1MB cylinders.  It's
    443       1.11   thorpej 	 * pretty close.
    444        1.1   hpeyerl 	 */
    445       1.11   thorpej 	ccg->ccg_secsize = DEV_BSIZE;
    446       1.19   thorpej 	ccg->ccg_ntracks = 1;
    447       1.11   thorpej 	ccg->ccg_nsectors = 1024 * (1024 / ccg->ccg_secsize);
    448       1.11   thorpej 	ccg->ccg_ncylinders = cs->sc_size / ccg->ccg_nsectors;
    449      1.156   jnemeth 
    450      1.156   jnemeth         dg = &cs->sc_dkdev.dk_geom;
    451      1.156   jnemeth         memset(dg, 0, sizeof(*dg));
    452      1.158  christos 	dg->dg_secperunit = cs->sc_size;
    453      1.158  christos 	dg->dg_secsize = ccg->ccg_secsize;
    454      1.158  christos 	dg->dg_nsectors = ccg->ccg_nsectors;
    455      1.158  christos 	dg->dg_ntracks = ccg->ccg_ntracks;
    456      1.158  christos 	dg->dg_ncylinders = ccg->ccg_ncylinders;
    457      1.164     skrll 
    458      1.152  sborrill 	if (cs->sc_ileave > 0)
    459      1.152  sborrill 	        aprint_normal("%s: Interleaving %d component%s "
    460      1.152  sborrill 	            "(%d block interleave)\n", cs->sc_xname,
    461      1.152  sborrill         	    cs->sc_nccdisks, (cs->sc_nccdisks != 0 ? "s" : ""),
    462      1.152  sborrill         	    cs->sc_ileave);
    463      1.152  sborrill 	else
    464      1.152  sborrill 	        aprint_normal("%s: Concatenating %d component%s\n",
    465      1.152  sborrill 	            cs->sc_xname,
    466      1.152  sborrill         	    cs->sc_nccdisks, (cs->sc_nccdisks != 0 ? "s" : ""));
    467      1.152  sborrill 	for (ix = 0; ix < cs->sc_nccdisks; ix++) {
    468      1.152  sborrill 		ci = &cs->sc_cinfo[ix];
    469      1.152  sborrill 		aprint_normal("%s: %s (%ju blocks)\n", cs->sc_xname,
    470      1.152  sborrill 		    ci->ci_path, (uintmax_t)ci->ci_size);
    471      1.152  sborrill 	}
    472      1.152  sborrill 	aprint_normal("%s: total %ju blocks\n", cs->sc_xname, cs->sc_size);
    473       1.11   thorpej 
    474      1.133        ad 	/*
    475      1.133        ad 	 * Create thread to handle deferred I/O.
    476      1.133        ad 	 */
    477      1.133        ad 	cs->sc_zap = false;
    478      1.133        ad 	error = kthread_create(PRI_BIO, KTHREAD_MPSAFE, NULL, ccdthread,
    479      1.133        ad 	    cs, &cs->sc_thread, "%s", cs->sc_xname);
    480      1.133        ad 	if (error) {
    481      1.133        ad 		printf("ccdinit: can't create thread: %d\n", error);
    482      1.133        ad 		goto out;
    483      1.133        ad 	}
    484      1.133        ad 
    485      1.133        ad 	/*
    486      1.133        ad 	 * Only now that everything is set up can we enable the device.
    487      1.133        ad 	 */
    488      1.133        ad 	mutex_enter(cs->sc_iolock);
    489       1.11   thorpej 	cs->sc_flags |= CCDF_INITED;
    490      1.133        ad 	mutex_exit(cs->sc_iolock);
    491      1.133        ad 	kmem_free(tmppath, MAXPATHLEN);
    492       1.11   thorpej 	return (0);
    493       1.67     enami 
    494       1.67     enami  out:
    495      1.133        ad 	for (ix = 0; ix < path_alloced; ix++) {
    496      1.133        ad 		kmem_free(cs->sc_cinfo[ix].ci_path,
    497      1.133        ad 		    cs->sc_cinfo[ix].ci_pathlen);
    498      1.133        ad 	}
    499      1.133        ad 	kmem_free(cs->sc_cinfo, cs->sc_nccdisks * sizeof(struct ccdcinfo));
    500      1.133        ad 	kmem_free(tmppath, MAXPATHLEN);
    501       1.67     enami 	return (error);
    502        1.1   hpeyerl }
    503        1.1   hpeyerl 
    504       1.11   thorpej static void
    505       1.97   thorpej ccdinterleave(struct ccd_softc *cs)
    506        1.1   hpeyerl {
    507       1.68  augustss 	struct ccdcinfo *ci, *smallci;
    508       1.68  augustss 	struct ccdiinfo *ii;
    509       1.68  augustss 	daddr_t bn, lbn;
    510       1.68  augustss 	int ix;
    511        1.1   hpeyerl 	u_long size;
    512        1.1   hpeyerl 
    513        1.1   hpeyerl #ifdef DEBUG
    514        1.3   hpeyerl 	if (ccddebug & CCDB_INIT)
    515       1.35  christos 		printf("ccdinterleave(%p): ileave %d\n", cs, cs->sc_ileave);
    516        1.1   hpeyerl #endif
    517        1.1   hpeyerl 	/*
    518        1.1   hpeyerl 	 * Allocate an interleave table.
    519        1.1   hpeyerl 	 * Chances are this is too big, but we don't care.
    520        1.1   hpeyerl 	 */
    521        1.1   hpeyerl 	size = (cs->sc_nccdisks + 1) * sizeof(struct ccdiinfo);
    522      1.133        ad 	cs->sc_itable = kmem_zalloc(size, KM_SLEEP);
    523       1.11   thorpej 
    524        1.1   hpeyerl 	/*
    525        1.1   hpeyerl 	 * Trivial case: no interleave (actually interleave of disk size).
    526       1.11   thorpej 	 * Each table entry represents a single component in its entirety.
    527        1.1   hpeyerl 	 */
    528        1.1   hpeyerl 	if (cs->sc_ileave == 0) {
    529        1.1   hpeyerl 		bn = 0;
    530        1.1   hpeyerl 		ii = cs->sc_itable;
    531       1.11   thorpej 
    532        1.1   hpeyerl 		for (ix = 0; ix < cs->sc_nccdisks; ix++) {
    533       1.19   thorpej 			/* Allocate space for ii_index. */
    534      1.133        ad 			ii->ii_indexsz = sizeof(int);
    535      1.133        ad 			ii->ii_index = kmem_alloc(ii->ii_indexsz, KM_SLEEP);
    536        1.1   hpeyerl 			ii->ii_ndisk = 1;
    537        1.1   hpeyerl 			ii->ii_startblk = bn;
    538        1.1   hpeyerl 			ii->ii_startoff = 0;
    539        1.1   hpeyerl 			ii->ii_index[0] = ix;
    540        1.1   hpeyerl 			bn += cs->sc_cinfo[ix].ci_size;
    541        1.1   hpeyerl 			ii++;
    542        1.1   hpeyerl 		}
    543        1.1   hpeyerl 		ii->ii_ndisk = 0;
    544        1.1   hpeyerl #ifdef DEBUG
    545        1.3   hpeyerl 		if (ccddebug & CCDB_INIT)
    546        1.1   hpeyerl 			printiinfo(cs->sc_itable);
    547        1.1   hpeyerl #endif
    548       1.11   thorpej 		return;
    549        1.1   hpeyerl 	}
    550       1.11   thorpej 
    551        1.1   hpeyerl 	/*
    552        1.1   hpeyerl 	 * The following isn't fast or pretty; it doesn't have to be.
    553        1.1   hpeyerl 	 */
    554        1.1   hpeyerl 	size = 0;
    555        1.1   hpeyerl 	bn = lbn = 0;
    556        1.1   hpeyerl 	for (ii = cs->sc_itable; ; ii++) {
    557       1.11   thorpej 		/* Allocate space for ii_index. */
    558      1.133        ad 		ii->ii_indexsz = sizeof(int) * cs->sc_nccdisks;
    559      1.133        ad 		ii->ii_index = kmem_alloc(ii->ii_indexsz, KM_SLEEP);
    560       1.11   thorpej 
    561        1.1   hpeyerl 		/*
    562        1.1   hpeyerl 		 * Locate the smallest of the remaining components
    563        1.1   hpeyerl 		 */
    564        1.1   hpeyerl 		smallci = NULL;
    565        1.1   hpeyerl 		for (ci = cs->sc_cinfo;
    566        1.1   hpeyerl 		     ci < &cs->sc_cinfo[cs->sc_nccdisks]; ci++)
    567        1.1   hpeyerl 			if (ci->ci_size > size &&
    568        1.1   hpeyerl 			    (smallci == NULL ||
    569        1.1   hpeyerl 			     ci->ci_size < smallci->ci_size))
    570        1.1   hpeyerl 				smallci = ci;
    571       1.11   thorpej 
    572        1.1   hpeyerl 		/*
    573        1.1   hpeyerl 		 * Nobody left, all done
    574        1.1   hpeyerl 		 */
    575        1.1   hpeyerl 		if (smallci == NULL) {
    576        1.1   hpeyerl 			ii->ii_ndisk = 0;
    577        1.1   hpeyerl 			break;
    578        1.1   hpeyerl 		}
    579       1.11   thorpej 
    580        1.1   hpeyerl 		/*
    581        1.1   hpeyerl 		 * Record starting logical block and component offset
    582        1.1   hpeyerl 		 */
    583        1.1   hpeyerl 		ii->ii_startblk = bn / cs->sc_ileave;
    584        1.1   hpeyerl 		ii->ii_startoff = lbn;
    585       1.11   thorpej 
    586        1.1   hpeyerl 		/*
    587        1.1   hpeyerl 		 * Determine how many disks take part in this interleave
    588        1.1   hpeyerl 		 * and record their indices.
    589        1.1   hpeyerl 		 */
    590        1.1   hpeyerl 		ix = 0;
    591        1.1   hpeyerl 		for (ci = cs->sc_cinfo;
    592        1.1   hpeyerl 		     ci < &cs->sc_cinfo[cs->sc_nccdisks]; ci++)
    593        1.1   hpeyerl 			if (ci->ci_size >= smallci->ci_size)
    594        1.1   hpeyerl 				ii->ii_index[ix++] = ci - cs->sc_cinfo;
    595        1.1   hpeyerl 		ii->ii_ndisk = ix;
    596        1.1   hpeyerl 		bn += ix * (smallci->ci_size - size);
    597        1.1   hpeyerl 		lbn = smallci->ci_size / cs->sc_ileave;
    598        1.1   hpeyerl 		size = smallci->ci_size;
    599        1.1   hpeyerl 	}
    600        1.1   hpeyerl #ifdef DEBUG
    601        1.3   hpeyerl 	if (ccddebug & CCDB_INIT)
    602        1.1   hpeyerl 		printiinfo(cs->sc_itable);
    603        1.1   hpeyerl #endif
    604        1.1   hpeyerl }
    605        1.1   hpeyerl 
    606       1.11   thorpej /* ARGSUSED */
    607       1.97   thorpej static int
    608      1.116  christos ccdopen(dev_t dev, int flags, int fmt, struct lwp *l)
    609        1.1   hpeyerl {
    610        1.1   hpeyerl 	int unit = ccdunit(dev);
    611       1.11   thorpej 	struct ccd_softc *cs;
    612       1.11   thorpej 	struct disklabel *lp;
    613       1.15   thorpej 	int error = 0, part, pmask;
    614        1.1   hpeyerl 
    615        1.1   hpeyerl #ifdef DEBUG
    616        1.3   hpeyerl 	if (ccddebug & CCDB_FOLLOW)
    617      1.131    cegger 		printf("ccdopen(0x%"PRIx64", 0x%x)\n", dev, flags);
    618        1.1   hpeyerl #endif
    619      1.158  christos 	if ((cs = ccdget(unit, 1)) == NULL)
    620      1.144  christos 		return ENXIO;
    621       1.15   thorpej 
    622      1.133        ad 	mutex_enter(&cs->sc_dvlock);
    623       1.15   thorpej 
    624       1.23   thorpej 	lp = cs->sc_dkdev.dk_label;
    625       1.11   thorpej 
    626       1.11   thorpej 	part = DISKPART(dev);
    627       1.11   thorpej 	pmask = (1 << part);
    628       1.11   thorpej 
    629       1.15   thorpej 	/*
    630       1.15   thorpej 	 * If we're initialized, check to see if there are any other
    631       1.15   thorpej 	 * open partitions.  If not, then it's safe to update
    632       1.87   thorpej 	 * the in-core disklabel.  Only read the disklabel if it is
    633       1.87   thorpej 	 * not already valid.
    634       1.15   thorpej 	 */
    635       1.87   thorpej 	if ((cs->sc_flags & (CCDF_INITED|CCDF_VLABEL)) == CCDF_INITED &&
    636       1.87   thorpej 	    cs->sc_dkdev.dk_openmask == 0)
    637       1.15   thorpej 		ccdgetdisklabel(dev);
    638       1.15   thorpej 
    639       1.11   thorpej 	/* Check that the partition exists. */
    640       1.27   thorpej 	if (part != RAW_PART) {
    641       1.27   thorpej 		if (((cs->sc_flags & CCDF_INITED) == 0) ||
    642       1.37   thorpej 		    ((part >= lp->d_npartitions) ||
    643       1.27   thorpej 		     (lp->d_partitions[part].p_fstype == FS_UNUSED))) {
    644       1.27   thorpej 			error = ENXIO;
    645       1.27   thorpej 			goto done;
    646       1.27   thorpej 		}
    647       1.15   thorpej 	}
    648       1.11   thorpej 
    649       1.11   thorpej 	/* Prevent our unit from being unconfigured while open. */
    650       1.11   thorpej 	switch (fmt) {
    651       1.11   thorpej 	case S_IFCHR:
    652       1.11   thorpej 		cs->sc_dkdev.dk_copenmask |= pmask;
    653       1.11   thorpej 		break;
    654       1.11   thorpej 
    655       1.11   thorpej 	case S_IFBLK:
    656       1.11   thorpej 		cs->sc_dkdev.dk_bopenmask |= pmask;
    657       1.11   thorpej 		break;
    658       1.11   thorpej 	}
    659       1.11   thorpej 	cs->sc_dkdev.dk_openmask =
    660       1.11   thorpej 	    cs->sc_dkdev.dk_copenmask | cs->sc_dkdev.dk_bopenmask;
    661       1.11   thorpej 
    662       1.15   thorpej  done:
    663      1.133        ad 	mutex_exit(&cs->sc_dvlock);
    664       1.33   thorpej 	return (error);
    665        1.7       cgd }
    666        1.7       cgd 
    667       1.11   thorpej /* ARGSUSED */
    668       1.97   thorpej static int
    669      1.116  christos ccdclose(dev_t dev, int flags, int fmt, struct lwp *l)
    670        1.7       cgd {
    671       1.11   thorpej 	int unit = ccdunit(dev);
    672       1.11   thorpej 	struct ccd_softc *cs;
    673      1.117        ad 	int part;
    674       1.11   thorpej 
    675        1.7       cgd #ifdef DEBUG
    676        1.7       cgd 	if (ccddebug & CCDB_FOLLOW)
    677      1.131    cegger 		printf("ccdclose(0x%"PRIx64", 0x%x)\n", dev, flags);
    678        1.7       cgd #endif
    679       1.11   thorpej 
    680      1.158  christos 	if ((cs = ccdget(unit, 0)) == NULL)
    681      1.144  christos 		return ENXIO;
    682       1.15   thorpej 
    683      1.133        ad 	mutex_enter(&cs->sc_dvlock);
    684       1.15   thorpej 
    685       1.11   thorpej 	part = DISKPART(dev);
    686       1.11   thorpej 
    687       1.11   thorpej 	/* ...that much closer to allowing unconfiguration... */
    688       1.11   thorpej 	switch (fmt) {
    689       1.11   thorpej 	case S_IFCHR:
    690       1.11   thorpej 		cs->sc_dkdev.dk_copenmask &= ~(1 << part);
    691       1.11   thorpej 		break;
    692       1.11   thorpej 
    693       1.11   thorpej 	case S_IFBLK:
    694       1.11   thorpej 		cs->sc_dkdev.dk_bopenmask &= ~(1 << part);
    695       1.11   thorpej 		break;
    696       1.11   thorpej 	}
    697       1.11   thorpej 	cs->sc_dkdev.dk_openmask =
    698       1.11   thorpej 	    cs->sc_dkdev.dk_copenmask | cs->sc_dkdev.dk_bopenmask;
    699       1.11   thorpej 
    700       1.87   thorpej 	if (cs->sc_dkdev.dk_openmask == 0) {
    701       1.87   thorpej 		if ((cs->sc_flags & CCDF_KLABEL) == 0)
    702       1.87   thorpej 			cs->sc_flags &= ~CCDF_VLABEL;
    703       1.87   thorpej 	}
    704       1.87   thorpej 
    705      1.133        ad 	mutex_exit(&cs->sc_dvlock);
    706        1.7       cgd 	return (0);
    707        1.1   hpeyerl }
    708        1.1   hpeyerl 
    709      1.133        ad static bool
    710      1.133        ad ccdbackoff(struct ccd_softc *cs)
    711      1.133        ad {
    712      1.133        ad 
    713      1.133        ad 	/* XXX Arbitrary, should be a uvm call. */
    714      1.133        ad 	return uvmexp.free < (uvmexp.freemin >> 1) &&
    715      1.133        ad 	    disk_isbusy(&cs->sc_dkdev);
    716      1.133        ad }
    717      1.133        ad 
    718      1.133        ad static void
    719      1.133        ad ccdthread(void *cookie)
    720      1.133        ad {
    721      1.133        ad 	struct ccd_softc *cs;
    722      1.133        ad 
    723      1.133        ad 	cs = cookie;
    724      1.133        ad 
    725      1.133        ad #ifdef DEBUG
    726      1.133        ad  	if (ccddebug & CCDB_FOLLOW)
    727      1.133        ad  		printf("ccdthread: hello\n");
    728      1.133        ad #endif
    729      1.133        ad 
    730      1.133        ad 	mutex_enter(cs->sc_iolock);
    731      1.133        ad 	while (__predict_true(!cs->sc_zap)) {
    732      1.133        ad 		if (bufq_peek(cs->sc_bufq) == NULL) {
    733      1.133        ad 			/* Nothing to do. */
    734      1.133        ad 			cv_wait(&cs->sc_push, cs->sc_iolock);
    735      1.133        ad 			continue;
    736      1.133        ad 		}
    737      1.133        ad 		if (ccdbackoff(cs)) {
    738      1.133        ad 			/* Wait for memory to become available. */
    739      1.133        ad 			(void)cv_timedwait(&cs->sc_push, cs->sc_iolock, 1);
    740      1.133        ad 			continue;
    741      1.133        ad 		}
    742      1.133        ad #ifdef DEBUG
    743      1.133        ad  		if (ccddebug & CCDB_FOLLOW)
    744      1.133        ad  			printf("ccdthread: dispatching I/O\n");
    745      1.133        ad #endif
    746      1.133        ad 		ccdstart(cs);
    747      1.133        ad 		mutex_enter(cs->sc_iolock);
    748      1.133        ad 	}
    749      1.133        ad 	cs->sc_thread = NULL;
    750      1.133        ad 	mutex_exit(cs->sc_iolock);
    751      1.133        ad #ifdef DEBUG
    752      1.133        ad  	if (ccddebug & CCDB_FOLLOW)
    753      1.133        ad  		printf("ccdthread: goodbye\n");
    754      1.133        ad #endif
    755      1.133        ad 	kthread_exit(0);
    756      1.133        ad }
    757      1.133        ad 
    758       1.97   thorpej static void
    759       1.97   thorpej ccdstrategy(struct buf *bp)
    760        1.1   hpeyerl {
    761       1.68  augustss 	int unit = ccdunit(bp->b_dev);
    762      1.144  christos 	struct ccd_softc *cs;
    763      1.158  christos 	if ((cs = ccdget(unit, 0)) == NULL)
    764      1.144  christos 		return;
    765      1.133        ad 
    766      1.133        ad 	/* Must be open or reading label. */
    767      1.133        ad 	KASSERT(cs->sc_dkdev.dk_openmask != 0 ||
    768      1.133        ad 	    (cs->sc_flags & CCDF_RLABEL) != 0);
    769      1.133        ad 
    770      1.133        ad 	mutex_enter(cs->sc_iolock);
    771      1.133        ad 	/* Synchronize with device init/uninit. */
    772      1.133        ad 	if (__predict_false((cs->sc_flags & CCDF_INITED) == 0)) {
    773      1.133        ad 		mutex_exit(cs->sc_iolock);
    774      1.133        ad #ifdef DEBUG
    775      1.133        ad  		if (ccddebug & CCDB_FOLLOW)
    776      1.133        ad  			printf("ccdstrategy: unit %d: not inited\n", unit);
    777      1.133        ad #endif
    778      1.133        ad  		bp->b_error = ENXIO;
    779      1.133        ad  		bp->b_resid = bp->b_bcount;
    780      1.133        ad  		biodone(bp);
    781      1.133        ad 		return;
    782      1.133        ad 	}
    783      1.133        ad 
    784      1.133        ad 	/* Defer to thread if system is low on memory. */
    785      1.133        ad 	bufq_put(cs->sc_bufq, bp);
    786      1.133        ad 	if (__predict_false(ccdbackoff(cs))) {
    787      1.133        ad 		mutex_exit(cs->sc_iolock);
    788      1.133        ad #ifdef DEBUG
    789      1.133        ad  		if (ccddebug & CCDB_FOLLOW)
    790      1.133        ad  			printf("ccdstrategy: holding off on I/O\n");
    791      1.133        ad #endif
    792      1.133        ad 		return;
    793      1.133        ad 	}
    794      1.133        ad 	ccdstart(cs);
    795      1.133        ad }
    796      1.133        ad 
    797      1.133        ad static void
    798      1.133        ad ccdstart(struct ccd_softc *cs)
    799      1.133        ad {
    800       1.88   thorpej 	daddr_t blkno;
    801       1.11   thorpej 	int wlabel;
    802       1.15   thorpej 	struct disklabel *lp;
    803      1.133        ad 	long bcount, rcount;
    804      1.133        ad 	struct ccdbuf *cbp;
    805      1.133        ad 	char *addr;
    806      1.133        ad 	daddr_t bn;
    807      1.133        ad 	vnode_t *vp;
    808      1.133        ad 	buf_t *bp;
    809      1.133        ad 
    810      1.133        ad 	KASSERT(mutex_owned(cs->sc_iolock));
    811      1.133        ad 
    812      1.133        ad 	bp = bufq_get(cs->sc_bufq);
    813      1.133        ad 	KASSERT(bp != NULL);
    814        1.1   hpeyerl 
    815  1.166.2.2  pgoyette 	disk_busy(&cs->sc_dkdev);
    816  1.166.2.2  pgoyette 
    817        1.1   hpeyerl #ifdef DEBUG
    818        1.3   hpeyerl 	if (ccddebug & CCDB_FOLLOW)
    819      1.133        ad 		printf("ccdstart(%s, %p)\n", cs->sc_xname, bp);
    820       1.59   thorpej #endif
    821       1.11   thorpej 
    822       1.11   thorpej 	/* If it's a nil transfer, wake up the top half now. */
    823       1.11   thorpej 	if (bp->b_bcount == 0)
    824       1.11   thorpej 		goto done;
    825       1.11   thorpej 
    826       1.23   thorpej 	lp = cs->sc_dkdev.dk_label;
    827       1.15   thorpej 
    828       1.11   thorpej 	/*
    829       1.17   thorpej 	 * Do bounds checking and adjust transfer.  If there's an
    830       1.88   thorpej 	 * error, the bounds check will flag that for us.  Convert
    831       1.88   thorpej 	 * the partition relative block number to an absolute.
    832       1.11   thorpej 	 */
    833       1.88   thorpej 	blkno = bp->b_blkno;
    834       1.11   thorpej 	wlabel = cs->sc_flags & (CCDF_WLABEL|CCDF_LABELLING);
    835       1.88   thorpej 	if (DISKPART(bp->b_dev) != RAW_PART) {
    836       1.86   thorpej 		if (bounds_check_with_label(&cs->sc_dkdev, bp, wlabel) <= 0)
    837        1.1   hpeyerl 			goto done;
    838       1.88   thorpej 		blkno += lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
    839       1.88   thorpej 	}
    840      1.133        ad 	mutex_exit(cs->sc_iolock);
    841       1.88   thorpej 	bp->b_rawblkno = blkno;
    842       1.11   thorpej 
    843      1.133        ad 	/* Allocate the component buffers and start I/O! */
    844      1.133        ad 	bp->b_resid = bp->b_bcount;
    845      1.133        ad 	bn = bp->b_rawblkno;
    846      1.133        ad 	addr = bp->b_data;
    847      1.133        ad 	for (bcount = bp->b_bcount; bcount > 0; bcount -= rcount) {
    848      1.133        ad 		cbp = ccdbuffer(cs, bp, bn, addr, bcount);
    849      1.133        ad 		rcount = cbp->cb_buf.b_bcount;
    850      1.133        ad 		bn += btodb(rcount);
    851      1.133        ad 		addr += rcount;
    852      1.133        ad 		vp = cbp->cb_buf.b_vp;
    853      1.133        ad 		if ((cbp->cb_buf.b_flags & B_READ) == 0) {
    854      1.139     rmind 			mutex_enter(vp->v_interlock);
    855      1.133        ad 			vp->v_numoutput++;
    856      1.139     rmind 			mutex_exit(vp->v_interlock);
    857      1.133        ad 		}
    858      1.133        ad 		(void)VOP_STRATEGY(vp, &cbp->cb_buf);
    859      1.133        ad 	}
    860        1.1   hpeyerl 	return;
    861       1.88   thorpej 
    862       1.88   thorpej  done:
    863      1.133        ad 	disk_unbusy(&cs->sc_dkdev, 0, 0);
    864      1.133        ad 	cv_broadcast(&cs->sc_stop);
    865      1.133        ad 	cv_broadcast(&cs->sc_push);
    866      1.133        ad 	mutex_exit(cs->sc_iolock);
    867       1.88   thorpej 	bp->b_resid = bp->b_bcount;
    868        1.1   hpeyerl 	biodone(bp);
    869        1.1   hpeyerl }
    870        1.1   hpeyerl 
    871        1.1   hpeyerl /*
    872        1.1   hpeyerl  * Build a component buffer header.
    873        1.1   hpeyerl  */
    874       1.55   thorpej static struct ccdbuf *
    875      1.118  christos ccdbuffer(struct ccd_softc *cs, struct buf *bp, daddr_t bn, void *addr,
    876       1.97   thorpej     long bcount)
    877        1.1   hpeyerl {
    878       1.68  augustss 	struct ccdcinfo *ci;
    879       1.68  augustss 	struct ccdbuf *cbp;
    880       1.68  augustss 	daddr_t cbn, cboff;
    881       1.68  augustss 	u_int64_t cbc;
    882       1.36   thorpej 	int ccdisk;
    883        1.1   hpeyerl 
    884        1.1   hpeyerl #ifdef DEBUG
    885        1.3   hpeyerl 	if (ccddebug & CCDB_IO)
    886       1.81    kleink 		printf("ccdbuffer(%p, %p, %" PRId64 ", %p, %ld)\n",
    887        1.1   hpeyerl 		       cs, bp, bn, addr, bcount);
    888        1.1   hpeyerl #endif
    889        1.1   hpeyerl 	/*
    890        1.1   hpeyerl 	 * Determine which component bn falls in.
    891        1.1   hpeyerl 	 */
    892        1.1   hpeyerl 	cbn = bn;
    893        1.1   hpeyerl 	cboff = 0;
    894       1.11   thorpej 
    895        1.1   hpeyerl 	/*
    896        1.1   hpeyerl 	 * Serially concatenated
    897        1.1   hpeyerl 	 */
    898        1.1   hpeyerl 	if (cs->sc_ileave == 0) {
    899       1.68  augustss 		daddr_t sblk;
    900        1.1   hpeyerl 
    901        1.1   hpeyerl 		sblk = 0;
    902       1.36   thorpej 		for (ccdisk = 0, ci = &cs->sc_cinfo[ccdisk];
    903       1.36   thorpej 		    cbn >= sblk + ci->ci_size;
    904       1.36   thorpej 		    ccdisk++, ci = &cs->sc_cinfo[ccdisk])
    905        1.1   hpeyerl 			sblk += ci->ci_size;
    906        1.1   hpeyerl 		cbn -= sblk;
    907        1.1   hpeyerl 	}
    908        1.1   hpeyerl 	/*
    909        1.1   hpeyerl 	 * Interleaved
    910        1.1   hpeyerl 	 */
    911        1.1   hpeyerl 	else {
    912       1.68  augustss 		struct ccdiinfo *ii;
    913       1.36   thorpej 		int off;
    914        1.1   hpeyerl 
    915        1.1   hpeyerl 		cboff = cbn % cs->sc_ileave;
    916        1.1   hpeyerl 		cbn /= cs->sc_ileave;
    917        1.1   hpeyerl 		for (ii = cs->sc_itable; ii->ii_ndisk; ii++)
    918        1.1   hpeyerl 			if (ii->ii_startblk > cbn)
    919        1.1   hpeyerl 				break;
    920        1.1   hpeyerl 		ii--;
    921        1.1   hpeyerl 		off = cbn - ii->ii_startblk;
    922        1.1   hpeyerl 		if (ii->ii_ndisk == 1) {
    923        1.1   hpeyerl 			ccdisk = ii->ii_index[0];
    924        1.1   hpeyerl 			cbn = ii->ii_startoff + off;
    925        1.1   hpeyerl 		} else {
    926       1.53   thorpej 			ccdisk = ii->ii_index[off % ii->ii_ndisk];
    927       1.53   thorpej 			cbn = ii->ii_startoff + off / ii->ii_ndisk;
    928        1.1   hpeyerl 		}
    929        1.1   hpeyerl 		cbn *= cs->sc_ileave;
    930        1.1   hpeyerl 		ci = &cs->sc_cinfo[ccdisk];
    931        1.1   hpeyerl 	}
    932       1.11   thorpej 
    933        1.1   hpeyerl 	/*
    934        1.1   hpeyerl 	 * Fill in the component buf structure.
    935        1.1   hpeyerl 	 */
    936       1.63   thorpej 	cbp = CCD_GETBUF();
    937      1.133        ad 	KASSERT(cbp != NULL);
    938      1.126        ad 	buf_init(&cbp->cb_buf);
    939      1.126        ad 	cbp->cb_buf.b_flags = bp->b_flags;
    940      1.126        ad 	cbp->cb_buf.b_oflags = bp->b_oflags;
    941      1.126        ad 	cbp->cb_buf.b_cflags = bp->b_cflags;
    942       1.29  christos 	cbp->cb_buf.b_iodone = ccdiodone;
    943        1.6       cgd 	cbp->cb_buf.b_proc = bp->b_proc;
    944       1.95   hannken 	cbp->cb_buf.b_dev = ci->ci_dev;
    945        1.6       cgd 	cbp->cb_buf.b_blkno = cbn + cboff;
    946        1.6       cgd 	cbp->cb_buf.b_data = addr;
    947       1.11   thorpej 	cbp->cb_buf.b_vp = ci->ci_vp;
    948      1.139     rmind 	cbp->cb_buf.b_objlock = ci->ci_vp->v_interlock;
    949        1.1   hpeyerl 	if (cs->sc_ileave == 0)
    950       1.50   thorpej 		cbc = dbtob((u_int64_t)(ci->ci_size - cbn));
    951        1.1   hpeyerl 	else
    952       1.50   thorpej 		cbc = dbtob((u_int64_t)(cs->sc_ileave - cboff));
    953       1.50   thorpej 	cbp->cb_buf.b_bcount = cbc < bcount ? cbc : bcount;
    954        1.6       cgd 
    955        1.1   hpeyerl 	/*
    956        1.6       cgd 	 * context for ccdiodone
    957        1.1   hpeyerl 	 */
    958        1.6       cgd 	cbp->cb_obp = bp;
    959       1.59   thorpej 	cbp->cb_sc = cs;
    960       1.36   thorpej 	cbp->cb_comp = ccdisk;
    961        1.6       cgd 
    962       1.94      yamt 	BIO_COPYPRIO(&cbp->cb_buf, bp);
    963       1.94      yamt 
    964        1.1   hpeyerl #ifdef DEBUG
    965        1.3   hpeyerl 	if (ccddebug & CCDB_IO)
    966      1.131    cegger 		printf(" dev 0x%"PRIx64"(u%lu): cbp %p bn %" PRId64 " addr %p"
    967       1.99      yamt 		       " bcnt %d\n",
    968       1.62    mjacob 		    ci->ci_dev, (unsigned long) (ci-cs->sc_cinfo), cbp,
    969       1.62    mjacob 		    cbp->cb_buf.b_blkno, cbp->cb_buf.b_data,
    970       1.62    mjacob 		    cbp->cb_buf.b_bcount);
    971        1.1   hpeyerl #endif
    972       1.55   thorpej 
    973       1.55   thorpej 	return (cbp);
    974        1.1   hpeyerl }
    975        1.1   hpeyerl 
    976        1.1   hpeyerl /*
    977       1.11   thorpej  * Called at interrupt time.
    978        1.1   hpeyerl  * Mark the component as done and if all components are done,
    979        1.1   hpeyerl  * take a ccd interrupt.
    980        1.1   hpeyerl  */
    981       1.97   thorpej static void
    982       1.97   thorpej ccdiodone(struct buf *vbp)
    983        1.1   hpeyerl {
    984       1.29  christos 	struct ccdbuf *cbp = (struct ccdbuf *) vbp;
    985       1.59   thorpej 	struct buf *bp = cbp->cb_obp;
    986       1.59   thorpej 	struct ccd_softc *cs = cbp->cb_sc;
    987      1.133        ad 	int count;
    988        1.1   hpeyerl 
    989        1.1   hpeyerl #ifdef DEBUG
    990        1.3   hpeyerl 	if (ccddebug & CCDB_FOLLOW)
    991       1.35  christos 		printf("ccdiodone(%p)\n", cbp);
    992        1.3   hpeyerl 	if (ccddebug & CCDB_IO) {
    993       1.99      yamt 		printf("ccdiodone: bp %p bcount %d resid %d\n",
    994       1.53   thorpej 		       bp, bp->b_bcount, bp->b_resid);
    995      1.131    cegger 		printf(" dev 0x%"PRIx64"(u%d), cbp %p bn %" PRId64 " addr %p"
    996       1.99      yamt 		       " bcnt %d\n",
    997        1.6       cgd 		       cbp->cb_buf.b_dev, cbp->cb_comp, cbp,
    998        1.6       cgd 		       cbp->cb_buf.b_blkno, cbp->cb_buf.b_data,
    999        1.6       cgd 		       cbp->cb_buf.b_bcount);
   1000        1.1   hpeyerl 	}
   1001        1.1   hpeyerl #endif
   1002        1.1   hpeyerl 
   1003      1.122        ad 	if (cbp->cb_buf.b_error != 0) {
   1004      1.122        ad 		bp->b_error = cbp->cb_buf.b_error;
   1005       1.53   thorpej 		printf("%s: error %d on component %d\n",
   1006       1.53   thorpej 		       cs->sc_xname, bp->b_error, cbp->cb_comp);
   1007        1.1   hpeyerl 	}
   1008        1.6       cgd 	count = cbp->cb_buf.b_bcount;
   1009      1.126        ad 	buf_destroy(&cbp->cb_buf);
   1010       1.63   thorpej 	CCD_PUTBUF(cbp);
   1011        1.1   hpeyerl 
   1012        1.1   hpeyerl 	/*
   1013        1.1   hpeyerl 	 * If all done, "interrupt".
   1014       1.53   thorpej 	 */
   1015      1.133        ad 	mutex_enter(cs->sc_iolock);
   1016       1.53   thorpej 	bp->b_resid -= count;
   1017       1.53   thorpej 	if (bp->b_resid < 0)
   1018       1.53   thorpej 		panic("ccdiodone: count");
   1019      1.133        ad 	if (bp->b_resid == 0) {
   1020      1.133        ad 		/*
   1021      1.133        ad 		 * Request is done for better or worse, wakeup the top half.
   1022      1.133        ad 		 */
   1023      1.133        ad 		if (bp->b_error != 0)
   1024      1.133        ad 			bp->b_resid = bp->b_bcount;
   1025      1.133        ad 		disk_unbusy(&cs->sc_dkdev, (bp->b_bcount - bp->b_resid),
   1026      1.133        ad 		    (bp->b_flags & B_READ));
   1027      1.133        ad 		if (!disk_isbusy(&cs->sc_dkdev)) {
   1028      1.133        ad 			if (bufq_peek(cs->sc_bufq) != NULL) {
   1029      1.133        ad 				cv_broadcast(&cs->sc_push);
   1030      1.133        ad 			}
   1031      1.133        ad 			cv_broadcast(&cs->sc_stop);
   1032      1.133        ad 		}
   1033      1.133        ad 		mutex_exit(cs->sc_iolock);
   1034      1.133        ad 		biodone(bp);
   1035      1.133        ad 	} else
   1036      1.133        ad 		mutex_exit(cs->sc_iolock);
   1037        1.1   hpeyerl }
   1038        1.1   hpeyerl 
   1039       1.11   thorpej /* ARGSUSED */
   1040       1.97   thorpej static int
   1041      1.116  christos ccdread(dev_t dev, struct uio *uio, int flags)
   1042        1.3   hpeyerl {
   1043       1.11   thorpej 	int unit = ccdunit(dev);
   1044       1.11   thorpej 	struct ccd_softc *cs;
   1045        1.3   hpeyerl 
   1046        1.3   hpeyerl #ifdef DEBUG
   1047        1.3   hpeyerl 	if (ccddebug & CCDB_FOLLOW)
   1048      1.131    cegger 		printf("ccdread(0x%"PRIx64", %p)\n", dev, uio);
   1049        1.3   hpeyerl #endif
   1050      1.158  christos 	if ((cs = ccdget(unit, 0)) == NULL)
   1051      1.144  christos 		return 0;
   1052       1.11   thorpej 
   1053      1.133        ad 	/* Unlocked advisory check, ccdstrategy check is synchronous. */
   1054       1.11   thorpej 	if ((cs->sc_flags & CCDF_INITED) == 0)
   1055       1.11   thorpej 		return (ENXIO);
   1056       1.11   thorpej 
   1057       1.10   mycroft 	return (physio(ccdstrategy, NULL, dev, B_READ, minphys, uio));
   1058        1.3   hpeyerl }
   1059        1.3   hpeyerl 
   1060       1.11   thorpej /* ARGSUSED */
   1061       1.97   thorpej static int
   1062      1.116  christos ccdwrite(dev_t dev, struct uio *uio, int flags)
   1063        1.3   hpeyerl {
   1064       1.11   thorpej 	int unit = ccdunit(dev);
   1065       1.11   thorpej 	struct ccd_softc *cs;
   1066        1.3   hpeyerl 
   1067        1.3   hpeyerl #ifdef DEBUG
   1068        1.3   hpeyerl 	if (ccddebug & CCDB_FOLLOW)
   1069      1.131    cegger 		printf("ccdwrite(0x%"PRIx64", %p)\n", dev, uio);
   1070        1.3   hpeyerl #endif
   1071      1.158  christos 	if ((cs = ccdget(unit, 0)) == NULL)
   1072      1.144  christos 		return ENOENT;
   1073       1.11   thorpej 
   1074      1.133        ad 	/* Unlocked advisory check, ccdstrategy check is synchronous. */
   1075       1.11   thorpej 	if ((cs->sc_flags & CCDF_INITED) == 0)
   1076       1.11   thorpej 		return (ENXIO);
   1077       1.11   thorpej 
   1078       1.10   mycroft 	return (physio(ccdstrategy, NULL, dev, B_WRITE, minphys, uio));
   1079        1.3   hpeyerl }
   1080        1.3   hpeyerl 
   1081       1.97   thorpej static int
   1082      1.118  christos ccdioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
   1083        1.1   hpeyerl {
   1084       1.11   thorpej 	int unit = ccdunit(dev);
   1085      1.133        ad 	int i, j, lookedup = 0, error = 0;
   1086      1.158  christos 	int part, pmask, make;
   1087       1.11   thorpej 	struct ccd_softc *cs;
   1088       1.11   thorpej 	struct ccd_ioctl *ccio = (struct ccd_ioctl *)data;
   1089      1.110      elad 	kauth_cred_t uc;
   1090       1.11   thorpej 	char **cpp;
   1091      1.136  dholland 	struct pathbuf *pb;
   1092       1.11   thorpej 	struct vnode **vpp;
   1093       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1094       1.70      fvdl 	struct disklabel newlabel;
   1095       1.70      fvdl #endif
   1096       1.11   thorpej 
   1097      1.158  christos 	switch (cmd) {
   1098      1.158  christos #if defined(COMPAT_60) && !defined(_LP64)
   1099      1.158  christos 	case CCDIOCSET_60:
   1100      1.158  christos #endif
   1101      1.158  christos 	case CCDIOCSET:
   1102      1.158  christos 		make = 1;
   1103      1.158  christos 		break;
   1104      1.158  christos 	default:
   1105      1.158  christos 		make = 0;
   1106      1.158  christos 		break;
   1107      1.158  christos 	}
   1108      1.158  christos 
   1109      1.158  christos 	if ((cs = ccdget(unit, make)) == NULL)
   1110      1.144  christos 		return ENOENT;
   1111      1.133        ad 	uc = kauth_cred_get();
   1112      1.109       jld 
   1113      1.152  sborrill /*
   1114      1.152  sborrill  * Compat code must not be called if on a platform where
   1115      1.152  sborrill  * sizeof (size_t) == sizeof (uint64_t) as CCDIOCSET will
   1116      1.152  sborrill  * be the same as CCDIOCSET_60
   1117      1.152  sborrill  */
   1118      1.152  sborrill #if defined(COMPAT_60) && !defined(_LP64)
   1119      1.152  sborrill 	switch (cmd) {
   1120      1.152  sborrill 	case CCDIOCSET_60: {
   1121      1.152  sborrill 		struct ccd_ioctl ccionew;
   1122      1.152  sborrill        		struct ccd_ioctl_60 *ccio60 =
   1123      1.152  sborrill        		    (struct ccd_ioctl_60 *)data;
   1124      1.152  sborrill 		ccionew.ccio_disks = ccio->ccio_disks;
   1125      1.152  sborrill 		ccionew.ccio_ndisks = ccio->ccio_ndisks;
   1126      1.152  sborrill 		ccionew.ccio_ileave = ccio->ccio_ileave;
   1127      1.152  sborrill 		ccionew.ccio_flags = ccio->ccio_flags;
   1128      1.152  sborrill 		ccionew.ccio_unit = ccio->ccio_unit;
   1129      1.152  sborrill 		error = ccdioctl(dev, CCDIOCSET, &ccionew, flag, l);
   1130      1.152  sborrill 		if (!error) {
   1131      1.152  sborrill 			/* Copy data back, adjust types if necessary */
   1132      1.152  sborrill 			ccio60->ccio_disks = ccionew.ccio_disks;
   1133      1.152  sborrill 			ccio60->ccio_ndisks = ccionew.ccio_ndisks;
   1134      1.152  sborrill 			ccio60->ccio_ileave = ccionew.ccio_ileave;
   1135      1.152  sborrill 			ccio60->ccio_flags = ccionew.ccio_flags;
   1136      1.152  sborrill 			ccio60->ccio_unit = ccionew.ccio_unit;
   1137      1.152  sborrill 			ccio60->ccio_size = (size_t)ccionew.ccio_size;
   1138      1.152  sborrill 		}
   1139      1.152  sborrill 		return error;
   1140      1.152  sborrill 		}
   1141      1.152  sborrill 		break;
   1142      1.152  sborrill 
   1143      1.152  sborrill 	case CCDIOCCLR_60:
   1144      1.152  sborrill 		/*
   1145      1.152  sborrill 		 * ccio_size member not used, so existing struct OK
   1146      1.152  sborrill 		 * drop through to existing non-compat version
   1147      1.152  sborrill 		 */
   1148      1.152  sborrill 		cmd = CCDIOCCLR;
   1149      1.152  sborrill 		break;
   1150      1.152  sborrill 	}
   1151      1.152  sborrill #endif /* COMPAT_60 && !_LP64*/
   1152      1.152  sborrill 
   1153       1.41   thorpej 	/* Must be open for writes for these commands... */
   1154       1.41   thorpej 	switch (cmd) {
   1155       1.41   thorpej 	case CCDIOCSET:
   1156       1.41   thorpej 	case CCDIOCCLR:
   1157       1.41   thorpej 	case DIOCSDINFO:
   1158       1.41   thorpej 	case DIOCWDINFO:
   1159      1.157   mlelstv 	case DIOCCACHESYNC:
   1160      1.157   mlelstv 	case DIOCAWEDGE:
   1161      1.157   mlelstv 	case DIOCDWEDGE:
   1162      1.157   mlelstv 	case DIOCMWEDGES:
   1163       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1164       1.70      fvdl 	case ODIOCSDINFO:
   1165       1.70      fvdl 	case ODIOCWDINFO:
   1166       1.70      fvdl #endif
   1167       1.87   thorpej 	case DIOCKLABEL:
   1168       1.41   thorpej 	case DIOCWLABEL:
   1169       1.41   thorpej 		if ((flag & FWRITE) == 0)
   1170       1.41   thorpej 			return (EBADF);
   1171       1.41   thorpej 	}
   1172       1.41   thorpej 
   1173      1.133        ad 	mutex_enter(&cs->sc_dvlock);
   1174       1.57   thorpej 
   1175       1.41   thorpej 	/* Must be initialized for these... */
   1176       1.41   thorpej 	switch (cmd) {
   1177       1.41   thorpej 	case CCDIOCCLR:
   1178       1.42    kleink 	case DIOCGDINFO:
   1179  1.166.2.3  pgoyette 	case DIOCGSTRATEGY:
   1180  1.166.2.3  pgoyette 	case DIOCGCACHE:
   1181      1.100   thorpej 	case DIOCCACHESYNC:
   1182      1.157   mlelstv 	case DIOCAWEDGE:
   1183      1.157   mlelstv 	case DIOCDWEDGE:
   1184      1.157   mlelstv 	case DIOCLWEDGES:
   1185      1.157   mlelstv 	case DIOCMWEDGES:
   1186       1.42    kleink 	case DIOCSDINFO:
   1187       1.42    kleink 	case DIOCWDINFO:
   1188      1.166  christos 	case DIOCGPARTINFO:
   1189       1.41   thorpej 	case DIOCWLABEL:
   1190       1.87   thorpej 	case DIOCKLABEL:
   1191       1.44   thorpej 	case DIOCGDEFLABEL:
   1192       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1193       1.70      fvdl 	case ODIOCGDINFO:
   1194       1.70      fvdl 	case ODIOCSDINFO:
   1195       1.70      fvdl 	case ODIOCWDINFO:
   1196       1.70      fvdl 	case ODIOCGDEFLABEL:
   1197       1.70      fvdl #endif
   1198       1.57   thorpej 		if ((cs->sc_flags & CCDF_INITED) == 0) {
   1199       1.57   thorpej 			error = ENXIO;
   1200       1.57   thorpej 			goto out;
   1201       1.57   thorpej 		}
   1202       1.41   thorpej 	}
   1203       1.41   thorpej 
   1204      1.164     skrll 	error = disk_ioctl(&cs->sc_dkdev, dev, cmd, data, flag, l);
   1205      1.155  christos 	if (error != EPASSTHROUGH)
   1206      1.155  christos 		goto out;
   1207      1.155  christos 
   1208      1.157   mlelstv 	error = 0;
   1209       1.11   thorpej 	switch (cmd) {
   1210       1.11   thorpej 	case CCDIOCSET:
   1211       1.57   thorpej 		if (cs->sc_flags & CCDF_INITED) {
   1212       1.57   thorpej 			error = EBUSY;
   1213       1.57   thorpej 			goto out;
   1214       1.57   thorpej 		}
   1215       1.54   thorpej 
   1216       1.54   thorpej 		/* Validate the flags. */
   1217       1.57   thorpej 		if ((ccio->ccio_flags & CCDF_USERMASK) != ccio->ccio_flags) {
   1218       1.57   thorpej 			error = EINVAL;
   1219       1.57   thorpej 			goto out;
   1220       1.57   thorpej 		}
   1221       1.15   thorpej 
   1222      1.133        ad 		if (ccio->ccio_ndisks > CCD_MAXNDISKS ||
   1223      1.133        ad 		    ccio->ccio_ndisks == 0) {
   1224       1.73  jdolecek 			error = EINVAL;
   1225       1.73  jdolecek 			goto out;
   1226       1.73  jdolecek 		}
   1227      1.102     perry 
   1228       1.11   thorpej 		/* Fill in some important bits. */
   1229       1.57   thorpej 		cs->sc_ileave = ccio->ccio_ileave;
   1230       1.57   thorpej 		cs->sc_nccdisks = ccio->ccio_ndisks;
   1231       1.57   thorpej 		cs->sc_flags = ccio->ccio_flags & CCDF_USERMASK;
   1232       1.11   thorpej 
   1233       1.11   thorpej 		/*
   1234       1.11   thorpej 		 * Allocate space for and copy in the array of
   1235      1.152  sborrill 		 * component pathnames and device numbers.
   1236       1.11   thorpej 		 */
   1237      1.133        ad 		cpp = kmem_alloc(ccio->ccio_ndisks * sizeof(*cpp), KM_SLEEP);
   1238      1.133        ad 		vpp = kmem_alloc(ccio->ccio_ndisks * sizeof(*vpp), KM_SLEEP);
   1239       1.84       dsl 		error = copyin(ccio->ccio_disks, cpp,
   1240      1.133        ad 		    ccio->ccio_ndisks * sizeof(*cpp));
   1241       1.11   thorpej 		if (error) {
   1242      1.133        ad 			kmem_free(vpp, ccio->ccio_ndisks * sizeof(*vpp));
   1243      1.133        ad 			kmem_free(cpp, ccio->ccio_ndisks * sizeof(*cpp));
   1244       1.57   thorpej 			goto out;
   1245       1.11   thorpej 		}
   1246       1.11   thorpej 
   1247       1.11   thorpej #ifdef DEBUG
   1248       1.11   thorpej 		if (ccddebug & CCDB_INIT)
   1249       1.11   thorpej 			for (i = 0; i < ccio->ccio_ndisks; ++i)
   1250      1.104  christos 				printf("ccdioctl: component %d: %p\n",
   1251       1.11   thorpej 				    i, cpp[i]);
   1252       1.11   thorpej #endif
   1253       1.11   thorpej 
   1254       1.11   thorpej 		for (i = 0; i < ccio->ccio_ndisks; ++i) {
   1255       1.11   thorpej #ifdef DEBUG
   1256       1.11   thorpej 			if (ccddebug & CCDB_INIT)
   1257       1.35  christos 				printf("ccdioctl: lookedup = %d\n", lookedup);
   1258       1.11   thorpej #endif
   1259      1.136  dholland 			error = pathbuf_copyin(cpp[i], &pb);
   1260      1.137  dholland 			if (error == 0) {
   1261      1.137  dholland 				error = dk_lookup(pb, l, &vpp[i]);
   1262      1.136  dholland 			}
   1263      1.136  dholland 			pathbuf_destroy(pb);
   1264      1.136  dholland 			if (error != 0) {
   1265       1.11   thorpej 				for (j = 0; j < lookedup; ++j)
   1266       1.12   thorpej 					(void)vn_close(vpp[j], FREAD|FWRITE,
   1267      1.128        ad 					    uc);
   1268      1.133        ad 				kmem_free(vpp, ccio->ccio_ndisks *
   1269      1.133        ad 				    sizeof(*vpp));
   1270      1.133        ad 				kmem_free(cpp, ccio->ccio_ndisks *
   1271      1.133        ad 				    sizeof(*cpp));
   1272       1.57   thorpej 				goto out;
   1273       1.11   thorpej 			}
   1274       1.11   thorpej 			++lookedup;
   1275       1.11   thorpej 		}
   1276       1.11   thorpej 
   1277      1.133        ad 		/* Attach the disk. */
   1278      1.133        ad 		disk_attach(&cs->sc_dkdev);
   1279      1.133        ad 		bufq_alloc(&cs->sc_bufq, "fcfs", 0);
   1280      1.133        ad 
   1281       1.11   thorpej 		/*
   1282       1.11   thorpej 		 * Initialize the ccd.  Fills in the softc for us.
   1283       1.11   thorpej 		 */
   1284      1.107  christos 		if ((error = ccdinit(cs, cpp, vpp, l)) != 0) {
   1285       1.11   thorpej 			for (j = 0; j < lookedup; ++j)
   1286       1.18   thorpej 				(void)vn_close(vpp[j], FREAD|FWRITE,
   1287      1.128        ad 				    uc);
   1288      1.133        ad 			kmem_free(vpp, ccio->ccio_ndisks * sizeof(*vpp));
   1289      1.133        ad 			kmem_free(cpp, ccio->ccio_ndisks * sizeof(*cpp));
   1290      1.133        ad 			disk_detach(&cs->sc_dkdev);
   1291  1.166.2.1  pgoyette 			mutex_exit(&cs->sc_dvlock);
   1292      1.133        ad 			bufq_free(cs->sc_bufq);
   1293  1.166.2.1  pgoyette 			return error;
   1294       1.11   thorpej 		}
   1295       1.11   thorpej 
   1296       1.57   thorpej 		/* We can free the temporary variables now. */
   1297      1.133        ad 		kmem_free(vpp, ccio->ccio_ndisks * sizeof(*vpp));
   1298      1.133        ad 		kmem_free(cpp, ccio->ccio_ndisks * sizeof(*cpp));
   1299       1.57   thorpej 
   1300       1.11   thorpej 		/*
   1301       1.11   thorpej 		 * The ccd has been successfully initialized, so
   1302       1.23   thorpej 		 * we can place it into the array.  Don't try to
   1303       1.23   thorpej 		 * read the disklabel until the disk has been attached,
   1304       1.23   thorpej 		 * because space for the disklabel is allocated
   1305       1.23   thorpej 		 * in disk_attach();
   1306       1.11   thorpej 		 */
   1307       1.11   thorpej 		ccio->ccio_unit = unit;
   1308       1.11   thorpej 		ccio->ccio_size = cs->sc_size;
   1309       1.23   thorpej 
   1310       1.23   thorpej 		/* Try and read the disklabel. */
   1311       1.11   thorpej 		ccdgetdisklabel(dev);
   1312      1.157   mlelstv 		disk_set_info(NULL, &cs->sc_dkdev, NULL);
   1313      1.157   mlelstv 
   1314      1.157   mlelstv 		/* discover wedges */
   1315      1.157   mlelstv 		mutex_exit(&cs->sc_dvlock);
   1316      1.157   mlelstv 		dkwedge_discover(&cs->sc_dkdev);
   1317      1.157   mlelstv 		return 0;
   1318       1.11   thorpej 
   1319       1.11   thorpej 	case CCDIOCCLR:
   1320       1.11   thorpej 		/*
   1321       1.11   thorpej 		 * Don't unconfigure if any other partitions are open
   1322       1.11   thorpej 		 * or if both the character and block flavors of this
   1323       1.11   thorpej 		 * partition are open.
   1324       1.11   thorpej 		 */
   1325       1.11   thorpej 		part = DISKPART(dev);
   1326       1.11   thorpej 		pmask = (1 << part);
   1327       1.11   thorpej 		if ((cs->sc_dkdev.dk_openmask & ~pmask) ||
   1328       1.11   thorpej 		    ((cs->sc_dkdev.dk_bopenmask & pmask) &&
   1329       1.15   thorpej 		    (cs->sc_dkdev.dk_copenmask & pmask))) {
   1330       1.57   thorpej 			error = EBUSY;
   1331       1.57   thorpej 			goto out;
   1332       1.15   thorpej 		}
   1333       1.88   thorpej 
   1334      1.157   mlelstv 		/* Delete all of our wedges. */
   1335      1.157   mlelstv 		dkwedge_delall(&cs->sc_dkdev);
   1336      1.157   mlelstv 
   1337      1.133        ad 		/* Stop new I/O, wait for in-flight I/O to complete. */
   1338      1.133        ad 		mutex_enter(cs->sc_iolock);
   1339      1.133        ad 		cs->sc_flags &= ~(CCDF_INITED|CCDF_VLABEL);
   1340      1.133        ad 		cs->sc_zap = true;
   1341      1.133        ad 		while (disk_isbusy(&cs->sc_dkdev) ||
   1342      1.133        ad 		    bufq_peek(cs->sc_bufq) != NULL ||
   1343      1.133        ad 		    cs->sc_thread != NULL) {
   1344      1.133        ad 			cv_broadcast(&cs->sc_push);
   1345      1.133        ad 			(void)cv_timedwait(&cs->sc_stop, cs->sc_iolock, hz);
   1346      1.133        ad 		}
   1347      1.133        ad 		mutex_exit(cs->sc_iolock);
   1348       1.11   thorpej 
   1349       1.11   thorpej 		/*
   1350       1.11   thorpej 		 * Free ccd_softc information and clear entry.
   1351       1.11   thorpej 		 */
   1352       1.22   thorpej 
   1353       1.22   thorpej 		/* Close the components and free their pathnames. */
   1354       1.11   thorpej 		for (i = 0; i < cs->sc_nccdisks; ++i) {
   1355       1.11   thorpej 			/*
   1356       1.11   thorpej 			 * XXX: this close could potentially fail and
   1357       1.11   thorpej 			 * cause Bad Things.  Maybe we need to force
   1358       1.11   thorpej 			 * the close to happen?
   1359       1.11   thorpej 			 */
   1360       1.11   thorpej #ifdef DEBUG
   1361       1.11   thorpej 			if (ccddebug & CCDB_VNODE)
   1362       1.11   thorpej 				vprint("CCDIOCCLR: vnode info",
   1363       1.11   thorpej 				    cs->sc_cinfo[i].ci_vp);
   1364       1.11   thorpej #endif
   1365       1.11   thorpej 			(void)vn_close(cs->sc_cinfo[i].ci_vp, FREAD|FWRITE,
   1366      1.128        ad 			    uc);
   1367      1.133        ad 			kmem_free(cs->sc_cinfo[i].ci_path,
   1368      1.133        ad 			    cs->sc_cinfo[i].ci_pathlen);
   1369       1.38   thorpej 		}
   1370       1.38   thorpej 
   1371       1.22   thorpej 		/* Free interleave index. */
   1372      1.133        ad 		for (i = 0; cs->sc_itable[i].ii_ndisk; ++i) {
   1373      1.133        ad 			kmem_free(cs->sc_itable[i].ii_index,
   1374      1.133        ad 			    cs->sc_itable[i].ii_indexsz);
   1375      1.133        ad 		}
   1376       1.22   thorpej 
   1377       1.22   thorpej 		/* Free component info and interleave table. */
   1378      1.133        ad 		kmem_free(cs->sc_cinfo, cs->sc_nccdisks *
   1379      1.133        ad 		    sizeof(struct ccdcinfo));
   1380      1.133        ad 		kmem_free(cs->sc_itable, (cs->sc_nccdisks + 1) *
   1381      1.133        ad 		    sizeof(struct ccdiinfo));
   1382       1.15   thorpej 
   1383      1.152  sborrill 		aprint_normal("%s: detached\n", cs->sc_xname);
   1384      1.152  sborrill 
   1385      1.152  sborrill 		/* Detach the disk. */
   1386      1.123        ad 		disk_detach(&cs->sc_dkdev);
   1387      1.133        ad 		bufq_free(cs->sc_bufq);
   1388      1.144  christos 		ccdput(cs);
   1389      1.148     joerg 		/* Don't break, otherwise cs is read again. */
   1390      1.148     joerg 		return 0;
   1391       1.11   thorpej 
   1392  1.166.2.3  pgoyette 	case DIOCGSTRATEGY:
   1393  1.166.2.3  pgoyette 	    {
   1394  1.166.2.3  pgoyette 		struct disk_strategy *dks = (void *)data;
   1395  1.166.2.3  pgoyette 
   1396  1.166.2.3  pgoyette 		mutex_enter(cs->sc_iolock);
   1397  1.166.2.3  pgoyette 		if (cs->sc_bufq != NULL)
   1398  1.166.2.3  pgoyette 			strlcpy(dks->dks_name,
   1399  1.166.2.3  pgoyette 			    bufq_getstrategyname(cs->sc_bufq),
   1400  1.166.2.3  pgoyette 			    sizeof(dks->dks_name));
   1401  1.166.2.3  pgoyette 		else
   1402  1.166.2.3  pgoyette 			error = EINVAL;
   1403  1.166.2.3  pgoyette 		mutex_exit(cs->sc_iolock);
   1404  1.166.2.3  pgoyette 		dks->dks_paramlen = 0;
   1405  1.166.2.3  pgoyette 		break;
   1406  1.166.2.3  pgoyette 	    }
   1407  1.166.2.3  pgoyette 
   1408  1.166.2.3  pgoyette 	case DIOCGCACHE:
   1409  1.166.2.3  pgoyette 	    {
   1410  1.166.2.3  pgoyette 		int dkcache = 0;
   1411  1.166.2.3  pgoyette 
   1412  1.166.2.3  pgoyette 		/*
   1413  1.166.2.3  pgoyette 		 * We pass this call down to all components and report
   1414  1.166.2.3  pgoyette 		 * intersection of the flags returned by the components.
   1415  1.166.2.3  pgoyette 		 * If any errors out, we return error. CCD components
   1416  1.166.2.3  pgoyette 		 * can not change unless the device is unconfigured, so
   1417  1.166.2.3  pgoyette 		 * device feature flags will remain static. RCE/WCE can change
   1418  1.166.2.3  pgoyette 		 * of course, if set directly on underlying device.
   1419  1.166.2.3  pgoyette 		 */
   1420  1.166.2.3  pgoyette 		for (error = 0, i = 0; i < cs->sc_nccdisks; i++) {
   1421  1.166.2.3  pgoyette 			error = VOP_IOCTL(cs->sc_cinfo[i].ci_vp, cmd, &j,
   1422  1.166.2.3  pgoyette 				      flag, uc);
   1423  1.166.2.3  pgoyette 			if (error)
   1424  1.166.2.3  pgoyette 				break;
   1425  1.166.2.3  pgoyette 
   1426  1.166.2.3  pgoyette 			if (i == 0)
   1427  1.166.2.3  pgoyette 				dkcache = j;
   1428  1.166.2.3  pgoyette 			else
   1429  1.166.2.3  pgoyette 				dkcache = DKCACHE_COMBINE(dkcache, j);
   1430  1.166.2.3  pgoyette 		}
   1431  1.166.2.3  pgoyette 
   1432  1.166.2.3  pgoyette 		*((int *)data) = dkcache;
   1433  1.166.2.3  pgoyette 		break;
   1434  1.166.2.3  pgoyette 	    }
   1435  1.166.2.3  pgoyette 
   1436      1.100   thorpej 	case DIOCCACHESYNC:
   1437      1.100   thorpej 		/*
   1438      1.100   thorpej 		 * We pass this call down to all components and report
   1439      1.100   thorpej 		 * the first error we encounter.
   1440      1.100   thorpej 		 */
   1441      1.100   thorpej 		for (error = 0, i = 0; i < cs->sc_nccdisks; i++) {
   1442      1.100   thorpej 			j = VOP_IOCTL(cs->sc_cinfo[i].ci_vp, cmd, data,
   1443      1.124     pooka 				      flag, uc);
   1444      1.100   thorpej 			if (j != 0 && error == 0)
   1445      1.100   thorpej 				error = j;
   1446      1.100   thorpej 		}
   1447      1.100   thorpej 		break;
   1448      1.100   thorpej 
   1449       1.11   thorpej 	case DIOCWDINFO:
   1450       1.11   thorpej 	case DIOCSDINFO:
   1451       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1452       1.70      fvdl 	case ODIOCWDINFO:
   1453       1.70      fvdl 	case ODIOCSDINFO:
   1454       1.70      fvdl #endif
   1455       1.70      fvdl 	{
   1456       1.70      fvdl 		struct disklabel *lp;
   1457       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1458       1.70      fvdl 		if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
   1459       1.70      fvdl 			memset(&newlabel, 0, sizeof newlabel);
   1460       1.70      fvdl 			memcpy(&newlabel, data, sizeof (struct olddisklabel));
   1461       1.70      fvdl 			lp = &newlabel;
   1462       1.70      fvdl 		} else
   1463       1.70      fvdl #endif
   1464       1.70      fvdl 		lp = (struct disklabel *)data;
   1465       1.70      fvdl 
   1466       1.11   thorpej 		cs->sc_flags |= CCDF_LABELLING;
   1467       1.11   thorpej 
   1468       1.23   thorpej 		error = setdisklabel(cs->sc_dkdev.dk_label,
   1469       1.70      fvdl 		    lp, 0, cs->sc_dkdev.dk_cpulabel);
   1470       1.11   thorpej 		if (error == 0) {
   1471       1.70      fvdl 			if (cmd == DIOCWDINFO
   1472       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1473       1.70      fvdl 			    || cmd == ODIOCWDINFO
   1474       1.70      fvdl #endif
   1475       1.70      fvdl 			   )
   1476       1.11   thorpej 				error = writedisklabel(CCDLABELDEV(dev),
   1477       1.23   thorpej 				    ccdstrategy, cs->sc_dkdev.dk_label,
   1478       1.23   thorpej 				    cs->sc_dkdev.dk_cpulabel);
   1479       1.11   thorpej 		}
   1480       1.11   thorpej 
   1481       1.11   thorpej 		cs->sc_flags &= ~CCDF_LABELLING;
   1482       1.11   thorpej 		break;
   1483       1.70      fvdl 	}
   1484       1.11   thorpej 
   1485       1.87   thorpej 	case DIOCKLABEL:
   1486       1.87   thorpej 		if (*(int *)data != 0)
   1487       1.87   thorpej 			cs->sc_flags |= CCDF_KLABEL;
   1488       1.87   thorpej 		else
   1489       1.87   thorpej 			cs->sc_flags &= ~CCDF_KLABEL;
   1490       1.87   thorpej 		break;
   1491       1.87   thorpej 
   1492       1.11   thorpej 	case DIOCWLABEL:
   1493       1.11   thorpej 		if (*(int *)data != 0)
   1494       1.11   thorpej 			cs->sc_flags |= CCDF_WLABEL;
   1495       1.11   thorpej 		else
   1496       1.11   thorpej 			cs->sc_flags &= ~CCDF_WLABEL;
   1497       1.11   thorpej 		break;
   1498       1.11   thorpej 
   1499       1.44   thorpej 	case DIOCGDEFLABEL:
   1500       1.44   thorpej 		ccdgetdefaultlabel(cs, (struct disklabel *)data);
   1501       1.44   thorpej 		break;
   1502       1.70      fvdl 
   1503       1.70      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1504       1.70      fvdl 	case ODIOCGDEFLABEL:
   1505       1.70      fvdl 		ccdgetdefaultlabel(cs, &newlabel);
   1506       1.70      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
   1507       1.71      fvdl 			return ENOTTY;
   1508       1.70      fvdl 		memcpy(data, &newlabel, sizeof (struct olddisklabel));
   1509       1.70      fvdl 		break;
   1510       1.70      fvdl #endif
   1511       1.44   thorpej 
   1512       1.11   thorpej 	default:
   1513       1.57   thorpej 		error = ENOTTY;
   1514       1.11   thorpej 	}
   1515       1.11   thorpej 
   1516       1.57   thorpej  out:
   1517      1.133        ad 	mutex_exit(&cs->sc_dvlock);
   1518       1.57   thorpej 	return (error);
   1519        1.1   hpeyerl }
   1520        1.1   hpeyerl 
   1521       1.97   thorpej static int
   1522       1.97   thorpej ccdsize(dev_t dev)
   1523        1.1   hpeyerl {
   1524       1.11   thorpej 	struct ccd_softc *cs;
   1525       1.40   thorpej 	struct disklabel *lp;
   1526       1.40   thorpej 	int part, unit, omask, size;
   1527       1.40   thorpej 
   1528       1.40   thorpej 	unit = ccdunit(dev);
   1529      1.158  christos 	if ((cs = ccdget(unit, 0)) == NULL)
   1530      1.144  christos 		return -1;
   1531       1.11   thorpej 
   1532       1.40   thorpej 	if ((cs->sc_flags & CCDF_INITED) == 0)
   1533       1.11   thorpej 		return (-1);
   1534       1.11   thorpej 
   1535       1.11   thorpej 	part = DISKPART(dev);
   1536       1.40   thorpej 	omask = cs->sc_dkdev.dk_openmask & (1 << part);
   1537       1.40   thorpej 	lp = cs->sc_dkdev.dk_label;
   1538       1.11   thorpej 
   1539      1.107  christos 	if (omask == 0 && ccdopen(dev, 0, S_IFBLK, curlwp))
   1540       1.11   thorpej 		return (-1);
   1541       1.11   thorpej 
   1542       1.40   thorpej 	if (lp->d_partitions[part].p_fstype != FS_SWAP)
   1543       1.11   thorpej 		size = -1;
   1544       1.11   thorpej 	else
   1545       1.40   thorpej 		size = lp->d_partitions[part].p_size *
   1546       1.40   thorpej 		    (lp->d_secsize / DEV_BSIZE);
   1547       1.11   thorpej 
   1548      1.107  christos 	if (omask == 0 && ccdclose(dev, 0, S_IFBLK, curlwp))
   1549       1.11   thorpej 		return (-1);
   1550        1.1   hpeyerl 
   1551       1.11   thorpej 	return (size);
   1552        1.1   hpeyerl }
   1553        1.1   hpeyerl 
   1554       1.11   thorpej static void
   1555       1.97   thorpej ccdgetdefaultlabel(struct ccd_softc *cs, struct disklabel *lp)
   1556       1.11   thorpej {
   1557       1.11   thorpej 	struct ccdgeom *ccg = &cs->sc_geom;
   1558       1.11   thorpej 
   1559       1.72   thorpej 	memset(lp, 0, sizeof(*lp));
   1560       1.11   thorpej 
   1561      1.153   mlelstv 	if (cs->sc_size > UINT32_MAX)
   1562      1.153   mlelstv 		lp->d_secperunit = UINT32_MAX;
   1563      1.153   mlelstv 	else
   1564      1.153   mlelstv 		lp->d_secperunit = cs->sc_size;
   1565       1.11   thorpej 	lp->d_secsize = ccg->ccg_secsize;
   1566       1.11   thorpej 	lp->d_nsectors = ccg->ccg_nsectors;
   1567       1.11   thorpej 	lp->d_ntracks = ccg->ccg_ntracks;
   1568       1.11   thorpej 	lp->d_ncylinders = ccg->ccg_ncylinders;
   1569       1.19   thorpej 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
   1570       1.11   thorpej 
   1571       1.11   thorpej 	strncpy(lp->d_typename, "ccd", sizeof(lp->d_typename));
   1572      1.162  christos 	lp->d_type = DKTYPE_CCD;
   1573       1.11   thorpej 	strncpy(lp->d_packname, "fictitious", sizeof(lp->d_packname));
   1574       1.11   thorpej 	lp->d_rpm = 3600;
   1575       1.11   thorpej 	lp->d_interleave = 1;
   1576       1.11   thorpej 	lp->d_flags = 0;
   1577       1.11   thorpej 
   1578       1.11   thorpej 	lp->d_partitions[RAW_PART].p_offset = 0;
   1579      1.153   mlelstv 	lp->d_partitions[RAW_PART].p_size = lp->d_secperunit;
   1580       1.11   thorpej 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
   1581       1.11   thorpej 	lp->d_npartitions = RAW_PART + 1;
   1582       1.11   thorpej 
   1583       1.11   thorpej 	lp->d_magic = DISKMAGIC;
   1584       1.11   thorpej 	lp->d_magic2 = DISKMAGIC;
   1585       1.23   thorpej 	lp->d_checksum = dkcksum(cs->sc_dkdev.dk_label);
   1586       1.44   thorpej }
   1587       1.44   thorpej 
   1588       1.44   thorpej /*
   1589       1.44   thorpej  * Read the disklabel from the ccd.  If one is not present, fake one
   1590       1.44   thorpej  * up.
   1591       1.44   thorpej  */
   1592       1.44   thorpej static void
   1593       1.97   thorpej ccdgetdisklabel(dev_t dev)
   1594       1.44   thorpej {
   1595       1.44   thorpej 	int unit = ccdunit(dev);
   1596      1.144  christos 	struct ccd_softc *cs;
   1597       1.85       dsl 	const char *errstring;
   1598      1.144  christos 	struct disklabel *lp;
   1599      1.144  christos 	struct cpu_disklabel *clp;
   1600       1.44   thorpej 
   1601      1.158  christos 	if ((cs = ccdget(unit, 0)) == NULL)
   1602      1.144  christos 		return;
   1603      1.144  christos 	lp = cs->sc_dkdev.dk_label;
   1604      1.144  christos 	clp = cs->sc_dkdev.dk_cpulabel;
   1605      1.133        ad 	KASSERT(mutex_owned(&cs->sc_dvlock));
   1606      1.133        ad 
   1607       1.72   thorpej 	memset(clp, 0, sizeof(*clp));
   1608       1.44   thorpej 
   1609       1.44   thorpej 	ccdgetdefaultlabel(cs, lp);
   1610       1.11   thorpej 
   1611       1.11   thorpej 	/*
   1612       1.11   thorpej 	 * Call the generic disklabel extraction routine.
   1613       1.11   thorpej 	 */
   1614      1.133        ad 	cs->sc_flags |= CCDF_RLABEL;
   1615       1.92     lukem 	if ((cs->sc_flags & CCDF_NOLABEL) != 0)
   1616       1.92     lukem 		errstring = "CCDF_NOLABEL set; ignoring on-disk label";
   1617       1.92     lukem 	else
   1618       1.92     lukem 		errstring = readdisklabel(CCDLABELDEV(dev), ccdstrategy,
   1619       1.92     lukem 		    cs->sc_dkdev.dk_label, cs->sc_dkdev.dk_cpulabel);
   1620       1.29  christos 	if (errstring)
   1621       1.11   thorpej 		ccdmakedisklabel(cs);
   1622       1.47     enami 	else {
   1623       1.47     enami 		int i;
   1624       1.47     enami 		struct partition *pp;
   1625       1.47     enami 
   1626       1.47     enami 		/*
   1627       1.47     enami 		 * Sanity check whether the found disklabel is valid.
   1628       1.47     enami 		 *
   1629       1.47     enami 		 * This is necessary since total size of ccd may vary
   1630       1.47     enami 		 * when an interleave is changed even though exactly
   1631       1.47     enami 		 * same componets are used, and old disklabel may used
   1632       1.47     enami 		 * if that is found.
   1633       1.47     enami 		 */
   1634      1.154   mlelstv 		if (lp->d_secperunit < UINT32_MAX ?
   1635      1.154   mlelstv 			lp->d_secperunit != cs->sc_size :
   1636      1.154   mlelstv 			lp->d_secperunit > cs->sc_size)
   1637       1.47     enami 			printf("WARNING: %s: "
   1638      1.152  sborrill 			    "total sector size in disklabel (%ju) != "
   1639      1.152  sborrill 			    "the size of ccd (%ju)\n", cs->sc_xname,
   1640      1.152  sborrill 			    (uintmax_t)lp->d_secperunit,
   1641      1.152  sborrill 			    (uintmax_t)cs->sc_size);
   1642       1.47     enami 		for (i = 0; i < lp->d_npartitions; i++) {
   1643       1.47     enami 			pp = &lp->d_partitions[i];
   1644       1.47     enami 			if (pp->p_offset + pp->p_size > cs->sc_size)
   1645       1.48     enami 				printf("WARNING: %s: end of partition `%c' "
   1646      1.152  sborrill 				    "exceeds the size of ccd (%ju)\n",
   1647      1.152  sborrill 				    cs->sc_xname, 'a' + i, (uintmax_t)cs->sc_size);
   1648       1.47     enami 		}
   1649       1.47     enami 	}
   1650       1.11   thorpej 
   1651       1.11   thorpej #ifdef DEBUG
   1652       1.11   thorpej 	/* It's actually extremely common to have unlabeled ccds. */
   1653       1.11   thorpej 	if (ccddebug & CCDB_LABEL)
   1654       1.11   thorpej 		if (errstring != NULL)
   1655       1.35  christos 			printf("%s: %s\n", cs->sc_xname, errstring);
   1656       1.11   thorpej #endif
   1657       1.87   thorpej 
   1658       1.87   thorpej 	/* In-core label now valid. */
   1659      1.133        ad 	cs->sc_flags = (cs->sc_flags | CCDF_VLABEL) & ~CCDF_RLABEL;
   1660       1.11   thorpej }
   1661       1.11   thorpej 
   1662       1.11   thorpej /*
   1663       1.11   thorpej  * Take care of things one might want to take care of in the event
   1664       1.11   thorpej  * that a disklabel isn't present.
   1665       1.11   thorpej  */
   1666       1.11   thorpej static void
   1667       1.97   thorpej ccdmakedisklabel(struct ccd_softc *cs)
   1668       1.11   thorpej {
   1669       1.23   thorpej 	struct disklabel *lp = cs->sc_dkdev.dk_label;
   1670       1.11   thorpej 
   1671       1.11   thorpej 	/*
   1672       1.11   thorpej 	 * For historical reasons, if there's no disklabel present
   1673       1.11   thorpej 	 * the raw partition must be marked FS_BSDFFS.
   1674       1.11   thorpej 	 */
   1675       1.11   thorpej 	lp->d_partitions[RAW_PART].p_fstype = FS_BSDFFS;
   1676       1.11   thorpej 
   1677       1.11   thorpej 	strncpy(lp->d_packname, "default label", sizeof(lp->d_packname));
   1678       1.44   thorpej 
   1679       1.44   thorpej 	lp->d_checksum = dkcksum(lp);
   1680       1.11   thorpej }
   1681       1.11   thorpej 
   1682       1.11   thorpej #ifdef DEBUG
   1683       1.11   thorpej static void
   1684       1.97   thorpej printiinfo(struct ccdiinfo *ii)
   1685       1.11   thorpej {
   1686       1.68  augustss 	int ix, i;
   1687       1.11   thorpej 
   1688       1.11   thorpej 	for (ix = 0; ii->ii_ndisk; ix++, ii++) {
   1689       1.81    kleink 		printf(" itab[%d]: #dk %d sblk %" PRId64 " soff %" PRId64,
   1690       1.34  christos 		    ix, ii->ii_ndisk, ii->ii_startblk, ii->ii_startoff);
   1691       1.11   thorpej 		for (i = 0; i < ii->ii_ndisk; i++)
   1692       1.35  christos 			printf(" %d", ii->ii_index[i]);
   1693       1.35  christos 		printf("\n");
   1694       1.11   thorpej 	}
   1695        1.1   hpeyerl }
   1696        1.1   hpeyerl #endif
   1697      1.134      haad 
   1698      1.146  pgoyette MODULE(MODULE_CLASS_DRIVER, ccd, "dk_subr");
   1699      1.134      haad 
   1700      1.134      haad static int
   1701      1.134      haad ccd_modcmd(modcmd_t cmd, void *arg)
   1702      1.134      haad {
   1703      1.145    martin 	int error = 0;
   1704      1.145    martin #ifdef _MODULE
   1705      1.145    martin 	int bmajor = -1, cmajor = -1;
   1706      1.145    martin #endif
   1707      1.140    jruoho 
   1708      1.140    jruoho 
   1709      1.134      haad 	switch (cmd) {
   1710      1.134      haad 	case MODULE_CMD_INIT:
   1711      1.140    jruoho #ifdef _MODULE
   1712      1.158  christos 		ccdattach(0);
   1713      1.140    jruoho 
   1714      1.158  christos 		error = devsw_attach("ccd", &ccd_bdevsw, &bmajor,
   1715      1.134      haad 		    &ccd_cdevsw, &cmajor);
   1716      1.140    jruoho #endif
   1717      1.134      haad 		break;
   1718      1.134      haad 
   1719      1.134      haad 	case MODULE_CMD_FINI:
   1720      1.140    jruoho #ifdef _MODULE
   1721      1.158  christos 		mutex_enter(&ccd_lock);
   1722      1.159  christos 		if (ccd_nactive) {
   1723      1.159  christos 			mutex_exit(&ccd_lock);
   1724      1.158  christos 			error = EBUSY;
   1725      1.159  christos 		} else {
   1726      1.159  christos 			mutex_exit(&ccd_lock);
   1727      1.158  christos 			error = devsw_detach(&ccd_bdevsw, &ccd_cdevsw);
   1728      1.159  christos 			ccddetach();
   1729      1.159  christos 		}
   1730      1.140    jruoho #endif
   1731      1.134      haad 		break;
   1732      1.134      haad 
   1733      1.134      haad 	case MODULE_CMD_STAT:
   1734      1.134      haad 		return ENOTTY;
   1735      1.134      haad 
   1736      1.134      haad 	default:
   1737      1.134      haad 		return ENOTTY;
   1738      1.134      haad 	}
   1739      1.134      haad 
   1740      1.134      haad 	return error;
   1741      1.134      haad }
   1742      1.144  christos 
   1743      1.144  christos static int
   1744      1.144  christos ccd_units_sysctl(SYSCTLFN_ARGS)
   1745      1.144  christos {
   1746      1.144  christos 	struct sysctlnode node;
   1747      1.144  christos 	struct ccd_softc *sc;
   1748      1.144  christos 	int error, i, nccd, *units;
   1749      1.144  christos 	size_t size;
   1750      1.144  christos 
   1751      1.144  christos 	nccd = 0;
   1752      1.144  christos 	mutex_enter(&ccd_lock);
   1753      1.144  christos 	LIST_FOREACH(sc, &ccds, sc_link)
   1754      1.144  christos 		nccd++;
   1755      1.144  christos 	mutex_exit(&ccd_lock);
   1756      1.144  christos 
   1757      1.144  christos 	if (nccd != 0) {
   1758      1.144  christos 		size = nccd * sizeof(*units);
   1759      1.144  christos 		units = kmem_zalloc(size, KM_SLEEP);
   1760      1.144  christos 		if (units == NULL)
   1761      1.144  christos 			return ENOMEM;
   1762      1.144  christos 
   1763      1.144  christos 		i = 0;
   1764      1.144  christos 		mutex_enter(&ccd_lock);
   1765      1.144  christos 		LIST_FOREACH(sc, &ccds, sc_link) {
   1766      1.144  christos 			if (i >= nccd)
   1767      1.144  christos 				break;
   1768      1.144  christos 			units[i] = sc->sc_unit;
   1769      1.144  christos 		}
   1770      1.144  christos 		mutex_exit(&ccd_lock);
   1771      1.144  christos 	} else {
   1772      1.144  christos 		units = NULL;
   1773      1.144  christos 		size = 0;
   1774      1.144  christos 	}
   1775      1.144  christos 
   1776      1.144  christos 	node = *rnode;
   1777      1.144  christos 	node.sysctl_data = units;
   1778      1.144  christos 	node.sysctl_size = size;
   1779      1.144  christos 
   1780      1.144  christos 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
   1781      1.144  christos 	if (units)
   1782      1.144  christos 		kmem_free(units, size);
   1783      1.144  christos 	return error;
   1784      1.144  christos }
   1785      1.144  christos 
   1786      1.144  christos static int
   1787      1.144  christos ccd_info_sysctl(SYSCTLFN_ARGS)
   1788      1.144  christos {
   1789      1.144  christos 	struct sysctlnode node;
   1790      1.144  christos 	struct ccddiskinfo ccd;
   1791      1.144  christos 	struct ccd_softc *sc;
   1792      1.144  christos 	int unit;
   1793      1.144  christos 
   1794      1.144  christos 	if (newp == NULL || newlen != sizeof(int))
   1795      1.144  christos 		return EINVAL;
   1796      1.144  christos 
   1797      1.144  christos 	unit = *(const int *)newp;
   1798      1.144  christos 	newp = NULL;
   1799      1.144  christos 	newlen = 0;
   1800      1.144  christos 	ccd.ccd_ndisks = ~0;
   1801      1.144  christos 	mutex_enter(&ccd_lock);
   1802      1.144  christos 	LIST_FOREACH(sc, &ccds, sc_link) {
   1803      1.144  christos 		if (sc->sc_unit == unit) {
   1804      1.144  christos 			ccd.ccd_ileave = sc->sc_ileave;
   1805      1.144  christos 			ccd.ccd_size = sc->sc_size;
   1806      1.144  christos 			ccd.ccd_ndisks = sc->sc_nccdisks;
   1807      1.144  christos 			ccd.ccd_flags = sc->sc_flags;
   1808      1.144  christos 			break;
   1809      1.144  christos 		}
   1810      1.144  christos 	}
   1811      1.144  christos 	mutex_exit(&ccd_lock);
   1812      1.144  christos 
   1813      1.144  christos 	if (ccd.ccd_ndisks == ~0)
   1814      1.144  christos 		return ENOENT;
   1815      1.144  christos 
   1816      1.144  christos 	node = *rnode;
   1817      1.144  christos 	node.sysctl_data = &ccd;
   1818      1.144  christos 	node.sysctl_size = sizeof(ccd);
   1819      1.144  christos 
   1820      1.144  christos 	return sysctl_lookup(SYSCTLFN_CALL(&node));
   1821      1.144  christos }
   1822      1.144  christos 
   1823      1.144  christos static int
   1824      1.144  christos ccd_components_sysctl(SYSCTLFN_ARGS)
   1825      1.144  christos {
   1826      1.144  christos 	struct sysctlnode node;
   1827      1.144  christos 	int error, unit;
   1828      1.144  christos 	size_t size;
   1829      1.144  christos 	char *names, *p, *ep;
   1830      1.144  christos 	struct ccd_softc *sc;
   1831      1.144  christos 
   1832      1.144  christos 	if (newp == NULL || newlen != sizeof(int))
   1833      1.144  christos 		return EINVAL;
   1834      1.144  christos 
   1835      1.144  christos 	size = 0;
   1836      1.144  christos 	unit = *(const int *)newp;
   1837      1.144  christos 	newp = NULL;
   1838      1.144  christos 	newlen = 0;
   1839      1.144  christos 	mutex_enter(&ccd_lock);
   1840      1.144  christos 	LIST_FOREACH(sc, &ccds, sc_link)
   1841      1.144  christos 		if (sc->sc_unit == unit) {
   1842      1.144  christos 			for (size_t i = 0; i < sc->sc_nccdisks; i++)
   1843      1.144  christos 				size += strlen(sc->sc_cinfo[i].ci_path) + 1;
   1844      1.144  christos 			break;
   1845      1.144  christos 		}
   1846      1.144  christos 	mutex_exit(&ccd_lock);
   1847      1.144  christos 
   1848      1.144  christos 	if (size == 0)
   1849      1.144  christos 		return ENOENT;
   1850      1.164     skrll 	names = kmem_zalloc(size, KM_SLEEP);
   1851      1.144  christos 	if (names == NULL)
   1852      1.144  christos 		return ENOMEM;
   1853      1.144  christos 
   1854      1.144  christos 	p = names;
   1855      1.144  christos 	ep = names + size;
   1856      1.144  christos 	mutex_enter(&ccd_lock);
   1857      1.144  christos 	LIST_FOREACH(sc, &ccds, sc_link)
   1858      1.144  christos 		if (sc->sc_unit == unit) {
   1859      1.144  christos 			for (size_t i = 0; i < sc->sc_nccdisks; i++) {
   1860      1.144  christos 				char *d = sc->sc_cinfo[i].ci_path;
   1861      1.164     skrll 				while (p < ep && (*p++ = *d++) != '\0')
   1862      1.144  christos 					continue;
   1863      1.144  christos 			}
   1864      1.144  christos 			break;
   1865      1.144  christos 		}
   1866      1.144  christos 	mutex_exit(&ccd_lock);
   1867      1.144  christos 
   1868      1.144  christos 	node = *rnode;
   1869      1.144  christos 	node.sysctl_data = names;
   1870      1.144  christos 	node.sysctl_size = ep - names;
   1871      1.144  christos 
   1872      1.144  christos 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
   1873      1.144  christos 	kmem_free(names, size);
   1874      1.144  christos 	return error;
   1875      1.144  christos }
   1876      1.144  christos 
   1877      1.144  christos SYSCTL_SETUP(sysctl_kern_ccd_setup, "sysctl kern.ccd subtree setup")
   1878      1.144  christos {
   1879      1.144  christos 	const struct sysctlnode *node = NULL;
   1880      1.144  christos 
   1881      1.144  christos 	sysctl_createv(clog, 0, NULL, &node,
   1882      1.144  christos 	    CTLFLAG_PERMANENT,
   1883      1.144  christos 	    CTLTYPE_NODE, "ccd",
   1884      1.144  christos 	    SYSCTL_DESCR("ConCatenated Disk state"),
   1885      1.144  christos 	    NULL, 0, NULL, 0,
   1886      1.144  christos 	    CTL_KERN, CTL_CREATE, CTL_EOL);
   1887      1.144  christos 
   1888      1.144  christos 	if (node == NULL)
   1889      1.144  christos 		return;
   1890      1.144  christos 
   1891      1.144  christos 	sysctl_createv(clog, 0, &node, NULL,
   1892      1.144  christos 	    CTLFLAG_PERMANENT | CTLFLAG_READONLY,
   1893      1.144  christos 	    CTLTYPE_STRUCT, "units",
   1894      1.144  christos 	    SYSCTL_DESCR("List of ccd unit numbers"),
   1895      1.144  christos 	    ccd_units_sysctl, 0, NULL, 0,
   1896      1.144  christos 	    CTL_CREATE, CTL_EOL);
   1897      1.144  christos 	sysctl_createv(clog, 0, &node, NULL,
   1898      1.144  christos 	    CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
   1899      1.144  christos 	    CTLTYPE_STRUCT, "info",
   1900      1.144  christos 	    SYSCTL_DESCR("Information about a CCD unit"),
   1901      1.144  christos 	    ccd_info_sysctl, 0, NULL, 0,
   1902      1.144  christos 	    CTL_CREATE, CTL_EOL);
   1903      1.144  christos 	sysctl_createv(clog, 0, &node, NULL,
   1904      1.144  christos 	    CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
   1905      1.144  christos 	    CTLTYPE_STRUCT, "components",
   1906      1.144  christos 	    SYSCTL_DESCR("Information about CCD components"),
   1907      1.144  christos 	    ccd_components_sysctl, 0, NULL, 0,
   1908      1.144  christos 	    CTL_CREATE, CTL_EOL);
   1909      1.144  christos }
   1910