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