d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
6dd6964074
freebsd-skq/sys/cam/scsi/scsi_low.c
imp 568d742088 Remove ccbque.h from i386/isa. 
inline ccbque.h into scsi_low.h. The file isn't MD, so shouldn't live
in i386/isa. It's only used by scsi_low, so move it there so no new
clients accidentally grow. scsi_low may not even still work, and the
locking here is still SPL based. CAM should do the right thing, but
I've received no reports of these cards still working. At least it
compiles still and there's one fewer files in sys/i386/isa. While I'm
here, ansify and de-splize. CCB_MWANTED appears to be a clear-only
flag, but I've not changed that.

Differential Review: https://reviews.freebsd.org/D13672
2018-01-09 16:11:33 +00:00

4262 lines
100 KiB
C
Raw Blame History

/* $NecBSD: scsi_low.c,v 1.24.10.8 2001/06/26 07:39:44 honda Exp $ */
/* $NetBSD$ */
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#define SCSI_LOW_STATICS
#define SCSI_LOW_DEBUG
#define SCSI_LOW_NEGOTIATE_BEFORE_SENSE
#define SCSI_LOW_START_UP_CHECK
/* #define SCSI_LOW_INFO_DETAIL */
/* #define SCSI_LOW_QCLEAR_AFTER_CA */
/* #define SCSI_LOW_FLAGS_QUIRKS_OK */
#define SCSI_LOW_FLAGS_QUIRKS_OK
/*-
* SPDX-License-Identifier: BSD-3-Clause
*
* [NetBSD for NEC PC-98 series]
* Copyright (c) 1995, 1996, 1997, 1998, 1999, 2000, 2001
* NetBSD/pc98 porting staff. All rights reserved.
* Copyright (c) 1995, 1996, 1997, 1998, 1999, 2000, 2001
* Naofumi HONDA. All rights reserved.
*
* [Ported for FreeBSD CAM]
* Copyright (c) 2000, 2001
* MITSUNAGA Noriaki, NOKUBI Hirotaka and TAKAHASHI Yoshihiro.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
* INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
/* <On the nexus establishment>
* When our host is reselected,
* nexus establish processes are little complicated.
* Normal steps are followings:
* 1) Our host selected by target => target nexus (slp->sl_Tnexus)
* 2) Identify msgin => lun nexus (slp->sl_Lnexus)
* 3) Qtag msg => ccb nexus (slp->sl_Qnexus)
*/
#include "opt_ddb.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/bio.h>
#include <sys/buf.h>
#include <sys/queue.h>
#include <sys/malloc.h>
#include <sys/errno.h>
#include <cam/cam.h>
#include <cam/cam_ccb.h>
#include <cam/cam_sim.h>
#include <cam/cam_debug.h>
#include <cam/cam_periph.h>
#include <cam/cam_xpt_periph.h>
#include <cam/scsi/scsi_all.h>
#include <cam/scsi/scsi_message.h>
#include <cam/scsi/scsi_low.h>
#include <sys/cons.h>
/**************************************************************
* CCB Macros
**************************************************************/
/* (II) static allocated memory */
#define GENERIC_CCB_STATIC_ALLOC(DEV, CCBTYPE) \
static struct CCBTYPE##que CCBTYPE##que;
/* (III) functions */
#define GENERIC_CCB(DEV, CCBTYPE, CHAIN) \
\
void \
DEV##_init_ccbque(int count) \
{ \
if (CCBTYPE##que.maxccb == 0) \
TAILQ_INIT(&CCBTYPE##que.CCBTYPE##tab); \
CCBTYPE##que.maxccb += count; \
} \
\
struct CCBTYPE * \
DEV##_get_ccb(void) \
{ \
struct CCBTYPE *cb; \
\
if (CCBTYPE##que.count < CCBTYPE##que.maxccb) \
{ \
CCBTYPE##que.count ++; \
cb = TAILQ_FIRST(&(CCBTYPE##que.CCBTYPE##tab)); \
if (cb != NULL) { \
TAILQ_REMOVE(&CCBTYPE##que.CCBTYPE##tab, cb, CHAIN);\
goto out; \
} else { \
cb = malloc(sizeof(*cb), M_DEVBUF, M_NOWAIT | M_ZERO); \
if (cb != NULL) \
goto out; \
} \
CCBTYPE##que.count --; \
} \
\
cb = NULL; \
\
out: \
return cb; \
} \
\
void \
DEV##_free_ccb(struct CCBTYPE *cb) \
{ \
\
TAILQ_INSERT_TAIL(&CCBTYPE##que.CCBTYPE##tab, cb, CHAIN); \
CCBTYPE##que.count --; \
\
if (CCBTYPE##que.flags & CCB_MWANTED) \
{ \
CCBTYPE##que.flags &= ~CCB_MWANTED; \
wakeup ((caddr_t) &CCBTYPE##que.count); \
} \
}
/**************************************************************
* Constants
**************************************************************/
#define SCSI_LOW_POLL_HZ 1000
/* functions return values */
#define SCSI_LOW_START_NO_QTAG 0
#define SCSI_LOW_START_QTAG 1
#define SCSI_LOW_DONE_COMPLETE 0
#define SCSI_LOW_DONE_RETRY 1
/* internal disk flags */
#define SCSI_LOW_DISK_DISC 0x00000001
#define SCSI_LOW_DISK_QTAG 0x00000002
#define SCSI_LOW_DISK_LINK 0x00000004
#define SCSI_LOW_DISK_PARITY 0x00000008
#define SCSI_LOW_DISK_SYNC 0x00010000
#define SCSI_LOW_DISK_WIDE_16 0x00020000
#define SCSI_LOW_DISK_WIDE_32 0x00040000
#define SCSI_LOW_DISK_WIDE (SCSI_LOW_DISK_WIDE_16 | SCSI_LOW_DISK_WIDE_32)
#define SCSI_LOW_DISK_LFLAGS 0x0000ffff
#define SCSI_LOW_DISK_TFLAGS 0xffff0000
static MALLOC_DEFINE(M_SCSILOW, "SCSI low", "SCSI low buffers");
/**************************************************************
* Declarations
**************************************************************/
/* static */ void scsi_low_info(struct scsi_low_softc *, struct targ_info *, u_char *);
static void scsi_low_engage(void *);
static struct slccb *scsi_low_establish_ccb(struct targ_info *, struct lun_info *, scsi_low_tag_t);
static int scsi_low_done(struct scsi_low_softc *, struct slccb *);
static int scsi_low_setup_done(struct scsi_low_softc *, struct slccb *);
static void scsi_low_bus_release(struct scsi_low_softc *, struct targ_info *);
static void scsi_low_twiddle_wait(void);
static struct lun_info *scsi_low_alloc_li(struct targ_info *, int, int);
static struct targ_info *scsi_low_alloc_ti(struct scsi_low_softc *, int);
static void scsi_low_calcf_lun(struct lun_info *);
static void scsi_low_calcf_target(struct targ_info *);
static void scsi_low_calcf_show(struct lun_info *);
static void scsi_low_reset_nexus(struct scsi_low_softc *, int);
static void scsi_low_reset_nexus_target(struct scsi_low_softc *, struct targ_info *, int);
static void scsi_low_reset_nexus_lun(struct scsi_low_softc *, struct lun_info *, int);
static int scsi_low_init(struct scsi_low_softc *, u_int);
static void scsi_low_start(struct scsi_low_softc *);
static void scsi_low_free_ti(struct scsi_low_softc *);
static int scsi_low_alloc_qtag(struct slccb *);
static int scsi_low_dealloc_qtag(struct slccb *);
static int scsi_low_enqueue(struct scsi_low_softc *, struct targ_info *, struct lun_info *, struct slccb *, u_int, u_int);
static int scsi_low_message_enqueue(struct scsi_low_softc *, struct targ_info *, struct lun_info *, u_int);
static void scsi_low_unit_ready_cmd(struct slccb *);
static void scsi_low_timeout(void *);
static int scsi_low_timeout_check(struct scsi_low_softc *);
#ifdef SCSI_LOW_START_UP_CHECK
static int scsi_low_start_up(struct scsi_low_softc *);
#endif /* SCSI_LOW_START_UP_CHECK */
static int scsi_low_abort_ccb(struct scsi_low_softc *, struct slccb *);
static struct slccb *scsi_low_revoke_ccb(struct scsi_low_softc *, struct slccb *, int);
int scsi_low_version_major = 2;
int scsi_low_version_minor = 17;
static struct scsi_low_softc_tab sl_tab = LIST_HEAD_INITIALIZER(sl_tab);
static struct mtx sl_tab_lock;
MTX_SYSINIT(sl_tab_lock, &sl_tab_lock, "scsi low table", MTX_DEF);
/**************************************************************
* Debug, Run test and Statics
**************************************************************/
#ifdef SCSI_LOW_INFO_DETAIL
#define SCSI_LOW_INFO(slp, ti, s) scsi_low_info((slp), (ti), (s))
#else /* !SCSI_LOW_INFO_DETAIL */
#define SCSI_LOW_INFO(slp, ti, s) device_printf((slp)->sl_dev, "%s\n", (s))
#endif /* !SCSI_LOW_INFO_DETAIL */
#ifdef SCSI_LOW_STATICS
static struct scsi_low_statics {
int nexus_win;
int nexus_fail;
int nexus_disconnected;
int nexus_reselected;
int nexus_conflict;
} scsi_low_statics;
#endif /* SCSI_LOW_STATICS */
#ifdef SCSI_LOW_DEBUG
#define SCSI_LOW_DEBUG_DONE 0x00001
#define SCSI_LOW_DEBUG_DISC 0x00002
#define SCSI_LOW_DEBUG_SENSE 0x00004
#define SCSI_LOW_DEBUG_CALCF 0x00008
#define SCSI_LOW_DEBUG_ACTION 0x10000
int scsi_low_debug = 0;
#define SCSI_LOW_MAX_ATTEN_CHECK 32
#define SCSI_LOW_ATTEN_CHECK 0x0001
#define SCSI_LOW_CMDLNK_CHECK 0x0002
#define SCSI_LOW_ABORT_CHECK 0x0004
#define SCSI_LOW_NEXUS_CHECK 0x0008
int scsi_low_test = 0;
int scsi_low_test_id = 0;
static void scsi_low_test_abort(struct scsi_low_softc *, struct targ_info *, struct lun_info *);
static void scsi_low_test_cmdlnk(struct scsi_low_softc *, struct slccb *);
static void scsi_low_test_atten(struct scsi_low_softc *, struct targ_info *, u_int);
#define SCSI_LOW_DEBUG_TEST_GO(fl, id) \
((scsi_low_test & (fl)) != 0 && (scsi_low_test_id & (1 << (id))) == 0)
#define SCSI_LOW_DEBUG_GO(fl, id) \
((scsi_low_debug & (fl)) != 0 && (scsi_low_test_id & (1 << (id))) == 0)
#endif /* SCSI_LOW_DEBUG */
/**************************************************************
* CCB
**************************************************************/
GENERIC_CCB_STATIC_ALLOC(scsi_low, slccb)
GENERIC_CCB(scsi_low, slccb, ccb_chain)
/**************************************************************
* Inline functions
**************************************************************/
#define SCSI_LOW_INLINE static __inline
SCSI_LOW_INLINE void scsi_low_activate_qtag(struct slccb *);
SCSI_LOW_INLINE void scsi_low_deactivate_qtag(struct slccb *);
SCSI_LOW_INLINE void scsi_low_ccb_message_assert(struct slccb *, u_int);
SCSI_LOW_INLINE void scsi_low_ccb_message_exec(struct scsi_low_softc *, struct slccb *);
SCSI_LOW_INLINE void scsi_low_ccb_message_retry(struct slccb *);
SCSI_LOW_INLINE void scsi_low_ccb_message_clear(struct slccb *);
SCSI_LOW_INLINE void scsi_low_init_msgsys(struct scsi_low_softc *, struct targ_info *);
SCSI_LOW_INLINE void
scsi_low_activate_qtag(cb)
struct slccb *cb;
{
struct lun_info *li = cb->li;
if (cb->ccb_tag != SCSI_LOW_UNKTAG)
return;
li->li_nqio ++;
cb->ccb_tag = cb->ccb_otag;
}
SCSI_LOW_INLINE void
scsi_low_deactivate_qtag(cb)
struct slccb *cb;
{
struct lun_info *li = cb->li;
if (cb->ccb_tag == SCSI_LOW_UNKTAG)
return;
li->li_nqio --;
cb->ccb_tag = SCSI_LOW_UNKTAG;
}
SCSI_LOW_INLINE void
scsi_low_ccb_message_exec(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
scsi_low_assert_msg(slp, cb->ti, cb->ccb_msgoutflag, 0);
cb->ccb_msgoutflag = 0;
}
SCSI_LOW_INLINE void
scsi_low_ccb_message_assert(cb, msg)
struct slccb *cb;
u_int msg;
{
cb->ccb_msgoutflag = cb->ccb_omsgoutflag = msg;
}
SCSI_LOW_INLINE void
scsi_low_ccb_message_retry(cb)
struct slccb *cb;
{
cb->ccb_msgoutflag = cb->ccb_omsgoutflag;
}
SCSI_LOW_INLINE void
scsi_low_ccb_message_clear(cb)
struct slccb *cb;
{
cb->ccb_msgoutflag = 0;
}
SCSI_LOW_INLINE void
scsi_low_init_msgsys(slp, ti)
struct scsi_low_softc *slp;
struct targ_info *ti;
{
ti->ti_msginptr = 0;
ti->ti_emsgflags = ti->ti_msgflags = ti->ti_omsgflags = 0;
SCSI_LOW_DEASSERT_ATN(slp);
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_NULL);
}
/*=============================================================
* START OF OS switch (All OS depend fucntions should be here)
=============================================================*/
/* common os depend utitlities */
#define SCSI_LOW_CMD_RESIDUAL_CHK 0x0001
#define SCSI_LOW_CMD_ORDERED_QTAG 0x0002
#define SCSI_LOW_CMD_ABORT_WARNING 0x0004
static u_int8_t scsi_low_cmd_flags[256] = {
/* 0 1 2 3 4 5 6 7 8 9 a b c d e f */
/*0*/ 0, 0, 0, 0, 0, 0, 0, 0, 5, 0, 5, 0, 0, 0, 0, 0,
/*1*/ 0, 0, 0, 0, 0, 0, 2, 2, 0, 0, 0, 0, 0, 0, 0, 0,
/*2*/ 0, 0, 0, 0, 0, 0, 0, 0, 5, 0, 5, 0, 0, 0, 5, 5,
/*3*/ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 5, 5,
};
struct scsi_low_error_code {
int error_bits;
int error_code;
};
static struct slccb *scsi_low_find_ccb(struct scsi_low_softc *, u_int, u_int, void *);
static int scsi_low_translate_error_code(struct slccb *, struct scsi_low_error_code *);
static struct slccb *
scsi_low_find_ccb(slp, target, lun, osdep)
struct scsi_low_softc *slp;
u_int target, lun;
void *osdep;
{
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
ti = slp->sl_ti[target];
li = scsi_low_alloc_li(ti, lun, 0);
if (li == NULL)
return NULL;
if ((cb = slp->sl_Qnexus) != NULL && cb->osdep == osdep)
return cb;
TAILQ_FOREACH(cb, &slp->sl_start, ccb_chain)
{
if (cb->osdep == osdep)
return cb;
}
TAILQ_FOREACH(cb, &li->li_discq, ccb_chain)
{
if (cb->osdep == osdep)
return cb;
}
return NULL;
}
static int
scsi_low_translate_error_code(cb, tp)
struct slccb *cb;
struct scsi_low_error_code *tp;
{
if (cb->ccb_error == 0)
return tp->error_code;
for (tp ++; (cb->ccb_error & tp->error_bits) == 0; tp ++)
;
return tp->error_code;
}
/**************************************************************
* SCSI INTERFACE (CAM)
**************************************************************/
#define SCSI_LOW_MALLOC(size) malloc((size), M_SCSILOW, M_NOWAIT)
#define SCSI_LOW_FREE(pt) free((pt), M_SCSILOW)
#define SCSI_LOW_ALLOC_CCB(flags) scsi_low_get_ccb()
static void scsi_low_poll_cam(struct cam_sim *);
void scsi_low_scsi_action_cam(struct cam_sim *, union ccb *);
static int scsi_low_attach_cam(struct scsi_low_softc *);
static int scsi_low_detach_cam(struct scsi_low_softc *);
static int scsi_low_ccb_setup_cam(struct scsi_low_softc *, struct slccb *);
static int scsi_low_done_cam(struct scsi_low_softc *, struct slccb *);
struct scsi_low_error_code scsi_low_error_code_cam[] = {
{0, CAM_REQ_CMP},
{SENSEIO, CAM_AUTOSNS_VALID | CAM_REQ_CMP_ERR},
{SENSEERR, CAM_AUTOSENSE_FAIL},
{UACAERR, CAM_SCSI_STATUS_ERROR},
{BUSYERR | STATERR, CAM_SCSI_STATUS_ERROR},
{SELTIMEOUTIO, CAM_SEL_TIMEOUT},
{TIMEOUTIO, CAM_CMD_TIMEOUT},
{PDMAERR, CAM_DATA_RUN_ERR},
{PARITYERR, CAM_UNCOR_PARITY},
{UBFERR, CAM_UNEXP_BUSFREE},
{ABORTIO, CAM_REQ_ABORTED},
{-1, CAM_UNREC_HBA_ERROR}
};
#define SIM2SLP(sim) ((struct scsi_low_softc *) cam_sim_softc((sim)))
/* XXX:
* Please check a polling hz, currently we assume scsi_low_poll() is
* called each 1 ms.
*/
#define SCSI_LOW_CAM_POLL_HZ 1000 /* OK ? */
static void
scsi_low_poll_cam(sim)
struct cam_sim *sim;
{
struct scsi_low_softc *slp = SIM2SLP(sim);
SCSI_LOW_ASSERT_LOCKED(slp);
(*slp->sl_funcs->scsi_low_poll) (slp);
if (slp->sl_poll_count ++ >=
SCSI_LOW_CAM_POLL_HZ / SCSI_LOW_TIMEOUT_HZ)
{
slp->sl_poll_count = 0;
scsi_low_timeout_check(slp);
}
}
void
scsi_low_scsi_action_cam(sim, ccb)
struct cam_sim *sim;
union ccb *ccb;
{
struct scsi_low_softc *slp = SIM2SLP(sim);
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
u_int lun, flags, msg, target;
int rv;
SCSI_LOW_ASSERT_LOCKED(slp);
target = (u_int) (ccb->ccb_h.target_id);
lun = (u_int) ccb->ccb_h.target_lun;
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_GO(SCSI_LOW_DEBUG_ACTION, target) != 0)
{
device_printf(slp->sl_dev,
"cam_action: func code 0x%x target: %d, lun: %d\n",
ccb->ccb_h.func_code, target, lun);
}
#endif /* SCSI_LOW_DEBUG */
switch (ccb->ccb_h.func_code) {
case XPT_SCSI_IO: /* Execute the requested I/O operation */
#ifdef SCSI_LOW_DIAGNOSTIC
if (target == CAM_TARGET_WILDCARD || lun == CAM_LUN_WILDCARD)
{
device_printf(slp->sl_dev, "invalid target/lun\n");
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
return;
}
#endif /* SCSI_LOW_DIAGNOSTIC */
if (((cb = SCSI_LOW_ALLOC_CCB(1)) == NULL)) {
ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
xpt_done(ccb);
return;
}
ti = slp->sl_ti[target];
cb->osdep = ccb;
cb->bp = NULL;
if ((ccb->ccb_h.flags & CAM_DIS_AUTOSENSE) == 0)
flags = CCB_AUTOSENSE | CCB_SCSIIO;
else
flags = CCB_SCSIIO;
li = scsi_low_alloc_li(ti, lun, 1);
if (ti->ti_setup_msg != 0)
{
scsi_low_message_enqueue(slp, ti, li, CCB_AUTOSENSE);
}
scsi_low_enqueue(slp, ti, li, cb, flags, 0);
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_ABORT_CHECK, target) != 0)
{
scsi_low_test_abort(slp, ti, li);
}
#endif /* SCSI_LOW_DEBUG */
break;
case XPT_ABORT: /* Abort the specified CCB */
#ifdef SCSI_LOW_DIAGNOSTIC
if (target == CAM_TARGET_WILDCARD || lun == CAM_LUN_WILDCARD)
{
device_printf(slp->sl_dev, "invalid target/lun\n");
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
return;
}
#endif /* SCSI_LOW_DIAGNOSTIC */
cb = scsi_low_find_ccb(slp, target, lun, ccb->cab.abort_ccb);
rv = scsi_low_abort_ccb(slp, cb);
if (rv == 0)
ccb->ccb_h.status = CAM_REQ_CMP;
else
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
break;
case XPT_SET_TRAN_SETTINGS: {
struct ccb_trans_settings_scsi *scsi;
struct ccb_trans_settings_spi *spi;
struct ccb_trans_settings *cts;
u_int val;
#ifdef SCSI_LOW_DIAGNOSTIC
if (target == CAM_TARGET_WILDCARD)
{
device_printf(slp->sl_dev, "invalid target\n");
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
return;
}
#endif /* SCSI_LOW_DIAGNOSTIC */
cts = &ccb->cts;
ti = slp->sl_ti[target];
if (lun == CAM_LUN_WILDCARD)
lun = 0;
scsi = &cts->proto_specific.scsi;
spi = &cts->xport_specific.spi;
if ((spi->valid & (CTS_SPI_VALID_BUS_WIDTH |
CTS_SPI_VALID_SYNC_RATE |
CTS_SPI_VALID_SYNC_OFFSET)) != 0)
{
if (spi->valid & CTS_SPI_VALID_BUS_WIDTH) {
val = spi->bus_width;
if (val < ti->ti_width)
ti->ti_width = val;
}
if (spi->valid & CTS_SPI_VALID_SYNC_RATE) {
val = spi->sync_period;
if (val == 0 || val > ti->ti_maxsynch.period)
ti->ti_maxsynch.period = val;
}
if (spi->valid & CTS_SPI_VALID_SYNC_OFFSET) {
val = spi->sync_offset;
if (val < ti->ti_maxsynch.offset)
ti->ti_maxsynch.offset = val;
}
ti->ti_flags_valid |= SCSI_LOW_TARG_FLAGS_QUIRKS_VALID;
scsi_low_calcf_target(ti);
}
if ((spi->valid & CTS_SPI_FLAGS_DISC_ENB) != 0 ||
(scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0) {
li = scsi_low_alloc_li(ti, lun, 1);
if (spi->valid & CTS_SPI_FLAGS_DISC_ENB) {
li->li_quirks |= SCSI_LOW_DISK_DISC;
} else {
li->li_quirks &= ~SCSI_LOW_DISK_DISC;
}
if (scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) {
li->li_quirks |= SCSI_LOW_DISK_QTAG;
} else {
li->li_quirks &= ~SCSI_LOW_DISK_QTAG;
}
li->li_flags_valid |= SCSI_LOW_LUN_FLAGS_QUIRKS_VALID;
scsi_low_calcf_target(ti);
scsi_low_calcf_lun(li);
if ((slp->sl_show_result & SHOW_CALCF_RES) != 0)
scsi_low_calcf_show(li);
}
ccb->ccb_h.status = CAM_REQ_CMP;
xpt_done(ccb);
break;
}
case XPT_GET_TRAN_SETTINGS: {
struct ccb_trans_settings *cts;
u_int diskflags;
cts = &ccb->cts;
#ifdef SCSI_LOW_DIAGNOSTIC
if (target == CAM_TARGET_WILDCARD)
{
device_printf(slp->sl_dev, "invalid target\n");
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
return;
}
#endif /* SCSI_LOW_DIAGNOSTIC */
ti = slp->sl_ti[target];
if (lun == CAM_LUN_WILDCARD)
lun = 0;
li = scsi_low_alloc_li(ti, lun, 1);
if (li != NULL && cts->type == CTS_TYPE_CURRENT_SETTINGS) {
struct ccb_trans_settings_scsi *scsi =
&cts->proto_specific.scsi;
struct ccb_trans_settings_spi *spi =
&cts->xport_specific.spi;
#ifdef SCSI_LOW_DIAGNOSTIC
if (li->li_flags_valid != SCSI_LOW_LUN_FLAGS_ALL_VALID)
{
ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
device_printf(slp->sl_dev,
"invalid GET_TRANS_CURRENT_SETTINGS call\n");
goto settings_out;
}
#endif /* SCSI_LOW_DIAGNOSTIC */
cts->protocol = PROTO_SCSI;
cts->protocol_version = SCSI_REV_2;
cts->transport = XPORT_SPI;
cts->transport_version = 2;
scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB;
spi->flags &= ~CTS_SPI_FLAGS_DISC_ENB;
diskflags = li->li_diskflags & li->li_cfgflags;
if (diskflags & SCSI_LOW_DISK_DISC)
spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
if (diskflags & SCSI_LOW_DISK_QTAG)
scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
spi->sync_period = ti->ti_maxsynch.period;
spi->valid |= CTS_SPI_VALID_SYNC_RATE;
spi->sync_offset = ti->ti_maxsynch.offset;
spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
spi->valid |= CTS_SPI_VALID_BUS_WIDTH;
spi->bus_width = ti->ti_width;
if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
scsi->valid = CTS_SCSI_VALID_TQ;
spi->valid |= CTS_SPI_VALID_DISC;
} else
scsi->valid = 0;
} else
ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
settings_out:
xpt_done(ccb);
break;
}
case XPT_CALC_GEOMETRY: { /* not yet HN2 */
cam_calc_geometry(&ccb->ccg, /*extended*/1);
xpt_done(ccb);
break;
}
case XPT_RESET_BUS: /* Reset the specified SCSI bus */
scsi_low_restart(slp, SCSI_LOW_RESTART_HARD, NULL);
ccb->ccb_h.status = CAM_REQ_CMP;
xpt_done(ccb);
break;
case XPT_TERM_IO: /* Terminate the I/O process */
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
break;
case XPT_RESET_DEV: /* Bus Device Reset the specified SCSI device */
#ifdef SCSI_LOW_DIAGNOSTIC
if (target == CAM_TARGET_WILDCARD)
{
device_printf(slp->sl_dev, "invalid target\n");
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
return;
}
#endif /* SCSI_LOW_DIAGNOSTIC */
msg = SCSI_LOW_MSG_RESET;
if (((cb = SCSI_LOW_ALLOC_CCB(1)) == NULL))
{
ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
xpt_done(ccb);
return;
}
ti = slp->sl_ti[target];
if (lun == CAM_LUN_WILDCARD)
lun = 0;
cb->osdep = ccb;
cb->bp = NULL;
if ((ccb->ccb_h.flags & CAM_DIS_AUTOSENSE) == 0)
flags = CCB_AUTOSENSE | CCB_NORETRY | CCB_URGENT;
else
flags = CCB_NORETRY | CCB_URGENT;
li = scsi_low_alloc_li(ti, lun, 1);
scsi_low_enqueue(slp, ti, li, cb, flags, msg);
break;
case XPT_PATH_INQ: { /* Path routing inquiry */
struct ccb_pathinq *cpi = &ccb->cpi;
cpi->version_num = scsi_low_version_major;
cpi->hba_inquiry = PI_TAG_ABLE | PI_LINKED_CDB;
ti = slp->sl_ti[slp->sl_hostid]; /* host id */
if (ti->ti_width > SCSI_LOW_BUS_WIDTH_8)
cpi->hba_inquiry |= PI_WIDE_16;
if (ti->ti_width > SCSI_LOW_BUS_WIDTH_16)
cpi->hba_inquiry |= PI_WIDE_32;
if (ti->ti_maxsynch.offset > 0)
cpi->hba_inquiry |= PI_SDTR_ABLE;
cpi->target_sprt = 0;
cpi->hba_misc = 0;
cpi->hba_eng_cnt = 0;
cpi->max_target = slp->sl_ntargs - 1;
cpi->max_lun = slp->sl_nluns - 1;
cpi->initiator_id = slp->sl_hostid;
cpi->bus_id = cam_sim_bus(sim);
cpi->base_transfer_speed = 3300;
cpi->transport = XPORT_SPI;
cpi->transport_version = 2;
cpi->protocol = PROTO_SCSI;
cpi->protocol_version = SCSI_REV_2;
strlcpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
strlcpy(cpi->hba_vid, "SCSI_LOW", HBA_IDLEN);
strlcpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
cpi->unit_number = cam_sim_unit(sim);
cpi->ccb_h.status = CAM_REQ_CMP;
xpt_done(ccb);
break;
}
default:
printf("scsi_low: non support func_code = %d ",
ccb->ccb_h.func_code);
ccb->ccb_h.status = CAM_REQ_INVALID;
xpt_done(ccb);
break;
}
}
static int
scsi_low_attach_cam(slp)
struct scsi_low_softc *slp;
{
struct cam_devq *devq;
int tagged_openings;
devq = cam_simq_alloc(SCSI_LOW_NCCB);
if (devq == NULL)
return (ENOMEM);
/*
* ask the adapter what subunits are present
*/
tagged_openings = min(slp->sl_openings, SCSI_LOW_MAXNEXUS);
slp->sl_sim = cam_sim_alloc(scsi_low_scsi_action_cam,
scsi_low_poll_cam,
device_get_name(slp->sl_dev), slp,
device_get_unit(slp->sl_dev), &slp->sl_lock,
slp->sl_openings, tagged_openings, devq);
if (slp->sl_sim == NULL) {
cam_simq_free(devq);
return ENODEV;
}
SCSI_LOW_LOCK(slp);
if (xpt_bus_register(slp->sl_sim, slp->sl_dev, 0) != CAM_SUCCESS) {
cam_sim_free(slp->sl_sim, TRUE);
SCSI_LOW_UNLOCK(slp);
return ENODEV;
}
if (xpt_create_path(&slp->sl_path, /*periph*/NULL,
cam_sim_path(slp->sl_sim), CAM_TARGET_WILDCARD,
CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
xpt_bus_deregister(cam_sim_path(slp->sl_sim));
cam_sim_free(slp->sl_sim, /*free_simq*/TRUE);
SCSI_LOW_UNLOCK(slp);
return ENODEV;
}
slp->sl_show_result = SHOW_CALCF_RES; /* OK ? */
SCSI_LOW_UNLOCK(slp);
return 0;
}
static int
scsi_low_detach_cam(slp)
struct scsi_low_softc *slp;
{
xpt_async(AC_LOST_DEVICE, slp->sl_path, NULL);
xpt_free_path(slp->sl_path);
xpt_bus_deregister(cam_sim_path(slp->sl_sim));
cam_sim_free(slp->sl_sim, /* free_devq */ TRUE);
return 0;
}
static int
scsi_low_ccb_setup_cam(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
union ccb *ccb = (union ccb *) cb->osdep;
if ((cb->ccb_flags & CCB_SCSIIO) != 0)
{
cb->ccb_scp.scp_cmd = ccb->csio.cdb_io.cdb_bytes;
cb->ccb_scp.scp_cmdlen = (int) ccb->csio.cdb_len;
cb->ccb_scp.scp_data = ccb->csio.data_ptr;
cb->ccb_scp.scp_datalen = (int) ccb->csio.dxfer_len;
if((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
cb->ccb_scp.scp_direction = SCSI_LOW_WRITE;
else /* if((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) */
cb->ccb_scp.scp_direction = SCSI_LOW_READ;
cb->ccb_tcmax = ccb->ccb_h.timeout / 1000;
}
else
{
scsi_low_unit_ready_cmd(cb);
}
return SCSI_LOW_START_QTAG;
}
static int
scsi_low_done_cam(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
union ccb *ccb;
ccb = (union ccb *) cb->osdep;
if (cb->ccb_error == 0)
{
ccb->ccb_h.status = CAM_REQ_CMP;
ccb->csio.resid = 0;
}
else
{
if (cb->ccb_rcnt >= slp->sl_max_retry)
cb->ccb_error |= ABORTIO;
if ((cb->ccb_flags & CCB_NORETRY) == 0 &&
(cb->ccb_error & ABORTIO) == 0)
return EJUSTRETURN;
if ((cb->ccb_error & SENSEIO) != 0)
{
memcpy(&ccb->csio.sense_data,
&cb->ccb_sense,
sizeof(ccb->csio.sense_data));
}
ccb->ccb_h.status = scsi_low_translate_error_code(cb,
&scsi_low_error_code_cam[0]);
#ifdef SCSI_LOW_DIAGNOSTIC
if ((cb->ccb_flags & CCB_SILENT) == 0 &&
cb->ccb_scp.scp_cmdlen > 0 &&
(scsi_low_cmd_flags[cb->ccb_scp.scp_cmd[0]] &
SCSI_LOW_CMD_ABORT_WARNING) != 0)
{
device_printf(slp->sl_dev,
"WARNING: scsi_low IO abort\n");
scsi_low_print(slp, NULL);
}
#endif /* SCSI_LOW_DIAGNOSTIC */
}
if ((ccb->ccb_h.status & CAM_STATUS_MASK) == 0)
ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
if (cb->ccb_scp.scp_status == ST_UNKNOWN)
ccb->csio.scsi_status = 0; /* XXX */
else
ccb->csio.scsi_status = cb->ccb_scp.scp_status;
if ((cb->ccb_flags & CCB_NOSDONE) == 0)
xpt_done(ccb);
return 0;
}
/**************************************************************
* scsi low deactivate and activate
**************************************************************/
int
scsi_low_is_busy(slp)
struct scsi_low_softc *slp;
{
if (slp->sl_nio > 0)
return EBUSY;
return 0;
}
int
scsi_low_deactivate(slp)
struct scsi_low_softc *slp;
{
slp->sl_flags |= HW_INACTIVE;
callout_stop(&slp->sl_timeout_timer);
callout_stop(&slp->sl_engage_timer);
return 0;
}
int
scsi_low_activate(slp)
struct scsi_low_softc *slp;
{
int error;
slp->sl_flags &= ~HW_INACTIVE;
if ((error = scsi_low_restart(slp, SCSI_LOW_RESTART_HARD, NULL)) != 0)
{
slp->sl_flags |= HW_INACTIVE;
return error;
}
slp->sl_timeout_count = 0;
callout_reset(&slp->sl_timeout_timer, hz / SCSI_LOW_TIMEOUT_HZ,
scsi_low_timeout, slp);
return 0;
}
/**************************************************************
* scsi low log
**************************************************************/
#ifdef SCSI_LOW_DIAGNOSTIC
static void scsi_low_msg_log_init(struct scsi_low_msg_log *);
static void scsi_low_msg_log_write(struct scsi_low_msg_log *, u_int8_t *, int);
static void scsi_low_msg_log_show(struct scsi_low_msg_log *, char *, int);
static void
scsi_low_msg_log_init(slmlp)
struct scsi_low_msg_log *slmlp;
{
slmlp->slml_ptr = 0;
}
static void
scsi_low_msg_log_write(slmlp, datap, len)
struct scsi_low_msg_log *slmlp;
u_int8_t *datap;
int len;
{
int ptr, ind;
if (slmlp->slml_ptr >= SCSI_LOW_MSG_LOG_DATALEN)
return;
ptr = slmlp->slml_ptr ++;
for (ind = 0; ind < sizeof(slmlp->slml_msg[0]) && ind < len; ind ++)
slmlp->slml_msg[ptr].msg[ind] = datap[ind];
for ( ; ind < sizeof(slmlp->slml_msg[0]); ind ++)
slmlp->slml_msg[ptr].msg[ind] = 0;
}
static void
scsi_low_msg_log_show(slmlp, s, len)
struct scsi_low_msg_log *slmlp;
char *s;
int len;
{
int ptr, ind;
printf("%s: (%d) ", s, slmlp->slml_ptr);
for (ptr = 0; ptr < slmlp->slml_ptr; ptr ++)
{
for (ind = 0; ind < len && ind < sizeof(slmlp->slml_msg[0]);
ind ++)
{
printf("[%x]", (u_int) slmlp->slml_msg[ptr].msg[ind]);
}
printf(">");
}
printf("\n");
}
#endif /* SCSI_LOW_DIAGNOSTIC */
/**************************************************************
* power control
**************************************************************/
static void
scsi_low_engage(arg)
void *arg;
{
struct scsi_low_softc *slp = arg;
SCSI_LOW_ASSERT_LOCKED(slp);
switch (slp->sl_rstep)
{
case 0:
slp->sl_rstep ++;
(*slp->sl_funcs->scsi_low_power) (slp, SCSI_LOW_ENGAGE);
callout_reset(&slp->sl_engage_timer, hz / 1000,
scsi_low_engage, slp);
break;
case 1:
slp->sl_rstep ++;
slp->sl_flags &= ~HW_RESUME;
scsi_low_start(slp);
break;
case 2:
break;
}
}
static int
scsi_low_init(slp, flags)
struct scsi_low_softc *slp;
u_int flags;
{
int rv = 0;
slp->sl_flags |= HW_INITIALIZING;
/* clear power control timeout */
if ((slp->sl_flags & HW_POWERCTRL) != 0)
{
callout_stop(&slp->sl_engage_timer);
slp->sl_flags &= ~(HW_POWDOWN | HW_RESUME);
slp->sl_active = 1;
slp->sl_powc = SCSI_LOW_POWDOWN_TC;
}
/* reset current nexus */
scsi_low_reset_nexus(slp, flags);
if ((slp->sl_flags & HW_INACTIVE) != 0)
{
rv = EBUSY;
goto out;
}
if (flags != SCSI_LOW_RESTART_SOFT)
{
rv = ((*slp->sl_funcs->scsi_low_init) (slp, flags));
}
out:
slp->sl_flags &= ~HW_INITIALIZING;
return rv;
}
/**************************************************************
* allocate lun_info
**************************************************************/
static struct lun_info *
scsi_low_alloc_li(ti, lun, alloc)
struct targ_info *ti;
int lun;
int alloc;
{
struct scsi_low_softc *slp = ti->ti_sc;
struct lun_info *li;
li = LIST_FIRST(&ti->ti_litab);
if (li != NULL)
{
if (li->li_lun == lun)
return li;
while ((li = LIST_NEXT(li, lun_chain)) != NULL)
{
if (li->li_lun == lun)
{
LIST_REMOVE(li, lun_chain);
LIST_INSERT_HEAD(&ti->ti_litab, li, lun_chain);
return li;
}
}
}
if (alloc == 0)
return li;
li = SCSI_LOW_MALLOC(ti->ti_lunsize);
if (li == NULL)
panic("no lun info mem");
bzero(li, ti->ti_lunsize);
li->li_lun = lun;
li->li_ti = ti;
li->li_cfgflags = SCSI_LOW_SYNC | SCSI_LOW_LINK | SCSI_LOW_DISC |
SCSI_LOW_QTAG;
li->li_quirks = li->li_diskflags = SCSI_LOW_DISK_LFLAGS;
li->li_flags_valid = SCSI_LOW_LUN_FLAGS_USER_VALID;
#ifdef SCSI_LOW_FLAGS_QUIRKS_OK
li->li_flags_valid |= SCSI_LOW_LUN_FLAGS_QUIRKS_VALID;
#endif /* SCSI_LOW_FLAGS_QUIRKS_OK */
li->li_qtagbits = (u_int) -1;
TAILQ_INIT(&li->li_discq);
LIST_INSERT_HEAD(&ti->ti_litab, li, lun_chain);
/* host specific structure initialization per lun */
if (slp->sl_funcs->scsi_low_lun_init != NULL)
(*slp->sl_funcs->scsi_low_lun_init)
(slp, ti, li, SCSI_LOW_INFO_ALLOC);
scsi_low_calcf_lun(li);
return li;
}
/**************************************************************
* allocate targ_info
**************************************************************/
static struct targ_info *
scsi_low_alloc_ti(slp, targ)
struct scsi_low_softc *slp;
int targ;
{
struct targ_info *ti;
if (TAILQ_FIRST(&slp->sl_titab) == NULL)
TAILQ_INIT(&slp->sl_titab);
ti = SCSI_LOW_MALLOC(slp->sl_targsize);
if (ti == NULL)
panic("%s short of memory", device_get_nameunit(slp->sl_dev));
bzero(ti, slp->sl_targsize);
ti->ti_id = targ;
ti->ti_sc = slp;
slp->sl_ti[targ] = ti;
TAILQ_INSERT_TAIL(&slp->sl_titab, ti, ti_chain);
LIST_INIT(&ti->ti_litab);
ti->ti_quirks = ti->ti_diskflags = SCSI_LOW_DISK_TFLAGS;
ti->ti_owidth = SCSI_LOW_BUS_WIDTH_8;
ti->ti_flags_valid = SCSI_LOW_TARG_FLAGS_USER_VALID;
#ifdef SCSI_LOW_FLAGS_QUIRKS_OK
ti->ti_flags_valid |= SCSI_LOW_TARG_FLAGS_QUIRKS_VALID;
#endif /* SCSI_LOW_FLAGS_QUIRKS_OK */
if (slp->sl_funcs->scsi_low_targ_init != NULL)
{
(*slp->sl_funcs->scsi_low_targ_init)
(slp, ti, SCSI_LOW_INFO_ALLOC);
}
scsi_low_calcf_target(ti);
return ti;
}
static void
scsi_low_free_ti(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti, *tib;
struct lun_info *li, *nli;
for (ti = TAILQ_FIRST(&slp->sl_titab); ti; ti = tib)
{
for (li = LIST_FIRST(&ti->ti_litab); li != NULL; li = nli)
{
if (slp->sl_funcs->scsi_low_lun_init != NULL)
{
(*slp->sl_funcs->scsi_low_lun_init)
(slp, ti, li, SCSI_LOW_INFO_DEALLOC);
}
nli = LIST_NEXT(li, lun_chain);
SCSI_LOW_FREE(li);
}
if (slp->sl_funcs->scsi_low_targ_init != NULL)
{
(*slp->sl_funcs->scsi_low_targ_init)
(slp, ti, SCSI_LOW_INFO_DEALLOC);
}
tib = TAILQ_NEXT(ti, ti_chain);
SCSI_LOW_FREE(ti);
}
}
/**************************************************************
* timeout
**************************************************************/
void
scsi_low_bus_idle(slp)
struct scsi_low_softc *slp;
{
slp->sl_retry_sel = 0;
if (slp->sl_Tnexus == NULL)
scsi_low_start(slp);
}
static void
scsi_low_timeout(arg)
void *arg;
{
struct scsi_low_softc *slp = arg;
SCSI_LOW_ASSERT_LOCKED(slp);
(void) scsi_low_timeout_check(slp);
callout_schedule(&slp->sl_timeout_timer, hz / SCSI_LOW_TIMEOUT_HZ);
}
static int
scsi_low_timeout_check(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb = NULL; /* XXX */
/* selection restart */
if (slp->sl_retry_sel != 0)
{
slp->sl_retry_sel = 0;
if (slp->sl_Tnexus != NULL)
goto step1;
cb = TAILQ_FIRST(&slp->sl_start);
if (cb == NULL)
goto step1;
if (cb->ccb_selrcnt >= SCSI_LOW_MAX_SELECTION_RETRY)
{
cb->ccb_flags |= CCB_NORETRY;
cb->ccb_error |= SELTIMEOUTIO;
if (scsi_low_revoke_ccb(slp, cb, 1) != NULL)
panic("%s: ccb not finished",
device_get_nameunit(slp->sl_dev));
}
if (slp->sl_Tnexus == NULL)
scsi_low_start(slp);
}
/* call hardware timeout */
step1:
if (slp->sl_funcs->scsi_low_timeout != NULL)
{
(*slp->sl_funcs->scsi_low_timeout) (slp);
}
if (slp->sl_timeout_count ++ <
SCSI_LOW_TIMEOUT_CHECK_INTERVAL * SCSI_LOW_TIMEOUT_HZ)
return 0;
slp->sl_timeout_count = 0;
if (slp->sl_nio > 0)
{
if ((cb = slp->sl_Qnexus) != NULL)
{
cb->ccb_tc -= SCSI_LOW_TIMEOUT_CHECK_INTERVAL;
if (cb->ccb_tc < 0)
goto bus_reset;
}
else if (slp->sl_disc == 0)
{
if ((cb = TAILQ_FIRST(&slp->sl_start)) == NULL)
return 0;
cb->ccb_tc -= SCSI_LOW_TIMEOUT_CHECK_INTERVAL;
if (cb->ccb_tc < 0)
goto bus_reset;
}
else for (ti = TAILQ_FIRST(&slp->sl_titab); ti != NULL;
ti = TAILQ_NEXT(ti, ti_chain))
{
if (ti->ti_disc == 0)
continue;
for (li = LIST_FIRST(&ti->ti_litab); li != NULL;
li = LIST_NEXT(li, lun_chain))
{
for (cb = TAILQ_FIRST(&li->li_discq);
cb != NULL;
cb = TAILQ_NEXT(cb, ccb_chain))
{
cb->ccb_tc -=
SCSI_LOW_TIMEOUT_CHECK_INTERVAL;
if (cb->ccb_tc < 0)
goto bus_reset;
}
}
}
}
else if ((slp->sl_flags & HW_POWERCTRL) != 0)
{
if ((slp->sl_flags & (HW_POWDOWN | HW_RESUME)) != 0)
return 0;
if (slp->sl_active != 0)
{
slp->sl_powc = SCSI_LOW_POWDOWN_TC;
slp->sl_active = 0;
return 0;
}
slp->sl_powc --;
if (slp->sl_powc < 0)
{
slp->sl_powc = SCSI_LOW_POWDOWN_TC;
slp->sl_flags |= HW_POWDOWN;
(*slp->sl_funcs->scsi_low_power)
(slp, SCSI_LOW_POWDOWN);
}
}
return 0;
bus_reset:
cb->ccb_error |= TIMEOUTIO;
device_printf(slp->sl_dev, "slccb (0x%lx) timeout!\n", (u_long) cb);
scsi_low_info(slp, NULL, "scsi bus hangup. try to recover.");
scsi_low_init(slp, SCSI_LOW_RESTART_HARD);
scsi_low_start(slp);
return ERESTART;
}
static int
scsi_low_abort_ccb(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
struct targ_info *ti;
struct lun_info *li;
u_int msg;
if (cb == NULL)
return EINVAL;
if ((cb->ccb_omsgoutflag &
(SCSI_LOW_MSG_ABORT | SCSI_LOW_MSG_ABORT_QTAG)) != 0)
return EBUSY;
ti = cb->ti;
li = cb->li;
if (cb->ccb_tag == SCSI_LOW_UNKTAG)
msg = SCSI_LOW_MSG_ABORT;
else
msg = SCSI_LOW_MSG_ABORT_QTAG;
cb->ccb_error |= ABORTIO;
cb->ccb_flags |= CCB_NORETRY;
scsi_low_ccb_message_assert(cb, msg);
if (cb == slp->sl_Qnexus)
{
scsi_low_assert_msg(slp, ti, msg, 1);
}
else if ((cb->ccb_flags & CCB_DISCQ) != 0)
{
if (scsi_low_revoke_ccb(slp, cb, 0) == NULL)
panic("%s: revoked ccb done",
device_get_nameunit(slp->sl_dev));
cb->ccb_flags |= CCB_STARTQ;
TAILQ_INSERT_HEAD(&slp->sl_start, cb, ccb_chain);
if (slp->sl_Tnexus == NULL)
scsi_low_start(slp);
}
else
{
if (scsi_low_revoke_ccb(slp, cb, 1) != NULL)
panic("%s: revoked ccb retried",
device_get_nameunit(slp->sl_dev));
}
return 0;
}
/**************************************************************
* Generic SCSI INTERFACE
**************************************************************/
int
scsi_low_attach(slp, openings, ntargs, nluns, targsize, lunsize)
struct scsi_low_softc *slp;
int openings, ntargs, nluns, targsize, lunsize;
{
struct targ_info *ti;
struct lun_info *li;
int i, nccb, rv;
if (ntargs > SCSI_LOW_NTARGETS)
{
printf("scsi_low: %d targets are too large\n", ntargs);
printf("change kernel options SCSI_LOW_NTARGETS");
return EINVAL;
}
if (openings <= 0)
slp->sl_openings = (SCSI_LOW_NCCB / ntargs);
else
slp->sl_openings = openings;
slp->sl_ntargs = ntargs;
slp->sl_nluns = nluns;
slp->sl_max_retry = SCSI_LOW_MAX_RETRY;
if (lunsize < sizeof(struct lun_info))
lunsize = sizeof(struct lun_info);
if (targsize < sizeof(struct targ_info))
targsize = sizeof(struct targ_info);
slp->sl_targsize = targsize;
for (i = 0; i < ntargs; i ++)
{
ti = scsi_low_alloc_ti(slp, i);
ti->ti_lunsize = lunsize;
li = scsi_low_alloc_li(ti, 0, 1);
}
/* initialize queue */
nccb = openings * ntargs;
if (nccb >= SCSI_LOW_NCCB || nccb <= 0)
nccb = SCSI_LOW_NCCB;
scsi_low_init_ccbque(nccb);
TAILQ_INIT(&slp->sl_start);
/* call os depend attach */
rv = scsi_low_attach_cam(slp);
if (rv != 0)
{
device_printf(slp->sl_dev,
"scsi_low_attach: osdep attach failed\n");
return (rv);
}
/* check hardware */
DELAY(1000); /* wait for 1ms */
SCSI_LOW_LOCK(slp);
if (scsi_low_init(slp, SCSI_LOW_RESTART_HARD) != 0)
{
device_printf(slp->sl_dev,
"scsi_low_attach: initialization failed\n");
SCSI_LOW_UNLOCK(slp);
return EINVAL;
}
/* start watch dog */
slp->sl_timeout_count = 0;
callout_reset(&slp->sl_timeout_timer, hz / SCSI_LOW_TIMEOUT_HZ,
scsi_low_timeout, slp);
mtx_lock(&sl_tab_lock);
LIST_INSERT_HEAD(&sl_tab, slp, sl_chain);
mtx_unlock(&sl_tab_lock);
/* fake call */
scsi_low_abort_ccb(slp, scsi_low_find_ccb(slp, 0, 0, NULL));
#ifdef SCSI_LOW_START_UP_CHECK
/* probing devices */
scsi_low_start_up(slp);
#endif /* SCSI_LOW_START_UP_CHECK */
SCSI_LOW_UNLOCK(slp);
return 0;
}
int
scsi_low_detach(slp)
struct scsi_low_softc *slp;
{
int rv;
SCSI_LOW_LOCK(slp);
if (scsi_low_is_busy(slp) != 0)
{
SCSI_LOW_UNLOCK(slp);
return EBUSY;
}
scsi_low_deactivate(slp);
rv = scsi_low_detach_cam(slp);
if (rv != 0)
{
SCSI_LOW_UNLOCK(slp);
return EBUSY;
}
scsi_low_free_ti(slp);
SCSI_LOW_UNLOCK(slp);
callout_drain(&slp->sl_timeout_timer);
callout_drain(&slp->sl_engage_timer);
mtx_lock(&sl_tab_lock);
LIST_REMOVE(slp, sl_chain);
mtx_unlock(&sl_tab_lock);
return 0;
}
/**************************************************************
* Generic enqueue
**************************************************************/
static int
scsi_low_enqueue(slp, ti, li, cb, flags, msg)
struct scsi_low_softc *slp;
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
u_int flags, msg;
{
cb->ti = ti;
cb->li = li;
scsi_low_ccb_message_assert(cb, msg);
cb->ccb_otag = cb->ccb_tag = SCSI_LOW_UNKTAG;
scsi_low_alloc_qtag(cb);
cb->ccb_flags = flags | CCB_STARTQ;
cb->ccb_tc = cb->ccb_tcmax = SCSI_LOW_MIN_TOUT;
cb->ccb_error |= PENDINGIO;
if ((flags & CCB_URGENT) != 0)
{
TAILQ_INSERT_HEAD(&slp->sl_start, cb, ccb_chain);
}
else
{
TAILQ_INSERT_TAIL(&slp->sl_start, cb, ccb_chain);
}
slp->sl_nio ++;
if (slp->sl_Tnexus == NULL)
scsi_low_start(slp);
return 0;
}
static int
scsi_low_message_enqueue(slp, ti, li, flags)
struct scsi_low_softc *slp;
struct targ_info *ti;
struct lun_info *li;
u_int flags;
{
struct slccb *cb;
u_int tmsgflags;
tmsgflags = ti->ti_setup_msg;
ti->ti_setup_msg = 0;
flags |= CCB_NORETRY;
if ((cb = SCSI_LOW_ALLOC_CCB(1)) == NULL)
return ENOMEM;
cb->osdep = NULL;
cb->bp = NULL;
scsi_low_enqueue(slp, ti, li, cb, flags, tmsgflags);
return 0;
}
/**************************************************************
* Generic Start & Done
**************************************************************/
#define SLSC_MODE_SENSE_SHORT 0x1a
static u_int8_t ss_cmd[6] = {START_STOP, 0, 0, 0, SSS_START, 0};
static u_int8_t sms_cmd[6] = {SLSC_MODE_SENSE_SHORT, 0x08, 0x0a, 0,
sizeof(struct scsi_low_mode_sense_data), 0};
static u_int8_t inq_cmd[6] = {INQUIRY, 0, 0, 0,
sizeof(struct scsi_low_inq_data), 0};
static u_int8_t unit_ready_cmd[6];
static int scsi_low_setup_start(struct scsi_low_softc *, struct targ_info *, struct lun_info *, struct slccb *);
static int scsi_low_sense_abort_start(struct scsi_low_softc *, struct targ_info *, struct lun_info *, struct slccb *);
static int scsi_low_resume(struct scsi_low_softc *);
static void
scsi_low_unit_ready_cmd(cb)
struct slccb *cb;
{
cb->ccb_scp.scp_cmd = unit_ready_cmd;
cb->ccb_scp.scp_cmdlen = sizeof(unit_ready_cmd);
cb->ccb_scp.scp_datalen = 0;
cb->ccb_scp.scp_direction = SCSI_LOW_READ;
cb->ccb_tcmax = 15;
}
static int
scsi_low_sense_abort_start(slp, ti, li, cb)
struct scsi_low_softc *slp;
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
{
cb->ccb_scp.scp_cmdlen = 6;
bzero(cb->ccb_scsi_cmd, cb->ccb_scp.scp_cmdlen);
cb->ccb_scsi_cmd[0] = REQUEST_SENSE;
cb->ccb_scsi_cmd[4] = sizeof(cb->ccb_sense);
cb->ccb_scp.scp_cmd = cb->ccb_scsi_cmd;
cb->ccb_scp.scp_data = (u_int8_t *) &cb->ccb_sense;
cb->ccb_scp.scp_datalen = sizeof(cb->ccb_sense);
cb->ccb_scp.scp_direction = SCSI_LOW_READ;
cb->ccb_tcmax = 15;
scsi_low_ccb_message_clear(cb);
if ((cb->ccb_flags & CCB_CLEARQ) != 0)
{
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
}
else
{
bzero(&cb->ccb_sense, sizeof(cb->ccb_sense));
#ifdef SCSI_LOW_NEGOTIATE_BEFORE_SENSE
scsi_low_assert_msg(slp, ti, ti->ti_setup_msg_done, 0);
#endif /* SCSI_LOW_NEGOTIATE_BEFORE_SENSE */
}
return SCSI_LOW_START_NO_QTAG;
}
static int
scsi_low_setup_start(slp, ti, li, cb)
struct scsi_low_softc *slp;
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
{
switch(li->li_state)
{
case SCSI_LOW_LUN_SLEEP:
scsi_low_unit_ready_cmd(cb);
break;
case SCSI_LOW_LUN_START:
cb->ccb_scp.scp_cmd = ss_cmd;
cb->ccb_scp.scp_cmdlen = sizeof(ss_cmd);
cb->ccb_scp.scp_datalen = 0;
cb->ccb_scp.scp_direction = SCSI_LOW_READ;
cb->ccb_tcmax = 30;
break;
case SCSI_LOW_LUN_INQ:
cb->ccb_scp.scp_cmd = inq_cmd;
cb->ccb_scp.scp_cmdlen = sizeof(inq_cmd);
cb->ccb_scp.scp_data = (u_int8_t *)&li->li_inq;
cb->ccb_scp.scp_datalen = sizeof(li->li_inq);
cb->ccb_scp.scp_direction = SCSI_LOW_READ;
cb->ccb_tcmax = 15;
break;
case SCSI_LOW_LUN_MODEQ:
cb->ccb_scp.scp_cmd = sms_cmd;
cb->ccb_scp.scp_cmdlen = sizeof(sms_cmd);
cb->ccb_scp.scp_data = (u_int8_t *)&li->li_sms;
cb->ccb_scp.scp_datalen = sizeof(li->li_sms);
cb->ccb_scp.scp_direction = SCSI_LOW_READ;
cb->ccb_tcmax = 15;
return SCSI_LOW_START_QTAG;
default:
panic("%s: no setup phase", device_get_nameunit(slp->sl_dev));
}
return SCSI_LOW_START_NO_QTAG;
}
static int
scsi_low_resume(slp)
struct scsi_low_softc *slp;
{
if (slp->sl_flags & HW_RESUME)
return EJUSTRETURN;
slp->sl_flags &= ~HW_POWDOWN;
if (slp->sl_funcs->scsi_low_power != NULL)
{
slp->sl_flags |= HW_RESUME;
slp->sl_rstep = 0;
(*slp->sl_funcs->scsi_low_power) (slp, SCSI_LOW_ENGAGE);
callout_reset(&slp->sl_engage_timer, hz / 1000,
scsi_low_engage, slp);
return EJUSTRETURN;
}
return 0;
}
static void
scsi_low_start(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
int rv;
/* check hardware exists or under initializations ? */
if ((slp->sl_flags & (HW_INACTIVE | HW_INITIALIZING)) != 0)
return;
/* check hardware power up ? */
if ((slp->sl_flags & HW_POWERCTRL) != 0)
{
slp->sl_active ++;
if (slp->sl_flags & (HW_POWDOWN | HW_RESUME))
{
if (scsi_low_resume(slp) == EJUSTRETURN)
return;
}
}
/* setup nexus */
#ifdef SCSI_LOW_DIAGNOSTIC
if (slp->sl_Tnexus || slp->sl_Lnexus || slp->sl_Qnexus)
{
scsi_low_info(slp, NULL, "NEXUS INCOSISTENT");
panic("%s: inconsistent", device_get_nameunit(slp->sl_dev));
}
#endif /* SCSI_LOW_DIAGNOSTIC */
for (cb = TAILQ_FIRST(&slp->sl_start); cb != NULL;
cb = TAILQ_NEXT(cb, ccb_chain))
{
li = cb->li;
if (li->li_disc == 0)
{
goto scsi_low_cmd_start;
}
else if (li->li_nqio > 0)
{
if (li->li_nqio < li->li_maxnqio ||
(cb->ccb_flags & (CCB_SENSE | CCB_CLEARQ)) != 0)
goto scsi_low_cmd_start;
}
}
return;
scsi_low_cmd_start:
cb->ccb_flags &= ~CCB_STARTQ;
TAILQ_REMOVE(&slp->sl_start, cb, ccb_chain);
ti = cb->ti;
/* clear all error flag bits (for restart) */
cb->ccb_error = 0;
cb->ccb_datalen = -1;
cb->ccb_scp.scp_status = ST_UNKNOWN;
/* setup nexus pointer */
slp->sl_Qnexus = cb;
slp->sl_Lnexus = li;
slp->sl_Tnexus = ti;
/* initialize msgsys */
scsi_low_init_msgsys(slp, ti);
/* exec cmd */
if ((cb->ccb_flags & (CCB_SENSE | CCB_CLEARQ)) != 0)
{
/* CA state or forced abort */
rv = scsi_low_sense_abort_start(slp, ti, li, cb);
}
else if (li->li_state >= SCSI_LOW_LUN_OK)
{
cb->ccb_flags &= ~CCB_INTERNAL;
rv = scsi_low_ccb_setup_cam(slp, cb);
if (cb->ccb_msgoutflag != 0)
{
scsi_low_ccb_message_exec(slp, cb);
}
}
else
{
cb->ccb_flags |= CCB_INTERNAL;
rv = scsi_low_setup_start(slp, ti, li, cb);
}
/* allocate qtag */
#define SCSI_LOW_QTAG_OK (SCSI_LOW_QTAG | SCSI_LOW_DISC)
if (rv == SCSI_LOW_START_QTAG &&
(li->li_flags & SCSI_LOW_QTAG_OK) == SCSI_LOW_QTAG_OK &&
li->li_maxnqio > 0)
{
u_int qmsg;
scsi_low_activate_qtag(cb);
if ((scsi_low_cmd_flags[cb->ccb_scp.scp_cmd[0]] &
SCSI_LOW_CMD_ORDERED_QTAG) != 0)
qmsg = SCSI_LOW_MSG_ORDERED_QTAG;
else if ((cb->ccb_flags & CCB_URGENT) != 0)
qmsg = SCSI_LOW_MSG_HEAD_QTAG;
else
qmsg = SCSI_LOW_MSG_SIMPLE_QTAG;
scsi_low_assert_msg(slp, ti, qmsg, 0);
}
/* timeout */
if (cb->ccb_tcmax < SCSI_LOW_MIN_TOUT)
cb->ccb_tcmax = SCSI_LOW_MIN_TOUT;
cb->ccb_tc = cb->ccb_tcmax;
/* setup saved scsi data pointer */
cb->ccb_sscp = cb->ccb_scp;
/* setup current scsi pointer */
slp->sl_scp = cb->ccb_sscp;
slp->sl_error = cb->ccb_error;
/* assert always an identify msg */
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_IDENTIFY, 0);
/* debug section */
#ifdef SCSI_LOW_DIAGNOSTIC
scsi_low_msg_log_init(&ti->ti_log_msgin);
scsi_low_msg_log_init(&ti->ti_log_msgout);
#endif /* SCSI_LOW_DIAGNOSTIC */
/* selection start */
slp->sl_selid = cb;
rv = ((*slp->sl_funcs->scsi_low_start_bus) (slp, cb));
if (rv == SCSI_LOW_START_OK)
{
#ifdef SCSI_LOW_STATICS
scsi_low_statics.nexus_win ++;
#endif /* SCSI_LOW_STATICS */
return;
}
scsi_low_arbit_fail(slp, cb);
#ifdef SCSI_LOW_STATICS
scsi_low_statics.nexus_fail ++;
#endif /* SCSI_LOW_STATICS */
}
void
scsi_low_arbit_fail(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
struct targ_info *ti = cb->ti;
scsi_low_deactivate_qtag(cb);
scsi_low_ccb_message_retry(cb);
cb->ccb_flags |= CCB_STARTQ;
TAILQ_INSERT_HEAD(&slp->sl_start, cb, ccb_chain);
scsi_low_bus_release(slp, ti);
cb->ccb_selrcnt ++;
if (slp->sl_disc == 0)
{
#ifdef SCSI_LOW_DIAGNOSTIC
device_printf(slp->sl_dev, "try selection again\n");
#endif /* SCSI_LOW_DIAGNOSTIC */
slp->sl_retry_sel = 1;
}
}
static void
scsi_low_bus_release(slp, ti)
struct scsi_low_softc *slp;
struct targ_info *ti;
{
if (ti->ti_disc > 0)
{
SCSI_LOW_SETUP_PHASE(ti, PH_DISC);
}
else
{
SCSI_LOW_SETUP_PHASE(ti, PH_NULL);
}
/* clear all nexus pointer */
slp->sl_Qnexus = NULL;
slp->sl_Lnexus = NULL;
slp->sl_Tnexus = NULL;
/* clear selection assert */
slp->sl_selid = NULL;
/* clear nexus data */
slp->sl_scp.scp_direction = SCSI_LOW_RWUNK;
/* clear phase change counter */
slp->sl_ph_count = 0;
}
static int
scsi_low_setup_done(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
struct targ_info *ti;
struct lun_info *li;
ti = cb->ti;
li = cb->li;
if (cb->ccb_rcnt >= slp->sl_max_retry)
{
cb->ccb_error |= ABORTIO;
return SCSI_LOW_DONE_COMPLETE;
}
/* XXX: special huck for selection timeout */
if (li->li_state == SCSI_LOW_LUN_SLEEP &&
(cb->ccb_error & SELTIMEOUTIO) != 0)
{
cb->ccb_error |= ABORTIO;
return SCSI_LOW_DONE_COMPLETE;
}
switch(li->li_state)
{
case SCSI_LOW_LUN_INQ:
if (cb->ccb_error != 0)
{
li->li_diskflags &=
~(SCSI_LOW_DISK_LINK | SCSI_LOW_DISK_QTAG);
if (li->li_lun > 0)
goto resume;
ti->ti_diskflags &=
~(SCSI_LOW_DISK_SYNC | SCSI_LOW_DISK_WIDE);
}
else if ((li->li_inq.sd_version & 7) >= 2 ||
(li->li_inq.sd_len >= 4))
{
if ((li->li_inq.sd_support & 0x2) == 0)
li->li_diskflags &= ~SCSI_LOW_DISK_QTAG;
if ((li->li_inq.sd_support & 0x8) == 0)
li->li_diskflags &= ~SCSI_LOW_DISK_LINK;
if (li->li_lun > 0)
goto resume;
if ((li->li_inq.sd_support & 0x10) == 0)
ti->ti_diskflags &= ~SCSI_LOW_DISK_SYNC;
if ((li->li_inq.sd_support & 0x20) == 0)
ti->ti_diskflags &= ~SCSI_LOW_DISK_WIDE_16;
if ((li->li_inq.sd_support & 0x40) == 0)
ti->ti_diskflags &= ~SCSI_LOW_DISK_WIDE_32;
}
else
{
li->li_diskflags &=
~(SCSI_LOW_DISK_QTAG | SCSI_LOW_DISK_LINK);
if (li->li_lun > 0)
goto resume;
ti->ti_diskflags &= ~SCSI_LOW_DISK_WIDE;
}
ti->ti_flags_valid |= SCSI_LOW_TARG_FLAGS_DISK_VALID;
resume:
scsi_low_calcf_target(ti);
scsi_low_calcf_lun(li);
break;
case SCSI_LOW_LUN_MODEQ:
if (cb->ccb_error != 0)
{
if (cb->ccb_error & SENSEIO)
{
#ifdef SCSI_LOW_DEBUG
if (scsi_low_debug & SCSI_LOW_DEBUG_SENSE)
{
int error_code, sense_key, asc, ascq;
scsi_extract_sense(&cb->ccb_sense,
&error_code,
&sense_key,
&asc,
&ascq);
printf("SENSE: [%x][%x][%x][%x]\n",
error_code, sense_key, asc,
ascq);
}
#endif /* SCSI_LOW_DEBUG */
}
else
{
li->li_diskflags &= ~SCSI_LOW_DISK_QTAG;
}
}
else if ((li->li_sms.sms_cmp.cmp_page & 0x3f) == 0x0a)
{
if (li->li_sms.sms_cmp.cmp_qc & 0x02)
li->li_qflags |= SCSI_LOW_QFLAG_CA_QCLEAR;
else
li->li_qflags &= ~SCSI_LOW_QFLAG_CA_QCLEAR;
if ((li->li_sms.sms_cmp.cmp_qc & 0x01) != 0)
li->li_diskflags &= ~SCSI_LOW_DISK_QTAG;
}
li->li_flags_valid |= SCSI_LOW_LUN_FLAGS_DISK_VALID;
scsi_low_calcf_lun(li);
break;
default:
break;
}
li->li_state ++;
if (li->li_state == SCSI_LOW_LUN_OK)
{
scsi_low_calcf_target(ti);
scsi_low_calcf_lun(li);
if (li->li_flags_valid == SCSI_LOW_LUN_FLAGS_ALL_VALID &&
(slp->sl_show_result & SHOW_CALCF_RES) != 0)
{
scsi_low_calcf_show(li);
}
}
cb->ccb_rcnt --;
return SCSI_LOW_DONE_RETRY;
}
static int
scsi_low_done(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
int rv;
if (cb->ccb_error == 0)
{
if ((cb->ccb_flags & (CCB_SENSE | CCB_CLEARQ)) != 0)
{
#ifdef SCSI_LOW_QCLEAR_AFTER_CA
/* XXX:
* SCSI-2 draft suggests
* page 0x0a QErr bit determins if
* the target aborts or continues
* the queueing io's after CA state resolved.
* However many targets seem not to support
* the page 0x0a. Thus we should manually clear the
* queuing io's after CA state.
*/
if ((cb->ccb_flags & CCB_CLEARQ) == 0)
{
cb->ccb_rcnt --;
cb->ccb_flags |= CCB_CLEARQ;
goto retry;
}
#endif /* SCSI_LOW_QCLEAR_AFTER_CA */
if ((cb->ccb_flags & CCB_SENSE) != 0)
cb->ccb_error |= (SENSEIO | ABORTIO);
cb->ccb_flags &= ~(CCB_SENSE | CCB_CLEARQ);
}
else switch (cb->ccb_sscp.scp_status)
{
case ST_GOOD:
case ST_MET:
case ST_INTERGOOD:
case ST_INTERMET:
if (cb->ccb_datalen == 0 ||
cb->ccb_scp.scp_datalen == 0)
break;
if (cb->ccb_scp.scp_cmdlen > 0 &&
(scsi_low_cmd_flags[cb->ccb_scp.scp_cmd[0]] &
SCSI_LOW_CMD_RESIDUAL_CHK) == 0)
break;
cb->ccb_error |= PDMAERR;
break;
case ST_BUSY:
case ST_QUEFULL:
cb->ccb_error |= (BUSYERR | STATERR);
break;
case ST_CONFLICT:
cb->ccb_error |= (STATERR | ABORTIO);
break;
case ST_CHKCOND:
case ST_CMDTERM:
if (cb->ccb_flags & (CCB_AUTOSENSE | CCB_INTERNAL))
{
cb->ccb_rcnt --;
cb->ccb_flags |= CCB_SENSE;
goto retry;
}
cb->ccb_error |= (UACAERR | STATERR | ABORTIO);
break;
case ST_UNKNOWN:
default:
cb->ccb_error |= FATALIO;
break;
}
}
else
{
if (cb->ccb_flags & CCB_SENSE)
{
cb->ccb_error |= (SENSEERR | ABORTIO);
}
cb->ccb_flags &= ~(CCB_CLEARQ | CCB_SENSE);
}
/* internal ccb */
if ((cb->ccb_flags & CCB_INTERNAL) != 0)
{
if (scsi_low_setup_done(slp, cb) == SCSI_LOW_DONE_RETRY)
goto retry;
}
/* check a ccb msgout flag */
if (cb->ccb_omsgoutflag != 0)
{
#define SCSI_LOW_MSG_ABORT_OK (SCSI_LOW_MSG_ABORT | \
SCSI_LOW_MSG_ABORT_QTAG | \
SCSI_LOW_MSG_CLEAR_QTAG | \
SCSI_LOW_MSG_TERMIO)
if ((cb->ccb_omsgoutflag & SCSI_LOW_MSG_ABORT_OK) != 0)
{
cb->ccb_error |= ABORTIO;
}
}
/* call OS depend done */
if (cb->osdep != NULL)
{
rv = scsi_low_done_cam(slp, cb);
if (rv == EJUSTRETURN)
goto retry;
}
else if (cb->ccb_error != 0)
{
if (cb->ccb_rcnt >= slp->sl_max_retry)
cb->ccb_error |= ABORTIO;
if ((cb->ccb_flags & CCB_NORETRY) == 0 &&
(cb->ccb_error & ABORTIO) == 0)
goto retry;
}
/* free our target */
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_GO(SCSI_LOW_DEBUG_DONE, cb->ti->ti_id) != 0)
{
printf(">> SCSI_LOW_DONE_COMPLETE ===============\n");
scsi_low_print(slp, NULL);
}
#endif /* SCSI_LOW_DEBUG */
scsi_low_deactivate_qtag(cb);
scsi_low_dealloc_qtag(cb);
scsi_low_free_ccb(cb);
slp->sl_nio --;
return SCSI_LOW_DONE_COMPLETE;
retry:
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_GO(SCSI_LOW_DEBUG_DONE, cb->ti->ti_id) != 0)
{
printf("** SCSI_LOW_DONE_RETRY ===============\n");
scsi_low_print(slp, NULL);
}
#endif /* SCSI_LOW_DEBUG */
cb->ccb_rcnt ++;
scsi_low_deactivate_qtag(cb);
scsi_low_ccb_message_retry(cb);
return SCSI_LOW_DONE_RETRY;
}
/**************************************************************
* Reset
**************************************************************/
static void
scsi_low_reset_nexus_target(slp, ti, fdone)
struct scsi_low_softc *slp;
struct targ_info *ti;
int fdone;
{
struct lun_info *li;
for (li = LIST_FIRST(&ti->ti_litab); li != NULL;
li = LIST_NEXT(li, lun_chain))
{
scsi_low_reset_nexus_lun(slp, li, fdone);
li->li_state = SCSI_LOW_LUN_SLEEP;
li->li_maxnqio = 0;
}
ti->ti_disc = 0;
ti->ti_setup_msg = 0;
ti->ti_setup_msg_done = 0;
ti->ti_osynch.offset = ti->ti_osynch.period = 0;
ti->ti_owidth = SCSI_LOW_BUS_WIDTH_8;
ti->ti_diskflags = SCSI_LOW_DISK_TFLAGS;
ti->ti_flags_valid &= ~SCSI_LOW_TARG_FLAGS_DISK_VALID;
if (slp->sl_funcs->scsi_low_targ_init != NULL)
{
((*slp->sl_funcs->scsi_low_targ_init)
(slp, ti, SCSI_LOW_INFO_REVOKE));
}
scsi_low_calcf_target(ti);
for (li = LIST_FIRST(&ti->ti_litab); li != NULL;
li = LIST_NEXT(li, lun_chain))
{
li->li_flags = 0;
li->li_diskflags = SCSI_LOW_DISK_LFLAGS;
li->li_flags_valid &= ~SCSI_LOW_LUN_FLAGS_DISK_VALID;
if (slp->sl_funcs->scsi_low_lun_init != NULL)
{
((*slp->sl_funcs->scsi_low_lun_init)
(slp, ti, li, SCSI_LOW_INFO_REVOKE));
}
scsi_low_calcf_lun(li);
}
}
static void
scsi_low_reset_nexus(slp, fdone)
struct scsi_low_softc *slp;
int fdone;
{
struct targ_info *ti;
struct slccb *cb, *topcb;
if ((cb = slp->sl_Qnexus) != NULL)
{
topcb = scsi_low_revoke_ccb(slp, cb, fdone);
}
else
{
topcb = NULL;
}
for (ti = TAILQ_FIRST(&slp->sl_titab); ti != NULL;
ti = TAILQ_NEXT(ti, ti_chain))
{
scsi_low_reset_nexus_target(slp, ti, fdone);
scsi_low_bus_release(slp, ti);
scsi_low_init_msgsys(slp, ti);
}
if (topcb != NULL)
{
topcb->ccb_flags |= CCB_STARTQ;
TAILQ_INSERT_HEAD(&slp->sl_start, topcb, ccb_chain);
}
slp->sl_disc = 0;
slp->sl_retry_sel = 0;
slp->sl_flags &= ~HW_PDMASTART;
}
/* misc */
static int tw_pos;
static char tw_chars[] = "|/-\\";
#define TWIDDLEWAIT 10000
static void
scsi_low_twiddle_wait(void)
{
cnputc('\b');
cnputc(tw_chars[tw_pos++]);
tw_pos %= (sizeof(tw_chars) - 1);
DELAY(TWIDDLEWAIT);
}
void
scsi_low_bus_reset(slp)
struct scsi_low_softc *slp;
{
int i;
(*slp->sl_funcs->scsi_low_bus_reset) (slp);
device_printf(slp->sl_dev, "try to reset scsi bus ");
for (i = 0; i <= SCSI2_RESET_DELAY / TWIDDLEWAIT ; i++)
scsi_low_twiddle_wait();
cnputc('\b');
printf("\n");
}
int
scsi_low_restart(slp, flags, s)
struct scsi_low_softc *slp;
int flags;
u_char *s;
{
int error;
if (s != NULL)
device_printf(slp->sl_dev, "scsi bus restart. reason: %s\n", s);
if ((error = scsi_low_init(slp, flags)) != 0)
return error;
scsi_low_start(slp);
return 0;
}
/**************************************************************
* disconnect and reselect
**************************************************************/
#define MSGCMD_LUN(msg) (msg & 0x07)
static struct slccb *
scsi_low_establish_ccb(ti, li, tag)
struct targ_info *ti;
struct lun_info *li;
scsi_low_tag_t tag;
{
struct scsi_low_softc *slp = ti->ti_sc;
struct slccb *cb;
if (li == NULL)
return NULL;
cb = TAILQ_FIRST(&li->li_discq);
for ( ; cb != NULL; cb = TAILQ_NEXT(cb, ccb_chain))
if (cb->ccb_tag == tag)
goto found;
return cb;
/*
* establish our ccb nexus
*/
found:
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_NEXUS_CHECK, ti->ti_id) != 0)
{
device_printf(slp->sl_dev, "nexus(0x%lx) abort check start\n",
(u_long) cb);
cb->ccb_flags |= (CCB_NORETRY | CCB_SILENT);
scsi_low_revoke_ccb(slp, cb, 1);
return NULL;
}
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_ATTEN_CHECK, ti->ti_id) != 0)
{
if (cb->ccb_omsgoutflag == 0)
scsi_low_ccb_message_assert(cb, SCSI_LOW_MSG_NOOP);
}
#endif /* SCSI_LOW_DEBUG */
TAILQ_REMOVE(&li->li_discq, cb, ccb_chain);
cb->ccb_flags &= ~CCB_DISCQ;
slp->sl_Qnexus = cb;
slp->sl_scp = cb->ccb_sscp;
slp->sl_error |= cb->ccb_error;
slp->sl_disc --;
ti->ti_disc --;
li->li_disc --;
/* inform "ccb nexus established" to the host driver */
(*slp->sl_funcs->scsi_low_establish_ccb_nexus) (slp);
/* check msg */
if (cb->ccb_msgoutflag != 0)
{
scsi_low_ccb_message_exec(slp, cb);
}
return cb;
}
struct targ_info *
scsi_low_reselected(slp, targ)
struct scsi_low_softc *slp;
u_int targ;
{
struct targ_info *ti;
struct slccb *cb;
u_char *s;
/*
* Check select vs reselected collision.
*/
if ((cb = slp->sl_selid) != NULL)
{
scsi_low_arbit_fail(slp, cb);
#ifdef SCSI_LOW_STATICS
scsi_low_statics.nexus_conflict ++;
#endif /* SCSI_LOW_STATICS */
}
/*
* Check if no current active nexus.
*/
if (slp->sl_Tnexus != NULL)
{
s = "host busy";
goto world_restart;
}
/*
* Check a valid target id asserted ?
*/
if (targ >= slp->sl_ntargs || targ == slp->sl_hostid)
{
s = "scsi id illegal";
goto world_restart;
}
/*
* Check the target scsi status.
*/
ti = slp->sl_ti[targ];
if (ti->ti_phase != PH_DISC && ti->ti_phase != PH_NULL)
{
s = "phase mismatch";
goto world_restart;
}
/*
* Setup init msgsys
*/
slp->sl_error = 0;
scsi_low_init_msgsys(slp, ti);
/*
* Establish our target nexus
*/
SCSI_LOW_SETUP_PHASE(ti, PH_RESEL);
slp->sl_Tnexus = ti;
#ifdef SCSI_LOW_STATICS
scsi_low_statics.nexus_reselected ++;
#endif /* SCSI_LOW_STATICS */
return ti;
world_restart:
device_printf(slp->sl_dev, "reselect(%x:unknown) %s\n", targ, s);
scsi_low_restart(slp, SCSI_LOW_RESTART_HARD,
"reselect: scsi world confused");
return NULL;
}
/**************************************************************
* cmd out pointer setup
**************************************************************/
int
scsi_low_cmd(slp, ti)
struct scsi_low_softc *slp;
struct targ_info *ti;
{
struct slccb *cb = slp->sl_Qnexus;
slp->sl_ph_count ++;
if (cb == NULL)
{
/*
* no ccb, abort!
*/
slp->sl_scp.scp_cmd = (u_int8_t *) &unit_ready_cmd;
slp->sl_scp.scp_cmdlen = sizeof(unit_ready_cmd);
slp->sl_scp.scp_datalen = 0;
slp->sl_scp.scp_direction = SCSI_LOW_READ;
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
SCSI_LOW_INFO(slp, ti, "CMDOUT: ccb nexus not found");
return EINVAL;
}
else
{
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_CMDLNK_CHECK, ti->ti_id))
{
scsi_low_test_cmdlnk(slp, cb);
}
#endif /* SCSI_LOW_DEBUG */
}
return 0;
}
/**************************************************************
* data out pointer setup
**************************************************************/
int
scsi_low_data(slp, ti, bp, direction)
struct scsi_low_softc *slp;
struct targ_info *ti;
struct buf **bp;
int direction;
{
struct slccb *cb = slp->sl_Qnexus;
if (cb != NULL && direction == cb->ccb_sscp.scp_direction)
{
*bp = cb->bp;
return 0;
}
slp->sl_error |= (FATALIO | PDMAERR);
slp->sl_scp.scp_datalen = 0;
slp->sl_scp.scp_direction = direction;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
if (ti->ti_ophase != ti->ti_phase)
{
char *s;
if (cb == NULL)
s = "DATA PHASE: ccb nexus not found";
else
s = "DATA PHASE: xfer direction mismatch";
SCSI_LOW_INFO(slp, ti, s);
}
*bp = NULL;
return EINVAL;
}
/**************************************************************
* MSG_SYS
**************************************************************/
#define MSGINPTR_CLR(ti) {(ti)->ti_msginptr = 0; (ti)->ti_msginlen = 0;}
#define MSGIN_PERIOD(ti) ((ti)->ti_msgin[3])
#define MSGIN_OFFSET(ti) ((ti)->ti_msgin[4])
#define MSGIN_WIDTHP(ti) ((ti)->ti_msgin[3])
#define MSGIN_DATA_LAST 0x30
static int scsi_low_errfunc_synch(struct scsi_low_softc *, u_int);
static int scsi_low_errfunc_wide(struct scsi_low_softc *, u_int);
static int scsi_low_errfunc_identify(struct scsi_low_softc *, u_int);
static int scsi_low_errfunc_qtag(struct scsi_low_softc *, u_int);
static int scsi_low_msgfunc_synch(struct scsi_low_softc *);
static int scsi_low_msgfunc_wide(struct scsi_low_softc *);
static int scsi_low_msgfunc_identify(struct scsi_low_softc *);
static int scsi_low_msgfunc_abort(struct scsi_low_softc *);
static int scsi_low_msgfunc_qabort(struct scsi_low_softc *);
static int scsi_low_msgfunc_qtag(struct scsi_low_softc *);
static int scsi_low_msgfunc_reset(struct scsi_low_softc *);
struct scsi_low_msgout_data {
u_int md_flags;
u_int8_t md_msg;
int (*md_msgfunc)(struct scsi_low_softc *);
int (*md_errfunc)(struct scsi_low_softc *, u_int);
#define MSG_RELEASE_ATN 0x0001
u_int md_condition;
};
struct scsi_low_msgout_data scsi_low_msgout_data[] = {
/* 0 */ {SCSI_LOW_MSG_RESET, MSG_RESET, scsi_low_msgfunc_reset, NULL, MSG_RELEASE_ATN},
/* 1 */ {SCSI_LOW_MSG_REJECT, MSG_REJECT, NULL, NULL, MSG_RELEASE_ATN},
/* 2 */ {SCSI_LOW_MSG_PARITY, MSG_PARITY, NULL, NULL, MSG_RELEASE_ATN},
/* 3 */ {SCSI_LOW_MSG_ERROR, MSG_I_ERROR, NULL, NULL, MSG_RELEASE_ATN},
/* 4 */ {SCSI_LOW_MSG_IDENTIFY, MSG_IDENTIFY, scsi_low_msgfunc_identify, scsi_low_errfunc_identify, 0},
/* 5 */ {SCSI_LOW_MSG_ABORT, MSG_ABORT, scsi_low_msgfunc_abort, NULL, MSG_RELEASE_ATN},
/* 6 */ {SCSI_LOW_MSG_TERMIO, MSG_TERM_IO, NULL, NULL, MSG_RELEASE_ATN},
/* 7 */ {SCSI_LOW_MSG_SIMPLE_QTAG, MSG_SIMPLE_QTAG, scsi_low_msgfunc_qtag, scsi_low_errfunc_qtag, 0},
/* 8 */ {SCSI_LOW_MSG_ORDERED_QTAG, MSG_ORDERED_QTAG, scsi_low_msgfunc_qtag, scsi_low_errfunc_qtag, 0},
/* 9 */{SCSI_LOW_MSG_HEAD_QTAG, MSG_HEAD_QTAG, scsi_low_msgfunc_qtag, scsi_low_errfunc_qtag, 0},
/* 10 */ {SCSI_LOW_MSG_ABORT_QTAG, MSG_ABORT_QTAG, scsi_low_msgfunc_qabort, NULL, MSG_RELEASE_ATN},
/* 11 */ {SCSI_LOW_MSG_CLEAR_QTAG, MSG_CLEAR_QTAG, scsi_low_msgfunc_abort, NULL, MSG_RELEASE_ATN},
/* 12 */{SCSI_LOW_MSG_WIDE, MSG_EXTEND, scsi_low_msgfunc_wide, scsi_low_errfunc_wide, MSG_RELEASE_ATN},
/* 13 */{SCSI_LOW_MSG_SYNCH, MSG_EXTEND, scsi_low_msgfunc_synch, scsi_low_errfunc_synch, MSG_RELEASE_ATN},
/* 14 */{SCSI_LOW_MSG_NOOP, MSG_NOOP, NULL, NULL, MSG_RELEASE_ATN},
/* 15 */{SCSI_LOW_MSG_ALL, 0},
};
static int scsi_low_msginfunc_ext(struct scsi_low_softc *);
static int scsi_low_synch(struct scsi_low_softc *);
static int scsi_low_wide(struct scsi_low_softc *);
static int scsi_low_msginfunc_msg_reject(struct scsi_low_softc *);
static int scsi_low_msginfunc_rejop(struct scsi_low_softc *);
static int scsi_low_msginfunc_rp(struct scsi_low_softc *);
static int scsi_low_msginfunc_sdp(struct scsi_low_softc *);
static int scsi_low_msginfunc_disc(struct scsi_low_softc *);
static int scsi_low_msginfunc_cc(struct scsi_low_softc *);
static int scsi_low_msginfunc_lcc(struct scsi_low_softc *);
static int scsi_low_msginfunc_parity(struct scsi_low_softc *);
static int scsi_low_msginfunc_noop(struct scsi_low_softc *);
static int scsi_low_msginfunc_simple_qtag(struct scsi_low_softc *);
static int scsi_low_msginfunc_i_wide_residue(struct scsi_low_softc *);
struct scsi_low_msgin_data {
u_int md_len;
int (*md_msgfunc)(struct scsi_low_softc *);
};
struct scsi_low_msgin_data scsi_low_msgin_data[] = {
/* 0 */ {1, scsi_low_msginfunc_cc},
/* 1 */ {2, scsi_low_msginfunc_ext},
/* 2 */ {1, scsi_low_msginfunc_sdp},
/* 3 */ {1, scsi_low_msginfunc_rp},
/* 4 */ {1, scsi_low_msginfunc_disc},
/* 5 */ {1, scsi_low_msginfunc_rejop},
/* 6 */ {1, scsi_low_msginfunc_rejop},
/* 7 */ {1, scsi_low_msginfunc_msg_reject},
/* 8 */ {1, scsi_low_msginfunc_noop},
/* 9 */ {1, scsi_low_msginfunc_parity},
/* a */ {1, scsi_low_msginfunc_lcc},
/* b */ {1, scsi_low_msginfunc_lcc},
/* c */ {1, scsi_low_msginfunc_rejop},
/* d */ {2, scsi_low_msginfunc_rejop},
/* e */ {1, scsi_low_msginfunc_rejop},
/* f */ {1, scsi_low_msginfunc_rejop},
/* 0x10 */ {1, scsi_low_msginfunc_rejop},
/* 0x11 */ {1, scsi_low_msginfunc_rejop},
/* 0x12 */ {1, scsi_low_msginfunc_rejop},
/* 0x13 */ {1, scsi_low_msginfunc_rejop},
/* 0x14 */ {1, scsi_low_msginfunc_rejop},
/* 0x15 */ {1, scsi_low_msginfunc_rejop},
/* 0x16 */ {1, scsi_low_msginfunc_rejop},
/* 0x17 */ {1, scsi_low_msginfunc_rejop},
/* 0x18 */ {1, scsi_low_msginfunc_rejop},
/* 0x19 */ {1, scsi_low_msginfunc_rejop},
/* 0x1a */ {1, scsi_low_msginfunc_rejop},
/* 0x1b */ {1, scsi_low_msginfunc_rejop},
/* 0x1c */ {1, scsi_low_msginfunc_rejop},
/* 0x1d */ {1, scsi_low_msginfunc_rejop},
/* 0x1e */ {1, scsi_low_msginfunc_rejop},
/* 0x1f */ {1, scsi_low_msginfunc_rejop},
/* 0x20 */ {2, scsi_low_msginfunc_simple_qtag},
/* 0x21 */ {2, scsi_low_msginfunc_rejop},
/* 0x22 */ {2, scsi_low_msginfunc_rejop},
/* 0x23 */ {2, scsi_low_msginfunc_i_wide_residue},
/* 0x24 */ {2, scsi_low_msginfunc_rejop},
/* 0x25 */ {2, scsi_low_msginfunc_rejop},
/* 0x26 */ {2, scsi_low_msginfunc_rejop},
/* 0x27 */ {2, scsi_low_msginfunc_rejop},
/* 0x28 */ {2, scsi_low_msginfunc_rejop},
/* 0x29 */ {2, scsi_low_msginfunc_rejop},
/* 0x2a */ {2, scsi_low_msginfunc_rejop},
/* 0x2b */ {2, scsi_low_msginfunc_rejop},
/* 0x2c */ {2, scsi_low_msginfunc_rejop},
/* 0x2d */ {2, scsi_low_msginfunc_rejop},
/* 0x2e */ {2, scsi_low_msginfunc_rejop},
/* 0x2f */ {2, scsi_low_msginfunc_rejop},
/* 0x30 */ {1, scsi_low_msginfunc_rejop} /* default rej op */
};
/**************************************************************
* msgout
**************************************************************/
static int
scsi_low_msgfunc_synch(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
int ptr = ti->ti_msgoutlen;
ti->ti_msgoutstr[ptr + 1] = MSG_EXTEND_SYNCHLEN;
ti->ti_msgoutstr[ptr + 2] = MSG_EXTEND_SYNCHCODE;
ti->ti_msgoutstr[ptr + 3] = ti->ti_maxsynch.period;
ti->ti_msgoutstr[ptr + 4] = ti->ti_maxsynch.offset;
return MSG_EXTEND_SYNCHLEN + 2;
}
static int
scsi_low_msgfunc_wide(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
int ptr = ti->ti_msgoutlen;
ti->ti_msgoutstr[ptr + 1] = MSG_EXTEND_WIDELEN;
ti->ti_msgoutstr[ptr + 2] = MSG_EXTEND_WIDECODE;
ti->ti_msgoutstr[ptr + 3] = ti->ti_width;
return MSG_EXTEND_WIDELEN + 2;
}
static int
scsi_low_msgfunc_identify(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
struct lun_info *li = slp->sl_Lnexus;
struct slccb *cb = slp->sl_Qnexus;
int ptr = ti->ti_msgoutlen;
u_int8_t msg;
msg = MSG_IDENTIFY;
if (cb == NULL)
{
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
SCSI_LOW_INFO(slp, ti, "MSGOUT: nexus unknown");
}
else
{
if (scsi_low_is_disconnect_ok(cb) != 0)
msg |= (MSG_IDENTIFY_DISCPRIV | li->li_lun);
else
msg |= li->li_lun;
if (ti->ti_phase == PH_MSGOUT)
{
(*slp->sl_funcs->scsi_low_establish_lun_nexus) (slp);
if (cb->ccb_tag == SCSI_LOW_UNKTAG)
{
(*slp->sl_funcs->scsi_low_establish_ccb_nexus) (slp);
}
}
}
ti->ti_msgoutstr[ptr + 0] = msg;
return 1;
}
static int
scsi_low_msgfunc_abort(slp)
struct scsi_low_softc *slp;
{
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_ABORT);
return 1;
}
static int
scsi_low_msgfunc_qabort(slp)
struct scsi_low_softc *slp;
{
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_TERM);
return 1;
}
static int
scsi_low_msgfunc_reset(slp)
struct scsi_low_softc *slp;
{
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_RESET);
return 1;
}
static int
scsi_low_msgfunc_qtag(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
struct slccb *cb = slp->sl_Qnexus;
int ptr = ti->ti_msgoutlen;
if (cb == NULL || cb->ccb_tag == SCSI_LOW_UNKTAG)
{
ti->ti_msgoutstr[ptr + 0] = MSG_NOOP;
return 1;
}
else
{
ti->ti_msgoutstr[ptr + 1] = (u_int8_t) cb->ccb_tag;
if (ti->ti_phase == PH_MSGOUT)
{
(*slp->sl_funcs->scsi_low_establish_ccb_nexus) (slp);
}
}
return 2;
}
/*
* The following functions are called when targets give unexpected
* responces in msgin (after msgout).
*/
static int
scsi_low_errfunc_identify(slp, msgflags)
struct scsi_low_softc *slp;
u_int msgflags;
{
if (slp->sl_Lnexus != NULL)
{
slp->sl_Lnexus->li_cfgflags &= ~SCSI_LOW_DISC;
scsi_low_calcf_lun(slp->sl_Lnexus);
}
return 0;
}
static int
scsi_low_errfunc_synch(slp, msgflags)
struct scsi_low_softc *slp;
u_int msgflags;
{
struct targ_info *ti = slp->sl_Tnexus;
MSGIN_PERIOD(ti) = 0;
MSGIN_OFFSET(ti) = 0;
scsi_low_synch(slp);
return 0;
}
static int
scsi_low_errfunc_wide(slp, msgflags)
struct scsi_low_softc *slp;
u_int msgflags;
{
struct targ_info *ti = slp->sl_Tnexus;
MSGIN_WIDTHP(ti) = 0;
scsi_low_wide(slp);
return 0;
}
static int
scsi_low_errfunc_qtag(slp, msgflags)
struct scsi_low_softc *slp;
u_int msgflags;
{
if ((msgflags & SCSI_LOW_MSG_REJECT) != 0)
{
if (slp->sl_Qnexus != NULL)
{
scsi_low_deactivate_qtag(slp->sl_Qnexus);
}
if (slp->sl_Lnexus != NULL)
{
slp->sl_Lnexus->li_cfgflags &= ~SCSI_LOW_QTAG;
scsi_low_calcf_lun(slp->sl_Lnexus);
}
device_printf(slp->sl_dev, "scsi_low: qtag msg rejected\n");
}
return 0;
}
int
scsi_low_msgout(slp, ti, fl)
struct scsi_low_softc *slp;
struct targ_info *ti;
u_int fl;
{
struct scsi_low_msgout_data *mdp;
int len = 0;
#ifdef SCSI_LOW_DIAGNOSTIC
if (ti != slp->sl_Tnexus)
{
scsi_low_print(slp, NULL);
panic("scsi_low_msgout: Target nexus inconsistent");
}
#endif /* SCSI_LOW_DIAGNOSTIC */
slp->sl_ph_count ++;
if (slp->sl_ph_count > SCSI_LOW_MAX_PHCHANGES)
{
device_printf(slp->sl_dev, "too many phase changes\n");
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
}
/* STEP I.
* Scsi phase changes.
* Previously msgs asserted are accepted by our target or
* processed by scsi_low_msgin.
* Thus clear all saved informations.
*/
if ((fl & SCSI_LOW_MSGOUT_INIT) != 0)
{
ti->ti_omsgflags = 0;
ti->ti_emsgflags = 0;
}
else if (slp->sl_atten == 0)
{
/* STEP II.
* We did not assert attention, however still our target required
* msgs. Resend previous msgs.
*/
ti->ti_msgflags |= ti->ti_omsgflags;
ti->ti_omsgflags = 0;
#ifdef SCSI_LOW_DIAGNOSTIC
device_printf(slp->sl_dev, "scsi_low_msgout: retry msgout\n");
#endif /* SCSI_LOW_DIAGNOSTIC */
}
/* STEP III.
* We have no msgs. send MSG_NOOP (OK?)
*/
if (scsi_low_is_msgout_continue(ti, 0) == 0)
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_NOOP, 0);
/* STEP IV.
* Process all msgs
*/
ti->ti_msgoutlen = 0;
slp->sl_clear_atten = 0;
mdp = &scsi_low_msgout_data[0];
for ( ; mdp->md_flags != SCSI_LOW_MSG_ALL; mdp ++)
{
if ((ti->ti_msgflags & mdp->md_flags) != 0)
{
ti->ti_omsgflags |= mdp->md_flags;
ti->ti_msgflags &= ~mdp->md_flags;
ti->ti_emsgflags = mdp->md_flags;
ti->ti_msgoutstr[ti->ti_msgoutlen] = mdp->md_msg;
if (mdp->md_msgfunc != NULL)
len = (*mdp->md_msgfunc) (slp);
else
len = 1;
#ifdef SCSI_LOW_DIAGNOSTIC
scsi_low_msg_log_write(&ti->ti_log_msgout,
&ti->ti_msgoutstr[ti->ti_msgoutlen], len);
#endif /* SCSI_LOW_DIAGNOSTIC */
ti->ti_msgoutlen += len;
if ((mdp->md_condition & MSG_RELEASE_ATN) != 0)
{
slp->sl_clear_atten = 1;
break;
}
if ((fl & SCSI_LOW_MSGOUT_UNIFY) == 0 ||
ti->ti_msgflags == 0)
break;
if (ti->ti_msgoutlen >= SCSI_LOW_MAX_MSGLEN - 5)
break;
}
}
if (scsi_low_is_msgout_continue(ti, 0) == 0)
slp->sl_clear_atten = 1;
return ti->ti_msgoutlen;
}
/**************************************************************
* msgin
**************************************************************/
static int
scsi_low_msginfunc_noop(slp)
struct scsi_low_softc *slp;
{
return 0;
}
static int
scsi_low_msginfunc_rejop(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
u_int8_t msg = ti->ti_msgin[0];
device_printf(slp->sl_dev, "MSGIN: msg 0x%x rejected\n", (u_int) msg);
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_REJECT, 0);
return 0;
}
static int
scsi_low_msginfunc_cc(slp)
struct scsi_low_softc *slp;
{
struct lun_info *li;
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_CMDC);
/* validate status */
if (slp->sl_Qnexus == NULL)
return ENOENT;
slp->sl_Qnexus->ccb_sscp.scp_status = slp->sl_scp.scp_status;
li = slp->sl_Lnexus;
switch (slp->sl_scp.scp_status)
{
case ST_GOOD:
li->li_maxnqio = li->li_maxnexus;
break;
case ST_CHKCOND:
li->li_maxnqio = 0;
if (li->li_qflags & SCSI_LOW_QFLAG_CA_QCLEAR)
scsi_low_reset_nexus_lun(slp, li, 0);
break;
case ST_BUSY:
li->li_maxnqio = 0;
break;
case ST_QUEFULL:
if (li->li_maxnexus >= li->li_nqio)
li->li_maxnexus = li->li_nqio - 1;
li->li_maxnqio = li->li_maxnexus;
break;
case ST_INTERGOOD:
case ST_INTERMET:
slp->sl_error |= MSGERR;
break;
default:
break;
}
return 0;
}
static int
scsi_low_msginfunc_lcc(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti;
struct lun_info *li;
struct slccb *ncb, *cb;
ti = slp->sl_Tnexus;
li = slp->sl_Lnexus;
if ((cb = slp->sl_Qnexus) == NULL)
goto bad;
cb->ccb_sscp.scp_status = slp->sl_scp.scp_status;
switch (slp->sl_scp.scp_status)
{
case ST_INTERGOOD:
case ST_INTERMET:
li->li_maxnqio = li->li_maxnexus;
break;
default:
slp->sl_error |= MSGERR;
break;
}
if ((li->li_flags & SCSI_LOW_LINK) == 0)
goto bad;
cb->ccb_error |= slp->sl_error;
if (cb->ccb_error != 0)
goto bad;
for (ncb = TAILQ_FIRST(&slp->sl_start); ncb != NULL;
ncb = TAILQ_NEXT(ncb, ccb_chain))
{
if (ncb->li == li)
goto cmd_link_start;
}
bad:
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_LCTERM);
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_REJECT, 0);
return EIO;
cmd_link_start:
ncb->ccb_flags &= ~CCB_STARTQ;
TAILQ_REMOVE(&slp->sl_start, ncb, ccb_chain);
scsi_low_dealloc_qtag(ncb);
ncb->ccb_tag = cb->ccb_tag;
ncb->ccb_otag = cb->ccb_otag;
cb->ccb_tag = SCSI_LOW_UNKTAG;
cb->ccb_otag = SCSI_LOW_UNKTAG;
if (scsi_low_done(slp, cb) == SCSI_LOW_DONE_RETRY)
panic("%s: linked ccb retried",
device_get_nameunit(slp->sl_dev));
slp->sl_Qnexus = ncb;
slp->sl_ph_count = 0;
ncb->ccb_error = 0;
ncb->ccb_datalen = -1;
ncb->ccb_scp.scp_status = ST_UNKNOWN;
ncb->ccb_flags &= ~CCB_INTERNAL;
scsi_low_init_msgsys(slp, ti);
scsi_low_ccb_setup_cam(slp, ncb);
if (ncb->ccb_tcmax < SCSI_LOW_MIN_TOUT)
ncb->ccb_tcmax = SCSI_LOW_MIN_TOUT;
ncb->ccb_tc = ncb->ccb_tcmax;
/* setup saved scsi data pointer */
ncb->ccb_sscp = ncb->ccb_scp;
slp->sl_scp = ncb->ccb_sscp;
slp->sl_error = ncb->ccb_error;
#ifdef SCSI_LOW_DIAGNOSTIC
scsi_low_msg_log_init(&ti->ti_log_msgin);
scsi_low_msg_log_init(&ti->ti_log_msgout);
#endif /* SCSI_LOW_DIAGNOSTIC */
return EJUSTRETURN;
}
static int
scsi_low_msginfunc_disc(slp)
struct scsi_low_softc *slp;
{
SCSI_LOW_SETUP_MSGPHASE(slp, MSGPH_DISC);
return 0;
}
static int
scsi_low_msginfunc_sdp(slp)
struct scsi_low_softc *slp;
{
struct slccb *cb = slp->sl_Qnexus;
if (cb != NULL)
{
cb->ccb_sscp.scp_datalen = slp->sl_scp.scp_datalen;
cb->ccb_sscp.scp_data = slp->sl_scp.scp_data;
}
else
scsi_low_assert_msg(slp, slp->sl_Tnexus, SCSI_LOW_MSG_REJECT, 0);
return 0;
}
static int
scsi_low_msginfunc_rp(slp)
struct scsi_low_softc *slp;
{
if (slp->sl_Qnexus != NULL)
slp->sl_scp = slp->sl_Qnexus->ccb_sscp;
else
scsi_low_assert_msg(slp, slp->sl_Tnexus, SCSI_LOW_MSG_REJECT, 0);
return 0;
}
static int
scsi_low_synch(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
u_int period = 0, offset = 0, speed;
u_char *s;
int error;
if ((MSGIN_PERIOD(ti) >= ti->ti_maxsynch.period &&
MSGIN_OFFSET(ti) <= ti->ti_maxsynch.offset) ||
MSGIN_OFFSET(ti) == 0)
{
if ((offset = MSGIN_OFFSET(ti)) != 0)
period = MSGIN_PERIOD(ti);
s = offset ? "synchronous" : "async";
}
else
{
/* XXX:
* Target seems to be brain damaged.
* Force async transfer.
*/
ti->ti_maxsynch.period = 0;
ti->ti_maxsynch.offset = 0;
device_printf(slp->sl_dev,
"target brain damaged. async transfer\n");
return EINVAL;
}
ti->ti_maxsynch.period = period;
ti->ti_maxsynch.offset = offset;
error = (*slp->sl_funcs->scsi_low_msg) (slp, ti, SCSI_LOW_MSG_SYNCH);
if (error != 0)
{
/* XXX:
* Current period and offset are not acceptable
* for our adapter.
* The adapter changes max synch and max offset.
*/
device_printf(slp->sl_dev,
"synch neg failed. retry synch msg neg ...\n");
return error;
}
ti->ti_osynch = ti->ti_maxsynch;
if (offset > 0)
{
ti->ti_setup_msg_done |= SCSI_LOW_MSG_SYNCH;
}
/* inform data */
if ((slp->sl_show_result & SHOW_SYNCH_NEG) != 0)
{
#ifdef SCSI_LOW_NEGOTIATE_BEFORE_SENSE
struct slccb *cb = slp->sl_Qnexus;
if (cb != NULL && (cb->ccb_flags & CCB_SENSE) != 0)
return 0;
#endif /* SCSI_LOW_NEGOTIATE_BEFORE_SENSE */
device_printf(slp->sl_dev,
"(%d:*): <%s> offset %d period %dns ",
ti->ti_id, s, offset, period * 4);
if (period != 0)
{
speed = 1000 * 10 / (period * 4);
printf("%d.%d M/s", speed / 10, speed % 10);
}
printf("\n");
}
return 0;
}
static int
scsi_low_wide(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
int error;
ti->ti_width = MSGIN_WIDTHP(ti);
error = (*slp->sl_funcs->scsi_low_msg) (slp, ti, SCSI_LOW_MSG_WIDE);
if (error != 0)
{
/* XXX:
* Current width is not acceptable for our adapter.
* The adapter changes max width.
*/
device_printf(slp->sl_dev,
"wide neg failed. retry wide msg neg ...\n");
return error;
}
ti->ti_owidth = ti->ti_width;
if (ti->ti_width > SCSI_LOW_BUS_WIDTH_8)
{
ti->ti_setup_msg_done |=
(SCSI_LOW_MSG_SYNCH | SCSI_LOW_MSG_WIDE);
}
/* inform data */
if ((slp->sl_show_result & SHOW_WIDE_NEG) != 0)
{
#ifdef SCSI_LOW_NEGOTIATE_BEFORE_SENSE
struct slccb *cb = slp->sl_Qnexus;
if (cb != NULL && (cb->ccb_flags & CCB_SENSE) != 0)
return 0;
#endif /* SCSI_LOW_NEGOTIATE_BEFORE_SENSE */
device_printf(slp->sl_dev, "(%d:*): transfer width %d bits\n",
ti->ti_id, 1 << (3 + ti->ti_width));
}
return 0;
}
static int
scsi_low_msginfunc_simple_qtag(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
scsi_low_tag_t etag = (scsi_low_tag_t) ti->ti_msgin[1];
if (slp->sl_Qnexus != NULL)
{
if (slp->sl_Qnexus->ccb_tag != etag)
{
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
SCSI_LOW_INFO(slp, ti, "MSGIN: qtag mismatch");
}
}
else if (scsi_low_establish_ccb(ti, slp->sl_Lnexus, etag) == NULL)
{
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_NEXUS_CHECK, ti->ti_id))
return 0;
#endif /* SCSI_LOW_DEBUG */
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT_QTAG, 0);
SCSI_LOW_INFO(slp, ti, "MSGIN: taged ccb not found");
}
return 0;
}
static int
scsi_low_msginfunc_i_wide_residue(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
struct slccb *cb = slp->sl_Qnexus;
int res = (int) ti->ti_msgin[1];
if (cb == NULL || res <= 0 ||
(ti->ti_width == SCSI_LOW_BUS_WIDTH_16 && res > 1) ||
(ti->ti_width == SCSI_LOW_BUS_WIDTH_32 && res > 3))
return EINVAL;
if (slp->sl_scp.scp_datalen + res > cb->ccb_scp.scp_datalen)
return EINVAL;
slp->sl_scp.scp_datalen += res;
slp->sl_scp.scp_data -= res;
scsi_low_data_finish(slp);
return 0;
}
static int
scsi_low_msginfunc_ext(slp)
struct scsi_low_softc *slp;
{
struct slccb *cb = slp->sl_Qnexus;
struct lun_info *li = slp->sl_Lnexus;
struct targ_info *ti = slp->sl_Tnexus;
int count, retry;
u_int32_t *ptr;
if (ti->ti_msginptr == 2)
{
ti->ti_msginlen = ti->ti_msgin[1] + 2;
return 0;
}
switch (MKMSG_EXTEND(ti->ti_msgin[1], ti->ti_msgin[2]))
{
case MKMSG_EXTEND(MSG_EXTEND_MDPLEN, MSG_EXTEND_MDPCODE):
if (cb == NULL)
break;
ptr = (u_int32_t *)(&ti->ti_msgin[3]);
count = (int) htonl((long) (*ptr));
if(slp->sl_scp.scp_datalen - count < 0 ||
slp->sl_scp.scp_datalen - count > cb->ccb_scp.scp_datalen)
break;
slp->sl_scp.scp_datalen -= count;
slp->sl_scp.scp_data += count;
return 0;
case MKMSG_EXTEND(MSG_EXTEND_SYNCHLEN, MSG_EXTEND_SYNCHCODE):
if (li == NULL)
break;
retry = scsi_low_synch(slp);
if (retry != 0 || (ti->ti_emsgflags & SCSI_LOW_MSG_SYNCH) == 0)
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_SYNCH, 0);
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_ATTEN_CHECK, ti->ti_id))
{
scsi_low_test_atten(slp, ti, SCSI_LOW_MSG_SYNCH);
}
#endif /* SCSI_LOW_DEBUG */
return 0;
case MKMSG_EXTEND(MSG_EXTEND_WIDELEN, MSG_EXTEND_WIDECODE):
if (li == NULL)
break;
retry = scsi_low_wide(slp);
if (retry != 0 || (ti->ti_emsgflags & SCSI_LOW_MSG_WIDE) == 0)
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_WIDE, 0);
return 0;
default:
break;
}
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_REJECT, 0);
return EINVAL;
}
static int
scsi_low_msginfunc_parity(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
/* only I -> T, invalid! */
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_REJECT, 0);
return 0;
}
static int
scsi_low_msginfunc_msg_reject(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti = slp->sl_Tnexus;
struct scsi_low_msgout_data *mdp;
u_int msgflags;
if (ti->ti_emsgflags != 0)
{
device_printf(slp->sl_dev, "msg flags [0x%x] rejected\n",
ti->ti_emsgflags);
msgflags = SCSI_LOW_MSG_REJECT;
mdp = &scsi_low_msgout_data[0];
for ( ; mdp->md_flags != SCSI_LOW_MSG_ALL; mdp ++)
{
if ((ti->ti_emsgflags & mdp->md_flags) != 0)
{
ti->ti_emsgflags &= ~mdp->md_flags;
if (mdp->md_errfunc != NULL)
(*mdp->md_errfunc) (slp, msgflags);
break;
}
}
return 0;
}
else
{
SCSI_LOW_INFO(slp, ti, "MSGIN: rejected msg not found");
slp->sl_error |= MSGERR;
}
return EINVAL;
}
int
scsi_low_msgin(slp, ti, c)
struct scsi_low_softc *slp;
struct targ_info *ti;
u_int c;
{
struct scsi_low_msgin_data *sdp;
struct lun_info *li;
u_int8_t msg;
#ifdef SCSI_LOW_DIAGNOSTIC
if (ti != slp->sl_Tnexus)
{
scsi_low_print(slp, NULL);
panic("scsi_low_msgin: Target nexus inconsistent");
}
#endif /* SCSI_LOW_DIAGNOSTIC */
/*
* Phase changes, clear the pointer.
*/
if (ti->ti_ophase != ti->ti_phase)
{
MSGINPTR_CLR(ti);
ti->ti_msgin_parity_error = 0;
slp->sl_ph_count ++;
if (slp->sl_ph_count > SCSI_LOW_MAX_PHCHANGES)
{
device_printf(slp->sl_dev, "too many phase changes\n");
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
}
}
/*
* Store a current messages byte into buffer and
* wait for the completion of the current msg.
*/
ti->ti_msgin[ti->ti_msginptr ++] = (u_int8_t) c;
if (ti->ti_msginptr >= SCSI_LOW_MAX_MSGLEN)
{
ti->ti_msginptr = SCSI_LOW_MAX_MSGLEN - 1;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_REJECT, 0);
}
/*
* Check parity errors.
*/
if ((c & SCSI_LOW_DATA_PE) != 0)
{
ti->ti_msgin_parity_error ++;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_PARITY, 0);
goto out;
}
if (ti->ti_msgin_parity_error != 0)
goto out;
/*
* Calculate messages length.
*/
msg = ti->ti_msgin[0];
if (msg < MSGIN_DATA_LAST)
sdp = &scsi_low_msgin_data[msg];
else
sdp = &scsi_low_msgin_data[MSGIN_DATA_LAST];
if (ti->ti_msginlen == 0)
{
ti->ti_msginlen = sdp->md_len;
}
/*
* Check comletion.
*/
if (ti->ti_msginptr < ti->ti_msginlen)
return EJUSTRETURN;
/*
* Do process.
*/
if ((msg & MSG_IDENTIFY) == 0)
{
if (((*sdp->md_msgfunc) (slp)) == EJUSTRETURN)
return EJUSTRETURN;
}
else
{
li = slp->sl_Lnexus;
if (li == NULL)
{
li = scsi_low_alloc_li(ti, MSGCMD_LUN(msg), 0);
if (li == NULL)
goto badlun;
slp->sl_Lnexus = li;
(*slp->sl_funcs->scsi_low_establish_lun_nexus) (slp);
}
else
{
if (MSGCMD_LUN(msg) != li->li_lun)
goto badlun;
}
if (slp->sl_Qnexus == NULL && li->li_nqio == 0)
{
if (!scsi_low_establish_ccb(ti, li, SCSI_LOW_UNKTAG))
{
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_NEXUS_CHECK, ti->ti_id) != 0)
{
goto out;
}
#endif /* SCSI_LOW_DEBUG */
goto badlun;
}
}
}
goto out;
/*
* Msg process completed, reset msgin pointer and assert ATN if desired.
*/
badlun:
slp->sl_error |= FATALIO;
scsi_low_assert_msg(slp, ti, SCSI_LOW_MSG_ABORT, 0);
SCSI_LOW_INFO(slp, ti, "MSGIN: identify wrong");
out:
if (ti->ti_msginptr < ti->ti_msginlen)
return EJUSTRETURN;
#ifdef SCSI_LOW_DIAGNOSTIC
scsi_low_msg_log_write(&ti->ti_log_msgin,
&ti->ti_msgin[0], ti->ti_msginlen);
#endif /* SCSI_LOW_DIAGNOSTIC */
MSGINPTR_CLR(ti);
return 0;
}
/**********************************************************
* disconnect
**********************************************************/
int
scsi_low_disconnected(slp, ti)
struct scsi_low_softc *slp;
struct targ_info *ti;
{
struct slccb *cb = slp->sl_Qnexus;
/* check phase completion */
switch (slp->sl_msgphase)
{
case MSGPH_RESET:
scsi_low_statusin(slp, slp->sl_Tnexus, ST_GOOD);
scsi_low_msginfunc_cc(slp);
scsi_low_reset_nexus_target(slp, slp->sl_Tnexus, 0);
goto io_resume;
case MSGPH_ABORT:
scsi_low_statusin(slp, slp->sl_Tnexus, ST_GOOD);
scsi_low_msginfunc_cc(slp);
scsi_low_reset_nexus_lun(slp, slp->sl_Lnexus, 0);
goto io_resume;
case MSGPH_TERM:
scsi_low_statusin(slp, slp->sl_Tnexus, ST_GOOD);
scsi_low_msginfunc_cc(slp);
goto io_resume;
case MSGPH_DISC:
if (cb != NULL)
{
struct lun_info *li;
li = cb->li;
TAILQ_INSERT_TAIL(&li->li_discq, cb, ccb_chain);
cb->ccb_flags |= CCB_DISCQ;
cb->ccb_error |= slp->sl_error;
li->li_disc ++;
ti->ti_disc ++;
slp->sl_disc ++;
}
#ifdef SCSI_LOW_STATICS
scsi_low_statics.nexus_disconnected ++;
#endif /* SCSI_LOW_STATICS */
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_GO(SCSI_LOW_DEBUG_DISC, ti->ti_id) != 0)
{
printf("## SCSI_LOW_DISCONNECTED ===============\n");
scsi_low_print(slp, NULL);
}
#endif /* SCSI_LOW_DEBUG */
break;
case MSGPH_NULL:
slp->sl_error |= FATALIO;
if (ti->ti_phase == PH_SELSTART)
slp->sl_error |= SELTIMEOUTIO;
else
slp->sl_error |= UBFERR;
/* fall through */
case MSGPH_LCTERM:
case MSGPH_CMDC:
io_resume:
if (cb == NULL)
break;
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_TEST_GO(SCSI_LOW_ATTEN_CHECK, ti->ti_id))
{
if (cb->ccb_omsgoutflag == SCSI_LOW_MSG_NOOP &&
(cb->ccb_msgoutflag != 0 ||
(ti->ti_msgflags & SCSI_LOW_MSG_NOOP)))
{
scsi_low_info(slp, ti, "ATTEN CHECK FAILED");
}
}
#endif /* SCSI_LOW_DEBUG */
cb->ccb_error |= slp->sl_error;
if (scsi_low_done(slp, cb) == SCSI_LOW_DONE_RETRY)
{
cb->ccb_flags |= CCB_STARTQ;
TAILQ_INSERT_HEAD(&slp->sl_start, cb, ccb_chain);
}
break;
}
scsi_low_bus_release(slp, ti);
scsi_low_start(slp);
return 1;
}
/**********************************************************
* TAG operations
**********************************************************/
static int
scsi_low_alloc_qtag(cb)
struct slccb *cb;
{
struct lun_info *li = cb->li;
scsi_low_tag_t etag;
if (cb->ccb_otag != SCSI_LOW_UNKTAG)
return 0;
#ifndef SCSI_LOW_ALT_QTAG_ALLOCATE
etag = ffs(li->li_qtagbits);
if (etag == 0)
return ENOSPC;
li->li_qtagbits &= ~(1 << (etag - 1));
cb->ccb_otag = etag;
return 0;
#else /* SCSI_LOW_ALT_QTAG_ALLOCATE */
for (etag = li->li_qd ; li->li_qd < SCSI_LOW_MAXNEXUS; li->li_qd ++)
if (li->li_qtagarray[li->li_qd] == 0)
goto found;
for (li->li_qd = 0; li->li_qd < etag; li->li_qd ++)
if (li->li_qtagarray[li->li_qd] == 0)
goto found;
return ENOSPC;
found:
li->li_qtagarray[li->li_qd] ++;
cb->ccb_otag = (li->li_qd ++);
return 0;
#endif /* SCSI_LOW_ALT_QTAG_ALLOCATE */
}
static int
scsi_low_dealloc_qtag(cb)
struct slccb *cb;
{
struct lun_info *li = cb->li;
scsi_low_tag_t etag;
if (cb->ccb_otag == SCSI_LOW_UNKTAG)
return 0;
#ifndef SCSI_LOW_ALT_QTAG_ALLOCATE
etag = cb->ccb_otag - 1;
#ifdef SCSI_LOW_DIAGNOSTIC
if (etag >= sizeof(li->li_qtagbits) * NBBY)
panic("scsi_low_dealloc_tag: illegal tag");
#endif /* SCSI_LOW_DIAGNOSTIC */
li->li_qtagbits |= (1 << etag);
#else /* SCSI_LOW_ALT_QTAG_ALLOCATE */
etag = cb->ccb_otag;
#ifdef SCSI_LOW_DIAGNOSTIC
if (etag >= SCSI_LOW_MAXNEXUS)
panic("scsi_low_dealloc_tag: illegal tag");
#endif /* SCSI_LOW_DIAGNOSTIC */
li->li_qtagarray[etag] --;
#endif /* SCSI_LOW_ALT_QTAG_ALLOCATE */
cb->ccb_otag = SCSI_LOW_UNKTAG;
return 0;
}
static struct slccb *
scsi_low_revoke_ccb(slp, cb, fdone)
struct scsi_low_softc *slp;
struct slccb *cb;
int fdone;
{
struct targ_info *ti = cb->ti;
struct lun_info *li = cb->li;
#ifdef SCSI_LOW_DIAGNOSTIC
if ((cb->ccb_flags & (CCB_STARTQ | CCB_DISCQ)) ==
(CCB_STARTQ | CCB_DISCQ))
{
panic("%s: ccb in both queue",
device_get_nameunit(slp->sl_dev));
}
#endif /* SCSI_LOW_DIAGNOSTIC */
if ((cb->ccb_flags & CCB_STARTQ) != 0)
{
TAILQ_REMOVE(&slp->sl_start, cb, ccb_chain);
}
if ((cb->ccb_flags & CCB_DISCQ) != 0)
{
TAILQ_REMOVE(&li->li_discq, cb, ccb_chain);
li->li_disc --;
ti->ti_disc --;
slp->sl_disc --;
}
cb->ccb_flags &= ~(CCB_STARTQ | CCB_DISCQ |
CCB_SENSE | CCB_CLEARQ | CCB_INTERNAL);
if (fdone != 0 &&
(cb->ccb_rcnt ++ >= slp->sl_max_retry ||
(cb->ccb_flags & CCB_NORETRY) != 0))
{
cb->ccb_error |= FATALIO;
cb->ccb_flags &= ~CCB_AUTOSENSE;
if (scsi_low_done(slp, cb) != SCSI_LOW_DONE_COMPLETE)
panic("%s: done ccb retried",
device_get_nameunit(slp->sl_dev));
return NULL;
}
else
{
cb->ccb_error |= PENDINGIO;
scsi_low_deactivate_qtag(cb);
scsi_low_ccb_message_retry(cb);
cb->ccb_tc = cb->ccb_tcmax = SCSI_LOW_MIN_TOUT;
return cb;
}
}
static void
scsi_low_reset_nexus_lun(slp, li, fdone)
struct scsi_low_softc *slp;
struct lun_info *li;
int fdone;
{
struct slccb *cb, *ncb, *ecb;
if (li == NULL)
return;
ecb = NULL;
for (cb = TAILQ_FIRST(&li->li_discq); cb != NULL; cb = ncb)
{
ncb = TAILQ_NEXT(cb, ccb_chain);
cb = scsi_low_revoke_ccb(slp, cb, fdone);
if (cb != NULL)
{
/*
* presumely keep ordering of io
*/
cb->ccb_flags |= CCB_STARTQ;
if (ecb == NULL)
{
TAILQ_INSERT_HEAD(&slp->sl_start,\
cb, ccb_chain);
}
else
{
TAILQ_INSERT_AFTER(&slp->sl_start,\
ecb, cb, ccb_chain);
}
ecb = cb;
}
}
}
/**************************************************************
* Qurik setup
**************************************************************/
static void
scsi_low_calcf_lun(li)
struct lun_info *li;
{
struct targ_info *ti = li->li_ti;
struct scsi_low_softc *slp = ti->ti_sc;
u_int cfgflags, diskflags;
if (li->li_flags_valid == SCSI_LOW_LUN_FLAGS_ALL_VALID)
cfgflags = li->li_cfgflags;
else
cfgflags = 0;
diskflags = li->li_diskflags & li->li_quirks;
/* disconnect */
li->li_flags &= ~SCSI_LOW_DISC;
if ((slp->sl_cfgflags & CFG_NODISC) == 0 &&
(diskflags & SCSI_LOW_DISK_DISC) != 0 &&
(cfgflags & SCSI_LOW_DISC) != 0)
li->li_flags |= SCSI_LOW_DISC;
/* parity */
li->li_flags |= SCSI_LOW_NOPARITY;
if ((slp->sl_cfgflags & CFG_NOPARITY) == 0 &&
(diskflags & SCSI_LOW_DISK_PARITY) != 0 &&
(cfgflags & SCSI_LOW_NOPARITY) == 0)
li->li_flags &= ~SCSI_LOW_NOPARITY;
/* qtag */
if ((slp->sl_cfgflags & CFG_NOQTAG) == 0 &&
(cfgflags & SCSI_LOW_QTAG) != 0 &&
(diskflags & SCSI_LOW_DISK_QTAG) != 0)
{
li->li_flags |= SCSI_LOW_QTAG;
li->li_maxnexus = SCSI_LOW_MAXNEXUS;
li->li_maxnqio = li->li_maxnexus;
}
else
{
li->li_flags &= ~SCSI_LOW_QTAG;
li->li_maxnexus = 0;
li->li_maxnqio = li->li_maxnexus;
}
/* cmd link */
li->li_flags &= ~SCSI_LOW_LINK;
if ((cfgflags & SCSI_LOW_LINK) != 0 &&
(diskflags & SCSI_LOW_DISK_LINK) != 0)
li->li_flags |= SCSI_LOW_LINK;
/* compatible flags */
li->li_flags &= ~SCSI_LOW_SYNC;
if (ti->ti_maxsynch.offset > 0)
li->li_flags |= SCSI_LOW_SYNC;
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_GO(SCSI_LOW_DEBUG_CALCF, ti->ti_id) != 0)
{
scsi_low_calcf_show(li);
}
#endif /* SCSI_LOW_DEBUG */
}
static void
scsi_low_calcf_target(ti)
struct targ_info *ti;
{
struct scsi_low_softc *slp = ti->ti_sc;
u_int offset, period, diskflags;
diskflags = ti->ti_diskflags & ti->ti_quirks;
/* synch */
if ((slp->sl_cfgflags & CFG_ASYNC) == 0 &&
(diskflags & SCSI_LOW_DISK_SYNC) != 0)
{
offset = ti->ti_maxsynch.offset;
period = ti->ti_maxsynch.period;
if (offset == 0 || period == 0)
offset = period = 0;
}
else
{
offset = period = 0;
}
ti->ti_maxsynch.offset = offset;
ti->ti_maxsynch.period = period;
/* wide */
if ((diskflags & SCSI_LOW_DISK_WIDE_32) == 0 &&
ti->ti_width > SCSI_LOW_BUS_WIDTH_16)
ti->ti_width = SCSI_LOW_BUS_WIDTH_16;
if ((diskflags & SCSI_LOW_DISK_WIDE_16) == 0 &&
ti->ti_width > SCSI_LOW_BUS_WIDTH_8)
ti->ti_width = SCSI_LOW_BUS_WIDTH_8;
if (ti->ti_flags_valid == SCSI_LOW_TARG_FLAGS_ALL_VALID)
{
if (ti->ti_maxsynch.offset != ti->ti_osynch.offset ||
ti->ti_maxsynch.period != ti->ti_osynch.period)
ti->ti_setup_msg |= SCSI_LOW_MSG_SYNCH;
if (ti->ti_width != ti->ti_owidth)
ti->ti_setup_msg |= (SCSI_LOW_MSG_WIDE | SCSI_LOW_MSG_SYNCH);
ti->ti_osynch = ti->ti_maxsynch;
ti->ti_owidth = ti->ti_width;
}
#ifdef SCSI_LOW_DEBUG
if (SCSI_LOW_DEBUG_GO(SCSI_LOW_DEBUG_CALCF, ti->ti_id) != 0)
{
device_printf(slp->sl_dev,
"(%d:*): max period(%dns) offset(%d) width(%d)\n",
ti->ti_id,
ti->ti_maxsynch.period * 4,
ti->ti_maxsynch.offset,
ti->ti_width);
}
#endif /* SCSI_LOW_DEBUG */
}
static void
scsi_low_calcf_show(li)
struct lun_info *li;
{
struct targ_info *ti = li->li_ti;
struct scsi_low_softc *slp = ti->ti_sc;
device_printf(slp->sl_dev,
"(%d:%d): period(%d ns) offset(%d) width(%d) flags 0x%b\n",
ti->ti_id, li->li_lun,
ti->ti_maxsynch.period * 4,
ti->ti_maxsynch.offset,
ti->ti_width,
li->li_flags, SCSI_LOW_BITS);
}
#ifdef SCSI_LOW_START_UP_CHECK
/**************************************************************
* scsi world start up
**************************************************************/
static int scsi_low_poll(struct scsi_low_softc *, struct slccb *);
static int
scsi_low_start_up(slp)
struct scsi_low_softc *slp;
{
struct targ_info *ti;
struct lun_info *li;
struct slccb *cb;
int target, lun;
device_printf(slp->sl_dev, "scsi_low: probing all devices ....\n");
for (target = 0; target < slp->sl_ntargs; target ++)
{
if (target == slp->sl_hostid)
{
if ((slp->sl_show_result & SHOW_PROBE_RES) != 0)
{
device_printf(slp->sl_dev,
"scsi_low: target %d (host card)\n",
target);
}
continue;
}
if ((slp->sl_show_result & SHOW_PROBE_RES) != 0)
{
device_printf(slp->sl_dev, "scsi_low: target %d lun ",
target);
}
ti = slp->sl_ti[target];
for (lun = 0; lun < slp->sl_nluns; lun ++)
{
if ((cb = SCSI_LOW_ALLOC_CCB(1)) == NULL)
break;
cb->osdep = NULL;
cb->bp = NULL;
li = scsi_low_alloc_li(ti, lun, 1);
scsi_low_enqueue(slp, ti, li, cb,
CCB_AUTOSENSE | CCB_POLLED, 0);
scsi_low_poll(slp, cb);
if (li->li_state != SCSI_LOW_LUN_OK)
break;
if ((slp->sl_show_result & SHOW_PROBE_RES) != 0)
{
printf("%d ", lun);
}
}
if ((slp->sl_show_result & SHOW_PROBE_RES) != 0)
{
printf("\n");
}
}
return 0;
}
static int
scsi_low_poll(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
int tcount;
tcount = 0;
while (slp->sl_nio > 0)
{
DELAY((1000 * 1000) / SCSI_LOW_POLL_HZ);
(*slp->sl_funcs->scsi_low_poll) (slp);
if (tcount ++ < SCSI_LOW_POLL_HZ / SCSI_LOW_TIMEOUT_HZ)
continue;
tcount = 0;
scsi_low_timeout_check(slp);
}
return 0;
}
#endif /* SCSI_LOW_START_UP_CHECK */
/**********************************************************
* DEBUG SECTION
**********************************************************/
#ifdef SCSI_LOW_DEBUG
static void
scsi_low_test_abort(slp, ti, li)
struct scsi_low_softc *slp;
struct targ_info *ti;
struct lun_info *li;
{
struct slccb *acb;
if (li->li_disc > 1)
{
acb = TAILQ_FIRST(&li->li_discq);
if (scsi_low_abort_ccb(slp, acb) == 0)
{
device_printf(slp->sl_dev,
"aborting ccb(0x%lx) start\n", (u_long) acb);
}
}
}
static void
scsi_low_test_atten(slp, ti, msg)
struct scsi_low_softc *slp;
struct targ_info *ti;
u_int msg;
{
if (slp->sl_ph_count < SCSI_LOW_MAX_ATTEN_CHECK)
scsi_low_assert_msg(slp, ti, msg, 0);
else
device_printf(slp->sl_dev, "atten check OK\n");
}
static void
scsi_low_test_cmdlnk(slp, cb)
struct scsi_low_softc *slp;
struct slccb *cb;
{
#define SCSI_LOW_CMDLNK_NOK (CCB_INTERNAL | CCB_SENSE | CCB_CLEARQ)
if ((cb->ccb_flags & SCSI_LOW_CMDLNK_NOK) != 0)
return;
memcpy(cb->ccb_scsi_cmd, slp->sl_scp.scp_cmd,
slp->sl_scp.scp_cmdlen);
cb->ccb_scsi_cmd[slp->sl_scp.scp_cmdlen - 1] |= 1;
slp->sl_scp.scp_cmd = cb->ccb_scsi_cmd;
}
#endif /* SCSI_LOW_DEBUG */
/* static */ void
scsi_low_info(slp, ti, s)
struct scsi_low_softc *slp;
struct targ_info *ti;
u_char *s;
{
if (slp == NULL)
slp = LIST_FIRST(&sl_tab);
if (s == NULL)
s = "no message";
printf(">>>>> SCSI_LOW_INFO(0x%lx): %s\n", (u_long) slp->sl_Tnexus, s);
if (ti == NULL)
{
TAILQ_FOREACH(ti, &slp->sl_titab, ti_chain)
{
scsi_low_print(slp, ti);
}
}
else
{
scsi_low_print(slp, ti);
}
}
static u_char *phase[] =
{
"FREE", "ARBSTART", "SELSTART", "SELECTED",
"CMDOUT", "DATA", "MSGIN", "MSGOUT", "STATIN", "DISC", "RESEL"
};
void
scsi_low_print(slp, ti)
struct scsi_low_softc *slp;
struct targ_info *ti;
{
struct lun_info *li;
struct slccb *cb;
struct sc_p *sp;
if (ti == NULL || ti == slp->sl_Tnexus)
{
ti = slp->sl_Tnexus;
li = slp->sl_Lnexus;
cb = slp->sl_Qnexus;
}
else
{
li = LIST_FIRST(&ti->ti_litab);
cb = TAILQ_FIRST(&li->li_discq);
}
sp = &slp->sl_scp;
device_printf(slp->sl_dev,
"=== NEXUS T(0x%lx) L(0x%lx) Q(0x%lx) NIO(%d) ===\n",
(u_long) ti, (u_long) li, (u_long) cb, slp->sl_nio);
/* target stat */
if (ti != NULL)
{
u_int flags = 0, maxnqio = 0, nqio = 0;
int lun = CAM_LUN_WILDCARD;
if (li != NULL)
{
lun = li->li_lun;
flags = li->li_flags;
maxnqio = li->li_maxnqio;
nqio = li->li_nqio;
}
device_printf(slp->sl_dev,
"(%d:%d) ph<%s> => ph<%s> DISC(%d) QIO(%d:%d)\n",
ti->ti_id, lun, phase[(int) ti->ti_ophase],
phase[(int) ti->ti_phase], ti->ti_disc,
nqio, maxnqio);
if (cb != NULL)
{
printf("CCB: cmd[0] 0x%x clen 0x%x dlen 0x%x<0x%x stat 0x%x err %b\n",
(u_int) cb->ccb_scp.scp_cmd[0],
cb->ccb_scp.scp_cmdlen,
cb->ccb_datalen,
cb->ccb_scp.scp_datalen,
(u_int) cb->ccb_sscp.scp_status,
cb->ccb_error, SCSI_LOW_ERRORBITS);
}
printf("MSGIN: ptr(%x) [%x][%x][%x][%x][%x] attention: %d\n",
(u_int) (ti->ti_msginptr),
(u_int) (ti->ti_msgin[0]),
(u_int) (ti->ti_msgin[1]),
(u_int) (ti->ti_msgin[2]),
(u_int) (ti->ti_msgin[3]),
(u_int) (ti->ti_msgin[4]),
slp->sl_atten);
printf("MSGOUT: msgflags 0x%x [%x][%x][%x][%x][%x] msgoutlen %d C_FLAGS: %b\n",
(u_int) ti->ti_msgflags,
(u_int) (ti->ti_msgoutstr[0]),
(u_int) (ti->ti_msgoutstr[1]),
(u_int) (ti->ti_msgoutstr[2]),
(u_int) (ti->ti_msgoutstr[3]),
(u_int) (ti->ti_msgoutstr[4]),
ti->ti_msgoutlen,
flags, SCSI_LOW_BITS);
#ifdef SCSI_LOW_DIAGNOSTIC
scsi_low_msg_log_show(&ti->ti_log_msgin, "MIN LOG ", 2);
scsi_low_msg_log_show(&ti->ti_log_msgout, "MOUT LOG", 2);
#endif /* SCSI_LOW_DIAGNOSTIC */
}
printf("SCB: daddr 0x%lx dlen 0x%x stat 0x%x err %b\n",
(u_long) sp->scp_data,
sp->scp_datalen,
(u_int) sp->scp_status,
slp->sl_error, SCSI_LOW_ERRORBITS);
}
Reference in New Issue View Git Blame Copy Permalink