Home | History | Annotate | Line # | Download | only in pci
twe.c revision 1.40
      1  1.40   thorpej /*	$NetBSD: twe.c,v 1.40 2003/09/21 18:35:31 thorpej Exp $	*/
      2   1.1        ad 
      3   1.1        ad /*-
      4  1.22        ad  * Copyright (c) 2000, 2001, 2002 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) 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.40   thorpej __KERNEL_RCSID(0, "$NetBSD: twe.c,v 1.40 2003/09/21 18:35:31 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.1        ad static void	twe_attach(struct device *, struct device *, void *);
    103   1.1        ad static int	twe_init_connection(struct twe_softc *);
    104   1.1        ad static int	twe_intr(void *);
    105   1.1        ad static int	twe_match(struct device *, struct cfdata *, void *);
    106   1.7        ad static int	twe_param_get(struct twe_softc *, int, int, size_t,
    107  1.38  jdolecek     void (*)(struct twe_ccb *, int), struct twe_param **);
    108  1.33  christos static int	twe_param_set(struct twe_softc *, int, int, size_t, void *);
    109   1.1        ad static void	twe_poll(struct twe_softc *);
    110   1.1        ad static int	twe_print(void *, const char *);
    111   1.1        ad static int	twe_reset(struct twe_softc *);
    112   1.1        ad static int	twe_submatch(struct device *, struct cfdata *, void *);
    113   1.1        ad static int	twe_status_check(struct twe_softc *, u_int);
    114   1.1        ad static int	twe_status_wait(struct twe_softc *, u_int, int);
    115  1.38  jdolecek static void	twe_describe_controller(struct twe_softc *);
    116   1.1        ad 
    117  1.22        ad static inline u_int32_t	twe_inl(struct twe_softc *, int);
    118  1.33  christos static inline void twe_outl(struct twe_softc *, int, u_int32_t);
    119  1.33  christos 
    120  1.33  christos dev_type_open(tweopen);
    121  1.33  christos dev_type_close(tweclose);
    122  1.33  christos dev_type_ioctl(tweioctl);
    123  1.33  christos 
    124  1.33  christos const struct cdevsw twe_cdevsw = {
    125  1.33  christos 	tweopen, tweclose, noread, nowrite, tweioctl,
    126  1.33  christos 	nostop, notty, nopoll, nommap,
    127  1.33  christos };
    128  1.33  christos 
    129  1.33  christos extern struct	cfdriver twe_cd;
    130  1.22        ad 
    131  1.30   thorpej CFATTACH_DECL(twe, sizeof(struct twe_softc),
    132  1.31   thorpej     twe_match, twe_attach, NULL, NULL);
    133   1.1        ad 
    134  1.40   thorpej /*
    135  1.40   thorpej  * Tables to convert numeric codes to strings.
    136  1.40   thorpej  */
    137  1.40   thorpej const struct twe_code_table twe_table_status[] = {
    138  1.40   thorpej 	{ 0x00,	"successful completion" },
    139  1.40   thorpej 
    140  1.40   thorpej 	/* info */
    141  1.40   thorpej 	{ 0x42,	"command in progress" },
    142  1.40   thorpej 	{ 0x6c,	"retrying interface CRC error from UDMA command" },
    143  1.40   thorpej 
    144  1.40   thorpej 	/* warning */
    145  1.40   thorpej 	{ 0x81,	"redundant/inconsequential request ignored" },
    146  1.40   thorpej 	{ 0x8e,	"failed to write zeroes to LBA 0" },
    147  1.40   thorpej 	{ 0x8f,	"failed to profile TwinStor zones" },
    148  1.40   thorpej 
    149  1.40   thorpej 	/* fatal */
    150  1.40   thorpej 	{ 0xc1,	"aborted due to system command or reconfiguration" },
    151  1.40   thorpej 	{ 0xc4,	"aborted" },
    152  1.40   thorpej 	{ 0xc5,	"access error" },
    153  1.40   thorpej 	{ 0xc6,	"access violation" },
    154  1.40   thorpej 	{ 0xc7,	"device failure" },	/* high byte may be port # */
    155  1.40   thorpej 	{ 0xc8,	"controller error" },
    156  1.40   thorpej 	{ 0xc9,	"timed out" },
    157  1.40   thorpej 	{ 0xcb,	"invalid unit number" },
    158  1.40   thorpej 	{ 0xcf,	"unit not available" },
    159  1.40   thorpej 	{ 0xd2,	"undefined opcode" },
    160  1.40   thorpej 	{ 0xdb,	"request incompatible with unit" },
    161  1.40   thorpej 	{ 0xdc,	"invalid request" },
    162  1.40   thorpej 	{ 0xff,	"firmware error, reset requested" },
    163  1.40   thorpej 
    164  1.40   thorpej 	{ 0,	NULL }
    165  1.40   thorpej };
    166  1.40   thorpej 
    167  1.40   thorpej const struct twe_code_table twe_table_unitstate[] = {
    168  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Normal,		"Normal" },
    169  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Initialising,	"Initializing" },
    170  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Degraded,	"Degraded" },
    171  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Rebuilding,	"Rebuilding" },
    172  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Verifying,	"Verifying" },
    173  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Corrupt,		"Corrupt" },
    174  1.40   thorpej 	{ TWE_PARAM_UNITSTATUS_Missing,		"Missing" },
    175  1.40   thorpej 
    176  1.40   thorpej 	{ 0,					NULL }
    177  1.40   thorpej };
    178  1.40   thorpej 
    179  1.40   thorpej const struct twe_code_table twe_table_unittype[] = {
    180  1.40   thorpej 	/* array descriptor configuration */
    181  1.40   thorpej 	{ TWE_AD_CONFIG_RAID0,			"RAID0" },
    182  1.40   thorpej 	{ TWE_AD_CONFIG_RAID1,			"RAID1" },
    183  1.40   thorpej 	{ TWE_AD_CONFIG_TwinStor,		"TwinStor" },
    184  1.40   thorpej 	{ TWE_AD_CONFIG_RAID5,			"RAID5" },
    185  1.40   thorpej 	{ TWE_AD_CONFIG_RAID10,			"RAID10" },
    186  1.40   thorpej 
    187  1.40   thorpej 	{ 0,					NULL }
    188  1.40   thorpej };
    189  1.40   thorpej 
    190  1.40   thorpej const struct twe_code_table twe_table_stripedepth[] = {
    191  1.40   thorpej 	{ TWE_AD_STRIPE_4k,			"4K" },
    192  1.40   thorpej 	{ TWE_AD_STRIPE_8k,			"8K" },
    193  1.40   thorpej 	{ TWE_AD_STRIPE_16k,			"16K" },
    194  1.40   thorpej 	{ TWE_AD_STRIPE_32k,			"32K" },
    195  1.40   thorpej 	{ TWE_AD_STRIPE_64k,			"64K" },
    196  1.40   thorpej 
    197  1.40   thorpej 	{ 0,					NULL }
    198  1.40   thorpej };
    199  1.40   thorpej 
    200  1.40   thorpej const char *
    201  1.40   thorpej twe_describe_code(const struct twe_code_table *table, uint32_t code)
    202  1.40   thorpej {
    203  1.40   thorpej 
    204  1.40   thorpej 	for (; table->string != NULL; table++) {
    205  1.40   thorpej 		if (table->code == code)
    206  1.40   thorpej 			return (table->string);
    207  1.40   thorpej 	}
    208  1.40   thorpej 	return (NULL);
    209  1.40   thorpej }
    210  1.40   thorpej 
    211   1.1        ad struct {
    212  1.26  christos 	const u_int	aen;	/* High byte indicates type of message */
    213   1.1        ad 	const char	*desc;
    214   1.1        ad } static const twe_aen_names[] = {
    215   1.1        ad 	{ 0x0000, "queue empty" },
    216   1.1        ad 	{ 0x0001, "soft reset" },
    217   1.3        ad 	{ 0x0102, "degraded mirror" },
    218   1.1        ad 	{ 0x0003, "controller error" },
    219   1.3        ad 	{ 0x0104, "rebuild fail" },
    220   1.3        ad 	{ 0x0105, "rebuild done" },
    221   1.3        ad 	{ 0x0106, "incompatible unit" },
    222  1.26  christos 	{ 0x0107, "initialisation done" },
    223  1.26  christos 	{ 0x0108, "unclean shutdown detected" },
    224  1.26  christos 	{ 0x0109, "drive timeout" },
    225   1.3        ad 	{ 0x010a, "drive error" },
    226   1.3        ad 	{ 0x010b, "rebuild started" },
    227  1.14        ad 	{ 0x010c, "init started" },
    228  1.26  christos 	{ 0x010d, "logical unit deleted" },
    229  1.26  christos 	{ 0x020f, "SMART threshold exceeded" },
    230  1.26  christos 	{ 0x0015, "table undefined" },	/* XXX: Not in FreeBSD's table */
    231  1.26  christos 	{ 0x0221, "ATA UDMA downgrade" },
    232  1.26  christos 	{ 0x0222, "ATA UDMA upgrade" },
    233  1.26  christos 	{ 0x0222, "ATA UDMA upgrade" },
    234  1.26  christos 	{ 0x0223, "Sector repair occurred" },
    235  1.26  christos 	{ 0x0024, "SBUF integrity check failure" },
    236  1.26  christos 	{ 0x0225, "lost cached write" },
    237  1.26  christos 	{ 0x0226, "drive ECC error detected" },
    238  1.26  christos 	{ 0x0227, "DCB checksum error" },
    239  1.26  christos 	{ 0x0228, "DCB unsupported version" },
    240  1.26  christos 	{ 0x0129, "verify started" },
    241  1.26  christos 	{ 0x012a, "verify failed" },
    242  1.26  christos 	{ 0x012b, "verify complete" },
    243  1.26  christos 	{ 0x022c, "overwrote bad sector during rebuild" },
    244  1.26  christos 	{ 0x022d, "encountered bad sector during rebuild" },
    245   1.1        ad 	{ 0x00ff, "aen queue full" },
    246   1.1        ad };
    247   1.1        ad 
    248  1.26  christos /*
    249  1.26  christos  * The high byte of the message above determines the format,
    250  1.26  christos  * currently we know about format 0 (no unit/port specific)
    251  1.26  christos  * format 1 (unit specific message), and format 2 (port specific message).
    252  1.26  christos  */
    253  1.38  jdolecek static const char * const aenfmt[] = {
    254  1.27       kim 	"",		/* No message */
    255  1.26  christos 	"unit %d: ",	/* Unit message */
    256  1.26  christos 	"port %d: "	/* Port message */
    257  1.26  christos };
    258  1.26  christos 
    259  1.26  christos 
    260  1.22        ad static inline u_int32_t
    261  1.22        ad twe_inl(struct twe_softc *sc, int off)
    262  1.22        ad {
    263  1.22        ad 
    264  1.22        ad 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, off, 4,
    265  1.22        ad 	    BUS_SPACE_BARRIER_WRITE | BUS_SPACE_BARRIER_READ);
    266  1.22        ad 	return (bus_space_read_4(sc->sc_iot, sc->sc_ioh, off));
    267  1.22        ad }
    268  1.22        ad 
    269  1.22        ad static inline void
    270  1.22        ad twe_outl(struct twe_softc *sc, int off, u_int32_t val)
    271  1.22        ad {
    272  1.22        ad 
    273  1.22        ad 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, off, val);
    274  1.22        ad 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, off, 4,
    275  1.22        ad 	    BUS_SPACE_BARRIER_WRITE);
    276  1.22        ad }
    277  1.22        ad 
    278   1.1        ad /*
    279   1.1        ad  * Match a supported board.
    280   1.1        ad  */
    281   1.1        ad static int
    282   1.1        ad twe_match(struct device *parent, struct cfdata *cfdata, void *aux)
    283   1.1        ad {
    284   1.1        ad 	struct pci_attach_args *pa;
    285   1.1        ad 
    286   1.1        ad 	pa = aux;
    287   1.1        ad 
    288   1.1        ad 	return (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_3WARE &&
    289  1.10        ad 	    (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3WARE_ESCALADE ||
    290  1.10        ad 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3WARE_ESCALADE_ASIC));
    291   1.1        ad }
    292   1.1        ad 
    293   1.1        ad /*
    294   1.1        ad  * Attach a supported board.
    295   1.1        ad  *
    296   1.1        ad  * XXX This doesn't fail gracefully.
    297   1.1        ad  */
    298   1.1        ad static void
    299   1.1        ad twe_attach(struct device *parent, struct device *self, void *aux)
    300   1.1        ad {
    301   1.1        ad 	struct pci_attach_args *pa;
    302   1.1        ad 	struct twe_softc *sc;
    303   1.1        ad 	pci_chipset_tag_t pc;
    304   1.1        ad 	pci_intr_handle_t ih;
    305   1.1        ad 	pcireg_t csr;
    306   1.1        ad 	const char *intrstr;
    307   1.1        ad 	int size, i, rv, rseg;
    308  1.23  christos 	size_t max_segs, max_xfer;
    309   1.1        ad 	struct twe_param *dtp, *ctp;
    310   1.1        ad 	bus_dma_segment_t seg;
    311   1.1        ad 	struct twe_cmd *tc;
    312   1.1        ad 	struct twe_attach_args twea;
    313   1.1        ad 	struct twe_ccb *ccb;
    314   1.1        ad 
    315   1.1        ad 	sc = (struct twe_softc *)self;
    316   1.1        ad 	pa = aux;
    317   1.1        ad 	pc = pa->pa_pc;
    318   1.1        ad 	sc->sc_dmat = pa->pa_dmat;
    319   1.1        ad 	SIMPLEQ_INIT(&sc->sc_ccb_queue);
    320   1.1        ad 	SLIST_INIT(&sc->sc_ccb_freelist);
    321   1.1        ad 
    322  1.40   thorpej 	aprint_naive(": RAID controller\n");
    323  1.38  jdolecek 	aprint_normal(": 3ware Escalade\n");
    324   1.1        ad 
    325  1.33  christos 	ccb = malloc(sizeof(*ccb) * TWE_MAX_QUEUECNT, M_DEVBUF, M_NOWAIT);
    326  1.33  christos 	if (ccb == NULL) {
    327  1.38  jdolecek 		aprint_error("%s: unable to allocate memory for ccbs\n",
    328  1.33  christos 		    sc->sc_dv.dv_xname);
    329  1.33  christos 		return;
    330  1.33  christos 	}
    331  1.33  christos 
    332   1.1        ad 	if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
    333   1.1        ad 	    &sc->sc_iot, &sc->sc_ioh, NULL, NULL)) {
    334  1.38  jdolecek 		aprint_error("%s: can't map i/o space\n", sc->sc_dv.dv_xname);
    335   1.1        ad 		return;
    336   1.1        ad 	}
    337   1.1        ad 
    338   1.1        ad 	/* Enable the device. */
    339   1.1        ad 	csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
    340   1.1        ad 	pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
    341   1.1        ad 	    csr | PCI_COMMAND_MASTER_ENABLE);
    342   1.1        ad 
    343   1.1        ad 	/* Map and establish the interrupt. */
    344   1.5  sommerfe 	if (pci_intr_map(pa, &ih)) {
    345  1.38  jdolecek 		aprint_error("%s: can't map interrupt\n", sc->sc_dv.dv_xname);
    346   1.1        ad 		return;
    347   1.1        ad 	}
    348  1.38  jdolecek 
    349   1.1        ad 	intrstr = pci_intr_string(pc, ih);
    350   1.1        ad 	sc->sc_ih = pci_intr_establish(pc, ih, IPL_BIO, twe_intr, sc);
    351   1.1        ad 	if (sc->sc_ih == NULL) {
    352  1.38  jdolecek 		aprint_error("%s: can't establish interrupt%s%s\n",
    353  1.38  jdolecek 			sc->sc_dv.dv_xname,
    354  1.38  jdolecek 			(intrstr) ? " at " : "",
    355  1.38  jdolecek 			(intrstr) ? intrstr : "");
    356   1.1        ad 		return;
    357   1.1        ad 	}
    358  1.38  jdolecek 
    359   1.1        ad 	if (intrstr != NULL)
    360  1.38  jdolecek 		aprint_normal("%s: interrupting at %s\n",
    361  1.38  jdolecek 			sc->sc_dv.dv_xname, intrstr);
    362   1.1        ad 
    363   1.1        ad 	/*
    364   1.1        ad 	 * Allocate and initialise the command blocks and CCBs.
    365   1.1        ad 	 */
    366   1.7        ad         size = sizeof(struct twe_cmd) * TWE_MAX_QUEUECNT;
    367   1.1        ad 
    368   1.4   thorpej 	if ((rv = bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &seg, 1,
    369   1.1        ad 	    &rseg, BUS_DMA_NOWAIT)) != 0) {
    370  1.38  jdolecek 		aprint_error("%s: unable to allocate commands, rv = %d\n",
    371   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    372   1.1        ad 		return;
    373   1.1        ad 	}
    374   1.1        ad 
    375   1.1        ad 	if ((rv = bus_dmamem_map(sc->sc_dmat, &seg, rseg, size,
    376   1.1        ad 	    (caddr_t *)&sc->sc_cmds,
    377   1.1        ad 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
    378  1.38  jdolecek 		aprint_error("%s: unable to map commands, rv = %d\n",
    379   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    380   1.1        ad 		return;
    381   1.1        ad 	}
    382   1.1        ad 
    383   1.1        ad 	if ((rv = bus_dmamap_create(sc->sc_dmat, size, size, 1, 0,
    384   1.1        ad 	    BUS_DMA_NOWAIT, &sc->sc_dmamap)) != 0) {
    385  1.38  jdolecek 		aprint_error("%s: unable to create command DMA map, rv = %d\n",
    386   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    387   1.1        ad 		return;
    388   1.1        ad 	}
    389   1.1        ad 
    390   1.1        ad 	if ((rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap, sc->sc_cmds,
    391   1.1        ad 	    size, NULL, BUS_DMA_NOWAIT)) != 0) {
    392  1.38  jdolecek 		aprint_error("%s: unable to load command DMA map, rv = %d\n",
    393   1.1        ad 		    sc->sc_dv.dv_xname, rv);
    394   1.1        ad 		return;
    395   1.1        ad 	}
    396   1.1        ad 
    397   1.1        ad 	sc->sc_cmds_paddr = sc->sc_dmamap->dm_segs[0].ds_addr;
    398   1.1        ad 	memset(sc->sc_cmds, 0, size);
    399   1.1        ad 
    400   1.1        ad 	sc->sc_ccbs = ccb;
    401   1.1        ad 	tc = (struct twe_cmd *)sc->sc_cmds;
    402  1.24  christos 	max_segs = twe_get_maxsegs();
    403  1.24  christos 	max_xfer = twe_get_maxxfer(max_segs);
    404   1.1        ad 
    405   1.7        ad 	for (i = 0; i < TWE_MAX_QUEUECNT; i++, tc++, ccb++) {
    406   1.1        ad 		ccb->ccb_cmd = tc;
    407   1.1        ad 		ccb->ccb_cmdid = i;
    408   1.1        ad 		ccb->ccb_flags = 0;
    409  1.23  christos 		rv = bus_dmamap_create(sc->sc_dmat, max_xfer,
    410  1.23  christos 		    max_segs, PAGE_SIZE, 0,
    411   1.4   thorpej 		    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
    412   1.1        ad 		    &ccb->ccb_dmamap_xfer);
    413   1.7        ad 		if (rv != 0) {
    414  1.38  jdolecek 			aprint_error("%s: can't create dmamap, rv = %d\n",
    415   1.7        ad 			    sc->sc_dv.dv_xname, rv);
    416   1.7        ad 			return;
    417   1.7        ad 		}
    418   1.3        ad 		/* Save one CCB for parameter retrieval. */
    419   1.3        ad 		if (i != 0)
    420   1.3        ad 			SLIST_INSERT_HEAD(&sc->sc_ccb_freelist, ccb,
    421   1.3        ad 			    ccb_chain.slist);
    422   1.3        ad 	}
    423   1.1        ad 
    424   1.1        ad 	/* Wait for the controller to become ready. */
    425   1.1        ad 	if (twe_status_wait(sc, TWE_STS_MICROCONTROLLER_READY, 6)) {
    426  1.38  jdolecek 		aprint_error("%s: microcontroller not ready\n",
    427  1.38  jdolecek 			sc->sc_dv.dv_xname);
    428   1.1        ad 		return;
    429   1.1        ad 	}
    430   1.1        ad 
    431  1.22        ad 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_DISABLE_INTRS);
    432   1.1        ad 
    433   1.1        ad 	/* Reset the controller. */
    434   1.1        ad 	if (twe_reset(sc)) {
    435  1.38  jdolecek 		aprint_error("%s: reset failed\n", sc->sc_dv.dv_xname);
    436   1.1        ad 		return;
    437   1.1        ad 	}
    438   1.1        ad 
    439   1.3        ad 	/* Find attached units. */
    440   1.7        ad 	rv = twe_param_get(sc, TWE_PARAM_UNITSUMMARY,
    441  1.38  jdolecek 	    TWE_PARAM_UNITSUMMARY_Status, TWE_MAX_UNITS, NULL, &dtp);
    442   1.7        ad 	if (rv != 0) {
    443  1.38  jdolecek 		aprint_error("%s: can't detect attached units (%d)\n",
    444   1.7        ad 		    sc->sc_dv.dv_xname, rv);
    445   1.1        ad 		return;
    446   1.1        ad 	}
    447   1.1        ad 
    448   1.1        ad 	/* For each detected unit, collect size and store in an array. */
    449   1.3        ad 	for (i = 0, sc->sc_nunits = 0; i < TWE_MAX_UNITS; i++) {
    450   1.1        ad 		/* Unit present? */
    451   1.3        ad 		if ((dtp->tp_data[i] & TWE_PARAM_UNITSTATUS_Online) == 0) {
    452   1.1        ad 			sc->sc_dsize[i] = 0;
    453   1.1        ad 	   		continue;
    454   1.1        ad 	   	}
    455   1.1        ad 
    456   1.7        ad 		rv = twe_param_get(sc, TWE_PARAM_UNITINFO + i,
    457  1.38  jdolecek 		    TWE_PARAM_UNITINFO_Capacity, 4, NULL, &ctp);
    458   1.7        ad 		if (rv != 0) {
    459  1.38  jdolecek 			aprint_error("%s: error %d fetching capacity for unit %d\n",
    460   1.7        ad 			    sc->sc_dv.dv_xname, rv, i);
    461   1.1        ad 			continue;
    462   1.1        ad 		}
    463   1.1        ad 
    464   1.1        ad 		sc->sc_dsize[i] = le32toh(*(u_int32_t *)ctp->tp_data);
    465   1.1        ad 		free(ctp, M_DEVBUF);
    466   1.3        ad 		sc->sc_nunits++;
    467   1.1        ad 	}
    468   1.1        ad 	free(dtp, M_DEVBUF);
    469   1.1        ad 
    470   1.1        ad 	/* Initialise connection with controller and enable interrupts. */
    471   1.1        ad 	twe_init_connection(sc);
    472  1.22        ad 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR |
    473   1.1        ad 	    TWE_CTL_UNMASK_RESP_INTR |
    474   1.1        ad 	    TWE_CTL_ENABLE_INTRS);
    475   1.1        ad 
    476  1.38  jdolecek 	twe_describe_controller(sc);
    477  1.38  jdolecek 
    478   1.1        ad 	/* Attach sub-devices. */
    479   1.1        ad 	for (i = 0; i < TWE_MAX_UNITS; i++) {
    480   1.1        ad 		if (sc->sc_dsize[i] == 0)
    481   1.1        ad 			continue;
    482   1.1        ad 		twea.twea_unit = i;
    483   1.1        ad 		config_found_sm(&sc->sc_dv, &twea, twe_print, twe_submatch);
    484   1.1        ad 	}
    485   1.1        ad }
    486   1.1        ad 
    487   1.1        ad /*
    488   1.1        ad  * Reset the controller.  Currently only useful at attach time; must be
    489   1.1        ad  * called with interrupts blocked.
    490   1.1        ad  */
    491   1.1        ad static int
    492   1.1        ad twe_reset(struct twe_softc *sc)
    493   1.1        ad {
    494   1.1        ad 	struct twe_param *tp;
    495   1.1        ad 	u_int aen, status;
    496   1.1        ad 	volatile u_int32_t junk;
    497   1.7        ad 	int got, rv;
    498   1.1        ad 
    499   1.1        ad 	/* Issue a soft reset. */
    500  1.22        ad 	twe_outl(sc, TWE_REG_CTL, TWE_CTL_ISSUE_SOFT_RESET |
    501   1.1        ad 	    TWE_CTL_CLEAR_HOST_INTR |
    502   1.1        ad 	    TWE_CTL_CLEAR_ATTN_INTR |
    503   1.1        ad 	    TWE_CTL_MASK_CMD_INTR |
    504   1.1        ad 	    TWE_CTL_MASK_RESP_INTR |
    505   1.1        ad 	    TWE_CTL_CLEAR_ERROR_STS |
    506   1.1        ad 	    TWE_CTL_DISABLE_INTRS);
    507   1.1        ad 
    508   1.1        ad 	if (twe_status_wait(sc, TWE_STS_ATTN_INTR, 15)) {
    509   1.1        ad 		printf("%s: no attention interrupt\n",
    510   1.1        ad 		    sc->sc_dv.dv_xname);
    511   1.1        ad 		return (-1);
    512   1.1        ad 	}
    513   1.1        ad 
    514   1.1        ad 	/* Pull AENs out of the controller; look for a soft reset AEN. */
    515   1.1        ad 	for (got = 0;;) {
    516   1.7        ad 		rv = twe_param_get(sc, TWE_PARAM_AEN, TWE_PARAM_AEN_UnitCode,
    517  1.38  jdolecek 		    2, NULL, &tp);
    518   1.7        ad 		if (rv != 0)
    519   1.7        ad 			printf("%s: error %d while draining response queue\n",
    520   1.7        ad 			    sc->sc_dv.dv_xname, rv);
    521   1.3        ad 		aen = TWE_AEN_CODE(le16toh(*(u_int16_t *)tp->tp_data));
    522   1.1        ad 		free(tp, M_DEVBUF);
    523   1.1        ad 		if (aen == TWE_AEN_QUEUE_EMPTY)
    524   1.1        ad 			break;
    525   1.1        ad 		if (aen == TWE_AEN_SOFT_RESET)
    526   1.1        ad 			got = 1;
    527   1.1        ad 	}
    528   1.1        ad 	if (!got) {
    529   1.1        ad 		printf("%s: reset not reported\n", sc->sc_dv.dv_xname);
    530   1.1        ad 		return (-1);
    531   1.1        ad 	}
    532   1.1        ad 
    533   1.1        ad 	/* Check controller status. */
    534  1.22        ad 	status = twe_inl(sc, TWE_REG_STS);
    535   1.1        ad 	if (twe_status_check(sc, status)) {
    536   1.1        ad 		printf("%s: controller errors detected\n",
    537   1.1        ad 		    sc->sc_dv.dv_xname);
    538   1.1        ad 		return (-1);
    539   1.1        ad 	}
    540   1.1        ad 
    541   1.1        ad 	/* Drain the response queue. */
    542   1.1        ad 	for (;;) {
    543  1.22        ad 		status = twe_inl(sc, TWE_REG_STS);
    544   1.1        ad 		if (twe_status_check(sc, status) != 0) {
    545   1.1        ad 			printf("%s: can't drain response queue\n",
    546   1.1        ad 			    sc->sc_dv.dv_xname);
    547   1.1        ad 			return (-1);
    548   1.1        ad 		}
    549   1.1        ad 		if ((status & TWE_STS_RESP_QUEUE_EMPTY) != 0)
    550   1.1        ad 			break;
    551  1.22        ad 		junk = twe_inl(sc, TWE_REG_RESP_QUEUE);
    552   1.1        ad 	}
    553   1.1        ad 
    554   1.1        ad 	return (0);
    555   1.1        ad }
    556   1.1        ad 
    557   1.1        ad /*
    558   1.1        ad  * Print autoconfiguration message for a sub-device.
    559   1.1        ad  */
    560   1.1        ad static int
    561   1.1        ad twe_print(void *aux, const char *pnp)
    562   1.1        ad {
    563   1.1        ad 	struct twe_attach_args *twea;
    564   1.1        ad 
    565   1.1        ad 	twea = aux;
    566   1.1        ad 
    567   1.1        ad 	if (pnp != NULL)
    568  1.35   thorpej 		aprint_normal("block device at %s", pnp);
    569  1.35   thorpej 	aprint_normal(" unit %d", twea->twea_unit);
    570   1.1        ad 	return (UNCONF);
    571   1.1        ad }
    572   1.1        ad 
    573   1.1        ad /*
    574   1.1        ad  * Match a sub-device.
    575   1.1        ad  */
    576   1.1        ad static int
    577   1.1        ad twe_submatch(struct device *parent, struct cfdata *cf, void *aux)
    578   1.1        ad {
    579   1.1        ad 	struct twe_attach_args *twea;
    580   1.1        ad 
    581   1.1        ad 	twea = aux;
    582   1.1        ad 
    583   1.1        ad 	if (cf->tweacf_unit != TWECF_UNIT_DEFAULT &&
    584   1.1        ad 	    cf->tweacf_unit != twea->twea_unit)
    585   1.1        ad 		return (0);
    586   1.1        ad 
    587  1.28   thorpej 	return (config_match(parent, cf, aux));
    588   1.1        ad }
    589   1.1        ad 
    590   1.1        ad /*
    591   1.1        ad  * Interrupt service routine.
    592   1.1        ad  */
    593   1.1        ad static int
    594   1.1        ad twe_intr(void *arg)
    595   1.1        ad {
    596   1.1        ad 	struct twe_softc *sc;
    597   1.1        ad 	u_int status;
    598   1.7        ad 	int caught, rv;
    599   1.1        ad 
    600   1.1        ad 	sc = arg;
    601   1.1        ad 	caught = 0;
    602  1.22        ad 	status = twe_inl(sc, TWE_REG_STS);
    603   1.1        ad 	twe_status_check(sc, status);
    604   1.1        ad 
    605   1.1        ad 	/* Host interrupts - purpose unknown. */
    606   1.1        ad 	if ((status & TWE_STS_HOST_INTR) != 0) {
    607  1.38  jdolecek #ifdef DEBUG
    608   1.1        ad 		printf("%s: host interrupt\n", sc->sc_dv.dv_xname);
    609   1.1        ad #endif
    610  1.22        ad 		twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_HOST_INTR);
    611   1.1        ad 		caught = 1;
    612   1.1        ad 	}
    613   1.1        ad 
    614   1.1        ad 	/*
    615   1.1        ad 	 * Attention interrupts, signalled when a controller or child device
    616  1.18       wiz 	 * state change has occurred.
    617   1.1        ad 	 */
    618   1.1        ad 	if ((status & TWE_STS_ATTN_INTR) != 0) {
    619  1.12        ad 		if ((sc->sc_flags & TWEF_AEN) == 0) {
    620  1.12        ad 			rv = twe_param_get(sc, TWE_PARAM_AEN,
    621  1.12        ad 			    TWE_PARAM_AEN_UnitCode, 2, twe_aen_handler,
    622  1.12        ad 			    NULL);
    623  1.12        ad 			if (rv != 0) {
    624  1.12        ad 				printf("%s: unable to retrieve AEN (%d)\n",
    625  1.12        ad 				    sc->sc_dv.dv_xname, rv);
    626  1.22        ad 				twe_outl(sc, TWE_REG_CTL,
    627  1.12        ad 				    TWE_CTL_CLEAR_ATTN_INTR);
    628  1.12        ad 			} else
    629  1.12        ad 				sc->sc_flags |= TWEF_AEN;
    630   1.9        ad 		}
    631   1.1        ad 		caught = 1;
    632   1.1        ad 	}
    633   1.1        ad 
    634   1.1        ad 	/*
    635   1.1        ad 	 * Command interrupts, signalled when the controller can accept more
    636   1.1        ad 	 * commands.  We don't use this; instead, we try to submit commands
    637   1.1        ad 	 * when we receive them, and when other commands have completed.
    638   1.1        ad 	 * Mask it so we don't get another one.
    639   1.1        ad 	 */
    640   1.1        ad 	if ((status & TWE_STS_CMD_INTR) != 0) {
    641  1.38  jdolecek #ifdef DEBUG
    642   1.1        ad 		printf("%s: command interrupt\n", sc->sc_dv.dv_xname);
    643   1.1        ad #endif
    644  1.22        ad 		twe_outl(sc, TWE_REG_CTL, TWE_CTL_MASK_CMD_INTR);
    645   1.1        ad 		caught = 1;
    646   1.1        ad 	}
    647   1.1        ad 
    648   1.1        ad 	if ((status & TWE_STS_RESP_INTR) != 0) {
    649   1.1        ad 		twe_poll(sc);
    650   1.1        ad 		caught = 1;
    651   1.1        ad 	}
    652   1.1        ad 
    653   1.1        ad 	return (caught);
    654   1.1        ad }
    655   1.1        ad 
    656   1.1        ad /*
    657   1.1        ad  * Handle an AEN returned by the controller.
    658   1.1        ad  */
    659   1.1        ad static void
    660   1.1        ad twe_aen_handler(struct twe_ccb *ccb, int error)
    661   1.1        ad {
    662   1.1        ad 	struct twe_softc *sc;
    663   1.1        ad 	struct twe_param *tp;
    664   1.1        ad 	const char *str;
    665   1.1        ad 	u_int aen;
    666   1.7        ad 	int i, hu, rv;
    667   1.1        ad 
    668   1.1        ad 	sc = (struct twe_softc *)ccb->ccb_tx.tx_dv;
    669   1.1        ad 	tp = ccb->ccb_tx.tx_context;
    670   1.1        ad 	twe_ccb_unmap(sc, ccb);
    671   1.1        ad 
    672   1.3        ad 	if (error) {
    673   1.1        ad 		printf("%s: error retrieving AEN\n", sc->sc_dv.dv_xname);
    674   1.3        ad 		aen = TWE_AEN_QUEUE_EMPTY;
    675   1.3        ad 	} else
    676   1.1        ad 		aen = le16toh(*(u_int16_t *)tp->tp_data);
    677   1.3        ad 	free(tp, M_DEVBUF);
    678   1.3        ad 	twe_ccb_free(sc, ccb);
    679   1.3        ad 
    680   1.7        ad 	if (TWE_AEN_CODE(aen) == TWE_AEN_QUEUE_EMPTY) {
    681  1.22        ad 		twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
    682  1.12        ad 		sc->sc_flags &= ~TWEF_AEN;
    683   1.7        ad 		return;
    684   1.7        ad 	}
    685   1.7        ad 
    686   1.7        ad 	str = "<unknown>";
    687   1.7        ad 	i = 0;
    688   1.7        ad 	hu = 0;
    689   1.3        ad 
    690   1.7        ad 	while (i < sizeof(twe_aen_names) / sizeof(twe_aen_names[0])) {
    691   1.7        ad 		if (TWE_AEN_CODE(twe_aen_names[i].aen) == TWE_AEN_CODE(aen)) {
    692   1.7        ad 			str = twe_aen_names[i].desc;
    693  1.26  christos 			hu = TWE_AEN_UNIT(twe_aen_names[i].aen);
    694   1.7        ad 			break;
    695   1.7        ad 		}
    696   1.7        ad 		i++;
    697   1.7        ad 	}
    698  1.26  christos 	printf("%s: ", sc->sc_dv.dv_xname);
    699  1.26  christos 	printf(aenfmt[hu], TWE_AEN_UNIT(aen));
    700  1.26  christos 	printf("AEN 0x%04x (%s) received\n", TWE_AEN_CODE(aen), str);
    701   1.3        ad 
    702   1.7        ad 	/*
    703   1.7        ad 	 * Chain another retrieval in case interrupts have been
    704   1.7        ad 	 * coalesced.
    705   1.7        ad 	 */
    706   1.7        ad 	rv = twe_param_get(sc, TWE_PARAM_AEN, TWE_PARAM_AEN_UnitCode, 2,
    707   1.7        ad 	    twe_aen_handler, NULL);
    708   1.7        ad 	if (rv != 0)
    709   1.7        ad 		printf("%s: unable to retrieve AEN (%d)\n",
    710   1.7        ad 		    sc->sc_dv.dv_xname, rv);
    711   1.1        ad }
    712   1.1        ad 
    713   1.1        ad /*
    714   1.1        ad  * Execute a TWE_OP_GET_PARAM command.  If a callback function is provided,
    715   1.1        ad  * it will be called with generated context when the command has completed.
    716   1.1        ad  * If no callback is provided, the command will be executed synchronously
    717   1.3        ad  * and a pointer to a buffer containing the data returned.
    718   1.1        ad  *
    719   1.3        ad  * The caller or callback is responsible for freeing the buffer.
    720   1.1        ad  */
    721   1.7        ad static int
    722   1.1        ad twe_param_get(struct twe_softc *sc, int table_id, int param_id, size_t size,
    723  1.38  jdolecek 	      void (*func)(struct twe_ccb *, int), struct twe_param **pbuf)
    724   1.1        ad {
    725   1.1        ad 	struct twe_ccb *ccb;
    726   1.1        ad 	struct twe_cmd *tc;
    727   1.1        ad 	struct twe_param *tp;
    728   1.1        ad 	int rv, s;
    729   1.1        ad 
    730  1.33  christos 	tp = malloc(TWE_SECTOR_SIZE, M_DEVBUF, M_NOWAIT);
    731  1.33  christos 	if (tp == NULL)
    732  1.33  christos 		return ENOMEM;
    733  1.33  christos 
    734   1.7        ad 	rv = twe_ccb_alloc(sc, &ccb,
    735   1.7        ad 	    TWE_CCB_PARAM | TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
    736   1.7        ad 	if (rv != 0)
    737  1.33  christos 		goto done;
    738   1.1        ad 
    739   1.1        ad 	ccb->ccb_data = tp;
    740   1.1        ad 	ccb->ccb_datasize = TWE_SECTOR_SIZE;
    741   1.1        ad 	ccb->ccb_tx.tx_handler = func;
    742   1.1        ad 	ccb->ccb_tx.tx_context = tp;
    743   1.1        ad 	ccb->ccb_tx.tx_dv = &sc->sc_dv;
    744   1.1        ad 
    745   1.1        ad 	tc = ccb->ccb_cmd;
    746   1.1        ad 	tc->tc_size = 2;
    747   1.1        ad 	tc->tc_opcode = TWE_OP_GET_PARAM | (tc->tc_size << 5);
    748   1.1        ad 	tc->tc_unit = 0;
    749   1.1        ad 	tc->tc_count = htole16(1);
    750   1.1        ad 
    751   1.1        ad 	/* Fill in the outbound parameter data. */
    752   1.1        ad 	tp->tp_table_id = htole16(table_id);
    753   1.1        ad 	tp->tp_param_id = param_id;
    754   1.1        ad 	tp->tp_param_size = size;
    755   1.1        ad 
    756   1.1        ad 	/* Map the transfer. */
    757   1.7        ad 	if ((rv = twe_ccb_map(sc, ccb)) != 0) {
    758   1.2        ad 		twe_ccb_free(sc, ccb);
    759  1.33  christos 		goto done;
    760   1.1        ad 	}
    761   1.1        ad 
    762   1.1        ad 	/* Submit the command and either wait or let the callback handle it. */
    763   1.1        ad 	if (func == NULL) {
    764   1.1        ad 		s = splbio();
    765   1.7        ad 		rv = twe_ccb_poll(sc, ccb, 5);
    766   1.1        ad 		twe_ccb_unmap(sc, ccb);
    767   1.2        ad 		twe_ccb_free(sc, ccb);
    768   1.1        ad 		splx(s);
    769   1.1        ad 	} else {
    770  1.38  jdolecek #ifdef DEBUG
    771  1.33  christos 		if (pbuf != NULL)
    772  1.33  christos 			panic("both func and pbuf defined");
    773  1.33  christos #endif
    774   1.1        ad 		twe_ccb_enqueue(sc, ccb);
    775  1.33  christos 		return 0;
    776  1.33  christos 	}
    777  1.33  christos 
    778  1.33  christos done:
    779  1.33  christos 	if (pbuf == NULL || rv != 0)
    780  1.33  christos 		free(tp, M_DEVBUF);
    781  1.33  christos 	else if (pbuf != NULL && rv == 0)
    782  1.33  christos 		*pbuf = tp;
    783  1.33  christos 	return rv;
    784  1.33  christos }
    785  1.33  christos 
    786  1.33  christos /*
    787  1.33  christos  * Execute a TWE_OP_SET_PARAM command.
    788  1.33  christos  */
    789  1.33  christos static int
    790  1.33  christos twe_param_set(struct twe_softc *sc, int table_id, int param_id, size_t size,
    791  1.33  christos 	      void *buf)
    792  1.33  christos {
    793  1.33  christos 	struct twe_ccb *ccb;
    794  1.33  christos 	struct twe_cmd *tc;
    795  1.33  christos 	struct twe_param *tp;
    796  1.33  christos 	int rv, s;
    797  1.33  christos 
    798  1.33  christos 	tp = malloc(TWE_SECTOR_SIZE, M_DEVBUF, M_NOWAIT);
    799  1.33  christos 	if (tp == NULL)
    800  1.33  christos 		return ENOMEM;
    801  1.33  christos 
    802  1.33  christos 	rv = twe_ccb_alloc(sc, &ccb,
    803  1.33  christos 	    TWE_CCB_PARAM | TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
    804  1.33  christos 	if (rv != 0)
    805  1.33  christos 		goto done;
    806  1.33  christos 
    807  1.33  christos 	ccb->ccb_data = tp;
    808  1.33  christos 	ccb->ccb_datasize = TWE_SECTOR_SIZE;
    809  1.33  christos 	ccb->ccb_tx.tx_handler = 0;
    810  1.33  christos 	ccb->ccb_tx.tx_context = tp;
    811  1.33  christos 	ccb->ccb_tx.tx_dv = &sc->sc_dv;
    812  1.33  christos 
    813  1.33  christos 	tc = ccb->ccb_cmd;
    814  1.33  christos 	tc->tc_size = 2;
    815  1.33  christos 	tc->tc_opcode = TWE_OP_SET_PARAM | (tc->tc_size << 5);
    816  1.33  christos 	tc->tc_unit = 0;
    817  1.33  christos 	tc->tc_count = htole16(1);
    818  1.33  christos 
    819  1.33  christos 	/* Fill in the outbound parameter data. */
    820  1.33  christos 	tp->tp_table_id = htole16(table_id);
    821  1.33  christos 	tp->tp_param_id = param_id;
    822  1.33  christos 	tp->tp_param_size = size;
    823  1.33  christos 	memcpy(tp->tp_data, buf, size);
    824  1.33  christos 
    825  1.33  christos 	/* Map the transfer. */
    826  1.33  christos 	if ((rv = twe_ccb_map(sc, ccb)) != 0) {
    827  1.33  christos 		twe_ccb_free(sc, ccb);
    828  1.33  christos 		goto done;
    829   1.1        ad 	}
    830   1.1        ad 
    831  1.33  christos 	/* Submit the command and wait. */
    832  1.33  christos 	s = splbio();
    833  1.33  christos 	rv = twe_ccb_poll(sc, ccb, 5);
    834  1.33  christos 	twe_ccb_unmap(sc, ccb);
    835  1.33  christos 	twe_ccb_free(sc, ccb);
    836  1.33  christos 	splx(s);
    837  1.33  christos done:
    838  1.33  christos 	free(tp, M_DEVBUF);
    839   1.7        ad 	return (rv);
    840   1.1        ad }
    841   1.1        ad 
    842   1.1        ad /*
    843   1.1        ad  * Execute a TWE_OP_INIT_CONNECTION command.  Return non-zero on error.
    844   1.1        ad  * Must be called with interrupts blocked.
    845   1.1        ad  */
    846   1.1        ad static int
    847   1.1        ad twe_init_connection(struct twe_softc *sc)
    848  1.33  christos /*###762 [cc] warning: `twe_init_connection' was used with no prototype before its definition%%%*/
    849  1.33  christos /*###762 [cc] warning: `twe_init_connection' was declared implicitly `extern' and later `static'%%%*/
    850   1.1        ad {
    851   1.1        ad 	struct twe_ccb *ccb;
    852   1.1        ad 	struct twe_cmd *tc;
    853   1.1        ad 	int rv;
    854   1.1        ad 
    855   1.3        ad 	if ((rv = twe_ccb_alloc(sc, &ccb, 0)) != 0)
    856   1.1        ad 		return (rv);
    857   1.1        ad 
    858   1.1        ad 	/* Build the command. */
    859   1.1        ad 	tc = ccb->ccb_cmd;
    860   1.1        ad 	tc->tc_size = 3;
    861   1.1        ad 	tc->tc_opcode = TWE_OP_INIT_CONNECTION;
    862   1.1        ad 	tc->tc_unit = 0;
    863   1.3        ad 	tc->tc_count = htole16(TWE_MAX_CMDS);
    864   1.1        ad 	tc->tc_args.init_connection.response_queue_pointer = 0;
    865   1.1        ad 
    866   1.1        ad 	/* Submit the command for immediate execution. */
    867   1.7        ad 	rv = twe_ccb_poll(sc, ccb, 5);
    868   1.2        ad 	twe_ccb_free(sc, ccb);
    869   1.1        ad 	return (rv);
    870   1.1        ad }
    871   1.1        ad 
    872   1.1        ad /*
    873   1.1        ad  * Poll the controller for completed commands.  Must be called with
    874   1.1        ad  * interrupts blocked.
    875   1.1        ad  */
    876   1.1        ad static void
    877   1.1        ad twe_poll(struct twe_softc *sc)
    878   1.1        ad {
    879   1.1        ad 	struct twe_ccb *ccb;
    880   1.1        ad 	int found;
    881   1.1        ad 	u_int status, cmdid;
    882   1.1        ad 
    883   1.1        ad 	found = 0;
    884   1.1        ad 
    885   1.1        ad 	for (;;) {
    886  1.22        ad 		status = twe_inl(sc, TWE_REG_STS);
    887   1.1        ad 		twe_status_check(sc, status);
    888   1.1        ad 
    889   1.1        ad 		if ((status & TWE_STS_RESP_QUEUE_EMPTY))
    890   1.1        ad 			break;
    891   1.1        ad 
    892   1.1        ad 		found = 1;
    893  1.22        ad 		cmdid = twe_inl(sc, TWE_REG_RESP_QUEUE);
    894   1.1        ad 		cmdid = (cmdid & TWE_RESP_MASK) >> TWE_RESP_SHIFT;
    895   1.7        ad 		if (cmdid >= TWE_MAX_QUEUECNT) {
    896   1.1        ad 			printf("%s: bad completion\n", sc->sc_dv.dv_xname);
    897   1.1        ad 			continue;
    898   1.1        ad 		}
    899   1.1        ad 
    900   1.1        ad 		ccb = sc->sc_ccbs + cmdid;
    901   1.1        ad 		if ((ccb->ccb_flags & TWE_CCB_ACTIVE) == 0) {
    902   1.1        ad 			printf("%s: bad completion (not active)\n",
    903   1.1        ad 			    sc->sc_dv.dv_xname);
    904   1.1        ad 			continue;
    905   1.1        ad 		}
    906   1.1        ad 		ccb->ccb_flags ^= TWE_CCB_COMPLETE | TWE_CCB_ACTIVE;
    907   1.1        ad 
    908   1.1        ad 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
    909   1.1        ad 		    (caddr_t)ccb->ccb_cmd - sc->sc_cmds,
    910   1.1        ad 		    sizeof(struct twe_cmd),
    911   1.1        ad 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
    912   1.1        ad 
    913   1.1        ad 		/* Pass notification to upper layers. */
    914   1.1        ad 		if (ccb->ccb_tx.tx_handler != NULL)
    915   1.1        ad 			(*ccb->ccb_tx.tx_handler)(ccb,
    916   1.1        ad 			    ccb->ccb_cmd->tc_status != 0 ? EIO : 0);
    917   1.1        ad 	}
    918   1.1        ad 
    919   1.1        ad 	/* If any commands have completed, run the software queue. */
    920   1.1        ad 	if (found)
    921   1.1        ad 		twe_ccb_enqueue(sc, NULL);
    922   1.1        ad }
    923   1.1        ad 
    924   1.1        ad /*
    925   1.1        ad  * Wait for `status' to be set in the controller status register.  Return
    926   1.1        ad  * zero if found, non-zero if the operation timed out.
    927   1.1        ad  */
    928   1.1        ad static int
    929   1.1        ad twe_status_wait(struct twe_softc *sc, u_int32_t status, int timo)
    930   1.1        ad {
    931   1.1        ad 
    932  1.11        ad 	for (timo *= 10; timo != 0; timo--) {
    933  1.22        ad 		if ((twe_inl(sc, TWE_REG_STS) & status) == status)
    934   1.1        ad 			break;
    935   1.1        ad 		delay(100000);
    936   1.1        ad 	}
    937   1.1        ad 
    938   1.1        ad 	return (timo == 0);
    939   1.1        ad }
    940   1.1        ad 
    941   1.1        ad /*
    942   1.1        ad  * Complain if the status bits aren't what we expect.
    943   1.1        ad  */
    944   1.1        ad static int
    945   1.1        ad twe_status_check(struct twe_softc *sc, u_int status)
    946   1.1        ad {
    947   1.1        ad 	int rv;
    948   1.1        ad 
    949   1.1        ad 	rv = 0;
    950   1.1        ad 
    951   1.1        ad 	if ((status & TWE_STS_EXPECTED_BITS) != TWE_STS_EXPECTED_BITS) {
    952   1.1        ad 		printf("%s: missing status bits: 0x%08x\n", sc->sc_dv.dv_xname,
    953   1.1        ad 		    status & ~TWE_STS_EXPECTED_BITS);
    954   1.1        ad 		rv = -1;
    955   1.1        ad 	}
    956   1.1        ad 
    957   1.1        ad 	if ((status & TWE_STS_UNEXPECTED_BITS) != 0) {
    958   1.1        ad 		printf("%s: unexpected status bits: 0x%08x\n",
    959   1.1        ad 		    sc->sc_dv.dv_xname, status & TWE_STS_UNEXPECTED_BITS);
    960   1.1        ad 		rv = -1;
    961   1.1        ad 	}
    962   1.1        ad 
    963   1.1        ad 	return (rv);
    964   1.1        ad }
    965   1.1        ad 
    966   1.1        ad /*
    967   1.1        ad  * Allocate and initialise a CCB.
    968   1.1        ad  */
    969   1.1        ad int
    970   1.3        ad twe_ccb_alloc(struct twe_softc *sc, struct twe_ccb **ccbp, int flags)
    971   1.1        ad {
    972   1.1        ad 	struct twe_cmd *tc;
    973   1.1        ad 	struct twe_ccb *ccb;
    974   1.1        ad 	int s;
    975   1.1        ad 
    976   1.7        ad 	s = splbio();
    977   1.3        ad 	if ((flags & TWE_CCB_PARAM) != 0)
    978   1.3        ad 		ccb = sc->sc_ccbs;
    979   1.3        ad 	else {
    980   1.3        ad 		/* Allocate a CCB and command block. */
    981   1.3        ad 		if (SLIST_FIRST(&sc->sc_ccb_freelist) == NULL) {
    982   1.1        ad 			splx(s);
    983   1.1        ad 			return (EAGAIN);
    984   1.1        ad 		}
    985   1.3        ad 		ccb = SLIST_FIRST(&sc->sc_ccb_freelist);
    986   1.3        ad 		SLIST_REMOVE_HEAD(&sc->sc_ccb_freelist, ccb_chain.slist);
    987   1.1        ad 	}
    988   1.3        ad #ifdef DIAGNOSTIC
    989   1.3        ad 	if ((ccb->ccb_flags & TWE_CCB_ALLOCED) != 0)
    990   1.3        ad 		panic("twe_ccb_alloc: CCB already allocated");
    991   1.3        ad 	flags |= TWE_CCB_ALLOCED;
    992   1.3        ad #endif
    993   1.7        ad 	splx(s);
    994   1.1        ad 
    995   1.1        ad 	/* Initialise some fields and return. */
    996   1.1        ad 	ccb->ccb_tx.tx_handler = NULL;
    997   1.3        ad 	ccb->ccb_flags = flags;
    998   1.1        ad 	tc = ccb->ccb_cmd;
    999   1.1        ad 	tc->tc_status = 0;
   1000   1.1        ad 	tc->tc_flags = 0;
   1001   1.1        ad 	tc->tc_cmdid = ccb->ccb_cmdid;
   1002   1.3        ad 	*ccbp = ccb;
   1003   1.1        ad 
   1004   1.1        ad 	return (0);
   1005   1.1        ad }
   1006   1.1        ad 
   1007   1.1        ad /*
   1008   1.3        ad  * Free a CCB.
   1009   1.1        ad  */
   1010   1.1        ad void
   1011   1.2        ad twe_ccb_free(struct twe_softc *sc, struct twe_ccb *ccb)
   1012   1.1        ad {
   1013   1.1        ad 	int s;
   1014   1.1        ad 
   1015   1.3        ad 	s = splbio();
   1016   1.3        ad 	if ((ccb->ccb_flags & TWE_CCB_PARAM) == 0)
   1017   1.3        ad 		SLIST_INSERT_HEAD(&sc->sc_ccb_freelist, ccb, ccb_chain.slist);
   1018   1.1        ad 	ccb->ccb_flags = 0;
   1019   1.1        ad 	splx(s);
   1020   1.1        ad }
   1021   1.1        ad 
   1022   1.1        ad /*
   1023   1.1        ad  * Map the specified CCB's command block and data buffer (if any) into
   1024   1.1        ad  * controller visible space.  Perform DMA synchronisation.
   1025   1.1        ad  */
   1026   1.1        ad int
   1027   1.1        ad twe_ccb_map(struct twe_softc *sc, struct twe_ccb *ccb)
   1028   1.1        ad {
   1029   1.1        ad 	struct twe_cmd *tc;
   1030  1.20        ad 	int flags, nsegs, i, s, rv;
   1031   1.1        ad 	void *data;
   1032   1.1        ad 
   1033   1.7        ad 	/*
   1034   1.7        ad 	 * The data as a whole must be 512-byte aligned.
   1035   1.7        ad 	 */
   1036   1.1        ad 	if (((u_long)ccb->ccb_data & (TWE_ALIGNMENT - 1)) != 0) {
   1037  1.20        ad 		s = splvm();
   1038  1.20        ad 		/* XXX */
   1039  1.20        ad 		ccb->ccb_abuf = uvm_km_kmemalloc(kmem_map, NULL,
   1040  1.20        ad 		    ccb->ccb_datasize, UVM_KMF_NOWAIT);
   1041  1.20        ad 		splx(s);
   1042  1.20        ad 		data = (void *)ccb->ccb_abuf;
   1043   1.2        ad 		if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
   1044   1.2        ad 			memcpy(data, ccb->ccb_data, ccb->ccb_datasize);
   1045   1.1        ad 	} else {
   1046  1.20        ad 		ccb->ccb_abuf = (vaddr_t)0;
   1047   1.1        ad 		data = ccb->ccb_data;
   1048   1.1        ad 	}
   1049   1.1        ad 
   1050   1.7        ad 	/*
   1051   1.7        ad 	 * Map the data buffer into bus space and build the S/G list.
   1052   1.7        ad 	 */
   1053   1.7        ad 	rv = bus_dmamap_load(sc->sc_dmat, ccb->ccb_dmamap_xfer, data,
   1054  1.16   thorpej 	    ccb->ccb_datasize, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
   1055  1.16   thorpej 	    ((ccb->ccb_flags & TWE_CCB_DATA_IN) ?
   1056  1.22        ad 	    BUS_DMA_READ : BUS_DMA_WRITE));
   1057   1.7        ad 	if (rv != 0) {
   1058  1.20        ad 		if (ccb->ccb_abuf != (vaddr_t)0) {
   1059  1.20        ad 			s = splvm();
   1060  1.20        ad 			/* XXX */
   1061  1.20        ad 			uvm_km_free(kmem_map, ccb->ccb_abuf,
   1062   1.7        ad 			    ccb->ccb_datasize);
   1063  1.20        ad 			splx(s);
   1064   1.7        ad 		}
   1065   1.7        ad 		return (rv);
   1066   1.7        ad 	}
   1067   1.1        ad 
   1068   1.1        ad 	nsegs = ccb->ccb_dmamap_xfer->dm_nsegs;
   1069   1.1        ad 	tc = ccb->ccb_cmd;
   1070   1.1        ad 	tc->tc_size += 2 * nsegs;
   1071   1.1        ad 
   1072   1.1        ad 	/* The location of the S/G list is dependant upon command type. */
   1073   1.1        ad 	switch (tc->tc_opcode >> 5) {
   1074   1.1        ad 	case 2:
   1075   1.1        ad 		for (i = 0; i < nsegs; i++) {
   1076   1.1        ad 			tc->tc_args.param.sgl[i].tsg_address =
   1077   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr);
   1078   1.1        ad 			tc->tc_args.param.sgl[i].tsg_length =
   1079   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len);
   1080   1.1        ad 		}
   1081   1.1        ad 		/* XXX Needed? */
   1082   1.1        ad 		for (; i < TWE_SG_SIZE; i++) {
   1083   1.1        ad 			tc->tc_args.param.sgl[i].tsg_address = 0;
   1084   1.1        ad 			tc->tc_args.param.sgl[i].tsg_length = 0;
   1085   1.1        ad 		}
   1086   1.1        ad 		break;
   1087   1.1        ad 	case 3:
   1088   1.1        ad 		for (i = 0; i < nsegs; i++) {
   1089   1.1        ad 			tc->tc_args.io.sgl[i].tsg_address =
   1090   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr);
   1091   1.1        ad 			tc->tc_args.io.sgl[i].tsg_length =
   1092   1.1        ad 			    htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len);
   1093   1.1        ad 		}
   1094   1.1        ad 		/* XXX Needed? */
   1095   1.1        ad 		for (; i < TWE_SG_SIZE; i++) {
   1096   1.1        ad 			tc->tc_args.io.sgl[i].tsg_address = 0;
   1097   1.1        ad 			tc->tc_args.io.sgl[i].tsg_length = 0;
   1098   1.1        ad 		}
   1099   1.1        ad 		break;
   1100   1.1        ad #ifdef DEBUG
   1101   1.1        ad 	default:
   1102   1.1        ad 		panic("twe_ccb_map: oops");
   1103   1.1        ad #endif
   1104   1.1        ad 	}
   1105   1.1        ad 
   1106   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
   1107   1.1        ad 		flags = BUS_DMASYNC_PREREAD;
   1108   1.1        ad 	else
   1109   1.1        ad 		flags = 0;
   1110   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
   1111   1.1        ad 		flags |= BUS_DMASYNC_PREWRITE;
   1112   1.1        ad 
   1113   1.1        ad 	bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0,
   1114   1.1        ad 	    ccb->ccb_datasize, flags);
   1115   1.1        ad 	return (0);
   1116   1.1        ad }
   1117   1.1        ad 
   1118   1.1        ad /*
   1119   1.1        ad  * Unmap the specified CCB's command block and data buffer (if any) and
   1120   1.1        ad  * perform DMA synchronisation.
   1121   1.1        ad  */
   1122   1.1        ad void
   1123   1.1        ad twe_ccb_unmap(struct twe_softc *sc, struct twe_ccb *ccb)
   1124   1.1        ad {
   1125  1.20        ad 	int flags, s;
   1126   1.1        ad 
   1127   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
   1128   1.1        ad 		flags = BUS_DMASYNC_POSTREAD;
   1129   1.1        ad 	else
   1130   1.1        ad 		flags = 0;
   1131   1.1        ad 	if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
   1132   1.1        ad 		flags |= BUS_DMASYNC_POSTWRITE;
   1133   1.1        ad 
   1134   1.1        ad 	bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0,
   1135   1.1        ad 	    ccb->ccb_datasize, flags);
   1136   1.1        ad 	bus_dmamap_unload(sc->sc_dmat, ccb->ccb_dmamap_xfer);
   1137   1.1        ad 
   1138  1.20        ad 	if (ccb->ccb_abuf != (vaddr_t)0) {
   1139   1.2        ad 		if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
   1140  1.20        ad 			memcpy(ccb->ccb_data, (void *)ccb->ccb_abuf,
   1141   1.2        ad 			    ccb->ccb_datasize);
   1142  1.20        ad 		s = splvm();
   1143  1.20        ad 		/* XXX */
   1144  1.20        ad 		uvm_km_free(kmem_map, ccb->ccb_abuf, ccb->ccb_datasize);
   1145  1.20        ad 		splx(s);
   1146   1.1        ad 	}
   1147   1.1        ad }
   1148   1.1        ad 
   1149   1.1        ad /*
   1150   1.7        ad  * Submit a command to the controller and poll on completion.  Return
   1151   1.7        ad  * non-zero on timeout (but don't check status, as some command types don't
   1152   1.7        ad  * return status).  Must be called with interrupts blocked.
   1153   1.1        ad  */
   1154   1.1        ad int
   1155   1.1        ad twe_ccb_poll(struct twe_softc *sc, struct twe_ccb *ccb, int timo)
   1156   1.1        ad {
   1157   1.7        ad 	int rv;
   1158   1.7        ad 
   1159   1.7        ad 	if ((rv = twe_ccb_submit(sc, ccb)) != 0)
   1160   1.7        ad 		return (rv);
   1161   1.1        ad 
   1162  1.15        ad 	for (timo *= 1000; timo != 0; timo--) {
   1163   1.1        ad 		twe_poll(sc);
   1164   1.1        ad 		if ((ccb->ccb_flags & TWE_CCB_COMPLETE) != 0)
   1165   1.1        ad 			break;
   1166  1.15        ad 		DELAY(100);
   1167   1.1        ad 	}
   1168   1.1        ad 
   1169   1.1        ad 	return (timo == 0);
   1170   1.1        ad }
   1171   1.1        ad 
   1172   1.1        ad /*
   1173   1.1        ad  * If a CCB is specified, enqueue it.  Pull CCBs off the software queue in
   1174   1.1        ad  * the order that they were enqueued and try to submit their command blocks
   1175   1.1        ad  * to the controller for execution.
   1176   1.1        ad  */
   1177   1.1        ad void
   1178   1.1        ad twe_ccb_enqueue(struct twe_softc *sc, struct twe_ccb *ccb)
   1179   1.1        ad {
   1180   1.1        ad 	int s;
   1181   1.1        ad 
   1182   1.1        ad 	s = splbio();
   1183   1.1        ad 
   1184   1.1        ad 	if (ccb != NULL)
   1185   1.1        ad 		SIMPLEQ_INSERT_TAIL(&sc->sc_ccb_queue, ccb, ccb_chain.simpleq);
   1186   1.1        ad 
   1187   1.1        ad 	while ((ccb = SIMPLEQ_FIRST(&sc->sc_ccb_queue)) != NULL) {
   1188   1.1        ad 		if (twe_ccb_submit(sc, ccb))
   1189   1.1        ad 			break;
   1190  1.25     lukem 		SIMPLEQ_REMOVE_HEAD(&sc->sc_ccb_queue, ccb_chain.simpleq);
   1191   1.1        ad 	}
   1192   1.1        ad 
   1193   1.1        ad 	splx(s);
   1194   1.1        ad }
   1195   1.1        ad 
   1196   1.1        ad /*
   1197   1.1        ad  * Submit the command block associated with the specified CCB to the
   1198   1.1        ad  * controller for execution.  Must be called with interrupts blocked.
   1199   1.1        ad  */
   1200   1.1        ad int
   1201   1.1        ad twe_ccb_submit(struct twe_softc *sc, struct twe_ccb *ccb)
   1202   1.1        ad {
   1203   1.1        ad 	bus_addr_t pa;
   1204   1.1        ad 	int rv;
   1205   1.1        ad 	u_int status;
   1206   1.1        ad 
   1207   1.1        ad 	/* Check to see if we can post a command. */
   1208  1.22        ad 	status = twe_inl(sc, TWE_REG_STS);
   1209   1.1        ad 	twe_status_check(sc, status);
   1210   1.1        ad 
   1211   1.1        ad 	if ((status & TWE_STS_CMD_QUEUE_FULL) == 0) {
   1212   1.1        ad 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
   1213   1.1        ad 		    (caddr_t)ccb->ccb_cmd - sc->sc_cmds, sizeof(struct twe_cmd),
   1214   1.1        ad 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
   1215   1.1        ad 		ccb->ccb_flags |= TWE_CCB_ACTIVE;
   1216   1.1        ad 		pa = sc->sc_cmds_paddr +
   1217   1.1        ad 		    ccb->ccb_cmdid * sizeof(struct twe_cmd);
   1218  1.22        ad 		twe_outl(sc, TWE_REG_CMD_QUEUE, (u_int32_t)pa);
   1219   1.1        ad 		rv = 0;
   1220   1.1        ad 	} else
   1221   1.1        ad 		rv = EBUSY;
   1222   1.1        ad 
   1223   1.1        ad 	return (rv);
   1224  1.33  christos }
   1225  1.33  christos 
   1226  1.33  christos 
   1227  1.33  christos /*
   1228  1.33  christos  * Accept an open operation on the control device.
   1229  1.33  christos  */
   1230  1.33  christos int
   1231  1.37      fvdl tweopen(dev_t dev, int flag, int mode, struct proc *p)
   1232  1.33  christos {
   1233  1.33  christos 	struct twe_softc *twe;
   1234  1.33  christos 
   1235  1.33  christos 	if ((twe = device_lookup(&twe_cd, minor(dev))) == NULL)
   1236  1.33  christos 		return (ENXIO);
   1237  1.33  christos 	if ((twe->sc_flags & TWEF_OPEN) != 0)
   1238  1.33  christos 		return (EBUSY);
   1239  1.33  christos 
   1240  1.33  christos 	twe->sc_flags |= TWEF_OPEN;
   1241  1.33  christos 	return (0);
   1242  1.33  christos }
   1243  1.33  christos 
   1244  1.33  christos /*
   1245  1.33  christos  * Accept the last close on the control device.
   1246  1.33  christos  */
   1247  1.33  christos int
   1248  1.37      fvdl tweclose(dev_t dev, int flag, int mode, struct proc *p)
   1249  1.33  christos {
   1250  1.33  christos 	struct twe_softc *twe;
   1251  1.33  christos 
   1252  1.33  christos 	twe = device_lookup(&twe_cd, minor(dev));
   1253  1.33  christos 	twe->sc_flags &= ~TWEF_OPEN;
   1254  1.33  christos 	return (0);
   1255  1.33  christos }
   1256  1.33  christos 
   1257  1.33  christos /*
   1258  1.33  christos  * Handle control operations.
   1259  1.33  christos  */
   1260  1.33  christos int
   1261  1.37      fvdl tweioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
   1262  1.33  christos {
   1263  1.33  christos 	struct twe_softc *twe;
   1264  1.33  christos 	struct twe_ccb *ccb;
   1265  1.33  christos 	struct twe_param *param;
   1266  1.33  christos 	struct twe_usercommand *tu;
   1267  1.33  christos 	struct twe_paramcommand *tp;
   1268  1.33  christos 	union twe_statrequest *ts;
   1269  1.33  christos 	void *pdata = NULL;
   1270  1.33  christos 	int rv, s, error = 0;
   1271  1.33  christos 	u_int8_t cmdid;
   1272  1.33  christos 
   1273  1.33  christos 	if (securelevel >= 2)
   1274  1.33  christos 		return (EPERM);
   1275  1.33  christos 
   1276  1.33  christos 	twe = device_lookup(&twe_cd, minor(dev));
   1277  1.33  christos 	tu = (struct twe_usercommand *)data;
   1278  1.33  christos 	tp = (struct twe_paramcommand *)data;
   1279  1.33  christos 	ts = (union twe_statrequest *)data;
   1280  1.33  christos 
   1281  1.33  christos 	/* Hmm, compatible with FreeBSD */
   1282  1.33  christos 	switch (cmd) {
   1283  1.33  christos 	case TWEIO_COMMAND:
   1284  1.33  christos 		if (tu->tu_size > 0) {
   1285  1.33  christos 			if (tu->tu_size > TWE_SECTOR_SIZE)
   1286  1.33  christos 				return EINVAL;
   1287  1.33  christos 			pdata = malloc(tu->tu_size, M_DEVBUF, M_WAITOK);
   1288  1.33  christos 			error = copyin(tu->tu_data, pdata, tu->tu_size);
   1289  1.33  christos 			if (error != 0)
   1290  1.33  christos 				goto done;
   1291  1.33  christos 			error = twe_ccb_alloc(twe, &ccb, TWE_CCB_PARAM |
   1292  1.33  christos 			    TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
   1293  1.33  christos 		} else {
   1294  1.33  christos 			error = twe_ccb_alloc(twe, &ccb, 0);
   1295  1.33  christos 		}
   1296  1.33  christos 		if (rv != 0)
   1297  1.33  christos 			goto done;
   1298  1.33  christos 		cmdid = ccb->ccb_cmdid;
   1299  1.33  christos 		memcpy(ccb->ccb_cmd, &tu->tu_cmd, sizeof(struct twe_cmd));
   1300  1.33  christos 		ccb->ccb_cmdid = cmdid;
   1301  1.33  christos 		if (ccb->ccb_flags & TWE_CCB_PARAM) {
   1302  1.33  christos 			ccb->ccb_data = pdata;
   1303  1.33  christos 			ccb->ccb_datasize = TWE_SECTOR_SIZE;
   1304  1.33  christos 			ccb->ccb_tx.tx_handler = 0;
   1305  1.33  christos 			ccb->ccb_tx.tx_context = pdata;
   1306  1.33  christos 			ccb->ccb_tx.tx_dv = &twe->sc_dv;
   1307  1.33  christos 		}
   1308  1.33  christos 		/* Map the transfer. */
   1309  1.33  christos 		if ((error = twe_ccb_map(twe, ccb)) != 0) {
   1310  1.33  christos 			twe_ccb_free(twe, ccb);
   1311  1.33  christos 			goto done;
   1312  1.33  christos 		}
   1313  1.33  christos 
   1314  1.33  christos 		/* Submit the command and wait. */
   1315  1.33  christos 		s = splbio();
   1316  1.33  christos 		rv = twe_ccb_poll(twe, ccb, 5);
   1317  1.33  christos 		twe_ccb_unmap(twe, ccb);
   1318  1.33  christos 		twe_ccb_free(twe, ccb);
   1319  1.33  christos 		splx(s);
   1320  1.33  christos 
   1321  1.33  christos 		if (tu->tu_size > 0)
   1322  1.33  christos 			error = copyout(pdata, tu->tu_data, tu->tu_size);
   1323  1.33  christos 		goto done;
   1324  1.33  christos 
   1325  1.33  christos 	case TWEIO_STATS:
   1326  1.33  christos 		return (ENOENT);
   1327  1.33  christos 
   1328  1.33  christos 	case TWEIO_AEN_POLL:
   1329  1.33  christos 		if ((twe->sc_flags & TWEF_AEN) == 0)
   1330  1.33  christos 			return (ENOENT);
   1331  1.33  christos 		return (0);
   1332  1.33  christos 
   1333  1.33  christos 	case TWEIO_AEN_WAIT:
   1334  1.33  christos 		s = splbio();
   1335  1.33  christos 		while ((twe->sc_flags & TWEF_AEN) == 0) {
   1336  1.33  christos 			/* tsleep(); */
   1337  1.33  christos 		}
   1338  1.33  christos 		splx(s);
   1339  1.33  christos 		return (0);
   1340  1.33  christos 
   1341  1.33  christos 	case TWEIO_GET_PARAM:
   1342  1.33  christos 		error = twe_param_get(twe, tp->tp_table_id, tp->tp_param_id,
   1343  1.39  jdolecek 		    tp->tp_size, 0, &param);
   1344  1.33  christos 		if (error != 0)
   1345  1.33  christos 			return (error);
   1346  1.33  christos 		if (param->tp_param_size > tp->tp_size) {
   1347  1.33  christos 			error = EFAULT;
   1348  1.33  christos 			goto done;
   1349  1.33  christos 		}
   1350  1.33  christos 		error = copyout(param->tp_data, tp->tp_data,
   1351  1.33  christos 		    param->tp_param_size);
   1352  1.33  christos 		goto done;
   1353  1.33  christos 
   1354  1.33  christos 	case TWEIO_SET_PARAM:
   1355  1.33  christos 		pdata = malloc(tp->tp_size, M_DEVBUF, M_WAITOK);
   1356  1.33  christos 		if ((error = copyin(tp->tp_data, pdata, tp->tp_size)) != 0)
   1357  1.33  christos 			goto done;
   1358  1.33  christos 		error = twe_param_set(twe, tp->tp_table_id, tp->tp_param_id,
   1359  1.33  christos 		    tp->tp_size, pdata);
   1360  1.33  christos 		goto done;
   1361  1.33  christos 
   1362  1.33  christos 	case TWEIO_RESET:
   1363  1.33  christos 		twe_reset(twe);
   1364  1.33  christos 		return (0);
   1365  1.33  christos 
   1366  1.33  christos 	default:
   1367  1.33  christos 		return EINVAL;
   1368  1.33  christos 	}
   1369  1.33  christos done:
   1370  1.33  christos 	if (pdata)
   1371  1.33  christos 		free(pdata, M_DEVBUF);
   1372  1.33  christos 	return error;
   1373  1.38  jdolecek }
   1374  1.38  jdolecek 
   1375  1.38  jdolecek /*
   1376  1.38  jdolecek  * Print some information about the controller
   1377  1.38  jdolecek  */
   1378  1.38  jdolecek static void
   1379  1.38  jdolecek twe_describe_controller(struct twe_softc *sc)
   1380  1.38  jdolecek {
   1381  1.38  jdolecek 	struct twe_param *p[7];
   1382  1.38  jdolecek 	int rv = 0;
   1383  1.38  jdolecek 
   1384  1.38  jdolecek 	/* get the port count */
   1385  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_CONTROLLER,
   1386  1.38  jdolecek 		TWE_PARAM_CONTROLLER_PortCount, 1, NULL, &p[0]);
   1387  1.38  jdolecek 
   1388  1.38  jdolecek 	/* get version strings */
   1389  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_Mon,
   1390  1.38  jdolecek 		16, NULL, &p[1]);
   1391  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_FW,
   1392  1.38  jdolecek 		16, NULL, &p[2]);
   1393  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_BIOS,
   1394  1.38  jdolecek 		16, NULL, &p[3]);
   1395  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_PCB,
   1396  1.38  jdolecek 		8, NULL, &p[4]);
   1397  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_ATA,
   1398  1.38  jdolecek 		8, NULL, &p[5]);
   1399  1.38  jdolecek 	rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_PCI,
   1400  1.38  jdolecek 		8, NULL, &p[6]);
   1401  1.38  jdolecek 
   1402  1.38  jdolecek 	if (rv) {
   1403  1.38  jdolecek 		/* some error occurred */
   1404  1.38  jdolecek 		aprint_error("%s: failed to fetch version information\n",
   1405  1.38  jdolecek 			sc->sc_dv.dv_xname);
   1406  1.38  jdolecek 		return;
   1407  1.38  jdolecek 	}
   1408  1.38  jdolecek 
   1409  1.38  jdolecek 	aprint_normal("%s: %d ports, Firmware %.16s, BIOS %.16s\n",
   1410  1.38  jdolecek 		sc->sc_dv.dv_xname,
   1411  1.38  jdolecek 		p[0]->tp_data[0], p[2]->tp_data, p[3]->tp_data);
   1412  1.38  jdolecek 
   1413  1.38  jdolecek 	aprint_verbose("%s: Monitor %.16s, PCB %.8s, Achip %.8s, Pchip %.8s\n",
   1414  1.38  jdolecek 		sc->sc_dv.dv_xname,
   1415  1.38  jdolecek 		p[1]->tp_data, p[4]->tp_data,
   1416  1.38  jdolecek 		p[5]->tp_data, p[6]->tp_data);
   1417  1.38  jdolecek 
   1418  1.38  jdolecek 	free(p[0], M_DEVBUF);
   1419  1.38  jdolecek 	free(p[1], M_DEVBUF);
   1420  1.38  jdolecek 	free(p[2], M_DEVBUF);
   1421  1.38  jdolecek 	free(p[3], M_DEVBUF);
   1422  1.38  jdolecek 	free(p[4], M_DEVBUF);
   1423  1.38  jdolecek 	free(p[5], M_DEVBUF);
   1424  1.38  jdolecek 	free(p[6], M_DEVBUF);
   1425   1.1        ad }
   1426