265 lines
6.1 KiB
C
265 lines
6.1 KiB
C
/*-
|
|
* Copyright (c) 2006 IronPort Systems
|
|
* 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>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include "opt_mfi.h"
|
|
|
|
#ifdef MFI_DEBUG
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/bio.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/selinfo.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/taskqueue.h>
|
|
#include <sys/uio.h>
|
|
#include <machine/resource.h>
|
|
#include <machine/bus.h>
|
|
|
|
#include <vm/vm.h>
|
|
#include <vm/pmap.h>
|
|
|
|
#include <dev/mfi/mfireg.h>
|
|
#include <dev/mfi/mfi_ioctl.h>
|
|
#include <dev/mfi/mfivar.h>
|
|
|
|
static void
|
|
mfi_print_frame_flags(device_t dev, uint32_t flags)
|
|
{
|
|
device_printf(dev, "flags=%b\n", flags,
|
|
"\20"
|
|
"\1NOPOST"
|
|
"\2SGL64"
|
|
"\3SENSE64"
|
|
"\4WRITE"
|
|
"\5READ");
|
|
}
|
|
|
|
static void
|
|
mfi_print_sgl(struct mfi_frame_header *hdr, union mfi_sgl *sgl, int count)
|
|
{
|
|
int i, columns = 0;
|
|
|
|
printf("SG List:\n");
|
|
for (i = 0; i < count; i++) {
|
|
if (hdr->flags & MFI_FRAME_SGL64) {
|
|
printf("0x%lx:%06d ", (u_long)sgl->sg64[i].addr,
|
|
sgl->sg64[i].len);
|
|
columns += 26;
|
|
if (columns > 77) {
|
|
printf("\n");
|
|
columns = 0;
|
|
}
|
|
} else {
|
|
printf("0x%x:%06d ", sgl->sg32[i].addr,
|
|
sgl->sg32[i].len);
|
|
columns += 18;
|
|
if (columns > 71) {
|
|
printf("\n");
|
|
columns = 0;
|
|
}
|
|
}
|
|
}
|
|
if (columns != 0)
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
static void
|
|
mfi_print_ldio(struct mfi_softc *sc, device_t dev, struct mfi_command *cm)
|
|
{
|
|
struct mfi_io_frame *io;
|
|
struct mfi_frame_header *hdr;
|
|
|
|
io = &cm->cm_frame->io;
|
|
hdr = &io->header;
|
|
|
|
device_printf(dev, "cmd=%s target_id=%d sg_count=%d data_len=%d "
|
|
"lba=%d\n", (hdr->cmd == MFI_CMD_LD_READ) ? "LD_READ":"LD_WRITE",
|
|
hdr->target_id, hdr->sg_count, hdr->data_len, io->lba_lo);
|
|
mfi_print_frame_flags(dev, hdr->flags);
|
|
mfi_print_sgl(hdr, &io->sgl, hdr->sg_count);
|
|
|
|
}
|
|
|
|
static void
|
|
mfi_print_dcmd(struct mfi_softc *sc, device_t dev, struct mfi_command *cm)
|
|
{
|
|
struct mfi_dcmd_frame *dcmd;
|
|
struct mfi_frame_header *hdr;
|
|
const char *opcode;
|
|
|
|
dcmd = &cm->cm_frame->dcmd;
|
|
hdr = &dcmd->header;
|
|
|
|
switch (dcmd->opcode) {
|
|
case MFI_DCMD_CTRL_GETINFO:
|
|
opcode = "CTRL_GETINFO";
|
|
break;
|
|
case MFI_DCMD_CTRL_FLUSHCACHE:
|
|
opcode = "CTRL_FLUSHCACHE";
|
|
break;
|
|
case MFI_DCMD_CTRL_SHUTDOWN:
|
|
opcode = "CTRL_SHUTDOWN";
|
|
break;
|
|
case MFI_DCMD_CTRL_EVENT_GETINFO:
|
|
opcode = "EVENT_GETINFO";
|
|
break;
|
|
case MFI_DCMD_CTRL_EVENT_GET:
|
|
opcode = "EVENT_GET";
|
|
break;
|
|
case MFI_DCMD_CTRL_EVENT_WAIT:
|
|
opcode = "EVENT_WAIT";
|
|
break;
|
|
case MFI_DCMD_LD_GET_LIST:
|
|
opcode = "LD_GET_LIST";
|
|
break;
|
|
case MFI_DCMD_LD_GET_INFO:
|
|
opcode = "LD_GET_INFO";
|
|
break;
|
|
case MFI_DCMD_LD_GET_PROP:
|
|
opcode = "LD_GET_PROP";
|
|
break;
|
|
case MFI_DCMD_LD_SET_PROP:
|
|
opcode = "LD_SET_PROP";
|
|
break;
|
|
case MFI_DCMD_CLUSTER:
|
|
opcode = "CLUSTER";
|
|
break;
|
|
case MFI_DCMD_CLUSTER_RESET_ALL:
|
|
opcode = "CLUSTER_RESET_ALL";
|
|
break;
|
|
case MFI_DCMD_CLUSTER_RESET_LD:
|
|
opcode = "CLUSTER_RESET_LD";
|
|
break;
|
|
default:
|
|
opcode = "UNKNOWN";
|
|
break;
|
|
}
|
|
|
|
device_printf(dev, "cmd=MFI_CMD_DCMD opcode=%s data_len=%d\n",
|
|
opcode, hdr->data_len);
|
|
mfi_print_frame_flags(dev, hdr->flags);
|
|
mfi_print_sgl(hdr, &dcmd->sgl, hdr->sg_count);
|
|
|
|
}
|
|
|
|
static void
|
|
mfi_print_generic_frame(struct mfi_softc *sc, struct mfi_command *cm)
|
|
{
|
|
hexdump(cm->cm_frame, cm->cm_total_frame_size, NULL, HD_OMIT_CHARS);
|
|
}
|
|
|
|
void
|
|
mfi_print_cmd(struct mfi_command *cm)
|
|
{
|
|
device_t dev;
|
|
struct mfi_softc *sc;
|
|
|
|
sc = cm->cm_sc;
|
|
dev = sc->mfi_dev;
|
|
|
|
device_printf(dev, "cm=%p index=%d total_frame_size=%d "
|
|
"extra_frames=%d\n", cm, cm->cm_index, cm->cm_total_frame_size,
|
|
cm->cm_extra_frames);
|
|
device_printf(dev, "flags=%b\n", cm->cm_flags,
|
|
"\20"
|
|
"\1MAPPED"
|
|
"\2DATAIN"
|
|
"\3DATAOUT"
|
|
"\4COMPLETED"
|
|
"\5POLLED"
|
|
"\6Q_FREE"
|
|
"\7Q_READY"
|
|
"\10Q_BUSY");
|
|
|
|
switch (cm->cm_frame->header.cmd) {
|
|
case MFI_CMD_DCMD:
|
|
mfi_print_dcmd(sc, dev, cm);
|
|
break;
|
|
case MFI_CMD_LD_READ:
|
|
case MFI_CMD_LD_WRITE:
|
|
mfi_print_ldio(sc, dev, cm);
|
|
break;
|
|
default:
|
|
mfi_print_generic_frame(sc, cm);
|
|
break;
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
mfi_dump_cmds(struct mfi_softc *sc)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < sc->mfi_total_cmds; i++)
|
|
mfi_print_generic_frame(sc, &sc->mfi_commands[i]);
|
|
}
|
|
|
|
void
|
|
mfi_validate_sg(struct mfi_softc *sc, struct mfi_command *cm,
|
|
const char *function, int line)
|
|
{
|
|
struct mfi_frame_header *hdr;
|
|
int i;
|
|
uint32_t count = 0, data_len;
|
|
|
|
hdr = &cm->cm_frame->header;
|
|
count = 0;
|
|
for (i = 0; i < hdr->sg_count; i++) {
|
|
count += cm->cm_sg->sg32[i].len;
|
|
}
|
|
/*
|
|
count++;
|
|
*/
|
|
data_len = hdr->data_len;
|
|
switch (hdr->cmd) {
|
|
case MFI_CMD_LD_READ:
|
|
case MFI_CMD_LD_WRITE:
|
|
data_len = data_len * 512;
|
|
case MFI_CMD_DCMD:
|
|
if (count != data_len) {
|
|
device_printf(sc->mfi_dev,
|
|
"%s %d COMMAND %p S/G count bad %d %d %d 0x%jx\n",
|
|
function, line, cm, count, data_len, cm->cm_len,
|
|
(intmax_t)pmap_kextract((vm_offset_t)cm->cm_data));
|
|
MFI_PRINT_CMD(cm);
|
|
}
|
|
}
|
|
}
|
|
|
|
#endif
|