Home | History | Annotate | Line # | Download | only in ic
mpt_netbsd.c revision 1.17.2.2
      1  1.17.2.2   msaitoh /*	$NetBSD: mpt_netbsd.c,v 1.17.2.2 2014/11/03 22:05:37 msaitoh Exp $	*/
      2       1.1   thorpej 
      3       1.1   thorpej /*
      4       1.1   thorpej  * Copyright (c) 2003 Wasabi Systems, Inc.
      5       1.1   thorpej  * All rights reserved.
      6       1.1   thorpej  *
      7       1.1   thorpej  * Written by Jason R. Thorpe for Wasabi Systems, Inc.
      8       1.1   thorpej  *
      9       1.1   thorpej  * Redistribution and use in source and binary forms, with or without
     10       1.1   thorpej  * modification, are permitted provided that the following conditions
     11       1.1   thorpej  * are met:
     12       1.1   thorpej  * 1. Redistributions of source code must retain the above copyright
     13       1.1   thorpej  *    notice, this list of conditions and the following disclaimer.
     14       1.1   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     15       1.1   thorpej  *    notice, this list of conditions and the following disclaimer in the
     16       1.1   thorpej  *    documentation and/or other materials provided with the distribution.
     17       1.1   thorpej  * 3. All advertising materials mentioning features or use of this software
     18       1.1   thorpej  *    must display the following acknowledgement:
     19       1.1   thorpej  *	This product includes software developed for the NetBSD Project by
     20       1.1   thorpej  *	Wasabi Systems, Inc.
     21       1.1   thorpej  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
     22       1.1   thorpej  *    or promote products derived from this software without specific prior
     23       1.1   thorpej  *    written permission.
     24       1.1   thorpej  *
     25       1.1   thorpej  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
     26       1.1   thorpej  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     27       1.1   thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     28       1.1   thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
     29       1.1   thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     30       1.1   thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     31       1.1   thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     32       1.1   thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     33       1.1   thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     34       1.1   thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     35       1.1   thorpej  * POSSIBILITY OF SUCH DAMAGE.
     36       1.1   thorpej  */
     37       1.1   thorpej 
     38       1.1   thorpej /*
     39       1.1   thorpej  * Copyright (c) 2000, 2001 by Greg Ansley
     40       1.1   thorpej  * Partially derived from Matt Jacob's ISP driver.
     41       1.1   thorpej  *
     42       1.1   thorpej  * Redistribution and use in source and binary forms, with or without
     43       1.1   thorpej  * modification, are permitted provided that the following conditions
     44       1.1   thorpej  * are met:
     45       1.1   thorpej  * 1. Redistributions of source code must retain the above copyright
     46       1.1   thorpej  *    notice immediately at the beginning of the file, without modification,
     47       1.1   thorpej  *    this list of conditions, and the following disclaimer.
     48       1.1   thorpej  * 2. The name of the author may not be used to endorse or promote products
     49       1.1   thorpej  *    derived from this software without specific prior written permission.
     50       1.1   thorpej  *
     51       1.1   thorpej  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     52       1.1   thorpej  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     53       1.1   thorpej  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     54       1.1   thorpej  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
     55       1.1   thorpej  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     56       1.1   thorpej  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     57       1.1   thorpej  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     58       1.1   thorpej  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     59       1.1   thorpej  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     60       1.1   thorpej  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     61       1.1   thorpej  * SUCH DAMAGE.
     62       1.1   thorpej  */
     63       1.1   thorpej /*
     64       1.1   thorpej  * Additional Copyright (c) 2002 by Matthew Jacob under same license.
     65       1.1   thorpej  */
     66       1.1   thorpej 
     67       1.1   thorpej /*
     68       1.1   thorpej  * mpt_netbsd.c:
     69       1.1   thorpej  *
     70       1.1   thorpej  * NetBSD-specific routines for LSI Fusion adapters.  Includes some
     71       1.1   thorpej  * bus_dma glue, and SCSIPI glue.
     72       1.1   thorpej  *
     73       1.1   thorpej  * Adapted from the FreeBSD "mpt" driver by Jason R. Thorpe for
     74       1.1   thorpej  * Wasabi Systems, Inc.
     75      1.12      tron  *
     76      1.12      tron  * Additional contributions by Garrett D'Amore on behalf of TELES AG.
     77       1.1   thorpej  */
     78       1.7     lukem 
     79       1.7     lukem #include <sys/cdefs.h>
     80  1.17.2.2   msaitoh __KERNEL_RCSID(0, "$NetBSD: mpt_netbsd.c,v 1.17.2.2 2014/11/03 22:05:37 msaitoh Exp $");
     81  1.17.2.2   msaitoh 
     82  1.17.2.2   msaitoh #include "bio.h"
     83       1.1   thorpej 
     84       1.1   thorpej #include <dev/ic/mpt.h>			/* pulls in all headers */
     85       1.1   thorpej 
     86  1.17.2.2   msaitoh #if NBIO > 0
     87  1.17.2.2   msaitoh #include <dev/biovar.h>
     88  1.17.2.2   msaitoh #include <sys/ioccom.h>
     89  1.17.2.2   msaitoh #endif
     90  1.17.2.2   msaitoh 
     91       1.1   thorpej static int	mpt_poll(mpt_softc_t *, struct scsipi_xfer *, int);
     92       1.1   thorpej static void	mpt_timeout(void *);
     93       1.1   thorpej static void	mpt_done(mpt_softc_t *, uint32_t);
     94       1.1   thorpej static void	mpt_run_xfer(mpt_softc_t *, struct scsipi_xfer *);
     95       1.1   thorpej static void	mpt_set_xfer_mode(mpt_softc_t *, struct scsipi_xfer_mode *);
     96       1.1   thorpej static void	mpt_get_xfer_mode(mpt_softc_t *, struct scsipi_periph *);
     97       1.1   thorpej static void	mpt_ctlop(mpt_softc_t *, void *vmsg, uint32_t);
     98       1.1   thorpej static void	mpt_event_notify_reply(mpt_softc_t *, MSG_EVENT_NOTIFY_REPLY *);
     99       1.1   thorpej 
    100       1.1   thorpej static void	mpt_scsipi_request(struct scsipi_channel *,
    101       1.1   thorpej 		    scsipi_adapter_req_t, void *);
    102       1.1   thorpej static void	mpt_minphys(struct buf *);
    103       1.1   thorpej 
    104  1.17.2.2   msaitoh #if NBIO > 0
    105  1.17.2.2   msaitoh static bool	mpt_is_raid(mpt_softc_t *);
    106  1.17.2.2   msaitoh static int	mpt_bio_ioctl(device_t, u_long, void *);
    107  1.17.2.2   msaitoh static int	mpt_bio_ioctl_inq(mpt_softc_t *, struct bioc_inq *);
    108  1.17.2.2   msaitoh static int	mpt_bio_ioctl_vol(mpt_softc_t *, struct bioc_vol *);
    109  1.17.2.2   msaitoh static int	mpt_bio_ioctl_disk(mpt_softc_t *, struct bioc_disk *);
    110  1.17.2.2   msaitoh static int	mpt_bio_ioctl_disk_novol(mpt_softc_t *, struct bioc_disk *);
    111  1.17.2.2   msaitoh static int	mpt_bio_ioctl_setstate(mpt_softc_t *, struct bioc_setstate *);
    112  1.17.2.2   msaitoh #endif
    113  1.17.2.2   msaitoh 
    114       1.1   thorpej void
    115       1.1   thorpej mpt_scsipi_attach(mpt_softc_t *mpt)
    116       1.1   thorpej {
    117       1.1   thorpej 	struct scsipi_adapter *adapt = &mpt->sc_adapter;
    118       1.1   thorpej 	struct scsipi_channel *chan = &mpt->sc_channel;
    119       1.1   thorpej 	int maxq;
    120       1.1   thorpej 
    121       1.1   thorpej 	mpt->bus = 0;		/* XXX ?? */
    122       1.1   thorpej 
    123       1.1   thorpej 	maxq = (mpt->mpt_global_credits < MPT_MAX_REQUESTS(mpt)) ?
    124       1.1   thorpej 	    mpt->mpt_global_credits : MPT_MAX_REQUESTS(mpt);
    125       1.1   thorpej 
    126       1.1   thorpej 	/* Fill in the scsipi_adapter. */
    127       1.1   thorpej 	memset(adapt, 0, sizeof(*adapt));
    128       1.1   thorpej 	adapt->adapt_dev = &mpt->sc_dev;
    129       1.1   thorpej 	adapt->adapt_nchannels = 1;
    130      1.17    mhitch 	adapt->adapt_openings = maxq - 2;	/* Reserve 2 for driver use*/
    131      1.17    mhitch 	adapt->adapt_max_periph = maxq - 2;
    132       1.1   thorpej 	adapt->adapt_request = mpt_scsipi_request;
    133       1.1   thorpej 	adapt->adapt_minphys = mpt_minphys;
    134       1.1   thorpej 
    135       1.1   thorpej 	/* Fill in the scsipi_channel. */
    136       1.1   thorpej 	memset(chan, 0, sizeof(*chan));
    137       1.1   thorpej 	chan->chan_adapter = adapt;
    138  1.17.2.1       riz 	if (mpt->is_sas) {
    139  1.17.2.1       riz 		chan->chan_bustype = &scsi_sas_bustype;
    140  1.17.2.1       riz 	} else if (mpt->is_fc) {
    141  1.17.2.1       riz 		chan->chan_bustype = &scsi_fc_bustype;
    142  1.17.2.1       riz 	} else {
    143  1.17.2.1       riz 		chan->chan_bustype = &scsi_bustype;
    144  1.17.2.1       riz 	}
    145       1.1   thorpej 	chan->chan_channel = 0;
    146       1.1   thorpej 	chan->chan_flags = 0;
    147       1.1   thorpej 	chan->chan_nluns = 8;
    148      1.12      tron 	chan->chan_ntargets = mpt->mpt_max_devices;
    149      1.12      tron 	chan->chan_id = mpt->mpt_ini_id;
    150       1.1   thorpej 
    151       1.1   thorpej 	(void) config_found(&mpt->sc_dev, &mpt->sc_channel, scsiprint);
    152  1.17.2.2   msaitoh 
    153  1.17.2.2   msaitoh #if NBIO > 0
    154  1.17.2.2   msaitoh 	if (mpt_is_raid(mpt)) {
    155  1.17.2.2   msaitoh 		if (bio_register(&mpt->sc_dev, mpt_bio_ioctl) != 0)
    156  1.17.2.2   msaitoh 			panic("%s: controller registration failed",
    157  1.17.2.2   msaitoh 			    device_xname(&mpt->sc_dev));
    158  1.17.2.2   msaitoh 	}
    159  1.17.2.2   msaitoh #endif
    160       1.1   thorpej }
    161       1.1   thorpej 
    162       1.1   thorpej int
    163       1.1   thorpej mpt_dma_mem_alloc(mpt_softc_t *mpt)
    164       1.1   thorpej {
    165       1.1   thorpej 	bus_dma_segment_t reply_seg, request_seg;
    166       1.1   thorpej 	int reply_rseg, request_rseg;
    167       1.1   thorpej 	bus_addr_t pptr, end;
    168      1.11  christos 	char *vptr;
    169       1.1   thorpej 	size_t len;
    170       1.1   thorpej 	int error, i;
    171       1.1   thorpej 
    172       1.1   thorpej 	/* Check if we have already allocated the reply memory. */
    173       1.1   thorpej 	if (mpt->reply != NULL)
    174       1.1   thorpej 		return (0);
    175       1.1   thorpej 
    176       1.1   thorpej 	/*
    177       1.1   thorpej 	 * Allocate the request pool.  This isn't really DMA'd memory,
    178       1.1   thorpej 	 * but it's a convenient place to do it.
    179       1.1   thorpej 	 */
    180       1.1   thorpej 	len = sizeof(request_t) * MPT_MAX_REQUESTS(mpt);
    181       1.1   thorpej 	mpt->request_pool = malloc(len, M_DEVBUF, M_WAITOK | M_ZERO);
    182       1.1   thorpej 	if (mpt->request_pool == NULL) {
    183      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to allocate request pool\n");
    184       1.1   thorpej 		return (ENOMEM);
    185       1.1   thorpej 	}
    186       1.1   thorpej 
    187       1.1   thorpej 	/*
    188       1.1   thorpej 	 * Allocate DMA resources for reply buffers.
    189       1.1   thorpej 	 */
    190       1.1   thorpej 	error = bus_dmamem_alloc(mpt->sc_dmat, PAGE_SIZE, PAGE_SIZE, 0,
    191       1.1   thorpej 	    &reply_seg, 1, &reply_rseg, 0);
    192       1.1   thorpej 	if (error) {
    193      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to allocate reply area, error = %d\n",
    194      1.14    cegger 		    error);
    195       1.1   thorpej 		goto fail_0;
    196       1.1   thorpej 	}
    197       1.1   thorpej 
    198       1.1   thorpej 	error = bus_dmamem_map(mpt->sc_dmat, &reply_seg, reply_rseg, PAGE_SIZE,
    199      1.11  christos 	    (void **) &mpt->reply, BUS_DMA_COHERENT/*XXX*/);
    200       1.1   thorpej 	if (error) {
    201      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to map reply area, error = %d\n",
    202      1.14    cegger 		    error);
    203       1.1   thorpej 		goto fail_1;
    204       1.1   thorpej 	}
    205       1.1   thorpej 
    206       1.1   thorpej 	error = bus_dmamap_create(mpt->sc_dmat, PAGE_SIZE, 1, PAGE_SIZE,
    207       1.1   thorpej 	    0, 0, &mpt->reply_dmap);
    208       1.1   thorpej 	if (error) {
    209      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to create reply DMA map, error = %d\n",
    210      1.14    cegger 		    error);
    211       1.1   thorpej 		goto fail_2;
    212       1.1   thorpej 	}
    213       1.1   thorpej 
    214       1.1   thorpej 	error = bus_dmamap_load(mpt->sc_dmat, mpt->reply_dmap, mpt->reply,
    215       1.1   thorpej 	    PAGE_SIZE, NULL, 0);
    216       1.1   thorpej 	if (error) {
    217      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to load reply DMA map, error = %d\n",
    218      1.14    cegger 		    error);
    219       1.1   thorpej 		goto fail_3;
    220       1.1   thorpej 	}
    221       1.1   thorpej 	mpt->reply_phys = mpt->reply_dmap->dm_segs[0].ds_addr;
    222       1.1   thorpej 
    223       1.1   thorpej 	/*
    224       1.1   thorpej 	 * Allocate DMA resources for request buffers.
    225       1.1   thorpej 	 */
    226       1.1   thorpej 	error = bus_dmamem_alloc(mpt->sc_dmat, MPT_REQ_MEM_SIZE(mpt),
    227       1.1   thorpej 	    PAGE_SIZE, 0, &request_seg, 1, &request_rseg, 0);
    228       1.1   thorpej 	if (error) {
    229      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to allocate request area, "
    230      1.14    cegger 		    "error = %d\n", error);
    231       1.1   thorpej 		goto fail_4;
    232       1.1   thorpej 	}
    233       1.1   thorpej 
    234       1.1   thorpej 	error = bus_dmamem_map(mpt->sc_dmat, &request_seg, request_rseg,
    235      1.11  christos 	    MPT_REQ_MEM_SIZE(mpt), (void **) &mpt->request, 0);
    236       1.1   thorpej 	if (error) {
    237      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to map request area, error = %d\n",
    238      1.14    cegger 		    error);
    239       1.1   thorpej 		goto fail_5;
    240       1.1   thorpej 	}
    241       1.1   thorpej 
    242       1.1   thorpej 	error = bus_dmamap_create(mpt->sc_dmat, MPT_REQ_MEM_SIZE(mpt), 1,
    243       1.1   thorpej 	    MPT_REQ_MEM_SIZE(mpt), 0, 0, &mpt->request_dmap);
    244       1.1   thorpej 	if (error) {
    245      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to create request DMA map, "
    246      1.14    cegger 		    "error = %d\n", error);
    247       1.1   thorpej 		goto fail_6;
    248       1.1   thorpej 	}
    249       1.1   thorpej 
    250       1.1   thorpej 	error = bus_dmamap_load(mpt->sc_dmat, mpt->request_dmap, mpt->request,
    251       1.1   thorpej 	    MPT_REQ_MEM_SIZE(mpt), NULL, 0);
    252       1.1   thorpej 	if (error) {
    253      1.14    cegger 		aprint_error_dev(&mpt->sc_dev, "unable to load request DMA map, error = %d\n",
    254      1.14    cegger 		    error);
    255       1.1   thorpej 		goto fail_7;
    256       1.1   thorpej 	}
    257       1.1   thorpej 	mpt->request_phys = mpt->request_dmap->dm_segs[0].ds_addr;
    258       1.1   thorpej 
    259       1.1   thorpej 	pptr = mpt->request_phys;
    260      1.11  christos 	vptr = (void *) mpt->request;
    261       1.1   thorpej 	end = pptr + MPT_REQ_MEM_SIZE(mpt);
    262       1.1   thorpej 
    263       1.1   thorpej 	for (i = 0; pptr < end; i++) {
    264       1.1   thorpej 		request_t *req = &mpt->request_pool[i];
    265       1.1   thorpej 		req->index = i;
    266       1.1   thorpej 
    267       1.1   thorpej 		/* Store location of Request Data */
    268       1.1   thorpej 		req->req_pbuf = pptr;
    269       1.1   thorpej 		req->req_vbuf = vptr;
    270       1.1   thorpej 
    271       1.1   thorpej 		pptr += MPT_REQUEST_AREA;
    272       1.1   thorpej 		vptr += MPT_REQUEST_AREA;
    273       1.1   thorpej 
    274       1.1   thorpej 		req->sense_pbuf = (pptr - MPT_SENSE_SIZE);
    275       1.1   thorpej 		req->sense_vbuf = (vptr - MPT_SENSE_SIZE);
    276       1.1   thorpej 
    277       1.5       tls 		error = bus_dmamap_create(mpt->sc_dmat, MAXPHYS,
    278       1.5       tls 		    MPT_SGL_MAX, MAXPHYS, 0, 0, &req->dmap);
    279       1.1   thorpej 		if (error) {
    280      1.14    cegger 			aprint_error_dev(&mpt->sc_dev, "unable to create req %d DMA map, "
    281      1.14    cegger 			    "error = %d\n", i, error);
    282       1.1   thorpej 			goto fail_8;
    283       1.1   thorpej 		}
    284       1.1   thorpej 	}
    285       1.1   thorpej 
    286       1.1   thorpej 	return (0);
    287       1.1   thorpej 
    288       1.1   thorpej  fail_8:
    289       1.1   thorpej 	for (--i; i >= 0; i--) {
    290       1.1   thorpej 		request_t *req = &mpt->request_pool[i];
    291       1.3   thorpej 		if (req->dmap != NULL)
    292       1.3   thorpej 			bus_dmamap_destroy(mpt->sc_dmat, req->dmap);
    293       1.1   thorpej 	}
    294       1.1   thorpej 	bus_dmamap_unload(mpt->sc_dmat, mpt->request_dmap);
    295       1.1   thorpej  fail_7:
    296       1.1   thorpej 	bus_dmamap_destroy(mpt->sc_dmat, mpt->request_dmap);
    297       1.1   thorpej  fail_6:
    298      1.11  christos 	bus_dmamem_unmap(mpt->sc_dmat, (void *)mpt->request, PAGE_SIZE);
    299       1.1   thorpej  fail_5:
    300       1.1   thorpej 	bus_dmamem_free(mpt->sc_dmat, &request_seg, request_rseg);
    301       1.1   thorpej  fail_4:
    302       1.1   thorpej 	bus_dmamap_unload(mpt->sc_dmat, mpt->reply_dmap);
    303       1.1   thorpej  fail_3:
    304       1.1   thorpej 	bus_dmamap_destroy(mpt->sc_dmat, mpt->reply_dmap);
    305       1.1   thorpej  fail_2:
    306      1.11  christos 	bus_dmamem_unmap(mpt->sc_dmat, (void *)mpt->reply, PAGE_SIZE);
    307       1.1   thorpej  fail_1:
    308       1.1   thorpej 	bus_dmamem_free(mpt->sc_dmat, &reply_seg, reply_rseg);
    309       1.1   thorpej  fail_0:
    310       1.1   thorpej 	free(mpt->request_pool, M_DEVBUF);
    311       1.1   thorpej 
    312       1.1   thorpej 	mpt->reply = NULL;
    313       1.1   thorpej 	mpt->request = NULL;
    314       1.1   thorpej 	mpt->request_pool = NULL;
    315       1.1   thorpej 
    316       1.1   thorpej 	return (error);
    317       1.1   thorpej }
    318       1.1   thorpej 
    319       1.1   thorpej int
    320       1.1   thorpej mpt_intr(void *arg)
    321       1.1   thorpej {
    322       1.1   thorpej 	mpt_softc_t *mpt = arg;
    323       1.1   thorpej 	int nrepl = 0;
    324       1.1   thorpej 	uint32_t reply;
    325       1.1   thorpej 
    326       1.1   thorpej 	if ((mpt_read(mpt, MPT_OFFSET_INTR_STATUS) & MPT_INTR_REPLY_READY) == 0)
    327       1.1   thorpej 		return (0);
    328       1.1   thorpej 
    329       1.1   thorpej 	reply = mpt_pop_reply_queue(mpt);
    330       1.1   thorpej 	while (reply != MPT_REPLY_EMPTY) {
    331       1.1   thorpej 		nrepl++;
    332       1.1   thorpej 		if (mpt->verbose > 1) {
    333       1.1   thorpej 			if ((reply & MPT_CONTEXT_REPLY) != 0) {
    334       1.1   thorpej 				/* Address reply; IOC has something to say */
    335       1.1   thorpej 				mpt_print_reply(MPT_REPLY_PTOV(mpt, reply));
    336       1.1   thorpej 			} else {
    337       1.1   thorpej 				/* Context reply; all went well */
    338       1.1   thorpej 				mpt_prt(mpt, "context %u reply OK", reply);
    339       1.1   thorpej 			}
    340       1.1   thorpej 		}
    341       1.1   thorpej 		mpt_done(mpt, reply);
    342       1.1   thorpej 		reply = mpt_pop_reply_queue(mpt);
    343       1.1   thorpej 	}
    344       1.1   thorpej 	return (nrepl != 0);
    345       1.1   thorpej }
    346       1.1   thorpej 
    347       1.1   thorpej void
    348       1.1   thorpej mpt_prt(mpt_softc_t *mpt, const char *fmt, ...)
    349       1.1   thorpej {
    350       1.1   thorpej 	va_list ap;
    351       1.1   thorpej 
    352      1.14    cegger 	printf("%s: ", device_xname(&mpt->sc_dev));
    353       1.1   thorpej 	va_start(ap, fmt);
    354       1.1   thorpej 	vprintf(fmt, ap);
    355       1.1   thorpej 	va_end(ap);
    356       1.1   thorpej 	printf("\n");
    357       1.1   thorpej }
    358       1.1   thorpej 
    359       1.1   thorpej static int
    360       1.1   thorpej mpt_poll(mpt_softc_t *mpt, struct scsipi_xfer *xs, int count)
    361       1.1   thorpej {
    362       1.1   thorpej 
    363       1.1   thorpej 	/* Timeouts are in msec, so we loop in 1000usec cycles */
    364       1.1   thorpej 	while (count) {
    365       1.1   thorpej 		mpt_intr(mpt);
    366       1.1   thorpej 		if (xs->xs_status & XS_STS_DONE)
    367       1.1   thorpej 			return (0);
    368       1.1   thorpej 		delay(1000);		/* only happens in boot, so ok */
    369       1.1   thorpej 		count--;
    370       1.1   thorpej 	}
    371       1.1   thorpej 	return (1);
    372       1.1   thorpej }
    373       1.1   thorpej 
    374       1.1   thorpej static void
    375       1.1   thorpej mpt_timeout(void *arg)
    376       1.1   thorpej {
    377       1.1   thorpej 	request_t *req = arg;
    378       1.1   thorpej 	struct scsipi_xfer *xs = req->xfer;
    379       1.1   thorpej 	struct scsipi_periph *periph = xs->xs_periph;
    380       1.9     perry 	mpt_softc_t *mpt =
    381       1.1   thorpej 	    (void *) periph->periph_channel->chan_adapter->adapt_dev;
    382       1.1   thorpej 	uint32_t oseq;
    383       1.1   thorpej 	int s;
    384       1.1   thorpej 
    385       1.1   thorpej 	scsipi_printaddr(periph);
    386       1.1   thorpej 	printf("command timeout\n");
    387       1.1   thorpej 
    388       1.1   thorpej 	s = splbio();
    389       1.1   thorpej 
    390       1.1   thorpej 	oseq = req->sequence;
    391       1.1   thorpej 	mpt->timeouts++;
    392       1.1   thorpej 	if (mpt_intr(mpt)) {
    393       1.1   thorpej 		if (req->sequence != oseq) {
    394       1.1   thorpej 			mpt_prt(mpt, "recovered from command timeout");
    395       1.1   thorpej 			splx(s);
    396       1.1   thorpej 			return;
    397       1.1   thorpej 		}
    398       1.1   thorpej 	}
    399       1.1   thorpej 	mpt_prt(mpt,
    400       1.1   thorpej 	    "timeout on request index = 0x%x, seq = 0x%08x",
    401       1.1   thorpej 	    req->index, req->sequence);
    402       1.1   thorpej 	mpt_check_doorbell(mpt);
    403       1.1   thorpej 	mpt_prt(mpt, "Status 0x%08x, Mask 0x%08x, Doorbell 0x%08x",
    404       1.1   thorpej 	    mpt_read(mpt, MPT_OFFSET_INTR_STATUS),
    405       1.1   thorpej 	    mpt_read(mpt, MPT_OFFSET_INTR_MASK),
    406       1.1   thorpej 	    mpt_read(mpt, MPT_OFFSET_DOORBELL));
    407       1.1   thorpej 	mpt_prt(mpt, "request state: %s", mpt_req_state(req->debug));
    408       1.1   thorpej 	if (mpt->verbose > 1)
    409       1.1   thorpej 		mpt_print_scsi_io_request((MSG_SCSI_IO_REQUEST *)req->req_vbuf);
    410       1.1   thorpej 
    411       1.1   thorpej 	/* XXX WHAT IF THE IOC IS STILL USING IT?? */
    412       1.1   thorpej 	req->xfer = NULL;
    413       1.1   thorpej 	mpt_free_request(mpt, req);
    414       1.1   thorpej 
    415       1.6   thorpej 	xs->error = XS_TIMEOUT;
    416       1.6   thorpej 	scsipi_done(xs);
    417       1.6   thorpej 
    418       1.1   thorpej 	splx(s);
    419       1.1   thorpej }
    420       1.1   thorpej 
    421       1.1   thorpej static void
    422       1.1   thorpej mpt_done(mpt_softc_t *mpt, uint32_t reply)
    423       1.1   thorpej {
    424       1.6   thorpej 	struct scsipi_xfer *xs = NULL;
    425       1.1   thorpej 	struct scsipi_periph *periph;
    426       1.1   thorpej 	int index;
    427       1.1   thorpej 	request_t *req;
    428       1.1   thorpej 	MSG_REQUEST_HEADER *mpt_req;
    429       1.1   thorpej 	MSG_SCSI_IO_REPLY *mpt_reply;
    430       1.1   thorpej 
    431       1.1   thorpej 	if (__predict_true((reply & MPT_CONTEXT_REPLY) == 0)) {
    432       1.1   thorpej 		/* context reply (ok) */
    433       1.1   thorpej 		mpt_reply = NULL;
    434       1.1   thorpej 		index = reply & MPT_CONTEXT_MASK;
    435       1.1   thorpej 	} else {
    436       1.1   thorpej 		/* address reply (error) */
    437       1.1   thorpej 
    438       1.1   thorpej 		/* XXX BUS_DMASYNC_POSTREAD XXX */
    439       1.1   thorpej 		mpt_reply = MPT_REPLY_PTOV(mpt, reply);
    440       1.1   thorpej 		if (mpt->verbose > 1) {
    441       1.1   thorpej 			uint32_t *pReply = (uint32_t *) mpt_reply;
    442       1.9     perry 
    443       1.1   thorpej 			mpt_prt(mpt, "Address Reply (index %u):",
    444      1.15       chs 			    le32toh(mpt_reply->MsgContext) & 0xffff);
    445       1.1   thorpej 			mpt_prt(mpt, "%08x %08x %08x %08x",
    446       1.1   thorpej 			    pReply[0], pReply[1], pReply[2], pReply[3]);
    447       1.1   thorpej 			mpt_prt(mpt, "%08x %08x %08x %08x",
    448       1.1   thorpej 			    pReply[4], pReply[5], pReply[6], pReply[7]);
    449       1.1   thorpej 			mpt_prt(mpt, "%08x %08x %08x %08x",
    450       1.1   thorpej 			    pReply[8], pReply[9], pReply[10], pReply[11]);
    451       1.1   thorpej 		}
    452      1.15       chs 		index = le32toh(mpt_reply->MsgContext);
    453       1.1   thorpej 	}
    454       1.1   thorpej 
    455       1.1   thorpej 	/*
    456       1.1   thorpej 	 * Address reply with MessageContext high bit set.
    457       1.1   thorpej 	 * This is most likely a notify message, so we try
    458       1.1   thorpej 	 * to process it, then free it.
    459       1.1   thorpej 	 */
    460       1.1   thorpej 	if (__predict_false((index & 0x80000000) != 0)) {
    461       1.1   thorpej 		if (mpt_reply != NULL)
    462       1.1   thorpej 			mpt_ctlop(mpt, mpt_reply, reply);
    463       1.1   thorpej 		else
    464       1.1   thorpej 			mpt_prt(mpt, "mpt_done: index 0x%x, NULL reply", index);
    465       1.1   thorpej 		return;
    466       1.1   thorpej 	}
    467       1.1   thorpej 
    468       1.1   thorpej 	/* Did we end up with a valid index into the table? */
    469       1.1   thorpej 	if (__predict_false(index < 0 || index >= MPT_MAX_REQUESTS(mpt))) {
    470       1.1   thorpej 		mpt_prt(mpt, "mpt_done: invalid index (0x%x) in reply", index);
    471       1.1   thorpej 		return;
    472       1.1   thorpej 	}
    473       1.1   thorpej 
    474       1.1   thorpej 	req = &mpt->request_pool[index];
    475       1.1   thorpej 
    476       1.1   thorpej 	/* Make sure memory hasn't been trashed. */
    477       1.1   thorpej 	if (__predict_false(req->index != index)) {
    478       1.1   thorpej 		mpt_prt(mpt, "mpt_done: corrupted request_t (0x%x)", index);
    479       1.1   thorpej 		return;
    480       1.1   thorpej 	}
    481       1.1   thorpej 
    482       1.2   thorpej 	MPT_SYNC_REQ(mpt, req, BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
    483       1.1   thorpej 	mpt_req = req->req_vbuf;
    484       1.1   thorpej 
    485       1.1   thorpej 	/* Short cut for task management replies; nothing more for us to do. */
    486       1.1   thorpej 	if (__predict_false(mpt_req->Function == MPI_FUNCTION_SCSI_TASK_MGMT)) {
    487       1.1   thorpej 		if (mpt->verbose > 1)
    488       1.1   thorpej 			mpt_prt(mpt, "mpt_done: TASK MGMT");
    489       1.1   thorpej 		goto done;
    490       1.1   thorpej 	}
    491       1.1   thorpej 
    492       1.1   thorpej 	if (__predict_false(mpt_req->Function == MPI_FUNCTION_PORT_ENABLE))
    493       1.1   thorpej 		goto done;
    494       1.1   thorpej 
    495       1.1   thorpej 	/*
    496       1.1   thorpej 	 * At this point, it had better be a SCSI I/O command, but don't
    497       1.1   thorpej 	 * crash if it isn't.
    498       1.1   thorpej 	 */
    499       1.1   thorpej 	if (__predict_false(mpt_req->Function !=
    500       1.1   thorpej 			    MPI_FUNCTION_SCSI_IO_REQUEST)) {
    501       1.1   thorpej 		if (mpt->verbose > 1)
    502       1.1   thorpej 			mpt_prt(mpt, "mpt_done: unknown Function 0x%x (0x%x)",
    503       1.1   thorpej 			    mpt_req->Function, index);
    504       1.1   thorpej 		goto done;
    505       1.1   thorpej 	}
    506       1.1   thorpej 
    507       1.1   thorpej 	/* Recover scsipi_xfer from the request structure. */
    508       1.1   thorpej 	xs = req->xfer;
    509       1.1   thorpej 
    510       1.1   thorpej 	/* Can't have a SCSI command without a scsipi_xfer. */
    511       1.1   thorpej 	if (__predict_false(xs == NULL)) {
    512       1.1   thorpej 		mpt_prt(mpt,
    513       1.1   thorpej 		    "mpt_done: no scsipi_xfer, index = 0x%x, seq = 0x%08x",
    514       1.1   thorpej 		    req->index, req->sequence);
    515       1.1   thorpej 		mpt_prt(mpt, "request state: %s", mpt_req_state(req->debug));
    516       1.1   thorpej 		mpt_prt(mpt, "mpt_request:");
    517       1.1   thorpej 		mpt_print_scsi_io_request((MSG_SCSI_IO_REQUEST *)req->req_vbuf);
    518       1.1   thorpej 
    519       1.1   thorpej 		if (mpt_reply != NULL) {
    520       1.1   thorpej 			mpt_prt(mpt, "mpt_reply:");
    521       1.1   thorpej 			mpt_print_reply(mpt_reply);
    522       1.1   thorpej 		} else {
    523       1.1   thorpej 			mpt_prt(mpt, "context reply: 0x%08x", reply);
    524       1.1   thorpej 		}
    525       1.1   thorpej 		goto done;
    526       1.1   thorpej 	}
    527       1.1   thorpej 
    528       1.1   thorpej 	callout_stop(&xs->xs_callout);
    529       1.1   thorpej 
    530       1.1   thorpej 	periph = xs->xs_periph;
    531       1.1   thorpej 
    532       1.1   thorpej 	/*
    533       1.1   thorpej 	 * If we were a data transfer, unload the map that described
    534       1.1   thorpej 	 * the data buffer.
    535       1.1   thorpej 	 */
    536       1.1   thorpej 	if (__predict_true(xs->datalen != 0)) {
    537       1.1   thorpej 		bus_dmamap_sync(mpt->sc_dmat, req->dmap, 0,
    538       1.1   thorpej 		    req->dmap->dm_mapsize,
    539       1.1   thorpej 		    (xs->xs_control & XS_CTL_DATA_IN) ? BUS_DMASYNC_POSTREAD
    540       1.1   thorpej 						      : BUS_DMASYNC_POSTWRITE);
    541       1.1   thorpej 		bus_dmamap_unload(mpt->sc_dmat, req->dmap);
    542       1.1   thorpej 	}
    543       1.1   thorpej 
    544       1.1   thorpej 	if (__predict_true(mpt_reply == NULL)) {
    545       1.1   thorpej 		/*
    546       1.1   thorpej 		 * Context reply; report that the command was
    547       1.1   thorpej 		 * successful!
    548       1.1   thorpej 		 *
    549       1.1   thorpej 		 * Also report the xfer mode, if necessary.
    550       1.1   thorpej 		 */
    551       1.1   thorpej 		if (__predict_false(mpt->mpt_report_xfer_mode != 0)) {
    552       1.1   thorpej 			if ((mpt->mpt_report_xfer_mode &
    553       1.1   thorpej 			     (1 << periph->periph_target)) != 0)
    554       1.1   thorpej 				mpt_get_xfer_mode(mpt, periph);
    555       1.1   thorpej 		}
    556       1.1   thorpej 		xs->error = XS_NOERROR;
    557       1.1   thorpej 		xs->status = SCSI_OK;
    558       1.1   thorpej 		xs->resid = 0;
    559       1.6   thorpej 		mpt_free_request(mpt, req);
    560       1.1   thorpej 		scsipi_done(xs);
    561       1.6   thorpej 		return;
    562       1.1   thorpej 	}
    563       1.1   thorpej 
    564       1.1   thorpej 	xs->status = mpt_reply->SCSIStatus;
    565      1.15       chs 	switch (le16toh(mpt_reply->IOCStatus)) {
    566       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_DATA_OVERRUN:
    567       1.1   thorpej 		xs->error = XS_DRIVER_STUFFUP;
    568       1.1   thorpej 		break;
    569       1.1   thorpej 
    570       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_DATA_UNDERRUN:
    571       1.1   thorpej 		/*
    572       1.1   thorpej 		 * Yikes!  Tagged queue full comes through this path!
    573       1.1   thorpej 		 *
    574       1.1   thorpej 		 * So we'll change it to a status error and anything
    575       1.1   thorpej 		 * that returns status should probably be a status
    576       1.1   thorpej 		 * error as well.
    577       1.1   thorpej 		 */
    578      1.15       chs 		xs->resid = xs->datalen - le32toh(mpt_reply->TransferCount);
    579       1.1   thorpej 		if (mpt_reply->SCSIState &
    580       1.1   thorpej 		    MPI_SCSI_STATE_NO_SCSI_STATUS) {
    581       1.1   thorpej 			xs->error = XS_DRIVER_STUFFUP;
    582       1.1   thorpej 			break;
    583       1.1   thorpej 		}
    584       1.1   thorpej 		/* FALLTHROUGH */
    585       1.1   thorpej 	case MPI_IOCSTATUS_SUCCESS:
    586       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_RECOVERED_ERROR:
    587       1.1   thorpej 		switch (xs->status) {
    588       1.1   thorpej 		case SCSI_OK:
    589       1.1   thorpej 			/* Report the xfer mode, if necessary. */
    590       1.1   thorpej 			if ((mpt->mpt_report_xfer_mode &
    591       1.1   thorpej 			     (1 << periph->periph_target)) != 0)
    592       1.1   thorpej 				mpt_get_xfer_mode(mpt, periph);
    593       1.1   thorpej 			xs->resid = 0;
    594       1.1   thorpej 			break;
    595       1.1   thorpej 
    596       1.1   thorpej 		case SCSI_CHECK:
    597       1.1   thorpej 			xs->error = XS_SENSE;
    598       1.1   thorpej 			break;
    599       1.1   thorpej 
    600       1.1   thorpej 		case SCSI_BUSY:
    601       1.1   thorpej 		case SCSI_QUEUE_FULL:
    602       1.1   thorpej 			xs->error = XS_BUSY;
    603       1.1   thorpej 			break;
    604       1.1   thorpej 
    605       1.1   thorpej 		default:
    606       1.1   thorpej 			scsipi_printaddr(periph);
    607       1.1   thorpej 			printf("invalid status code %d\n", xs->status);
    608       1.1   thorpej 			xs->error = XS_DRIVER_STUFFUP;
    609       1.1   thorpej 			break;
    610       1.1   thorpej 		}
    611       1.1   thorpej 		break;
    612       1.1   thorpej 
    613       1.1   thorpej 	case MPI_IOCSTATUS_BUSY:
    614       1.1   thorpej 	case MPI_IOCSTATUS_INSUFFICIENT_RESOURCES:
    615       1.1   thorpej 		xs->error = XS_RESOURCE_SHORTAGE;
    616       1.1   thorpej 		break;
    617       1.1   thorpej 
    618       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_INVALID_BUS:
    619       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_INVALID_TARGETID:
    620       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
    621       1.1   thorpej 		xs->error = XS_SELTIMEOUT;
    622       1.1   thorpej 		break;
    623       1.1   thorpej 
    624       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
    625       1.1   thorpej 		xs->error = XS_DRIVER_STUFFUP;
    626       1.1   thorpej 		break;
    627       1.1   thorpej 
    628       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_TASK_TERMINATED:
    629       1.1   thorpej 		/* XXX What should we do here? */
    630       1.1   thorpej 		break;
    631       1.1   thorpej 
    632       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
    633       1.1   thorpej 		/* XXX */
    634       1.1   thorpej 		xs->error = XS_DRIVER_STUFFUP;
    635       1.1   thorpej 		break;
    636       1.1   thorpej 
    637       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_IOC_TERMINATED:
    638       1.1   thorpej 		/* XXX */
    639       1.1   thorpej 		xs->error = XS_DRIVER_STUFFUP;
    640       1.1   thorpej 		break;
    641       1.1   thorpej 
    642       1.1   thorpej 	case MPI_IOCSTATUS_SCSI_EXT_TERMINATED:
    643       1.1   thorpej 		/* XXX This is a bus-reset */
    644       1.1   thorpej 		xs->error = XS_DRIVER_STUFFUP;
    645       1.1   thorpej 		break;
    646       1.1   thorpej 
    647       1.1   thorpej 	default:
    648       1.1   thorpej 		/* XXX unrecognized HBA error */
    649       1.1   thorpej 		xs->error = XS_DRIVER_STUFFUP;
    650       1.1   thorpej 		break;
    651       1.1   thorpej 	}
    652       1.9     perry 
    653       1.1   thorpej 	if (mpt_reply->SCSIState & MPI_SCSI_STATE_AUTOSENSE_VALID) {
    654       1.1   thorpej 		memcpy(&xs->sense.scsi_sense, req->sense_vbuf,
    655       1.1   thorpej 		    sizeof(xs->sense.scsi_sense));
    656       1.1   thorpej 	} else if (mpt_reply->SCSIState & MPI_SCSI_STATE_AUTOSENSE_FAILED) {
    657       1.1   thorpej 		/*
    658       1.1   thorpej 		 * This will cause the scsipi layer to issue
    659       1.1   thorpej 		 * a REQUEST SENSE.
    660       1.1   thorpej 		 */
    661       1.1   thorpej 		if (xs->status == SCSI_CHECK)
    662       1.1   thorpej 			xs->error = XS_BUSY;
    663       1.1   thorpej 	}
    664       1.1   thorpej 
    665       1.1   thorpej  done:
    666       1.1   thorpej 	/* If IOC done with this requeset, free it up. */
    667       1.1   thorpej 	if (mpt_reply == NULL || (mpt_reply->MsgFlags & 0x80) == 0)
    668       1.1   thorpej 		mpt_free_request(mpt, req);
    669       1.1   thorpej 
    670       1.1   thorpej 	/* If address reply, give the buffer back to the IOC. */
    671       1.1   thorpej 	if (mpt_reply != NULL)
    672       1.1   thorpej 		mpt_free_reply(mpt, (reply << 1));
    673       1.6   thorpej 
    674       1.6   thorpej 	if (xs != NULL)
    675       1.6   thorpej 		scsipi_done(xs);
    676       1.1   thorpej }
    677       1.1   thorpej 
    678       1.1   thorpej static void
    679       1.1   thorpej mpt_run_xfer(mpt_softc_t *mpt, struct scsipi_xfer *xs)
    680       1.1   thorpej {
    681       1.1   thorpej 	struct scsipi_periph *periph = xs->xs_periph;
    682       1.1   thorpej 	request_t *req;
    683       1.1   thorpej 	MSG_SCSI_IO_REQUEST *mpt_req;
    684       1.1   thorpej 	int error, s;
    685       1.1   thorpej 
    686       1.1   thorpej 	s = splbio();
    687       1.1   thorpej 	req = mpt_get_request(mpt);
    688       1.1   thorpej 	if (__predict_false(req == NULL)) {
    689       1.1   thorpej 		/* This should happen very infrequently. */
    690       1.1   thorpej 		xs->error = XS_RESOURCE_SHORTAGE;
    691       1.1   thorpej 		scsipi_done(xs);
    692       1.1   thorpej 		splx(s);
    693       1.1   thorpej 		return;
    694       1.1   thorpej 	}
    695       1.1   thorpej 	splx(s);
    696       1.1   thorpej 
    697       1.1   thorpej 	/* Link the req and the scsipi_xfer. */
    698       1.1   thorpej 	req->xfer = xs;
    699       1.1   thorpej 
    700       1.1   thorpej 	/* Now we build the command for the IOC */
    701       1.1   thorpej 	mpt_req = req->req_vbuf;
    702       1.1   thorpej 	memset(mpt_req, 0, sizeof(*mpt_req));
    703       1.1   thorpej 
    704       1.1   thorpej 	mpt_req->Function = MPI_FUNCTION_SCSI_IO_REQUEST;
    705       1.1   thorpej 	mpt_req->Bus = mpt->bus;
    706       1.1   thorpej 
    707       1.1   thorpej 	mpt_req->SenseBufferLength =
    708       1.1   thorpej 	    (sizeof(xs->sense.scsi_sense) < MPT_SENSE_SIZE) ?
    709       1.1   thorpej 	    sizeof(xs->sense.scsi_sense) : MPT_SENSE_SIZE;
    710       1.1   thorpej 
    711       1.1   thorpej 	/*
    712       1.1   thorpej 	 * We use the message context to find the request structure when
    713       1.1   thorpej 	 * we get the command completion interrupt from the IOC.
    714       1.1   thorpej 	 */
    715      1.15       chs 	mpt_req->MsgContext = htole32(req->index);
    716       1.1   thorpej 
    717       1.1   thorpej 	/* Which physical device to do the I/O on. */
    718       1.1   thorpej 	mpt_req->TargetID = periph->periph_target;
    719       1.1   thorpej 	mpt_req->LUN[1] = periph->periph_lun;
    720       1.1   thorpej 
    721       1.1   thorpej 	/* Set the direction of the transfer. */
    722       1.1   thorpej 	if (xs->xs_control & XS_CTL_DATA_IN)
    723       1.1   thorpej 		mpt_req->Control = MPI_SCSIIO_CONTROL_READ;
    724       1.1   thorpej 	else if (xs->xs_control & XS_CTL_DATA_OUT)
    725       1.1   thorpej 		mpt_req->Control = MPI_SCSIIO_CONTROL_WRITE;
    726       1.1   thorpej 	else
    727       1.1   thorpej 		mpt_req->Control = MPI_SCSIIO_CONTROL_NODATATRANSFER;
    728       1.1   thorpej 
    729       1.1   thorpej 	/* Set the queue behavior. */
    730      1.12      tron 	if (__predict_true((!mpt->is_scsi) ||
    731       1.1   thorpej 			   (mpt->mpt_tag_enable &
    732       1.1   thorpej 			    (1 << periph->periph_target)))) {
    733       1.1   thorpej 		switch (XS_CTL_TAGTYPE(xs)) {
    734       1.1   thorpej 		case XS_CTL_HEAD_TAG:
    735       1.1   thorpej 			mpt_req->Control |= MPI_SCSIIO_CONTROL_HEADOFQ;
    736       1.1   thorpej 			break;
    737       1.1   thorpej 
    738       1.1   thorpej #if 0	/* XXX */
    739       1.1   thorpej 		case XS_CTL_ACA_TAG:
    740       1.1   thorpej 			mpt_req->Control |= MPI_SCSIIO_CONTROL_ACAQ;
    741       1.1   thorpej 			break;
    742       1.1   thorpej #endif
    743       1.1   thorpej 
    744       1.1   thorpej 		case XS_CTL_ORDERED_TAG:
    745       1.1   thorpej 			mpt_req->Control |= MPI_SCSIIO_CONTROL_ORDEREDQ;
    746       1.1   thorpej 			break;
    747       1.1   thorpej 
    748       1.1   thorpej 		case XS_CTL_SIMPLE_TAG:
    749       1.1   thorpej 			mpt_req->Control |= MPI_SCSIIO_CONTROL_SIMPLEQ;
    750       1.1   thorpej 			break;
    751       1.1   thorpej 
    752       1.1   thorpej 		default:
    753      1.12      tron 			if (mpt->is_scsi)
    754      1.12      tron 				mpt_req->Control |= MPI_SCSIIO_CONTROL_UNTAGGED;
    755      1.12      tron 			else
    756       1.1   thorpej 				mpt_req->Control |= MPI_SCSIIO_CONTROL_SIMPLEQ;
    757       1.1   thorpej 			break;
    758       1.1   thorpej 		}
    759       1.1   thorpej 	} else
    760       1.1   thorpej 		mpt_req->Control |= MPI_SCSIIO_CONTROL_UNTAGGED;
    761       1.1   thorpej 
    762      1.12      tron 	if (__predict_false(mpt->is_scsi &&
    763       1.1   thorpej 			    (mpt->mpt_disc_enable &
    764       1.1   thorpej 			     (1 << periph->periph_target)) == 0))
    765       1.1   thorpej 		mpt_req->Control |= MPI_SCSIIO_CONTROL_NO_DISCONNECT;
    766       1.1   thorpej 
    767      1.15       chs 	mpt_req->Control = htole32(mpt_req->Control);
    768      1.15       chs 
    769       1.1   thorpej 	/* Copy the SCSI command block into place. */
    770       1.1   thorpej 	memcpy(mpt_req->CDB, xs->cmd, xs->cmdlen);
    771       1.1   thorpej 
    772       1.1   thorpej 	mpt_req->CDBLength = xs->cmdlen;
    773      1.15       chs 	mpt_req->DataLength = htole32(xs->datalen);
    774      1.15       chs 	mpt_req->SenseBufferLowAddr = htole32(req->sense_pbuf);
    775       1.1   thorpej 
    776       1.1   thorpej 	/*
    777       1.1   thorpej 	 * Map the DMA transfer.
    778       1.1   thorpej 	 */
    779       1.1   thorpej 	if (xs->datalen) {
    780       1.1   thorpej 		SGE_SIMPLE32 *se;
    781       1.1   thorpej 
    782       1.1   thorpej 		error = bus_dmamap_load(mpt->sc_dmat, req->dmap, xs->data,
    783       1.1   thorpej 		    xs->datalen, NULL,
    784       1.1   thorpej 		    ((xs->xs_control & XS_CTL_NOSLEEP) ? BUS_DMA_NOWAIT
    785       1.1   thorpej 						       : BUS_DMA_WAITOK) |
    786       1.1   thorpej 		    BUS_DMA_STREAMING |
    787       1.1   thorpej 		    ((xs->xs_control & XS_CTL_DATA_IN) ? BUS_DMA_READ
    788       1.1   thorpej 						       : BUS_DMA_WRITE));
    789       1.1   thorpej 		switch (error) {
    790       1.1   thorpej 		case 0:
    791       1.1   thorpej 			break;
    792       1.1   thorpej 
    793       1.1   thorpej 		case ENOMEM:
    794       1.1   thorpej 		case EAGAIN:
    795       1.1   thorpej 			xs->error = XS_RESOURCE_SHORTAGE;
    796       1.1   thorpej 			goto out_bad;
    797       1.1   thorpej 
    798       1.1   thorpej 		default:
    799       1.1   thorpej 			xs->error = XS_DRIVER_STUFFUP;
    800       1.1   thorpej 			mpt_prt(mpt, "error %d loading DMA map", error);
    801       1.1   thorpej  out_bad:
    802       1.1   thorpej 			s = splbio();
    803       1.1   thorpej 			mpt_free_request(mpt, req);
    804       1.1   thorpej 			scsipi_done(xs);
    805       1.1   thorpej 			splx(s);
    806       1.1   thorpej 			return;
    807       1.1   thorpej 		}
    808       1.1   thorpej 
    809       1.1   thorpej 		if (req->dmap->dm_nsegs > MPT_NSGL_FIRST(mpt)) {
    810       1.1   thorpej 			int seg, i, nleft = req->dmap->dm_nsegs;
    811       1.1   thorpej 			uint32_t flags;
    812       1.1   thorpej 			SGE_CHAIN32 *ce;
    813       1.1   thorpej 
    814       1.1   thorpej 			seg = 0;
    815       1.1   thorpej 			flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT;
    816       1.1   thorpej 			if (xs->xs_control & XS_CTL_DATA_OUT)
    817       1.1   thorpej 				flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
    818       1.1   thorpej 
    819       1.1   thorpej 			se = (SGE_SIMPLE32 *) &mpt_req->SGL;
    820       1.1   thorpej 			for (i = 0; i < MPT_NSGL_FIRST(mpt) - 1;
    821       1.1   thorpej 			     i++, se++, seg++) {
    822       1.1   thorpej 				uint32_t tf;
    823       1.1   thorpej 
    824       1.1   thorpej 				memset(se, 0, sizeof(*se));
    825      1.15       chs 				se->Address =
    826      1.15       chs 				    htole32(req->dmap->dm_segs[seg].ds_addr);
    827       1.1   thorpej 				MPI_pSGE_SET_LENGTH(se,
    828       1.1   thorpej 				    req->dmap->dm_segs[seg].ds_len);
    829       1.1   thorpej 				tf = flags;
    830       1.1   thorpej 				if (i == MPT_NSGL_FIRST(mpt) - 2)
    831       1.1   thorpej 					tf |= MPI_SGE_FLAGS_LAST_ELEMENT;
    832       1.1   thorpej 				MPI_pSGE_SET_FLAGS(se, tf);
    833      1.15       chs 				se->FlagsLength = htole32(se->FlagsLength);
    834       1.1   thorpej 				nleft--;
    835       1.1   thorpej 			}
    836       1.1   thorpej 
    837       1.1   thorpej 			/*
    838       1.1   thorpej 			 * Tell the IOC where to find the first chain element.
    839       1.1   thorpej 			 */
    840       1.1   thorpej 			mpt_req->ChainOffset =
    841       1.1   thorpej 			    ((char *)se - (char *)mpt_req) >> 2;
    842       1.1   thorpej 
    843       1.1   thorpej 			/*
    844       1.1   thorpej 			 * Until we're finished with all segments...
    845       1.1   thorpej 			 */
    846       1.1   thorpej 			while (nleft) {
    847       1.1   thorpej 				int ntodo;
    848       1.1   thorpej 
    849       1.1   thorpej 				/*
    850       1.1   thorpej 				 * Construct the chain element that points to
    851       1.1   thorpej 				 * the next segment.
    852       1.1   thorpej 				 */
    853       1.1   thorpej 				ce = (SGE_CHAIN32 *) se++;
    854       1.1   thorpej 				if (nleft > MPT_NSGL(mpt)) {
    855       1.1   thorpej 					ntodo = MPT_NSGL(mpt) - 1;
    856       1.1   thorpej 					ce->NextChainOffset = (MPT_RQSL(mpt) -
    857       1.1   thorpej 					    sizeof(SGE_SIMPLE32)) >> 2;
    858      1.15       chs 					ce->Length = htole16(MPT_NSGL(mpt)
    859      1.15       chs 						* sizeof(SGE_SIMPLE32));
    860       1.1   thorpej 				} else {
    861       1.1   thorpej 					ntodo = nleft;
    862       1.1   thorpej 					ce->NextChainOffset = 0;
    863      1.15       chs 					ce->Length = htole16(ntodo
    864      1.15       chs 						* sizeof(SGE_SIMPLE32));
    865       1.1   thorpej 				}
    866      1.15       chs 				ce->Address = htole32(req->req_pbuf +
    867      1.15       chs 				    ((char *)se - (char *)mpt_req));
    868       1.1   thorpej 				ce->Flags = MPI_SGE_FLAGS_CHAIN_ELEMENT;
    869       1.1   thorpej 				for (i = 0; i < ntodo; i++, se++, seg++) {
    870       1.1   thorpej 					uint32_t tf;
    871       1.1   thorpej 
    872       1.1   thorpej 					memset(se, 0, sizeof(*se));
    873      1.15       chs 					se->Address = htole32(
    874      1.15       chs 					    req->dmap->dm_segs[seg].ds_addr);
    875       1.1   thorpej 					MPI_pSGE_SET_LENGTH(se,
    876       1.1   thorpej 					    req->dmap->dm_segs[seg].ds_len);
    877       1.1   thorpej 					tf = flags;
    878       1.1   thorpej 					if (i == ntodo - 1) {
    879       1.1   thorpej 						tf |=
    880       1.1   thorpej 						    MPI_SGE_FLAGS_LAST_ELEMENT;
    881       1.1   thorpej 						if (ce->NextChainOffset == 0) {
    882       1.1   thorpej 							tf |=
    883       1.1   thorpej 						    MPI_SGE_FLAGS_END_OF_LIST |
    884       1.1   thorpej 						    MPI_SGE_FLAGS_END_OF_BUFFER;
    885       1.1   thorpej 						}
    886       1.1   thorpej 					}
    887       1.1   thorpej 					MPI_pSGE_SET_FLAGS(se, tf);
    888      1.15       chs 					se->FlagsLength =
    889      1.15       chs 					    htole32(se->FlagsLength);
    890       1.1   thorpej 					nleft--;
    891       1.1   thorpej 				}
    892       1.1   thorpej 			}
    893       1.1   thorpej 			bus_dmamap_sync(mpt->sc_dmat, req->dmap, 0,
    894       1.1   thorpej 			    req->dmap->dm_mapsize,
    895       1.1   thorpej 			    (xs->xs_control & XS_CTL_DATA_IN) ?
    896       1.1   thorpej 			    				BUS_DMASYNC_PREREAD
    897       1.1   thorpej 						      : BUS_DMASYNC_PREWRITE);
    898       1.1   thorpej 		} else {
    899       1.1   thorpej 			int i;
    900       1.1   thorpej 			uint32_t flags;
    901       1.1   thorpej 
    902       1.1   thorpej 			flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT;
    903       1.1   thorpej 			if (xs->xs_control & XS_CTL_DATA_OUT)
    904       1.1   thorpej 				flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
    905       1.1   thorpej 
    906       1.1   thorpej 			/* Copy the segments into our SG list. */
    907       1.1   thorpej 			se = (SGE_SIMPLE32 *) &mpt_req->SGL;
    908       1.1   thorpej 			for (i = 0; i < req->dmap->dm_nsegs;
    909       1.1   thorpej 			     i++, se++) {
    910       1.1   thorpej 				uint32_t tf;
    911       1.1   thorpej 
    912       1.1   thorpej 				memset(se, 0, sizeof(*se));
    913      1.15       chs 				se->Address =
    914      1.15       chs 				    htole32(req->dmap->dm_segs[i].ds_addr);
    915       1.1   thorpej 				MPI_pSGE_SET_LENGTH(se,
    916       1.1   thorpej 				    req->dmap->dm_segs[i].ds_len);
    917       1.1   thorpej 				tf = flags;
    918       1.1   thorpej 				if (i == req->dmap->dm_nsegs - 1) {
    919       1.1   thorpej 					tf |=
    920       1.1   thorpej 					    MPI_SGE_FLAGS_LAST_ELEMENT |
    921       1.1   thorpej 					    MPI_SGE_FLAGS_END_OF_BUFFER |
    922       1.1   thorpej 					    MPI_SGE_FLAGS_END_OF_LIST;
    923       1.1   thorpej 				}
    924       1.1   thorpej 				MPI_pSGE_SET_FLAGS(se, tf);
    925      1.15       chs 				se->FlagsLength = htole32(se->FlagsLength);
    926       1.1   thorpej 			}
    927       1.1   thorpej 			bus_dmamap_sync(mpt->sc_dmat, req->dmap, 0,
    928       1.1   thorpej 			    req->dmap->dm_mapsize,
    929       1.1   thorpej 			    (xs->xs_control & XS_CTL_DATA_IN) ?
    930       1.1   thorpej 			    				BUS_DMASYNC_PREREAD
    931       1.1   thorpej 						      : BUS_DMASYNC_PREWRITE);
    932       1.1   thorpej 		}
    933       1.1   thorpej 	} else {
    934       1.1   thorpej 		/*
    935       1.1   thorpej 		 * No data to transfer; just make a single simple SGL
    936       1.1   thorpej 		 * with zero length.
    937       1.1   thorpej 		 */
    938       1.1   thorpej 		SGE_SIMPLE32 *se = (SGE_SIMPLE32 *) &mpt_req->SGL;
    939       1.1   thorpej 		memset(se, 0, sizeof(*se));
    940       1.1   thorpej 		MPI_pSGE_SET_FLAGS(se,
    941       1.1   thorpej 		    (MPI_SGE_FLAGS_LAST_ELEMENT | MPI_SGE_FLAGS_END_OF_BUFFER |
    942       1.1   thorpej 		     MPI_SGE_FLAGS_SIMPLE_ELEMENT | MPI_SGE_FLAGS_END_OF_LIST));
    943      1.15       chs 		se->FlagsLength = htole32(se->FlagsLength);
    944       1.1   thorpej 	}
    945       1.1   thorpej 
    946       1.1   thorpej 	if (mpt->verbose > 1)
    947       1.1   thorpej 		mpt_print_scsi_io_request(mpt_req);
    948       1.1   thorpej 
    949       1.1   thorpej 	s = splbio();
    950       1.1   thorpej 	if (__predict_true((xs->xs_control & XS_CTL_POLL) == 0))
    951       1.1   thorpej 		callout_reset(&xs->xs_callout,
    952       1.1   thorpej 		    mstohz(xs->timeout), mpt_timeout, req);
    953       1.1   thorpej 	mpt_send_cmd(mpt, req);
    954       1.1   thorpej 	splx(s);
    955       1.1   thorpej 
    956       1.1   thorpej 	if (__predict_true((xs->xs_control & XS_CTL_POLL) == 0))
    957       1.1   thorpej 		return;
    958       1.1   thorpej 
    959       1.1   thorpej 	/*
    960       1.1   thorpej 	 * If we can't use interrupts, poll on completion.
    961       1.1   thorpej 	 */
    962       1.4   thorpej 	if (mpt_poll(mpt, xs, xs->timeout))
    963       1.1   thorpej 		mpt_timeout(req);
    964       1.1   thorpej }
    965       1.1   thorpej 
    966       1.1   thorpej static void
    967       1.1   thorpej mpt_set_xfer_mode(mpt_softc_t *mpt, struct scsipi_xfer_mode *xm)
    968       1.1   thorpej {
    969       1.1   thorpej 	fCONFIG_PAGE_SCSI_DEVICE_1 tmp;
    970       1.1   thorpej 
    971       1.1   thorpej 	/*
    972       1.1   thorpej 	 * Always allow disconnect; we don't have a way to disable
    973       1.1   thorpej 	 * it right now, in any case.
    974       1.1   thorpej 	 */
    975       1.1   thorpej 	mpt->mpt_disc_enable |= (1 << xm->xm_target);
    976       1.1   thorpej 
    977       1.1   thorpej 	if (xm->xm_mode & PERIPH_CAP_TQING)
    978       1.1   thorpej 		mpt->mpt_tag_enable |= (1 << xm->xm_target);
    979       1.1   thorpej 	else
    980       1.1   thorpej 		mpt->mpt_tag_enable &= ~(1 << xm->xm_target);
    981       1.1   thorpej 
    982      1.17    mhitch 	if (mpt->is_scsi) {
    983      1.17    mhitch 		/*
    984      1.17    mhitch 		 * SCSI transport settings only make any sense for
    985      1.17    mhitch 		 * SCSI
    986      1.17    mhitch 		 */
    987      1.17    mhitch 
    988      1.17    mhitch 		tmp = mpt->mpt_dev_page1[xm->xm_target];
    989       1.1   thorpej 
    990      1.17    mhitch 		/*
    991      1.17    mhitch 		 * Set the wide/narrow parameter for the target.
    992      1.17    mhitch 		 */
    993      1.17    mhitch 		if (xm->xm_mode & PERIPH_CAP_WIDE16)
    994      1.17    mhitch 			tmp.RequestedParameters |= MPI_SCSIDEVPAGE1_RP_WIDE;
    995      1.17    mhitch 		else
    996      1.17    mhitch 			tmp.RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_WIDE;
    997       1.1   thorpej 
    998      1.17    mhitch 		/*
    999      1.17    mhitch 		 * Set the synchronous parameters for the target.
   1000      1.17    mhitch 		 *
   1001      1.17    mhitch 		 * XXX If we request sync transfers, we just go ahead and
   1002      1.17    mhitch 		 * XXX request the maximum available.  We need finer control
   1003      1.17    mhitch 		 * XXX in order to implement Domain Validation.
   1004      1.17    mhitch 		 */
   1005      1.17    mhitch 		tmp.RequestedParameters &= ~(MPI_SCSIDEVPAGE1_RP_MIN_SYNC_PERIOD_MASK |
   1006      1.17    mhitch 		    MPI_SCSIDEVPAGE1_RP_MAX_SYNC_OFFSET_MASK |
   1007      1.17    mhitch 		    MPI_SCSIDEVPAGE1_RP_DT | MPI_SCSIDEVPAGE1_RP_QAS |
   1008      1.17    mhitch 		    MPI_SCSIDEVPAGE1_RP_IU);
   1009      1.17    mhitch 		if (xm->xm_mode & PERIPH_CAP_SYNC) {
   1010      1.17    mhitch 			int factor, offset, np;
   1011      1.17    mhitch 
   1012      1.17    mhitch 			factor = (mpt->mpt_port_page0.Capabilities >> 8) & 0xff;
   1013      1.17    mhitch 			offset = (mpt->mpt_port_page0.Capabilities >> 16) & 0xff;
   1014      1.17    mhitch 			np = 0;
   1015      1.17    mhitch 			if (factor < 0x9) {
   1016      1.17    mhitch 				/* Ultra320 */
   1017      1.17    mhitch 				np |= MPI_SCSIDEVPAGE1_RP_QAS | MPI_SCSIDEVPAGE1_RP_IU;
   1018      1.17    mhitch 			}
   1019      1.17    mhitch 			if (factor < 0xa) {
   1020      1.17    mhitch 				/* at least Ultra160 */
   1021      1.17    mhitch 				np |= MPI_SCSIDEVPAGE1_RP_DT;
   1022      1.17    mhitch 			}
   1023      1.17    mhitch 			np |= (factor << 8) | (offset << 16);
   1024      1.17    mhitch 			tmp.RequestedParameters |= np;
   1025       1.1   thorpej 		}
   1026      1.17    mhitch 
   1027      1.17    mhitch 		host2mpt_config_page_scsi_device_1(&tmp);
   1028      1.17    mhitch 		if (mpt_write_cfg_page(mpt, xm->xm_target, &tmp.Header)) {
   1029      1.17    mhitch 			mpt_prt(mpt, "unable to write Device Page 1");
   1030      1.17    mhitch 			return;
   1031       1.1   thorpej 		}
   1032       1.1   thorpej 
   1033      1.17    mhitch 		if (mpt_read_cfg_page(mpt, xm->xm_target, &tmp.Header)) {
   1034      1.17    mhitch 			mpt_prt(mpt, "unable to read back Device Page 1");
   1035      1.17    mhitch 			return;
   1036      1.17    mhitch 		}
   1037       1.1   thorpej 
   1038      1.17    mhitch 		mpt2host_config_page_scsi_device_1(&tmp);
   1039      1.17    mhitch 		mpt->mpt_dev_page1[xm->xm_target] = tmp;
   1040      1.17    mhitch 		if (mpt->verbose > 1) {
   1041      1.17    mhitch 			mpt_prt(mpt,
   1042      1.17    mhitch 			    "SPI Target %d Page 1: RequestedParameters %x Config %x",
   1043      1.17    mhitch 			    xm->xm_target,
   1044      1.17    mhitch 			    mpt->mpt_dev_page1[xm->xm_target].RequestedParameters,
   1045      1.17    mhitch 			    mpt->mpt_dev_page1[xm->xm_target].Configuration);
   1046      1.17    mhitch 		}
   1047       1.1   thorpej 	}
   1048       1.1   thorpej 
   1049       1.1   thorpej 	/*
   1050       1.1   thorpej 	 * Make a note that we should perform an async callback at the
   1051       1.1   thorpej 	 * end of the next successful command completion to report the
   1052       1.1   thorpej 	 * negotiated transfer mode.
   1053       1.1   thorpej 	 */
   1054       1.1   thorpej 	mpt->mpt_report_xfer_mode |= (1 << xm->xm_target);
   1055       1.1   thorpej }
   1056       1.1   thorpej 
   1057       1.1   thorpej static void
   1058       1.1   thorpej mpt_get_xfer_mode(mpt_softc_t *mpt, struct scsipi_periph *periph)
   1059       1.1   thorpej {
   1060       1.1   thorpej 	fCONFIG_PAGE_SCSI_DEVICE_0 tmp;
   1061       1.1   thorpej 	struct scsipi_xfer_mode xm;
   1062       1.1   thorpej 	int period, offset;
   1063       1.1   thorpej 
   1064       1.1   thorpej 	tmp = mpt->mpt_dev_page0[periph->periph_target];
   1065      1.15       chs 	host2mpt_config_page_scsi_device_0(&tmp);
   1066       1.1   thorpej 	if (mpt_read_cfg_page(mpt, periph->periph_target, &tmp.Header)) {
   1067       1.1   thorpej 		mpt_prt(mpt, "unable to read Device Page 0");
   1068       1.1   thorpej 		return;
   1069       1.1   thorpej 	}
   1070      1.15       chs 	mpt2host_config_page_scsi_device_0(&tmp);
   1071       1.1   thorpej 
   1072       1.1   thorpej 	if (mpt->verbose > 1) {
   1073       1.1   thorpej 		mpt_prt(mpt,
   1074       1.1   thorpej 		    "SPI Tgt %d Page 0: NParms %x Information %x",
   1075       1.1   thorpej 		    periph->periph_target,
   1076       1.1   thorpej 		    tmp.NegotiatedParameters, tmp.Information);
   1077       1.1   thorpej 	}
   1078       1.1   thorpej 
   1079       1.1   thorpej 	xm.xm_target = periph->periph_target;
   1080       1.1   thorpej 	xm.xm_mode = 0;
   1081       1.1   thorpej 
   1082       1.1   thorpej 	if (tmp.NegotiatedParameters & MPI_SCSIDEVPAGE0_NP_WIDE)
   1083       1.1   thorpej 		xm.xm_mode |= PERIPH_CAP_WIDE16;
   1084       1.1   thorpej 
   1085       1.1   thorpej 	period = (tmp.NegotiatedParameters >> 8) & 0xff;
   1086       1.1   thorpej 	offset = (tmp.NegotiatedParameters >> 16) & 0xff;
   1087       1.1   thorpej 	if (offset) {
   1088       1.1   thorpej 		xm.xm_period = period;
   1089       1.1   thorpej 		xm.xm_offset = offset;
   1090       1.1   thorpej 		xm.xm_mode |= PERIPH_CAP_SYNC;
   1091       1.1   thorpej 	}
   1092       1.1   thorpej 
   1093       1.1   thorpej 	/*
   1094       1.1   thorpej 	 * Tagged queueing is all controlled by us; there is no
   1095       1.1   thorpej 	 * other setting to query.
   1096       1.1   thorpej 	 */
   1097       1.1   thorpej 	if (mpt->mpt_tag_enable & (1 << periph->periph_target))
   1098       1.1   thorpej 		xm.xm_mode |= PERIPH_CAP_TQING;
   1099       1.1   thorpej 
   1100       1.1   thorpej 	/*
   1101       1.1   thorpej 	 * We're going to deliver the async event, so clear the marker.
   1102       1.1   thorpej 	 */
   1103       1.1   thorpej 	mpt->mpt_report_xfer_mode &= ~(1 << periph->periph_target);
   1104       1.1   thorpej 
   1105       1.1   thorpej 	scsipi_async_event(&mpt->sc_channel, ASYNC_EVENT_XFER_MODE, &xm);
   1106       1.1   thorpej }
   1107       1.1   thorpej 
   1108       1.1   thorpej static void
   1109       1.1   thorpej mpt_ctlop(mpt_softc_t *mpt, void *vmsg, uint32_t reply)
   1110       1.1   thorpej {
   1111       1.1   thorpej 	MSG_DEFAULT_REPLY *dmsg = vmsg;
   1112       1.1   thorpej 
   1113       1.1   thorpej 	switch (dmsg->Function) {
   1114       1.1   thorpej 	case MPI_FUNCTION_EVENT_NOTIFICATION:
   1115       1.1   thorpej 		mpt_event_notify_reply(mpt, vmsg);
   1116       1.1   thorpej 		mpt_free_reply(mpt, (reply << 1));
   1117       1.1   thorpej 		break;
   1118       1.1   thorpej 
   1119       1.1   thorpej 	case MPI_FUNCTION_EVENT_ACK:
   1120       1.1   thorpej 		mpt_free_reply(mpt, (reply << 1));
   1121       1.1   thorpej 		break;
   1122       1.1   thorpej 
   1123       1.1   thorpej 	case MPI_FUNCTION_PORT_ENABLE:
   1124       1.1   thorpej 	    {
   1125       1.1   thorpej 		MSG_PORT_ENABLE_REPLY *msg = vmsg;
   1126      1.15       chs 		int index = le32toh(msg->MsgContext) & ~0x80000000;
   1127       1.1   thorpej 		if (mpt->verbose > 1)
   1128       1.1   thorpej 			mpt_prt(mpt, "enable port reply index %d", index);
   1129       1.1   thorpej 		if (index >= 0 && index < MPT_MAX_REQUESTS(mpt)) {
   1130       1.1   thorpej 			request_t *req = &mpt->request_pool[index];
   1131       1.1   thorpej 			req->debug = REQ_DONE;
   1132       1.1   thorpej 		}
   1133       1.1   thorpej 		mpt_free_reply(mpt, (reply << 1));
   1134       1.1   thorpej 		break;
   1135       1.1   thorpej 	    }
   1136       1.1   thorpej 
   1137       1.1   thorpej 	case MPI_FUNCTION_CONFIG:
   1138       1.1   thorpej 	    {
   1139       1.1   thorpej 		MSG_CONFIG_REPLY *msg = vmsg;
   1140      1.15       chs 		int index = le32toh(msg->MsgContext) & ~0x80000000;
   1141       1.1   thorpej 		if (index >= 0 && index < MPT_MAX_REQUESTS(mpt)) {
   1142       1.1   thorpej 			request_t *req = &mpt->request_pool[index];
   1143       1.1   thorpej 			req->debug = REQ_DONE;
   1144       1.1   thorpej 			req->sequence = reply;
   1145       1.1   thorpej 		} else
   1146       1.1   thorpej 			mpt_free_reply(mpt, (reply << 1));
   1147       1.1   thorpej 		break;
   1148       1.1   thorpej 	    }
   1149       1.1   thorpej 
   1150       1.1   thorpej 	default:
   1151       1.1   thorpej 		mpt_prt(mpt, "unknown ctlop: 0x%x", dmsg->Function);
   1152       1.1   thorpej 	}
   1153       1.1   thorpej }
   1154       1.1   thorpej 
   1155       1.1   thorpej static void
   1156       1.1   thorpej mpt_event_notify_reply(mpt_softc_t *mpt, MSG_EVENT_NOTIFY_REPLY *msg)
   1157       1.1   thorpej {
   1158       1.1   thorpej 
   1159      1.15       chs 	switch (le32toh(msg->Event)) {
   1160       1.1   thorpej 	case MPI_EVENT_LOG_DATA:
   1161       1.1   thorpej 	    {
   1162       1.1   thorpej 		int i;
   1163       1.1   thorpej 
   1164       1.1   thorpej 		/* Some error occurrerd that the Fusion wants logged. */
   1165       1.1   thorpej 		mpt_prt(mpt, "EvtLogData: IOCLogInfo: 0x%08x", msg->IOCLogInfo);
   1166       1.1   thorpej 		mpt_prt(mpt, "EvtLogData: Event Data:");
   1167       1.1   thorpej 		for (i = 0; i < msg->EventDataLength; i++) {
   1168       1.1   thorpej 			if ((i % 4) == 0)
   1169      1.14    cegger 				printf("%s:\t", device_xname(&mpt->sc_dev));
   1170       1.1   thorpej 			printf("0x%08x%c", msg->Data[i],
   1171       1.1   thorpej 			    ((i % 4) == 3) ? '\n' : ' ');
   1172       1.1   thorpej 		}
   1173       1.1   thorpej 		if ((i % 4) != 0)
   1174       1.1   thorpej 			printf("\n");
   1175       1.1   thorpej 		break;
   1176       1.1   thorpej 	    }
   1177       1.1   thorpej 
   1178       1.1   thorpej 	case MPI_EVENT_UNIT_ATTENTION:
   1179       1.1   thorpej 		mpt_prt(mpt, "Unit Attn: Bus 0x%02x Target 0x%02x",
   1180       1.1   thorpej 		    (msg->Data[0] >> 8) & 0xff, msg->Data[0] & 0xff);
   1181       1.1   thorpej 		break;
   1182       1.1   thorpej 
   1183       1.1   thorpej 	case MPI_EVENT_IOC_BUS_RESET:
   1184       1.1   thorpej 		/* We generated a bus reset. */
   1185       1.1   thorpej 		mpt_prt(mpt, "IOC Bus Reset Port %d",
   1186       1.1   thorpej 		    (msg->Data[0] >> 8) & 0xff);
   1187       1.1   thorpej 		break;
   1188       1.1   thorpej 
   1189       1.1   thorpej 	case MPI_EVENT_EXT_BUS_RESET:
   1190       1.1   thorpej 		/* Someone else generated a bus reset. */
   1191       1.1   thorpej 		mpt_prt(mpt, "External Bus Reset");
   1192       1.1   thorpej 		/*
   1193       1.1   thorpej 		 * These replies don't return EventData like the MPI
   1194       1.1   thorpej 		 * spec says they do.
   1195       1.1   thorpej 		 */
   1196       1.1   thorpej 		/* XXX Send an async event? */
   1197       1.1   thorpej 		break;
   1198       1.1   thorpej 
   1199       1.1   thorpej 	case MPI_EVENT_RESCAN:
   1200       1.1   thorpej 		/*
   1201       1.1   thorpej 		 * In general, thise means a device has been added
   1202       1.1   thorpej 		 * to the loop.
   1203       1.1   thorpej 		 */
   1204       1.1   thorpej 		mpt_prt(mpt, "Rescan Port %d", (msg->Data[0] >> 8) & 0xff);
   1205       1.1   thorpej 		/* XXX Send an async event? */
   1206       1.1   thorpej 		break;
   1207       1.1   thorpej 
   1208       1.1   thorpej 	case MPI_EVENT_LINK_STATUS_CHANGE:
   1209       1.1   thorpej 		mpt_prt(mpt, "Port %d: Link state %s",
   1210       1.1   thorpej 		    (msg->Data[1] >> 8) & 0xff,
   1211       1.1   thorpej 		    (msg->Data[0] & 0xff) == 0 ? "Failed" : "Active");
   1212       1.1   thorpej 		break;
   1213       1.1   thorpej 
   1214       1.1   thorpej 	case MPI_EVENT_LOOP_STATE_CHANGE:
   1215       1.1   thorpej 		switch ((msg->Data[0] >> 16) & 0xff) {
   1216       1.1   thorpej 		case 0x01:
   1217       1.1   thorpej 			mpt_prt(mpt,
   1218       1.1   thorpej 			    "Port %d: FC Link Event: LIP(%02x,%02x) "
   1219       1.1   thorpej 			    "(Loop Initialization)",
   1220       1.1   thorpej 			    (msg->Data[1] >> 8) & 0xff,
   1221       1.1   thorpej 			    (msg->Data[0] >> 8) & 0xff,
   1222       1.1   thorpej 			    (msg->Data[0]     ) & 0xff);
   1223       1.1   thorpej 			switch ((msg->Data[0] >> 8) & 0xff) {
   1224       1.1   thorpej 			case 0xf7:
   1225       1.1   thorpej 				if ((msg->Data[0] & 0xff) == 0xf7)
   1226       1.1   thorpej 					mpt_prt(mpt, "\tDevice needs AL_PA");
   1227       1.1   thorpej 				else
   1228       1.1   thorpej 					mpt_prt(mpt, "\tDevice %02x doesn't "
   1229       1.1   thorpej 					    "like FC performance",
   1230       1.1   thorpej 					    msg->Data[0] & 0xff);
   1231       1.1   thorpej 				break;
   1232       1.1   thorpej 
   1233       1.1   thorpej 			case 0xf8:
   1234       1.1   thorpej 				if ((msg->Data[0] & 0xff) == 0xf7)
   1235       1.1   thorpej 					mpt_prt(mpt, "\tDevice detected loop "
   1236       1.1   thorpej 					    "failure before acquiring AL_PA");
   1237       1.1   thorpej 				else
   1238       1.1   thorpej 					mpt_prt(mpt, "\tDevice %02x detected "
   1239       1.1   thorpej 					    "loop failure",
   1240       1.1   thorpej 					    msg->Data[0] & 0xff);
   1241       1.1   thorpej 				break;
   1242       1.1   thorpej 
   1243       1.1   thorpej 			default:
   1244       1.1   thorpej 				mpt_prt(mpt, "\tDevice %02x requests that "
   1245       1.1   thorpej 				    "device %02x reset itself",
   1246       1.1   thorpej 				    msg->Data[0] & 0xff,
   1247       1.1   thorpej 				    (msg->Data[0] >> 8) & 0xff);
   1248       1.1   thorpej 				break;
   1249       1.1   thorpej 			}
   1250       1.1   thorpej 			break;
   1251       1.1   thorpej 
   1252       1.1   thorpej 		case 0x02:
   1253       1.1   thorpej 			mpt_prt(mpt, "Port %d: FC Link Event: LPE(%02x,%02x) "
   1254       1.1   thorpej 			    "(Loop Port Enable)",
   1255       1.1   thorpej 			    (msg->Data[1] >> 8) & 0xff,
   1256       1.1   thorpej 			    (msg->Data[0] >> 8) & 0xff,
   1257       1.1   thorpej 			    (msg->Data[0]     ) & 0xff);
   1258       1.1   thorpej 			break;
   1259       1.1   thorpej 
   1260       1.1   thorpej 		case 0x03:
   1261       1.1   thorpej 			mpt_prt(mpt, "Port %d: FC Link Event: LPB(%02x,%02x) "
   1262       1.1   thorpej 			    "(Loop Port Bypass)",
   1263       1.1   thorpej 			    (msg->Data[1] >> 8) & 0xff,
   1264       1.1   thorpej 			    (msg->Data[0] >> 8) & 0xff,
   1265       1.1   thorpej 			    (msg->Data[0]     ) & 0xff);
   1266       1.1   thorpej 			break;
   1267       1.1   thorpej 
   1268       1.1   thorpej 		default:
   1269       1.1   thorpej 			mpt_prt(mpt, "Port %d: FC Link Event: "
   1270       1.1   thorpej 			    "Unknown event (%02x %02x %02x)",
   1271       1.1   thorpej 			    (msg->Data[1] >>  8) & 0xff,
   1272       1.1   thorpej 			    (msg->Data[0] >> 16) & 0xff,
   1273       1.1   thorpej 			    (msg->Data[0] >>  8) & 0xff,
   1274       1.1   thorpej 			    (msg->Data[0]      ) & 0xff);
   1275       1.1   thorpej 			break;
   1276       1.1   thorpej 		}
   1277       1.1   thorpej 		break;
   1278       1.1   thorpej 
   1279       1.1   thorpej 	case MPI_EVENT_LOGOUT:
   1280       1.1   thorpej 		mpt_prt(mpt, "Port %d: FC Logout: N_PortID: %02x",
   1281       1.1   thorpej 		    (msg->Data[1] >> 8) & 0xff, msg->Data[0]);
   1282       1.1   thorpej 		break;
   1283       1.1   thorpej 
   1284       1.1   thorpej 	case MPI_EVENT_EVENT_CHANGE:
   1285       1.1   thorpej 		/*
   1286       1.1   thorpej 		 * This is just an acknowledgement of our
   1287       1.1   thorpej 		 * mpt_send_event_request().
   1288       1.1   thorpej 		 */
   1289       1.1   thorpej 		break;
   1290       1.1   thorpej 
   1291      1.12      tron 	case MPI_EVENT_SAS_PHY_LINK_STATUS:
   1292      1.13      tron 		switch ((msg->Data[0] >> 12) & 0x0f) {
   1293      1.12      tron 		case 0x00:
   1294      1.12      tron 			mpt_prt(mpt, "Phy %d: Link Status Unknown",
   1295      1.12      tron 			    msg->Data[0] & 0xff);
   1296      1.12      tron 			break;
   1297      1.12      tron 		case 0x01:
   1298      1.12      tron 			mpt_prt(mpt, "Phy %d: Link Disabled",
   1299      1.12      tron 			    msg->Data[0] & 0xff);
   1300      1.12      tron 			break;
   1301      1.12      tron 		case 0x02:
   1302      1.12      tron 			mpt_prt(mpt, "Phy %d: Failed Speed Negotiation",
   1303      1.12      tron 			    msg->Data[0] & 0xff);
   1304      1.12      tron 			break;
   1305      1.12      tron 		case 0x03:
   1306      1.12      tron 			mpt_prt(mpt, "Phy %d: SATA OOB Complete",
   1307      1.12      tron 			    msg->Data[0] & 0xff);
   1308      1.12      tron 			break;
   1309      1.12      tron 		case 0x08:
   1310      1.12      tron 			mpt_prt(mpt, "Phy %d: Link Rate 1.5 Gbps",
   1311      1.12      tron 			    msg->Data[0] & 0xff);
   1312      1.12      tron 			break;
   1313      1.12      tron 		case 0x09:
   1314      1.12      tron 			mpt_prt(mpt, "Phy %d: Link Rate 3.0 Gbps",
   1315      1.12      tron 			    msg->Data[0] & 0xff);
   1316      1.12      tron 			break;
   1317      1.13      tron 		default:
   1318      1.12      tron 			mpt_prt(mpt, "Phy %d: SAS Phy Link Status Event: "
   1319      1.12      tron 			    "Unknown event (%0x)",
   1320      1.12      tron 			    msg->Data[0] & 0xff, (msg->Data[0] >> 8) & 0xff);
   1321      1.12      tron 		}
   1322      1.12      tron 		break;
   1323      1.12      tron 
   1324      1.12      tron 	case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
   1325      1.12      tron 	case MPI_EVENT_SAS_DISCOVERY:
   1326      1.12      tron 		/* ignore these events for now */
   1327      1.12      tron 		break;
   1328      1.12      tron 
   1329      1.17    mhitch 	case MPI_EVENT_QUEUE_FULL:
   1330      1.17    mhitch 		/* This can get a little chatty */
   1331      1.17    mhitch 		if (mpt->verbose > 0)
   1332      1.17    mhitch 			mpt_prt(mpt, "Queue Full Event");
   1333      1.17    mhitch 		break;
   1334      1.17    mhitch 
   1335       1.1   thorpej 	default:
   1336       1.1   thorpej 		mpt_prt(mpt, "Unknown async event: 0x%x", msg->Event);
   1337       1.1   thorpej 		break;
   1338       1.1   thorpej 	}
   1339       1.9     perry 
   1340       1.1   thorpej 	if (msg->AckRequired) {
   1341       1.1   thorpej 		MSG_EVENT_ACK *ackp;
   1342       1.1   thorpej 		request_t *req;
   1343       1.1   thorpej 
   1344       1.1   thorpej 		if ((req = mpt_get_request(mpt)) == NULL) {
   1345       1.1   thorpej 			/* XXX XXX XXX XXXJRT */
   1346       1.1   thorpej 			panic("mpt_event_notify_reply: unable to allocate "
   1347       1.1   thorpej 			    "request structure");
   1348       1.1   thorpej 		}
   1349       1.1   thorpej 
   1350       1.1   thorpej 		ackp = (MSG_EVENT_ACK *) req->req_vbuf;
   1351       1.1   thorpej 		memset(ackp, 0, sizeof(*ackp));
   1352       1.1   thorpej 		ackp->Function = MPI_FUNCTION_EVENT_ACK;
   1353       1.1   thorpej 		ackp->Event = msg->Event;
   1354       1.1   thorpej 		ackp->EventContext = msg->EventContext;
   1355      1.15       chs 		ackp->MsgContext = htole32(req->index | 0x80000000);
   1356       1.1   thorpej 		mpt_check_doorbell(mpt);
   1357       1.1   thorpej 		mpt_send_cmd(mpt, req);
   1358       1.1   thorpej 	}
   1359       1.1   thorpej }
   1360       1.1   thorpej 
   1361       1.1   thorpej /* XXXJRT mpt_bus_reset() */
   1362       1.1   thorpej 
   1363       1.1   thorpej /*****************************************************************************
   1364       1.1   thorpej  * SCSI interface routines
   1365       1.1   thorpej  *****************************************************************************/
   1366       1.1   thorpej 
   1367       1.1   thorpej static void
   1368       1.1   thorpej mpt_scsipi_request(struct scsipi_channel *chan, scsipi_adapter_req_t req,
   1369       1.1   thorpej     void *arg)
   1370       1.1   thorpej {
   1371       1.1   thorpej 	struct scsipi_adapter *adapt = chan->chan_adapter;
   1372       1.1   thorpej 	mpt_softc_t *mpt = (void *) adapt->adapt_dev;
   1373       1.1   thorpej 
   1374       1.1   thorpej 	switch (req) {
   1375       1.1   thorpej 	case ADAPTER_REQ_RUN_XFER:
   1376       1.1   thorpej 		mpt_run_xfer(mpt, (struct scsipi_xfer *) arg);
   1377       1.1   thorpej 		return;
   1378       1.1   thorpej 
   1379       1.1   thorpej 	case ADAPTER_REQ_GROW_RESOURCES:
   1380       1.1   thorpej 		/* Not supported. */
   1381       1.1   thorpej 		return;
   1382       1.1   thorpej 
   1383       1.1   thorpej 	case ADAPTER_REQ_SET_XFER_MODE:
   1384       1.1   thorpej 		mpt_set_xfer_mode(mpt, (struct scsipi_xfer_mode *) arg);
   1385       1.1   thorpej 		return;
   1386       1.1   thorpej 	}
   1387       1.1   thorpej }
   1388       1.1   thorpej 
   1389       1.1   thorpej static void
   1390       1.1   thorpej mpt_minphys(struct buf *bp)
   1391       1.1   thorpej {
   1392       1.1   thorpej 
   1393       1.1   thorpej /*
   1394       1.1   thorpej  * Subtract one from the SGL limit, since we need an extra one to handle
   1395       1.1   thorpej  * an non-page-aligned transfer.
   1396       1.1   thorpej  */
   1397       1.1   thorpej #define	MPT_MAX_XFER	((MPT_SGL_MAX - 1) * PAGE_SIZE)
   1398       1.1   thorpej 
   1399       1.1   thorpej 	if (bp->b_bcount > MPT_MAX_XFER)
   1400       1.1   thorpej 		bp->b_bcount = MPT_MAX_XFER;
   1401       1.1   thorpej 	minphys(bp);
   1402       1.1   thorpej }
   1403  1.17.2.2   msaitoh 
   1404  1.17.2.2   msaitoh #if NBIO > 0
   1405  1.17.2.2   msaitoh static fCONFIG_PAGE_IOC_2 *
   1406  1.17.2.2   msaitoh mpt_get_cfg_page_ioc2(mpt_softc_t *mpt)
   1407  1.17.2.2   msaitoh {
   1408  1.17.2.2   msaitoh 	fCONFIG_PAGE_HEADER hdr;
   1409  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2 *ioc2;
   1410  1.17.2.2   msaitoh 	int rv;
   1411  1.17.2.2   msaitoh 
   1412  1.17.2.2   msaitoh 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_IOC, 2, 0, &hdr);
   1413  1.17.2.2   msaitoh 	if (rv)
   1414  1.17.2.2   msaitoh 		return NULL;
   1415  1.17.2.2   msaitoh 
   1416  1.17.2.2   msaitoh 	ioc2 = malloc(hdr.PageLength * 4, M_DEVBUF, M_WAITOK | M_ZERO);
   1417  1.17.2.2   msaitoh 	if (ioc2 == NULL)
   1418  1.17.2.2   msaitoh 		return NULL;
   1419  1.17.2.2   msaitoh 
   1420  1.17.2.2   msaitoh 	memcpy(ioc2, &hdr, sizeof(hdr));
   1421  1.17.2.2   msaitoh 
   1422  1.17.2.2   msaitoh 	rv = mpt_read_cfg_page(mpt, 0, &ioc2->Header);
   1423  1.17.2.2   msaitoh 	if (rv)
   1424  1.17.2.2   msaitoh 		goto fail;
   1425  1.17.2.2   msaitoh 	mpt2host_config_page_ioc_2(ioc2);
   1426  1.17.2.2   msaitoh 
   1427  1.17.2.2   msaitoh 	return ioc2;
   1428  1.17.2.2   msaitoh 
   1429  1.17.2.2   msaitoh fail:
   1430  1.17.2.2   msaitoh 	free(ioc2, M_DEVBUF);
   1431  1.17.2.2   msaitoh 	return NULL;
   1432  1.17.2.2   msaitoh }
   1433  1.17.2.2   msaitoh 
   1434  1.17.2.2   msaitoh static fCONFIG_PAGE_IOC_3 *
   1435  1.17.2.2   msaitoh mpt_get_cfg_page_ioc3(mpt_softc_t *mpt)
   1436  1.17.2.2   msaitoh {
   1437  1.17.2.2   msaitoh 	fCONFIG_PAGE_HEADER hdr;
   1438  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_3 *ioc3;
   1439  1.17.2.2   msaitoh 	int rv;
   1440  1.17.2.2   msaitoh 
   1441  1.17.2.2   msaitoh 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_IOC, 3, 0, &hdr);
   1442  1.17.2.2   msaitoh 	if (rv)
   1443  1.17.2.2   msaitoh 		return NULL;
   1444  1.17.2.2   msaitoh 
   1445  1.17.2.2   msaitoh 	ioc3 = malloc(hdr.PageLength * 4, M_DEVBUF, M_WAITOK | M_ZERO);
   1446  1.17.2.2   msaitoh 	if (ioc3 == NULL)
   1447  1.17.2.2   msaitoh 		return NULL;
   1448  1.17.2.2   msaitoh 
   1449  1.17.2.2   msaitoh 	memcpy(ioc3, &hdr, sizeof(hdr));
   1450  1.17.2.2   msaitoh 
   1451  1.17.2.2   msaitoh 	rv = mpt_read_cfg_page(mpt, 0, &ioc3->Header);
   1452  1.17.2.2   msaitoh 	if (rv)
   1453  1.17.2.2   msaitoh 		goto fail;
   1454  1.17.2.2   msaitoh 
   1455  1.17.2.2   msaitoh 	return ioc3;
   1456  1.17.2.2   msaitoh 
   1457  1.17.2.2   msaitoh fail:
   1458  1.17.2.2   msaitoh 	free(ioc3, M_DEVBUF);
   1459  1.17.2.2   msaitoh 	return NULL;
   1460  1.17.2.2   msaitoh }
   1461  1.17.2.2   msaitoh 
   1462  1.17.2.2   msaitoh 
   1463  1.17.2.2   msaitoh static fCONFIG_PAGE_RAID_VOL_0 *
   1464  1.17.2.2   msaitoh mpt_get_cfg_page_raid_vol0(mpt_softc_t *mpt, int address)
   1465  1.17.2.2   msaitoh {
   1466  1.17.2.2   msaitoh 	fCONFIG_PAGE_HEADER hdr;
   1467  1.17.2.2   msaitoh 	fCONFIG_PAGE_RAID_VOL_0 *rvol0;
   1468  1.17.2.2   msaitoh 	int rv;
   1469  1.17.2.2   msaitoh 
   1470  1.17.2.2   msaitoh 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_RAID_VOLUME, 0,
   1471  1.17.2.2   msaitoh 	    address, &hdr);
   1472  1.17.2.2   msaitoh 	if (rv)
   1473  1.17.2.2   msaitoh 		return NULL;
   1474  1.17.2.2   msaitoh 
   1475  1.17.2.2   msaitoh 	rvol0 = malloc(hdr.PageLength * 4, M_DEVBUF, M_WAITOK | M_ZERO);
   1476  1.17.2.2   msaitoh 	if (rvol0 == NULL)
   1477  1.17.2.2   msaitoh 		return NULL;
   1478  1.17.2.2   msaitoh 
   1479  1.17.2.2   msaitoh 	memcpy(rvol0, &hdr, sizeof(hdr));
   1480  1.17.2.2   msaitoh 
   1481  1.17.2.2   msaitoh 	rv = mpt_read_cfg_page(mpt, address, &rvol0->Header);
   1482  1.17.2.2   msaitoh 	if (rv)
   1483  1.17.2.2   msaitoh 		goto fail;
   1484  1.17.2.2   msaitoh 	mpt2host_config_page_raid_vol_0(rvol0);
   1485  1.17.2.2   msaitoh 
   1486  1.17.2.2   msaitoh 	return rvol0;
   1487  1.17.2.2   msaitoh 
   1488  1.17.2.2   msaitoh fail:
   1489  1.17.2.2   msaitoh 	free(rvol0, M_DEVBUF);
   1490  1.17.2.2   msaitoh 	return NULL;
   1491  1.17.2.2   msaitoh }
   1492  1.17.2.2   msaitoh 
   1493  1.17.2.2   msaitoh static fCONFIG_PAGE_RAID_PHYS_DISK_0 *
   1494  1.17.2.2   msaitoh mpt_get_cfg_page_raid_phys_disk0(mpt_softc_t *mpt, int address)
   1495  1.17.2.2   msaitoh {
   1496  1.17.2.2   msaitoh 	fCONFIG_PAGE_HEADER hdr;
   1497  1.17.2.2   msaitoh 	fCONFIG_PAGE_RAID_PHYS_DISK_0 *physdisk0;
   1498  1.17.2.2   msaitoh 	int rv;
   1499  1.17.2.2   msaitoh 
   1500  1.17.2.2   msaitoh 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_RAID_PHYSDISK, 0,
   1501  1.17.2.2   msaitoh 	    address, &hdr);
   1502  1.17.2.2   msaitoh 	if (rv)
   1503  1.17.2.2   msaitoh 		return NULL;
   1504  1.17.2.2   msaitoh 
   1505  1.17.2.2   msaitoh 	physdisk0 = malloc(hdr.PageLength * 4, M_DEVBUF, M_WAITOK | M_ZERO);
   1506  1.17.2.2   msaitoh 	if (physdisk0 == NULL)
   1507  1.17.2.2   msaitoh 		return NULL;
   1508  1.17.2.2   msaitoh 
   1509  1.17.2.2   msaitoh 	memcpy(physdisk0, &hdr, sizeof(hdr));
   1510  1.17.2.2   msaitoh 
   1511  1.17.2.2   msaitoh 	rv = mpt_read_cfg_page(mpt, address, &physdisk0->Header);
   1512  1.17.2.2   msaitoh 	if (rv)
   1513  1.17.2.2   msaitoh 		goto fail;
   1514  1.17.2.2   msaitoh 	mpt2host_config_page_raid_phys_disk_0(physdisk0);
   1515  1.17.2.2   msaitoh 
   1516  1.17.2.2   msaitoh 	return physdisk0;
   1517  1.17.2.2   msaitoh 
   1518  1.17.2.2   msaitoh fail:
   1519  1.17.2.2   msaitoh 	free(physdisk0, M_DEVBUF);
   1520  1.17.2.2   msaitoh 	return NULL;
   1521  1.17.2.2   msaitoh }
   1522  1.17.2.2   msaitoh 
   1523  1.17.2.2   msaitoh static bool
   1524  1.17.2.2   msaitoh mpt_is_raid(mpt_softc_t *mpt)
   1525  1.17.2.2   msaitoh {
   1526  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2 *ioc2;
   1527  1.17.2.2   msaitoh 	bool is_raid = false;
   1528  1.17.2.2   msaitoh 
   1529  1.17.2.2   msaitoh 	ioc2 = mpt_get_cfg_page_ioc2(mpt);
   1530  1.17.2.2   msaitoh 	if (ioc2 == NULL)
   1531  1.17.2.2   msaitoh 		return false;
   1532  1.17.2.2   msaitoh 
   1533  1.17.2.2   msaitoh 	if (ioc2->CapabilitiesFlags != 0xdeadbeef) {
   1534  1.17.2.2   msaitoh 		is_raid = !!(ioc2->CapabilitiesFlags &
   1535  1.17.2.2   msaitoh 				(MPI_IOCPAGE2_CAP_FLAGS_IS_SUPPORT|
   1536  1.17.2.2   msaitoh 				 MPI_IOCPAGE2_CAP_FLAGS_IME_SUPPORT|
   1537  1.17.2.2   msaitoh 				 MPI_IOCPAGE2_CAP_FLAGS_IM_SUPPORT));
   1538  1.17.2.2   msaitoh 	}
   1539  1.17.2.2   msaitoh 
   1540  1.17.2.2   msaitoh 	free(ioc2, M_DEVBUF);
   1541  1.17.2.2   msaitoh 
   1542  1.17.2.2   msaitoh 	return is_raid;
   1543  1.17.2.2   msaitoh }
   1544  1.17.2.2   msaitoh 
   1545  1.17.2.2   msaitoh static int
   1546  1.17.2.2   msaitoh mpt_bio_ioctl(device_t dev, u_long cmd, void *addr)
   1547  1.17.2.2   msaitoh {
   1548  1.17.2.2   msaitoh 	mpt_softc_t *mpt = device_private(dev);
   1549  1.17.2.2   msaitoh 	int error, s;
   1550  1.17.2.2   msaitoh 
   1551  1.17.2.2   msaitoh 	KERNEL_LOCK(1, curlwp);
   1552  1.17.2.2   msaitoh 	s = splbio();
   1553  1.17.2.2   msaitoh 
   1554  1.17.2.2   msaitoh 	switch (cmd) {
   1555  1.17.2.2   msaitoh 	case BIOCINQ:
   1556  1.17.2.2   msaitoh 		error = mpt_bio_ioctl_inq(mpt, addr);
   1557  1.17.2.2   msaitoh 		break;
   1558  1.17.2.2   msaitoh 	case BIOCVOL:
   1559  1.17.2.2   msaitoh 		error = mpt_bio_ioctl_vol(mpt, addr);
   1560  1.17.2.2   msaitoh 		break;
   1561  1.17.2.2   msaitoh 	case BIOCDISK_NOVOL:
   1562  1.17.2.2   msaitoh 		error = mpt_bio_ioctl_disk_novol(mpt, addr);
   1563  1.17.2.2   msaitoh 		break;
   1564  1.17.2.2   msaitoh 	case BIOCDISK:
   1565  1.17.2.2   msaitoh 		error = mpt_bio_ioctl_disk(mpt, addr);
   1566  1.17.2.2   msaitoh 		break;
   1567  1.17.2.2   msaitoh 	case BIOCSETSTATE:
   1568  1.17.2.2   msaitoh 		error = mpt_bio_ioctl_setstate(mpt, addr);
   1569  1.17.2.2   msaitoh 		break;
   1570  1.17.2.2   msaitoh 	default:
   1571  1.17.2.2   msaitoh 		error = EINVAL;
   1572  1.17.2.2   msaitoh 		break;
   1573  1.17.2.2   msaitoh 	}
   1574  1.17.2.2   msaitoh 
   1575  1.17.2.2   msaitoh 	splx(s);
   1576  1.17.2.2   msaitoh 	KERNEL_UNLOCK_ONE(curlwp);
   1577  1.17.2.2   msaitoh 
   1578  1.17.2.2   msaitoh 	return error;
   1579  1.17.2.2   msaitoh }
   1580  1.17.2.2   msaitoh 
   1581  1.17.2.2   msaitoh static int
   1582  1.17.2.2   msaitoh mpt_bio_ioctl_inq(mpt_softc_t *mpt, struct bioc_inq *bi)
   1583  1.17.2.2   msaitoh {
   1584  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2 *ioc2;
   1585  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_3 *ioc3;
   1586  1.17.2.2   msaitoh 
   1587  1.17.2.2   msaitoh 	ioc2 = mpt_get_cfg_page_ioc2(mpt);
   1588  1.17.2.2   msaitoh 	if (ioc2 == NULL)
   1589  1.17.2.2   msaitoh 		return EIO;
   1590  1.17.2.2   msaitoh 	ioc3 = mpt_get_cfg_page_ioc3(mpt);
   1591  1.17.2.2   msaitoh 	if (ioc3 == NULL) {
   1592  1.17.2.2   msaitoh 		free(ioc2, M_DEVBUF);
   1593  1.17.2.2   msaitoh 		return EIO;
   1594  1.17.2.2   msaitoh 	}
   1595  1.17.2.2   msaitoh 
   1596  1.17.2.2   msaitoh 	strlcpy(bi->bi_dev, device_xname(&mpt->sc_dev), sizeof(bi->bi_dev));
   1597  1.17.2.2   msaitoh 	bi->bi_novol = ioc2->NumActiveVolumes;
   1598  1.17.2.2   msaitoh 	bi->bi_nodisk = ioc3->NumPhysDisks;
   1599  1.17.2.2   msaitoh 
   1600  1.17.2.2   msaitoh 	free(ioc2, M_DEVBUF);
   1601  1.17.2.2   msaitoh 	free(ioc3, M_DEVBUF);
   1602  1.17.2.2   msaitoh 
   1603  1.17.2.2   msaitoh 	return 0;
   1604  1.17.2.2   msaitoh }
   1605  1.17.2.2   msaitoh 
   1606  1.17.2.2   msaitoh static int
   1607  1.17.2.2   msaitoh mpt_bio_ioctl_vol(mpt_softc_t *mpt, struct bioc_vol *bv)
   1608  1.17.2.2   msaitoh {
   1609  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2 *ioc2 = NULL;
   1610  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2_RAID_VOL *ioc2rvol;
   1611  1.17.2.2   msaitoh 	fCONFIG_PAGE_RAID_VOL_0 *rvol0 = NULL;
   1612  1.17.2.2   msaitoh 	struct scsipi_periph *periph;
   1613  1.17.2.2   msaitoh 	struct scsipi_inquiry_data inqbuf;
   1614  1.17.2.2   msaitoh 	char vendor[9], product[17], revision[5];
   1615  1.17.2.2   msaitoh 	int address;
   1616  1.17.2.2   msaitoh 
   1617  1.17.2.2   msaitoh 	ioc2 = mpt_get_cfg_page_ioc2(mpt);
   1618  1.17.2.2   msaitoh 	if (ioc2 == NULL)
   1619  1.17.2.2   msaitoh 		return EIO;
   1620  1.17.2.2   msaitoh 
   1621  1.17.2.2   msaitoh 	if (bv->bv_volid < 0 || bv->bv_volid >= ioc2->NumActiveVolumes)
   1622  1.17.2.2   msaitoh 		goto fail;
   1623  1.17.2.2   msaitoh 
   1624  1.17.2.2   msaitoh 	ioc2rvol = &ioc2->RaidVolume[bv->bv_volid];
   1625  1.17.2.2   msaitoh 	address = ioc2rvol->VolumeID | (ioc2rvol->VolumeBus << 8);
   1626  1.17.2.2   msaitoh 
   1627  1.17.2.2   msaitoh 	rvol0 = mpt_get_cfg_page_raid_vol0(mpt, address);
   1628  1.17.2.2   msaitoh 	if (rvol0 == NULL)
   1629  1.17.2.2   msaitoh 		goto fail;
   1630  1.17.2.2   msaitoh 
   1631  1.17.2.2   msaitoh 	bv->bv_dev[0] = '\0';
   1632  1.17.2.2   msaitoh 	bv->bv_vendor[0] = '\0';
   1633  1.17.2.2   msaitoh 
   1634  1.17.2.2   msaitoh 	periph = scsipi_lookup_periph(&mpt->sc_channel, ioc2rvol->VolumeBus, 0);
   1635  1.17.2.2   msaitoh 	if (periph != NULL) {
   1636  1.17.2.2   msaitoh 		if (periph->periph_dev != NULL) {
   1637  1.17.2.2   msaitoh 			snprintf(bv->bv_dev, sizeof(bv->bv_dev), "%s",
   1638  1.17.2.2   msaitoh 			    device_xname(periph->periph_dev));
   1639  1.17.2.2   msaitoh 		}
   1640  1.17.2.2   msaitoh 		memset(&inqbuf, 0, sizeof(inqbuf));
   1641  1.17.2.2   msaitoh 		if (scsipi_inquire(periph, &inqbuf,
   1642  1.17.2.2   msaitoh 		    XS_CTL_DISCOVERY | XS_CTL_SILENT) == 0) {
   1643  1.17.2.2   msaitoh 			scsipi_strvis(vendor, sizeof(vendor),
   1644  1.17.2.2   msaitoh 			    inqbuf.vendor, sizeof(inqbuf.vendor));
   1645  1.17.2.2   msaitoh 			scsipi_strvis(product, sizeof(product),
   1646  1.17.2.2   msaitoh 			    inqbuf.product, sizeof(inqbuf.product));
   1647  1.17.2.2   msaitoh 			scsipi_strvis(revision, sizeof(revision),
   1648  1.17.2.2   msaitoh 			    inqbuf.revision, sizeof(inqbuf.revision));
   1649  1.17.2.2   msaitoh 
   1650  1.17.2.2   msaitoh 			snprintf(bv->bv_vendor, sizeof(bv->bv_vendor),
   1651  1.17.2.2   msaitoh 			    "%s %s %s", vendor, product, revision);
   1652  1.17.2.2   msaitoh 		}
   1653  1.17.2.2   msaitoh 	}
   1654  1.17.2.2   msaitoh 	bv->bv_nodisk = rvol0->NumPhysDisks;
   1655  1.17.2.2   msaitoh 	bv->bv_size = (uint64_t)rvol0->MaxLBA * 512;
   1656  1.17.2.2   msaitoh 	bv->bv_stripe_size = rvol0->StripeSize;
   1657  1.17.2.2   msaitoh 	bv->bv_percent = -1;
   1658  1.17.2.2   msaitoh 	bv->bv_seconds = 0;
   1659  1.17.2.2   msaitoh 
   1660  1.17.2.2   msaitoh 	switch (rvol0->VolumeStatus.State) {
   1661  1.17.2.2   msaitoh 	case MPI_RAIDVOL0_STATUS_STATE_OPTIMAL:
   1662  1.17.2.2   msaitoh 		bv->bv_status = BIOC_SVONLINE;
   1663  1.17.2.2   msaitoh 		break;
   1664  1.17.2.2   msaitoh 	case MPI_RAIDVOL0_STATUS_STATE_DEGRADED:
   1665  1.17.2.2   msaitoh 		bv->bv_status = BIOC_SVDEGRADED;
   1666  1.17.2.2   msaitoh 		break;
   1667  1.17.2.2   msaitoh 	case MPI_RAIDVOL0_STATUS_STATE_FAILED:
   1668  1.17.2.2   msaitoh 		bv->bv_status = BIOC_SVOFFLINE;
   1669  1.17.2.2   msaitoh 		break;
   1670  1.17.2.2   msaitoh 	default:
   1671  1.17.2.2   msaitoh 		bv->bv_status = BIOC_SVINVALID;
   1672  1.17.2.2   msaitoh 		break;
   1673  1.17.2.2   msaitoh 	}
   1674  1.17.2.2   msaitoh 
   1675  1.17.2.2   msaitoh 	switch (ioc2rvol->VolumeType) {
   1676  1.17.2.2   msaitoh 	case MPI_RAID_VOL_TYPE_IS:
   1677  1.17.2.2   msaitoh 		bv->bv_level = 0;
   1678  1.17.2.2   msaitoh 		break;
   1679  1.17.2.2   msaitoh 	case MPI_RAID_VOL_TYPE_IME:
   1680  1.17.2.2   msaitoh 	case MPI_RAID_VOL_TYPE_IM:
   1681  1.17.2.2   msaitoh 		bv->bv_level = 1;
   1682  1.17.2.2   msaitoh 		break;
   1683  1.17.2.2   msaitoh 	default:
   1684  1.17.2.2   msaitoh 		bv->bv_level = -1;
   1685  1.17.2.2   msaitoh 		break;
   1686  1.17.2.2   msaitoh 	}
   1687  1.17.2.2   msaitoh 
   1688  1.17.2.2   msaitoh 	free(ioc2, M_DEVBUF);
   1689  1.17.2.2   msaitoh 	free(rvol0, M_DEVBUF);
   1690  1.17.2.2   msaitoh 
   1691  1.17.2.2   msaitoh 	return 0;
   1692  1.17.2.2   msaitoh 
   1693  1.17.2.2   msaitoh fail:
   1694  1.17.2.2   msaitoh 	if (ioc2) free(ioc2, M_DEVBUF);
   1695  1.17.2.2   msaitoh 	if (rvol0) free(rvol0, M_DEVBUF);
   1696  1.17.2.2   msaitoh 	return EINVAL;
   1697  1.17.2.2   msaitoh }
   1698  1.17.2.2   msaitoh 
   1699  1.17.2.2   msaitoh static void
   1700  1.17.2.2   msaitoh mpt_bio_ioctl_disk_common(mpt_softc_t *mpt, struct bioc_disk *bd,
   1701  1.17.2.2   msaitoh     int address)
   1702  1.17.2.2   msaitoh {
   1703  1.17.2.2   msaitoh 	fCONFIG_PAGE_RAID_PHYS_DISK_0 *phys = NULL;
   1704  1.17.2.2   msaitoh 	char vendor[9], product[17], revision[5];
   1705  1.17.2.2   msaitoh 
   1706  1.17.2.2   msaitoh 	phys = mpt_get_cfg_page_raid_phys_disk0(mpt, address);
   1707  1.17.2.2   msaitoh 	if (phys == NULL)
   1708  1.17.2.2   msaitoh 		return;
   1709  1.17.2.2   msaitoh 
   1710  1.17.2.2   msaitoh 	scsipi_strvis(vendor, sizeof(vendor),
   1711  1.17.2.2   msaitoh 	    phys->InquiryData.VendorID, sizeof(phys->InquiryData.VendorID));
   1712  1.17.2.2   msaitoh 	scsipi_strvis(product, sizeof(product),
   1713  1.17.2.2   msaitoh 	    phys->InquiryData.ProductID, sizeof(phys->InquiryData.ProductID));
   1714  1.17.2.2   msaitoh 	scsipi_strvis(revision, sizeof(revision),
   1715  1.17.2.2   msaitoh 	    phys->InquiryData.ProductRevLevel,
   1716  1.17.2.2   msaitoh 	    sizeof(phys->InquiryData.ProductRevLevel));
   1717  1.17.2.2   msaitoh 
   1718  1.17.2.2   msaitoh 	snprintf(bd->bd_vendor, sizeof(bd->bd_vendor), "%s %s %s",
   1719  1.17.2.2   msaitoh 	    vendor, product, revision);
   1720  1.17.2.2   msaitoh 	strlcpy(bd->bd_serial, phys->InquiryData.Info, sizeof(bd->bd_serial));
   1721  1.17.2.2   msaitoh 	bd->bd_procdev[0] = '\0';
   1722  1.17.2.2   msaitoh 	bd->bd_channel = phys->PhysDiskBus;
   1723  1.17.2.2   msaitoh 	bd->bd_target = phys->PhysDiskID;
   1724  1.17.2.2   msaitoh 	bd->bd_lun = 0;
   1725  1.17.2.2   msaitoh 	bd->bd_size = (uint64_t)phys->MaxLBA * 512;
   1726  1.17.2.2   msaitoh 
   1727  1.17.2.2   msaitoh 	switch (phys->PhysDiskStatus.State) {
   1728  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_ONLINE:
   1729  1.17.2.2   msaitoh 		bd->bd_status = BIOC_SDONLINE;
   1730  1.17.2.2   msaitoh 		break;
   1731  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_MISSING:
   1732  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_FAILED:
   1733  1.17.2.2   msaitoh 		bd->bd_status = BIOC_SDFAILED;
   1734  1.17.2.2   msaitoh 		break;
   1735  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_OFFLINE_REQUESTED:
   1736  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_FAILED_REQUESTED:
   1737  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_OTHER_OFFLINE:
   1738  1.17.2.2   msaitoh 		bd->bd_status = BIOC_SDOFFLINE;
   1739  1.17.2.2   msaitoh 		break;
   1740  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_INITIALIZING:
   1741  1.17.2.2   msaitoh 		bd->bd_status = BIOC_SDSCRUB;
   1742  1.17.2.2   msaitoh 		break;
   1743  1.17.2.2   msaitoh 	case MPI_PHYSDISK0_STATUS_NOT_COMPATIBLE:
   1744  1.17.2.2   msaitoh 	default:
   1745  1.17.2.2   msaitoh 		bd->bd_status = BIOC_SDINVALID;
   1746  1.17.2.2   msaitoh 		break;
   1747  1.17.2.2   msaitoh 	}
   1748  1.17.2.2   msaitoh 
   1749  1.17.2.2   msaitoh 	free(phys, M_DEVBUF);
   1750  1.17.2.2   msaitoh }
   1751  1.17.2.2   msaitoh 
   1752  1.17.2.2   msaitoh static int
   1753  1.17.2.2   msaitoh mpt_bio_ioctl_disk_novol(mpt_softc_t *mpt, struct bioc_disk *bd)
   1754  1.17.2.2   msaitoh {
   1755  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2 *ioc2 = NULL;
   1756  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_3 *ioc3 = NULL;
   1757  1.17.2.2   msaitoh 	fCONFIG_PAGE_RAID_VOL_0 *rvol0 = NULL;
   1758  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2_RAID_VOL *ioc2rvol;
   1759  1.17.2.2   msaitoh 	int address, v, d;
   1760  1.17.2.2   msaitoh 
   1761  1.17.2.2   msaitoh 	ioc2 = mpt_get_cfg_page_ioc2(mpt);
   1762  1.17.2.2   msaitoh 	if (ioc2 == NULL)
   1763  1.17.2.2   msaitoh 		return EIO;
   1764  1.17.2.2   msaitoh 	ioc3 = mpt_get_cfg_page_ioc3(mpt);
   1765  1.17.2.2   msaitoh 	if (ioc3 == NULL) {
   1766  1.17.2.2   msaitoh 		free(ioc2, M_DEVBUF);
   1767  1.17.2.2   msaitoh 		return EIO;
   1768  1.17.2.2   msaitoh 	}
   1769  1.17.2.2   msaitoh 
   1770  1.17.2.2   msaitoh 	if (bd->bd_diskid < 0 || bd->bd_diskid >= ioc3->NumPhysDisks)
   1771  1.17.2.2   msaitoh 		goto fail;
   1772  1.17.2.2   msaitoh 
   1773  1.17.2.2   msaitoh 	address = ioc3->PhysDisk[bd->bd_diskid].PhysDiskNum;
   1774  1.17.2.2   msaitoh 
   1775  1.17.2.2   msaitoh 	mpt_bio_ioctl_disk_common(mpt, bd, address);
   1776  1.17.2.2   msaitoh 
   1777  1.17.2.2   msaitoh 	bd->bd_disknovol = true;
   1778  1.17.2.2   msaitoh 	for (v = 0; bd->bd_disknovol && v < ioc2->NumActiveVolumes; v++) {
   1779  1.17.2.2   msaitoh 		ioc2rvol = &ioc2->RaidVolume[v];
   1780  1.17.2.2   msaitoh 		address = ioc2rvol->VolumeID | (ioc2rvol->VolumeBus << 8);
   1781  1.17.2.2   msaitoh 
   1782  1.17.2.2   msaitoh 		rvol0 = mpt_get_cfg_page_raid_vol0(mpt, address);
   1783  1.17.2.2   msaitoh 		if (rvol0 == NULL)
   1784  1.17.2.2   msaitoh 			continue;
   1785  1.17.2.2   msaitoh 
   1786  1.17.2.2   msaitoh 		for (d = 0; d < rvol0->NumPhysDisks; d++) {
   1787  1.17.2.2   msaitoh 			if (rvol0->PhysDisk[d].PhysDiskNum ==
   1788  1.17.2.2   msaitoh 			    ioc3->PhysDisk[bd->bd_diskid].PhysDiskNum) {
   1789  1.17.2.2   msaitoh 				bd->bd_disknovol = false;
   1790  1.17.2.2   msaitoh 				bd->bd_volid = v;
   1791  1.17.2.2   msaitoh 				break;
   1792  1.17.2.2   msaitoh 			}
   1793  1.17.2.2   msaitoh 		}
   1794  1.17.2.2   msaitoh 		free(rvol0, M_DEVBUF);
   1795  1.17.2.2   msaitoh 	}
   1796  1.17.2.2   msaitoh 
   1797  1.17.2.2   msaitoh 	free(ioc3, M_DEVBUF);
   1798  1.17.2.2   msaitoh 	free(ioc2, M_DEVBUF);
   1799  1.17.2.2   msaitoh 
   1800  1.17.2.2   msaitoh 	return 0;
   1801  1.17.2.2   msaitoh 
   1802  1.17.2.2   msaitoh fail:
   1803  1.17.2.2   msaitoh 	if (ioc3) free(ioc3, M_DEVBUF);
   1804  1.17.2.2   msaitoh 	if (ioc2) free(ioc2, M_DEVBUF);
   1805  1.17.2.2   msaitoh 	return EINVAL;
   1806  1.17.2.2   msaitoh }
   1807  1.17.2.2   msaitoh 
   1808  1.17.2.2   msaitoh 
   1809  1.17.2.2   msaitoh static int
   1810  1.17.2.2   msaitoh mpt_bio_ioctl_disk(mpt_softc_t *mpt, struct bioc_disk *bd)
   1811  1.17.2.2   msaitoh {
   1812  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2 *ioc2 = NULL;
   1813  1.17.2.2   msaitoh 	fCONFIG_PAGE_RAID_VOL_0 *rvol0 = NULL;
   1814  1.17.2.2   msaitoh 	fCONFIG_PAGE_IOC_2_RAID_VOL *ioc2rvol;
   1815  1.17.2.2   msaitoh 	int address;
   1816  1.17.2.2   msaitoh 
   1817  1.17.2.2   msaitoh 	ioc2 = mpt_get_cfg_page_ioc2(mpt);
   1818  1.17.2.2   msaitoh 	if (ioc2 == NULL)
   1819  1.17.2.2   msaitoh 		return EIO;
   1820  1.17.2.2   msaitoh 
   1821  1.17.2.2   msaitoh 	if (bd->bd_volid < 0 || bd->bd_volid >= ioc2->NumActiveVolumes)
   1822  1.17.2.2   msaitoh 		goto fail;
   1823  1.17.2.2   msaitoh 
   1824  1.17.2.2   msaitoh 	ioc2rvol = &ioc2->RaidVolume[bd->bd_volid];
   1825  1.17.2.2   msaitoh 	address = ioc2rvol->VolumeID | (ioc2rvol->VolumeBus << 8);
   1826  1.17.2.2   msaitoh 
   1827  1.17.2.2   msaitoh 	rvol0 = mpt_get_cfg_page_raid_vol0(mpt, address);
   1828  1.17.2.2   msaitoh 	if (rvol0 == NULL)
   1829  1.17.2.2   msaitoh 		goto fail;
   1830  1.17.2.2   msaitoh 
   1831  1.17.2.2   msaitoh 	if (bd->bd_diskid < 0 || bd->bd_diskid >= rvol0->NumPhysDisks)
   1832  1.17.2.2   msaitoh 		goto fail;
   1833  1.17.2.2   msaitoh 
   1834  1.17.2.2   msaitoh 	address = rvol0->PhysDisk[bd->bd_diskid].PhysDiskNum;
   1835  1.17.2.2   msaitoh 
   1836  1.17.2.2   msaitoh 	mpt_bio_ioctl_disk_common(mpt, bd, address);
   1837  1.17.2.2   msaitoh 
   1838  1.17.2.2   msaitoh 	free(ioc2, M_DEVBUF);
   1839  1.17.2.2   msaitoh 
   1840  1.17.2.2   msaitoh 	return 0;
   1841  1.17.2.2   msaitoh 
   1842  1.17.2.2   msaitoh fail:
   1843  1.17.2.2   msaitoh 	if (ioc2) free(ioc2, M_DEVBUF);
   1844  1.17.2.2   msaitoh 	return EINVAL;
   1845  1.17.2.2   msaitoh }
   1846  1.17.2.2   msaitoh 
   1847  1.17.2.2   msaitoh static int
   1848  1.17.2.2   msaitoh mpt_bio_ioctl_setstate(mpt_softc_t *mpt, struct bioc_setstate *bs)
   1849  1.17.2.2   msaitoh {
   1850  1.17.2.2   msaitoh 	return ENOTTY;
   1851  1.17.2.2   msaitoh }
   1852  1.17.2.2   msaitoh #endif
   1853  1.17.2.2   msaitoh 
   1854