blob: 570b21268970f993bac5a0bb6083eea908d65ca3 [file] [log] [blame]
// MPT Fusion boot support.
//
// Copyright (c) 2012 Verizon, Inc.
// Copyright (C) 2016 Paolo Bonzini <pbonzini@redhat.com>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "biosvar.h" // GET_GLOBALFLAT
#include "block.h" // struct drive_s
#include "blockcmd.h" // scsi_drive_setup
#include "config.h" // CONFIG_*
#include "fw/paravirt.h" // runningOnQEMU
#include "malloc.h" // free
#include "output.h" // dprintf
#include "pcidevice.h" // foreachpci
#include "pci_ids.h" // PCI_DEVICE_ID
#include "pci_regs.h" // PCI_VENDOR_ID
#include "stacks.h" // run_thread
#include "std/disk.h" // DISK_RET_SUCCESS
#include "string.h" // memset
#include "util.h" // usleep
#define MPT_REG_DOORBELL 0x00
#define MPT_REG_WRITE_SEQ 0x04
#define MPT_REG_HOST_DIAG 0x08
#define MPT_REG_TEST 0x0c
#define MPT_REG_DIAG_DATA 0x10
#define MPT_REG_DIAG_ADDR 0x14
#define MPT_REG_ISTATUS 0x30
#define MPT_REG_IMASK 0x34
#define MPT_REG_REQ_Q 0x40
#define MPT_REG_REP_Q 0x44
#define MPT_DOORBELL_MSG_RESET 0x40
#define MPT_DOORBELL_HANDSHAKE 0x42
#define MPT_IMASK_DOORBELL 0x01
#define MPT_IMASK_REPLY 0x08
struct mpt_lun_s {
struct drive_s drive;
struct pci_device *pci;
u32 iobase;
u8 target;
u8 lun;
};
u8 reply_msg[4] __attribute((aligned(4))) VARLOW;
#define MPT_MESSAGE_HDR_FUNCTION_SCSI_IO_REQUEST (0x00)
#define MPT_MESSAGE_HDR_FUNCTION_IOC_INIT (0x02)
static struct MptIOCInitRequest
{
u8 WhoInit; /* Which system sent this init request. */
u8 Reserved1; /* Reserved */
u8 ChainOffset; /* Chain offset in the SG list. */
u8 Function; /* Function to execute. */
u8 Flags; /* Flags */
u8 MaxDevices; /* Max devices the driver can handle. */
u8 MaxBuses; /* Max buses the driver can handle. */
u8 MessageFlags; /* Message flags. */
u32 MessageContext; /* Message context ID. */
u16 ReplyFrameSize; /* Reply frame size. */
u16 Reserved2; /* Reserved */
u32 HostMfaHighAddr; /* Upper 32bit of the message frames. */
u32 SenseBufferHighAddr; /* Upper 32bit of the sense buffer. */
} MptIOCInitRequest = {
.WhoInit = 2,
.Function = MPT_MESSAGE_HDR_FUNCTION_IOC_INIT,
.MaxDevices = 8,
.MaxBuses = 1,
.ReplyFrameSize = sizeof(reply_msg),
.HostMfaHighAddr = 0,
.SenseBufferHighAddr = 0
};
struct MptIOCInitReply {
u8 WhoInit; /* Which subsystem sent this init request. */
u8 Reserved1; /* Reserved */
u8 MessageLength; /* Message length */
u8 Function; /* Function. */
u8 Flags; /* Flags */
u8 MaxDevices; /* Maximum number of devices the driver can handle. */
u8 MaxBuses; /* Maximum number of busses the driver can handle. */
u8 MessageFlags; /* Message flags. */
u32 MessageContext; /* Message context ID */
u16 Reserved2; /* Reserved */
u16 IOCStatus; /* IO controller status. */
u32 IOCLogInfo; /* IO controller log information. */
};
typedef struct MptSCSIIORequest {
u8 TargetID; /* Target ID */
u8 Bus; /* Bus number */
u8 ChainOffset; /* Chain offset */
u8 Function; /* Function number. */
u8 CDBLength; /* CDB length. */
u8 SenseBufferLength; /* Sense buffer length. */
u8 Reserved; /* Reserved */
u8 MessageFlags; /* Message flags. */
u32 MessageContext; /* Message context ID. */
u8 LUN[8]; /* LUN */
u32 Control; /* Control values. */
u8 CDB[16]; /* The CDB. */
u32 DataLength; /* Data length. */
u32 SenseBufferLowAddr; /* Sense buffer low 32bit address. */
} __attribute__((packed)) MptSCSIIORequest_t;
#define MPT_POLL_TIMEOUT 60000
typedef struct MptSGEntrySimple32 {
u32 FlagsLength;
u32 DataBufferAddressLow;
} __attribute__((packed)) MptSGEntrySimple32_t;
static int
mpt_scsi_cmd(u32 iobase, struct disk_op_s *op,
u8 *cdb, u16 target, u16 lun, u16 blocksize)
{
u32 end = timer_calc(MPT_POLL_TIMEOUT);
u8 sense_buf[18];
struct scsi_req {
MptSCSIIORequest_t scsi_io;
MptSGEntrySimple32_t sge;
} __attribute__((packed, aligned(4))) req = {
.scsi_io = {
.TargetID = target,
.Bus = 0,
.Function = MPT_MESSAGE_HDR_FUNCTION_SCSI_IO_REQUEST,
.CDBLength = 16,
.SenseBufferLength = 18,
.MessageContext = end & 0x7fffffff,
.DataLength = op->count * blocksize,
.SenseBufferLowAddr = (u32)MAKE_FLATPTR(GET_SEG(SS), &sense_buf[0]),
},
.sge = {
/* end of list, simple entry, end of buffer, last element */
.FlagsLength = (op->count * blocksize) | 0xD1000000,
.DataBufferAddressLow = (u32)op->buf_fl,
}
};
req.scsi_io.LUN[1] = lun;
memcpy(req.scsi_io.CDB, cdb, 16);
if (blocksize) {
if (scsi_is_read(op)) {
req.scsi_io.Control = 2 << 24;
} else {
req.scsi_io.Control = 1 << 24;
req.sge.FlagsLength |= 0x04000000;
}
}
outl((u32)MAKE_FLATPTR(GET_SEG(SS), &req), iobase + MPT_REG_REQ_Q);
for (;;) {
if (timer_check(end)) {
return DISK_RET_ETIMEOUT;
}
u32 istatus = inl(iobase + MPT_REG_ISTATUS);
if (istatus & MPT_IMASK_REPLY) {
u32 resp = inl(iobase + MPT_REG_REP_Q);
/* another read to turn interrupt off */
inl(iobase + MPT_REG_REP_Q);
if (resp == req.scsi_io.MessageContext) {
return DISK_RET_SUCCESS;
} else if (resp & 0x80000000) {
outl((u32)&reply_msg[0], iobase + MPT_REG_REP_Q);
return DISK_RET_EBADTRACK;
}
}
usleep(50);
}
}
int
mpt_scsi_process_op(struct disk_op_s *op)
{
if (!CONFIG_MPT_SCSI)
return DISK_RET_EBADTRACK;
u8 cdbcmd[16];
int blocksize = scsi_fill_cmd(op, cdbcmd, sizeof(cdbcmd));
if (blocksize < 0)
return default_process_op(op);
struct mpt_lun_s *llun_gf =
container_of(op->drive_fl, struct mpt_lun_s, drive);
u16 target = GET_GLOBALFLAT(llun_gf->target);
u16 lun = GET_GLOBALFLAT(llun_gf->lun);
u32 iobase = GET_GLOBALFLAT(llun_gf->iobase);
return mpt_scsi_cmd(iobase, op, cdbcmd, target, lun, blocksize);
}
static void
mpt_scsi_init_lun(struct mpt_lun_s *llun, struct pci_device *pci,
u32 iobase, u8 target, u8 lun)
{
memset(llun, 0, sizeof(*llun));
llun->drive.type = DTYPE_MPT_SCSI;
llun->drive.cntl_id = pci->bdf;
llun->pci = pci;
llun->target = target;
llun->lun = lun;
llun->iobase = iobase;
}
static int
mpt_scsi_add_lun(u32 lun, struct drive_s *tmpl_drv)
{
struct mpt_lun_s *tmpl_llun =
container_of(tmpl_drv, struct mpt_lun_s, drive);
struct mpt_lun_s *llun = malloc_fseg(sizeof(*llun));
if (!llun) {
warn_noalloc();
return -1;
}
mpt_scsi_init_lun(llun, tmpl_llun->pci, tmpl_llun->iobase,
tmpl_llun->target, lun);
boot_lchs_find_scsi_device(llun->pci, llun->target, llun->lun,
&(llun->drive.lchs));
char *name = znprintf(MAXDESCSIZE, "mpt %pP %d:%d",
llun->pci, llun->target, llun->lun);
int prio = bootprio_find_scsi_device(llun->pci, llun->target, llun->lun);
int ret = scsi_drive_setup(&llun->drive, name, prio);
free(name);
if (ret) {
goto fail;
}
return 0;
fail:
free(llun);
return -1;
}
static void
mpt_scsi_scan_target(struct pci_device *pci, u32 iobase, u8 target)
{
struct mpt_lun_s llun0;
mpt_scsi_init_lun(&llun0, pci, iobase, target, 0);
if (scsi_rep_luns_scan(&llun0.drive, mpt_scsi_add_lun) < 0)
scsi_sequential_scan(&llun0.drive, 8, mpt_scsi_add_lun);
}
static inline void
mpt_out_doorbell(u8 func, u8 arg, u16 iobase)
{
outl((func << 24) | (arg << 16), iobase + MPT_REG_DOORBELL);
}
static void
init_mpt_scsi(void *data)
{
struct pci_device *pci = data;
u16 *msg_in_p;
u32 iobase = pci_enable_iobar(pci, PCI_BASE_ADDRESS_0);
if (!iobase)
return;
struct MptIOCInitReply MptIOCInitReply;
pci_enable_busmaster(pci);
dprintf(1, "found mpt-scsi(%04x) at %pP, io @ %x\n"
, pci->device, pci, iobase);
// reset
mpt_out_doorbell(MPT_DOORBELL_MSG_RESET, 0, iobase);
outl(MPT_IMASK_DOORBELL|MPT_IMASK_REPLY , iobase + MPT_REG_IMASK);
outl(0, iobase + MPT_REG_ISTATUS);
// send IOC Init message through the doorbell
mpt_out_doorbell(MPT_DOORBELL_HANDSHAKE,
sizeof(MptIOCInitRequest)/sizeof(u32),
iobase);
outsl(iobase + MPT_REG_DOORBELL,
(u32 *)&MptIOCInitRequest,
sizeof(MptIOCInitRequest)/sizeof(u32));
// Read the reply 16 bits at a time. Cannot use insl
// because the port is 32 bits wide.
msg_in_p = (u16 *)&MptIOCInitReply;
while(msg_in_p != (u16 *)(&MptIOCInitReply + 1))
*msg_in_p++ = (u16)inl(iobase + MPT_REG_DOORBELL);
// Eat doorbell interrupt
outl(0, iobase + MPT_REG_ISTATUS);
// Post reply message used for SCSI errors
outl((u32)&reply_msg[0], iobase + MPT_REG_REP_Q);
int i;
for (i = 0; i < 7; i++)
mpt_scsi_scan_target(pci, iobase, i);
}
void
mpt_scsi_setup(void)
{
ASSERT32FLAT();
if (!CONFIG_MPT_SCSI || !runningOnQEMU()) {
return;
}
dprintf(3, "init MPT\n");
struct pci_device *pci;
foreachpci(pci) {
if (pci->vendor == PCI_VENDOR_ID_LSI_LOGIC
&& (pci->device == PCI_DEVICE_ID_LSI_53C1030
|| pci->device == PCI_DEVICE_ID_LSI_SAS1068
|| pci->device == PCI_DEVICE_ID_LSI_SAS1068E))
run_thread(init_mpt_scsi, pci);
}
}