Home | History | Annotate | Line # | Download | only in i2o
dpti.c revision 1.3.12.2
      1  1.3.12.2  gehenna /*	$NetBSD: dpti.c,v 1.3.12.2 2002/06/20 16:33:00 gehenna Exp $	*/
      2       1.1       ad 
      3       1.1       ad /*-
      4       1.1       ad  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      5       1.1       ad  * All rights reserved.
      6       1.1       ad  *
      7       1.1       ad  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1       ad  * by Andrew Doran.
      9       1.1       ad  *
     10       1.1       ad  * Redistribution and use in source and binary forms, with or without
     11       1.1       ad  * modification, are permitted provided that the following conditions
     12       1.1       ad  * are met:
     13       1.1       ad  * 1. Redistributions of source code must retain the above copyright
     14       1.1       ad  *    notice, this list of conditions and the following disclaimer.
     15       1.1       ad  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1       ad  *    notice, this list of conditions and the following disclaimer in the
     17       1.1       ad  *    documentation and/or other materials provided with the distribution.
     18       1.1       ad  * 3. All advertising materials mentioning features or use of this software
     19       1.1       ad  *    must display the following acknowledgement:
     20       1.1       ad  *        This product includes software developed by the NetBSD
     21       1.1       ad  *        Foundation, Inc. and its contributors.
     22       1.1       ad  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1       ad  *    contributors may be used to endorse or promote products derived
     24       1.1       ad  *    from this software without specific prior written permission.
     25       1.1       ad  *
     26       1.1       ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1       ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1       ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1       ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1       ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1       ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1       ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1       ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1       ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1       ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1       ad  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1       ad  */
     38       1.1       ad 
     39       1.1       ad /*
     40       1.1       ad  * Copyright (c) 1996-2000 Distributed Processing Technology Corporation
     41       1.1       ad  * Copyright (c) 2000 Adaptec Corporation
     42       1.1       ad  * All rights reserved.
     43       1.1       ad  *
     44       1.1       ad  * TERMS AND CONDITIONS OF USE
     45       1.1       ad  *
     46       1.1       ad  * Redistribution and use in source form, with or without modification, are
     47       1.1       ad  * permitted provided that redistributions of source code must retain the
     48       1.1       ad  * above copyright notice, this list of conditions and the following disclaimer.
     49       1.1       ad  *
     50       1.1       ad  * This software is provided `as is' by Adaptec and any express or implied
     51       1.1       ad  * warranties, including, but not limited to, the implied warranties of
     52       1.1       ad  * merchantability and fitness for a particular purpose, are disclaimed. In no
     53       1.1       ad  * event shall Adaptec be liable for any direct, indirect, incidental, special,
     54       1.1       ad  * exemplary or consequential damages (including, but not limited to,
     55       1.1       ad  * procurement of substitute goods or services; loss of use, data, or profits;
     56       1.1       ad  * or business interruptions) however caused and on any theory of liability,
     57       1.1       ad  * whether in contract, strict liability, or tort (including negligence or
     58       1.1       ad  * otherwise) arising in any way out of the use of this driver software, even
     59       1.1       ad  * if advised of the possibility of such damage.
     60       1.1       ad  */
     61       1.1       ad 
     62       1.1       ad /*
     63       1.1       ad  * Adaptec/DPT I2O control interface.
     64       1.1       ad  */
     65       1.3    lukem 
     66       1.3    lukem #include <sys/cdefs.h>
     67  1.3.12.2  gehenna __KERNEL_RCSID(0, "$NetBSD: dpti.c,v 1.3.12.2 2002/06/20 16:33:00 gehenna Exp $");
     68       1.1       ad 
     69       1.1       ad #include "opt_i2o.h"
     70       1.1       ad 
     71       1.1       ad #include <sys/param.h>
     72       1.1       ad #include <sys/systm.h>
     73       1.1       ad #include <sys/kernel.h>
     74       1.1       ad #include <sys/device.h>
     75       1.1       ad #include <sys/queue.h>
     76       1.1       ad #include <sys/proc.h>
     77       1.1       ad #include <sys/endian.h>
     78       1.1       ad #include <sys/malloc.h>
     79       1.1       ad #include <sys/conf.h>
     80       1.1       ad #include <sys/ioctl.h>
     81       1.1       ad 
     82       1.2       ad #include <uvm/uvm_extern.h>
     83       1.2       ad 
     84       1.1       ad #include <machine/bus.h>
     85       1.2       ad #ifdef i386
     86       1.2       ad #include <machine/pio.h>
     87       1.2       ad #endif
     88       1.1       ad 
     89       1.1       ad #include <dev/i2o/i2o.h>
     90       1.1       ad #include <dev/i2o/i2odpt.h>
     91       1.1       ad #include <dev/i2o/iopio.h>
     92       1.1       ad #include <dev/i2o/iopvar.h>
     93       1.1       ad #include <dev/i2o/dptivar.h>
     94       1.1       ad 
     95       1.1       ad #ifdef I2ODEBUG
     96       1.1       ad #define	DPRINTF(x)		printf x
     97       1.1       ad #else
     98       1.1       ad #define	DPRINTF(x)
     99       1.1       ad #endif
    100       1.1       ad 
    101       1.1       ad static struct dpt_sig dpti_sig = {
    102       1.2       ad 	{ 'd', 'P', 't', 'S', 'i', 'G'},
    103       1.2       ad 	SIG_VERSION,
    104       1.2       ad #if defined(i386)
    105       1.2       ad 	PROC_INTEL,
    106       1.2       ad #elif defined(powerpc)
    107       1.2       ad 	PROC_POWERPC,
    108       1.2       ad #elif defined(alpha)
    109       1.2       ad 	PROC_ALPHA,
    110  1.3.12.2  gehenna #elif defined(__mips__)
    111       1.2       ad 	PROC_MIPS,
    112       1.2       ad #elif defined(sparc64)
    113       1.2       ad 	PROC_ULTRASPARC,
    114       1.2       ad #endif
    115       1.2       ad #if defined(i386)
    116       1.2       ad 	PROC_386 | PROC_486 | PROC_PENTIUM | PROC_SEXIUM,
    117       1.2       ad #else
    118       1.2       ad 	0,
    119       1.2       ad #endif
    120       1.2       ad 	FT_HBADRVR,
    121       1.2       ad 	0,
    122       1.2       ad 	OEM_DPT,
    123       1.2       ad 	OS_FREE_BSD,	/* XXX */
    124       1.2       ad 	CAP_ABOVE16MB,
    125       1.2       ad 	DEV_ALL,
    126       1.1       ad 	ADF_ALL_SC5,
    127       1.2       ad 	0,
    128       1.2       ad 	0,
    129       1.2       ad 	DPTI_VERSION,
    130       1.2       ad 	DPTI_REVISION,
    131       1.2       ad 	DPTI_SUBREVISION,
    132       1.2       ad 	DPTI_MONTH,
    133       1.2       ad 	DPTI_DAY,
    134       1.2       ad 	DPTI_YEAR,
    135       1.2       ad 	""		/* Will be filled later */
    136       1.1       ad };
    137       1.1       ad 
    138       1.1       ad void	dpti_attach(struct device *, struct device *, void *);
    139       1.1       ad int	dpti_blinkled(struct dpti_softc *);
    140       1.1       ad int	dpti_ctlrinfo(struct dpti_softc *, u_long, caddr_t);
    141       1.1       ad int	dpti_match(struct device *, struct cfdata *, void *);
    142       1.1       ad int	dpti_passthrough(struct dpti_softc *, caddr_t, struct proc *);
    143       1.1       ad int	dpti_sysinfo(struct dpti_softc *, u_long, caddr_t);
    144       1.1       ad 
    145  1.3.12.1  gehenna dev_type_open(dptiopen);
    146  1.3.12.1  gehenna dev_type_ioctl(dptiioctl);
    147  1.3.12.1  gehenna 
    148  1.3.12.1  gehenna const struct cdevsw dpti_cdevsw = {
    149  1.3.12.1  gehenna 	dptiopen, nullclose, noread, nowrite, dptiioctl,
    150  1.3.12.1  gehenna 	nostop, notty, nopoll, nommap,
    151  1.3.12.1  gehenna };
    152       1.1       ad 
    153       1.1       ad extern struct cfdriver dpti_cd;
    154       1.1       ad 
    155       1.1       ad struct cfattach dpti_ca = {
    156       1.1       ad 	sizeof(struct dpti_softc), dpti_match, dpti_attach
    157       1.1       ad };
    158       1.1       ad 
    159       1.1       ad int
    160       1.1       ad dpti_match(struct device *parent, struct cfdata *match, void *aux)
    161       1.1       ad {
    162       1.1       ad 	struct iop_attach_args *ia;
    163       1.1       ad 	struct iop_softc *iop;
    164       1.1       ad 
    165       1.1       ad 	ia = aux;
    166       1.1       ad 	iop = (struct iop_softc *)parent;
    167       1.1       ad 
    168       1.1       ad 	if (ia->ia_class != I2O_CLASS_ANY || ia->ia_tid != I2O_TID_IOP)
    169       1.1       ad 		return (0);
    170       1.1       ad 
    171       1.1       ad 	if (le16toh(iop->sc_status.orgid) != I2O_ORG_DPT)
    172       1.1       ad 		return (0);
    173       1.1       ad 
    174       1.1       ad 	return (1);
    175       1.1       ad }
    176       1.1       ad 
    177       1.1       ad void
    178       1.1       ad dpti_attach(struct device *parent, struct device *self, void *aux)
    179       1.1       ad {
    180       1.1       ad 	struct iop_softc *iop;
    181       1.1       ad 	struct dpti_softc *sc;
    182       1.1       ad 	struct {
    183       1.1       ad 		struct	i2o_param_op_results pr;
    184       1.1       ad 		struct	i2o_param_read_results prr;
    185       1.1       ad 		struct	i2o_dpt_param_exec_iop_buffers dib;
    186       1.1       ad 	} __attribute__ ((__packed__)) param;
    187       1.1       ad 	int rv;
    188       1.1       ad 
    189       1.1       ad 	sc = (struct dpti_softc *)self;
    190       1.1       ad 	iop = (struct iop_softc *)parent;
    191       1.1       ad 
    192       1.1       ad 	/*
    193       1.1       ad 	 * Tell the world what we are.  The description in the signature
    194       1.1       ad 	 * must be no more than 46 bytes long (see dptivar.h).
    195       1.1       ad 	 */
    196       1.2       ad 	printf(": DPT/Adaptec RAID management interface\n");
    197       1.1       ad 	sprintf(dpti_sig.dsDescription, "NetBSD %s I2O OSM", osrelease);
    198       1.1       ad 
    199       1.1       ad 	rv = iop_field_get_all(iop, I2O_TID_IOP,
    200       1.1       ad 	    I2O_DPT_PARAM_EXEC_IOP_BUFFERS, &param,
    201       1.1       ad 	    sizeof(param), NULL);
    202       1.1       ad 	if (rv != 0)
    203       1.1       ad 		return;
    204       1.1       ad 
    205       1.1       ad 	sc->sc_blinkled = le32toh(param.dib.serialoutputoff) + 8;
    206       1.1       ad }
    207       1.1       ad 
    208       1.1       ad int
    209       1.1       ad dptiopen(dev_t dev, int flag, int mode, struct proc *p)
    210       1.1       ad {
    211       1.1       ad 
    212       1.1       ad 	if (securelevel > 1)
    213       1.1       ad 		return (EPERM);
    214       1.1       ad 	if (device_lookup(&dpti_cd, minor(dev)) == NULL)
    215       1.1       ad 		return (ENXIO);
    216       1.1       ad 
    217       1.1       ad 	return (0);
    218       1.1       ad }
    219       1.1       ad 
    220       1.1       ad int
    221       1.1       ad dptiioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
    222       1.1       ad {
    223       1.1       ad 	struct iop_softc *iop;
    224       1.1       ad 	struct dpti_softc *sc;
    225       1.1       ad 	struct ioctl_pt *pt;
    226       1.2       ad 	int i, size, rv;
    227       1.1       ad 
    228       1.1       ad 	sc = device_lookup(&dpti_cd, minor(dev));
    229       1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    230       1.1       ad 
    231       1.1       ad 	/*
    232       1.1       ad 	 * Currently, we only take ioctls passed down from the Linux
    233       1.1       ad 	 * emulation layer.
    234       1.1       ad 	 */
    235       1.1       ad 	if (cmd == PTIOCLINUX) {
    236       1.1       ad 		pt = (struct ioctl_pt *)data;
    237       1.1       ad 		cmd = pt->com;
    238       1.1       ad 		data = pt->data;
    239       1.1       ad 	} else
    240       1.1       ad 		return (ENOTTY);
    241       1.1       ad 
    242       1.1       ad 	size = IOCPARM_LEN(cmd);
    243       1.1       ad 
    244       1.1       ad 	switch (cmd & 0xffff) {
    245       1.1       ad 	case DPT_SIGNATURE:
    246       1.1       ad 		if (size > sizeof(dpti_sig))
    247       1.1       ad 			size = sizeof(dpti_sig);
    248       1.1       ad 		memcpy(data, &dpti_sig, size);
    249       1.1       ad 		return (0);
    250       1.1       ad 
    251       1.1       ad 	case DPT_CTRLINFO:
    252       1.1       ad 		return (dpti_ctlrinfo(sc, cmd, data));
    253       1.1       ad 
    254       1.1       ad 	case DPT_SYSINFO:
    255       1.1       ad 		return (dpti_sysinfo(sc, cmd, data));
    256       1.1       ad 
    257       1.1       ad 	case DPT_BLINKLED:
    258       1.1       ad 		if ((i = dpti_blinkled(sc)) == -1)
    259       1.1       ad 			i = 0;
    260       1.1       ad 
    261       1.1       ad 		if (size == 0)
    262       1.1       ad 			return (copyout(&i, *(caddr_t *)data, sizeof(i)));
    263       1.1       ad 
    264       1.1       ad 		*(int *)data = i;
    265       1.1       ad 		return (0);
    266       1.1       ad 
    267       1.1       ad 	case DPT_TARGET_BUSY:
    268       1.1       ad 		/*
    269       1.1       ad 		 * XXX This is here to stop linux_machdepioctl() from
    270       1.1       ad 		 * whining about an unknown ioctl.  Really, it should be
    271       1.1       ad 		 * implemented.
    272       1.1       ad 		 */
    273       1.1       ad 		return (EIO);
    274       1.1       ad 
    275       1.1       ad 	case DPT_I2OUSRCMD:
    276       1.2       ad 		if (sc->sc_nactive++ >= 2)
    277       1.2       ad 			tsleep(&sc->sc_nactive, PRIBIO, "dptislp", 0);
    278       1.2       ad 
    279       1.2       ad 		rv = dpti_passthrough(sc, data, p);
    280       1.2       ad 
    281       1.2       ad 		sc->sc_nactive--;
    282       1.2       ad 		wakeup_one(&sc->sc_nactive);
    283       1.2       ad 		return (rv);
    284       1.1       ad 
    285       1.1       ad 	case DPT_I2ORESETCMD:
    286       1.1       ad 		printf("%s: I2ORESETCMD not implemented\n",
    287       1.1       ad 		    sc->sc_dv.dv_xname);
    288       1.2       ad 		return (EOPNOTSUPP);
    289       1.1       ad 
    290       1.1       ad 	case DPT_I2ORESCANCMD:
    291       1.1       ad 		return (iop_reconfigure(iop, 0));
    292       1.1       ad 
    293       1.1       ad 	default:
    294       1.1       ad 		return (ENOTTY);
    295       1.1       ad 	}
    296       1.1       ad }
    297       1.1       ad 
    298       1.1       ad int
    299       1.1       ad dpti_blinkled(struct dpti_softc *sc)
    300       1.1       ad {
    301       1.1       ad 	struct iop_softc *iop;
    302       1.1       ad 	u_int v;
    303       1.1       ad 
    304       1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    305       1.1       ad 
    306       1.1       ad 	v = bus_space_read_1(iop->sc_iot, iop->sc_ioh, sc->sc_blinkled + 0);
    307       1.1       ad 	if (v == 0xbc) {
    308       1.1       ad 		v = bus_space_read_1(iop->sc_iot, iop->sc_ioh,
    309       1.1       ad 		    sc->sc_blinkled + 1);
    310       1.1       ad 		return (v);
    311       1.1       ad 	}
    312       1.1       ad 
    313       1.1       ad 	return (-1);
    314       1.1       ad }
    315       1.1       ad 
    316       1.1       ad int
    317       1.1       ad dpti_ctlrinfo(struct dpti_softc *sc, u_long cmd, caddr_t data)
    318       1.1       ad {
    319       1.2       ad 	struct dpt_ctlrinfo info;
    320       1.1       ad 	struct iop_softc *iop;
    321       1.1       ad 	int rv, i;
    322       1.1       ad 
    323       1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    324       1.1       ad 
    325       1.2       ad 	memset(&info, 0, sizeof(info));
    326       1.1       ad 
    327       1.2       ad 	info.length = sizeof(info) - sizeof(u_int16_t);
    328       1.2       ad 	info.drvrHBAnum = sc->sc_dv.dv_unit;
    329       1.2       ad 	info.baseAddr = iop->sc_memaddr;
    330       1.1       ad 	if ((i = dpti_blinkled(sc)) == -1)
    331       1.1       ad 		i = 0;
    332       1.2       ad 	info.blinkState = i;
    333       1.2       ad 	info.pciBusNum = iop->sc_pcibus;
    334       1.2       ad 	info.pciDeviceNum = iop->sc_pcidev;
    335       1.2       ad 	info.hbaFlags = FLG_OSD_PCI_VALID | FLG_OSD_DMA | FLG_OSD_I2O;
    336       1.2       ad 	info.Interrupt = 10;			/* XXX */
    337       1.1       ad 
    338       1.1       ad 	if (IOCPARM_LEN(cmd) > sizeof(*data)) {
    339       1.2       ad 		memcpy(data, &info, min(sizeof(info), IOCPARM_LEN(cmd)));
    340       1.1       ad 		rv = 0;
    341       1.1       ad 	} else
    342       1.2       ad 		rv = copyout(&info, *(caddr_t *)data, sizeof(info));
    343       1.1       ad 
    344       1.1       ad 	return (rv);
    345       1.1       ad }
    346       1.1       ad 
    347       1.1       ad int
    348       1.1       ad dpti_sysinfo(struct dpti_softc *sc, u_long cmd, caddr_t data)
    349       1.1       ad {
    350       1.2       ad 	struct dpt_sysinfo info;
    351       1.2       ad 	int rv;
    352       1.2       ad #ifdef i386
    353       1.2       ad 	int i, j;
    354       1.2       ad #endif
    355       1.2       ad 
    356       1.2       ad 	memset(&info, 0, sizeof(info));
    357       1.2       ad 
    358       1.2       ad #ifdef i386
    359       1.2       ad 	outb (0x70, 0x12);
    360       1.2       ad 	i = inb(0x71);
    361       1.2       ad 	j = i >> 4;
    362       1.2       ad 	if (i == 0x0f) {
    363       1.2       ad 		outb (0x70, 0x19);
    364       1.2       ad 		j = inb (0x71);
    365       1.2       ad 	}
    366       1.2       ad 	info.drive0CMOS = j;
    367       1.2       ad 
    368       1.2       ad 	j = i & 0x0f;
    369       1.2       ad 	if (i == 0x0f) {
    370       1.2       ad 		outb (0x70, 0x1a);
    371       1.2       ad 		j = inb (0x71);
    372       1.2       ad 	}
    373       1.2       ad 	info.drive1CMOS = j;
    374       1.2       ad 	info.processorFamily = dpti_sig.dsProcessorFamily;
    375       1.2       ad 
    376       1.2       ad 	/*
    377       1.2       ad 	 * Get the conventional memory size from CMOS.
    378       1.2       ad 	 */
    379       1.2       ad 	outb(0x70, 0x16);
    380       1.2       ad 	j = inb(0x71);
    381       1.2       ad 	j <<= 8;
    382       1.2       ad 	outb(0x70, 0x15);
    383       1.2       ad 	j |= inb(0x71);
    384       1.2       ad 	info.conventionalMemSize = j;
    385       1.2       ad 
    386       1.2       ad 	/*
    387       1.2       ad 	 * Get the extended memory size from CMOS.
    388       1.2       ad 	 */
    389       1.2       ad 	outb(0x70, 0x31);
    390       1.2       ad 	j = inb(0x71);
    391       1.2       ad 	j <<= 8;
    392       1.2       ad 	outb(0x70, 0x30);
    393       1.2       ad 	j |= inb(0x71);
    394       1.2       ad 	info.extendedMemSize = j;
    395       1.2       ad 
    396       1.2       ad 	switch (cpu_class) {
    397       1.2       ad 	case CPUCLASS_386:
    398       1.2       ad 		info.processorType = PROC_386;
    399       1.2       ad 		break;
    400       1.2       ad 	case CPUCLASS_486:
    401       1.2       ad 		info.processorType = PROC_486;
    402       1.2       ad 		break;
    403       1.2       ad 	case CPUCLASS_586:
    404       1.2       ad 		info.processorType = PROC_PENTIUM;
    405       1.2       ad 		break;
    406       1.2       ad 	case CPUCLASS_686:
    407       1.2       ad 	default:
    408       1.2       ad 		info.processorType = PROC_SEXIUM;
    409       1.2       ad 		break;
    410       1.2       ad 	}
    411       1.2       ad 
    412       1.2       ad 	info.flags = SI_CMOS_Valid | SI_BusTypeValid |
    413       1.2       ad 	    SI_MemorySizeValid | SI_NO_SmartROM;
    414       1.2       ad #else
    415       1.2       ad 	info.flags = SI_BusTypeValid | SI_NO_SmartROM;
    416       1.2       ad #endif
    417       1.2       ad 
    418       1.2       ad 	info.busType = SI_PCI_BUS;
    419       1.1       ad 
    420       1.1       ad 	/*
    421       1.2       ad 	 * Copy out the info structure to the user.
    422       1.1       ad 	 */
    423       1.2       ad 	if (IOCPARM_LEN(cmd) > sizeof(*data)) {
    424       1.2       ad 		memcpy(data, &info, min(sizeof(info), IOCPARM_LEN(cmd)));
    425       1.2       ad 		rv = 0;
    426       1.2       ad 	} else
    427       1.2       ad 		rv = copyout(&info, *(caddr_t *)data, sizeof(info));
    428       1.2       ad 
    429       1.2       ad 	return (rv);
    430       1.1       ad }
    431       1.1       ad 
    432       1.1       ad int
    433       1.1       ad dpti_passthrough(struct dpti_softc *sc, caddr_t data, struct proc *proc)
    434       1.1       ad {
    435       1.1       ad 	struct iop_softc *iop;
    436       1.1       ad 	struct i2o_msg mh, *mf;
    437       1.1       ad 	struct i2o_reply rh;
    438       1.1       ad 	struct iop_msg *im;
    439       1.1       ad 	struct dpti_ptbuf bufs[IOP_MAX_MSG_XFERS];
    440       1.1       ad 	u_int32_t mbtmp[IOP_MAX_MSG_SIZE / sizeof(u_int32_t)];
    441       1.1       ad 	u_int32_t rbtmp[IOP_MAX_MSG_SIZE / sizeof(u_int32_t)];
    442       1.2       ad 	int rv, msgsize, repsize, sgoff, i, mapped, nbuf, nfrag, j, sz;
    443       1.2       ad 	u_int32_t *p, *pmax, *pstart;
    444       1.1       ad 
    445       1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    446       1.2       ad 	im = NULL;
    447       1.1       ad 
    448       1.1       ad 	if ((rv = dpti_blinkled(sc)) != -1) {
    449       1.1       ad 		if (rv != 0) {
    450       1.1       ad 			printf("%s: adapter blinkled = 0x%02x\n",
    451       1.1       ad 			    sc->sc_dv.dv_xname, rv);
    452       1.1       ad 			return (EIO);
    453       1.1       ad 		}
    454       1.1       ad 	}
    455       1.1       ad 
    456       1.1       ad 	/*
    457       1.1       ad 	 * Copy in the message frame header and determine the size of the
    458       1.1       ad 	 * full message frame.
    459       1.1       ad 	 */
    460       1.1       ad 	if ((rv = copyin(data, &mh, sizeof(mh))) != 0) {
    461       1.1       ad 		DPRINTF(("%s: message copyin failed\n",
    462       1.1       ad 		    sc->sc_dv.dv_xname));
    463       1.1       ad 		return (rv);
    464       1.1       ad 	}
    465       1.1       ad 
    466       1.1       ad 	msgsize = (mh.msgflags >> 14) & ~3;
    467       1.1       ad 	if (msgsize < sizeof(mh) || msgsize >= IOP_MAX_MSG_SIZE) {
    468       1.1       ad 		DPRINTF(("%s: bad message frame size\n",
    469       1.1       ad 		    sc->sc_dv.dv_xname));
    470       1.1       ad 		return (EINVAL);
    471       1.1       ad 	}
    472       1.1       ad 
    473       1.1       ad 	/*
    474       1.1       ad 	 * Handle special commands.
    475       1.1       ad 	 */
    476       1.1       ad 	switch (mh.msgfunc >> 24) {
    477       1.1       ad 	case I2O_EXEC_IOP_RESET:
    478       1.2       ad 		printf("%s: I2O_EXEC_IOP_RESET not implemented\n",
    479       1.1       ad 		    sc->sc_dv.dv_xname);
    480       1.2       ad 		return (EOPNOTSUPP);
    481       1.1       ad 
    482       1.1       ad 	case I2O_EXEC_OUTBOUND_INIT:
    483       1.2       ad 		printf("%s: I2O_EXEC_OUTBOUND_INIT not implemented\n",
    484       1.1       ad 		    sc->sc_dv.dv_xname);
    485       1.2       ad 		return (EOPNOTSUPP);
    486       1.1       ad 
    487       1.1       ad 	case I2O_EXEC_SYS_TAB_SET:
    488       1.2       ad 		printf("%s: I2O_EXEC_SYS_TAB_SET not implemented\n",
    489       1.1       ad 		    sc->sc_dv.dv_xname);
    490       1.2       ad 		return (EOPNOTSUPP);
    491       1.1       ad 
    492       1.1       ad 	case I2O_EXEC_STATUS_GET:
    493       1.2       ad 		if ((rv = iop_status_get(iop, 0)) == 0)
    494       1.2       ad 			rv = copyout(&iop->sc_status, data + msgsize,
    495       1.2       ad 			    sizeof(iop->sc_status));
    496       1.1       ad 		return (rv);
    497       1.1       ad 	}
    498       1.1       ad 
    499       1.1       ad 	/*
    500       1.1       ad 	 * Copy in the full message frame.
    501       1.1       ad 	 */
    502       1.1       ad 	if ((rv = copyin(data, mbtmp, msgsize)) != 0) {
    503       1.1       ad 		DPRINTF(("%s: full message copyin failed\n",
    504       1.1       ad 		    sc->sc_dv.dv_xname));
    505       1.1       ad 		return (rv);
    506       1.1       ad 	}
    507       1.1       ad 
    508       1.1       ad 	/*
    509       1.1       ad 	 * Determine the size of the reply frame, and copy it in.
    510       1.1       ad 	 */
    511       1.1       ad 	if ((rv = copyin(data + msgsize, &rh, sizeof(rh))) != 0) {
    512       1.1       ad 		DPRINTF(("%s: reply copyin failed\n",
    513       1.1       ad 		    sc->sc_dv.dv_xname));
    514       1.1       ad 		return (rv);
    515       1.1       ad 	}
    516       1.1       ad 
    517       1.1       ad 	repsize = (rh.msgflags >> 14) & ~3;
    518       1.1       ad 	if (repsize < sizeof(rh) || repsize >= IOP_MAX_MSG_SIZE) {
    519       1.1       ad 		DPRINTF(("%s: bad reply header size\n",
    520       1.1       ad 		    sc->sc_dv.dv_xname));
    521       1.1       ad 		return (EINVAL);
    522       1.1       ad 	}
    523       1.1       ad 
    524       1.1       ad 	if ((rv = copyin(data + msgsize, rbtmp, repsize)) != 0) {
    525       1.1       ad 		DPRINTF(("%s: reply too large\n", sc->sc_dv.dv_xname));
    526       1.1       ad 		return (rv);
    527       1.1       ad 	}
    528       1.1       ad 
    529       1.1       ad 	/*
    530       1.1       ad 	 * If the message has a scatter gather list, it must be comprised of
    531       1.1       ad 	 * simple elements.  If any one transfer contains multiple segments,
    532       1.1       ad 	 * we allocate a temporary buffer for it; otherwise, the buffer will
    533       1.2       ad 	 * be mapped directly.
    534       1.1       ad 	 */
    535       1.1       ad 	if ((sgoff = ((mh.msgflags >> 4) & 15)) != 0) {
    536       1.1       ad 		if ((sgoff + 2) > (msgsize >> 2)) {
    537       1.1       ad 			DPRINTF(("%s: invalid message size fields\n",
    538       1.1       ad 			    sc->sc_dv.dv_xname));
    539       1.1       ad 			return (EINVAL);
    540       1.1       ad 		}
    541       1.2       ad 
    542       1.2       ad 		memset(bufs, 0, sizeof(bufs));
    543       1.1       ad 	} else
    544       1.1       ad 		nbuf = -1;
    545       1.1       ad 
    546       1.2       ad 	rv = EINVAL;
    547       1.2       ad 
    548       1.1       ad 	if (sgoff != 0) {
    549       1.1       ad 		p = mbtmp + sgoff;
    550       1.2       ad 		pmax = mbtmp + (msgsize >> 2) - 2;
    551       1.1       ad 
    552       1.2       ad 		for (nbuf = 0; nbuf < IOP_MAX_MSG_XFERS; nbuf++, p += 2) {
    553       1.2       ad 			if (p > pmax) {
    554       1.1       ad 				DPRINTF(("%s: invalid SGL (1)\n",
    555       1.1       ad 				    sc->sc_dv.dv_xname));
    556       1.2       ad 				goto bad;
    557       1.1       ad 			}
    558       1.1       ad 
    559       1.1       ad 			if ((p[0] & 0x30000000) != I2O_SGL_SIMPLE) {
    560       1.1       ad 				DPRINTF(("%s: invalid SGL (2)\n",
    561       1.1       ad 				    sc->sc_dv.dv_xname));
    562       1.2       ad 				goto bad;
    563       1.1       ad 			}
    564       1.1       ad 
    565       1.1       ad 			bufs[nbuf].db_out = (p[0] & I2O_SGL_DATA_OUT) != 0;
    566       1.2       ad 			bufs[nbuf].db_ptr = NULL;
    567       1.1       ad 
    568       1.1       ad 			if ((p[0] & I2O_SGL_END_BUFFER) != 0) {
    569       1.1       ad 				if ((p[0] & 0x00ffffff) > IOP_MAX_XFER) {
    570       1.1       ad 					DPRINTF(("%s: buffer too large\n",
    571       1.1       ad 					    sc->sc_dv.dv_xname));
    572       1.2       ad 					goto bad;
    573       1.1       ad 				}
    574       1.1       ad 
    575       1.1       ad 				bufs[nbuf].db_ptr = (caddr_t)p[1];
    576       1.1       ad 				bufs[nbuf].db_proc = proc;
    577       1.1       ad 				bufs[nbuf].db_size = p[0] & 0x00ffffff;
    578       1.1       ad 
    579       1.1       ad 				if ((p[0] & I2O_SGL_END) != 0)
    580       1.1       ad 					break;
    581       1.1       ad 
    582       1.1       ad 				continue;
    583       1.1       ad 			}
    584       1.1       ad 
    585       1.2       ad 			/*
    586       1.2       ad 			 * The buffer has multiple segments.  Determine the
    587       1.2       ad 			 * total size.
    588       1.2       ad 			 */
    589       1.2       ad 			nfrag = 0;
    590       1.2       ad 			sz = 0;
    591       1.2       ad 			for (pstart = p; p <= pmax; p += 2) {
    592       1.2       ad 				if (nfrag == DPTI_MAX_SEGS) {
    593       1.2       ad 					DPRINTF(("%s: too many segments\n",
    594       1.2       ad 					    sc->sc_dv.dv_xname));
    595       1.2       ad 					goto bad;
    596       1.2       ad 				}
    597       1.2       ad 
    598       1.2       ad 				bufs[nbuf].db_frags[nfrag].iov_len =
    599       1.2       ad 				    p[0] & 0x00ffffff;
    600       1.2       ad 				bufs[nbuf].db_frags[nfrag].iov_base =
    601       1.2       ad 				    (void *)p[1];
    602       1.2       ad 
    603       1.2       ad 				sz += p[0] & 0x00ffffff;
    604       1.2       ad 				nfrag++;
    605       1.2       ad 
    606       1.2       ad 				if ((p[0] & I2O_SGL_END) != 0) {
    607       1.2       ad 					if ((p[0] & I2O_SGL_END_BUFFER) == 0) {
    608       1.2       ad 						DPRINTF((
    609       1.2       ad 						    "%s: invalid SGL (3)\n",
    610       1.2       ad 						    sc->sc_dv.dv_xname));
    611       1.2       ad 						goto bad;
    612       1.2       ad 					}
    613       1.2       ad 					break;
    614       1.2       ad 				}
    615       1.2       ad 				if ((p[0] & I2O_SGL_END_BUFFER) != 0)
    616       1.2       ad 					break;
    617       1.2       ad 			}
    618       1.2       ad 			bufs[nbuf].db_nfrag = nfrag;
    619       1.2       ad 
    620       1.2       ad 			if (p > pmax) {
    621       1.2       ad 				DPRINTF(("%s: invalid SGL (4)\n",
    622       1.2       ad 				    sc->sc_dv.dv_xname));
    623       1.2       ad 				goto bad;
    624       1.2       ad 			}
    625       1.2       ad 
    626       1.2       ad 			if (sz > IOP_MAX_XFER) {
    627       1.2       ad 				DPRINTF(("%s: buffer too large\n",
    628       1.2       ad 				    sc->sc_dv.dv_xname));
    629       1.2       ad 				goto bad;
    630       1.2       ad 			}
    631       1.2       ad 
    632       1.2       ad 			bufs[nbuf].db_size = sz;
    633       1.2       ad 			bufs[nbuf].db_ptr = malloc(sz, M_DEVBUF, M_WAITOK);
    634       1.2       ad 			if (bufs[nbuf].db_ptr == NULL) {
    635       1.2       ad 				DPRINTF(("%s: allocation failure\n",
    636       1.2       ad 				    sc->sc_dv.dv_xname));
    637       1.2       ad 				rv = ENOMEM;
    638       1.2       ad 				goto bad;
    639       1.2       ad 			}
    640       1.2       ad 
    641       1.2       ad 			for (i = 0, sz = 0; i < bufs[nbuf].db_nfrag; i++) {
    642       1.2       ad 				rv = copyin(bufs[nbuf].db_frags[i].iov_base,
    643       1.2       ad 				    bufs[nbuf].db_ptr + sz,
    644       1.2       ad 				    bufs[nbuf].db_frags[i].iov_len);
    645       1.2       ad 				if (rv != 0) {
    646       1.2       ad 					DPRINTF(("%s: frag copyin\n",
    647       1.2       ad 					    sc->sc_dv.dv_xname));
    648       1.2       ad 					goto bad;
    649       1.2       ad 				}
    650       1.2       ad 				sz += bufs[nbuf].db_frags[i].iov_len;
    651       1.2       ad 			}
    652       1.2       ad 
    653       1.2       ad 			if ((p[0] & I2O_SGL_END) != 0)
    654       1.2       ad 				break;
    655       1.1       ad 		}
    656       1.1       ad 
    657       1.1       ad 		if (nbuf == IOP_MAX_MSG_XFERS) {
    658       1.1       ad 			DPRINTF(("%s: too many transfers\n",
    659       1.1       ad 			    sc->sc_dv.dv_xname));
    660       1.2       ad 			goto bad;
    661       1.1       ad 		}
    662       1.1       ad 	}
    663       1.1       ad 
    664       1.1       ad 	/*
    665       1.1       ad 	 * Allocate a wrapper, and adjust the message header fields to
    666       1.1       ad 	 * indicate that no scatter-gather list is currently present.
    667       1.1       ad 	 */
    668       1.2       ad 	mapped = 0;
    669       1.2       ad 
    670       1.1       ad 	im = iop_msg_alloc(iop, IM_WAIT | IM_NOSTATUS);
    671       1.1       ad 	im->im_rb = (struct i2o_reply *)rbtmp;
    672       1.1       ad 	mf = (struct i2o_msg *)mbtmp;
    673       1.1       ad 	mf->msgictx = IOP_ICTX;
    674       1.1       ad 	mf->msgtctx = im->im_tctx;
    675       1.1       ad 
    676       1.1       ad 	if (sgoff != 0)
    677       1.1       ad 		mf->msgflags = (mf->msgflags & 0xff0f) | (sgoff << 16);
    678       1.1       ad 
    679       1.1       ad 	/*
    680       1.1       ad 	 * Map the data transfer(s).
    681       1.1       ad 	 */
    682       1.1       ad 	for (i = 0; i <= nbuf; i++) {
    683       1.1       ad 		rv = iop_msg_map(iop, im, mbtmp, bufs[i].db_ptr,
    684       1.1       ad 		    bufs[i].db_size, bufs[i].db_out, bufs[i].db_proc);
    685       1.1       ad 		if (rv != 0) {
    686       1.2       ad 			DPRINTF(("%s: msg_map failed, rv = %d\n",
    687       1.2       ad 			    sc->sc_dv.dv_xname, rv));
    688       1.1       ad 			goto bad;
    689       1.1       ad 		}
    690       1.1       ad 		mapped = 1;
    691       1.1       ad 	}
    692       1.1       ad 
    693       1.1       ad 	/*
    694       1.1       ad 	 * Start the command and sleep until it completes.
    695       1.1       ad 	 */
    696       1.1       ad 	if ((rv = iop_msg_post(iop, im, mbtmp, 5*60*1000)) != 0)
    697       1.1       ad 		goto bad;
    698       1.1       ad 
    699       1.1       ad 	/*
    700       1.1       ad 	 * Copy out the reply frame.
    701       1.1       ad 	 */
    702       1.1       ad 	if ((rv = copyout(rbtmp, data + msgsize, repsize)) != 0)
    703       1.1       ad 		DPRINTF(("%s: reply copyout() failed\n",
    704       1.1       ad 		    sc->sc_dv.dv_xname));
    705       1.1       ad 
    706       1.1       ad  bad:
    707       1.2       ad 	/*
    708       1.2       ad 	 * Free resources and return to the caller.
    709       1.2       ad 	 */
    710       1.2       ad 	if (im != NULL) {
    711       1.2       ad 		if (mapped)
    712       1.2       ad 			iop_msg_unmap(iop, im);
    713       1.2       ad 		iop_msg_free(iop, im);
    714       1.2       ad 	}
    715       1.2       ad 
    716       1.2       ad 	for (i = 0; i <= nbuf; i++) {
    717       1.2       ad 		if (bufs[i].db_proc != NULL)
    718       1.2       ad 			continue;
    719       1.2       ad 
    720       1.2       ad 		if (!bufs[i].db_out && rv == 0) {
    721       1.2       ad 			for (j = 0, sz = 0; j < bufs[i].db_nfrag; j++) {
    722       1.2       ad 				rv = copyout(bufs[i].db_ptr + sz,
    723       1.2       ad 				    bufs[i].db_frags[j].iov_base,
    724       1.2       ad 				    bufs[i].db_frags[j].iov_len);
    725       1.2       ad 				if (rv != 0)
    726       1.2       ad 					break;
    727       1.2       ad 				sz += bufs[i].db_frags[j].iov_len;
    728       1.2       ad 			}
    729       1.2       ad 		}
    730       1.1       ad 
    731       1.2       ad 		if (bufs[i].db_ptr != NULL)
    732       1.2       ad 			free(bufs[i].db_ptr, M_DEVBUF);
    733       1.2       ad 	}
    734       1.1       ad 
    735       1.1       ad 	return (rv);
    736       1.1       ad }
    737