MFp4:
Move Port Multiplier support code out of ATA XPT into pmp periph driver. This is convinient, as PMP itself is a bus target and has own state.
This commit is contained in:
parent
48f2bfe224
commit
65d0fb03ad
Notes:
svn2git
2020-12-20 02:59:44 +00:00
svn path=/head/; revision=198389
735
sys/cam/ata/ata_pmp.c
Normal file
735
sys/cam/ata/ata_pmp.c
Normal file
@ -0,0 +1,735 @@
|
||||
/*-
|
||||
* Copyright (c) 2009 Alexander Motin <mav@FreeBSD.org>
|
||||
* 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,
|
||||
* without modification, immediately at the beginning of the file.
|
||||
* 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.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include <sys/cdefs.h>
|
||||
__FBSDID("$FreeBSD$");
|
||||
|
||||
#include <sys/param.h>
|
||||
|
||||
#ifdef _KERNEL
|
||||
#include <sys/systm.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/bio.h>
|
||||
#include <sys/sysctl.h>
|
||||
#include <sys/taskqueue.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/conf.h>
|
||||
#include <sys/devicestat.h>
|
||||
#include <sys/eventhandler.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/cons.h>
|
||||
#include <geom/geom_disk.h>
|
||||
#endif /* _KERNEL */
|
||||
|
||||
#ifndef _KERNEL
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#endif /* _KERNEL */
|
||||
|
||||
#include <cam/cam.h>
|
||||
#include <cam/cam_ccb.h>
|
||||
#include <cam/cam_periph.h>
|
||||
#include <cam/cam_xpt_periph.h>
|
||||
#include <cam/cam_sim.h>
|
||||
|
||||
#include <cam/ata/ata_all.h>
|
||||
|
||||
#ifdef _KERNEL
|
||||
|
||||
typedef enum {
|
||||
PMP_STATE_NORMAL,
|
||||
PMP_STATE_PORTS,
|
||||
PMP_STATE_CONFIG,
|
||||
PMP_STATE_RESET,
|
||||
PMP_STATE_CONNECT,
|
||||
PMP_STATE_CHECK,
|
||||
PMP_STATE_CLEAR,
|
||||
PMP_STATE_SCAN
|
||||
} pmp_state;
|
||||
|
||||
typedef enum {
|
||||
PMP_FLAG_SCTX_INIT = 0x200
|
||||
} pmp_flags;
|
||||
|
||||
typedef enum {
|
||||
PMP_CCB_PROBE = 0x01,
|
||||
} pmp_ccb_state;
|
||||
|
||||
/* Offsets into our private area for storing information */
|
||||
#define ccb_state ppriv_field0
|
||||
#define ccb_bp ppriv_ptr1
|
||||
|
||||
struct pmp_softc {
|
||||
SLIST_ENTRY(pmp_softc) links;
|
||||
pmp_state state;
|
||||
pmp_flags flags;
|
||||
uint32_t pm_pid;
|
||||
uint32_t pm_prv;
|
||||
int pm_ports;
|
||||
int pm_step;
|
||||
int pm_try;
|
||||
int found;
|
||||
int frozen;
|
||||
union ccb saved_ccb;
|
||||
struct task sysctl_task;
|
||||
struct sysctl_ctx_list sysctl_ctx;
|
||||
struct sysctl_oid *sysctl_tree;
|
||||
};
|
||||
|
||||
static periph_init_t pmpinit;
|
||||
static void pmpasync(void *callback_arg, u_int32_t code,
|
||||
struct cam_path *path, void *arg);
|
||||
static void pmpsysctlinit(void *context, int pending);
|
||||
static periph_ctor_t pmpregister;
|
||||
static periph_dtor_t pmpcleanup;
|
||||
static periph_start_t pmpstart;
|
||||
static periph_oninv_t pmponinvalidate;
|
||||
static void pmpdone(struct cam_periph *periph,
|
||||
union ccb *done_ccb);
|
||||
|
||||
#ifndef PMP_DEFAULT_TIMEOUT
|
||||
#define PMP_DEFAULT_TIMEOUT 30 /* Timeout in seconds */
|
||||
#endif
|
||||
|
||||
#ifndef PMP_DEFAULT_RETRY
|
||||
#define PMP_DEFAULT_RETRY 1
|
||||
#endif
|
||||
|
||||
static int pmp_retry_count = PMP_DEFAULT_RETRY;
|
||||
static int pmp_default_timeout = PMP_DEFAULT_TIMEOUT;
|
||||
|
||||
SYSCTL_NODE(_kern_cam, OID_AUTO, pmp, CTLFLAG_RD, 0,
|
||||
"CAM Direct Access Disk driver");
|
||||
SYSCTL_INT(_kern_cam_pmp, OID_AUTO, retry_count, CTLFLAG_RW,
|
||||
&pmp_retry_count, 0, "Normal I/O retry count");
|
||||
TUNABLE_INT("kern.cam.pmp.retry_count", &pmp_retry_count);
|
||||
SYSCTL_INT(_kern_cam_pmp, OID_AUTO, default_timeout, CTLFLAG_RW,
|
||||
&pmp_default_timeout, 0, "Normal I/O timeout (in seconds)");
|
||||
TUNABLE_INT("kern.cam.pmp.default_timeout", &pmp_default_timeout);
|
||||
|
||||
static struct periph_driver pmpdriver =
|
||||
{
|
||||
pmpinit, "pmp",
|
||||
TAILQ_HEAD_INITIALIZER(pmpdriver.units), /* generation */ 0
|
||||
};
|
||||
|
||||
PERIPHDRIVER_DECLARE(pmp, pmpdriver);
|
||||
|
||||
MALLOC_DEFINE(M_ATPMP, "ata_pmp", "ata_pmp buffers");
|
||||
|
||||
static void
|
||||
pmpinit(void)
|
||||
{
|
||||
cam_status status;
|
||||
|
||||
/*
|
||||
* Install a global async callback. This callback will
|
||||
* receive async callbacks like "new device found".
|
||||
*/
|
||||
status = xpt_register_async(AC_FOUND_DEVICE, pmpasync, NULL, NULL);
|
||||
|
||||
if (status != CAM_REQ_CMP) {
|
||||
printf("pmp: Failed to attach master async callback "
|
||||
"due to status 0x%x!\n", status);
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
pmpfreeze(struct cam_periph *periph, int mask)
|
||||
{
|
||||
struct pmp_softc *softc = (struct pmp_softc *)periph->softc;
|
||||
struct cam_path *dpath;
|
||||
int i;
|
||||
|
||||
mask &= ~softc->frozen;
|
||||
for (i = 0; i < 15; i++) {
|
||||
if ((mask & (1 << i)) == 0)
|
||||
continue;
|
||||
if (xpt_create_path(&dpath, periph,
|
||||
xpt_path_path_id(periph->path),
|
||||
i, 0) == CAM_REQ_CMP) {
|
||||
printf("PMP freeze: %d\n", i);
|
||||
softc->frozen |= (1 << i);
|
||||
cam_freeze_devq(dpath);
|
||||
xpt_free_path(dpath);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
pmprelease(struct cam_periph *periph, int mask)
|
||||
{
|
||||
struct pmp_softc *softc = (struct pmp_softc *)periph->softc;
|
||||
struct cam_path *dpath;
|
||||
int i;
|
||||
|
||||
mask &= softc->frozen;
|
||||
for (i = 0; i < 15; i++) {
|
||||
if ((mask & (1 << i)) == 0)
|
||||
continue;
|
||||
if (xpt_create_path(&dpath, periph,
|
||||
xpt_path_path_id(periph->path),
|
||||
i, 0) == CAM_REQ_CMP) {
|
||||
printf("PMP release: %d\n", i);
|
||||
softc->frozen &= ~(1 << i);
|
||||
cam_release_devq(dpath, 0, 0, 0, FALSE);
|
||||
xpt_free_path(dpath);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
pmponinvalidate(struct cam_periph *periph)
|
||||
{
|
||||
struct pmp_softc *softc;
|
||||
struct cam_path *dpath;
|
||||
int i;
|
||||
|
||||
softc = (struct pmp_softc *)periph->softc;
|
||||
|
||||
/*
|
||||
* De-register any async callbacks.
|
||||
*/
|
||||
xpt_register_async(0, pmpasync, periph, periph->path);
|
||||
|
||||
for (i = 0; i < 15; i++) {
|
||||
if (xpt_create_path(&dpath, periph,
|
||||
xpt_path_path_id(periph->path),
|
||||
i, 0) == CAM_REQ_CMP) {
|
||||
xpt_async(AC_LOST_DEVICE, dpath, NULL);
|
||||
xpt_free_path(dpath);
|
||||
}
|
||||
}
|
||||
xpt_print(periph->path, "lost device\n");
|
||||
}
|
||||
|
||||
static void
|
||||
pmpcleanup(struct cam_periph *periph)
|
||||
{
|
||||
struct pmp_softc *softc;
|
||||
|
||||
softc = (struct pmp_softc *)periph->softc;
|
||||
|
||||
xpt_print(periph->path, "removing device entry\n");
|
||||
cam_periph_unlock(periph);
|
||||
|
||||
/*
|
||||
* If we can't free the sysctl tree, oh well...
|
||||
*/
|
||||
if ((softc->flags & PMP_FLAG_SCTX_INIT) != 0
|
||||
&& sysctl_ctx_free(&softc->sysctl_ctx) != 0) {
|
||||
xpt_print(periph->path, "can't remove sysctl context\n");
|
||||
}
|
||||
|
||||
free(softc, M_DEVBUF);
|
||||
cam_periph_lock(periph);
|
||||
}
|
||||
|
||||
static void
|
||||
pmpasync(void *callback_arg, u_int32_t code,
|
||||
struct cam_path *path, void *arg)
|
||||
{
|
||||
struct cam_periph *periph;
|
||||
struct pmp_softc *softc;
|
||||
|
||||
periph = (struct cam_periph *)callback_arg;
|
||||
switch (code) {
|
||||
case AC_FOUND_DEVICE:
|
||||
{
|
||||
struct ccb_getdev *cgd;
|
||||
cam_status status;
|
||||
|
||||
cgd = (struct ccb_getdev *)arg;
|
||||
if (cgd == NULL)
|
||||
break;
|
||||
|
||||
if (cgd->protocol != PROTO_SATAPM)
|
||||
break;
|
||||
|
||||
/*
|
||||
* Allocate a peripheral instance for
|
||||
* this device and start the probe
|
||||
* process.
|
||||
*/
|
||||
status = cam_periph_alloc(pmpregister, pmponinvalidate,
|
||||
pmpcleanup, pmpstart,
|
||||
"pmp", CAM_PERIPH_BIO,
|
||||
cgd->ccb_h.path, pmpasync,
|
||||
AC_FOUND_DEVICE, cgd);
|
||||
|
||||
if (status != CAM_REQ_CMP
|
||||
&& status != CAM_REQ_INPROG)
|
||||
printf("pmpasync: Unable to attach to new device "
|
||||
"due to status 0x%x\n", status);
|
||||
break;
|
||||
}
|
||||
case AC_SCSI_AEN:
|
||||
case AC_SENT_BDR:
|
||||
case AC_BUS_RESET:
|
||||
softc = (struct pmp_softc *)periph->softc;
|
||||
cam_periph_async(periph, code, path, arg);
|
||||
if (softc->state != PMP_STATE_NORMAL)
|
||||
break;
|
||||
pmpfreeze(periph, softc->found);
|
||||
if (code == AC_SENT_BDR || code == AC_BUS_RESET)
|
||||
softc->found = 0; /* We have to reset everything. */
|
||||
softc->state = PMP_STATE_PORTS;
|
||||
cam_periph_acquire(periph);
|
||||
xpt_schedule(periph, CAM_PRIORITY_DEV);
|
||||
break;
|
||||
default:
|
||||
cam_periph_async(periph, code, path, arg);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
pmpsysctlinit(void *context, int pending)
|
||||
{
|
||||
struct cam_periph *periph;
|
||||
struct pmp_softc *softc;
|
||||
char tmpstr[80], tmpstr2[80];
|
||||
|
||||
periph = (struct cam_periph *)context;
|
||||
if (cam_periph_acquire(periph) != CAM_REQ_CMP)
|
||||
return;
|
||||
|
||||
softc = (struct pmp_softc *)periph->softc;
|
||||
snprintf(tmpstr, sizeof(tmpstr), "CAM PMP unit %d", periph->unit_number);
|
||||
snprintf(tmpstr2, sizeof(tmpstr2), "%d", periph->unit_number);
|
||||
|
||||
sysctl_ctx_init(&softc->sysctl_ctx);
|
||||
softc->flags |= PMP_FLAG_SCTX_INIT;
|
||||
softc->sysctl_tree = SYSCTL_ADD_NODE(&softc->sysctl_ctx,
|
||||
SYSCTL_STATIC_CHILDREN(_kern_cam_pmp), OID_AUTO, tmpstr2,
|
||||
CTLFLAG_RD, 0, tmpstr);
|
||||
if (softc->sysctl_tree == NULL) {
|
||||
printf("pmpsysctlinit: unable to allocate sysctl tree\n");
|
||||
cam_periph_release(periph);
|
||||
return;
|
||||
}
|
||||
|
||||
cam_periph_release(periph);
|
||||
}
|
||||
|
||||
static cam_status
|
||||
pmpregister(struct cam_periph *periph, void *arg)
|
||||
{
|
||||
struct pmp_softc *softc;
|
||||
struct ccb_pathinq cpi;
|
||||
struct ccb_getdev *cgd;
|
||||
|
||||
cgd = (struct ccb_getdev *)arg;
|
||||
if (periph == NULL) {
|
||||
printf("pmpregister: periph was NULL!!\n");
|
||||
return(CAM_REQ_CMP_ERR);
|
||||
}
|
||||
|
||||
if (cgd == NULL) {
|
||||
printf("pmpregister: no getdev CCB, can't register device\n");
|
||||
return(CAM_REQ_CMP_ERR);
|
||||
}
|
||||
|
||||
softc = (struct pmp_softc *)malloc(sizeof(*softc), M_DEVBUF,
|
||||
M_NOWAIT|M_ZERO);
|
||||
|
||||
if (softc == NULL) {
|
||||
printf("pmpregister: Unable to probe new device. "
|
||||
"Unable to allocate softc\n");
|
||||
return(CAM_REQ_CMP_ERR);
|
||||
}
|
||||
periph->softc = softc;
|
||||
|
||||
softc->state = PMP_STATE_PORTS;
|
||||
softc->pm_pid = ((uint32_t *)&cgd->ident_data)[0];
|
||||
softc->pm_prv = ((uint32_t *)&cgd->ident_data)[1];
|
||||
|
||||
/* Check if the SIM does not want queued commands */
|
||||
bzero(&cpi, sizeof(cpi));
|
||||
xpt_setup_ccb(&cpi.ccb_h, periph->path, CAM_PRIORITY_NORMAL);
|
||||
cpi.ccb_h.func_code = XPT_PATH_INQ;
|
||||
xpt_action((union ccb *)&cpi);
|
||||
|
||||
TASK_INIT(&softc->sysctl_task, 0, pmpsysctlinit, periph);
|
||||
|
||||
xpt_announce_periph(periph, NULL);
|
||||
|
||||
/*
|
||||
* Add async callbacks for bus reset and
|
||||
* bus device reset calls. I don't bother
|
||||
* checking if this fails as, in most cases,
|
||||
* the system will function just fine without
|
||||
* them and the only alternative would be to
|
||||
* not attach the device on failure.
|
||||
*/
|
||||
xpt_register_async(AC_SENT_BDR | AC_BUS_RESET | AC_LOST_DEVICE |
|
||||
AC_SCSI_AEN, pmpasync, periph, periph->path);
|
||||
|
||||
/*
|
||||
* Take an exclusive refcount on the periph while pmpstart is called
|
||||
* to finish the probe. The reference will be dropped in pmpdone at
|
||||
* the end of probe.
|
||||
*/
|
||||
(void)cam_periph_acquire(periph);
|
||||
xpt_schedule(periph, CAM_PRIORITY_DEV);
|
||||
|
||||
return(CAM_REQ_CMP);
|
||||
}
|
||||
|
||||
static void
|
||||
pmpstart(struct cam_periph *periph, union ccb *start_ccb)
|
||||
{
|
||||
struct ccb_ataio *ataio;
|
||||
struct pmp_softc *softc;
|
||||
|
||||
softc = (struct pmp_softc *)periph->softc;
|
||||
ataio = &start_ccb->ataio;
|
||||
|
||||
switch (softc->state) {
|
||||
case PMP_STATE_PORTS:
|
||||
cam_fill_ataio(ataio,
|
||||
pmp_retry_count,
|
||||
pmpdone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
pmp_default_timeout * 1000);
|
||||
ata_pm_read_cmd(ataio, 2, 15);
|
||||
break;
|
||||
case PMP_STATE_CONFIG:
|
||||
cam_fill_ataio(ataio,
|
||||
pmp_retry_count,
|
||||
pmpdone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
pmp_default_timeout * 1000);
|
||||
ata_pm_write_cmd(ataio, 0x60, 15, 0xf);
|
||||
break;
|
||||
case PMP_STATE_RESET:
|
||||
cam_fill_ataio(ataio,
|
||||
pmp_retry_count,
|
||||
pmpdone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
pmp_default_timeout * 1000);
|
||||
ata_pm_write_cmd(ataio, 2, softc->pm_step,
|
||||
(softc->found & (1 << softc->pm_step)) ? 0 : 1);
|
||||
printf("PM RESET %d%s\n", softc->pm_step,
|
||||
(softc->found & (1 << softc->pm_step)) ? " skipping" : "");
|
||||
break;
|
||||
case PMP_STATE_CONNECT:
|
||||
cam_fill_ataio(ataio,
|
||||
pmp_retry_count,
|
||||
pmpdone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
pmp_default_timeout * 1000);
|
||||
ata_pm_write_cmd(ataio, 2, softc->pm_step, 0);
|
||||
break;
|
||||
case PMP_STATE_CHECK:
|
||||
cam_fill_ataio(ataio,
|
||||
pmp_retry_count,
|
||||
pmpdone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
pmp_default_timeout * 1000);
|
||||
ata_pm_read_cmd(ataio, 0, softc->pm_step);
|
||||
break;
|
||||
case PMP_STATE_CLEAR:
|
||||
cam_fill_ataio(ataio,
|
||||
pmp_retry_count,
|
||||
pmpdone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
pmp_default_timeout * 1000);
|
||||
ata_pm_write_cmd(ataio, 1, softc->pm_step, 0xFFFFFFFF);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
xpt_action(start_ccb);
|
||||
}
|
||||
|
||||
static void
|
||||
pmpdone(struct cam_periph *periph, union ccb *done_ccb)
|
||||
{
|
||||
struct pmp_softc *softc;
|
||||
struct ccb_ataio *ataio;
|
||||
union ccb *work_ccb;
|
||||
struct cam_path *path, *dpath;
|
||||
u_int32_t priority;
|
||||
|
||||
softc = (struct pmp_softc *)periph->softc;
|
||||
ataio = &done_ccb->ataio;
|
||||
|
||||
CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("pmpdone\n"));
|
||||
|
||||
path = done_ccb->ccb_h.path;
|
||||
priority = done_ccb->ccb_h.pinfo.priority;
|
||||
|
||||
switch (softc->state) {
|
||||
case PMP_STATE_PORTS:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_ports = (done_ccb->ataio.res.lba_high << 24) +
|
||||
(done_ccb->ataio.res.lba_mid << 16) +
|
||||
(done_ccb->ataio.res.lba_low << 8) +
|
||||
done_ccb->ataio.res.sector_count;
|
||||
/* This PM declares 6 ports, while only 5 of them are real.
|
||||
* Port 5 is enclosure management bridge port, which has implementation
|
||||
* problems, causing probe faults. Hide it for now. */
|
||||
if (softc->pm_pid == 0x37261095 && softc->pm_ports == 6)
|
||||
softc->pm_ports = 5;
|
||||
/* This PM declares 7 ports, while only 5 of them are real.
|
||||
* Port 5 is some fake "Config Disk" with 640 sectors size,
|
||||
* port 6 is enclosure management bridge port.
|
||||
* Both fake ports has implementation problems, causing
|
||||
* probe faults. Hide them for now. */
|
||||
if (softc->pm_pid == 0x47261095 && softc->pm_ports == 7)
|
||||
softc->pm_ports = 5;
|
||||
printf("PM ports: %d\n", softc->pm_ports);
|
||||
softc->state = PMP_STATE_CONFIG;
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
cam_release_devq(done_ccb->ccb_h.path,
|
||||
/*relsim_flags*/0,
|
||||
/*reduction*/0,
|
||||
/*timeout*/0,
|
||||
/*getcount_only*/0);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
case PMP_STATE_CONFIG:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step = 0;
|
||||
softc->state = PMP_STATE_RESET;
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
cam_release_devq(done_ccb->ccb_h.path,
|
||||
/*relsim_flags*/0,
|
||||
/*reduction*/0,
|
||||
/*timeout*/0,
|
||||
/*getcount_only*/0);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
case PMP_STATE_RESET:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step++;
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else {
|
||||
softc->pm_step = 0;
|
||||
DELAY(5000);
|
||||
printf("PM reset done\n");
|
||||
softc->state = PMP_STATE_CONNECT;
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
cam_release_devq(done_ccb->ccb_h.path,
|
||||
/*relsim_flags*/0,
|
||||
/*reduction*/0,
|
||||
/*timeout*/0,
|
||||
/*getcount_only*/0);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
case PMP_STATE_CONNECT:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step++;
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else {
|
||||
softc->pm_step = 0;
|
||||
softc->pm_try = 0;
|
||||
printf("PM connect done\n");
|
||||
softc->state = PMP_STATE_CHECK;
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
cam_release_devq(done_ccb->ccb_h.path,
|
||||
/*relsim_flags*/0,
|
||||
/*reduction*/0,
|
||||
/*timeout*/0,
|
||||
/*getcount_only*/0);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
case PMP_STATE_CHECK:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
int res = (done_ccb->ataio.res.lba_high << 24) +
|
||||
(done_ccb->ataio.res.lba_mid << 16) +
|
||||
(done_ccb->ataio.res.lba_low << 8) +
|
||||
done_ccb->ataio.res.sector_count;
|
||||
if ((res & 0xf0f) == 0x103 && (res & 0x0f0) != 0) {
|
||||
printf("PM status: %d - %08x\n", softc->pm_step, res);
|
||||
softc->found |= (1 << softc->pm_step);
|
||||
softc->pm_step++;
|
||||
} else {
|
||||
if (softc->pm_try < 100) {
|
||||
DELAY(10000);
|
||||
softc->pm_try++;
|
||||
} else {
|
||||
printf("PM status: %d - %08x\n", softc->pm_step, res);
|
||||
softc->found &= ~(1 << softc->pm_step);
|
||||
if (xpt_create_path(&dpath, periph,
|
||||
done_ccb->ccb_h.path_id,
|
||||
softc->pm_step, 0) == CAM_REQ_CMP) {
|
||||
xpt_async(AC_LOST_DEVICE, dpath, NULL);
|
||||
xpt_free_path(dpath);
|
||||
}
|
||||
softc->pm_step++;
|
||||
}
|
||||
}
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else {
|
||||
softc->pm_step = 0;
|
||||
softc->state = PMP_STATE_CLEAR;
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
cam_release_devq(done_ccb->ccb_h.path,
|
||||
/*relsim_flags*/0,
|
||||
/*reduction*/0,
|
||||
/*timeout*/0,
|
||||
/*getcount_only*/0);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
case PMP_STATE_CLEAR:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step++;
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else if (softc->found) {
|
||||
softc->pm_step = 0;
|
||||
softc->state = PMP_STATE_SCAN;
|
||||
work_ccb = xpt_alloc_ccb_nowait();
|
||||
if (work_ccb != NULL)
|
||||
goto do_scan;
|
||||
xpt_release_ccb(done_ccb);
|
||||
}
|
||||
break;
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
cam_release_devq(done_ccb->ccb_h.path,
|
||||
/*relsim_flags*/0,
|
||||
/*reduction*/0,
|
||||
/*timeout*/0,
|
||||
/*getcount_only*/0);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
case PMP_STATE_SCAN:
|
||||
work_ccb = done_ccb;
|
||||
done_ccb = (union ccb*)work_ccb->ccb_h.ppriv_ptr0;
|
||||
/* Free the current request path- we're done with it. */
|
||||
xpt_free_path(work_ccb->ccb_h.path);
|
||||
softc->pm_step++;
|
||||
do_scan:
|
||||
while (softc->pm_step < softc->pm_ports &&
|
||||
(softc->found & (1 << softc->pm_step)) == 0) {
|
||||
softc->pm_step++;
|
||||
}
|
||||
if (softc->pm_step >= softc->pm_ports) {
|
||||
xpt_free_ccb(work_ccb);
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
}
|
||||
if (xpt_create_path(&dpath, periph,
|
||||
done_ccb->ccb_h.path_id,
|
||||
softc->pm_step, 0) != CAM_REQ_CMP) {
|
||||
printf("pmpdone: xpt_create_path failed"
|
||||
", bus scan halted\n");
|
||||
xpt_free_ccb(work_ccb);
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
}
|
||||
xpt_setup_ccb(&work_ccb->ccb_h, dpath,
|
||||
done_ccb->ccb_h.pinfo.priority);
|
||||
work_ccb->ccb_h.func_code = XPT_SCAN_LUN;
|
||||
work_ccb->ccb_h.cbfcnp = pmpdone;
|
||||
work_ccb->ccb_h.ppriv_ptr0 = done_ccb;
|
||||
work_ccb->crcn.flags = done_ccb->crcn.flags;
|
||||
xpt_action(work_ccb);
|
||||
pmprelease(periph, 1 << softc->pm_step);
|
||||
return;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
softc->state = PMP_STATE_NORMAL;
|
||||
pmprelease(periph, -1);
|
||||
cam_periph_release_locked(periph);
|
||||
}
|
||||
|
||||
#endif /* _KERNEL */
|
@ -96,11 +96,6 @@ typedef enum {
|
||||
PROBE_FULL_INQUIRY,
|
||||
PROBE_PM_PID,
|
||||
PROBE_PM_PRV,
|
||||
PROBE_PM_PORTS,
|
||||
PROBE_PM_RESET,
|
||||
PROBE_PM_CONNECT,
|
||||
PROBE_PM_CHECK,
|
||||
PROBE_PM_CLEAR,
|
||||
PROBE_INVALID
|
||||
} probe_action;
|
||||
|
||||
@ -112,11 +107,6 @@ static char *probe_action_text[] = {
|
||||
"PROBE_FULL_INQUIRY",
|
||||
"PROBE_PM_PID",
|
||||
"PROBE_PM_PRV",
|
||||
"PROBE_PM_PORTS",
|
||||
"PROBE_PM_RESET",
|
||||
"PROBE_PM_CONNECT",
|
||||
"PROBE_PM_CHECK",
|
||||
"PROBE_PM_CLEAR",
|
||||
"PROBE_INVALID"
|
||||
};
|
||||
|
||||
@ -142,9 +132,6 @@ typedef struct {
|
||||
u_int8_t digest[16];
|
||||
uint32_t pm_pid;
|
||||
uint32_t pm_prv;
|
||||
int pm_ports;
|
||||
int pm_step;
|
||||
int pm_try;
|
||||
struct cam_periph *periph;
|
||||
} probe_softc;
|
||||
|
||||
@ -274,10 +261,9 @@ probeschedule(struct cam_periph *periph)
|
||||
cpi.ccb_h.func_code = XPT_PATH_INQ;
|
||||
xpt_action((union ccb *)&cpi);
|
||||
|
||||
if (periph->path->device->flags & CAM_DEV_UNCONFIGURED)
|
||||
if ((periph->path->device->flags & CAM_DEV_UNCONFIGURED) ||
|
||||
periph->path->device->protocol == PROTO_SATAPM)
|
||||
PROBE_SET_ACTION(softc, PROBE_RESET);
|
||||
else if (periph->path->device->protocol == PROTO_SATAPM)
|
||||
PROBE_SET_ACTION(softc, PROBE_PM_PID);
|
||||
else
|
||||
PROBE_SET_ACTION(softc, PROBE_IDENTIFY);
|
||||
|
||||
@ -295,7 +281,6 @@ probestart(struct cam_periph *periph, union ccb *start_ccb)
|
||||
/* Probe the device that our peripheral driver points to */
|
||||
struct ccb_ataio *ataio;
|
||||
struct ccb_scsiio *csio;
|
||||
struct ccb_trans_settings cts;
|
||||
probe_softc *softc;
|
||||
|
||||
CAM_DEBUG(start_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("probestart\n"));
|
||||
@ -306,21 +291,11 @@ probestart(struct cam_periph *periph, union ccb *start_ccb)
|
||||
|
||||
switch (softc->action) {
|
||||
case PROBE_RESET:
|
||||
if (start_ccb->ccb_h.target_id == 15) {
|
||||
/* Report SIM that we have no knowledge about PM presence. */
|
||||
bzero(&cts, sizeof(cts));
|
||||
xpt_setup_ccb(&cts.ccb_h, start_ccb->ccb_h.path, 1);
|
||||
cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS;
|
||||
cts.type = CTS_TYPE_CURRENT_SETTINGS;
|
||||
cts.xport_specific.sata.pm_present = 0;
|
||||
cts.xport_specific.sata.valid = CTS_SATA_VALID_PM;
|
||||
xpt_action((union ccb *)&cts);
|
||||
}
|
||||
cam_fill_ataio(ataio,
|
||||
0,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
(start_ccb->ccb_h.target_id == 15 ? 3 : 15) * 1000);
|
||||
@ -351,7 +326,7 @@ probestart(struct cam_periph *periph, union ccb *start_ccb)
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_IN,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
0,
|
||||
/*data_ptr*/(u_int8_t *)ident_buf,
|
||||
/*dxfer_len*/sizeof(struct ata_params),
|
||||
30 * 1000);
|
||||
@ -413,7 +388,7 @@ probestart(struct cam_periph *periph, union ccb *start_ccb)
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
@ -424,74 +399,12 @@ probestart(struct cam_periph *periph, union ccb *start_ccb)
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
0,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
ata_pm_read_cmd(ataio, 1, 15);
|
||||
break;
|
||||
case PROBE_PM_PORTS:
|
||||
cam_fill_ataio(ataio,
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
ata_pm_read_cmd(ataio, 2, 15);
|
||||
break;
|
||||
case PROBE_PM_RESET:
|
||||
{
|
||||
struct ata_params *ident_buf =
|
||||
&periph->path->device->ident_data;
|
||||
cam_fill_ataio(ataio,
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
ata_pm_write_cmd(ataio, 2, softc->pm_step,
|
||||
(ident_buf->cylinders & (1 << softc->pm_step)) ? 0 : 1);
|
||||
printf("PM RESET %d %04x %d\n", softc->pm_step, ident_buf->cylinders,
|
||||
(ident_buf->cylinders & (1 << softc->pm_step)) ? 0 : 1);
|
||||
break;
|
||||
}
|
||||
case PROBE_PM_CONNECT:
|
||||
cam_fill_ataio(ataio,
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
ata_pm_write_cmd(ataio, 2, softc->pm_step, 0);
|
||||
break;
|
||||
case PROBE_PM_CHECK:
|
||||
cam_fill_ataio(ataio,
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
ata_pm_read_cmd(ataio, 0, softc->pm_step);
|
||||
break;
|
||||
case PROBE_PM_CLEAR:
|
||||
cam_fill_ataio(ataio,
|
||||
1,
|
||||
probedone,
|
||||
/*flags*/CAM_DIR_NONE,
|
||||
MSG_SIMPLE_Q_TAG,
|
||||
/*data_ptr*/NULL,
|
||||
/*dxfer_len*/0,
|
||||
10 * 1000);
|
||||
ata_pm_write_cmd(ataio, 1, softc->pm_step, 0xFFFFFFFF);
|
||||
break;
|
||||
case PROBE_INVALID:
|
||||
CAM_DEBUG(start_ccb->ccb_h.path, CAM_DEBUG_INFO,
|
||||
("probestart: invalid action state\n"));
|
||||
@ -630,7 +543,7 @@ probedone(struct cam_periph *periph, union ccb *done_ccb)
|
||||
probe_softc *softc;
|
||||
struct cam_path *path;
|
||||
u_int32_t priority;
|
||||
int found = 0;
|
||||
int found = 1;
|
||||
|
||||
CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("probedone\n"));
|
||||
|
||||
@ -672,8 +585,7 @@ probedone(struct cam_periph *periph, union ccb *done_ccb)
|
||||
xpt_print(path,
|
||||
"Unexpected signature 0x%04x\n", sign);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
goto device_fail;
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
@ -780,9 +692,8 @@ probedone(struct cam_periph *periph, union ccb *done_ccb)
|
||||
* drivers that this device is no more.
|
||||
*/
|
||||
if ((path->device->flags & CAM_DEV_UNCONFIGURED) == 0)
|
||||
/* Send the async notification. */
|
||||
xpt_async(AC_LOST_DEVICE, path, NULL);
|
||||
|
||||
found = 0;
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
}
|
||||
@ -881,6 +792,7 @@ modedone: if (path->device->protocol == PROTO_ATA) {
|
||||
(done_ccb->ataio.res.lba_mid << 16) +
|
||||
(done_ccb->ataio.res.lba_low << 8) +
|
||||
done_ccb->ataio.res.sector_count;
|
||||
((uint32_t *)ident_buf)[0] = softc->pm_pid;
|
||||
printf("PM Product ID: %08x\n", softc->pm_pid);
|
||||
snprintf(ident_buf->model, sizeof(ident_buf->model),
|
||||
"Port Multiplier %08x", softc->pm_pid);
|
||||
@ -903,164 +815,24 @@ modedone: if (path->device->protocol == PROTO_ATA) {
|
||||
(done_ccb->ataio.res.lba_mid << 16) +
|
||||
(done_ccb->ataio.res.lba_low << 8) +
|
||||
done_ccb->ataio.res.sector_count;
|
||||
((uint32_t *)ident_buf)[1] = softc->pm_prv;
|
||||
printf("PM Revision: %08x\n", softc->pm_prv);
|
||||
snprintf(ident_buf->revision, sizeof(ident_buf->revision),
|
||||
"%04x", softc->pm_prv);
|
||||
PROBE_SET_ACTION(softc, PROBE_PM_PORTS);
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
/* Don't wedge the queue */
|
||||
xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
|
||||
/*run_queue*/TRUE);
|
||||
}
|
||||
goto device_fail;
|
||||
case PROBE_PM_PORTS:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_ports = (done_ccb->ataio.res.lba_high << 24) +
|
||||
(done_ccb->ataio.res.lba_mid << 16) +
|
||||
(done_ccb->ataio.res.lba_low << 8) +
|
||||
done_ccb->ataio.res.sector_count;
|
||||
/* This PM declares 6 ports, while only 5 of them are real.
|
||||
* Port 5 is enclosure management bridge port, which has implementation
|
||||
* problems, causing probe faults. Hide it for now. */
|
||||
if (softc->pm_pid == 0x37261095 && softc->pm_ports == 6)
|
||||
softc->pm_ports = 5;
|
||||
/* This PM declares 7 ports, while only 5 of them are real.
|
||||
* Port 5 is some fake "Config Disk" with 640 sectors size,
|
||||
* port 6 is enclosure management bridge port.
|
||||
* Both fake ports has implementation problems, causing
|
||||
* probe faults. Hide them for now. */
|
||||
if (softc->pm_pid == 0x47261095 && softc->pm_ports == 7)
|
||||
softc->pm_ports = 5;
|
||||
printf("PM ports: %d\n", softc->pm_ports);
|
||||
ident_buf->config = softc->pm_ports;
|
||||
path->device->flags |= CAM_DEV_IDENTIFY_DATA_VALID;
|
||||
softc->pm_step = 0;
|
||||
PROBE_SET_ACTION(softc, PROBE_PM_RESET);
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
/* Don't wedge the queue */
|
||||
xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
|
||||
/*run_queue*/TRUE);
|
||||
}
|
||||
goto device_fail;
|
||||
case PROBE_PM_RESET:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step++;
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else {
|
||||
softc->pm_step = 0;
|
||||
DELAY(5000);
|
||||
printf("PM reset done\n");
|
||||
PROBE_SET_ACTION(softc, PROBE_PM_CONNECT);
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
/* Don't wedge the queue */
|
||||
xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
|
||||
/*run_queue*/TRUE);
|
||||
}
|
||||
goto device_fail;
|
||||
case PROBE_PM_CONNECT:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step++;
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else {
|
||||
softc->pm_step = 0;
|
||||
softc->pm_try = 0;
|
||||
printf("PM connect done\n");
|
||||
PROBE_SET_ACTION(softc, PROBE_PM_CHECK);
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
/* Don't wedge the queue */
|
||||
xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
|
||||
/*run_queue*/TRUE);
|
||||
}
|
||||
goto device_fail;
|
||||
case PROBE_PM_CHECK:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
int res = (done_ccb->ataio.res.lba_high << 24) +
|
||||
(done_ccb->ataio.res.lba_mid << 16) +
|
||||
(done_ccb->ataio.res.lba_low << 8) +
|
||||
done_ccb->ataio.res.sector_count;
|
||||
if ((res & 0xf0f) == 0x103 && (res & 0x0f0) != 0) {
|
||||
printf("PM status: %d - %08x\n", softc->pm_step, res);
|
||||
ident_buf->cylinders |= (1 << softc->pm_step);
|
||||
softc->pm_step++;
|
||||
} else {
|
||||
if (softc->pm_try < 100) {
|
||||
DELAY(10000);
|
||||
softc->pm_try++;
|
||||
} else {
|
||||
printf("PM status: %d - %08x\n", softc->pm_step, res);
|
||||
ident_buf->cylinders &= ~(1 << softc->pm_step);
|
||||
softc->pm_step++;
|
||||
}
|
||||
}
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
} else {
|
||||
softc->pm_step = 0;
|
||||
PROBE_SET_ACTION(softc, PROBE_PM_CLEAR);
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
return;
|
||||
} else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
|
||||
/* Don't wedge the queue */
|
||||
xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
|
||||
/*run_queue*/TRUE);
|
||||
}
|
||||
goto device_fail;
|
||||
case PROBE_PM_CLEAR:
|
||||
if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
|
||||
softc->pm_step++;
|
||||
if (softc->pm_step < softc->pm_ports) {
|
||||
xpt_release_ccb(done_ccb);
|
||||
xpt_schedule(periph, priority);
|
||||
return;
|
||||
}
|
||||
found = ident_buf->cylinders | 0x8000;
|
||||
if (path->device->flags & CAM_DEV_UNCONFIGURED) {
|
||||
if (periph->path->device->flags & CAM_DEV_UNCONFIGURED) {
|
||||
path->device->flags &= ~CAM_DEV_UNCONFIGURED;
|
||||
done_ccb->ccb_h.func_code = XPT_GDEV_TYPE;
|
||||
xpt_action(done_ccb);
|
||||
xpt_async(AC_FOUND_DEVICE, done_ccb->ccb_h.path,
|
||||
done_ccb);
|
||||
xpt_release_ccb(done_ccb);
|
||||
} else {
|
||||
done_ccb->ccb_h.func_code = XPT_GDEV_TYPE;
|
||||
xpt_action(done_ccb);
|
||||
xpt_async(AC_SCSI_AEN, done_ccb->ccb_h.path,
|
||||
done_ccb);
|
||||
}
|
||||
xpt_release_ccb(done_ccb);
|
||||
break;
|
||||
} else if (cam_periph_error(done_ccb, 0, 0,
|
||||
&softc->saved_ccb) == ERESTART) {
|
||||
@ -1192,11 +964,11 @@ ata_scan_bus(struct cam_periph *periph, union ccb *request_ccb)
|
||||
scan_info = (ata_scan_bus_info *)work_ccb->ccb_h.ppriv_ptr0;
|
||||
/* Free the current request path- we're done with it. */
|
||||
xpt_free_path(work_ccb->ccb_h.path);
|
||||
/* If there is PM... */
|
||||
/* If there is PMP... */
|
||||
if (scan_info->counter == 15) {
|
||||
if (work_ccb->ccb_h.ppriv_field1 != 0) {
|
||||
/* Save PM probe result. */
|
||||
scan_info->found = work_ccb->ccb_h.ppriv_field1;
|
||||
/* everything else willbe probed by it */
|
||||
scan_info->found = 0x8000;
|
||||
} else {
|
||||
struct ccb_trans_settings cts;
|
||||
|
||||
@ -1225,6 +997,8 @@ ata_scan_bus(struct cam_periph *periph, union ccb *request_ccb)
|
||||
break;
|
||||
}
|
||||
scan_next:
|
||||
if ((scan_info->found & (1 << scan_info->counter)) == 0)
|
||||
goto take_next;
|
||||
status = xpt_create_path(&path, xpt_periph,
|
||||
scan_info->request_ccb->ccb_h.path_id,
|
||||
scan_info->counter, 0);
|
||||
@ -1240,11 +1014,6 @@ ata_scan_bus(struct cam_periph *periph, union ccb *request_ccb)
|
||||
xpt_done(request_ccb);
|
||||
break;
|
||||
}
|
||||
if ((scan_info->found & (1 << scan_info->counter)) == 0) {
|
||||
xpt_async(AC_LOST_DEVICE, path, NULL);
|
||||
xpt_free_path(path);
|
||||
goto take_next;
|
||||
}
|
||||
xpt_setup_ccb(&work_ccb->ccb_h, path,
|
||||
scan_info->request_ccb->ccb_h.pinfo.priority);
|
||||
work_ccb->ccb_h.func_code = XPT_SCAN_LUN;
|
||||
|
@ -117,6 +117,7 @@ cam/scsi/scsi_all.c optional scbus
|
||||
cam/scsi/scsi_cd.c optional cd
|
||||
cam/scsi/scsi_ch.c optional ch
|
||||
cam/ata/ata_da.c optional da
|
||||
cam/ata/ata_pmp.c optional da
|
||||
cam/scsi/scsi_da.c optional da
|
||||
cam/scsi/scsi_low.c optional ct | ncv | nsp | stg
|
||||
cam/scsi/scsi_low_pisa.c optional ct | ncv | nsp | stg
|
||||
|
@ -28,6 +28,7 @@ SRCS+= scsi_xpt.c
|
||||
SRCS+= ata_all.c
|
||||
SRCS+= ata_xpt.c
|
||||
SRCS+= ata_da.c
|
||||
SRCS+= ata_pmp.c
|
||||
|
||||
EXPORT_SYMS= YES # XXX evaluate
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user