root/sys/dev/mfi/mfi_cam.c
/*-
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright 2007 Scott Long
 * 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.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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>
#include "opt_mfi.h"

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/selinfo.h>
#include <sys/bus.h>
#include <sys/conf.h>
#include <sys/eventhandler.h>
#include <sys/rman.h>
#include <sys/bio.h>
#include <sys/ioccom.h>
#include <sys/uio.h>
#include <sys/proc.h>
#include <sys/signalvar.h>
#include <sys/sysctl.h>

#include <cam/cam.h>
#include <cam/cam_ccb.h>
#include <cam/cam_debug.h>
#include <cam/cam_periph.h>
#include <cam/cam_sim.h>
#include <cam/cam_xpt_periph.h>
#include <cam/cam_xpt_sim.h>
#include <cam/scsi/scsi_all.h>
#include <cam/scsi/scsi_message.h>

#include <machine/md_var.h>
#include <machine/bus.h>
#include <machine/resource.h>

#include <dev/mfi/mfireg.h>
#include <dev/mfi/mfi_ioctl.h>
#include <dev/mfi/mfivar.h>

enum mfip_state {
        MFIP_STATE_NONE,
        MFIP_STATE_DETACH,
        MFIP_STATE_RESCAN
};

struct mfip_softc {
        device_t        dev;
        struct mfi_softc *mfi_sc;
        struct cam_devq *devq;
        struct cam_sim  *sim;
        struct cam_path *path;
        enum mfip_state state;
};

static int      mfip_probe(device_t);
static int      mfip_attach(device_t);
static int      mfip_detach(device_t);
static void     mfip_cam_action(struct cam_sim *, union ccb *);
static void     mfip_cam_poll(struct cam_sim *);
static void     mfip_cam_rescan(struct mfi_softc *, uint32_t tid);
static struct mfi_command * mfip_start(void *);
static void     mfip_done(struct mfi_command *cm);

static int mfi_allow_disks = 0;
SYSCTL_INT(_hw_mfi, OID_AUTO, allow_cam_disk_passthrough, CTLFLAG_RDTUN,
    &mfi_allow_disks, 0, "event message locale");

static device_method_t  mfip_methods[] = {
        DEVMETHOD(device_probe,         mfip_probe),
        DEVMETHOD(device_attach,        mfip_attach),
        DEVMETHOD(device_detach,        mfip_detach),

        DEVMETHOD_END
};

static driver_t mfip_driver = {
        "mfip",
        mfip_methods,
        sizeof(struct mfip_softc)
};

DRIVER_MODULE(mfip, mfi, mfip_driver, 0, 0);
MODULE_DEPEND(mfip, cam, 1, 1, 1);
MODULE_DEPEND(mfip, mfi, 1, 1, 1);

#define ccb_mfip_ptr sim_priv.entries[0].ptr

static int
mfip_probe(device_t dev)
{

        device_set_desc(dev, "SCSI Passthrough Bus");
        return (0);
}

static int
mfip_attach(device_t dev)
{
        struct mfip_softc *sc;
        struct mfi_softc *mfisc;

        sc = device_get_softc(dev);
        if (sc == NULL)
                return (EINVAL);

        mfisc = device_get_softc(device_get_parent(dev));
        sc->dev = dev;
        sc->state = MFIP_STATE_NONE;
        sc->mfi_sc = mfisc;
        mfisc->mfi_cam_start = mfip_start;

        if ((sc->devq = cam_simq_alloc(MFI_SCSI_MAX_CMDS)) == NULL)
                return (ENOMEM);

        sc->sim = cam_sim_alloc(mfip_cam_action, mfip_cam_poll, "mfi", sc,
                                device_get_unit(dev), &mfisc->mfi_io_lock, 1,
                                MFI_SCSI_MAX_CMDS, sc->devq);
        if (sc->sim == NULL) {
                cam_simq_free(sc->devq);
                sc->devq = NULL;
                device_printf(dev, "CAM SIM attach failed\n");
                return (EINVAL);
        }

        mfisc->mfi_cam_rescan_cb = mfip_cam_rescan;

        mtx_lock(&mfisc->mfi_io_lock);
        if (xpt_bus_register(sc->sim, dev, 0) != 0) {
                device_printf(dev, "XPT bus registration failed\n");
                cam_sim_free(sc->sim, FALSE);
                sc->sim = NULL;
                cam_simq_free(sc->devq);
                sc->devq = NULL;
                mtx_unlock(&mfisc->mfi_io_lock);
                return (EINVAL);
        }
        mtx_unlock(&mfisc->mfi_io_lock);

        return (0);
}

static int
mfip_detach(device_t dev)
{
        struct mfip_softc *sc;

        sc = device_get_softc(dev);
        if (sc == NULL)
                return (EINVAL);

        mtx_lock(&sc->mfi_sc->mfi_io_lock);
        if (sc->state == MFIP_STATE_RESCAN) {
                mtx_unlock(&sc->mfi_sc->mfi_io_lock);
                return (EBUSY);
        }
        sc->state = MFIP_STATE_DETACH;
        mtx_unlock(&sc->mfi_sc->mfi_io_lock);

        sc->mfi_sc->mfi_cam_rescan_cb = NULL;

        if (sc->sim != NULL) {
                mtx_lock(&sc->mfi_sc->mfi_io_lock);
                xpt_bus_deregister(cam_sim_path(sc->sim));
                cam_sim_free(sc->sim, FALSE);
                sc->sim = NULL;
                mtx_unlock(&sc->mfi_sc->mfi_io_lock);
        }

        if (sc->devq != NULL) {
                cam_simq_free(sc->devq);
                sc->devq = NULL;
        }

        return (0);
}

static void
mfip_cam_action(struct cam_sim *sim, union ccb *ccb)
{
        struct mfip_softc *sc = cam_sim_softc(sim);
        struct mfi_softc *mfisc = sc->mfi_sc;

        mtx_assert(&mfisc->mfi_io_lock, MA_OWNED);

        switch (ccb->ccb_h.func_code) {
        case XPT_PATH_INQ:
        {
                struct ccb_pathinq *cpi = &ccb->cpi;

                cpi->version_num = 1;
                cpi->hba_inquiry = PI_TAG_ABLE;
                cpi->target_sprt = 0;
                cpi->hba_misc = PIM_NOBUSRESET | PIM_SEQSCAN | PIM_UNMAPPED;
                cpi->hba_eng_cnt = 0;
                cpi->max_target = MFI_SCSI_MAX_TARGETS;
                cpi->max_lun = MFI_SCSI_MAX_LUNS;
                cpi->initiator_id = MFI_SCSI_INITIATOR_ID;
                strlcpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
                strlcpy(cpi->hba_vid, "LSI", HBA_IDLEN);
                strlcpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
                cpi->unit_number = cam_sim_unit(sim);
                cpi->bus_id = cam_sim_bus(sim);
                cpi->base_transfer_speed = 150000;
                cpi->transport = XPORT_SAS;
                cpi->transport_version = 0;
                cpi->protocol = PROTO_SCSI;
                cpi->protocol_version = SCSI_REV_2;
                cpi->ccb_h.status = CAM_REQ_CMP;
                break;
        }
        case XPT_RESET_BUS:
                ccb->ccb_h.status = CAM_REQ_CMP;
                break;
        case XPT_RESET_DEV:
                ccb->ccb_h.status = CAM_REQ_CMP;
                break;
        case XPT_GET_TRAN_SETTINGS:
        {
                struct ccb_trans_settings_scsi *scsi =
                    &ccb->cts.proto_specific.scsi;
                struct ccb_trans_settings_sas *sas =
                    &ccb->cts.xport_specific.sas;

                ccb->cts.protocol = PROTO_SCSI;
                ccb->cts.protocol_version = SCSI_REV_2;
                ccb->cts.transport = XPORT_SAS;
                ccb->cts.transport_version = 0;

                scsi->valid = CTS_SCSI_VALID_TQ;
                scsi->flags = CTS_SCSI_FLAGS_TAG_ENB;

                sas->valid &= ~CTS_SAS_VALID_SPEED;
                sas->bitrate = 150000;

                ccb->ccb_h.status = CAM_REQ_CMP;
                break;
        }
        case XPT_SET_TRAN_SETTINGS:
                ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
                break;
        case XPT_SCSI_IO:
        {
                struct ccb_hdr          *ccbh = &ccb->ccb_h;
                struct ccb_scsiio       *csio = &ccb->csio;

                ccbh->status = CAM_REQ_INPROG;
                if (csio->cdb_len > MFI_SCSI_MAX_CDB_LEN) {
                        ccbh->status = CAM_REQ_INVALID;
                        break;
                }
                ccbh->ccb_mfip_ptr = sc;
                TAILQ_INSERT_TAIL(&mfisc->mfi_cam_ccbq, ccbh, sim_links.tqe);
                mfi_startio(mfisc);
                return;
        }
        default:
                ccb->ccb_h.status = CAM_REQ_INVALID;
                break;
        }

        xpt_done(ccb);
        return;
}

static void
mfip_cam_rescan(struct mfi_softc *sc, uint32_t tid)
{
        union ccb *ccb;
        struct mfip_softc *camsc;
        struct cam_sim *sim;
        device_t mfip_dev;

        bus_topo_lock();
        mfip_dev = device_find_child(sc->mfi_dev, "mfip", DEVICE_UNIT_ANY);
        bus_topo_unlock();
        if (mfip_dev == NULL) {
                device_printf(sc->mfi_dev, "Couldn't find mfip child device!\n");
                return;
        }

        mtx_lock(&sc->mfi_io_lock);
        camsc = device_get_softc(mfip_dev);
        if (camsc->state == MFIP_STATE_DETACH) {
                mtx_unlock(&sc->mfi_io_lock);
                return;
        }
        camsc->state = MFIP_STATE_RESCAN;

        ccb = xpt_alloc_ccb_nowait();
        if (ccb == NULL) {
                mtx_unlock(&sc->mfi_io_lock);
                device_printf(sc->mfi_dev,
                    "Cannot allocate ccb for bus rescan.\n");
                return;
        }

        sim = camsc->sim;
        if (xpt_create_path(&ccb->ccb_h.path, NULL, cam_sim_path(sim),
            tid, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
                xpt_free_ccb(ccb);
                mtx_unlock(&sc->mfi_io_lock);
                device_printf(sc->mfi_dev,
                    "Cannot create path for bus rescan.\n");
                return;
        }
        xpt_rescan(ccb);

        camsc->state = MFIP_STATE_NONE;
        mtx_unlock(&sc->mfi_io_lock);
}

static struct mfi_command *
mfip_start(void *data)
{
        union ccb *ccb = data;
        struct ccb_hdr *ccbh = &ccb->ccb_h;
        struct ccb_scsiio *csio = &ccb->csio;
        struct mfip_softc *sc;
        struct mfi_pass_frame *pt;
        struct mfi_command *cm;
        uint32_t context = 0;

        sc = ccbh->ccb_mfip_ptr;

        if ((cm = mfi_dequeue_free(sc->mfi_sc)) == NULL)
                return (NULL);

        /* Zero out the MFI frame */
        context = cm->cm_frame->header.context;
        bzero(cm->cm_frame, sizeof(union mfi_frame));
        cm->cm_frame->header.context = context;

        pt = &cm->cm_frame->pass;
        pt->header.cmd = MFI_CMD_PD_SCSI_IO;
        pt->header.cmd_status = 0;
        pt->header.scsi_status = 0;
        pt->header.target_id = ccbh->target_id;
        pt->header.lun_id = ccbh->target_lun;
        pt->header.flags = 0;
        pt->header.timeout = 0;
        pt->header.data_len = csio->dxfer_len;
        pt->header.sense_len = MFI_SENSE_LEN;
        pt->header.cdb_len = csio->cdb_len;
        pt->sense_addr_lo = (uint32_t)cm->cm_sense_busaddr;
        pt->sense_addr_hi = (uint32_t)((uint64_t)cm->cm_sense_busaddr >> 32);
        if (ccbh->flags & CAM_CDB_POINTER)
                bcopy(csio->cdb_io.cdb_ptr, &pt->cdb[0], csio->cdb_len);
        else
                bcopy(csio->cdb_io.cdb_bytes, &pt->cdb[0], csio->cdb_len);
        cm->cm_complete = mfip_done;
        cm->cm_private = ccb;
        cm->cm_sg = &pt->sgl;
        cm->cm_total_frame_size = MFI_PASS_FRAME_SIZE;
        cm->cm_data = ccb;
        cm->cm_len = csio->dxfer_len;
        switch (ccbh->flags & CAM_DIR_MASK) {
        case CAM_DIR_IN:
                cm->cm_flags = MFI_CMD_DATAIN | MFI_CMD_CCB;
                break;
        case CAM_DIR_OUT:
                cm->cm_flags = MFI_CMD_DATAOUT | MFI_CMD_CCB;
                break;
        case CAM_DIR_NONE:
        default:
                cm->cm_data = NULL;
                cm->cm_len = 0;
                cm->cm_flags = 0;
                break;
        }

        TAILQ_REMOVE(&sc->mfi_sc->mfi_cam_ccbq, ccbh, sim_links.tqe);
        return (cm);
}

static void
mfip_done(struct mfi_command *cm)
{
        union ccb *ccb = cm->cm_private;
        struct ccb_hdr *ccbh = &ccb->ccb_h;
        struct ccb_scsiio *csio = &ccb->csio;
        struct mfi_pass_frame *pt;

        pt = &cm->cm_frame->pass;

        switch (pt->header.cmd_status) {
        case MFI_STAT_OK:
        {
                uint8_t command, device;

                ccbh->status = CAM_REQ_CMP;
                csio->scsi_status = pt->header.scsi_status;
                if (ccbh->flags & CAM_CDB_POINTER)
                        command = csio->cdb_io.cdb_ptr[0];
                else
                        command = csio->cdb_io.cdb_bytes[0];
                if (command == INQUIRY) {
                        device = csio->data_ptr[0] & 0x1f;
                        if ((!mfi_allow_disks && device == T_DIRECT) ||
                            (device == T_PROCESSOR))
                                csio->data_ptr[0] =
                                     (csio->data_ptr[0] & 0xe0) | T_NODEVICE;
                }
                break;
        }
        case MFI_STAT_SCSI_DONE_WITH_ERROR:
        {
                int sense_len;

                ccbh->status = CAM_SCSI_STATUS_ERROR | CAM_AUTOSNS_VALID;
                csio->scsi_status = pt->header.scsi_status;
                if (pt->header.sense_len < csio->sense_len)
                        csio->sense_resid = csio->sense_len -
                            pt->header.sense_len;
                else
                        csio->sense_resid = 0;
                sense_len = min(pt->header.sense_len,
                    sizeof(struct scsi_sense_data));
                bzero(&csio->sense_data, sizeof(struct scsi_sense_data));
                bcopy(&cm->cm_sense->data[0], &csio->sense_data, sense_len);
                break;
        }
        case MFI_STAT_DEVICE_NOT_FOUND:
                ccbh->status = CAM_SEL_TIMEOUT;
                break;
        case MFI_STAT_SCSI_IO_FAILED:
                ccbh->status = CAM_REQ_CMP_ERR;
                csio->scsi_status = pt->header.scsi_status;
                break;
        default:
                ccbh->status = CAM_REQ_CMP_ERR;
                csio->scsi_status = pt->header.scsi_status;
                break;
        }

        mfi_release_command(cm);
        xpt_done(ccb);
}

static void
mfip_cam_poll(struct cam_sim *sim)
{
        struct mfip_softc *sc = cam_sim_softc(sim);
        struct mfi_softc *mfisc = sc->mfi_sc;

        mfisc->mfi_intr_ptr(mfisc);
}