2010-09-10 15:03:56 +00:00
|
|
|
/*-
|
|
|
|
* Copyright (c) 2008 Yahoo!, Inc.
|
|
|
|
* All rights reserved.
|
|
|
|
* Written by: John Baldwin <jhb@FreeBSD.org>
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
* 3. Neither the name of the author nor the names of any co-contributors
|
|
|
|
* may be used to endorse or promote products derived from this software
|
|
|
|
* without specific prior written permission.
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*
|
|
|
|
* LSI MPS-Fusion Host Adapter FreeBSD userland interface
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <sys/cdefs.h>
|
|
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
|
2010-10-11 21:26:24 +00:00
|
|
|
#include "opt_compat.h"
|
|
|
|
|
2010-09-10 15:03:56 +00:00
|
|
|
#include <sys/types.h>
|
|
|
|
#include <sys/param.h>
|
|
|
|
#include <sys/systm.h>
|
|
|
|
#include <sys/kernel.h>
|
|
|
|
#include <sys/selinfo.h>
|
|
|
|
#include <sys/module.h>
|
|
|
|
#include <sys/bus.h>
|
|
|
|
#include <sys/conf.h>
|
|
|
|
#include <sys/bio.h>
|
|
|
|
#include <sys/malloc.h>
|
|
|
|
#include <sys/uio.h>
|
|
|
|
#include <sys/sysctl.h>
|
|
|
|
#include <sys/ioccom.h>
|
|
|
|
#include <sys/endian.h>
|
2010-10-11 21:26:24 +00:00
|
|
|
#include <sys/proc.h>
|
|
|
|
#include <sys/sysent.h>
|
2010-09-10 15:03:56 +00:00
|
|
|
|
|
|
|
#include <machine/bus.h>
|
|
|
|
#include <machine/resource.h>
|
|
|
|
#include <sys/rman.h>
|
|
|
|
|
|
|
|
#include <cam/scsi/scsi_all.h>
|
|
|
|
|
|
|
|
#include <dev/mps/mpi/mpi2_type.h>
|
|
|
|
#include <dev/mps/mpi/mpi2.h>
|
|
|
|
#include <dev/mps/mpi/mpi2_ioc.h>
|
|
|
|
#include <dev/mps/mpi/mpi2_cnfg.h>
|
|
|
|
#include <dev/mps/mpsvar.h>
|
|
|
|
#include <dev/mps/mps_table.h>
|
|
|
|
#include <dev/mps/mps_ioctl.h>
|
|
|
|
|
|
|
|
static d_open_t mps_open;
|
|
|
|
static d_close_t mps_close;
|
2010-10-11 21:26:24 +00:00
|
|
|
static d_ioctl_t mps_ioctl_devsw;
|
2010-09-10 15:03:56 +00:00
|
|
|
|
|
|
|
static struct cdevsw mps_cdevsw = {
|
|
|
|
.d_version = D_VERSION,
|
|
|
|
.d_flags = 0,
|
|
|
|
.d_open = mps_open,
|
|
|
|
.d_close = mps_close,
|
2010-10-11 21:26:24 +00:00
|
|
|
.d_ioctl = mps_ioctl_devsw,
|
2010-09-10 15:03:56 +00:00
|
|
|
.d_name = "mps",
|
|
|
|
};
|
|
|
|
|
|
|
|
static MALLOC_DEFINE(M_MPSUSER, "mps_user", "Buffers for mps(4) ioctls");
|
|
|
|
|
|
|
|
int
|
|
|
|
mps_attach_user(struct mps_softc *sc)
|
|
|
|
{
|
|
|
|
int unit;
|
|
|
|
|
|
|
|
unit = device_get_unit(sc->mps_dev);
|
|
|
|
sc->mps_cdev = make_dev(&mps_cdevsw, unit, UID_ROOT, GID_OPERATOR, 0640,
|
|
|
|
"mps%d", unit);
|
|
|
|
if (sc->mps_cdev == NULL) {
|
|
|
|
return (ENOMEM);
|
|
|
|
}
|
|
|
|
sc->mps_cdev->si_drv1 = sc;
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
mps_detach_user(struct mps_softc *sc)
|
|
|
|
{
|
|
|
|
|
|
|
|
/* XXX: do a purge of pending requests? */
|
|
|
|
destroy_dev(sc->mps_cdev);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_open(struct cdev *dev, int flags, int fmt, struct thread *td)
|
|
|
|
{
|
|
|
|
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_close(struct cdev *dev, int flags, int fmt, struct thread *td)
|
|
|
|
{
|
|
|
|
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_read_cfg_header(struct mps_softc *sc,
|
|
|
|
struct mps_cfg_page_req *page_req)
|
|
|
|
{
|
|
|
|
MPI2_CONFIG_PAGE_HEADER *hdr;
|
|
|
|
struct mps_config_params params;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
hdr = ¶ms.hdr.Struct;
|
|
|
|
params.action = MPI2_CONFIG_ACTION_PAGE_HEADER;
|
|
|
|
params.page_address = le32toh(page_req->page_address);
|
|
|
|
hdr->PageVersion = 0;
|
|
|
|
hdr->PageLength = 0;
|
|
|
|
hdr->PageNumber = page_req->header.PageNumber;
|
|
|
|
hdr->PageType = page_req->header.PageType;
|
|
|
|
params.buffer = NULL;
|
|
|
|
params.length = 0;
|
|
|
|
params.callback = NULL;
|
|
|
|
|
|
|
|
if ((error = mps_read_config_page(sc, ¶ms)) != 0) {
|
|
|
|
/*
|
|
|
|
* Leave the request. Without resetting the chip, it's
|
|
|
|
* still owned by it and we'll just get into trouble
|
|
|
|
* freeing it now. Mark it as abandoned so that if it
|
|
|
|
* shows up later it can be freed.
|
|
|
|
*/
|
|
|
|
mps_printf(sc, "read_cfg_header timed out\n");
|
|
|
|
return (ETIMEDOUT);
|
|
|
|
}
|
|
|
|
|
|
|
|
page_req->ioc_status = htole16(params.status);
|
|
|
|
if ((page_req->ioc_status & MPI2_IOCSTATUS_MASK) ==
|
|
|
|
MPI2_IOCSTATUS_SUCCESS) {
|
|
|
|
bcopy(hdr, &page_req->header, sizeof(page_req->header));
|
|
|
|
}
|
|
|
|
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_read_cfg_page(struct mps_softc *sc, struct mps_cfg_page_req *page_req,
|
|
|
|
void *buf)
|
|
|
|
{
|
|
|
|
MPI2_CONFIG_PAGE_HEADER *reqhdr, *hdr;
|
|
|
|
struct mps_config_params params;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
reqhdr = buf;
|
|
|
|
hdr = ¶ms.hdr.Struct;
|
|
|
|
hdr->PageVersion = reqhdr->PageVersion;
|
|
|
|
hdr->PageLength = reqhdr->PageLength;
|
|
|
|
hdr->PageNumber = reqhdr->PageNumber;
|
|
|
|
hdr->PageType = reqhdr->PageType & MPI2_CONFIG_PAGETYPE_MASK;
|
|
|
|
params.action = MPI2_CONFIG_ACTION_PAGE_READ_CURRENT;
|
|
|
|
params.page_address = le32toh(page_req->page_address);
|
|
|
|
params.buffer = buf;
|
|
|
|
params.length = le32toh(page_req->len);
|
|
|
|
params.callback = NULL;
|
|
|
|
|
|
|
|
if ((error = mps_read_config_page(sc, ¶ms)) != 0) {
|
|
|
|
mps_printf(sc, "mps_user_read_cfg_page timed out\n");
|
|
|
|
return (ETIMEDOUT);
|
|
|
|
}
|
|
|
|
|
|
|
|
page_req->ioc_status = htole16(params.status);
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_read_extcfg_header(struct mps_softc *sc,
|
|
|
|
struct mps_ext_cfg_page_req *ext_page_req)
|
|
|
|
{
|
|
|
|
MPI2_CONFIG_EXTENDED_PAGE_HEADER *hdr;
|
|
|
|
struct mps_config_params params;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
hdr = ¶ms.hdr.Ext;
|
|
|
|
params.action = MPI2_CONFIG_ACTION_PAGE_HEADER;
|
|
|
|
hdr->PageVersion = ext_page_req->header.PageVersion;
|
|
|
|
hdr->ExtPageLength = 0;
|
|
|
|
hdr->PageNumber = ext_page_req->header.PageNumber;
|
|
|
|
hdr->ExtPageType = ext_page_req->header.ExtPageType;
|
|
|
|
params.page_address = le32toh(ext_page_req->page_address);
|
|
|
|
if ((error = mps_read_config_page(sc, ¶ms)) != 0) {
|
|
|
|
/*
|
|
|
|
* Leave the request. Without resetting the chip, it's
|
|
|
|
* still owned by it and we'll just get into trouble
|
|
|
|
* freeing it now. Mark it as abandoned so that if it
|
|
|
|
* shows up later it can be freed.
|
|
|
|
*/
|
|
|
|
mps_printf(sc, "mps_user_read_extcfg_header timed out\n");
|
|
|
|
return (ETIMEDOUT);
|
|
|
|
}
|
|
|
|
|
|
|
|
ext_page_req->ioc_status = htole16(params.status);
|
|
|
|
if ((ext_page_req->ioc_status & MPI2_IOCSTATUS_MASK) ==
|
|
|
|
MPI2_IOCSTATUS_SUCCESS) {
|
|
|
|
ext_page_req->header.PageVersion = hdr->PageVersion;
|
|
|
|
ext_page_req->header.PageNumber = hdr->PageNumber;
|
|
|
|
ext_page_req->header.PageType = hdr->PageType;
|
|
|
|
ext_page_req->header.ExtPageLength = hdr->ExtPageLength;
|
|
|
|
ext_page_req->header.ExtPageType = hdr->ExtPageType;
|
|
|
|
}
|
|
|
|
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_read_extcfg_page(struct mps_softc *sc,
|
|
|
|
struct mps_ext_cfg_page_req *ext_page_req, void *buf)
|
|
|
|
{
|
|
|
|
MPI2_CONFIG_EXTENDED_PAGE_HEADER *reqhdr, *hdr;
|
|
|
|
struct mps_config_params params;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
reqhdr = buf;
|
|
|
|
hdr = ¶ms.hdr.Ext;
|
|
|
|
params.action = MPI2_CONFIG_ACTION_PAGE_READ_CURRENT;
|
|
|
|
params.page_address = le32toh(ext_page_req->page_address);
|
|
|
|
hdr->PageVersion = reqhdr->PageVersion;
|
|
|
|
hdr->PageNumber = reqhdr->PageNumber;
|
|
|
|
hdr->ExtPageType = reqhdr->ExtPageType;
|
|
|
|
hdr->ExtPageLength = reqhdr->ExtPageLength;
|
|
|
|
params.buffer = buf;
|
|
|
|
params.length = le32toh(ext_page_req->len);
|
|
|
|
params.callback = NULL;
|
|
|
|
|
|
|
|
if ((error = mps_read_config_page(sc, ¶ms)) != 0) {
|
|
|
|
mps_printf(sc, "mps_user_read_extcfg_page timed out\n");
|
|
|
|
return (ETIMEDOUT);
|
|
|
|
}
|
|
|
|
|
|
|
|
ext_page_req->ioc_status = htole16(params.status);
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_write_cfg_page(struct mps_softc *sc,
|
|
|
|
struct mps_cfg_page_req *page_req, void *buf)
|
|
|
|
{
|
|
|
|
MPI2_CONFIG_PAGE_HEADER *reqhdr, *hdr;
|
|
|
|
struct mps_config_params params;
|
|
|
|
u_int hdr_attr;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
reqhdr = buf;
|
|
|
|
hdr = ¶ms.hdr.Struct;
|
|
|
|
hdr_attr = reqhdr->PageType & MPI2_CONFIG_PAGEATTR_MASK;
|
|
|
|
if (hdr_attr != MPI2_CONFIG_PAGEATTR_CHANGEABLE &&
|
|
|
|
hdr_attr != MPI2_CONFIG_PAGEATTR_PERSISTENT) {
|
|
|
|
mps_printf(sc, "page type 0x%x not changeable\n",
|
|
|
|
reqhdr->PageType & MPI2_CONFIG_PAGETYPE_MASK);
|
|
|
|
return (EINVAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* There isn't any point in restoring stripped out attributes
|
|
|
|
* if you then mask them going down to issue the request.
|
|
|
|
*/
|
|
|
|
|
|
|
|
hdr->PageVersion = reqhdr->PageVersion;
|
|
|
|
hdr->PageLength = reqhdr->PageLength;
|
|
|
|
hdr->PageNumber = reqhdr->PageNumber;
|
|
|
|
hdr->PageType = reqhdr->PageType;
|
|
|
|
params.action = MPI2_CONFIG_ACTION_PAGE_WRITE_CURRENT;
|
|
|
|
params.page_address = le32toh(page_req->page_address);
|
|
|
|
params.buffer = buf;
|
|
|
|
params.length = le32toh(page_req->len);
|
|
|
|
params.callback = NULL;
|
|
|
|
|
|
|
|
if ((error = mps_write_config_page(sc, ¶ms)) != 0) {
|
|
|
|
mps_printf(sc, "mps_write_cfg_page timed out\n");
|
|
|
|
return (ETIMEDOUT);
|
|
|
|
}
|
|
|
|
|
|
|
|
page_req->ioc_status = htole16(params.status);
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
struct mps_user_func {
|
|
|
|
U8 Func;
|
|
|
|
U8 SgOff;
|
|
|
|
} mps_user_func_list[] = {
|
|
|
|
{ MPI2_FUNCTION_IOC_FACTS, 0 },
|
|
|
|
{ MPI2_FUNCTION_PORT_FACTS, 0 },
|
|
|
|
{ MPI2_FUNCTION_FW_DOWNLOAD, offsetof(Mpi2FWDownloadRequest,SGL)},
|
|
|
|
{ MPI2_FUNCTION_FW_UPLOAD, offsetof(Mpi2FWUploadRequest_t,SGL)},
|
|
|
|
{ MPI2_FUNCTION_SATA_PASSTHROUGH,offsetof(Mpi2SataPassthroughRequest_t,SGL)},
|
|
|
|
{ MPI2_FUNCTION_SMP_PASSTHROUGH, offsetof(Mpi2SmpPassthroughRequest_t,SGL)},
|
|
|
|
{ MPI2_FUNCTION_CONFIG, offsetof(Mpi2ConfigRequest_t,PageBufferSGE)},
|
|
|
|
{ MPI2_FUNCTION_SAS_IO_UNIT_CONTROL, 0 },
|
|
|
|
};
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_verify_request(MPI2_REQUEST_HEADER *hdr, MPI2_SGE_IO_UNION **psgl)
|
|
|
|
{
|
|
|
|
int i, err = EINVAL;
|
|
|
|
|
|
|
|
for (i = 0; i < sizeof(mps_user_func_list) /
|
|
|
|
sizeof(mps_user_func_list[0]); i++ ) {
|
|
|
|
struct mps_user_func *func = &mps_user_func_list[i];
|
|
|
|
|
|
|
|
if (hdr->Function == func->Func) {
|
|
|
|
if (psgl != NULL) {
|
|
|
|
if (func->SgOff != 0)
|
|
|
|
*psgl = (PTR_MPI2_SGE_IO_UNION)
|
|
|
|
((char*)hdr + func->SgOff);
|
|
|
|
else
|
|
|
|
*psgl = NULL;
|
|
|
|
err = 0;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_user_command(struct mps_softc *sc, struct mps_usr_command *cmd)
|
|
|
|
{
|
|
|
|
MPI2_REQUEST_HEADER *hdr;
|
|
|
|
MPI2_DEFAULT_REPLY *rpl;
|
|
|
|
MPI2_SGE_IO_UNION *sgl;
|
2010-10-11 21:38:31 +00:00
|
|
|
void *buf = NULL;
|
2010-09-10 15:03:56 +00:00
|
|
|
struct mps_command *cm;
|
|
|
|
int err = 0;
|
|
|
|
int sz;
|
|
|
|
|
|
|
|
mps_lock(sc);
|
|
|
|
cm = mps_alloc_command(sc);
|
|
|
|
|
|
|
|
if (cm == NULL) {
|
|
|
|
mps_printf(sc, "mps_user_command: no mps requests\n");
|
|
|
|
err = ENOMEM;
|
|
|
|
goto Ret;
|
|
|
|
}
|
|
|
|
mps_unlock(sc);
|
|
|
|
|
|
|
|
hdr = (MPI2_REQUEST_HEADER *)cm->cm_req;
|
|
|
|
|
|
|
|
mps_dprint(sc, MPS_INFO, "mps_user_command: req %p %d rpl %p %d\n",
|
|
|
|
cmd->req, cmd->req_len, cmd->rpl, cmd->rpl_len );
|
|
|
|
|
2010-10-11 21:38:31 +00:00
|
|
|
if (cmd->req_len > (int)sc->facts->IOCRequestFrameSize * 4) {
|
|
|
|
err = EINVAL;
|
|
|
|
goto RetFreeUnlocked;
|
|
|
|
}
|
|
|
|
err = copyin(cmd->req, hdr, cmd->req_len);
|
|
|
|
if (err != 0)
|
|
|
|
goto RetFreeUnlocked;
|
2010-09-10 15:03:56 +00:00
|
|
|
|
|
|
|
mps_dprint(sc, MPS_INFO, "mps_user_command: Function %02X "
|
|
|
|
"MsgFlags %02X\n", hdr->Function, hdr->MsgFlags );
|
|
|
|
|
|
|
|
err = mps_user_verify_request(hdr, &sgl);
|
|
|
|
if (err != 0) {
|
|
|
|
mps_printf(sc, "mps_user_command: unsupported function 0x%X\n",
|
|
|
|
hdr->Function );
|
2010-10-11 21:38:31 +00:00
|
|
|
goto RetFreeUnlocked;
|
2010-09-10 15:03:56 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
if (cmd->len > 0) {
|
|
|
|
buf = malloc(cmd->len, M_MPSUSER, M_WAITOK|M_ZERO);
|
|
|
|
cm->cm_data = buf;
|
|
|
|
cm->cm_length = cmd->len;
|
|
|
|
} else {
|
|
|
|
cm->cm_data = NULL;
|
|
|
|
cm->cm_length = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
cm->cm_sge = sgl;
|
|
|
|
cm->cm_sglsize = sizeof(MPI2_SGE_IO_UNION);
|
|
|
|
cm->cm_flags = MPS_CM_FLAGS_SGE_SIMPLE | MPS_CM_FLAGS_WAKEUP;
|
|
|
|
cm->cm_desc.Default.RequestFlags = MPI2_REQ_DESCRIPT_FLAGS_DEFAULT_TYPE;
|
|
|
|
|
|
|
|
mps_lock(sc);
|
|
|
|
err = mps_map_command(sc, cm);
|
|
|
|
|
|
|
|
if (err != 0) {
|
|
|
|
mps_printf(sc, "mps_user_command: request timed out\n");
|
|
|
|
goto Ret;
|
|
|
|
}
|
|
|
|
msleep(cm, &sc->mps_mtx, 0, "mpsuser", 0); /* 30 seconds */
|
|
|
|
|
|
|
|
rpl = (MPI2_DEFAULT_REPLY *)cm->cm_reply;
|
|
|
|
sz = rpl->MsgLength * 4;
|
|
|
|
|
|
|
|
if (sz > cmd->rpl_len) {
|
|
|
|
mps_printf(sc,
|
|
|
|
"mps_user_command: reply buffer too small %d required %d\n",
|
|
|
|
cmd->rpl_len, sz );
|
|
|
|
err = EINVAL;
|
|
|
|
sz = cmd->rpl_len;
|
|
|
|
}
|
|
|
|
|
|
|
|
mps_unlock(sc);
|
|
|
|
copyout(rpl, cmd->rpl, sz);
|
2010-10-11 21:38:31 +00:00
|
|
|
if (buf != NULL)
|
2010-09-10 15:03:56 +00:00
|
|
|
copyout(buf, cmd->buf, cmd->len);
|
|
|
|
mps_lock(sc);
|
|
|
|
|
|
|
|
mps_dprint(sc, MPS_INFO, "mps_user_command: reply size %d\n", sz );
|
|
|
|
|
|
|
|
mps_free_command(sc, cm);
|
|
|
|
Ret:
|
|
|
|
mps_unlock(sc);
|
2010-10-11 21:38:31 +00:00
|
|
|
if (buf != NULL)
|
|
|
|
free(buf, M_MPSUSER);
|
|
|
|
return (err);
|
|
|
|
|
|
|
|
RetFreeUnlocked:
|
|
|
|
mps_lock(sc);
|
|
|
|
mps_free_command(sc, cm);
|
|
|
|
mps_unlock(sc);
|
|
|
|
|
|
|
|
if (buf != NULL)
|
|
|
|
free(buf, M_MPSUSER);
|
|
|
|
return (err);
|
2010-09-10 15:03:56 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
2010-10-11 21:26:24 +00:00
|
|
|
mps_ioctl(struct cdev *dev, u_long cmd, void *arg, int flag,
|
2010-09-10 15:03:56 +00:00
|
|
|
struct thread *td)
|
|
|
|
{
|
|
|
|
struct mps_softc *sc;
|
|
|
|
struct mps_cfg_page_req *page_req;
|
|
|
|
struct mps_ext_cfg_page_req *ext_page_req;
|
|
|
|
void *mps_page;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
mps_page = NULL;
|
|
|
|
sc = dev->si_drv1;
|
|
|
|
page_req = (void *)arg;
|
|
|
|
ext_page_req = (void *)arg;
|
|
|
|
|
|
|
|
switch (cmd) {
|
|
|
|
case MPSIO_READ_CFG_HEADER:
|
|
|
|
mps_lock(sc);
|
|
|
|
error = mps_user_read_cfg_header(sc, page_req);
|
|
|
|
mps_unlock(sc);
|
|
|
|
break;
|
|
|
|
case MPSIO_READ_CFG_PAGE:
|
|
|
|
mps_page = malloc(page_req->len, M_MPSUSER, M_WAITOK | M_ZERO);
|
|
|
|
error = copyin(page_req->buf, mps_page,
|
|
|
|
sizeof(MPI2_CONFIG_PAGE_HEADER));
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
mps_lock(sc);
|
|
|
|
error = mps_user_read_cfg_page(sc, page_req, mps_page);
|
|
|
|
mps_unlock(sc);
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
error = copyout(mps_page, page_req->buf, page_req->len);
|
|
|
|
break;
|
|
|
|
case MPSIO_READ_EXT_CFG_HEADER:
|
|
|
|
mps_lock(sc);
|
|
|
|
error = mps_user_read_extcfg_header(sc, ext_page_req);
|
|
|
|
mps_unlock(sc);
|
|
|
|
break;
|
|
|
|
case MPSIO_READ_EXT_CFG_PAGE:
|
|
|
|
mps_page = malloc(ext_page_req->len, M_MPSUSER, M_WAITOK|M_ZERO);
|
|
|
|
error = copyin(ext_page_req->buf, mps_page,
|
|
|
|
sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
mps_lock(sc);
|
|
|
|
error = mps_user_read_extcfg_page(sc, ext_page_req, mps_page);
|
|
|
|
mps_unlock(sc);
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
error = copyout(mps_page, ext_page_req->buf, ext_page_req->len);
|
|
|
|
break;
|
|
|
|
case MPSIO_WRITE_CFG_PAGE:
|
|
|
|
mps_page = malloc(page_req->len, M_MPSUSER, M_WAITOK|M_ZERO);
|
|
|
|
error = copyin(page_req->buf, mps_page, page_req->len);
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
mps_lock(sc);
|
|
|
|
error = mps_user_write_cfg_page(sc, page_req, mps_page);
|
|
|
|
mps_unlock(sc);
|
|
|
|
break;
|
|
|
|
case MPSIO_MPS_COMMAND:
|
|
|
|
error = mps_user_command(sc, (struct mps_usr_command *)arg);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
error = ENOIOCTL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (mps_page != NULL)
|
|
|
|
free(mps_page, M_MPSUSER);
|
|
|
|
|
2010-10-11 21:26:24 +00:00
|
|
|
return (error);
|
|
|
|
}
|
2010-09-10 15:03:56 +00:00
|
|
|
|
2010-10-11 21:26:24 +00:00
|
|
|
#ifdef COMPAT_FREEBSD32
|
|
|
|
|
|
|
|
/* Macros from compat/freebsd32/freebsd32.h */
|
|
|
|
#define PTRIN(v) (void *)(uintptr_t)(v)
|
|
|
|
#define PTROUT(v) (uint32_t)(uintptr_t)(v)
|
|
|
|
|
|
|
|
#define CP(src,dst,fld) do { (dst).fld = (src).fld; } while (0)
|
|
|
|
#define PTRIN_CP(src,dst,fld) \
|
|
|
|
do { (dst).fld = PTRIN((src).fld); } while (0)
|
|
|
|
#define PTROUT_CP(src,dst,fld) \
|
|
|
|
do { (dst).fld = PTROUT((src).fld); } while (0)
|
|
|
|
|
|
|
|
struct mps_cfg_page_req32 {
|
|
|
|
MPI2_CONFIG_PAGE_HEADER header;
|
|
|
|
uint32_t page_address;
|
|
|
|
uint32_t buf;
|
|
|
|
int len;
|
|
|
|
uint16_t ioc_status;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct mps_ext_cfg_page_req32 {
|
|
|
|
MPI2_CONFIG_EXTENDED_PAGE_HEADER header;
|
|
|
|
uint32_t page_address;
|
|
|
|
uint32_t buf;
|
|
|
|
int len;
|
|
|
|
uint16_t ioc_status;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct mps_raid_action32 {
|
|
|
|
uint8_t action;
|
|
|
|
uint8_t volume_bus;
|
|
|
|
uint8_t volume_id;
|
|
|
|
uint8_t phys_disk_num;
|
|
|
|
uint32_t action_data_word;
|
|
|
|
uint32_t buf;
|
|
|
|
int len;
|
|
|
|
uint32_t volume_status;
|
|
|
|
uint32_t action_data[4];
|
|
|
|
uint16_t action_status;
|
|
|
|
uint16_t ioc_status;
|
|
|
|
uint8_t write;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct mps_usr_command32 {
|
|
|
|
uint32_t req;
|
|
|
|
uint32_t req_len;
|
|
|
|
uint32_t rpl;
|
|
|
|
uint32_t rpl_len;
|
|
|
|
uint32_t buf;
|
|
|
|
int len;
|
|
|
|
uint32_t flags;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define MPSIO_READ_CFG_HEADER32 _IOWR('M', 200, struct mps_cfg_page_req32)
|
|
|
|
#define MPSIO_READ_CFG_PAGE32 _IOWR('M', 201, struct mps_cfg_page_req32)
|
|
|
|
#define MPSIO_READ_EXT_CFG_HEADER32 _IOWR('M', 202, struct mps_ext_cfg_page_req32)
|
|
|
|
#define MPSIO_READ_EXT_CFG_PAGE32 _IOWR('M', 203, struct mps_ext_cfg_page_req32)
|
|
|
|
#define MPSIO_WRITE_CFG_PAGE32 _IOWR('M', 204, struct mps_cfg_page_req32)
|
|
|
|
#define MPSIO_RAID_ACTION32 _IOWR('M', 205, struct mps_raid_action32)
|
|
|
|
#define MPSIO_MPS_COMMAND32 _IOWR('M', 210, struct mps_usr_command32)
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_ioctl32(struct cdev *dev, u_long cmd32, void *_arg, int flag,
|
|
|
|
struct thread *td)
|
|
|
|
{
|
|
|
|
struct mps_cfg_page_req32 *page32 = _arg;
|
|
|
|
struct mps_ext_cfg_page_req32 *ext32 = _arg;
|
|
|
|
struct mps_raid_action32 *raid32 = _arg;
|
|
|
|
struct mps_usr_command32 *user32 = _arg;
|
|
|
|
union {
|
|
|
|
struct mps_cfg_page_req page;
|
|
|
|
struct mps_ext_cfg_page_req ext;
|
|
|
|
struct mps_raid_action raid;
|
|
|
|
struct mps_usr_command user;
|
|
|
|
} arg;
|
|
|
|
u_long cmd;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
switch (cmd32) {
|
2010-09-10 15:03:56 +00:00
|
|
|
case MPSIO_READ_CFG_HEADER32:
|
|
|
|
case MPSIO_READ_CFG_PAGE32:
|
|
|
|
case MPSIO_WRITE_CFG_PAGE32:
|
2010-10-11 21:26:24 +00:00
|
|
|
if (cmd32 == MPSIO_READ_CFG_HEADER32)
|
|
|
|
cmd = MPSIO_READ_CFG_HEADER;
|
|
|
|
else if (cmd32 == MPSIO_READ_CFG_PAGE32)
|
|
|
|
cmd = MPSIO_READ_CFG_PAGE;
|
|
|
|
else
|
|
|
|
cmd = MPSIO_WRITE_CFG_PAGE;
|
|
|
|
CP(*page32, arg.page, header);
|
|
|
|
CP(*page32, arg.page, page_address);
|
|
|
|
PTRIN_CP(*page32, arg.page, buf);
|
|
|
|
CP(*page32, arg.page, len);
|
|
|
|
CP(*page32, arg.page, ioc_status);
|
2010-09-10 15:03:56 +00:00
|
|
|
break;
|
2010-10-11 21:26:24 +00:00
|
|
|
|
2010-09-10 15:03:56 +00:00
|
|
|
case MPSIO_READ_EXT_CFG_HEADER32:
|
2010-10-11 21:26:24 +00:00
|
|
|
case MPSIO_READ_EXT_CFG_PAGE32:
|
|
|
|
if (cmd32 == MPSIO_READ_EXT_CFG_HEADER32)
|
|
|
|
cmd = MPSIO_READ_EXT_CFG_HEADER;
|
|
|
|
else
|
|
|
|
cmd = MPSIO_READ_EXT_CFG_PAGE;
|
|
|
|
CP(*ext32, arg.ext, header);
|
|
|
|
CP(*ext32, arg.ext, page_address);
|
|
|
|
PTRIN_CP(*ext32, arg.ext, buf);
|
|
|
|
CP(*ext32, arg.ext, len);
|
|
|
|
CP(*ext32, arg.ext, ioc_status);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case MPSIO_RAID_ACTION32:
|
|
|
|
cmd = MPSIO_RAID_ACTION;
|
|
|
|
CP(*raid32, arg.raid, action);
|
|
|
|
CP(*raid32, arg.raid, volume_bus);
|
|
|
|
CP(*raid32, arg.raid, volume_id);
|
|
|
|
CP(*raid32, arg.raid, phys_disk_num);
|
|
|
|
CP(*raid32, arg.raid, action_data_word);
|
|
|
|
PTRIN_CP(*raid32, arg.raid, buf);
|
|
|
|
CP(*raid32, arg.raid, len);
|
|
|
|
CP(*raid32, arg.raid, volume_status);
|
|
|
|
bcopy(raid32->action_data, arg.raid.action_data,
|
|
|
|
sizeof arg.raid.action_data);
|
|
|
|
CP(*raid32, arg.raid, ioc_status);
|
|
|
|
CP(*raid32, arg.raid, write);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case MPSIO_MPS_COMMAND32:
|
|
|
|
cmd = MPSIO_MPS_COMMAND;
|
|
|
|
PTRIN_CP(*user32, arg.user, req);
|
|
|
|
CP(*user32, arg.user, req_len);
|
|
|
|
PTRIN_CP(*user32, arg.user, rpl);
|
|
|
|
CP(*user32, arg.user, rpl_len);
|
|
|
|
PTRIN_CP(*user32, arg.user, buf);
|
|
|
|
CP(*user32, arg.user, len);
|
|
|
|
CP(*user32, arg.user, flags);
|
2010-09-10 15:03:56 +00:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return (ENOIOCTL);
|
|
|
|
}
|
|
|
|
|
2010-10-11 21:26:24 +00:00
|
|
|
error = mps_ioctl(dev, cmd, &arg, flag, td);
|
|
|
|
if (error == 0 && (cmd32 & IOC_OUT) != 0) {
|
|
|
|
switch (cmd32) {
|
|
|
|
case MPSIO_READ_CFG_HEADER32:
|
|
|
|
case MPSIO_READ_CFG_PAGE32:
|
|
|
|
case MPSIO_WRITE_CFG_PAGE32:
|
|
|
|
CP(arg.page, *page32, header);
|
|
|
|
CP(arg.page, *page32, page_address);
|
|
|
|
PTROUT_CP(arg.page, *page32, buf);
|
|
|
|
CP(arg.page, *page32, len);
|
|
|
|
CP(arg.page, *page32, ioc_status);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case MPSIO_READ_EXT_CFG_HEADER32:
|
|
|
|
case MPSIO_READ_EXT_CFG_PAGE32:
|
|
|
|
CP(arg.ext, *ext32, header);
|
|
|
|
CP(arg.ext, *ext32, page_address);
|
|
|
|
PTROUT_CP(arg.ext, *ext32, buf);
|
|
|
|
CP(arg.ext, *ext32, len);
|
|
|
|
CP(arg.ext, *ext32, ioc_status);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case MPSIO_RAID_ACTION32:
|
|
|
|
CP(arg.raid, *raid32, action);
|
|
|
|
CP(arg.raid, *raid32, volume_bus);
|
|
|
|
CP(arg.raid, *raid32, volume_id);
|
|
|
|
CP(arg.raid, *raid32, phys_disk_num);
|
|
|
|
CP(arg.raid, *raid32, action_data_word);
|
|
|
|
PTROUT_CP(arg.raid, *raid32, buf);
|
|
|
|
CP(arg.raid, *raid32, len);
|
|
|
|
CP(arg.raid, *raid32, volume_status);
|
|
|
|
bcopy(arg.raid.action_data, raid32->action_data,
|
|
|
|
sizeof arg.raid.action_data);
|
|
|
|
CP(arg.raid, *raid32, ioc_status);
|
|
|
|
CP(arg.raid, *raid32, write);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case MPSIO_MPS_COMMAND32:
|
|
|
|
PTROUT_CP(arg.user, *user32, req);
|
|
|
|
CP(arg.user, *user32, req_len);
|
|
|
|
PTROUT_CP(arg.user, *user32, rpl);
|
|
|
|
CP(arg.user, *user32, rpl_len);
|
|
|
|
PTROUT_CP(arg.user, *user32, buf);
|
|
|
|
CP(arg.user, *user32, len);
|
|
|
|
CP(arg.user, *user32, flags);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return (error);
|
|
|
|
}
|
|
|
|
#endif /* COMPAT_FREEBSD32 */
|
|
|
|
|
|
|
|
static int
|
|
|
|
mps_ioctl_devsw(struct cdev *dev, u_long com, caddr_t arg, int flag,
|
|
|
|
struct thread *td)
|
|
|
|
{
|
|
|
|
#ifdef COMPAT_FREEBSD32
|
|
|
|
if (SV_CURPROC_FLAG(SV_ILP32))
|
|
|
|
return (mps_ioctl32(dev, com, arg, flag, td));
|
|
|
|
#endif
|
|
|
|
return (mps_ioctl(dev, com, arg, flag, td));
|
2010-09-10 15:03:56 +00:00
|
|
|
}
|