Author: mav
Date: Fri Oct 23 12:36:42 2009
New Revision: 198389
URL: http://svn.freebsd.org/changeset/base/198389
Log:
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.
Added:
head/sys/cam/ata/ata_pmp.c (contents, props changed)
Modified:
head/sys/cam/ata/ata_xpt.c
head/sys/conf/files
head/sys/modules/cam/Makefile
Added: head/sys/cam/ata/ata_pmp.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/sys/cam/ata/ata_pmp.c Fri Oct 23 12:36:42 2009 (r198389)
@@ -0,0 +1,735 @@
+/*-
+ * Copyright (c) 2009 Alexander Motin <m...@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 */
Modified: head/sys/cam/ata/ata_xpt.c
==============================================================================
--- head/sys/cam/ata/ata_xpt.c Fri Oct 23 12:29:45 2009 (r198388)
+++ head/sys/cam/ata/ata_xpt.c Fri Oct 23 12:36:42 2009 (r198389)
@@ -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, un
/* 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, un
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, un
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, un
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, un
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, uni
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, uni
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 @@ device_fail:
* 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 ==
(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 ==
(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;
*** DIFF OUTPUT TRUNCATED AT 1000 LINES ***
_______________________________________________
svn-src-all@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-all
To unsubscribe, send any mail to "svn-src-all-unsubscr...@freebsd.org"
