Home | History | Annotate | Line # | Download | only in i2o
dpti.c revision 1.7
      1  1.7  thorpej /*	$NetBSD: dpti.c,v 1.7 2002/09/30 21:11:45 thorpej 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.7  thorpej __KERNEL_RCSID(0, "$NetBSD: dpti.c,v 1.7 2002/09/30 21:11:45 thorpej 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.4  thorpej #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.5  gehenna dev_type_open(dptiopen);
    146  1.5  gehenna dev_type_ioctl(dptiioctl);
    147  1.5  gehenna 
    148  1.5  gehenna const struct cdevsw dpti_cdevsw = {
    149  1.5  gehenna 	dptiopen, nullclose, noread, nowrite, dptiioctl,
    150  1.5  gehenna 	nostop, notty, nopoll, nommap,
    151  1.5  gehenna };
    152  1.1       ad 
    153  1.1       ad extern struct cfdriver dpti_cd;
    154  1.1       ad 
    155  1.7  thorpej CFATTACH_DECL(dpti, sizeof(struct dpti_softc),
    156  1.7  thorpej     dpti_match, dpti_attach, NULL, NULL)
    157  1.1       ad 
    158  1.1       ad int
    159  1.1       ad dpti_match(struct device *parent, struct cfdata *match, void *aux)
    160  1.1       ad {
    161  1.1       ad 	struct iop_attach_args *ia;
    162  1.1       ad 	struct iop_softc *iop;
    163  1.1       ad 
    164  1.1       ad 	ia = aux;
    165  1.1       ad 	iop = (struct iop_softc *)parent;
    166  1.1       ad 
    167  1.1       ad 	if (ia->ia_class != I2O_CLASS_ANY || ia->ia_tid != I2O_TID_IOP)
    168  1.1       ad 		return (0);
    169  1.1       ad 
    170  1.1       ad 	if (le16toh(iop->sc_status.orgid) != I2O_ORG_DPT)
    171  1.1       ad 		return (0);
    172  1.1       ad 
    173  1.1       ad 	return (1);
    174  1.1       ad }
    175  1.1       ad 
    176  1.1       ad void
    177  1.1       ad dpti_attach(struct device *parent, struct device *self, void *aux)
    178  1.1       ad {
    179  1.1       ad 	struct iop_softc *iop;
    180  1.1       ad 	struct dpti_softc *sc;
    181  1.1       ad 	struct {
    182  1.1       ad 		struct	i2o_param_op_results pr;
    183  1.1       ad 		struct	i2o_param_read_results prr;
    184  1.1       ad 		struct	i2o_dpt_param_exec_iop_buffers dib;
    185  1.1       ad 	} __attribute__ ((__packed__)) param;
    186  1.1       ad 	int rv;
    187  1.1       ad 
    188  1.1       ad 	sc = (struct dpti_softc *)self;
    189  1.1       ad 	iop = (struct iop_softc *)parent;
    190  1.1       ad 
    191  1.1       ad 	/*
    192  1.1       ad 	 * Tell the world what we are.  The description in the signature
    193  1.1       ad 	 * must be no more than 46 bytes long (see dptivar.h).
    194  1.1       ad 	 */
    195  1.2       ad 	printf(": DPT/Adaptec RAID management interface\n");
    196  1.1       ad 	sprintf(dpti_sig.dsDescription, "NetBSD %s I2O OSM", osrelease);
    197  1.1       ad 
    198  1.1       ad 	rv = iop_field_get_all(iop, I2O_TID_IOP,
    199  1.1       ad 	    I2O_DPT_PARAM_EXEC_IOP_BUFFERS, &param,
    200  1.1       ad 	    sizeof(param), NULL);
    201  1.1       ad 	if (rv != 0)
    202  1.1       ad 		return;
    203  1.1       ad 
    204  1.1       ad 	sc->sc_blinkled = le32toh(param.dib.serialoutputoff) + 8;
    205  1.1       ad }
    206  1.1       ad 
    207  1.1       ad int
    208  1.1       ad dptiopen(dev_t dev, int flag, int mode, struct proc *p)
    209  1.1       ad {
    210  1.1       ad 
    211  1.1       ad 	if (securelevel > 1)
    212  1.1       ad 		return (EPERM);
    213  1.1       ad 	if (device_lookup(&dpti_cd, minor(dev)) == NULL)
    214  1.1       ad 		return (ENXIO);
    215  1.1       ad 
    216  1.1       ad 	return (0);
    217  1.1       ad }
    218  1.1       ad 
    219  1.1       ad int
    220  1.1       ad dptiioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
    221  1.1       ad {
    222  1.1       ad 	struct iop_softc *iop;
    223  1.1       ad 	struct dpti_softc *sc;
    224  1.1       ad 	struct ioctl_pt *pt;
    225  1.2       ad 	int i, size, rv;
    226  1.1       ad 
    227  1.1       ad 	sc = device_lookup(&dpti_cd, minor(dev));
    228  1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    229  1.1       ad 
    230  1.1       ad 	/*
    231  1.1       ad 	 * Currently, we only take ioctls passed down from the Linux
    232  1.1       ad 	 * emulation layer.
    233  1.1       ad 	 */
    234  1.1       ad 	if (cmd == PTIOCLINUX) {
    235  1.1       ad 		pt = (struct ioctl_pt *)data;
    236  1.1       ad 		cmd = pt->com;
    237  1.1       ad 		data = pt->data;
    238  1.1       ad 	} else
    239  1.1       ad 		return (ENOTTY);
    240  1.1       ad 
    241  1.1       ad 	size = IOCPARM_LEN(cmd);
    242  1.1       ad 
    243  1.1       ad 	switch (cmd & 0xffff) {
    244  1.1       ad 	case DPT_SIGNATURE:
    245  1.1       ad 		if (size > sizeof(dpti_sig))
    246  1.1       ad 			size = sizeof(dpti_sig);
    247  1.1       ad 		memcpy(data, &dpti_sig, size);
    248  1.1       ad 		return (0);
    249  1.1       ad 
    250  1.1       ad 	case DPT_CTRLINFO:
    251  1.1       ad 		return (dpti_ctlrinfo(sc, cmd, data));
    252  1.1       ad 
    253  1.1       ad 	case DPT_SYSINFO:
    254  1.1       ad 		return (dpti_sysinfo(sc, cmd, data));
    255  1.1       ad 
    256  1.1       ad 	case DPT_BLINKLED:
    257  1.1       ad 		if ((i = dpti_blinkled(sc)) == -1)
    258  1.1       ad 			i = 0;
    259  1.1       ad 
    260  1.1       ad 		if (size == 0)
    261  1.1       ad 			return (copyout(&i, *(caddr_t *)data, sizeof(i)));
    262  1.1       ad 
    263  1.1       ad 		*(int *)data = i;
    264  1.1       ad 		return (0);
    265  1.1       ad 
    266  1.1       ad 	case DPT_TARGET_BUSY:
    267  1.1       ad 		/*
    268  1.1       ad 		 * XXX This is here to stop linux_machdepioctl() from
    269  1.1       ad 		 * whining about an unknown ioctl.  Really, it should be
    270  1.1       ad 		 * implemented.
    271  1.1       ad 		 */
    272  1.1       ad 		return (EIO);
    273  1.1       ad 
    274  1.1       ad 	case DPT_I2OUSRCMD:
    275  1.2       ad 		if (sc->sc_nactive++ >= 2)
    276  1.2       ad 			tsleep(&sc->sc_nactive, PRIBIO, "dptislp", 0);
    277  1.2       ad 
    278  1.2       ad 		rv = dpti_passthrough(sc, data, p);
    279  1.2       ad 
    280  1.2       ad 		sc->sc_nactive--;
    281  1.2       ad 		wakeup_one(&sc->sc_nactive);
    282  1.2       ad 		return (rv);
    283  1.1       ad 
    284  1.1       ad 	case DPT_I2ORESETCMD:
    285  1.1       ad 		printf("%s: I2ORESETCMD not implemented\n",
    286  1.1       ad 		    sc->sc_dv.dv_xname);
    287  1.2       ad 		return (EOPNOTSUPP);
    288  1.1       ad 
    289  1.1       ad 	case DPT_I2ORESCANCMD:
    290  1.1       ad 		return (iop_reconfigure(iop, 0));
    291  1.1       ad 
    292  1.1       ad 	default:
    293  1.1       ad 		return (ENOTTY);
    294  1.1       ad 	}
    295  1.1       ad }
    296  1.1       ad 
    297  1.1       ad int
    298  1.1       ad dpti_blinkled(struct dpti_softc *sc)
    299  1.1       ad {
    300  1.1       ad 	struct iop_softc *iop;
    301  1.1       ad 	u_int v;
    302  1.1       ad 
    303  1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    304  1.1       ad 
    305  1.1       ad 	v = bus_space_read_1(iop->sc_iot, iop->sc_ioh, sc->sc_blinkled + 0);
    306  1.1       ad 	if (v == 0xbc) {
    307  1.1       ad 		v = bus_space_read_1(iop->sc_iot, iop->sc_ioh,
    308  1.1       ad 		    sc->sc_blinkled + 1);
    309  1.1       ad 		return (v);
    310  1.1       ad 	}
    311  1.1       ad 
    312  1.1       ad 	return (-1);
    313  1.1       ad }
    314  1.1       ad 
    315  1.1       ad int
    316  1.1       ad dpti_ctlrinfo(struct dpti_softc *sc, u_long cmd, caddr_t data)
    317  1.1       ad {
    318  1.2       ad 	struct dpt_ctlrinfo info;
    319  1.1       ad 	struct iop_softc *iop;
    320  1.1       ad 	int rv, i;
    321  1.1       ad 
    322  1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    323  1.1       ad 
    324  1.2       ad 	memset(&info, 0, sizeof(info));
    325  1.1       ad 
    326  1.2       ad 	info.length = sizeof(info) - sizeof(u_int16_t);
    327  1.2       ad 	info.drvrHBAnum = sc->sc_dv.dv_unit;
    328  1.2       ad 	info.baseAddr = iop->sc_memaddr;
    329  1.1       ad 	if ((i = dpti_blinkled(sc)) == -1)
    330  1.1       ad 		i = 0;
    331  1.2       ad 	info.blinkState = i;
    332  1.2       ad 	info.pciBusNum = iop->sc_pcibus;
    333  1.2       ad 	info.pciDeviceNum = iop->sc_pcidev;
    334  1.2       ad 	info.hbaFlags = FLG_OSD_PCI_VALID | FLG_OSD_DMA | FLG_OSD_I2O;
    335  1.2       ad 	info.Interrupt = 10;			/* XXX */
    336  1.1       ad 
    337  1.1       ad 	if (IOCPARM_LEN(cmd) > sizeof(*data)) {
    338  1.2       ad 		memcpy(data, &info, min(sizeof(info), IOCPARM_LEN(cmd)));
    339  1.1       ad 		rv = 0;
    340  1.1       ad 	} else
    341  1.2       ad 		rv = copyout(&info, *(caddr_t *)data, sizeof(info));
    342  1.1       ad 
    343  1.1       ad 	return (rv);
    344  1.1       ad }
    345  1.1       ad 
    346  1.1       ad int
    347  1.1       ad dpti_sysinfo(struct dpti_softc *sc, u_long cmd, caddr_t data)
    348  1.1       ad {
    349  1.2       ad 	struct dpt_sysinfo info;
    350  1.2       ad 	int rv;
    351  1.2       ad #ifdef i386
    352  1.2       ad 	int i, j;
    353  1.2       ad #endif
    354  1.2       ad 
    355  1.2       ad 	memset(&info, 0, sizeof(info));
    356  1.2       ad 
    357  1.2       ad #ifdef i386
    358  1.2       ad 	outb (0x70, 0x12);
    359  1.2       ad 	i = inb(0x71);
    360  1.2       ad 	j = i >> 4;
    361  1.2       ad 	if (i == 0x0f) {
    362  1.2       ad 		outb (0x70, 0x19);
    363  1.2       ad 		j = inb (0x71);
    364  1.2       ad 	}
    365  1.2       ad 	info.drive0CMOS = j;
    366  1.2       ad 
    367  1.2       ad 	j = i & 0x0f;
    368  1.2       ad 	if (i == 0x0f) {
    369  1.2       ad 		outb (0x70, 0x1a);
    370  1.2       ad 		j = inb (0x71);
    371  1.2       ad 	}
    372  1.2       ad 	info.drive1CMOS = j;
    373  1.2       ad 	info.processorFamily = dpti_sig.dsProcessorFamily;
    374  1.2       ad 
    375  1.2       ad 	/*
    376  1.2       ad 	 * Get the conventional memory size from CMOS.
    377  1.2       ad 	 */
    378  1.2       ad 	outb(0x70, 0x16);
    379  1.2       ad 	j = inb(0x71);
    380  1.2       ad 	j <<= 8;
    381  1.2       ad 	outb(0x70, 0x15);
    382  1.2       ad 	j |= inb(0x71);
    383  1.2       ad 	info.conventionalMemSize = j;
    384  1.2       ad 
    385  1.2       ad 	/*
    386  1.2       ad 	 * Get the extended memory size from CMOS.
    387  1.2       ad 	 */
    388  1.2       ad 	outb(0x70, 0x31);
    389  1.2       ad 	j = inb(0x71);
    390  1.2       ad 	j <<= 8;
    391  1.2       ad 	outb(0x70, 0x30);
    392  1.2       ad 	j |= inb(0x71);
    393  1.2       ad 	info.extendedMemSize = j;
    394  1.2       ad 
    395  1.2       ad 	switch (cpu_class) {
    396  1.2       ad 	case CPUCLASS_386:
    397  1.2       ad 		info.processorType = PROC_386;
    398  1.2       ad 		break;
    399  1.2       ad 	case CPUCLASS_486:
    400  1.2       ad 		info.processorType = PROC_486;
    401  1.2       ad 		break;
    402  1.2       ad 	case CPUCLASS_586:
    403  1.2       ad 		info.processorType = PROC_PENTIUM;
    404  1.2       ad 		break;
    405  1.2       ad 	case CPUCLASS_686:
    406  1.2       ad 	default:
    407  1.2       ad 		info.processorType = PROC_SEXIUM;
    408  1.2       ad 		break;
    409  1.2       ad 	}
    410  1.2       ad 
    411  1.2       ad 	info.flags = SI_CMOS_Valid | SI_BusTypeValid |
    412  1.2       ad 	    SI_MemorySizeValid | SI_NO_SmartROM;
    413  1.2       ad #else
    414  1.2       ad 	info.flags = SI_BusTypeValid | SI_NO_SmartROM;
    415  1.2       ad #endif
    416  1.2       ad 
    417  1.2       ad 	info.busType = SI_PCI_BUS;
    418  1.1       ad 
    419  1.1       ad 	/*
    420  1.2       ad 	 * Copy out the info structure to the user.
    421  1.1       ad 	 */
    422  1.2       ad 	if (IOCPARM_LEN(cmd) > sizeof(*data)) {
    423  1.2       ad 		memcpy(data, &info, min(sizeof(info), IOCPARM_LEN(cmd)));
    424  1.2       ad 		rv = 0;
    425  1.2       ad 	} else
    426  1.2       ad 		rv = copyout(&info, *(caddr_t *)data, sizeof(info));
    427  1.2       ad 
    428  1.2       ad 	return (rv);
    429  1.1       ad }
    430  1.1       ad 
    431  1.1       ad int
    432  1.1       ad dpti_passthrough(struct dpti_softc *sc, caddr_t data, struct proc *proc)
    433  1.1       ad {
    434  1.1       ad 	struct iop_softc *iop;
    435  1.1       ad 	struct i2o_msg mh, *mf;
    436  1.1       ad 	struct i2o_reply rh;
    437  1.1       ad 	struct iop_msg *im;
    438  1.1       ad 	struct dpti_ptbuf bufs[IOP_MAX_MSG_XFERS];
    439  1.1       ad 	u_int32_t mbtmp[IOP_MAX_MSG_SIZE / sizeof(u_int32_t)];
    440  1.1       ad 	u_int32_t rbtmp[IOP_MAX_MSG_SIZE / sizeof(u_int32_t)];
    441  1.2       ad 	int rv, msgsize, repsize, sgoff, i, mapped, nbuf, nfrag, j, sz;
    442  1.2       ad 	u_int32_t *p, *pmax, *pstart;
    443  1.1       ad 
    444  1.1       ad 	iop = (struct iop_softc *)sc->sc_dv.dv_parent;
    445  1.2       ad 	im = NULL;
    446  1.1       ad 
    447  1.1       ad 	if ((rv = dpti_blinkled(sc)) != -1) {
    448  1.1       ad 		if (rv != 0) {
    449  1.1       ad 			printf("%s: adapter blinkled = 0x%02x\n",
    450  1.1       ad 			    sc->sc_dv.dv_xname, rv);
    451  1.1       ad 			return (EIO);
    452  1.1       ad 		}
    453  1.1       ad 	}
    454  1.1       ad 
    455  1.1       ad 	/*
    456  1.1       ad 	 * Copy in the message frame header and determine the size of the
    457  1.1       ad 	 * full message frame.
    458  1.1       ad 	 */
    459  1.1       ad 	if ((rv = copyin(data, &mh, sizeof(mh))) != 0) {
    460  1.1       ad 		DPRINTF(("%s: message copyin failed\n",
    461  1.1       ad 		    sc->sc_dv.dv_xname));
    462  1.1       ad 		return (rv);
    463  1.1       ad 	}
    464  1.1       ad 
    465  1.1       ad 	msgsize = (mh.msgflags >> 14) & ~3;
    466  1.1       ad 	if (msgsize < sizeof(mh) || msgsize >= IOP_MAX_MSG_SIZE) {
    467  1.1       ad 		DPRINTF(("%s: bad message frame size\n",
    468  1.1       ad 		    sc->sc_dv.dv_xname));
    469  1.1       ad 		return (EINVAL);
    470  1.1       ad 	}
    471  1.1       ad 
    472  1.1       ad 	/*
    473  1.1       ad 	 * Handle special commands.
    474  1.1       ad 	 */
    475  1.1       ad 	switch (mh.msgfunc >> 24) {
    476  1.1       ad 	case I2O_EXEC_IOP_RESET:
    477  1.2       ad 		printf("%s: I2O_EXEC_IOP_RESET not implemented\n",
    478  1.1       ad 		    sc->sc_dv.dv_xname);
    479  1.2       ad 		return (EOPNOTSUPP);
    480  1.1       ad 
    481  1.1       ad 	case I2O_EXEC_OUTBOUND_INIT:
    482  1.2       ad 		printf("%s: I2O_EXEC_OUTBOUND_INIT not implemented\n",
    483  1.1       ad 		    sc->sc_dv.dv_xname);
    484  1.2       ad 		return (EOPNOTSUPP);
    485  1.1       ad 
    486  1.1       ad 	case I2O_EXEC_SYS_TAB_SET:
    487  1.2       ad 		printf("%s: I2O_EXEC_SYS_TAB_SET not implemented\n",
    488  1.1       ad 		    sc->sc_dv.dv_xname);
    489  1.2       ad 		return (EOPNOTSUPP);
    490  1.1       ad 
    491  1.1       ad 	case I2O_EXEC_STATUS_GET:
    492  1.2       ad 		if ((rv = iop_status_get(iop, 0)) == 0)
    493  1.2       ad 			rv = copyout(&iop->sc_status, data + msgsize,
    494  1.2       ad 			    sizeof(iop->sc_status));
    495  1.1       ad 		return (rv);
    496  1.1       ad 	}
    497  1.1       ad 
    498  1.1       ad 	/*
    499  1.1       ad 	 * Copy in the full message frame.
    500  1.1       ad 	 */
    501  1.1       ad 	if ((rv = copyin(data, mbtmp, msgsize)) != 0) {
    502  1.1       ad 		DPRINTF(("%s: full message copyin failed\n",
    503  1.1       ad 		    sc->sc_dv.dv_xname));
    504  1.1       ad 		return (rv);
    505  1.1       ad 	}
    506  1.1       ad 
    507  1.1       ad 	/*
    508  1.1       ad 	 * Determine the size of the reply frame, and copy it in.
    509  1.1       ad 	 */
    510  1.1       ad 	if ((rv = copyin(data + msgsize, &rh, sizeof(rh))) != 0) {
    511  1.1       ad 		DPRINTF(("%s: reply copyin failed\n",
    512  1.1       ad 		    sc->sc_dv.dv_xname));
    513  1.1       ad 		return (rv);
    514  1.1       ad 	}
    515  1.1       ad 
    516  1.1       ad 	repsize = (rh.msgflags >> 14) & ~3;
    517  1.1       ad 	if (repsize < sizeof(rh) || repsize >= IOP_MAX_MSG_SIZE) {
    518  1.1       ad 		DPRINTF(("%s: bad reply header size\n",
    519  1.1       ad 		    sc->sc_dv.dv_xname));
    520  1.1       ad 		return (EINVAL);
    521  1.1       ad 	}
    522  1.1       ad 
    523  1.1       ad 	if ((rv = copyin(data + msgsize, rbtmp, repsize)) != 0) {
    524  1.1       ad 		DPRINTF(("%s: reply too large\n", sc->sc_dv.dv_xname));
    525  1.1       ad 		return (rv);
    526  1.1       ad 	}
    527  1.1       ad 
    528  1.1       ad 	/*
    529  1.1       ad 	 * If the message has a scatter gather list, it must be comprised of
    530  1.1       ad 	 * simple elements.  If any one transfer contains multiple segments,
    531  1.1       ad 	 * we allocate a temporary buffer for it; otherwise, the buffer will
    532  1.2       ad 	 * be mapped directly.
    533  1.1       ad 	 */
    534  1.1       ad 	if ((sgoff = ((mh.msgflags >> 4) & 15)) != 0) {
    535  1.1       ad 		if ((sgoff + 2) > (msgsize >> 2)) {
    536  1.1       ad 			DPRINTF(("%s: invalid message size fields\n",
    537  1.1       ad 			    sc->sc_dv.dv_xname));
    538  1.1       ad 			return (EINVAL);
    539  1.1       ad 		}
    540  1.2       ad 
    541  1.2       ad 		memset(bufs, 0, sizeof(bufs));
    542  1.1       ad 	} else
    543  1.1       ad 		nbuf = -1;
    544  1.1       ad 
    545  1.2       ad 	rv = EINVAL;
    546  1.2       ad 
    547  1.1       ad 	if (sgoff != 0) {
    548  1.1       ad 		p = mbtmp + sgoff;
    549  1.2       ad 		pmax = mbtmp + (msgsize >> 2) - 2;
    550  1.1       ad 
    551  1.2       ad 		for (nbuf = 0; nbuf < IOP_MAX_MSG_XFERS; nbuf++, p += 2) {
    552  1.2       ad 			if (p > pmax) {
    553  1.1       ad 				DPRINTF(("%s: invalid SGL (1)\n",
    554  1.1       ad 				    sc->sc_dv.dv_xname));
    555  1.2       ad 				goto bad;
    556  1.1       ad 			}
    557  1.1       ad 
    558  1.1       ad 			if ((p[0] & 0x30000000) != I2O_SGL_SIMPLE) {
    559  1.1       ad 				DPRINTF(("%s: invalid SGL (2)\n",
    560  1.1       ad 				    sc->sc_dv.dv_xname));
    561  1.2       ad 				goto bad;
    562  1.1       ad 			}
    563  1.1       ad 
    564  1.1       ad 			bufs[nbuf].db_out = (p[0] & I2O_SGL_DATA_OUT) != 0;
    565  1.2       ad 			bufs[nbuf].db_ptr = NULL;
    566  1.1       ad 
    567  1.1       ad 			if ((p[0] & I2O_SGL_END_BUFFER) != 0) {
    568  1.1       ad 				if ((p[0] & 0x00ffffff) > IOP_MAX_XFER) {
    569  1.1       ad 					DPRINTF(("%s: buffer too large\n",
    570  1.1       ad 					    sc->sc_dv.dv_xname));
    571  1.2       ad 					goto bad;
    572  1.1       ad 				}
    573  1.1       ad 
    574  1.1       ad 				bufs[nbuf].db_ptr = (caddr_t)p[1];
    575  1.1       ad 				bufs[nbuf].db_proc = proc;
    576  1.1       ad 				bufs[nbuf].db_size = p[0] & 0x00ffffff;
    577  1.1       ad 
    578  1.1       ad 				if ((p[0] & I2O_SGL_END) != 0)
    579  1.1       ad 					break;
    580  1.1       ad 
    581  1.1       ad 				continue;
    582  1.1       ad 			}
    583  1.1       ad 
    584  1.2       ad 			/*
    585  1.2       ad 			 * The buffer has multiple segments.  Determine the
    586  1.2       ad 			 * total size.
    587  1.2       ad 			 */
    588  1.2       ad 			nfrag = 0;
    589  1.2       ad 			sz = 0;
    590  1.2       ad 			for (pstart = p; p <= pmax; p += 2) {
    591  1.2       ad 				if (nfrag == DPTI_MAX_SEGS) {
    592  1.2       ad 					DPRINTF(("%s: too many segments\n",
    593  1.2       ad 					    sc->sc_dv.dv_xname));
    594  1.2       ad 					goto bad;
    595  1.2       ad 				}
    596  1.2       ad 
    597  1.2       ad 				bufs[nbuf].db_frags[nfrag].iov_len =
    598  1.2       ad 				    p[0] & 0x00ffffff;
    599  1.2       ad 				bufs[nbuf].db_frags[nfrag].iov_base =
    600  1.2       ad 				    (void *)p[1];
    601  1.2       ad 
    602  1.2       ad 				sz += p[0] & 0x00ffffff;
    603  1.2       ad 				nfrag++;
    604  1.2       ad 
    605  1.2       ad 				if ((p[0] & I2O_SGL_END) != 0) {
    606  1.2       ad 					if ((p[0] & I2O_SGL_END_BUFFER) == 0) {
    607  1.2       ad 						DPRINTF((
    608  1.2       ad 						    "%s: invalid SGL (3)\n",
    609  1.2       ad 						    sc->sc_dv.dv_xname));
    610  1.2       ad 						goto bad;
    611  1.2       ad 					}
    612  1.2       ad 					break;
    613  1.2       ad 				}
    614  1.2       ad 				if ((p[0] & I2O_SGL_END_BUFFER) != 0)
    615  1.2       ad 					break;
    616  1.2       ad 			}
    617  1.2       ad 			bufs[nbuf].db_nfrag = nfrag;
    618  1.2       ad 
    619  1.2       ad 			if (p > pmax) {
    620  1.2       ad 				DPRINTF(("%s: invalid SGL (4)\n",
    621  1.2       ad 				    sc->sc_dv.dv_xname));
    622  1.2       ad 				goto bad;
    623  1.2       ad 			}
    624  1.2       ad 
    625  1.2       ad 			if (sz > IOP_MAX_XFER) {
    626  1.2       ad 				DPRINTF(("%s: buffer too large\n",
    627  1.2       ad 				    sc->sc_dv.dv_xname));
    628  1.2       ad 				goto bad;
    629  1.2       ad 			}
    630  1.2       ad 
    631  1.2       ad 			bufs[nbuf].db_size = sz;
    632  1.2       ad 			bufs[nbuf].db_ptr = malloc(sz, M_DEVBUF, M_WAITOK);
    633  1.2       ad 			if (bufs[nbuf].db_ptr == NULL) {
    634  1.2       ad 				DPRINTF(("%s: allocation failure\n",
    635  1.2       ad 				    sc->sc_dv.dv_xname));
    636  1.2       ad 				rv = ENOMEM;
    637  1.2       ad 				goto bad;
    638  1.2       ad 			}
    639  1.2       ad 
    640  1.2       ad 			for (i = 0, sz = 0; i < bufs[nbuf].db_nfrag; i++) {
    641  1.2       ad 				rv = copyin(bufs[nbuf].db_frags[i].iov_base,
    642  1.2       ad 				    bufs[nbuf].db_ptr + sz,
    643  1.2       ad 				    bufs[nbuf].db_frags[i].iov_len);
    644  1.2       ad 				if (rv != 0) {
    645  1.2       ad 					DPRINTF(("%s: frag copyin\n",
    646  1.2       ad 					    sc->sc_dv.dv_xname));
    647  1.2       ad 					goto bad;
    648  1.2       ad 				}
    649  1.2       ad 				sz += bufs[nbuf].db_frags[i].iov_len;
    650  1.2       ad 			}
    651  1.2       ad 
    652  1.2       ad 			if ((p[0] & I2O_SGL_END) != 0)
    653  1.2       ad 				break;
    654  1.1       ad 		}
    655  1.1       ad 
    656  1.1       ad 		if (nbuf == IOP_MAX_MSG_XFERS) {
    657  1.1       ad 			DPRINTF(("%s: too many transfers\n",
    658  1.1       ad 			    sc->sc_dv.dv_xname));
    659  1.2       ad 			goto bad;
    660  1.1       ad 		}
    661  1.1       ad 	}
    662  1.1       ad 
    663  1.1       ad 	/*
    664  1.1       ad 	 * Allocate a wrapper, and adjust the message header fields to
    665  1.1       ad 	 * indicate that no scatter-gather list is currently present.
    666  1.1       ad 	 */
    667  1.2       ad 	mapped = 0;
    668  1.2       ad 
    669  1.1       ad 	im = iop_msg_alloc(iop, IM_WAIT | IM_NOSTATUS);
    670  1.1       ad 	im->im_rb = (struct i2o_reply *)rbtmp;
    671  1.1       ad 	mf = (struct i2o_msg *)mbtmp;
    672  1.1       ad 	mf->msgictx = IOP_ICTX;
    673  1.1       ad 	mf->msgtctx = im->im_tctx;
    674  1.1       ad 
    675  1.1       ad 	if (sgoff != 0)
    676  1.1       ad 		mf->msgflags = (mf->msgflags & 0xff0f) | (sgoff << 16);
    677  1.1       ad 
    678  1.1       ad 	/*
    679  1.1       ad 	 * Map the data transfer(s).
    680  1.1       ad 	 */
    681  1.1       ad 	for (i = 0; i <= nbuf; i++) {
    682  1.1       ad 		rv = iop_msg_map(iop, im, mbtmp, bufs[i].db_ptr,
    683  1.1       ad 		    bufs[i].db_size, bufs[i].db_out, bufs[i].db_proc);
    684  1.1       ad 		if (rv != 0) {
    685  1.2       ad 			DPRINTF(("%s: msg_map failed, rv = %d\n",
    686  1.2       ad 			    sc->sc_dv.dv_xname, rv));
    687  1.1       ad 			goto bad;
    688  1.1       ad 		}
    689  1.1       ad 		mapped = 1;
    690  1.1       ad 	}
    691  1.1       ad 
    692  1.1       ad 	/*
    693  1.1       ad 	 * Start the command and sleep until it completes.
    694  1.1       ad 	 */
    695  1.1       ad 	if ((rv = iop_msg_post(iop, im, mbtmp, 5*60*1000)) != 0)
    696  1.1       ad 		goto bad;
    697  1.1       ad 
    698  1.1       ad 	/*
    699  1.1       ad 	 * Copy out the reply frame.
    700  1.1       ad 	 */
    701  1.1       ad 	if ((rv = copyout(rbtmp, data + msgsize, repsize)) != 0)
    702  1.1       ad 		DPRINTF(("%s: reply copyout() failed\n",
    703  1.1       ad 		    sc->sc_dv.dv_xname));
    704  1.1       ad 
    705  1.1       ad  bad:
    706  1.2       ad 	/*
    707  1.2       ad 	 * Free resources and return to the caller.
    708  1.2       ad 	 */
    709  1.2       ad 	if (im != NULL) {
    710  1.2       ad 		if (mapped)
    711  1.2       ad 			iop_msg_unmap(iop, im);
    712  1.2       ad 		iop_msg_free(iop, im);
    713  1.2       ad 	}
    714  1.2       ad 
    715  1.2       ad 	for (i = 0; i <= nbuf; i++) {
    716  1.2       ad 		if (bufs[i].db_proc != NULL)
    717  1.2       ad 			continue;
    718  1.2       ad 
    719  1.2       ad 		if (!bufs[i].db_out && rv == 0) {
    720  1.2       ad 			for (j = 0, sz = 0; j < bufs[i].db_nfrag; j++) {
    721  1.2       ad 				rv = copyout(bufs[i].db_ptr + sz,
    722  1.2       ad 				    bufs[i].db_frags[j].iov_base,
    723  1.2       ad 				    bufs[i].db_frags[j].iov_len);
    724  1.2       ad 				if (rv != 0)
    725  1.2       ad 					break;
    726  1.2       ad 				sz += bufs[i].db_frags[j].iov_len;
    727  1.2       ad 			}
    728  1.2       ad 		}
    729  1.1       ad 
    730  1.2       ad 		if (bufs[i].db_ptr != NULL)
    731  1.2       ad 			free(bufs[i].db_ptr, M_DEVBUF);
    732  1.2       ad 	}
    733  1.1       ad 
    734  1.1       ad 	return (rv);
    735  1.1       ad }
    736