Home | History | Annotate | Line # | Download | only in pci
twe.c revision 1.45
      1  1.45   thorpej /*	$NetBSD: twe.c,v 1.45 2003/09/22 01:13:02 thorpej Exp $	*/
      2   1.1        ad 
      3   1.1        ad /*-
      4  1.42   thorpej  * Copyright (c) 2000, 2001, 2002, 2003 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.42   thorpej  * by Andrew Doran; and by Jason R. Thorpe of Wasabi Systems, Inc.
      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) 2000 Michael Smith
     41   1.1        ad  * Copyright (c) 2000 BSDi
     42   1.1        ad  * All rights reserved.
     43   1.1        ad  *
     44   1.1        ad  * Redistribution and use in source and binary forms, with or without
     45   1.1        ad  * modification, are permitted provided that the following conditions
     46   1.1        ad  * are met:
     47   1.1        ad  * 1. Redistributions of source code must retain the above copyright
     48   1.1        ad  *    notice, this list of conditions and the following disclaimer.
     49   1.1        ad  * 2. Redistributions in binary form must reproduce the above copyright
     50   1.1        ad  *    notice, this list of conditions and the following disclaimer in the
     51   1.1        ad  *    documentation and/or other materials provided with the distribution.
     52   1.1        ad  *
     53   1.1        ad  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     54   1.1        ad  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     55   1.1        ad  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     56   1.1        ad  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     57   1.1        ad  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     58   1.1        ad  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     59   1.1        ad  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     60   1.1        ad  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     61   1.1        ad  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     62   1.1        ad  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     63   1.1        ad  * SUCH DAMAGE.
     64   1.1        ad  *
     65   1.1        ad  * from FreeBSD: twe.c,v 1.1 2000/05/24 23:35:23 msmith Exp
     66   1.1        ad  */
     67   1.1        ad 
     68   1.1        ad /*
     69   1.1        ad  * Driver for the 3ware Escalade family of RAID controllers.
     70   1.1        ad  */
     71  1.21     lukem 
     72  1.21     lukem #include <sys/cdefs.h>
     73  1.45   thorpej __KERNEL_RCSID(0, "$NetBSD: twe.c,v 1.45 2003/09/22 01:13:02 thorpej Exp $");
     74   1.1        ad 
     75   1.1        ad #include <sys/param.h>
     76   1.1        ad #include <sys/systm.h>
     77   1.1        ad #include <sys/kernel.h>
     78   1.1        ad #include <sys/device.h>
     79   1.1        ad #include <sys/queue.h>
     80   1.1        ad #include <sys/proc.h>
     81   1.1        ad #include <sys/buf.h>
     82   1.1        ad #include <sys/endian.h>
     83   1.1        ad #include <sys/malloc.h>
     84  1.33  christos #include <sys/conf.h>
     85   1.1        ad #include <sys/disk.h>
     86   1.1        ad 
     87   1.1        ad #include <uvm/uvm_extern.h>
     88   1.1        ad 
     89   1.1        ad #include <machine/bswap.h>
     90   1.1        ad #include <machine/bus.h>
     91   1.1        ad 
     92   1.1        ad #include <dev/pci/pcireg.h>
     93   1.1        ad #include <dev/pci/pcivar.h>
     94   1.1        ad #include <dev/pci/pcidevs.h>
     95   1.1        ad #include <dev/pci/twereg.h>
     96   1.1        ad #include <dev/pci/twevar.h>
     97  1.33  christos #include <dev/pci/tweio.h>
     98   1.1        ad 
     99   1.1        ad #define	PCI_CBIO	0x10
    100   1.1        ad 
    101   1.1        ad static void	twe_aen_handler(struct twe_ccb *, int);
    102  1.45   thorpej static void	twe_aen_enqueue(struct twe_softc *sc, uint16_t, int);
    103  1.45   thorpej static uint16_t	twe_aen_dequeue(struct twe_softc *);
    104  1.45   thorpej 
    105   1.1        ad static void	twe_attach(struct device *, struct device *, void *);
    106   1.1        ad static int	twe_init_connection(struct twe_softc *);
    107   1.1        ad static int	twe_intr(void *);
    108   1.1        ad static int	twe_match(struct device *, struct cfdata *, void *);
    109  1.33  christos static int	twe_param_set(struct twe_softc *, int, int, size_t, void *);
    110   1.1        ad static void	twe_poll(struct twe_softc *);
    111   1.1        ad static int	twe_print(void *, const char *);
    112   1.1        ad static int	twe_reset(struct twe_softc *);
    113   1.1        ad static int	twe_submatch(struct device *, struct cfdata *, void *);
    114   1.1        ad static int	twe_status_check(struct twe_softc *, u_int);
    115   1.1        ad static int	twe_status_wait(struct twe_softc *, u_int, int);
    116  1.38  jdolecek static void	twe_describe_controller(struct twe_softc *);
    117   1.1        ad 
    118  1.22        ad static inline u_int32_t	twe_inl(struct twe_softc *, int);
    119  1.33  christos static inline void twe_outl(struct twe_softc *, int, u_int32_t);
    120  1.33  christos 
    121  1.33  christos dev_type_open(tweopen);
    122  1.33  christos dev_type_close(tweclose);
    123  1.33  christos dev_type_ioctl(tweioctl);
    124  1.33  christos 
    125  1.33  christos const struct cdevsw twe_cdevsw = {
    126  1.33  christos 	tweopen, tweclose, noread, nowrite, tweioctl,
    127  1.33  christos 	nostop, notty, nopoll, nommap,
    128  1.33  christos };
    129  1.33  christos 
    130  1.33  christos extern struct	cfdriver twe_cd;
    131  1.22        ad 
    132  1.30   thorpej CFATTACH_DECL(twe, sizeof(struct twe_softc),
    133  1.31   thorpej     twe_match, twe_attach, NULL, NULL);
    134   1.1        ad 
    135  1.40   thorpej /*
    136  1.40   thorpej  * Tables to convert numeric codes to strings.
    137  1.40   thorpej  */
    138  1.40   thorpej const struct twe_code_table twe_table_status[] = {
    139  1.40   thorpej 	{ 0x00,	"successful completion" },
    140  1.40   thorpej 
    141  1.40   thorpej 	/* info */
    142  1.40   thorpej 	{ 0x42,	"command in progress" },
    143  1.40   thorpej 	{ 0x6c,	"retrying interface CRC error from UDMA command" },
    144  1.40   thorpej 
    145  1.40   thorpej 	/* warning */
    146  1.40   thorpej 	{ 0x81,	"redundant/inconsequential request ignored" },
    147  1.40   thorpej 	{ 0x8e,	"failed to write zeroes to LBA 0" },
    148  1.40   thorpej 	{ 0x8f,	"failed to profile TwinStor zones" },
    149  1.40   thorpej 
    150  1.40   thorpej 	/* fatal */
    151  1.40   thorpej 	{ 0xc1,	"aborted due to system command or reconfiguration" },
    152  1.40   thorpej 	{ 0xc4,	"aborted" },
    153  1.40   thorpej 	{ 0xc5,	"access error" },
    154  1.40   thorpej 	{ 0xc6,	"access violation" },
    155  1.40   thorpej 	{ 0xc7,	"device failure" },	/* high byte may be port # */
    156  1.40   thorpej 	{ 0xc8,	"controller error" },
    157  1.40   thorpej 	{ 0xc9,	"timed out" },
    158  1.40   thorpej 	{ 0xcb,	"invalid unit number" },
    159  1.40   thorpej 	{ 0xcf,	"unit not available" },
    160  1.40   thorpej 	{ 0xd2,	"undefined opcode" },
    161  1.40   thorpej 	{ 0xdb,	"request incompatible with unit" },
    162  1.40   thorpej 	{ 0xdc,	"invalid request" },
    163  1.40   thorpej 	{ 0xff,	"firmware error, reset requested" },
    164  1.40   thorpej 
    165  1.40   thorpej 	{ 0,	NULL }
    166  1.40   thorpej };
    167  1.40   thorpej 
    168  1.40   thorpej const struct twe_code_table twe_table_unitstate[] = {
    169  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Normal,		"Normal" },
    170  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Initialising,	"Initializing" },
    171  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Degraded,	"Degraded" },
    172  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Rebuilding,	"Rebuilding" },
    173  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Verifying,	"Verifying" },
    174  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Corrupt,		"Corrupt" },
    175  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Missing,		"Missing" },
    176  1.40   thorpej 
    177  1.40   thorpej 	{ 0,					NULL }
    178  1.40   thorpej };
    179  1.40   thorpej 
    180  1.40   thorpej const struct twe_code_table twe_table_unittype[] = {
    181  1.40   thorpej 	/* array descriptor configuration */
    182  1.40   thorpej 	{ TWE_AD_CONFIG_RAID0,			"RAID0" },
    183  1.40   thorpej 	{ TWE_AD_CONFIG_RAID1,			"RAID1" },
    184  1.40   thorpej 	{ TWE_AD_CONFIG_TwinStor,		"TwinStor" },
    185  1.40   thorpej 	{ TWE_AD_CONFIG_RAID5,			"RAID5" },
    186  1.40   thorpej 	{ TWE_AD_CONFIG_RAID10,			"RAID10" },
    187  1.40   thorpej 
    188  1.40   thorpej 	{ 0,					NULL }
    189  1.40   thorpej };
    190  1.40   thorpej 
    191  1.40   thorpej const struct twe_code_table twe_table_stripedepth[] = {
    192  1.40   thorpej 	{ TWE_AD_STRIPE_4k,			"4K" },
    193  1.40   thorpej 	{ TWE_AD_STRIPE_8k,			"8K" },
    194  1.40   thorpej 	{ TWE_AD_STRIPE_16k,			"16K" },
    195  1.40   thorpej 	{ TWE_AD_STRIPE_32k,			"32K" },
    196  1.40   thorpej 	{ TWE_AD_STRIPE_64k,			"64K" },
    197  1.40   thorpej 
    198  1.40   thorpej 	{ 0,					NULL }
    199  1.40   thorpej };
    200  1.40   thorpej 
    201  1.45   thorpej /*
    202  1.45   thorpej  * Asynchronous event notification messages are qualified:
    203  1.45   thorpej  *	a - not unit/port specific
    204  1.45   thorpej  *	u - unit specific
    205  1.45   thorpej  *	p - port specific
    206  1.45   thorpej  */
    207  1.45   thorpej const struct twe_code_table twe_table_aen[] = {
    208  1.45   thorpej 	{ 0x00,	"a queue empty" },
    209  1.45   thorpej 	{ 0x01,	"a soft reset" },
    210  1.45   thorpej 	{ 0x02,	"u degraded mode" },
    211  1.45   thorpej 	{ 0x03,	"a controller error" },
    212  1.45   thorpej 	{ 0x04,	"u rebuild fail" },
    213  1.45   thorpej 	{ 0x05,	"u rebuild done" },
    214  1.45   thorpej 	{ 0x06,	"u incomplete unit" },
    215  1.45   thorpej 	{ 0x07,	"u initialization done" },
    216  1.45   thorpej 	{ 0x08,	"u unclean shutdown detected" },
    217  1.45   thorpej 	{ 0x09,	"p drive timeout" },
    218  1.45   thorpej 	{ 0x0a,	"p drive error" },
    219  1.45   thorpej 	{ 0x0b,	"u rebuild started" },
    220  1.45   thorpej 	{ 0x0c,	"u initialization started" },
    221  1.45   thorpej 	{ 0x0d,	"u logical unit deleted" },
    222  1.45   thorpej 	{ 0x0f,	"p SMART threshold exceeded" },
    223  1.45   thorpej 	{ 0x15,	"a table undefined" },	/* XXX: Not in FreeBSD's table */
    224  1.45   thorpej 	{ 0x21,	"p ATA UDMA downgrade" },
    225  1.45   thorpej 	{ 0x22,	"p ATA UDMA upgrade" },
    226  1.45   thorpej 	{ 0x23,	"p sector repair occurred" },
    227  1.45   thorpej 	{ 0x24,	"a SBUF integrity check failure" },
    228  1.45   thorpej 	{ 0x25,	"p lost cached write" },
    229  1.45   thorpej 	{ 0x26,	"p drive ECC error detected" },
    230  1.45   thorpej 	{ 0x27,	"p DCB checksum error" },
    231  1.45   thorpej 	{ 0x28,	"p DCB unsupported version" },
    232  1.45   thorpej 	{ 0x29,	"u verify started" },
    233  1.45   thorpej 	{ 0x2a,	"u verify failed" },
    234  1.45   thorpej 	{ 0x2b,	"u verify complete" },
    235  1.45   thorpej 	{ 0x2c,	"p overwrote bad sector during rebuild" },
    236  1.45   thorpej 	{ 0x2d,	"p encountered bad sector during rebuild" },
    237  1.45   thorpej 	{ 0x2e,	"p replacement drive too small" },
    238  1.45   thorpej 	{ 0x2f,	"u array not previously initialized" },
    239  1.45   thorpej 	{ 0x30,	"p drive not supported" },
    240  1.45   thorpej 	{ 0xff,	"a aen queue full" },
    241  1.45   thorpej 
    242  1.45   thorpej 	{ 0,	NULL },
    243  1.45   thorpej };
    244  1.45   thorpej 
    245  1.40   thorpej const char *
    246  1.40   thorpej twe_describe_code(const struct twe_code_table *table, uint32_t code)
    247  1.40   thorpej {
    248  1.40   thorpej 
    249  1.40   thorpej 	for (; table->string != NULL; table++) {
    250  1.40   thorpej 		if (table->code == code)
    251  1.40   thorpej 			return (table->string);
    252  1.40   thorpej 	}
    253  1.40   thorpej 	return (NULL);
    254  1.40   thorpej }
    255  1.40   thorpej 
    256  1.22        ad static inline u_int32_t
    257  1.22        ad twe_inl(struct twe_softc *sc, int off)
    258  1.22        ad {
    259  1.22        ad 
    260  1.22        ad 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, off, 4,
    261  1.22        ad 	    BUS_SPACE_BARRIER_WRITE | BUS_SPACE_BARRIER_READ);
    262  1.22        ad 	return (bus_space_read_4(sc->sc_iot, sc->sc_ioh, off));
    263  1.22        ad }
    264  1.22        ad 
    265  1.22        ad static inline void
    266  1.22        ad twe_outl(struct twe_softc *sc, int off, u_int32_t val)
    267  1.22        ad {
    268  1.22        ad 
    269  1.22        ad 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, off, val);
    270  1.22        ad 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, off, 4,
    271  1.22        ad 	    BUS_SPACE_BARRIER_WRITE);
    272  1.22        ad }
    273  1.22        ad 
    274   1.1        ad /*
    275   1.1        ad  * Match a supported board.
    276   1.1        ad  */
    277   1.1        ad static int
    278   1.1        ad twe_match(struct device *parent, struct cfdata *cfdata, void *aux)
    279   1.1        ad {
    280   1.1        ad 	struct pci_attach_args *pa;
    281   1.1        ad 
    282   1.1        ad 	pa = aux;
    283   1.1        ad 
    284   1.1        ad 	return (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_3WARE &&
    285  1.10        ad 	    (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3WARE_ESCALADE ||
    286  1.10        ad 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3WARE_ESCALADE_ASIC));
    287   1.1        ad }
    288   1.1        ad 
    289   1.1        ad /*
    290   1.1        ad  * Attach a supported board.
    291   1.1        ad  *
    292   1.1        ad  * XXX This doesn't fail gracefully.
    293   1.1        ad  */
    294   1.1        ad static void
    295   1.1        ad twe_attach(struct device *parent, struct device *self, void *aux)
    296   1.1        ad {
    297   1.1        ad 	struct pci_attach_args *pa;
    298   1.1        ad 	struct twe_softc *sc;
    299   1.1        ad 	pci_chipset_tag_t pc;
    300   1.1        ad 	pci_intr_handle_t ih;
    301   1.1        ad 	pcireg_t csr;
    302   1.1        ad 	const char *intrstr;
    303   1.1        ad 	int size, i, rv, rseg;
    304  1.23  christos 	size_t max_segs, max_xfer;
    305  1.42   thorpej 	struct twe_param *dtp, *atp;
    306  1.42   thorpej 	struct twe_array_descriptor *ad;
    307  1.42   thorpej 	struct twe_drive *td;
    308   1.1        ad 	bus_dma_segment_t seg;
    309   1.1        ad 	struct twe_cmd *tc;
    310   1.1        ad 	struct twe_attach_args twea;
    311   1.1        ad 	struct twe_ccb *ccb;
    312  1.42   thorpej 	uint16_t dsize;
    313   1.1        ad 
    314   1.1        ad 	sc = (struct twe_softc *)self;
    315   1.1        ad 	pa = aux;
    316   1.1        ad 	pc = pa->pa_pc;
    317   1.1        ad 	sc->sc_dmat = pa->pa_dmat;
    318   1.1        ad 	SIMPLEQ_INIT(&sc->sc_ccb_queue);
    319   1.1        ad 	SLIST_INIT(&sc->sc_ccb_freelist);
    320   1.1        ad 
    321  1.40   thorpej 	aprint_naive(": RAID controller\n");
    322  1.38  jdolecek 	aprint_normal(": 3ware Escalade\n");
    323   1.1        ad 
    324  1.33  christos 	ccb = malloc(sizeof(*ccb) * TWE_MAX_QUEUECNT, M_DEVBUF, M_NOWAIT);
    325  1.33  christos 	if (ccb == NULL) {
    326  1.38  jdolecek 		aprint_error("%s: unable to allocate memory for ccbs\n",
    327  1.33  christos 		    sc->sc_dv.dv_xname);
    328  1.33  christos 		return;
    329  1.33  christos 	}
    330  1.33  christos 
    331   1.1        ad 	if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
    332   1.1        ad 	    &sc->sc_iot, &sc->sc_ioh, NULL, NULL)) {
    333  1.38  jdolecek 		aprint_error("%s: can't map i/o space\n", sc->sc_dv.dv_xname);
    334   1.1        ad 		return;
    335   1.1        ad 	}
    336   1.1        ad 
    337   1.1        ad 	/* Enable the device. */
    338   1.1        ad 	csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
    339   1.1        ad 	pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
    340   1.1        ad 	    csr | PCI_COMMAND_MASTER_ENABLE);
    341   1.1        ad 
    342   1.1        ad 	/* Map and establish the interrupt. */
    343   1.5  sommerfe 	if (pci_intr_map(pa, &ih)) {
    344  1.38  jdolecek 		aprint_error("%s: can't map interrupt\n", sc->sc_dv.dv_xname);
    345   1.1        ad 		return;
    346   1.1        ad 	}
    347  1.38  jdolecek 
    348   1.1        ad 	intrstr = pci_intr_string(pc, ih);
    349   1.1        ad 	sc->sc_ih = pci_intr_establish(pc, ih, IPL_BIO, twe_intr, sc);
    350   1.1        ad 	if (sc->sc_ih == NULL) {
    351  1.38  jdolecek 		aprint_error("%s: can't establish interrupt%s%s\n",
    352  1.38  jdolecek 			sc->sc_dv.dv_xname,
    353  1.38  jdolecek 			(intrstr) ? " at " : "",
    354  1.38  jdolecek 			(intrstr) ? intrstr : "");
    355   1.1        ad 		return;
    356   1.1        ad 	}
    357  1.38  jdolecek 
    358   1.1        ad 	if (intrstr != NULL)
    359  1.38  jdolecek 		aprint_normal("%s: interrupting at %s\n",
    360  1.38  jdolecek 			sc->sc_dv.dv_xname, intrstr);
    361   1.1        ad 
    362   1.1        ad 	/*
    363   1.1        ad 	 * Allocate and initialise the command blocks and CCBs.
    364   1.1        ad 	 */
    365   1.7        ad         size = sizeof(struct twe_cmd) * TWE_MAX_QUEUECNT;
    366   1.1        ad 
    367   1.4   thorpej 	if ((rv = bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &seg, 1,
    368   1.1        ad 	    &rseg, BUS_DMA_NOWAIT)) != 0) {
    369  1.38  jdolecek 		aprint_error("%s: unable to allocate commands, rv = %d\n",
    370   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    371   1.1        ad 		return;
    372   1.1        ad 	}
    373   1.1        ad 
    374   1.1        ad 	if ((rv = bus_dmamem_map(sc->sc_dmat, &seg, rseg, size,
    375   1.1        ad 	    (caddr_t *)&sc->sc_cmds,
    376   1.1        ad 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
    377  1.38  jdolecek 		aprint_error("%s: unable to map commands, rv = %d\n",
    378   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    379   1.1        ad 		return;
    380   1.1        ad 	}
    381   1.1        ad 
    382   1.1        ad 	if ((rv = bus_dmamap_create(sc->sc_dmat, size, size, 1, 0,
    383   1.1        ad 	    BUS_DMA_NOWAIT, &sc->sc_dmamap)) != 0) {
    384  1.38  jdolecek 		aprint_error("%s: unable to create command DMA map, rv = %d\n",
    385   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    386   1.1        ad 		return;
    387   1.1        ad 	}
    388   1.1        ad 
    389   1.1        ad 	if ((rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap, sc->sc_cmds,
    390   1.1        ad 	    size, NULL, BUS_DMA_NOWAIT)) != 0) {
    391  1.38  jdolecek 		aprint_error("%s: unable to load command DMA map, rv = %d\n",
    392   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    393   1.1        ad 		return;
    394   1.1        ad 	}
    395   1.1        ad 
    396   1.1        ad 	sc->sc_cmds_paddr = sc->sc_dmamap->dm_segs[0].ds_addr;
    397   1.1        ad 	memset(sc->sc_cmds, 0, size);
    398   1.1        ad 
    399   1.1        ad 	sc->sc_ccbs = ccb;
    400   1.1        ad 	tc = (struct twe_cmd *)sc->sc_cmds;
    401  1.24  christos 	max_segs = twe_get_maxsegs();
    402  1.24  christos 	max_xfer = twe_get_maxxfer(max_segs);
    403   1.1        ad 
    404   1.7        ad 	for (i = 0; i < TWE_MAX_QUEUECNT; i++, tc++, ccb++) {
    405   1.1        ad 		ccb->ccb_cmd = tc;
    406   1.1        ad 		ccb->ccb_cmdid = i;
    407   1.1        ad 		ccb->ccb_flags = 0;
    408  1.23  christos 		rv = bus_dmamap_create(sc->sc_dmat, max_xfer,
    409  1.23  christos 		    max_segs, PAGE_SIZE, 0,
    410   1.4   thorpej 		    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
    411   1.1        ad 		    &ccb->ccb_dmamap_xfer);
    412   1.7        ad 		if (rv != 0) {
    413  1.38  jdolecek 			aprint_error("%s: can't create dmamap, rv = %d\n",
    414   1.7        ad 			    sc->sc_dv.dv_xname, rv);
    415   1.7        ad 			return;
    416   1.7        ad 		}
    417   1.3        ad 		/* Save one CCB for parameter retrieval. */
    418   1.3        ad 		if (i != 0)
    419   1.3        ad 			SLIST_INSERT_HEAD(&sc->sc_ccb_freelist, ccb,
    420   1.3        ad 			    ccb_chain.slist);
    421   1.3        ad 	}
    422   1.1        ad 
    423   1.1        ad 	/* Wait for the controller to become ready. */
    424   1.1        ad 	if (twe_status_wait(sc, TWE_STS_MICROCONTROLLER_READY, 6)) {
    425  1.38  jdolecek 		aprint_error("%s: microcontroller not ready\n",
    426  1.38  jdolecek 			sc->sc_dv.dv_xname);
    427   1.1        ad 		return;
    428   1.1        ad 	}
    429   1.1        ad 
    430  1.22        ad 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_DISABLE_INTRS);
    431   1.1        ad 
    432   1.1        ad 	/* Reset the controller. */
    433   1.1        ad 	if (twe_reset(sc)) {
    434  1.38  jdolecek 		aprint_error("%s: reset failed\n", sc->sc_dv.dv_xname);
    435   1.1        ad 		return;
    436   1.1        ad 	}
    437   1.1        ad 
    438   1.3        ad 	/* Find attached units. */
    439   1.7        ad 	rv = twe_param_get(sc, TWE_PARAM_UNITSUMMARY,
    440  1.38  jdolecek 	    TWE_PARAM_UNITSUMMARY_Status, TWE_MAX_UNITS, NULL, &dtp);
    441   1.7        ad 	if (rv != 0) {
    442  1.38  jdolecek 		aprint_error("%s: can't detect attached units (%d)\n",
    443   1.7        ad 		    sc->sc_dv.dv_xname, rv);
    444   1.1        ad 		return;
    445   1.1        ad 	}
    446   1.1        ad 
    447   1.1        ad 	/* For each detected unit, collect size and store in an array. */
    448   1.3        ad 	for (i = 0, sc->sc_nunits = 0; i < TWE_MAX_UNITS; i++) {
    449  1.42   thorpej 		td = &sc->sc_units[i];
    450  1.42   thorpej 
    451   1.1        ad 		/* Unit present? */
    452   1.3        ad 		if ((dtp->tp_data[i] & TWE_PARAM_UNITSTATUS_Online) == 0) {
    453  1.42   thorpej 			td->td_size = 0;
    454  1.42   thorpej 			td->td_type = 0;
    455  1.42   thorpej 			td->td_stripe = 0;
    456   1.1        ad 	   		continue;
    457   1.1        ad 	   	}
    458   1.1        ad 
    459  1.42   thorpej 		rv = twe_param_get_2(sc, TWE_PARAM_UNITINFO + i,
    460  1.42   thorpej 		    TWE_PARAM_UNITINFO_DescriptorSize, &dsize);
    461  1.42   thorpej 		if (rv != 0) {
    462  1.42   thorpej 			aprint_error("%s: error %d fetching descriptor size "
    463  1.42   thorpej 			    "for unit %d\n", sc->sc_dv.dv_xname, rv, i);
    464  1.42   thorpej 			td->td_size = 0;
    465  1.42   thorpej 			td->td_type = 0;
    466  1.42   thorpej 			td->td_stripe = 0;
    467  1.42   thorpej 			continue;
    468  1.42   thorpej 		}
    469  1.42   thorpej 
    470  1.42   thorpej 		rv = twe_param_get(sc, TWE_PARAM_UNITINFO + i,
    471  1.42   thorpej 		    TWE_PARAM_UNITINFO_Descriptor, dsize - 3, NULL, &atp);
    472  1.42   thorpej 		if (rv != 0) {
    473  1.42   thorpej 			aprint_error("%s: error %d fetching array descriptor "
    474  1.42   thorpej 			    "for unit %d\n", sc->sc_dv.dv_xname, rv, i);
    475  1.42   thorpej 			td->td_size = 0;
    476  1.42   thorpej 			td->td_type = 0;
    477  1.42   thorpej 			td->td_stripe = 0;
    478  1.42   thorpej 			continue;
    479  1.42   thorpej 		}
    480  1.42   thorpej 		ad = (struct twe_array_descriptor *)atp->tp_data;
    481  1.42   thorpej 		td->td_type = ad->configuration;
    482  1.42   thorpej 		td->td_stripe = ad->stripe_size;
    483  1.42   thorpej 		free(atp, M_DEVBUF);
    484  1.42   thorpej 
    485  1.41   thorpej 		rv = twe_param_get_4(sc, TWE_PARAM_UNITINFO + i,
    486  1.42   thorpej 		    TWE_PARAM_UNITINFO_Capacity, &td->td_size);
    487   1.7        ad 		if (rv != 0) {
    488  1.42   thorpej 			aprint_error(
    489  1.42   thorpej 			    "%s: error %d fetching capacity for unit %d\n",
    490   1.7        ad 			    sc->sc_dv.dv_xname, rv, i);
    491  1.42   thorpej 			td->td_size = 0;
    492  1.42   thorpej 			td->td_type = 0;
    493  1.42   thorpej 			td->td_stripe = 0;
    494   1.1        ad 			continue;
    495   1.1        ad 		}
    496   1.1        ad 
    497   1.3        ad 		sc->sc_nunits++;
    498   1.1        ad 	}
    499   1.1        ad 	free(dtp, M_DEVBUF);
    500   1.1        ad 
    501   1.1        ad 	/* Initialise connection with controller and enable interrupts. */
    502   1.1        ad 	twe_init_connection(sc);
    503  1.22        ad 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR |
    504   1.1        ad 	    TWE_CTL_UNMASK_RESP_INTR |
    505   1.1        ad 	    TWE_CTL_ENABLE_INTRS);
    506   1.1        ad 
    507  1.38  jdolecek 	twe_describe_controller(sc);
    508  1.38  jdolecek 
    509   1.1        ad 	/* Attach sub-devices. */
    510   1.1        ad 	for (i = 0; i < TWE_MAX_UNITS; i++) {
    511  1.42   thorpej 		td = &sc->sc_units[i];
    512  1.42   thorpej 		if (td->td_size == 0)
    513   1.1        ad 			continue;
    514   1.1        ad 		twea.twea_unit = i;
    515  1.42   thorpej 		td->td_dev = config_found_sm(&sc->sc_dv, &twea, twe_print,
    516  1.42   thorpej 		    twe_submatch);
    517   1.1        ad 	}
    518   1.1        ad }
    519   1.1        ad 
    520   1.1        ad /*
    521   1.1        ad  * Reset the controller.  Currently only useful at attach time; must be
    522   1.1        ad  * called with interrupts blocked.
    523   1.1        ad  */
    524   1.1        ad static int
    525   1.1        ad twe_reset(struct twe_softc *sc)
    526   1.1        ad {
    527  1.41   thorpej 	uint16_t aen;
    528  1.41   thorpej 	u_int status;
    529   1.1        ad 	volatile u_int32_t junk;
    530   1.7        ad 	int got, rv;
    531   1.1        ad 
    532   1.1        ad 	/* Issue a soft reset. */
    533  1.22        ad 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_ISSUE_SOFT_RESET |
    534   1.1        ad 	    TWE_CTL_CLEAR_HOST_INTR |
    535   1.1        ad 	    TWE_CTL_CLEAR_ATTN_INTR |
    536   1.1        ad 	    TWE_CTL_MASK_CMD_INTR |
    537   1.1        ad 	    TWE_CTL_MASK_RESP_INTR |
    538   1.1        ad 	    TWE_CTL_CLEAR_ERROR_STS |
    539   1.1        ad 	    TWE_CTL_DISABLE_INTRS);
    540   1.1        ad 
    541  1.45   thorpej 	/* Wait for attention... */
    542   1.1        ad 	if (twe_status_wait(sc, TWE_STS_ATTN_INTR, 15)) {
    543   1.1        ad 		printf("%s: no attention interrupt\n",
    544   1.1        ad 		    sc->sc_dv.dv_xname);
    545   1.1        ad 		return (-1);
    546   1.1        ad 	}
    547   1.1        ad 
    548  1.45   thorpej 	/* ...and ACK it. */
    549  1.45   thorpej 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
    550  1.45   thorpej 
    551  1.45   thorpej 	/*
    552  1.45   thorpej 	 * Pull AENs out of the controller; look for a soft reset AEN.
    553  1.45   thorpej 	 * Open code this, since we want to detect reset even if the
    554  1.45   thorpej 	 * queue for management tools is full.
    555  1.45   thorpej 	 */
    556   1.1        ad 	for (got = 0;;) {
    557  1.41   thorpej 		rv = twe_param_get_2(sc, TWE_PARAM_AEN, TWE_PARAM_AEN_UnitCode,
    558  1.41   thorpej 		    &aen);
    559   1.7        ad 		if (rv != 0)
    560  1.45   thorpej 			printf("%s: error %d while draining event queue\n",
    561   1.7        ad 			    sc->sc_dv.dv_xname, rv);
    562  1.41   thorpej 		if (TWE_AEN_CODE(aen) == TWE_AEN_QUEUE_EMPTY)
    563   1.1        ad 			break;
    564  1.41   thorpej 		if (TWE_AEN_CODE(aen) == TWE_AEN_SOFT_RESET)
    565   1.1        ad 			got = 1;
    566  1.45   thorpej 		twe_aen_enqueue(sc, aen, 1);
    567   1.1        ad 	}
    568  1.45   thorpej 
    569   1.1        ad 	if (!got) {
    570   1.1        ad 		printf("%s: reset not reported\n", sc->sc_dv.dv_xname);
    571   1.1        ad 		return (-1);
    572   1.1        ad 	}
    573   1.1        ad 
    574   1.1        ad 	/* Check controller status. */
    575  1.22        ad 	status = twe_inl(sc, TWE_REG_STS);
    576   1.1        ad 	if (twe_status_check(sc, status)) {
    577   1.1        ad 		printf("%s: controller errors detected\n",
    578   1.1        ad 		    sc->sc_dv.dv_xname);
    579   1.1        ad 		return (-1);
    580   1.1        ad 	}
    581   1.1        ad 
    582   1.1        ad 	/* Drain the response queue. */
    583   1.1        ad 	for (;;) {
    584  1.22        ad 		status = twe_inl(sc, TWE_REG_STS);
    585   1.1        ad 		if (twe_status_check(sc, status) != 0) {
    586   1.1        ad 			printf("%s: can't drain response queue\n",
    587   1.1        ad 			    sc->sc_dv.dv_xname);
    588   1.1        ad 			return (-1);
    589   1.1        ad 		}
    590   1.1        ad 		if ((status & TWE_STS_RESP_QUEUE_EMPTY) != 0)
    591   1.1        ad 			break;
    592  1.22        ad 		junk = twe_inl(sc, TWE_REG_RESP_QUEUE);
    593   1.1        ad 	}
    594   1.1        ad 
    595   1.1        ad 	return (0);
    596   1.1        ad }
    597   1.1        ad 
    598   1.1        ad /*
    599   1.1        ad  * Print autoconfiguration message for a sub-device.
    600   1.1        ad  */
    601   1.1        ad static int
    602   1.1        ad twe_print(void *aux, const char *pnp)
    603   1.1        ad {
    604   1.1        ad 	struct twe_attach_args *twea;
    605   1.1        ad 
    606   1.1        ad 	twea = aux;
    607   1.1        ad 
    608   1.1        ad 	if (pnp != NULL)
    609  1.35   thorpej 		aprint_normal("block device at %s", pnp);
    610  1.35   thorpej 	aprint_normal(" unit %d", twea->twea_unit);
    611   1.1        ad 	return (UNCONF);
    612   1.1        ad }
    613   1.1        ad 
    614   1.1        ad /*
    615   1.1        ad  * Match a sub-device.
    616   1.1        ad  */
    617   1.1        ad static int
    618   1.1        ad twe_submatch(struct device *parent, struct cfdata *cf, void *aux)
    619   1.1        ad {
    620   1.1        ad 	struct twe_attach_args *twea;
    621   1.1        ad 
    622   1.1        ad 	twea = aux;
    623   1.1        ad 
    624   1.1        ad 	if (cf->tweacf_unit != TWECF_UNIT_DEFAULT &&
    625   1.1        ad 	    cf->tweacf_unit != twea->twea_unit)
    626   1.1        ad 		return (0);
    627   1.1        ad 
    628  1.28   thorpej 	return (config_match(parent, cf, aux));
    629   1.1        ad }
    630   1.1        ad 
    631   1.1        ad /*
    632   1.1        ad  * Interrupt service routine.
    633   1.1        ad  */
    634   1.1        ad static int
    635   1.1        ad twe_intr(void *arg)
    636   1.1        ad {
    637   1.1        ad 	struct twe_softc *sc;
    638   1.1        ad 	u_int status;
    639   1.7        ad 	int caught, rv;
    640   1.1        ad 
    641   1.1        ad 	sc = arg;
    642   1.1        ad 	caught = 0;
    643  1.22        ad 	status = twe_inl(sc, TWE_REG_STS);
    644   1.1        ad 	twe_status_check(sc, status);
    645   1.1        ad 
    646   1.1        ad 	/* Host interrupts - purpose unknown. */
    647   1.1        ad 	if ((status & TWE_STS_HOST_INTR) != 0) {
    648  1.38  jdolecek #ifdef DEBUG
    649   1.1        ad 		printf("%s: host interrupt\n", sc->sc_dv.dv_xname);
    650   1.1        ad #endif
    651  1.22        ad 		twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_HOST_INTR);
    652   1.1        ad 		caught = 1;
    653   1.1        ad 	}
    654   1.1        ad 
    655   1.1        ad 	/*
    656   1.1        ad 	 * Attention interrupts, signalled when a controller or child device
    657  1.18       wiz 	 * state change has occurred.
    658   1.1        ad 	 */
    659   1.1        ad 	if ((status & TWE_STS_ATTN_INTR) != 0) {
    660  1.45   thorpej 		rv = twe_param_get(sc, TWE_PARAM_AEN,
    661  1.45   thorpej 		    TWE_PARAM_AEN_UnitCode, 2, twe_aen_handler,
    662  1.45   thorpej 		    NULL);
    663  1.45   thorpej 		if (rv != 0)
    664  1.45   thorpej 			printf("%s: unable to retrieve AEN (%d)\n",
    665  1.45   thorpej 			    sc->sc_dv.dv_xname, rv);
    666  1.45   thorpej 		else
    667  1.45   thorpej 			twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
    668   1.1        ad 		caught = 1;
    669   1.1        ad 	}
    670   1.1        ad 
    671   1.1        ad 	/*
    672   1.1        ad 	 * Command interrupts, signalled when the controller can accept more
    673   1.1        ad 	 * commands.  We don't use this; instead, we try to submit commands
    674   1.1        ad 	 * when we receive them, and when other commands have completed.
    675   1.1        ad 	 * Mask it so we don't get another one.
    676   1.1        ad 	 */
    677   1.1        ad 	if ((status & TWE_STS_CMD_INTR) != 0) {
    678  1.38  jdolecek #ifdef DEBUG
    679   1.1        ad 		printf("%s: command interrupt\n", sc->sc_dv.dv_xname);
    680   1.1        ad #endif
    681  1.22        ad 		twe_outl(sc, TWE_REG_CTL, TWE_CTL_MASK_CMD_INTR);
    682   1.1        ad 		caught = 1;
    683   1.1        ad 	}
    684   1.1        ad 
    685   1.1        ad 	if ((status & TWE_STS_RESP_INTR) != 0) {
    686   1.1        ad 		twe_poll(sc);
    687   1.1        ad 		caught = 1;
    688   1.1        ad 	}
    689   1.1        ad 
    690   1.1        ad 	return (caught);
    691   1.1        ad }
    692   1.1        ad 
    693   1.1        ad /*
    694   1.1        ad  * Handle an AEN returned by the controller.
    695   1.1        ad  */
    696   1.1        ad static void
    697   1.1        ad twe_aen_handler(struct twe_ccb *ccb, int error)
    698   1.1        ad {
    699   1.1        ad 	struct twe_softc *sc;
    700   1.1        ad 	struct twe_param *tp;
    701  1.45   thorpej 	uint16_t aen;
    702  1.45   thorpej 	int rv;
    703   1.1        ad 
    704   1.1        ad 	sc = (struct twe_softc *)ccb->ccb_tx.tx_dv;
    705   1.1        ad 	tp = ccb->ccb_tx.tx_context;
    706   1.1        ad 	twe_ccb_unmap(sc, ccb);
    707   1.1        ad 
    708   1.3        ad 	if (error) {
    709   1.1        ad 		printf("%s: error retrieving AEN\n", sc->sc_dv.dv_xname);
    710   1.3        ad 		aen = TWE_AEN_QUEUE_EMPTY;
    711   1.3        ad 	} else
    712   1.1        ad 		aen = le16toh(*(u_int16_t *)tp->tp_data);
    713   1.3        ad 	free(tp, M_DEVBUF);
    714   1.3        ad 	twe_ccb_free(sc, ccb);
    715   1.3        ad 
    716   1.7        ad 	if (TWE_AEN_CODE(aen) == TWE_AEN_QUEUE_EMPTY) {
    717  1.22        ad 		twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
    718   1.7        ad 		return;
    719   1.7        ad 	}
    720   1.7        ad 
    721  1.45   thorpej 	twe_aen_enqueue(sc, aen, 0);
    722   1.3        ad 
    723   1.7        ad 	/*
    724   1.7        ad 	 * Chain another retrieval in case interrupts have been
    725   1.7        ad 	 * coalesced.
    726   1.7        ad 	 */
    727   1.7        ad 	rv = twe_param_get(sc, TWE_PARAM_AEN, TWE_PARAM_AEN_UnitCode, 2,
    728   1.7        ad 	    twe_aen_handler, NULL);
    729   1.7        ad 	if (rv != 0)
    730   1.7        ad 		printf("%s: unable to retrieve AEN (%d)\n",
    731   1.7        ad 		    sc->sc_dv.dv_xname, rv);
    732   1.1        ad }
    733   1.1        ad 
    734  1.45   thorpej static void
    735  1.45   thorpej twe_aen_enqueue(struct twe_softc *sc, uint16_t aen, int quiet)
    736  1.45   thorpej {
    737  1.45   thorpej 	const char *str, *msg;
    738  1.45   thorpej 	int s, next, nextnext;
    739  1.45   thorpej 
    740  1.45   thorpej 	/*
    741  1.45   thorpej 	 * First report the AEN on the console.  Maybe.
    742  1.45   thorpej 	 */
    743  1.45   thorpej 	if (! quiet) {
    744  1.45   thorpej 		str = twe_describe_code(twe_table_aen, TWE_AEN_CODE(aen));
    745  1.45   thorpej 		if (str == NULL) {
    746  1.45   thorpej 			printf("%s: unknown AEN 0x%04x\n",
    747  1.45   thorpej 			    sc->sc_dv.dv_xname, aen);
    748  1.45   thorpej 		} else {
    749  1.45   thorpej 			msg = str + 2;
    750  1.45   thorpej 			switch (*str) {
    751  1.45   thorpej 			case 'u':
    752  1.45   thorpej 				printf("%s: unit %d: %s\n",
    753  1.45   thorpej 				    sc->sc_dv.dv_xname, TWE_AEN_UNIT(aen), msg);
    754  1.45   thorpej 				break;
    755  1.45   thorpej 
    756  1.45   thorpej 			case 'p':
    757  1.45   thorpej 				printf("%s: port %d: %s\n",
    758  1.45   thorpej 				    sc->sc_dv.dv_xname, TWE_AEN_UNIT(aen), msg);
    759  1.45   thorpej 				break;
    760  1.45   thorpej 
    761  1.45   thorpej 			default:
    762  1.45   thorpej 				printf("%s: %s\n", sc->sc_dv.dv_xname, msg);
    763  1.45   thorpej 			}
    764  1.45   thorpej 		}
    765  1.45   thorpej 	}
    766  1.45   thorpej 
    767  1.45   thorpej 	/* Now enqueue the AEN for mangement tools. */
    768  1.45   thorpej 	s = splbio();
    769  1.45   thorpej 
    770  1.45   thorpej 	next = (sc->sc_aen_head + 1) % TWE_AEN_Q_LENGTH;
    771  1.45   thorpej 	nextnext = (sc->sc_aen_head + 2) % TWE_AEN_Q_LENGTH;
    772  1.45   thorpej 
    773  1.45   thorpej 	/*
    774  1.45   thorpej 	 * If this is the last free slot, then queue up a "queue
    775  1.45   thorpej 	 * full" message.
    776  1.45   thorpej 	 */
    777  1.45   thorpej 	if (nextnext == sc->sc_aen_tail)
    778  1.45   thorpej 		aen = TWE_AEN_QUEUE_FULL;
    779  1.45   thorpej 
    780  1.45   thorpej 	if (next != sc->sc_aen_tail) {
    781  1.45   thorpej 		sc->sc_aen_queue[sc->sc_aen_head] = aen;
    782  1.45   thorpej 		sc->sc_aen_head = next;
    783  1.45   thorpej 	}
    784  1.45   thorpej 
    785  1.45   thorpej 	if (sc->sc_flags & TWEF_AENQ_WAIT) {
    786  1.45   thorpej 		sc->sc_flags &= ~TWEF_AENQ_WAIT;
    787  1.45   thorpej 		wakeup(&sc->sc_aen_queue);
    788  1.45   thorpej 	}
    789  1.45   thorpej 
    790  1.45   thorpej 	splx(s);
    791  1.45   thorpej }
    792  1.45   thorpej 
    793  1.45   thorpej /* NOTE: Must be called at splbio(). */
    794  1.45   thorpej static uint16_t
    795  1.45   thorpej twe_aen_dequeue(struct twe_softc *sc)
    796  1.45   thorpej {
    797  1.45   thorpej 	uint16_t aen;
    798  1.45   thorpej 
    799  1.45   thorpej 	if (sc->sc_aen_tail == sc->sc_aen_head)
    800  1.45   thorpej 		aen = TWE_AEN_QUEUE_EMPTY;
    801  1.45   thorpej 	else {
    802  1.45   thorpej 		aen = sc->sc_aen_queue[sc->sc_aen_tail];
    803  1.45   thorpej 		sc->sc_aen_tail = (sc->sc_aen_tail + 1) & TWE_AEN_Q_LENGTH;
    804  1.45   thorpej 	}
    805  1.45   thorpej 
    806  1.45   thorpej 	return (aen);
    807  1.45   thorpej }
    808  1.45   thorpej 
    809   1.1        ad /*
    810  1.41   thorpej  * These are short-hand functions that execute TWE_OP_GET_PARAM to
    811  1.41   thorpej  * fetch 1, 2, and 4 byte parameter values, respectively.
    812  1.41   thorpej  */
    813  1.43   thorpej int
    814  1.41   thorpej twe_param_get_1(struct twe_softc *sc, int table_id, int param_id,
    815  1.41   thorpej     uint8_t *valp)
    816  1.41   thorpej {
    817  1.41   thorpej 	struct twe_param *tp;
    818  1.41   thorpej 	int rv;
    819  1.41   thorpej 
    820  1.41   thorpej 	rv = twe_param_get(sc, table_id, param_id, 1, NULL, &tp);
    821  1.41   thorpej 	if (rv != 0)
    822  1.41   thorpej 		return (rv);
    823  1.41   thorpej 	*valp = *(uint8_t *)tp->tp_data;
    824  1.41   thorpej 	free(tp, M_DEVBUF);
    825  1.41   thorpej 	return (0);
    826  1.41   thorpej }
    827  1.41   thorpej 
    828  1.43   thorpej int
    829  1.41   thorpej twe_param_get_2(struct twe_softc *sc, int table_id, int param_id,
    830  1.41   thorpej     uint16_t *valp)
    831  1.41   thorpej {
    832  1.41   thorpej 	struct twe_param *tp;
    833  1.41   thorpej 	int rv;
    834  1.41   thorpej 
    835  1.41   thorpej 	rv = twe_param_get(sc, table_id, param_id, 2, NULL, &tp);
    836  1.41   thorpej 	if (rv != 0)
    837  1.41   thorpej 		return (rv);
    838  1.41   thorpej 	*valp = le16toh(*(uint16_t *)tp->tp_data);
    839  1.41   thorpej 	free(tp, M_DEVBUF);
    840  1.41   thorpej 	return (0);
    841  1.41   thorpej }
    842  1.41   thorpej 
    843  1.43   thorpej int
    844  1.41   thorpej twe_param_get_4(struct twe_softc *sc, int table_id, int param_id,
    845  1.41   thorpej     uint32_t *valp)
    846  1.41   thorpej {
    847  1.41   thorpej 	struct twe_param *tp;
    848  1.41   thorpej 	int rv;
    849  1.41   thorpej 
    850  1.41   thorpej 	rv = twe_param_get(sc, table_id, param_id, 4, NULL, &tp);
    851  1.41   thorpej 	if (rv != 0)
    852  1.41   thorpej 		return (rv);
    853  1.41   thorpej 	*valp = le32toh(*(uint32_t *)tp->tp_data);
    854  1.41   thorpej 	free(tp, M_DEVBUF);
    855  1.41   thorpej 	return (0);
    856  1.41   thorpej }
    857  1.41   thorpej 
    858  1.41   thorpej /*
    859   1.1        ad  * Execute a TWE_OP_GET_PARAM command.  If a callback function is provided,
    860   1.1        ad  * it will be called with generated context when the command has completed.
    861   1.1        ad  * If no callback is provided, the command will be executed synchronously
    862   1.3        ad  * and a pointer to a buffer containing the data returned.
    863   1.1        ad  *
    864   1.3        ad  * The caller or callback is responsible for freeing the buffer.
    865   1.1        ad  */
    866  1.43   thorpej int
    867   1.1        ad twe_param_get(struct twe_softc *sc, int table_id, int param_id, size_t size,
    868  1.38  jdolecek 	      void (*func)(struct twe_ccb *, int), struct twe_param **pbuf)
    869   1.1        ad {
    870   1.1        ad 	struct twe_ccb *ccb;
    871   1.1        ad 	struct twe_cmd *tc;
    872   1.1        ad 	struct twe_param *tp;
    873   1.1        ad 	int rv, s;
    874   1.1        ad 
    875  1.33  christos 	tp = malloc(TWE_SECTOR_SIZE, M_DEVBUF, M_NOWAIT);
    876  1.33  christos 	if (tp == NULL)
    877  1.33  christos 		return ENOMEM;
    878  1.33  christos 
    879   1.7        ad 	rv = twe_ccb_alloc(sc, &ccb,
    880   1.7        ad 	    TWE_CCB_PARAM | TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
    881   1.7        ad 	if (rv != 0)
    882  1.33  christos 		goto done;
    883   1.1        ad 
    884   1.1        ad 	ccb->ccb_data = tp;
    885   1.1        ad 	ccb->ccb_datasize = TWE_SECTOR_SIZE;
    886   1.1        ad 	ccb->ccb_tx.tx_handler = func;
    887   1.1        ad 	ccb->ccb_tx.tx_context = tp;
    888   1.1        ad 	ccb->ccb_tx.tx_dv = &sc->sc_dv;
    889   1.1        ad 
    890   1.1        ad 	tc = ccb->ccb_cmd;
    891   1.1        ad 	tc->tc_size = 2;
    892   1.1        ad 	tc->tc_opcode = TWE_OP_GET_PARAM | (tc->tc_size << 5);
    893   1.1        ad 	tc->tc_unit = 0;
    894   1.1        ad 	tc->tc_count = htole16(1);
    895   1.1        ad 
    896   1.1        ad 	/* Fill in the outbound parameter data. */
    897   1.1        ad 	tp->tp_table_id = htole16(table_id);
    898   1.1        ad 	tp->tp_param_id = param_id;
    899   1.1        ad 	tp->tp_param_size = size;
    900   1.1        ad 
    901   1.1        ad 	/* Map the transfer. */
    902   1.7        ad 	if ((rv = twe_ccb_map(sc, ccb)) != 0) {
    903   1.2        ad 		twe_ccb_free(sc, ccb);
    904  1.33  christos 		goto done;
    905   1.1        ad 	}
    906   1.1        ad 
    907   1.1        ad 	/* Submit the command and either wait or let the callback handle it. */
    908   1.1        ad 	if (func == NULL) {
    909   1.1        ad 		s = splbio();
    910   1.7        ad 		rv = twe_ccb_poll(sc, ccb, 5);
    911   1.1        ad 		twe_ccb_unmap(sc, ccb);
    912   1.2        ad 		twe_ccb_free(sc, ccb);
    913   1.1        ad 		splx(s);
    914   1.1        ad 	} else {
    915  1.38  jdolecek #ifdef DEBUG
    916  1.33  christos 		if (pbuf != NULL)
    917  1.33  christos 			panic("both func and pbuf defined");
    918  1.33  christos #endif
    919   1.1        ad 		twe_ccb_enqueue(sc, ccb);
    920  1.33  christos 		return 0;
    921  1.33  christos 	}
    922  1.33  christos 
    923  1.33  christos done:
    924  1.33  christos 	if (pbuf == NULL || rv != 0)
    925  1.33  christos 		free(tp, M_DEVBUF);
    926  1.33  christos 	else if (pbuf != NULL && rv == 0)
    927  1.33  christos 		*pbuf = tp;
    928  1.33  christos 	return rv;
    929  1.33  christos }
    930  1.33  christos 
    931  1.33  christos /*
    932  1.33  christos  * Execute a TWE_OP_SET_PARAM command.
    933  1.33  christos  */
    934  1.33  christos static int
    935  1.33  christos twe_param_set(struct twe_softc *sc, int table_id, int param_id, size_t size,
    936  1.33  christos 	      void *buf)
    937  1.33  christos {
    938  1.33  christos 	struct twe_ccb *ccb;
    939  1.33  christos 	struct twe_cmd *tc;
    940  1.33  christos 	struct twe_param *tp;
    941  1.33  christos 	int rv, s;
    942  1.33  christos 
    943  1.33  christos 	tp = malloc(TWE_SECTOR_SIZE, M_DEVBUF, M_NOWAIT);
    944  1.33  christos 	if (tp == NULL)
    945  1.33  christos 		return ENOMEM;
    946  1.33  christos 
    947  1.33  christos 	rv = twe_ccb_alloc(sc, &ccb,
    948  1.33  christos 	    TWE_CCB_PARAM | TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
    949  1.33  christos 	if (rv != 0)
    950  1.33  christos 		goto done;
    951  1.33  christos 
    952  1.33  christos 	ccb->ccb_data = tp;
    953  1.33  christos 	ccb->ccb_datasize = TWE_SECTOR_SIZE;
    954  1.33  christos 	ccb->ccb_tx.tx_handler = 0;
    955  1.33  christos 	ccb->ccb_tx.tx_context = tp;
    956  1.33  christos 	ccb->ccb_tx.tx_dv = &sc->sc_dv;
    957  1.33  christos 
    958  1.33  christos 	tc = ccb->ccb_cmd;
    959  1.33  christos 	tc->tc_size = 2;
    960  1.33  christos 	tc->tc_opcode = TWE_OP_SET_PARAM | (tc->tc_size << 5);
    961  1.33  christos 	tc->tc_unit = 0;
    962  1.33  christos 	tc->tc_count = htole16(1);
    963  1.33  christos 
    964  1.33  christos 	/* Fill in the outbound parameter data. */
    965  1.33  christos 	tp->tp_table_id = htole16(table_id);
    966  1.33  christos 	tp->tp_param_id = param_id;
    967  1.33  christos 	tp->tp_param_size = size;
    968  1.33  christos 	memcpy(tp->tp_data, buf, size);
    969  1.33  christos 
    970  1.33  christos 	/* Map the transfer. */
    971  1.33  christos 	if ((rv = twe_ccb_map(sc, ccb)) != 0) {
    972  1.33  christos 		twe_ccb_free(sc, ccb);
    973  1.33  christos 		goto done;
    974   1.1        ad 	}
    975   1.1        ad 
    976  1.33  christos 	/* Submit the command and wait. */
    977  1.33  christos 	s = splbio();
    978  1.33  christos 	rv = twe_ccb_poll(sc, ccb, 5);
    979  1.33  christos 	twe_ccb_unmap(sc, ccb);
    980  1.33  christos 	twe_ccb_free(sc, ccb);
    981  1.33  christos 	splx(s);
    982  1.33  christos done:
    983  1.33  christos 	free(tp, M_DEVBUF);
    984   1.7        ad 	return (rv);
    985   1.1        ad }
    986   1.1        ad 
    987   1.1        ad /*
    988   1.1        ad  * Execute a TWE_OP_INIT_CONNECTION command.  Return non-zero on error.
    989   1.1        ad  * Must be called with interrupts blocked.
    990   1.1        ad  */
    991   1.1        ad static int
    992   1.1        ad twe_init_connection(struct twe_softc *sc)
    993  1.33  christos /*###762 [cc] warning: `twe_init_connection' was used with no prototype before its definition%%%*/
    994  1.33  christos /*###762 [cc] warning: `twe_init_connection' was declared implicitly `extern' and later `static'%%%*/
    995   1.1        ad {
    996   1.1        ad 	struct twe_ccb *ccb;
    997   1.1        ad 	struct twe_cmd *tc;
    998   1.1        ad 	int rv;
    999   1.1        ad 
   1000   1.3        ad 	if ((rv = twe_ccb_alloc(sc, &ccb, 0)) != 0)
   1001   1.1        ad 		return (rv);
   1002   1.1        ad 
   1003   1.1        ad 	/* Build the command. */
   1004   1.1        ad 	tc = ccb->ccb_cmd;
   1005   1.1        ad 	tc->tc_size = 3;
   1006   1.1        ad 	tc->tc_opcode = TWE_OP_INIT_CONNECTION;
   1007   1.1        ad 	tc->tc_unit = 0;
   1008   1.3        ad 	tc->tc_count = htole16(TWE_MAX_CMDS);
   1009   1.1        ad 	tc->tc_args.init_connection.response_queue_pointer = 0;
   1010   1.1        ad 
   1011   1.1        ad 	/* Submit the command for immediate execution. */
   1012   1.7        ad 	rv = twe_ccb_poll(sc, ccb, 5);
   1013   1.2        ad 	twe_ccb_free(sc, ccb);
   1014   1.1        ad 	return (rv);
   1015   1.1        ad }
   1016   1.1        ad 
   1017   1.1        ad /*
   1018   1.1        ad  * Poll the controller for completed commands.  Must be called with
   1019   1.1        ad  * interrupts blocked.
   1020   1.1        ad  */
   1021   1.1        ad static void
   1022   1.1        ad twe_poll(struct twe_softc *sc)
   1023   1.1        ad {
   1024   1.1        ad 	struct twe_ccb *ccb;
   1025   1.1        ad 	int found;
   1026   1.1        ad 	u_int status, cmdid;
   1027   1.1        ad 
   1028   1.1        ad 	found = 0;
   1029   1.1        ad 
   1030   1.1        ad 	for (;;) {
   1031  1.22        ad 		status = twe_inl(sc, TWE_REG_STS);
   1032   1.1        ad 		twe_status_check(sc, status);
   1033   1.1        ad 
   1034   1.1        ad 		if ((status & TWE_STS_RESP_QUEUE_EMPTY))
   1035   1.1        ad 			break;
   1036   1.1        ad 
   1037   1.1        ad 		found = 1;
   1038  1.22        ad 		cmdid = twe_inl(sc, TWE_REG_RESP_QUEUE);
   1039   1.1        ad 		cmdid = (cmdid & TWE_RESP_MASK) >> TWE_RESP_SHIFT;
   1040   1.7        ad 		if (cmdid >= TWE_MAX_QUEUECNT) {
   1041   1.1        ad 			printf("%s: bad completion\n", sc->sc_dv.dv_xname);
   1042   1.1        ad 			continue;
   1043   1.1        ad 		}
   1044   1.1        ad 
   1045   1.1        ad 		ccb = sc->sc_ccbs + cmdid;
   1046   1.1        ad 		if ((ccb->ccb_flags & TWE_CCB_ACTIVE) == 0) {
   1047   1.1        ad 			printf("%s: bad completion (not active)\n",
   1048   1.1        ad 			    sc->sc_dv.dv_xname);
   1049   1.1        ad 			continue;
   1050   1.1        ad 		}
   1051   1.1        ad 		ccb->ccb_flags ^= TWE_CCB_COMPLETE | TWE_CCB_ACTIVE;
   1052   1.1        ad 
   1053   1.1        ad 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
   1054   1.1        ad 		    (caddr_t)ccb->ccb_cmd - sc->sc_cmds,
   1055   1.1        ad 		    sizeof(struct twe_cmd),
   1056   1.1        ad 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
   1057   1.1        ad 
   1058   1.1        ad 		/* Pass notification to upper layers. */
   1059   1.1        ad 		if (ccb->ccb_tx.tx_handler != NULL)
   1060   1.1        ad 			(*ccb->ccb_tx.tx_handler)(ccb,
   1061   1.1        ad 			    ccb->ccb_cmd->tc_status != 0 ? EIO : 0);
   1062   1.1        ad 	}
   1063   1.1        ad 
   1064   1.1        ad 	/* If any commands have completed, run the software queue. */
   1065   1.1        ad 	if (found)
   1066   1.1        ad 		twe_ccb_enqueue(sc, NULL);
   1067   1.1        ad }
   1068   1.1        ad 
   1069   1.1        ad /*
   1070   1.1        ad  * Wait for `status' to be set in the controller status register.  Return
   1071   1.1        ad  * zero if found, non-zero if the operation timed out.
   1072   1.1        ad  */
   1073   1.1        ad static int
   1074   1.1        ad twe_status_wait(struct twe_softc *sc, u_int32_t status, int timo)
   1075   1.1        ad {
   1076   1.1        ad 
   1077  1.11        ad 	for (timo *= 10; timo != 0; timo--) {
   1078  1.22        ad 		if ((twe_inl(sc, TWE_REG_STS) & status) == status)
   1079   1.1        ad 			break;
   1080   1.1        ad 		delay(100000);
   1081   1.1        ad 	}
   1082   1.1        ad 
   1083   1.1        ad 	return (timo == 0);
   1084   1.1        ad }
   1085   1.1        ad 
   1086   1.1        ad /*
   1087   1.1        ad  * Complain if the status bits aren't what we expect.
   1088   1.1        ad  */
   1089   1.1        ad static int
   1090   1.1        ad twe_status_check(struct twe_softc *sc, u_int status)
   1091   1.1        ad {
   1092   1.1        ad 	int rv;
   1093   1.1        ad 
   1094   1.1        ad 	rv = 0;
   1095   1.1        ad 
   1096   1.1        ad 	if ((status & TWE_STS_EXPECTED_BITS) != TWE_STS_EXPECTED_BITS) {
   1097   1.1        ad 		printf("%s: missing status bits: 0x%08x\n", sc->sc_dv.dv_xname,
   1098   1.1        ad 		    status & ~TWE_STS_EXPECTED_BITS);
   1099   1.1        ad 		rv = -1;
   1100   1.1        ad 	}
   1101   1.1        ad 
   1102   1.1        ad 	if ((status & TWE_STS_UNEXPECTED_BITS) != 0) {
   1103   1.1        ad 		printf("%s: unexpected status bits: 0x%08x\n",
   1104   1.1        ad 		    sc->sc_dv.dv_xname, status & TWE_STS_UNEXPECTED_BITS);
   1105   1.1        ad 		rv = -1;
   1106   1.1        ad 	}
   1107   1.1        ad 
   1108   1.1        ad 	return (rv);
   1109   1.1        ad }
   1110   1.1        ad 
   1111   1.1        ad /*
   1112   1.1        ad  * Allocate and initialise a CCB.
   1113   1.1        ad  */
   1114   1.1        ad int
   1115   1.3        ad twe_ccb_alloc(struct twe_softc *sc, struct twe_ccb **ccbp, int flags)
   1116   1.1        ad {
   1117   1.1        ad 	struct twe_cmd *tc;
   1118   1.1        ad 	struct twe_ccb *ccb;
   1119   1.1        ad 	int s;
   1120   1.1        ad 
   1121   1.7        ad 	s = splbio();
   1122   1.3        ad 	if ((flags & TWE_CCB_PARAM) != 0)
   1123   1.3        ad 		ccb = sc->sc_ccbs;
   1124   1.3        ad 	else {
   1125   1.3        ad 		/* Allocate a CCB and command block. */
   1126   1.3        ad 		if (SLIST_FIRST(&sc->sc_ccb_freelist) == NULL) {
   1127   1.1        ad 			splx(s);
   1128   1.1        ad 			return (EAGAIN);
   1129   1.1        ad 		}
   1130   1.3        ad 		ccb = SLIST_FIRST(&sc->sc_ccb_freelist);
   1131   1.3        ad 		SLIST_REMOVE_HEAD(&sc->sc_ccb_freelist, ccb_chain.slist);
   1132   1.1        ad 	}
   1133   1.3        ad #ifdef DIAGNOSTIC
   1134   1.3        ad 	if ((ccb->ccb_flags & TWE_CCB_ALLOCED) != 0)
   1135   1.3        ad 		panic("twe_ccb_alloc: CCB already allocated");
   1136   1.3        ad 	flags |= TWE_CCB_ALLOCED;
   1137   1.3        ad #endif
   1138   1.7        ad 	splx(s);
   1139   1.1        ad 
   1140   1.1        ad 	/* Initialise some fields and return. */
   1141   1.1        ad 	ccb->ccb_tx.tx_handler = NULL;
   1142   1.3        ad 	ccb->ccb_flags = flags;
   1143   1.1        ad 	tc = ccb->ccb_cmd;
   1144   1.1        ad 	tc->tc_status = 0;
   1145   1.1        ad 	tc->tc_flags = 0;
   1146   1.1        ad 	tc->tc_cmdid = ccb->ccb_cmdid;
   1147   1.3        ad 	*ccbp = ccb;
   1148   1.1        ad 
   1149   1.1        ad 	return (0);
   1150   1.1        ad }
   1151   1.1        ad 
   1152   1.1        ad /*
   1153   1.3        ad  * Free a CCB.
   1154   1.1        ad  */
   1155   1.1        ad void
   1156   1.2        ad twe_ccb_free(struct twe_softc *sc, struct twe_ccb *ccb)
   1157   1.1        ad {
   1158   1.1        ad 	int s;
   1159   1.1        ad 
   1160   1.3        ad 	s = splbio();
   1161   1.3        ad 	if ((ccb->ccb_flags & TWE_CCB_PARAM) == 0)
   1162   1.3        ad 		SLIST_INSERT_HEAD(&sc->sc_ccb_freelist, ccb, ccb_chain.slist);
   1163   1.1        ad 	ccb->ccb_flags = 0;
   1164   1.1        ad 	splx(s);
   1165   1.1        ad }
   1166   1.1        ad 
   1167   1.1        ad /*
   1168   1.1        ad  * Map the specified CCB's command block and data buffer (if any) into
   1169   1.1        ad  * controller visible space.  Perform DMA synchronisation.
   1170   1.1        ad  */
   1171   1.1        ad int
   1172   1.1        ad twe_ccb_map(struct twe_softc *sc, struct twe_ccb *ccb)
   1173   1.1        ad {
   1174   1.1        ad 	struct twe_cmd *tc;
   1175  1.20        ad 	int flags, nsegs, i, s, rv;
   1176   1.1        ad 	void *data;
   1177   1.1        ad 
   1178   1.7        ad 	/*
   1179   1.7        ad 	 * The data as a whole must be 512-byte aligned.
   1180   1.7        ad 	 */
   1181   1.1        ad 	if (((u_long)ccb->ccb_data & (TWE_ALIGNMENT - 1)) != 0) {
   1182  1.20        ad 		s = splvm();
   1183  1.20        ad 		/* XXX */
   1184  1.20        ad 		ccb->ccb_abuf = uvm_km_kmemalloc(kmem_map, NULL,
   1185  1.20        ad 		    ccb->ccb_datasize, UVM_KMF_NOWAIT);
   1186  1.20        ad 		splx(s);
   1187  1.20        ad 		data = (void *)ccb->ccb_abuf;
   1188   1.2        ad 		if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
   1189   1.2        ad 			memcpy(data, ccb->ccb_data, ccb->ccb_datasize);
   1190   1.1        ad 	} else {
   1191  1.20        ad 		ccb->ccb_abuf = (vaddr_t)0;
   1192   1.1        ad 		data = ccb->ccb_data;
   1193   1.1        ad 	}
   1194   1.1        ad 
   1195   1.7        ad 	/*
   1196   1.7        ad 	 * Map the data buffer into bus space and build the S/G list.
   1197   1.7        ad 	 */
   1198   1.7        ad 	rv = bus_dmamap_load(sc->sc_dmat, ccb->ccb_dmamap_xfer, data,
   1199  1.16   thorpej 	    ccb->ccb_datasize, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
   1200  1.16   thorpej 	    ((ccb->ccb_flags & TWE_CCB_DATA_IN) ?
   1201  1.22        ad 	    BUS_DMA_READ : BUS_DMA_WRITE));
   1202   1.7        ad 	if (rv != 0) {
   1203  1.20        ad 		if (ccb->ccb_abuf != (vaddr_t)0) {
   1204  1.20        ad 			s = splvm();
   1205  1.20        ad 			/* XXX */
   1206  1.20        ad 			uvm_km_free(kmem_map, ccb->ccb_abuf,
   1207   1.7        ad 			    ccb->ccb_datasize);
   1208  1.20        ad 			splx(s);
   1209   1.7        ad 		}
   1210   1.7        ad 		return (rv);
   1211   1.7        ad 	}
   1212   1.1        ad 
   1213   1.1        ad 	nsegs = ccb->ccb_dmamap_xfer->dm_nsegs;
   1214   1.1        ad 	tc = ccb->ccb_cmd;
   1215   1.1        ad 	tc->tc_size += 2 * nsegs;
   1216   1.1        ad 
   1217   1.1        ad 	/* The location of the S/G list is dependant upon command type. */
   1218   1.1        ad 	switch (tc->tc_opcode >> 5) {
   1219   1.1        ad 	case 2:
   1220   1.1        ad 		for (i = 0; i < nsegs; i++) {
   1221   1.1        ad 			tc->tc_args.param.sgl[i].tsg_address =
   1222   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr);
   1223   1.1        ad 			tc->tc_args.param.sgl[i].tsg_length =
   1224   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len);
   1225   1.1        ad 		}
   1226   1.1        ad 		/* XXX Needed? */
   1227   1.1        ad 		for (; i < TWE_SG_SIZE; i++) {
   1228   1.1        ad 			tc->tc_args.param.sgl[i].tsg_address = 0;
   1229   1.1        ad 			tc->tc_args.param.sgl[i].tsg_length = 0;
   1230   1.1        ad 		}
   1231   1.1        ad 		break;
   1232   1.1        ad 	case 3:
   1233   1.1        ad 		for (i = 0; i < nsegs; i++) {
   1234   1.1        ad 			tc->tc_args.io.sgl[i].tsg_address =
   1235   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr);
   1236   1.1        ad 			tc->tc_args.io.sgl[i].tsg_length =
   1237   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len);
   1238   1.1        ad 		}
   1239   1.1        ad 		/* XXX Needed? */
   1240   1.1        ad 		for (; i < TWE_SG_SIZE; i++) {
   1241   1.1        ad 			tc->tc_args.io.sgl[i].tsg_address = 0;
   1242   1.1        ad 			tc->tc_args.io.sgl[i].tsg_length = 0;
   1243   1.1        ad 		}
   1244   1.1        ad 		break;
   1245   1.1        ad #ifdef DEBUG
   1246   1.1        ad 	default:
   1247   1.1        ad 		panic("twe_ccb_map: oops");
   1248   1.1        ad #endif
   1249   1.1        ad 	}
   1250   1.1        ad 
   1251   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
   1252   1.1        ad 		flags = BUS_DMASYNC_PREREAD;
   1253   1.1        ad 	else
   1254   1.1        ad 		flags = 0;
   1255   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
   1256   1.1        ad 		flags |= BUS_DMASYNC_PREWRITE;
   1257   1.1        ad 
   1258   1.1        ad 	bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0,
   1259   1.1        ad 	    ccb->ccb_datasize, flags);
   1260   1.1        ad 	return (0);
   1261   1.1        ad }
   1262   1.1        ad 
   1263   1.1        ad /*
   1264   1.1        ad  * Unmap the specified CCB's command block and data buffer (if any) and
   1265   1.1        ad  * perform DMA synchronisation.
   1266   1.1        ad  */
   1267   1.1        ad void
   1268   1.1        ad twe_ccb_unmap(struct twe_softc *sc, struct twe_ccb *ccb)
   1269   1.1        ad {
   1270  1.20        ad 	int flags, s;
   1271   1.1        ad 
   1272   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
   1273   1.1        ad 		flags = BUS_DMASYNC_POSTREAD;
   1274   1.1        ad 	else
   1275   1.1        ad 		flags = 0;
   1276   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
   1277   1.1        ad 		flags |= BUS_DMASYNC_POSTWRITE;
   1278   1.1        ad 
   1279   1.1        ad 	bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0,
   1280   1.1        ad 	    ccb->ccb_datasize, flags);
   1281   1.1        ad 	bus_dmamap_unload(sc->sc_dmat, ccb->ccb_dmamap_xfer);
   1282   1.1        ad 
   1283  1.20        ad 	if (ccb->ccb_abuf != (vaddr_t)0) {
   1284   1.2        ad 		if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
   1285  1.20        ad 			memcpy(ccb->ccb_data, (void *)ccb->ccb_abuf,
   1286   1.2        ad 			    ccb->ccb_datasize);
   1287  1.20        ad 		s = splvm();
   1288  1.20        ad 		/* XXX */
   1289  1.20        ad 		uvm_km_free(kmem_map, ccb->ccb_abuf, ccb->ccb_datasize);
   1290  1.20        ad 		splx(s);
   1291   1.1        ad 	}
   1292   1.1        ad }
   1293   1.1        ad 
   1294   1.1        ad /*
   1295   1.7        ad  * Submit a command to the controller and poll on completion.  Return
   1296   1.7        ad  * non-zero on timeout (but don't check status, as some command types don't
   1297   1.7        ad  * return status).  Must be called with interrupts blocked.
   1298   1.1        ad  */
   1299   1.1        ad int
   1300   1.1        ad twe_ccb_poll(struct twe_softc *sc, struct twe_ccb *ccb, int timo)
   1301   1.1        ad {
   1302   1.7        ad 	int rv;
   1303   1.7        ad 
   1304   1.7        ad 	if ((rv = twe_ccb_submit(sc, ccb)) != 0)
   1305   1.7        ad 		return (rv);
   1306   1.1        ad 
   1307  1.15        ad 	for (timo *= 1000; timo != 0; timo--) {
   1308   1.1        ad 		twe_poll(sc);
   1309   1.1        ad 		if ((ccb->ccb_flags & TWE_CCB_COMPLETE) != 0)
   1310   1.1        ad 			break;
   1311  1.15        ad 		DELAY(100);
   1312   1.1        ad 	}
   1313   1.1        ad 
   1314   1.1        ad 	return (timo == 0);
   1315   1.1        ad }
   1316   1.1        ad 
   1317   1.1        ad /*
   1318   1.1        ad  * If a CCB is specified, enqueue it.  Pull CCBs off the software queue in
   1319   1.1        ad  * the order that they were enqueued and try to submit their command blocks
   1320   1.1        ad  * to the controller for execution.
   1321   1.1        ad  */
   1322   1.1        ad void
   1323   1.1        ad twe_ccb_enqueue(struct twe_softc *sc, struct twe_ccb *ccb)
   1324   1.1        ad {
   1325   1.1        ad 	int s;
   1326   1.1        ad 
   1327   1.1        ad 	s = splbio();
   1328   1.1        ad 
   1329   1.1        ad 	if (ccb != NULL)
   1330   1.1        ad 		SIMPLEQ_INSERT_TAIL(&sc->sc_ccb_queue, ccb, ccb_chain.simpleq);
   1331   1.1        ad 
   1332   1.1        ad 	while ((ccb = SIMPLEQ_FIRST(&sc->sc_ccb_queue)) != NULL) {
   1333   1.1        ad 		if (twe_ccb_submit(sc, ccb))
   1334   1.1        ad 			break;
   1335  1.25     lukem 		SIMPLEQ_REMOVE_HEAD(&sc->sc_ccb_queue, ccb_chain.simpleq);
   1336   1.1        ad 	}
   1337   1.1        ad 
   1338   1.1        ad 	splx(s);
   1339   1.1        ad }
   1340   1.1        ad 
   1341   1.1        ad /*
   1342   1.1        ad  * Submit the command block associated with the specified CCB to the
   1343   1.1        ad  * controller for execution.  Must be called with interrupts blocked.
   1344   1.1        ad  */
   1345   1.1        ad int
   1346   1.1        ad twe_ccb_submit(struct twe_softc *sc, struct twe_ccb *ccb)
   1347   1.1        ad {
   1348   1.1        ad 	bus_addr_t pa;
   1349   1.1        ad 	int rv;
   1350   1.1        ad 	u_int status;
   1351   1.1        ad 
   1352   1.1        ad 	/* Check to see if we can post a command. */
   1353  1.22        ad 	status = twe_inl(sc, TWE_REG_STS);
   1354   1.1        ad 	twe_status_check(sc, status);
   1355   1.1        ad 
   1356   1.1        ad 	if ((status & TWE_STS_CMD_QUEUE_FULL) == 0) {
   1357   1.1        ad 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
   1358   1.1        ad 		    (caddr_t)ccb->ccb_cmd - sc->sc_cmds, sizeof(struct twe_cmd),
   1359   1.1        ad 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
   1360   1.1        ad 		ccb->ccb_flags |= TWE_CCB_ACTIVE;
   1361   1.1        ad 		pa = sc->sc_cmds_paddr +
   1362   1.1        ad 		    ccb->ccb_cmdid * sizeof(struct twe_cmd);
   1363  1.22        ad 		twe_outl(sc, TWE_REG_CMD_QUEUE, (u_int32_t)pa);
   1364   1.1        ad 		rv = 0;
   1365   1.1        ad 	} else
   1366   1.1        ad 		rv = EBUSY;
   1367   1.1        ad 
   1368   1.1        ad 	return (rv);
   1369  1.33  christos }
   1370  1.33  christos 
   1371  1.33  christos 
   1372  1.33  christos /*
   1373  1.33  christos  * Accept an open operation on the control device.
   1374  1.33  christos  */
   1375  1.33  christos int
   1376  1.37      fvdl tweopen(dev_t dev, int flag, int mode, struct proc *p)
   1377  1.33  christos {
   1378  1.33  christos 	struct twe_softc *twe;
   1379  1.33  christos 
   1380  1.33  christos 	if ((twe = device_lookup(&twe_cd, minor(dev))) == NULL)
   1381  1.33  christos 		return (ENXIO);
   1382  1.33  christos 	if ((twe->sc_flags & TWEF_OPEN) != 0)
   1383  1.33  christos 		return (EBUSY);
   1384  1.33  christos 
   1385  1.33  christos 	twe->sc_flags |= TWEF_OPEN;
   1386  1.33  christos 	return (0);
   1387  1.33  christos }
   1388  1.33  christos 
   1389  1.33  christos /*
   1390  1.33  christos  * Accept the last close on the control device.
   1391  1.33  christos  */
   1392  1.33  christos int
   1393  1.37      fvdl tweclose(dev_t dev, int flag, int mode, struct proc *p)
   1394  1.33  christos {
   1395  1.33  christos 	struct twe_softc *twe;
   1396  1.33  christos 
   1397  1.33  christos 	twe = device_lookup(&twe_cd, minor(dev));
   1398  1.33  christos 	twe->sc_flags &= ~TWEF_OPEN;
   1399  1.33  christos 	return (0);
   1400  1.33  christos }
   1401  1.33  christos 
   1402  1.33  christos /*
   1403  1.33  christos  * Handle control operations.
   1404  1.33  christos  */
   1405  1.33  christos int
   1406  1.37      fvdl tweioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
   1407  1.33  christos {
   1408  1.33  christos 	struct twe_softc *twe;
   1409  1.33  christos 	struct twe_ccb *ccb;
   1410  1.33  christos 	struct twe_param *param;
   1411  1.33  christos 	struct twe_usercommand *tu;
   1412  1.33  christos 	struct twe_paramcommand *tp;
   1413  1.33  christos 	union twe_statrequest *ts;
   1414  1.33  christos 	void *pdata = NULL;
   1415  1.33  christos 	int rv, s, error = 0;
   1416  1.33  christos 	u_int8_t cmdid;
   1417  1.33  christos 
   1418  1.33  christos 	if (securelevel >= 2)
   1419  1.33  christos 		return (EPERM);
   1420  1.33  christos 
   1421  1.33  christos 	twe = device_lookup(&twe_cd, minor(dev));
   1422  1.33  christos 	tu = (struct twe_usercommand *)data;
   1423  1.33  christos 	tp = (struct twe_paramcommand *)data;
   1424  1.33  christos 	ts = (union twe_statrequest *)data;
   1425  1.33  christos 
   1426  1.33  christos 	/* Hmm, compatible with FreeBSD */
   1427  1.33  christos 	switch (cmd) {
   1428  1.33  christos 	case TWEIO_COMMAND:
   1429  1.33  christos 		if (tu->tu_size > 0) {
   1430  1.33  christos 			if (tu->tu_size > TWE_SECTOR_SIZE)
   1431  1.33  christos 				return EINVAL;
   1432  1.33  christos 			pdata = malloc(tu->tu_size, M_DEVBUF, M_WAITOK);
   1433  1.33  christos 			error = copyin(tu->tu_data, pdata, tu->tu_size);
   1434  1.33  christos 			if (error != 0)
   1435  1.33  christos 				goto done;
   1436  1.33  christos 			error = twe_ccb_alloc(twe, &ccb, TWE_CCB_PARAM |
   1437  1.33  christos 			    TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
   1438  1.33  christos 		} else {
   1439  1.33  christos 			error = twe_ccb_alloc(twe, &ccb, 0);
   1440  1.33  christos 		}
   1441  1.33  christos 		if (rv != 0)
   1442  1.33  christos 			goto done;
   1443  1.33  christos 		cmdid = ccb->ccb_cmdid;
   1444  1.33  christos 		memcpy(ccb->ccb_cmd, &tu->tu_cmd, sizeof(struct twe_cmd));
   1445  1.33  christos 		ccb->ccb_cmdid = cmdid;
   1446  1.33  christos 		if (ccb->ccb_flags & TWE_CCB_PARAM) {
   1447  1.33  christos 			ccb->ccb_data = pdata;
   1448  1.33  christos 			ccb->ccb_datasize = TWE_SECTOR_SIZE;
   1449  1.33  christos 			ccb->ccb_tx.tx_handler = 0;
   1450  1.33  christos 			ccb->ccb_tx.tx_context = pdata;
   1451  1.33  christos 			ccb->ccb_tx.tx_dv = &twe->sc_dv;
   1452  1.33  christos 		}
   1453  1.33  christos 		/* Map the transfer. */
   1454  1.33  christos 		if ((error = twe_ccb_map(twe, ccb)) != 0) {
   1455  1.33  christos 			twe_ccb_free(twe, ccb);
   1456  1.33  christos 			goto done;
   1457  1.33  christos 		}
   1458  1.33  christos 
   1459  1.33  christos 		/* Submit the command and wait. */
   1460  1.33  christos 		s = splbio();
   1461  1.33  christos 		rv = twe_ccb_poll(twe, ccb, 5);
   1462  1.33  christos 		twe_ccb_unmap(twe, ccb);
   1463  1.33  christos 		twe_ccb_free(twe, ccb);
   1464  1.33  christos 		splx(s);
   1465  1.33  christos 
   1466  1.33  christos 		if (tu->tu_size > 0)
   1467  1.33  christos 			error = copyout(pdata, tu->tu_data, tu->tu_size);
   1468  1.33  christos 		goto done;
   1469  1.33  christos 
   1470  1.33  christos 	case TWEIO_STATS:
   1471  1.33  christos 		return (ENOENT);
   1472  1.33  christos 
   1473  1.33  christos 	case TWEIO_AEN_POLL:
   1474  1.45   thorpej 		s = splbio();
   1475  1.45   thorpej 		*(u_int *)data = twe_aen_dequeue(twe);
   1476  1.45   thorpej 		splx(s);
   1477  1.33  christos 		return (0);
   1478  1.33  christos 
   1479  1.33  christos 	case TWEIO_AEN_WAIT:
   1480  1.33  christos 		s = splbio();
   1481  1.45   thorpej 		while ((*(u_int *)data =
   1482  1.45   thorpej 		    twe_aen_dequeue(twe)) == TWE_AEN_QUEUE_EMPTY) {
   1483  1.45   thorpej 			twe->sc_flags |= TWEF_AENQ_WAIT;
   1484  1.45   thorpej 			error = tsleep(&twe->sc_aen_queue, PRIBIO | PCATCH,
   1485  1.45   thorpej 			    "tweaen", 0);
   1486  1.45   thorpej 			if (error == EINTR) {
   1487  1.45   thorpej 				splx(s);
   1488  1.45   thorpej 				return (error);
   1489  1.45   thorpej 			}
   1490  1.33  christos 		}
   1491  1.33  christos 		splx(s);
   1492  1.33  christos 		return (0);
   1493  1.33  christos 
   1494  1.33  christos 	case TWEIO_GET_PARAM:
   1495  1.33  christos 		error = twe_param_get(twe, tp->tp_table_id, tp->tp_param_id,
   1496  1.39  jdolecek 		    tp->tp_size, 0, &param);
   1497  1.33  christos 		if (error != 0)
   1498  1.33  christos 			return (error);
   1499  1.33  christos 		if (param->tp_param_size > tp->tp_size) {
   1500  1.33  christos 			error = EFAULT;
   1501  1.33  christos 			goto done;
   1502  1.33  christos 		}
   1503  1.33  christos 		error = copyout(param->tp_data, tp->tp_data,
   1504  1.33  christos 		    param->tp_param_size);
   1505  1.33  christos 		goto done;
   1506  1.33  christos 
   1507  1.33  christos 	case TWEIO_SET_PARAM:
   1508  1.33  christos 		pdata = malloc(tp->tp_size, M_DEVBUF, M_WAITOK);
   1509  1.33  christos 		if ((error = copyin(tp->tp_data, pdata, tp->tp_size)) != 0)
   1510  1.33  christos 			goto done;
   1511  1.33  christos 		error = twe_param_set(twe, tp->tp_table_id, tp->tp_param_id,
   1512  1.33  christos 		    tp->tp_size, pdata);
   1513  1.33  christos 		goto done;
   1514  1.33  christos 
   1515  1.33  christos 	case TWEIO_RESET:
   1516  1.33  christos 		twe_reset(twe);
   1517  1.33  christos 		return (0);
   1518  1.33  christos 
   1519  1.33  christos 	default:
   1520  1.33  christos 		return EINVAL;
   1521  1.33  christos 	}
   1522  1.33  christos done:
   1523  1.33  christos 	if (pdata)
   1524  1.33  christos 		free(pdata, M_DEVBUF);
   1525  1.33  christos 	return error;
   1526  1.38  jdolecek }
   1527  1.38  jdolecek 
   1528  1.38  jdolecek /*
   1529  1.38  jdolecek  * Print some information about the controller
   1530  1.38  jdolecek  */
   1531  1.38  jdolecek static void
   1532  1.38  jdolecek twe_describe_controller(struct twe_softc *sc)
   1533  1.38  jdolecek {
   1534  1.41   thorpej 	struct twe_param *p[6];
   1535  1.44   thorpej 	int i, rv = 0;
   1536  1.44   thorpej 	uint32_t dsize;
   1537  1.41   thorpej 	uint8_t ports;
   1538  1.41   thorpej 
   1539  1.38  jdolecek 	/* get the port count */
   1540  1.41   thorpej 	rv |= twe_param_get_1(sc, TWE_PARAM_CONTROLLER,
   1541  1.41   thorpej 		TWE_PARAM_CONTROLLER_PortCount, &ports);
   1542  1.38  jdolecek 
   1543  1.38  jdolecek 	/* get version strings */
   1544  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_Mon,
   1545  1.41   thorpej 		16, NULL, &p[0]);
   1546  1.41   thorpej 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_FW,
   1547  1.38  jdolecek 		16, NULL, &p[1]);
   1548  1.41   thorpej 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_BIOS,
   1549  1.38  jdolecek 		16, NULL, &p[2]);
   1550  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_PCB,
   1551  1.41   thorpej 		8, NULL, &p[3]);
   1552  1.41   thorpej 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_ATA,
   1553  1.38  jdolecek 		8, NULL, &p[4]);
   1554  1.41   thorpej 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_PCI,
   1555  1.38  jdolecek 		8, NULL, &p[5]);
   1556  1.38  jdolecek 
   1557  1.38  jdolecek 	if (rv) {
   1558  1.38  jdolecek 		/* some error occurred */
   1559  1.38  jdolecek 		aprint_error("%s: failed to fetch version information\n",
   1560  1.38  jdolecek 			sc->sc_dv.dv_xname);
   1561  1.38  jdolecek 		return;
   1562  1.38  jdolecek 	}
   1563  1.38  jdolecek 
   1564  1.38  jdolecek 	aprint_normal("%s: %d ports, Firmware %.16s, BIOS %.16s\n",
   1565  1.41   thorpej 		sc->sc_dv.dv_xname, ports,
   1566  1.41   thorpej 		p[1]->tp_data, p[2]->tp_data);
   1567  1.38  jdolecek 
   1568  1.38  jdolecek 	aprint_verbose("%s: Monitor %.16s, PCB %.8s, Achip %.8s, Pchip %.8s\n",
   1569  1.38  jdolecek 		sc->sc_dv.dv_xname,
   1570  1.41   thorpej 		p[0]->tp_data, p[3]->tp_data,
   1571  1.41   thorpej 		p[4]->tp_data, p[5]->tp_data);
   1572  1.38  jdolecek 
   1573  1.38  jdolecek 	free(p[0], M_DEVBUF);
   1574  1.38  jdolecek 	free(p[1], M_DEVBUF);
   1575  1.38  jdolecek 	free(p[2], M_DEVBUF);
   1576  1.38  jdolecek 	free(p[3], M_DEVBUF);
   1577  1.38  jdolecek 	free(p[4], M_DEVBUF);
   1578  1.38  jdolecek 	free(p[5], M_DEVBUF);
   1579  1.44   thorpej 
   1580  1.44   thorpej 	rv = twe_param_get(sc, TWE_PARAM_DRIVESUMMARY,
   1581  1.44   thorpej 	    TWE_PARAM_DRIVESUMMARY_Status, 16, NULL, &p[0]);
   1582  1.44   thorpej 	if (rv) {
   1583  1.44   thorpej 		aprint_error("%s: failed to get drive status summary\n",
   1584  1.44   thorpej 		    sc->sc_dv.dv_xname);
   1585  1.44   thorpej 		return;
   1586  1.44   thorpej 	}
   1587  1.44   thorpej 	for (i = 0; i < ports; i++) {
   1588  1.44   thorpej 		if (p[0]->tp_data[i] != TWE_PARAM_DRIVESTATUS_Present)
   1589  1.44   thorpej 			continue;
   1590  1.44   thorpej 		rv = twe_param_get_4(sc, TWE_PARAM_DRIVEINFO + i,
   1591  1.44   thorpej 		    TWE_PARAM_DRIVEINFO_Size, &dsize);
   1592  1.44   thorpej 		if (rv) {
   1593  1.44   thorpej 			aprint_error(
   1594  1.44   thorpej 			    "%s: unable to get drive size for port %d\n",
   1595  1.44   thorpej 			    sc->sc_dv.dv_xname, i);
   1596  1.44   thorpej 			continue;
   1597  1.44   thorpej 		}
   1598  1.44   thorpej 		rv = twe_param_get(sc, TWE_PARAM_DRIVEINFO + i,
   1599  1.44   thorpej 		    TWE_PARAM_DRIVEINFO_Model, 40, NULL, &p[1]);
   1600  1.44   thorpej 		if (rv) {
   1601  1.44   thorpej 			aprint_error(
   1602  1.44   thorpej 			    "%s: unable to get drive model for port %d\n",
   1603  1.44   thorpej 			    sc->sc_dv.dv_xname, i);
   1604  1.44   thorpej 			continue;
   1605  1.44   thorpej 		}
   1606  1.44   thorpej 		aprint_verbose("%s: port %d: %.40s %d MB\n", sc->sc_dv.dv_xname,
   1607  1.44   thorpej 		    i, p[1]->tp_data, dsize / 2048);
   1608  1.44   thorpej 		free(p[1], M_DEVBUF);
   1609  1.44   thorpej 	}
   1610  1.44   thorpej 	free(p[0], M_DEVBUF);
   1611   1.1        ad }
   1612