cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

mptctl.c (84889B)


      1/*
      2 *  linux/drivers/message/fusion/mptctl.c
      3 *      mpt Ioctl driver.
      4 *      For use with LSI PCI chip/adapters
      5 *      running LSI Fusion MPT (Message Passing Technology) firmware.
      6 *
      7 *  Copyright (c) 1999-2008 LSI Corporation
      8 *  (mailto:DL-MPTFusionLinux@lsi.com)
      9 *
     10 */
     11/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
     12/*
     13    This program is free software; you can redistribute it and/or modify
     14    it under the terms of the GNU General Public License as published by
     15    the Free Software Foundation; version 2 of the License.
     16
     17    This program is distributed in the hope that it will be useful,
     18    but WITHOUT ANY WARRANTY; without even the implied warranty of
     19    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     20    GNU General Public License for more details.
     21
     22    NO WARRANTY
     23    THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
     24    CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
     25    LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
     26    MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
     27    solely responsible for determining the appropriateness of using and
     28    distributing the Program and assumes all risks associated with its
     29    exercise of rights under this Agreement, including but not limited to
     30    the risks and costs of program errors, damage to or loss of data,
     31    programs or equipment, and unavailability or interruption of operations.
     32
     33    DISCLAIMER OF LIABILITY
     34    NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
     35    DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     36    DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
     37    ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
     38    TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
     39    USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
     40    HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
     41
     42    You should have received a copy of the GNU General Public License
     43    along with this program; if not, write to the Free Software
     44    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
     45*/
     46/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
     47
     48#include <linux/kernel.h>
     49#include <linux/module.h>
     50#include <linux/errno.h>
     51#include <linux/init.h>
     52#include <linux/slab.h>
     53#include <linux/types.h>
     54#include <linux/pci.h>
     55#include <linux/delay.h>	/* for mdelay */
     56#include <linux/miscdevice.h>
     57#include <linux/mutex.h>
     58#include <linux/compat.h>
     59
     60#include <asm/io.h>
     61#include <linux/uaccess.h>
     62
     63#include <scsi/scsi.h>
     64#include <scsi/scsi_cmnd.h>
     65#include <scsi/scsi_device.h>
     66#include <scsi/scsi_host.h>
     67#include <scsi/scsi_tcq.h>
     68
     69#define COPYRIGHT	"Copyright (c) 1999-2008 LSI Corporation"
     70#define MODULEAUTHOR	"LSI Corporation"
     71#include "mptbase.h"
     72#include "mptctl.h"
     73
     74/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
     75#define my_NAME		"Fusion MPT misc device (ioctl) driver"
     76#define my_VERSION	MPT_LINUX_VERSION_COMMON
     77#define MYNAM		"mptctl"
     78
     79MODULE_AUTHOR(MODULEAUTHOR);
     80MODULE_DESCRIPTION(my_NAME);
     81MODULE_LICENSE("GPL");
     82MODULE_VERSION(my_VERSION);
     83
     84/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
     85
     86static DEFINE_MUTEX(mpctl_mutex);
     87static u8 mptctl_id = MPT_MAX_PROTOCOL_DRIVERS;
     88static u8 mptctl_taskmgmt_id = MPT_MAX_PROTOCOL_DRIVERS;
     89
     90static DECLARE_WAIT_QUEUE_HEAD ( mptctl_wait );
     91
     92/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
     93
     94struct buflist {
     95	u8	*kptr;
     96	int	 len;
     97};
     98
     99/*
    100 * Function prototypes. Called from OS entry point mptctl_ioctl.
    101 * arg contents specific to function.
    102 */
    103static int mptctl_fw_download(MPT_ADAPTER *iocp, unsigned long arg);
    104static int mptctl_getiocinfo(MPT_ADAPTER *iocp, unsigned long arg, unsigned int cmd);
    105static int mptctl_gettargetinfo(MPT_ADAPTER *iocp, unsigned long arg);
    106static int mptctl_readtest(MPT_ADAPTER *iocp, unsigned long arg);
    107static int mptctl_mpt_command(MPT_ADAPTER *iocp, unsigned long arg);
    108static int mptctl_eventquery(MPT_ADAPTER *iocp, unsigned long arg);
    109static int mptctl_eventenable(MPT_ADAPTER *iocp, unsigned long arg);
    110static int mptctl_eventreport(MPT_ADAPTER *iocp, unsigned long arg);
    111static int mptctl_replace_fw(MPT_ADAPTER *iocp, unsigned long arg);
    112
    113static int mptctl_do_reset(MPT_ADAPTER *iocp, unsigned long arg);
    114static int mptctl_hp_hostinfo(MPT_ADAPTER *iocp, unsigned long arg, unsigned int cmd);
    115static int mptctl_hp_targetinfo(MPT_ADAPTER *iocp, unsigned long arg);
    116
    117static int  mptctl_probe(struct pci_dev *);
    118static void mptctl_remove(struct pci_dev *);
    119
    120#ifdef CONFIG_COMPAT
    121static long compat_mpctl_ioctl(struct file *f, unsigned cmd, unsigned long arg);
    122#endif
    123/*
    124 * Private function calls.
    125 */
    126static int mptctl_do_mpt_command(MPT_ADAPTER *iocp, struct mpt_ioctl_command karg, void __user *mfPtr);
    127static int mptctl_do_fw_download(MPT_ADAPTER *iocp, char __user *ufwbuf, size_t fwlen);
    128static MptSge_t *kbuf_alloc_2_sgl(int bytes, u32 dir, int sge_offset, int *frags,
    129		struct buflist **blp, dma_addr_t *sglbuf_dma, MPT_ADAPTER *ioc);
    130static void kfree_sgl(MptSge_t *sgl, dma_addr_t sgl_dma,
    131		struct buflist *buflist, MPT_ADAPTER *ioc);
    132
    133/*
    134 * Reset Handler cleanup function
    135 */
    136static int  mptctl_ioc_reset(MPT_ADAPTER *ioc, int reset_phase);
    137
    138/*
    139 * Event Handler function
    140 */
    141static int mptctl_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *pEvReply);
    142static struct fasync_struct *async_queue=NULL;
    143
    144/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    145/*
    146 * Scatter gather list (SGL) sizes and limits...
    147 */
    148//#define MAX_SCSI_FRAGS	9
    149#define MAX_FRAGS_SPILL1	9
    150#define MAX_FRAGS_SPILL2	15
    151#define FRAGS_PER_BUCKET	(MAX_FRAGS_SPILL2 + 1)
    152
    153//#define MAX_CHAIN_FRAGS	64
    154//#define MAX_CHAIN_FRAGS	(15+15+15+16)
    155#define MAX_CHAIN_FRAGS		(4 * MAX_FRAGS_SPILL2 + 1)
    156
    157//  Define max sg LIST bytes ( == (#frags + #chains) * 8 bytes each)
    158//  Works out to: 592d bytes!     (9+1)*8 + 4*(15+1)*8
    159//                  ^----------------- 80 + 512
    160#define MAX_SGL_BYTES		((MAX_FRAGS_SPILL1 + 1 + (4 * FRAGS_PER_BUCKET)) * 8)
    161
    162/* linux only seems to ever give 128kB MAX contiguous (GFP_USER) mem bytes */
    163#define MAX_KMALLOC_SZ		(128*1024)
    164
    165#define MPT_IOCTL_DEFAULT_TIMEOUT 10	/* Default timeout value (seconds) */
    166
    167/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    168/**
    169 *	mptctl_syscall_down - Down the MPT adapter syscall semaphore.
    170 *	@ioc: Pointer to MPT adapter
    171 *	@nonblock: boolean, non-zero if O_NONBLOCK is set
    172 *
    173 *	All of the ioctl commands can potentially sleep, which is illegal
    174 *	with a spinlock held, thus we perform mutual exclusion here.
    175 *
    176 *	Returns negative errno on error, or zero for success.
    177 */
    178static inline int
    179mptctl_syscall_down(MPT_ADAPTER *ioc, int nonblock)
    180{
    181	int rc = 0;
    182
    183	if (nonblock) {
    184		if (!mutex_trylock(&ioc->ioctl_cmds.mutex))
    185			rc = -EAGAIN;
    186	} else {
    187		if (mutex_lock_interruptible(&ioc->ioctl_cmds.mutex))
    188			rc = -ERESTARTSYS;
    189	}
    190	return rc;
    191}
    192
    193/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    194/*
    195 *  This is the callback for any message we have posted. The message itself
    196 *  will be returned to the message pool when we return from the IRQ
    197 *
    198 *  This runs in irq context so be short and sweet.
    199 */
    200static int
    201mptctl_reply(MPT_ADAPTER *ioc, MPT_FRAME_HDR *req, MPT_FRAME_HDR *reply)
    202{
    203	char	*sense_data;
    204	int	req_index;
    205	int	sz;
    206
    207	if (!req)
    208		return 0;
    209
    210	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "completing mpi function "
    211	    "(0x%02X), req=%p, reply=%p\n", ioc->name,  req->u.hdr.Function,
    212	    req, reply));
    213
    214	/*
    215	 * Handling continuation of the same reply. Processing the first
    216	 * reply, and eating the other replys that come later.
    217	 */
    218	if (ioc->ioctl_cmds.msg_context != req->u.hdr.MsgContext)
    219		goto out_continuation;
    220
    221	ioc->ioctl_cmds.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
    222
    223	if (!reply)
    224		goto out;
    225
    226	ioc->ioctl_cmds.status |= MPT_MGMT_STATUS_RF_VALID;
    227	sz = min(ioc->reply_sz, 4*reply->u.reply.MsgLength);
    228	memcpy(ioc->ioctl_cmds.reply, reply, sz);
    229
    230	if (reply->u.reply.IOCStatus || reply->u.reply.IOCLogInfo)
    231		dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    232		    "iocstatus (0x%04X), loginfo (0x%08X)\n", ioc->name,
    233		    le16_to_cpu(reply->u.reply.IOCStatus),
    234		    le32_to_cpu(reply->u.reply.IOCLogInfo)));
    235
    236	if ((req->u.hdr.Function == MPI_FUNCTION_SCSI_IO_REQUEST) ||
    237		(req->u.hdr.Function ==
    238		 MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH)) {
    239
    240		if (reply->u.sreply.SCSIStatus || reply->u.sreply.SCSIState)
    241			dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    242			"scsi_status (0x%02x), scsi_state (0x%02x), "
    243			"tag = (0x%04x), transfer_count (0x%08x)\n", ioc->name,
    244			reply->u.sreply.SCSIStatus,
    245			reply->u.sreply.SCSIState,
    246			le16_to_cpu(reply->u.sreply.TaskTag),
    247			le32_to_cpu(reply->u.sreply.TransferCount)));
    248
    249		if (reply->u.sreply.SCSIState &
    250			MPI_SCSI_STATE_AUTOSENSE_VALID) {
    251			sz = req->u.scsireq.SenseBufferLength;
    252			req_index =
    253			    le16_to_cpu(req->u.frame.hwhdr.msgctxu.fld.req_idx);
    254			sense_data = ((u8 *)ioc->sense_buf_pool +
    255			     (req_index * MPT_SENSE_BUFFER_ALLOC));
    256			memcpy(ioc->ioctl_cmds.sense, sense_data, sz);
    257			ioc->ioctl_cmds.status |= MPT_MGMT_STATUS_SENSE_VALID;
    258		}
    259	}
    260
    261 out:
    262	/* We are done, issue wake up
    263	 */
    264	if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_PENDING) {
    265		if (req->u.hdr.Function == MPI_FUNCTION_SCSI_TASK_MGMT) {
    266			mpt_clear_taskmgmt_in_progress_flag(ioc);
    267			ioc->ioctl_cmds.status &= ~MPT_MGMT_STATUS_PENDING;
    268			complete(&ioc->ioctl_cmds.done);
    269			if (ioc->bus_type == SAS)
    270				ioc->schedule_target_reset(ioc);
    271		} else {
    272			ioc->ioctl_cmds.status &= ~MPT_MGMT_STATUS_PENDING;
    273			complete(&ioc->ioctl_cmds.done);
    274		}
    275	}
    276
    277 out_continuation:
    278	if (reply && (reply->u.reply.MsgFlags &
    279	    MPI_MSGFLAGS_CONTINUATION_REPLY))
    280		return 0;
    281	return 1;
    282}
    283
    284
    285static int
    286mptctl_taskmgmt_reply(MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *mr)
    287{
    288	if (!mf)
    289		return 0;
    290
    291	dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    292		"TaskMgmt completed (mf=%p, mr=%p)\n",
    293		ioc->name, mf, mr));
    294
    295	ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
    296
    297	if (!mr)
    298		goto out;
    299
    300	ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_RF_VALID;
    301	memcpy(ioc->taskmgmt_cmds.reply, mr,
    302	    min(MPT_DEFAULT_FRAME_SIZE, 4 * mr->u.reply.MsgLength));
    303 out:
    304	if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_PENDING) {
    305		mpt_clear_taskmgmt_in_progress_flag(ioc);
    306		ioc->taskmgmt_cmds.status &= ~MPT_MGMT_STATUS_PENDING;
    307		complete(&ioc->taskmgmt_cmds.done);
    308		if (ioc->bus_type == SAS)
    309			ioc->schedule_target_reset(ioc);
    310		return 1;
    311	}
    312	return 0;
    313}
    314
    315static int
    316mptctl_do_taskmgmt(MPT_ADAPTER *ioc, u8 tm_type, u8 bus_id, u8 target_id)
    317{
    318	MPT_FRAME_HDR	*mf;
    319	SCSITaskMgmt_t	*pScsiTm;
    320	SCSITaskMgmtReply_t *pScsiTmReply;
    321	int		 ii;
    322	int		 retval;
    323	unsigned long	 timeout;
    324	u16		 iocstatus;
    325
    326
    327	mutex_lock(&ioc->taskmgmt_cmds.mutex);
    328	if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0) {
    329		mutex_unlock(&ioc->taskmgmt_cmds.mutex);
    330		return -EPERM;
    331	}
    332
    333	retval = 0;
    334
    335	mf = mpt_get_msg_frame(mptctl_taskmgmt_id, ioc);
    336	if (mf == NULL) {
    337		dtmprintk(ioc,
    338			printk(MYIOC_s_WARN_FMT "TaskMgmt, no msg frames!!\n",
    339			ioc->name));
    340		mpt_clear_taskmgmt_in_progress_flag(ioc);
    341		retval = -ENOMEM;
    342		goto tm_done;
    343	}
    344
    345	dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request (mf=%p)\n",
    346		ioc->name, mf));
    347
    348	pScsiTm = (SCSITaskMgmt_t *) mf;
    349	memset(pScsiTm, 0, sizeof(SCSITaskMgmt_t));
    350	pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
    351	pScsiTm->TaskType = tm_type;
    352	if ((tm_type == MPI_SCSITASKMGMT_TASKTYPE_RESET_BUS) &&
    353		(ioc->bus_type == FC))
    354		pScsiTm->MsgFlags =
    355				MPI_SCSITASKMGMT_MSGFLAGS_LIPRESET_RESET_OPTION;
    356	pScsiTm->TargetID = target_id;
    357	pScsiTm->Bus = bus_id;
    358	pScsiTm->ChainOffset = 0;
    359	pScsiTm->Reserved = 0;
    360	pScsiTm->Reserved1 = 0;
    361	pScsiTm->TaskMsgContext = 0;
    362	for (ii= 0; ii < 8; ii++)
    363		pScsiTm->LUN[ii] = 0;
    364	for (ii=0; ii < 7; ii++)
    365		pScsiTm->Reserved2[ii] = 0;
    366
    367	switch (ioc->bus_type) {
    368	case FC:
    369		timeout = 40;
    370		break;
    371	case SAS:
    372		timeout = 30;
    373		break;
    374	case SPI:
    375		default:
    376		timeout = 10;
    377		break;
    378	}
    379
    380	dtmprintk(ioc,
    381		printk(MYIOC_s_DEBUG_FMT "TaskMgmt type=%d timeout=%ld\n",
    382		ioc->name, tm_type, timeout));
    383
    384	INITIALIZE_MGMT_STATUS(ioc->taskmgmt_cmds.status)
    385	if ((ioc->facts.IOCCapabilities & MPI_IOCFACTS_CAPABILITY_HIGH_PRI_Q) &&
    386	    (ioc->facts.MsgVersion >= MPI_VERSION_01_05))
    387		mpt_put_msg_frame_hi_pri(mptctl_taskmgmt_id, ioc, mf);
    388	else {
    389		retval = mpt_send_handshake_request(mptctl_taskmgmt_id, ioc,
    390		    sizeof(SCSITaskMgmt_t), (u32 *)pScsiTm, CAN_SLEEP);
    391		if (retval != 0) {
    392			dfailprintk(ioc,
    393				printk(MYIOC_s_ERR_FMT
    394				"TaskMgmt send_handshake FAILED!"
    395				" (ioc %p, mf %p, rc=%d) \n", ioc->name,
    396				ioc, mf, retval));
    397			mpt_free_msg_frame(ioc, mf);
    398			mpt_clear_taskmgmt_in_progress_flag(ioc);
    399			goto tm_done;
    400		}
    401	}
    402
    403	/* Now wait for the command to complete */
    404	ii = wait_for_completion_timeout(&ioc->taskmgmt_cmds.done, timeout*HZ);
    405
    406	if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
    407		dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    408		    "TaskMgmt failed\n", ioc->name));
    409		mpt_free_msg_frame(ioc, mf);
    410		mpt_clear_taskmgmt_in_progress_flag(ioc);
    411		if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET)
    412			retval = 0;
    413		else
    414			retval = -1; /* return failure */
    415		goto tm_done;
    416	}
    417
    418	if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_RF_VALID)) {
    419		dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    420		    "TaskMgmt failed\n", ioc->name));
    421		retval = -1; /* return failure */
    422		goto tm_done;
    423	}
    424
    425	pScsiTmReply = (SCSITaskMgmtReply_t *) ioc->taskmgmt_cmds.reply;
    426	dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    427	    "TaskMgmt fw_channel = %d, fw_id = %d, task_type=0x%02X, "
    428	    "iocstatus=0x%04X\n\tloginfo=0x%08X, response_code=0x%02X, "
    429	    "term_cmnds=%d\n", ioc->name, pScsiTmReply->Bus,
    430	    pScsiTmReply->TargetID, tm_type,
    431	    le16_to_cpu(pScsiTmReply->IOCStatus),
    432	    le32_to_cpu(pScsiTmReply->IOCLogInfo),
    433	    pScsiTmReply->ResponseCode,
    434	    le32_to_cpu(pScsiTmReply->TerminationCount)));
    435
    436	iocstatus = le16_to_cpu(pScsiTmReply->IOCStatus) & MPI_IOCSTATUS_MASK;
    437
    438	if (iocstatus == MPI_IOCSTATUS_SCSI_TASK_TERMINATED ||
    439	   iocstatus == MPI_IOCSTATUS_SCSI_IOC_TERMINATED ||
    440	   iocstatus == MPI_IOCSTATUS_SUCCESS)
    441		retval = 0;
    442	else {
    443		dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    444		    "TaskMgmt failed\n", ioc->name));
    445		retval = -1; /* return failure */
    446	}
    447
    448 tm_done:
    449	mutex_unlock(&ioc->taskmgmt_cmds.mutex);
    450	CLEAR_MGMT_STATUS(ioc->taskmgmt_cmds.status)
    451	return retval;
    452}
    453
    454/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    455/* mptctl_timeout_expired
    456 *
    457 * Expecting an interrupt, however timed out.
    458 *
    459 */
    460static void
    461mptctl_timeout_expired(MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf)
    462{
    463	unsigned long flags;
    464	int ret_val = -1;
    465	SCSIIORequest_t *scsi_req = (SCSIIORequest_t *) mf;
    466	u8 function = mf->u.hdr.Function;
    467
    468	dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT ": %s\n",
    469		ioc->name, __func__));
    470
    471	if (mpt_fwfault_debug)
    472		mpt_halt_firmware(ioc);
    473
    474	spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
    475	if (ioc->ioc_reset_in_progress) {
    476		spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
    477		CLEAR_MGMT_PENDING_STATUS(ioc->ioctl_cmds.status)
    478		mpt_free_msg_frame(ioc, mf);
    479		return;
    480	}
    481	spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
    482
    483
    484	CLEAR_MGMT_PENDING_STATUS(ioc->ioctl_cmds.status)
    485
    486	if (ioc->bus_type == SAS) {
    487		if (function == MPI_FUNCTION_SCSI_IO_REQUEST)
    488			ret_val = mptctl_do_taskmgmt(ioc,
    489				MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET,
    490				scsi_req->Bus, scsi_req->TargetID);
    491		else if (function == MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH)
    492			ret_val = mptctl_do_taskmgmt(ioc,
    493				MPI_SCSITASKMGMT_TASKTYPE_RESET_BUS,
    494				scsi_req->Bus, 0);
    495		if (!ret_val)
    496			return;
    497	} else {
    498		if ((function == MPI_FUNCTION_SCSI_IO_REQUEST) ||
    499			(function == MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH))
    500			ret_val = mptctl_do_taskmgmt(ioc,
    501				MPI_SCSITASKMGMT_TASKTYPE_RESET_BUS,
    502				scsi_req->Bus, 0);
    503		if (!ret_val)
    504			return;
    505	}
    506
    507	dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Calling Reset! \n",
    508		 ioc->name));
    509	mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
    510	mpt_free_msg_frame(ioc, mf);
    511}
    512
    513
    514/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    515/* mptctl_ioc_reset
    516 *
    517 * Clean-up functionality. Used only if there has been a
    518 * reload of the FW due.
    519 *
    520 */
    521static int
    522mptctl_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
    523{
    524	switch(reset_phase) {
    525	case MPT_IOC_SETUP_RESET:
    526		dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    527		    "%s: MPT_IOC_SETUP_RESET\n", ioc->name, __func__));
    528		break;
    529	case MPT_IOC_PRE_RESET:
    530		dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    531		    "%s: MPT_IOC_PRE_RESET\n", ioc->name, __func__));
    532		break;
    533	case MPT_IOC_POST_RESET:
    534		dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    535		    "%s: MPT_IOC_POST_RESET\n", ioc->name, __func__));
    536		if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_PENDING) {
    537			ioc->ioctl_cmds.status |= MPT_MGMT_STATUS_DID_IOCRESET;
    538			complete(&ioc->ioctl_cmds.done);
    539		}
    540		break;
    541	default:
    542		break;
    543	}
    544
    545	return 1;
    546}
    547
    548/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    549/* ASYNC Event Notification Support */
    550static int
    551mptctl_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *pEvReply)
    552{
    553	u8 event;
    554
    555	event = le32_to_cpu(pEvReply->Event) & 0xFF;
    556
    557	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s() called\n",
    558	    ioc->name, __func__));
    559	if(async_queue == NULL)
    560		return 1;
    561
    562	/* Raise SIGIO for persistent events.
    563	 * TODO - this define is not in MPI spec yet,
    564	 * but they plan to set it to 0x21
    565	 */
    566	if (event == 0x21) {
    567		ioc->aen_event_read_flag=1;
    568		dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Raised SIGIO to application\n",
    569		    ioc->name));
    570		devtverboseprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    571		    "Raised SIGIO to application\n", ioc->name));
    572		kill_fasync(&async_queue, SIGIO, POLL_IN);
    573		return 1;
    574	 }
    575
    576	/* This flag is set after SIGIO was raised, and
    577	 * remains set until the application has read
    578	 * the event log via ioctl=MPTEVENTREPORT
    579	 */
    580	if(ioc->aen_event_read_flag)
    581		return 1;
    582
    583	/* Signal only for the events that are
    584	 * requested for by the application
    585	 */
    586	if (ioc->events && (ioc->eventTypes & ( 1 << event))) {
    587		ioc->aen_event_read_flag=1;
    588		dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    589		    "Raised SIGIO to application\n", ioc->name));
    590		devtverboseprintk(ioc, printk(MYIOC_s_DEBUG_FMT
    591		    "Raised SIGIO to application\n", ioc->name));
    592		kill_fasync(&async_queue, SIGIO, POLL_IN);
    593	}
    594	return 1;
    595}
    596
    597static int
    598mptctl_fasync(int fd, struct file *filep, int mode)
    599{
    600	MPT_ADAPTER	*ioc;
    601	int ret;
    602
    603	mutex_lock(&mpctl_mutex);
    604	list_for_each_entry(ioc, &ioc_list, list)
    605		ioc->aen_event_read_flag=0;
    606
    607	ret = fasync_helper(fd, filep, mode, &async_queue);
    608	mutex_unlock(&mpctl_mutex);
    609	return ret;
    610}
    611
    612/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    613/*
    614 *  MPT ioctl handler
    615 *  cmd - specify the particular IOCTL command to be issued
    616 *  arg - data specific to the command. Must not be null.
    617 */
    618static long
    619__mptctl_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
    620{
    621	mpt_ioctl_header __user *uhdr = (void __user *) arg;
    622	mpt_ioctl_header	 khdr;
    623	int iocnum;
    624	unsigned iocnumX;
    625	int nonblock = (file->f_flags & O_NONBLOCK);
    626	int ret;
    627	MPT_ADAPTER *iocp = NULL;
    628
    629	if (copy_from_user(&khdr, uhdr, sizeof(khdr))) {
    630		printk(KERN_ERR MYNAM "%s::mptctl_ioctl() @%d - "
    631				"Unable to copy mpt_ioctl_header data @ %p\n",
    632				__FILE__, __LINE__, uhdr);
    633		return -EFAULT;
    634	}
    635	ret = -ENXIO;				/* (-6) No such device or address */
    636
    637	/* Verify intended MPT adapter - set iocnum and the adapter
    638	 * pointer (iocp)
    639	 */
    640	iocnumX = khdr.iocnum & 0xFF;
    641	if (((iocnum = mpt_verify_adapter(iocnumX, &iocp)) < 0) ||
    642	    (iocp == NULL))
    643		return -ENODEV;
    644
    645	if (!iocp->active) {
    646		printk(KERN_DEBUG MYNAM "%s::mptctl_ioctl() @%d - Controller disabled.\n",
    647				__FILE__, __LINE__);
    648		return -EFAULT;
    649	}
    650
    651	/* Handle those commands that are just returning
    652	 * information stored in the driver.
    653	 * These commands should never time out and are unaffected
    654	 * by TM and FW reloads.
    655	 */
    656	if ((cmd & ~IOCSIZE_MASK) == (MPTIOCINFO & ~IOCSIZE_MASK)) {
    657		return mptctl_getiocinfo(iocp, arg, _IOC_SIZE(cmd));
    658	} else if (cmd == MPTTARGETINFO) {
    659		return mptctl_gettargetinfo(iocp, arg);
    660	} else if (cmd == MPTTEST) {
    661		return mptctl_readtest(iocp, arg);
    662	} else if (cmd == MPTEVENTQUERY) {
    663		return mptctl_eventquery(iocp, arg);
    664	} else if (cmd == MPTEVENTENABLE) {
    665		return mptctl_eventenable(iocp, arg);
    666	} else if (cmd == MPTEVENTREPORT) {
    667		return mptctl_eventreport(iocp, arg);
    668	} else if (cmd == MPTFWREPLACE) {
    669		return mptctl_replace_fw(iocp, arg);
    670	}
    671
    672	/* All of these commands require an interrupt or
    673	 * are unknown/illegal.
    674	 */
    675	if ((ret = mptctl_syscall_down(iocp, nonblock)) != 0)
    676		return ret;
    677
    678	if (cmd == MPTFWDOWNLOAD)
    679		ret = mptctl_fw_download(iocp, arg);
    680	else if (cmd == MPTCOMMAND)
    681		ret = mptctl_mpt_command(iocp, arg);
    682	else if (cmd == MPTHARDRESET)
    683		ret = mptctl_do_reset(iocp, arg);
    684	else if ((cmd & ~IOCSIZE_MASK) == (HP_GETHOSTINFO & ~IOCSIZE_MASK))
    685		ret = mptctl_hp_hostinfo(iocp, arg, _IOC_SIZE(cmd));
    686	else if (cmd == HP_GETTARGETINFO)
    687		ret = mptctl_hp_targetinfo(iocp, arg);
    688	else
    689		ret = -EINVAL;
    690
    691	mutex_unlock(&iocp->ioctl_cmds.mutex);
    692
    693	return ret;
    694}
    695
    696static long
    697mptctl_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
    698{
    699	long ret;
    700	mutex_lock(&mpctl_mutex);
    701	ret = __mptctl_ioctl(file, cmd, arg);
    702	mutex_unlock(&mpctl_mutex);
    703	return ret;
    704}
    705
    706static int mptctl_do_reset(MPT_ADAPTER *iocp, unsigned long arg)
    707{
    708	struct mpt_ioctl_diag_reset __user *urinfo = (void __user *) arg;
    709	struct mpt_ioctl_diag_reset krinfo;
    710
    711	if (copy_from_user(&krinfo, urinfo, sizeof(struct mpt_ioctl_diag_reset))) {
    712		printk(KERN_ERR MYNAM "%s@%d::mptctl_do_reset - "
    713				"Unable to copy mpt_ioctl_diag_reset struct @ %p\n",
    714				__FILE__, __LINE__, urinfo);
    715		return -EFAULT;
    716	}
    717
    718	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT "mptctl_do_reset called.\n",
    719	    iocp->name));
    720
    721	if (mpt_HardResetHandler(iocp, CAN_SLEEP) != 0) {
    722		printk (MYIOC_s_ERR_FMT "%s@%d::mptctl_do_reset - reset failed.\n",
    723			iocp->name, __FILE__, __LINE__);
    724		return -1;
    725	}
    726
    727	return 0;
    728}
    729
    730/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    731/*
    732 * MPT FW download function.  Cast the arg into the mpt_fw_xfer structure.
    733 * This structure contains: iocnum, firmware length (bytes),
    734 *      pointer to user space memory where the fw image is stored.
    735 *
    736 * Outputs:	None.
    737 * Return:	0 if successful
    738 *		-EFAULT if data unavailable
    739 *		-ENXIO  if no such device
    740 *		-EAGAIN if resource problem
    741 *		-ENOMEM if no memory for SGE
    742 *		-EMLINK if too many chain buffers required
    743 *		-EBADRQC if adapter does not support FW download
    744 *		-EBUSY if adapter is busy
    745 *		-ENOMSG if FW upload returned bad status
    746 */
    747static int
    748mptctl_fw_download(MPT_ADAPTER *iocp, unsigned long arg)
    749{
    750	struct mpt_fw_xfer __user *ufwdl = (void __user *) arg;
    751	struct mpt_fw_xfer	 kfwdl;
    752
    753	if (copy_from_user(&kfwdl, ufwdl, sizeof(struct mpt_fw_xfer))) {
    754		printk(KERN_ERR MYNAM "%s@%d::_ioctl_fwdl - "
    755				"Unable to copy mpt_fw_xfer struct @ %p\n",
    756				__FILE__, __LINE__, ufwdl);
    757		return -EFAULT;
    758	}
    759
    760	return mptctl_do_fw_download(iocp, kfwdl.bufp, kfwdl.fwlen);
    761}
    762
    763/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    764/*
    765 * FW Download engine.
    766 * Outputs:	None.
    767 * Return:	0 if successful
    768 *		-EFAULT if data unavailable
    769 *		-ENXIO  if no such device
    770 *		-EAGAIN if resource problem
    771 *		-ENOMEM if no memory for SGE
    772 *		-EMLINK if too many chain buffers required
    773 *		-EBADRQC if adapter does not support FW download
    774 *		-EBUSY if adapter is busy
    775 *		-ENOMSG if FW upload returned bad status
    776 */
    777static int
    778mptctl_do_fw_download(MPT_ADAPTER *iocp, char __user *ufwbuf, size_t fwlen)
    779{
    780	FWDownload_t		*dlmsg;
    781	MPT_FRAME_HDR		*mf;
    782	FWDownloadTCSGE_t	*ptsge;
    783	MptSge_t		*sgl, *sgIn;
    784	char			*sgOut;
    785	struct buflist		*buflist;
    786	struct buflist		*bl;
    787	dma_addr_t		 sgl_dma;
    788	int			 ret;
    789	int			 numfrags = 0;
    790	int			 maxfrags;
    791	int			 n = 0;
    792	u32			 sgdir;
    793	u32			 nib;
    794	int			 fw_bytes_copied = 0;
    795	int			 i;
    796	int			 sge_offset = 0;
    797	u16			 iocstat;
    798	pFWDownloadReply_t	 ReplyMsg = NULL;
    799	unsigned long		 timeleft;
    800
    801	/*  Valid device. Get a message frame and construct the FW download message.
    802	*/
    803	if ((mf = mpt_get_msg_frame(mptctl_id, iocp)) == NULL)
    804		return -EAGAIN;
    805
    806	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT
    807	    "mptctl_do_fwdl called. mptctl_id = %xh.\n", iocp->name, mptctl_id));
    808	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT "DbG: kfwdl.bufp  = %p\n",
    809	    iocp->name, ufwbuf));
    810	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT "DbG: kfwdl.fwlen = %d\n",
    811	    iocp->name, (int)fwlen));
    812
    813	dlmsg = (FWDownload_t*) mf;
    814	ptsge = (FWDownloadTCSGE_t *) &dlmsg->SGL;
    815	sgOut = (char *) (ptsge + 1);
    816
    817	/*
    818	 * Construct f/w download request
    819	 */
    820	dlmsg->ImageType = MPI_FW_DOWNLOAD_ITYPE_FW;
    821	dlmsg->Reserved = 0;
    822	dlmsg->ChainOffset = 0;
    823	dlmsg->Function = MPI_FUNCTION_FW_DOWNLOAD;
    824	dlmsg->Reserved1[0] = dlmsg->Reserved1[1] = dlmsg->Reserved1[2] = 0;
    825	if (iocp->facts.MsgVersion >= MPI_VERSION_01_05)
    826		dlmsg->MsgFlags = MPI_FW_DOWNLOAD_MSGFLGS_LAST_SEGMENT;
    827	else
    828		dlmsg->MsgFlags = 0;
    829
    830
    831	/* Set up the Transaction SGE.
    832	 */
    833	ptsge->Reserved = 0;
    834	ptsge->ContextSize = 0;
    835	ptsge->DetailsLength = 12;
    836	ptsge->Flags = MPI_SGE_FLAGS_TRANSACTION_ELEMENT;
    837	ptsge->Reserved_0100_Checksum = 0;
    838	ptsge->ImageOffset = 0;
    839	ptsge->ImageSize = cpu_to_le32(fwlen);
    840
    841	/* Add the SGL
    842	 */
    843
    844	/*
    845	 * Need to kmalloc area(s) for holding firmware image bytes.
    846	 * But we need to do it piece meal, using a proper
    847	 * scatter gather list (with 128kB MAX hunks).
    848	 *
    849	 * A practical limit here might be # of sg hunks that fit into
    850	 * a single IOC request frame; 12 or 8 (see below), so:
    851	 * For FC9xx: 12 x 128kB == 1.5 mB (max)
    852	 * For C1030:  8 x 128kB == 1   mB (max)
    853	 * We could support chaining, but things get ugly(ier:)
    854	 *
    855	 * Set the sge_offset to the start of the sgl (bytes).
    856	 */
    857	sgdir = 0x04000000;		/* IOC will READ from sys mem */
    858	sge_offset = sizeof(MPIHeader_t) + sizeof(FWDownloadTCSGE_t);
    859	if ((sgl = kbuf_alloc_2_sgl(fwlen, sgdir, sge_offset,
    860				    &numfrags, &buflist, &sgl_dma, iocp)) == NULL)
    861		return -ENOMEM;
    862
    863	/*
    864	 * We should only need SGL with 2 simple_32bit entries (up to 256 kB)
    865	 * for FC9xx f/w image, but calculate max number of sge hunks
    866	 * we can fit into a request frame, and limit ourselves to that.
    867	 * (currently no chain support)
    868	 * maxfrags = (Request Size - FWdownload Size ) / Size of 32 bit SGE
    869	 *	Request		maxfrags
    870	 *	128		12
    871	 *	96		8
    872	 *	64		4
    873	 */
    874	maxfrags = (iocp->req_sz - sizeof(MPIHeader_t) -
    875			sizeof(FWDownloadTCSGE_t))
    876			/ iocp->SGE_size;
    877	if (numfrags > maxfrags) {
    878		ret = -EMLINK;
    879		goto fwdl_out;
    880	}
    881
    882	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT "DbG: sgl buffer = %p, sgfrags = %d\n",
    883	    iocp->name, sgl, numfrags));
    884
    885	/*
    886	 * Parse SG list, copying sgl itself,
    887	 * plus f/w image hunks from user space as we go...
    888	 */
    889	ret = -EFAULT;
    890	sgIn = sgl;
    891	bl = buflist;
    892	for (i=0; i < numfrags; i++) {
    893
    894		/* Get the SGE type: 0 - TCSGE, 3 - Chain, 1 - Simple SGE
    895		 * Skip everything but Simple. If simple, copy from
    896		 *	user space into kernel space.
    897		 * Note: we should not have anything but Simple as
    898		 *	Chain SGE are illegal.
    899		 */
    900		nib = (sgIn->FlagsLength & 0x30000000) >> 28;
    901		if (nib == 0 || nib == 3) {
    902			;
    903		} else if (sgIn->Address) {
    904			iocp->add_sge(sgOut, sgIn->FlagsLength, sgIn->Address);
    905			n++;
    906			if (copy_from_user(bl->kptr, ufwbuf+fw_bytes_copied, bl->len)) {
    907				printk(MYIOC_s_ERR_FMT "%s@%d::_ioctl_fwdl - "
    908					"Unable to copy f/w buffer hunk#%d @ %p\n",
    909					iocp->name, __FILE__, __LINE__, n, ufwbuf);
    910				goto fwdl_out;
    911			}
    912			fw_bytes_copied += bl->len;
    913		}
    914		sgIn++;
    915		bl++;
    916		sgOut += iocp->SGE_size;
    917	}
    918
    919	DBG_DUMP_FW_DOWNLOAD(iocp, (u32 *)mf, numfrags);
    920
    921	/*
    922	 * Finally, perform firmware download.
    923	 */
    924	ReplyMsg = NULL;
    925	SET_MGMT_MSG_CONTEXT(iocp->ioctl_cmds.msg_context, dlmsg->MsgContext);
    926	INITIALIZE_MGMT_STATUS(iocp->ioctl_cmds.status)
    927	mpt_put_msg_frame(mptctl_id, iocp, mf);
    928
    929	/* Now wait for the command to complete */
    930retry_wait:
    931	timeleft = wait_for_completion_timeout(&iocp->ioctl_cmds.done, HZ*60);
    932	if (!(iocp->ioctl_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
    933		ret = -ETIME;
    934		printk(MYIOC_s_WARN_FMT "%s: failed\n", iocp->name, __func__);
    935		if (iocp->ioctl_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET) {
    936			mpt_free_msg_frame(iocp, mf);
    937			goto fwdl_out;
    938		}
    939		if (!timeleft) {
    940			printk(MYIOC_s_WARN_FMT
    941			       "FW download timeout, doorbell=0x%08x\n",
    942			       iocp->name, mpt_GetIocState(iocp, 0));
    943			mptctl_timeout_expired(iocp, mf);
    944		} else
    945			goto retry_wait;
    946		goto fwdl_out;
    947	}
    948
    949	if (!(iocp->ioctl_cmds.status & MPT_MGMT_STATUS_RF_VALID)) {
    950		printk(MYIOC_s_WARN_FMT "%s: failed\n", iocp->name, __func__);
    951		mpt_free_msg_frame(iocp, mf);
    952		ret = -ENODATA;
    953		goto fwdl_out;
    954	}
    955
    956	if (sgl)
    957		kfree_sgl(sgl, sgl_dma, buflist, iocp);
    958
    959	ReplyMsg = (pFWDownloadReply_t)iocp->ioctl_cmds.reply;
    960	iocstat = le16_to_cpu(ReplyMsg->IOCStatus) & MPI_IOCSTATUS_MASK;
    961	if (iocstat == MPI_IOCSTATUS_SUCCESS) {
    962		printk(MYIOC_s_INFO_FMT "F/W update successful!\n", iocp->name);
    963		return 0;
    964	} else if (iocstat == MPI_IOCSTATUS_INVALID_FUNCTION) {
    965		printk(MYIOC_s_WARN_FMT "Hmmm...  F/W download not supported!?!\n",
    966			iocp->name);
    967		printk(MYIOC_s_WARN_FMT "(time to go bang on somebodies door)\n",
    968			iocp->name);
    969		return -EBADRQC;
    970	} else if (iocstat == MPI_IOCSTATUS_BUSY) {
    971		printk(MYIOC_s_WARN_FMT "IOC_BUSY!\n", iocp->name);
    972		printk(MYIOC_s_WARN_FMT "(try again later?)\n", iocp->name);
    973		return -EBUSY;
    974	} else {
    975		printk(MYIOC_s_WARN_FMT "ioctl_fwdl() returned [bad] status = %04xh\n",
    976			iocp->name, iocstat);
    977		printk(MYIOC_s_WARN_FMT "(bad VooDoo)\n", iocp->name);
    978		return -ENOMSG;
    979	}
    980	return 0;
    981
    982fwdl_out:
    983
    984	CLEAR_MGMT_STATUS(iocp->ioctl_cmds.status);
    985	SET_MGMT_MSG_CONTEXT(iocp->ioctl_cmds.msg_context, 0);
    986        kfree_sgl(sgl, sgl_dma, buflist, iocp);
    987	return ret;
    988}
    989
    990/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
    991/*
    992 * SGE Allocation routine
    993 *
    994 * Inputs:	bytes - number of bytes to be transferred
    995 *		sgdir - data direction
    996 *		sge_offset - offset (in bytes) from the start of the request
    997 *			frame to the first SGE
    998 *		ioc - pointer to the mptadapter
    999 * Outputs:	frags - number of scatter gather elements
   1000 *		blp - point to the buflist pointer
   1001 *		sglbuf_dma - pointer to the (dma) sgl
   1002 * Returns:	Null if failes
   1003 *		pointer to the (virtual) sgl if successful.
   1004 */
   1005static MptSge_t *
   1006kbuf_alloc_2_sgl(int bytes, u32 sgdir, int sge_offset, int *frags,
   1007		 struct buflist **blp, dma_addr_t *sglbuf_dma, MPT_ADAPTER *ioc)
   1008{
   1009	MptSge_t	*sglbuf = NULL;		/* pointer to array of SGE */
   1010						/* and chain buffers */
   1011	struct buflist	*buflist = NULL;	/* kernel routine */
   1012	MptSge_t	*sgl;
   1013	int		 numfrags = 0;
   1014	int		 fragcnt = 0;
   1015	int		 alloc_sz = min(bytes,MAX_KMALLOC_SZ);	// avoid kernel warning msg!
   1016	int		 bytes_allocd = 0;
   1017	int		 this_alloc;
   1018	dma_addr_t	 pa;					// phys addr
   1019	int		 i, buflist_ent;
   1020	int		 sg_spill = MAX_FRAGS_SPILL1;
   1021	int		 dir;
   1022
   1023	if (bytes < 0)
   1024		return NULL;
   1025
   1026	/* initialization */
   1027	*frags = 0;
   1028	*blp = NULL;
   1029
   1030	/* Allocate and initialize an array of kernel
   1031	 * structures for the SG elements.
   1032	 */
   1033	i = MAX_SGL_BYTES / 8;
   1034	buflist = kzalloc(i, GFP_USER);
   1035	if (!buflist)
   1036		return NULL;
   1037	buflist_ent = 0;
   1038
   1039	/* Allocate a single block of memory to store the sg elements and
   1040	 * the chain buffers.  The calling routine is responsible for
   1041	 * copying the data in this array into the correct place in the
   1042	 * request and chain buffers.
   1043	 */
   1044	sglbuf = dma_alloc_coherent(&ioc->pcidev->dev, MAX_SGL_BYTES,
   1045				    sglbuf_dma, GFP_KERNEL);
   1046	if (sglbuf == NULL)
   1047		goto free_and_fail;
   1048
   1049	if (sgdir & 0x04000000)
   1050		dir = DMA_TO_DEVICE;
   1051	else
   1052		dir = DMA_FROM_DEVICE;
   1053
   1054	/* At start:
   1055	 *	sgl = sglbuf = point to beginning of sg buffer
   1056	 *	buflist_ent = 0 = first kernel structure
   1057	 *	sg_spill = number of SGE that can be written before the first
   1058	 *		chain element.
   1059	 *
   1060	 */
   1061	sgl = sglbuf;
   1062	sg_spill = ((ioc->req_sz - sge_offset)/ioc->SGE_size) - 1;
   1063	while (bytes_allocd < bytes) {
   1064		this_alloc = min(alloc_sz, bytes-bytes_allocd);
   1065		buflist[buflist_ent].len = this_alloc;
   1066		buflist[buflist_ent].kptr = dma_alloc_coherent(&ioc->pcidev->dev,
   1067							       this_alloc,
   1068							       &pa, GFP_KERNEL);
   1069		if (buflist[buflist_ent].kptr == NULL) {
   1070			alloc_sz = alloc_sz / 2;
   1071			if (alloc_sz == 0) {
   1072				printk(MYIOC_s_WARN_FMT "-SG: No can do - "
   1073				    "not enough memory!   :-(\n", ioc->name);
   1074				printk(MYIOC_s_WARN_FMT "-SG: (freeing %d frags)\n",
   1075					ioc->name, numfrags);
   1076				goto free_and_fail;
   1077			}
   1078			continue;
   1079		} else {
   1080			dma_addr_t dma_addr;
   1081
   1082			bytes_allocd += this_alloc;
   1083			sgl->FlagsLength = (0x10000000|sgdir|this_alloc);
   1084			dma_addr = dma_map_single(&ioc->pcidev->dev,
   1085						  buflist[buflist_ent].kptr,
   1086						  this_alloc, dir);
   1087			sgl->Address = dma_addr;
   1088
   1089			fragcnt++;
   1090			numfrags++;
   1091			sgl++;
   1092			buflist_ent++;
   1093		}
   1094
   1095		if (bytes_allocd >= bytes)
   1096			break;
   1097
   1098		/* Need to chain? */
   1099		if (fragcnt == sg_spill) {
   1100			printk(MYIOC_s_WARN_FMT
   1101			    "-SG: No can do - " "Chain required!   :-(\n", ioc->name);
   1102			printk(MYIOC_s_WARN_FMT "(freeing %d frags)\n", ioc->name, numfrags);
   1103			goto free_and_fail;
   1104		}
   1105
   1106		/* overflow check... */
   1107		if (numfrags*8 > MAX_SGL_BYTES){
   1108			/* GRRRRR... */
   1109			printk(MYIOC_s_WARN_FMT "-SG: No can do - "
   1110				"too many SG frags!   :-(\n", ioc->name);
   1111			printk(MYIOC_s_WARN_FMT "-SG: (freeing %d frags)\n",
   1112				ioc->name, numfrags);
   1113			goto free_and_fail;
   1114		}
   1115	}
   1116
   1117	/* Last sge fixup: set LE+eol+eob bits */
   1118	sgl[-1].FlagsLength |= 0xC1000000;
   1119
   1120	*frags = numfrags;
   1121	*blp = buflist;
   1122
   1123	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "-SG: kbuf_alloc_2_sgl() - "
   1124	   "%d SG frags generated!\n", ioc->name, numfrags));
   1125
   1126	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "-SG: kbuf_alloc_2_sgl() - "
   1127	   "last (big) alloc_sz=%d\n", ioc->name, alloc_sz));
   1128
   1129	return sglbuf;
   1130
   1131free_and_fail:
   1132	if (sglbuf != NULL) {
   1133		for (i = 0; i < numfrags; i++) {
   1134			dma_addr_t dma_addr;
   1135			u8 *kptr;
   1136			int len;
   1137
   1138			if ((sglbuf[i].FlagsLength >> 24) == 0x30)
   1139				continue;
   1140
   1141			dma_addr = sglbuf[i].Address;
   1142			kptr = buflist[i].kptr;
   1143			len = buflist[i].len;
   1144
   1145			dma_free_coherent(&ioc->pcidev->dev, len, kptr,
   1146					  dma_addr);
   1147		}
   1148		dma_free_coherent(&ioc->pcidev->dev, MAX_SGL_BYTES, sglbuf,
   1149				  *sglbuf_dma);
   1150	}
   1151	kfree(buflist);
   1152	return NULL;
   1153}
   1154
   1155/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1156/*
   1157 * Routine to free the SGL elements.
   1158 */
   1159static void
   1160kfree_sgl(MptSge_t *sgl, dma_addr_t sgl_dma, struct buflist *buflist, MPT_ADAPTER *ioc)
   1161{
   1162	MptSge_t	*sg = sgl;
   1163	struct buflist	*bl = buflist;
   1164	u32		 nib;
   1165	int		 dir;
   1166	int		 n = 0;
   1167
   1168	if (sg->FlagsLength & 0x04000000)
   1169		dir = DMA_TO_DEVICE;
   1170	else
   1171		dir = DMA_FROM_DEVICE;
   1172
   1173	nib = (sg->FlagsLength & 0xF0000000) >> 28;
   1174	while (! (nib & 0x4)) { /* eob */
   1175		/* skip ignore/chain. */
   1176		if (nib == 0 || nib == 3) {
   1177			;
   1178		} else if (sg->Address) {
   1179			dma_addr_t dma_addr;
   1180			void *kptr;
   1181			int len;
   1182
   1183			dma_addr = sg->Address;
   1184			kptr = bl->kptr;
   1185			len = bl->len;
   1186			dma_unmap_single(&ioc->pcidev->dev, dma_addr, len,
   1187					 dir);
   1188			dma_free_coherent(&ioc->pcidev->dev, len, kptr,
   1189					  dma_addr);
   1190			n++;
   1191		}
   1192		sg++;
   1193		bl++;
   1194		nib = (le32_to_cpu(sg->FlagsLength) & 0xF0000000) >> 28;
   1195	}
   1196
   1197	/* we're at eob! */
   1198	if (sg->Address) {
   1199		dma_addr_t dma_addr;
   1200		void *kptr;
   1201		int len;
   1202
   1203		dma_addr = sg->Address;
   1204		kptr = bl->kptr;
   1205		len = bl->len;
   1206		dma_unmap_single(&ioc->pcidev->dev, dma_addr, len, dir);
   1207		dma_free_coherent(&ioc->pcidev->dev, len, kptr, dma_addr);
   1208		n++;
   1209	}
   1210
   1211	dma_free_coherent(&ioc->pcidev->dev, MAX_SGL_BYTES, sgl, sgl_dma);
   1212	kfree(buflist);
   1213	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "-SG: Free'd 1 SGL buf + %d kbufs!\n",
   1214	    ioc->name, n));
   1215}
   1216
   1217/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1218/*
   1219 *	mptctl_getiocinfo - Query the host adapter for IOC information.
   1220 *	@arg: User space argument
   1221 *
   1222 * Outputs:	None.
   1223 * Return:	0 if successful
   1224 *		-EFAULT if data unavailable
   1225 *		-ENODEV  if no such device/adapter
   1226 */
   1227static int
   1228mptctl_getiocinfo (MPT_ADAPTER *ioc, unsigned long arg, unsigned int data_size)
   1229{
   1230	struct mpt_ioctl_iocinfo __user *uarg = (void __user *) arg;
   1231	struct mpt_ioctl_iocinfo *karg;
   1232	struct pci_dev		*pdev;
   1233	unsigned int		port;
   1234	int			cim_rev;
   1235	struct scsi_device 	*sdev;
   1236	VirtDevice		*vdevice;
   1237
   1238	/* Add of PCI INFO results in unaligned access for
   1239	 * IA64 and Sparc. Reset long to int. Return no PCI
   1240	 * data for obsolete format.
   1241	 */
   1242	if (data_size == sizeof(struct mpt_ioctl_iocinfo_rev0))
   1243		cim_rev = 0;
   1244	else if (data_size == sizeof(struct mpt_ioctl_iocinfo_rev1))
   1245		cim_rev = 1;
   1246	else if (data_size == sizeof(struct mpt_ioctl_iocinfo))
   1247		cim_rev = 2;
   1248	else if (data_size == (sizeof(struct mpt_ioctl_iocinfo_rev0)+12))
   1249		cim_rev = 0;	/* obsolete */
   1250	else
   1251		return -EFAULT;
   1252
   1253	karg = memdup_user(uarg, data_size);
   1254	if (IS_ERR(karg)) {
   1255		printk(KERN_ERR MYNAM "%s@%d::mpt_ioctl_iocinfo() - memdup_user returned error [%ld]\n",
   1256				__FILE__, __LINE__, PTR_ERR(karg));
   1257		return PTR_ERR(karg);
   1258	}
   1259
   1260	/* Verify the data transfer size is correct. */
   1261	if (karg->hdr.maxDataSize != data_size) {
   1262		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_getiocinfo - "
   1263			"Structure size mismatch. Command not completed.\n",
   1264			ioc->name, __FILE__, __LINE__);
   1265		kfree(karg);
   1266		return -EFAULT;
   1267	}
   1268
   1269	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_getiocinfo called.\n",
   1270	    ioc->name));
   1271
   1272	/* Fill in the data and return the structure to the calling
   1273	 * program
   1274	 */
   1275	if (ioc->bus_type == SAS)
   1276		karg->adapterType = MPT_IOCTL_INTERFACE_SAS;
   1277	else if (ioc->bus_type == FC)
   1278		karg->adapterType = MPT_IOCTL_INTERFACE_FC;
   1279	else
   1280		karg->adapterType = MPT_IOCTL_INTERFACE_SCSI;
   1281
   1282	if (karg->hdr.port > 1) {
   1283		kfree(karg);
   1284		return -EINVAL;
   1285	}
   1286	port = karg->hdr.port;
   1287
   1288	karg->port = port;
   1289	pdev = (struct pci_dev *) ioc->pcidev;
   1290
   1291	karg->pciId = pdev->device;
   1292	karg->hwRev = pdev->revision;
   1293	karg->subSystemDevice = pdev->subsystem_device;
   1294	karg->subSystemVendor = pdev->subsystem_vendor;
   1295
   1296	if (cim_rev == 1) {
   1297		/* Get the PCI bus, device, and function numbers for the IOC
   1298		 */
   1299		karg->pciInfo.u.bits.busNumber = pdev->bus->number;
   1300		karg->pciInfo.u.bits.deviceNumber = PCI_SLOT( pdev->devfn );
   1301		karg->pciInfo.u.bits.functionNumber = PCI_FUNC( pdev->devfn );
   1302	} else if (cim_rev == 2) {
   1303		/* Get the PCI bus, device, function and segment ID numbers
   1304		   for the IOC */
   1305		karg->pciInfo.u.bits.busNumber = pdev->bus->number;
   1306		karg->pciInfo.u.bits.deviceNumber = PCI_SLOT( pdev->devfn );
   1307		karg->pciInfo.u.bits.functionNumber = PCI_FUNC( pdev->devfn );
   1308		karg->pciInfo.segmentID = pci_domain_nr(pdev->bus);
   1309	}
   1310
   1311	/* Get number of devices
   1312         */
   1313	karg->numDevices = 0;
   1314	if (ioc->sh) {
   1315		shost_for_each_device(sdev, ioc->sh) {
   1316			vdevice = sdev->hostdata;
   1317			if (vdevice == NULL || vdevice->vtarget == NULL)
   1318				continue;
   1319			if (vdevice->vtarget->tflags &
   1320			    MPT_TARGET_FLAGS_RAID_COMPONENT)
   1321				continue;
   1322			karg->numDevices++;
   1323		}
   1324	}
   1325
   1326	/* Set the BIOS and FW Version
   1327	 */
   1328	karg->FWVersion = ioc->facts.FWVersion.Word;
   1329	karg->BIOSVersion = ioc->biosVersion;
   1330
   1331	/* Set the Version Strings.
   1332	 */
   1333	strncpy (karg->driverVersion, MPT_LINUX_PACKAGE_NAME, MPT_IOCTL_VERSION_LENGTH);
   1334	karg->driverVersion[MPT_IOCTL_VERSION_LENGTH-1]='\0';
   1335
   1336	karg->busChangeEvent = 0;
   1337	karg->hostId = ioc->pfacts[port].PortSCSIID;
   1338	karg->rsvd[0] = karg->rsvd[1] = 0;
   1339
   1340	/* Copy the data from kernel memory to user memory
   1341	 */
   1342	if (copy_to_user((char __user *)arg, karg, data_size)) {
   1343		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_getiocinfo - "
   1344			"Unable to write out mpt_ioctl_iocinfo struct @ %p\n",
   1345			ioc->name, __FILE__, __LINE__, uarg);
   1346		kfree(karg);
   1347		return -EFAULT;
   1348	}
   1349
   1350	kfree(karg);
   1351	return 0;
   1352}
   1353
   1354/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1355/*
   1356 *	mptctl_gettargetinfo - Query the host adapter for target information.
   1357 *	@arg: User space argument
   1358 *
   1359 * Outputs:	None.
   1360 * Return:	0 if successful
   1361 *		-EFAULT if data unavailable
   1362 *		-ENODEV  if no such device/adapter
   1363 */
   1364static int
   1365mptctl_gettargetinfo (MPT_ADAPTER *ioc, unsigned long arg)
   1366{
   1367	struct mpt_ioctl_targetinfo __user *uarg = (void __user *) arg;
   1368	struct mpt_ioctl_targetinfo karg;
   1369	VirtDevice		*vdevice;
   1370	char			*pmem;
   1371	int			*pdata;
   1372	int			numDevices = 0;
   1373	int			lun;
   1374	int			maxWordsLeft;
   1375	int			numBytes;
   1376	struct scsi_device 	*sdev;
   1377
   1378	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_targetinfo))) {
   1379		printk(KERN_ERR MYNAM "%s@%d::mptctl_gettargetinfo - "
   1380			"Unable to read in mpt_ioctl_targetinfo struct @ %p\n",
   1381				__FILE__, __LINE__, uarg);
   1382		return -EFAULT;
   1383	}
   1384
   1385	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_gettargetinfo called.\n",
   1386	    ioc->name));
   1387	numBytes = karg.hdr.maxDataSize - sizeof(mpt_ioctl_header);
   1388	maxWordsLeft = numBytes/sizeof(int);
   1389
   1390	if (maxWordsLeft <= 0) {
   1391		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_gettargetinfo() - no memory available!\n",
   1392			ioc->name, __FILE__, __LINE__);
   1393		return -ENOMEM;
   1394	}
   1395
   1396	/* Fill in the data and return the structure to the calling
   1397	 * program
   1398	 */
   1399
   1400	/* struct mpt_ioctl_targetinfo does not contain sufficient space
   1401	 * for the target structures so when the IOCTL is called, there is
   1402	 * not sufficient stack space for the structure. Allocate memory,
   1403	 * populate the memory, copy back to the user, then free memory.
   1404	 * targetInfo format:
   1405	 * bits 31-24: reserved
   1406	 *      23-16: LUN
   1407	 *      15- 8: Bus Number
   1408	 *       7- 0: Target ID
   1409	 */
   1410	pmem = kzalloc(numBytes, GFP_KERNEL);
   1411	if (!pmem) {
   1412		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_gettargetinfo() - no memory available!\n",
   1413			ioc->name, __FILE__, __LINE__);
   1414		return -ENOMEM;
   1415	}
   1416	pdata =  (int *) pmem;
   1417
   1418	/* Get number of devices
   1419         */
   1420	if (ioc->sh){
   1421		shost_for_each_device(sdev, ioc->sh) {
   1422			if (!maxWordsLeft)
   1423				continue;
   1424			vdevice = sdev->hostdata;
   1425			if (vdevice == NULL || vdevice->vtarget == NULL)
   1426				continue;
   1427			if (vdevice->vtarget->tflags &
   1428			    MPT_TARGET_FLAGS_RAID_COMPONENT)
   1429				continue;
   1430			lun = (vdevice->vtarget->raidVolume) ? 0x80 : vdevice->lun;
   1431			*pdata = (((u8)lun << 16) + (vdevice->vtarget->channel << 8) +
   1432			    (vdevice->vtarget->id ));
   1433			pdata++;
   1434			numDevices++;
   1435			--maxWordsLeft;
   1436		}
   1437	}
   1438	karg.numDevices = numDevices;
   1439
   1440	/* Copy part of the data from kernel memory to user memory
   1441	 */
   1442	if (copy_to_user((char __user *)arg, &karg,
   1443				sizeof(struct mpt_ioctl_targetinfo))) {
   1444		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_gettargetinfo - "
   1445			"Unable to write out mpt_ioctl_targetinfo struct @ %p\n",
   1446			ioc->name, __FILE__, __LINE__, uarg);
   1447		kfree(pmem);
   1448		return -EFAULT;
   1449	}
   1450
   1451	/* Copy the remaining data from kernel memory to user memory
   1452	 */
   1453	if (copy_to_user(uarg->targetInfo, pmem, numBytes)) {
   1454		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_gettargetinfo - "
   1455			"Unable to write out mpt_ioctl_targetinfo struct @ %p\n",
   1456			ioc->name, __FILE__, __LINE__, pdata);
   1457		kfree(pmem);
   1458		return -EFAULT;
   1459	}
   1460
   1461	kfree(pmem);
   1462
   1463	return 0;
   1464}
   1465
   1466/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1467/* MPT IOCTL Test function.
   1468 *
   1469 * Outputs:	None.
   1470 * Return:	0 if successful
   1471 *		-EFAULT if data unavailable
   1472 *		-ENODEV  if no such device/adapter
   1473 */
   1474static int
   1475mptctl_readtest (MPT_ADAPTER *ioc, unsigned long arg)
   1476{
   1477	struct mpt_ioctl_test __user *uarg = (void __user *) arg;
   1478	struct mpt_ioctl_test	 karg;
   1479
   1480	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_test))) {
   1481		printk(KERN_ERR MYNAM "%s@%d::mptctl_readtest - "
   1482			"Unable to read in mpt_ioctl_test struct @ %p\n",
   1483				__FILE__, __LINE__, uarg);
   1484		return -EFAULT;
   1485	}
   1486
   1487	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_readtest called.\n",
   1488	    ioc->name));
   1489	/* Fill in the data and return the structure to the calling
   1490	 * program
   1491	 */
   1492
   1493#ifdef MFCNT
   1494	karg.chip_type = ioc->mfcnt;
   1495#else
   1496	karg.chip_type = ioc->pcidev->device;
   1497#endif
   1498	strncpy (karg.name, ioc->name, MPT_MAX_NAME);
   1499	karg.name[MPT_MAX_NAME-1]='\0';
   1500	strncpy (karg.product, ioc->prod_name, MPT_PRODUCT_LENGTH);
   1501	karg.product[MPT_PRODUCT_LENGTH-1]='\0';
   1502
   1503	/* Copy the data from kernel memory to user memory
   1504	 */
   1505	if (copy_to_user((char __user *)arg, &karg, sizeof(struct mpt_ioctl_test))) {
   1506		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_readtest - "
   1507			"Unable to write out mpt_ioctl_test struct @ %p\n",
   1508			ioc->name, __FILE__, __LINE__, uarg);
   1509		return -EFAULT;
   1510	}
   1511
   1512	return 0;
   1513}
   1514
   1515/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1516/*
   1517 *	mptctl_eventquery - Query the host adapter for the event types
   1518 *	that are being logged.
   1519 *	@arg: User space argument
   1520 *
   1521 * Outputs:	None.
   1522 * Return:	0 if successful
   1523 *		-EFAULT if data unavailable
   1524 *		-ENODEV  if no such device/adapter
   1525 */
   1526static int
   1527mptctl_eventquery (MPT_ADAPTER *ioc, unsigned long arg)
   1528{
   1529	struct mpt_ioctl_eventquery __user *uarg = (void __user *) arg;
   1530	struct mpt_ioctl_eventquery	 karg;
   1531
   1532	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_eventquery))) {
   1533		printk(KERN_ERR MYNAM "%s@%d::mptctl_eventquery - "
   1534			"Unable to read in mpt_ioctl_eventquery struct @ %p\n",
   1535				__FILE__, __LINE__, uarg);
   1536		return -EFAULT;
   1537	}
   1538
   1539	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_eventquery called.\n",
   1540	    ioc->name));
   1541	karg.eventEntries = MPTCTL_EVENT_LOG_SIZE;
   1542	karg.eventTypes = ioc->eventTypes;
   1543
   1544	/* Copy the data from kernel memory to user memory
   1545	 */
   1546	if (copy_to_user((char __user *)arg, &karg, sizeof(struct mpt_ioctl_eventquery))) {
   1547		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_eventquery - "
   1548			"Unable to write out mpt_ioctl_eventquery struct @ %p\n",
   1549			ioc->name, __FILE__, __LINE__, uarg);
   1550		return -EFAULT;
   1551	}
   1552	return 0;
   1553}
   1554
   1555/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1556static int
   1557mptctl_eventenable (MPT_ADAPTER *ioc, unsigned long arg)
   1558{
   1559	struct mpt_ioctl_eventenable __user *uarg = (void __user *) arg;
   1560	struct mpt_ioctl_eventenable	 karg;
   1561
   1562	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_eventenable))) {
   1563		printk(KERN_ERR MYNAM "%s@%d::mptctl_eventenable - "
   1564			"Unable to read in mpt_ioctl_eventenable struct @ %p\n",
   1565				__FILE__, __LINE__, uarg);
   1566		return -EFAULT;
   1567	}
   1568
   1569	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_eventenable called.\n",
   1570	    ioc->name));
   1571	if (ioc->events == NULL) {
   1572		/* Have not yet allocated memory - do so now.
   1573		 */
   1574		int sz = MPTCTL_EVENT_LOG_SIZE * sizeof(MPT_IOCTL_EVENTS);
   1575		ioc->events = kzalloc(sz, GFP_KERNEL);
   1576		if (!ioc->events) {
   1577			printk(MYIOC_s_ERR_FMT
   1578			    ": ERROR - Insufficient memory to add adapter!\n",
   1579			    ioc->name);
   1580			return -ENOMEM;
   1581		}
   1582		ioc->alloc_total += sz;
   1583
   1584		ioc->eventContext = 0;
   1585        }
   1586
   1587	/* Update the IOC event logging flag.
   1588	 */
   1589	ioc->eventTypes = karg.eventTypes;
   1590
   1591	return 0;
   1592}
   1593
   1594/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1595static int
   1596mptctl_eventreport (MPT_ADAPTER *ioc, unsigned long arg)
   1597{
   1598	struct mpt_ioctl_eventreport __user *uarg = (void __user *) arg;
   1599	struct mpt_ioctl_eventreport	 karg;
   1600	int			 numBytes, maxEvents, max;
   1601
   1602	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_eventreport))) {
   1603		printk(KERN_ERR MYNAM "%s@%d::mptctl_eventreport - "
   1604			"Unable to read in mpt_ioctl_eventreport struct @ %p\n",
   1605				__FILE__, __LINE__, uarg);
   1606		return -EFAULT;
   1607	}
   1608
   1609	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_eventreport called.\n",
   1610	    ioc->name));
   1611
   1612	numBytes = karg.hdr.maxDataSize - sizeof(mpt_ioctl_header);
   1613	maxEvents = numBytes/sizeof(MPT_IOCTL_EVENTS);
   1614
   1615
   1616	max = MPTCTL_EVENT_LOG_SIZE < maxEvents ? MPTCTL_EVENT_LOG_SIZE : maxEvents;
   1617
   1618	/* If fewer than 1 event is requested, there must have
   1619	 * been some type of error.
   1620	 */
   1621	if ((max < 1) || !ioc->events)
   1622		return -ENODATA;
   1623
   1624	/* reset this flag so SIGIO can restart */
   1625	ioc->aen_event_read_flag=0;
   1626
   1627	/* Copy the data from kernel memory to user memory
   1628	 */
   1629	numBytes = max * sizeof(MPT_IOCTL_EVENTS);
   1630	if (copy_to_user(uarg->eventData, ioc->events, numBytes)) {
   1631		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_eventreport - "
   1632			"Unable to write out mpt_ioctl_eventreport struct @ %p\n",
   1633			ioc->name, __FILE__, __LINE__, ioc->events);
   1634		return -EFAULT;
   1635	}
   1636
   1637	return 0;
   1638}
   1639
   1640/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1641static int
   1642mptctl_replace_fw (MPT_ADAPTER *ioc, unsigned long arg)
   1643{
   1644	struct mpt_ioctl_replace_fw __user *uarg = (void __user *) arg;
   1645	struct mpt_ioctl_replace_fw	 karg;
   1646	int			 newFwSize;
   1647
   1648	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_replace_fw))) {
   1649		printk(KERN_ERR MYNAM "%s@%d::mptctl_replace_fw - "
   1650			"Unable to read in mpt_ioctl_replace_fw struct @ %p\n",
   1651				__FILE__, __LINE__, uarg);
   1652		return -EFAULT;
   1653	}
   1654
   1655	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_replace_fw called.\n",
   1656	    ioc->name));
   1657	/* If caching FW, Free the old FW image
   1658	 */
   1659	if (ioc->cached_fw == NULL)
   1660		return 0;
   1661
   1662	mpt_free_fw_memory(ioc);
   1663
   1664	/* Allocate memory for the new FW image
   1665	 */
   1666	newFwSize = ALIGN(karg.newImageSize, 4);
   1667
   1668	mpt_alloc_fw_memory(ioc, newFwSize);
   1669	if (ioc->cached_fw == NULL)
   1670		return -ENOMEM;
   1671
   1672	/* Copy the data from user memory to kernel space
   1673	 */
   1674	if (copy_from_user(ioc->cached_fw, uarg->newImage, newFwSize)) {
   1675		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_replace_fw - "
   1676				"Unable to read in mpt_ioctl_replace_fw image "
   1677				"@ %p\n", ioc->name, __FILE__, __LINE__, uarg);
   1678		mpt_free_fw_memory(ioc);
   1679		return -EFAULT;
   1680	}
   1681
   1682	/* Update IOCFactsReply
   1683	 */
   1684	ioc->facts.FWImageSize = newFwSize;
   1685	return 0;
   1686}
   1687
   1688/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1689/* MPT IOCTL MPTCOMMAND function.
   1690 * Cast the arg into the mpt_ioctl_mpt_command structure.
   1691 *
   1692 * Outputs:	None.
   1693 * Return:	0 if successful
   1694 *		-EBUSY  if previous command timeout and IOC reset is not complete.
   1695 *		-EFAULT if data unavailable
   1696 *		-ENODEV if no such device/adapter
   1697 *		-ETIME	if timer expires
   1698 *		-ENOMEM if memory allocation error
   1699 */
   1700static int
   1701mptctl_mpt_command (MPT_ADAPTER *ioc, unsigned long arg)
   1702{
   1703	struct mpt_ioctl_command __user *uarg = (void __user *) arg;
   1704	struct mpt_ioctl_command  karg;
   1705	int		rc;
   1706
   1707
   1708	if (copy_from_user(&karg, uarg, sizeof(struct mpt_ioctl_command))) {
   1709		printk(KERN_ERR MYNAM "%s@%d::mptctl_mpt_command - "
   1710			"Unable to read in mpt_ioctl_command struct @ %p\n",
   1711				__FILE__, __LINE__, uarg);
   1712		return -EFAULT;
   1713	}
   1714
   1715	rc = mptctl_do_mpt_command (ioc, karg, &uarg->MF);
   1716
   1717	return rc;
   1718}
   1719
   1720/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   1721/* Worker routine for the IOCTL MPTCOMMAND and MPTCOMMAND32 (sparc) commands.
   1722 *
   1723 * Outputs:	None.
   1724 * Return:	0 if successful
   1725 *		-EBUSY  if previous command timeout and IOC reset is not complete.
   1726 *		-EFAULT if data unavailable
   1727 *		-ENODEV if no such device/adapter
   1728 *		-ETIME	if timer expires
   1729 *		-ENOMEM if memory allocation error
   1730 *		-EPERM if SCSI I/O and target is untagged
   1731 */
   1732static int
   1733mptctl_do_mpt_command (MPT_ADAPTER *ioc, struct mpt_ioctl_command karg, void __user *mfPtr)
   1734{
   1735	MPT_FRAME_HDR	*mf = NULL;
   1736	MPIHeader_t	*hdr;
   1737	char		*psge;
   1738	struct buflist	bufIn;	/* data In buffer */
   1739	struct buflist	bufOut; /* data Out buffer */
   1740	dma_addr_t	dma_addr_in;
   1741	dma_addr_t	dma_addr_out;
   1742	int		sgSize = 0;	/* Num SG elements */
   1743	int		flagsLength;
   1744	int		sz, rc = 0;
   1745	int		msgContext;
   1746	u16		req_idx;
   1747	ulong 		timeout;
   1748	unsigned long	timeleft;
   1749	struct scsi_device *sdev;
   1750	unsigned long	 flags;
   1751	u8		 function;
   1752
   1753	/* bufIn and bufOut are used for user to kernel space transfers
   1754	 */
   1755	bufIn.kptr = bufOut.kptr = NULL;
   1756	bufIn.len = bufOut.len = 0;
   1757
   1758	spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
   1759	if (ioc->ioc_reset_in_progress) {
   1760		spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
   1761		printk(KERN_ERR MYNAM "%s@%d::mptctl_do_mpt_command - "
   1762			"Busy with diagnostic reset\n", __FILE__, __LINE__);
   1763		return -EBUSY;
   1764	}
   1765	spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
   1766
   1767	/* Basic sanity checks to prevent underflows or integer overflows */
   1768	if (karg.maxReplyBytes < 0 ||
   1769	    karg.dataInSize < 0 ||
   1770	    karg.dataOutSize < 0 ||
   1771	    karg.dataSgeOffset < 0 ||
   1772	    karg.maxSenseBytes < 0 ||
   1773	    karg.dataSgeOffset > ioc->req_sz / 4)
   1774		return -EINVAL;
   1775
   1776	/* Verify that the final request frame will not be too large.
   1777	 */
   1778	sz = karg.dataSgeOffset * 4;
   1779	if (karg.dataInSize > 0)
   1780		sz += ioc->SGE_size;
   1781	if (karg.dataOutSize > 0)
   1782		sz += ioc->SGE_size;
   1783
   1784	if (sz > ioc->req_sz) {
   1785		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   1786			"Request frame too large (%d) maximum (%d)\n",
   1787			ioc->name, __FILE__, __LINE__, sz, ioc->req_sz);
   1788		return -EFAULT;
   1789	}
   1790
   1791	/* Get a free request frame and save the message context.
   1792	 */
   1793        if ((mf = mpt_get_msg_frame(mptctl_id, ioc)) == NULL)
   1794                return -EAGAIN;
   1795
   1796	hdr = (MPIHeader_t *) mf;
   1797	msgContext = le32_to_cpu(hdr->MsgContext);
   1798	req_idx = le16_to_cpu(mf->u.frame.hwhdr.msgctxu.fld.req_idx);
   1799
   1800	/* Copy the request frame
   1801	 * Reset the saved message context.
   1802	 * Request frame in user space
   1803	 */
   1804	if (copy_from_user(mf, mfPtr, karg.dataSgeOffset * 4)) {
   1805		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   1806			"Unable to read MF from mpt_ioctl_command struct @ %p\n",
   1807			ioc->name, __FILE__, __LINE__, mfPtr);
   1808		function = -1;
   1809		rc = -EFAULT;
   1810		goto done_free_mem;
   1811	}
   1812	hdr->MsgContext = cpu_to_le32(msgContext);
   1813	function = hdr->Function;
   1814
   1815
   1816	/* Verify that this request is allowed.
   1817	 */
   1818	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "sending mpi function (0x%02X), req=%p\n",
   1819	    ioc->name, hdr->Function, mf));
   1820
   1821	switch (function) {
   1822	case MPI_FUNCTION_IOC_FACTS:
   1823	case MPI_FUNCTION_PORT_FACTS:
   1824		karg.dataOutSize  = karg.dataInSize = 0;
   1825		break;
   1826
   1827	case MPI_FUNCTION_CONFIG:
   1828	{
   1829		Config_t *config_frame;
   1830		config_frame = (Config_t *)mf;
   1831		dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\ttype=0x%02x ext_type=0x%02x "
   1832		    "number=0x%02x action=0x%02x\n", ioc->name,
   1833		    config_frame->Header.PageType,
   1834		    config_frame->ExtPageType,
   1835		    config_frame->Header.PageNumber,
   1836		    config_frame->Action));
   1837		break;
   1838	}
   1839
   1840	case MPI_FUNCTION_FC_COMMON_TRANSPORT_SEND:
   1841	case MPI_FUNCTION_FC_EX_LINK_SRVC_SEND:
   1842	case MPI_FUNCTION_FW_UPLOAD:
   1843	case MPI_FUNCTION_SCSI_ENCLOSURE_PROCESSOR:
   1844	case MPI_FUNCTION_FW_DOWNLOAD:
   1845	case MPI_FUNCTION_FC_PRIMITIVE_SEND:
   1846	case MPI_FUNCTION_TOOLBOX:
   1847	case MPI_FUNCTION_SAS_IO_UNIT_CONTROL:
   1848		break;
   1849
   1850	case MPI_FUNCTION_SCSI_IO_REQUEST:
   1851		if (ioc->sh) {
   1852			SCSIIORequest_t *pScsiReq = (SCSIIORequest_t *) mf;
   1853			int qtag = MPI_SCSIIO_CONTROL_UNTAGGED;
   1854			int scsidir = 0;
   1855			int dataSize;
   1856			u32 id;
   1857
   1858			id = (ioc->devices_per_bus == 0) ? 256 : ioc->devices_per_bus;
   1859			if (pScsiReq->TargetID > id) {
   1860				printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   1861					"Target ID out of bounds. \n",
   1862					ioc->name, __FILE__, __LINE__);
   1863				rc = -ENODEV;
   1864				goto done_free_mem;
   1865			}
   1866
   1867			if (pScsiReq->Bus >= ioc->number_of_buses) {
   1868				printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   1869					"Target Bus out of bounds. \n",
   1870					ioc->name, __FILE__, __LINE__);
   1871				rc = -ENODEV;
   1872				goto done_free_mem;
   1873			}
   1874
   1875			pScsiReq->MsgFlags &= ~MPI_SCSIIO_MSGFLGS_SENSE_WIDTH;
   1876			pScsiReq->MsgFlags |= mpt_msg_flags(ioc);
   1877
   1878
   1879			/* verify that app has not requested
   1880			 *	more sense data than driver
   1881			 *	can provide, if so, reset this parameter
   1882			 * set the sense buffer pointer low address
   1883			 * update the control field to specify Q type
   1884			 */
   1885			if (karg.maxSenseBytes > MPT_SENSE_BUFFER_SIZE)
   1886				pScsiReq->SenseBufferLength = MPT_SENSE_BUFFER_SIZE;
   1887			else
   1888				pScsiReq->SenseBufferLength = karg.maxSenseBytes;
   1889
   1890			pScsiReq->SenseBufferLowAddr =
   1891				cpu_to_le32(ioc->sense_buf_low_dma
   1892				   + (req_idx * MPT_SENSE_BUFFER_ALLOC));
   1893
   1894			shost_for_each_device(sdev, ioc->sh) {
   1895				struct scsi_target *starget = scsi_target(sdev);
   1896				VirtTarget *vtarget = starget->hostdata;
   1897
   1898				if (vtarget == NULL)
   1899					continue;
   1900
   1901				if ((pScsiReq->TargetID == vtarget->id) &&
   1902				    (pScsiReq->Bus == vtarget->channel) &&
   1903				    (vtarget->tflags & MPT_TARGET_FLAGS_Q_YES))
   1904					qtag = MPI_SCSIIO_CONTROL_SIMPLEQ;
   1905			}
   1906
   1907			/* Have the IOCTL driver set the direction based
   1908			 * on the dataOutSize (ordering issue with Sparc).
   1909			 */
   1910			if (karg.dataOutSize > 0) {
   1911				scsidir = MPI_SCSIIO_CONTROL_WRITE;
   1912				dataSize = karg.dataOutSize;
   1913			} else {
   1914				scsidir = MPI_SCSIIO_CONTROL_READ;
   1915				dataSize = karg.dataInSize;
   1916			}
   1917
   1918			pScsiReq->Control = cpu_to_le32(scsidir | qtag);
   1919			pScsiReq->DataLength = cpu_to_le32(dataSize);
   1920
   1921
   1922		} else {
   1923			printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   1924				"SCSI driver is not loaded. \n",
   1925				ioc->name, __FILE__, __LINE__);
   1926			rc = -EFAULT;
   1927			goto done_free_mem;
   1928		}
   1929		break;
   1930
   1931	case MPI_FUNCTION_SMP_PASSTHROUGH:
   1932		/* Check mf->PassthruFlags to determine if
   1933		 * transfer is ImmediateMode or not.
   1934		 * Immediate mode returns data in the ReplyFrame.
   1935		 * Else, we are sending request and response data
   1936		 * in two SGLs at the end of the mf.
   1937		 */
   1938		break;
   1939
   1940	case MPI_FUNCTION_SATA_PASSTHROUGH:
   1941		if (!ioc->sh) {
   1942			printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   1943				"SCSI driver is not loaded. \n",
   1944				ioc->name, __FILE__, __LINE__);
   1945			rc = -EFAULT;
   1946			goto done_free_mem;
   1947		}
   1948		break;
   1949
   1950	case MPI_FUNCTION_RAID_ACTION:
   1951		/* Just add a SGE
   1952		 */
   1953		break;
   1954
   1955	case MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH:
   1956		if (ioc->sh) {
   1957			SCSIIORequest_t *pScsiReq = (SCSIIORequest_t *) mf;
   1958			int qtag = MPI_SCSIIO_CONTROL_SIMPLEQ;
   1959			int scsidir = MPI_SCSIIO_CONTROL_READ;
   1960			int dataSize;
   1961
   1962			pScsiReq->MsgFlags &= ~MPI_SCSIIO_MSGFLGS_SENSE_WIDTH;
   1963			pScsiReq->MsgFlags |= mpt_msg_flags(ioc);
   1964
   1965
   1966			/* verify that app has not requested
   1967			 *	more sense data than driver
   1968			 *	can provide, if so, reset this parameter
   1969			 * set the sense buffer pointer low address
   1970			 * update the control field to specify Q type
   1971			 */
   1972			if (karg.maxSenseBytes > MPT_SENSE_BUFFER_SIZE)
   1973				pScsiReq->SenseBufferLength = MPT_SENSE_BUFFER_SIZE;
   1974			else
   1975				pScsiReq->SenseBufferLength = karg.maxSenseBytes;
   1976
   1977			pScsiReq->SenseBufferLowAddr =
   1978				cpu_to_le32(ioc->sense_buf_low_dma
   1979				   + (req_idx * MPT_SENSE_BUFFER_ALLOC));
   1980
   1981			/* All commands to physical devices are tagged
   1982			 */
   1983
   1984			/* Have the IOCTL driver set the direction based
   1985			 * on the dataOutSize (ordering issue with Sparc).
   1986			 */
   1987			if (karg.dataOutSize > 0) {
   1988				scsidir = MPI_SCSIIO_CONTROL_WRITE;
   1989				dataSize = karg.dataOutSize;
   1990			} else {
   1991				scsidir = MPI_SCSIIO_CONTROL_READ;
   1992				dataSize = karg.dataInSize;
   1993			}
   1994
   1995			pScsiReq->Control = cpu_to_le32(scsidir | qtag);
   1996			pScsiReq->DataLength = cpu_to_le32(dataSize);
   1997
   1998		} else {
   1999			printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   2000				"SCSI driver is not loaded. \n",
   2001				ioc->name, __FILE__, __LINE__);
   2002			rc = -EFAULT;
   2003			goto done_free_mem;
   2004		}
   2005		break;
   2006
   2007	case MPI_FUNCTION_SCSI_TASK_MGMT:
   2008	{
   2009		SCSITaskMgmt_t	*pScsiTm;
   2010		pScsiTm = (SCSITaskMgmt_t *)mf;
   2011		dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT
   2012			"\tTaskType=0x%x MsgFlags=0x%x "
   2013			"TaskMsgContext=0x%x id=%d channel=%d\n",
   2014			ioc->name, pScsiTm->TaskType, le32_to_cpu
   2015			(pScsiTm->TaskMsgContext), pScsiTm->MsgFlags,
   2016			pScsiTm->TargetID, pScsiTm->Bus));
   2017		break;
   2018	}
   2019
   2020	case MPI_FUNCTION_IOC_INIT:
   2021		{
   2022			IOCInit_t	*pInit = (IOCInit_t *) mf;
   2023			u32		high_addr, sense_high;
   2024
   2025			/* Verify that all entries in the IOC INIT match
   2026			 * existing setup (and in LE format).
   2027			 */
   2028			if (sizeof(dma_addr_t) == sizeof(u64)) {
   2029				high_addr = cpu_to_le32((u32)((u64)ioc->req_frames_dma >> 32));
   2030				sense_high= cpu_to_le32((u32)((u64)ioc->sense_buf_pool_dma >> 32));
   2031			} else {
   2032				high_addr = 0;
   2033				sense_high= 0;
   2034			}
   2035
   2036			if ((pInit->Flags != 0) || (pInit->MaxDevices != ioc->facts.MaxDevices) ||
   2037				(pInit->MaxBuses != ioc->facts.MaxBuses) ||
   2038				(pInit->ReplyFrameSize != cpu_to_le16(ioc->reply_sz)) ||
   2039				(pInit->HostMfaHighAddr != high_addr) ||
   2040				(pInit->SenseBufferHighAddr != sense_high)) {
   2041				printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   2042					"IOC_INIT issued with 1 or more incorrect parameters. Rejected.\n",
   2043					ioc->name, __FILE__, __LINE__);
   2044				rc = -EFAULT;
   2045				goto done_free_mem;
   2046			}
   2047		}
   2048		break;
   2049	default:
   2050		/*
   2051		 * MPI_FUNCTION_PORT_ENABLE
   2052		 * MPI_FUNCTION_TARGET_CMD_BUFFER_POST
   2053		 * MPI_FUNCTION_TARGET_ASSIST
   2054		 * MPI_FUNCTION_TARGET_STATUS_SEND
   2055		 * MPI_FUNCTION_TARGET_MODE_ABORT
   2056		 * MPI_FUNCTION_IOC_MESSAGE_UNIT_RESET
   2057		 * MPI_FUNCTION_IO_UNIT_RESET
   2058		 * MPI_FUNCTION_HANDSHAKE
   2059		 * MPI_FUNCTION_REPLY_FRAME_REMOVAL
   2060		 * MPI_FUNCTION_EVENT_NOTIFICATION
   2061		 *  (driver handles event notification)
   2062		 * MPI_FUNCTION_EVENT_ACK
   2063		 */
   2064
   2065		/*  What to do with these???  CHECK ME!!!
   2066			MPI_FUNCTION_FC_LINK_SRVC_BUF_POST
   2067			MPI_FUNCTION_FC_LINK_SRVC_RSP
   2068			MPI_FUNCTION_FC_ABORT
   2069			MPI_FUNCTION_LAN_SEND
   2070			MPI_FUNCTION_LAN_RECEIVE
   2071		 	MPI_FUNCTION_LAN_RESET
   2072		*/
   2073
   2074		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   2075			"Illegal request (function 0x%x) \n",
   2076			ioc->name, __FILE__, __LINE__, hdr->Function);
   2077		rc = -EFAULT;
   2078		goto done_free_mem;
   2079	}
   2080
   2081	/* Add the SGL ( at most one data in SGE and one data out SGE )
   2082	 * In the case of two SGE's - the data out (write) will always
   2083	 * preceede the data in (read) SGE. psgList is used to free the
   2084	 * allocated memory.
   2085	 */
   2086	psge = (char *) (((int *) mf) + karg.dataSgeOffset);
   2087	flagsLength = 0;
   2088
   2089	if (karg.dataOutSize > 0)
   2090		sgSize ++;
   2091
   2092	if (karg.dataInSize > 0)
   2093		sgSize ++;
   2094
   2095	if (sgSize > 0) {
   2096
   2097		/* Set up the dataOut memory allocation */
   2098		if (karg.dataOutSize > 0) {
   2099			if (karg.dataInSize > 0) {
   2100				flagsLength = ( MPI_SGE_FLAGS_SIMPLE_ELEMENT |
   2101						MPI_SGE_FLAGS_END_OF_BUFFER |
   2102						MPI_SGE_FLAGS_DIRECTION)
   2103						<< MPI_SGE_FLAGS_SHIFT;
   2104			} else {
   2105				flagsLength = MPT_SGE_FLAGS_SSIMPLE_WRITE;
   2106			}
   2107			flagsLength |= karg.dataOutSize;
   2108			bufOut.len = karg.dataOutSize;
   2109			bufOut.kptr = dma_alloc_coherent(&ioc->pcidev->dev,
   2110							 bufOut.len,
   2111							 &dma_addr_out, GFP_KERNEL);
   2112
   2113			if (bufOut.kptr == NULL) {
   2114				rc = -ENOMEM;
   2115				goto done_free_mem;
   2116			} else {
   2117				/* Set up this SGE.
   2118				 * Copy to MF and to sglbuf
   2119				 */
   2120				ioc->add_sge(psge, flagsLength, dma_addr_out);
   2121				psge += ioc->SGE_size;
   2122
   2123				/* Copy user data to kernel space.
   2124				 */
   2125				if (copy_from_user(bufOut.kptr,
   2126						karg.dataOutBufPtr,
   2127						bufOut.len)) {
   2128					printk(MYIOC_s_ERR_FMT
   2129						"%s@%d::mptctl_do_mpt_command - Unable "
   2130						"to read user data "
   2131						"struct @ %p\n",
   2132						ioc->name, __FILE__, __LINE__,karg.dataOutBufPtr);
   2133					rc =  -EFAULT;
   2134					goto done_free_mem;
   2135				}
   2136			}
   2137		}
   2138
   2139		if (karg.dataInSize > 0) {
   2140			flagsLength = MPT_SGE_FLAGS_SSIMPLE_READ;
   2141			flagsLength |= karg.dataInSize;
   2142
   2143			bufIn.len = karg.dataInSize;
   2144			bufIn.kptr = dma_alloc_coherent(&ioc->pcidev->dev,
   2145							bufIn.len,
   2146							&dma_addr_in, GFP_KERNEL);
   2147
   2148			if (bufIn.kptr == NULL) {
   2149				rc = -ENOMEM;
   2150				goto done_free_mem;
   2151			} else {
   2152				/* Set up this SGE
   2153				 * Copy to MF and to sglbuf
   2154				 */
   2155				ioc->add_sge(psge, flagsLength, dma_addr_in);
   2156			}
   2157		}
   2158	} else  {
   2159		/* Add a NULL SGE
   2160		 */
   2161		ioc->add_sge(psge, flagsLength, (dma_addr_t) -1);
   2162	}
   2163
   2164	SET_MGMT_MSG_CONTEXT(ioc->ioctl_cmds.msg_context, hdr->MsgContext);
   2165	INITIALIZE_MGMT_STATUS(ioc->ioctl_cmds.status)
   2166	if (hdr->Function == MPI_FUNCTION_SCSI_TASK_MGMT) {
   2167
   2168		mutex_lock(&ioc->taskmgmt_cmds.mutex);
   2169		if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0) {
   2170			mutex_unlock(&ioc->taskmgmt_cmds.mutex);
   2171			goto done_free_mem;
   2172		}
   2173
   2174		DBG_DUMP_TM_REQUEST_FRAME(ioc, (u32 *)mf);
   2175
   2176		if ((ioc->facts.IOCCapabilities & MPI_IOCFACTS_CAPABILITY_HIGH_PRI_Q) &&
   2177		    (ioc->facts.MsgVersion >= MPI_VERSION_01_05))
   2178			mpt_put_msg_frame_hi_pri(mptctl_id, ioc, mf);
   2179		else {
   2180			rc =mpt_send_handshake_request(mptctl_id, ioc,
   2181				sizeof(SCSITaskMgmt_t), (u32*)mf, CAN_SLEEP);
   2182			if (rc != 0) {
   2183				dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
   2184				    "send_handshake FAILED! (ioc %p, mf %p)\n",
   2185				    ioc->name, ioc, mf));
   2186				mpt_clear_taskmgmt_in_progress_flag(ioc);
   2187				rc = -ENODATA;
   2188				mutex_unlock(&ioc->taskmgmt_cmds.mutex);
   2189				goto done_free_mem;
   2190			}
   2191		}
   2192
   2193	} else
   2194		mpt_put_msg_frame(mptctl_id, ioc, mf);
   2195
   2196	/* Now wait for the command to complete */
   2197	timeout = (karg.timeout > 0) ? karg.timeout : MPT_IOCTL_DEFAULT_TIMEOUT;
   2198retry_wait:
   2199	timeleft = wait_for_completion_timeout(&ioc->ioctl_cmds.done,
   2200				HZ*timeout);
   2201	if (!(ioc->ioctl_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
   2202		rc = -ETIME;
   2203		dfailprintk(ioc, printk(MYIOC_s_ERR_FMT "%s: TIMED OUT!\n",
   2204		    ioc->name, __func__));
   2205		if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET) {
   2206			if (function == MPI_FUNCTION_SCSI_TASK_MGMT)
   2207				mutex_unlock(&ioc->taskmgmt_cmds.mutex);
   2208			goto done_free_mem;
   2209		}
   2210		if (!timeleft) {
   2211			printk(MYIOC_s_WARN_FMT
   2212			       "mpt cmd timeout, doorbell=0x%08x"
   2213			       " function=0x%x\n",
   2214			       ioc->name, mpt_GetIocState(ioc, 0), function);
   2215			if (function == MPI_FUNCTION_SCSI_TASK_MGMT)
   2216				mutex_unlock(&ioc->taskmgmt_cmds.mutex);
   2217			mptctl_timeout_expired(ioc, mf);
   2218			mf = NULL;
   2219		} else
   2220			goto retry_wait;
   2221		goto done_free_mem;
   2222	}
   2223
   2224	if (function == MPI_FUNCTION_SCSI_TASK_MGMT)
   2225		mutex_unlock(&ioc->taskmgmt_cmds.mutex);
   2226
   2227
   2228	mf = NULL;
   2229
   2230	/* If a valid reply frame, copy to the user.
   2231	 * Offset 2: reply length in U32's
   2232	 */
   2233	if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_RF_VALID) {
   2234		if (karg.maxReplyBytes < ioc->reply_sz) {
   2235			sz = min(karg.maxReplyBytes,
   2236				4*ioc->ioctl_cmds.reply[2]);
   2237		} else {
   2238			 sz = min(ioc->reply_sz, 4*ioc->ioctl_cmds.reply[2]);
   2239		}
   2240		if (sz > 0) {
   2241			if (copy_to_user(karg.replyFrameBufPtr,
   2242				 ioc->ioctl_cmds.reply, sz)){
   2243				 printk(MYIOC_s_ERR_FMT
   2244				     "%s@%d::mptctl_do_mpt_command - "
   2245				 "Unable to write out reply frame %p\n",
   2246				 ioc->name, __FILE__, __LINE__, karg.replyFrameBufPtr);
   2247				 rc =  -ENODATA;
   2248				 goto done_free_mem;
   2249			}
   2250		}
   2251	}
   2252
   2253	/* If valid sense data, copy to user.
   2254	 */
   2255	if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_SENSE_VALID) {
   2256		sz = min(karg.maxSenseBytes, MPT_SENSE_BUFFER_SIZE);
   2257		if (sz > 0) {
   2258			if (copy_to_user(karg.senseDataPtr,
   2259				ioc->ioctl_cmds.sense, sz)) {
   2260				printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   2261				"Unable to write sense data to user %p\n",
   2262				ioc->name, __FILE__, __LINE__,
   2263				karg.senseDataPtr);
   2264				rc =  -ENODATA;
   2265				goto done_free_mem;
   2266			}
   2267		}
   2268	}
   2269
   2270	/* If the overall status is _GOOD and data in, copy data
   2271	 * to user.
   2272	 */
   2273	if ((ioc->ioctl_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD) &&
   2274				(karg.dataInSize > 0) && (bufIn.kptr)) {
   2275
   2276		if (copy_to_user(karg.dataInBufPtr,
   2277				 bufIn.kptr, karg.dataInSize)) {
   2278			printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_do_mpt_command - "
   2279				"Unable to write data to user %p\n",
   2280				ioc->name, __FILE__, __LINE__,
   2281				karg.dataInBufPtr);
   2282			rc =  -ENODATA;
   2283		}
   2284	}
   2285
   2286done_free_mem:
   2287
   2288	CLEAR_MGMT_STATUS(ioc->ioctl_cmds.status)
   2289	SET_MGMT_MSG_CONTEXT(ioc->ioctl_cmds.msg_context, 0);
   2290
   2291	/* Free the allocated memory.
   2292	 */
   2293	if (bufOut.kptr != NULL) {
   2294		dma_free_coherent(&ioc->pcidev->dev, bufOut.len,
   2295				  (void *)bufOut.kptr, dma_addr_out);
   2296	}
   2297
   2298	if (bufIn.kptr != NULL) {
   2299		dma_free_coherent(&ioc->pcidev->dev, bufIn.len,
   2300				  (void *)bufIn.kptr, dma_addr_in);
   2301	}
   2302
   2303	/* mf is null if command issued successfully
   2304	 * otherwise, failure occurred after mf acquired.
   2305	 */
   2306	if (mf)
   2307		mpt_free_msg_frame(ioc, mf);
   2308
   2309	return rc;
   2310}
   2311
   2312/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2313/* Prototype Routine for the HOST INFO command.
   2314 *
   2315 * Outputs:	None.
   2316 * Return:	0 if successful
   2317 *		-EFAULT if data unavailable
   2318 *		-EBUSY  if previous command timeout and IOC reset is not complete.
   2319 *		-ENODEV if no such device/adapter
   2320 *		-ETIME	if timer expires
   2321 *		-ENOMEM if memory allocation error
   2322 */
   2323static int
   2324mptctl_hp_hostinfo(MPT_ADAPTER *ioc, unsigned long arg, unsigned int data_size)
   2325{
   2326	hp_host_info_t	__user *uarg = (void __user *) arg;
   2327	struct pci_dev		*pdev;
   2328	char                    *pbuf=NULL;
   2329	dma_addr_t		buf_dma;
   2330	hp_host_info_t		karg;
   2331	CONFIGPARMS		cfg;
   2332	ConfigPageHeader_t	hdr;
   2333	int			rc, cim_rev;
   2334	ToolboxIstwiReadWriteRequest_t	*IstwiRWRequest;
   2335	MPT_FRAME_HDR		*mf = NULL;
   2336	unsigned long		timeleft;
   2337	u32			msgcontext;
   2338
   2339	/* Reset long to int. Should affect IA64 and SPARC only
   2340	 */
   2341	if (data_size == sizeof(hp_host_info_t))
   2342		cim_rev = 1;
   2343	else if (data_size == sizeof(hp_host_info_rev0_t))
   2344		cim_rev = 0;	/* obsolete */
   2345	else
   2346		return -EFAULT;
   2347
   2348	if (copy_from_user(&karg, uarg, sizeof(hp_host_info_t))) {
   2349		printk(KERN_ERR MYNAM "%s@%d::mptctl_hp_host_info - "
   2350			"Unable to read in hp_host_info struct @ %p\n",
   2351				__FILE__, __LINE__, uarg);
   2352		return -EFAULT;
   2353	}
   2354
   2355	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT ": mptctl_hp_hostinfo called.\n",
   2356	    ioc->name));
   2357
   2358	/* Fill in the data and return the structure to the calling
   2359	 * program
   2360	 */
   2361	pdev = (struct pci_dev *) ioc->pcidev;
   2362
   2363	karg.vendor = pdev->vendor;
   2364	karg.device = pdev->device;
   2365	karg.subsystem_id = pdev->subsystem_device;
   2366	karg.subsystem_vendor = pdev->subsystem_vendor;
   2367	karg.devfn = pdev->devfn;
   2368	karg.bus = pdev->bus->number;
   2369
   2370	/* Save the SCSI host no. if
   2371	 * SCSI driver loaded
   2372	 */
   2373	if (ioc->sh != NULL)
   2374		karg.host_no = ioc->sh->host_no;
   2375	else
   2376		karg.host_no =  -1;
   2377
   2378	/* Reformat the fw_version into a string */
   2379	snprintf(karg.fw_version, sizeof(karg.fw_version),
   2380		 "%.2hhu.%.2hhu.%.2hhu.%.2hhu",
   2381		 ioc->facts.FWVersion.Struct.Major,
   2382		 ioc->facts.FWVersion.Struct.Minor,
   2383		 ioc->facts.FWVersion.Struct.Unit,
   2384		 ioc->facts.FWVersion.Struct.Dev);
   2385
   2386	/* Issue a config request to get the device serial number
   2387	 */
   2388	hdr.PageVersion = 0;
   2389	hdr.PageLength = 0;
   2390	hdr.PageNumber = 0;
   2391	hdr.PageType = MPI_CONFIG_PAGETYPE_MANUFACTURING;
   2392	cfg.cfghdr.hdr = &hdr;
   2393	cfg.physAddr = -1;
   2394	cfg.pageAddr = 0;
   2395	cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
   2396	cfg.dir = 0;	/* read */
   2397	cfg.timeout = 10;
   2398
   2399	strncpy(karg.serial_number, " ", 24);
   2400	if (mpt_config(ioc, &cfg) == 0) {
   2401		if (cfg.cfghdr.hdr->PageLength > 0) {
   2402			/* Issue the second config page request */
   2403			cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
   2404
   2405			pbuf = dma_alloc_coherent(&ioc->pcidev->dev,
   2406						  hdr.PageLength * 4,
   2407						  &buf_dma, GFP_KERNEL);
   2408			if (pbuf) {
   2409				cfg.physAddr = buf_dma;
   2410				if (mpt_config(ioc, &cfg) == 0) {
   2411					ManufacturingPage0_t *pdata = (ManufacturingPage0_t *) pbuf;
   2412					if (strlen(pdata->BoardTracerNumber) > 1) {
   2413						strlcpy(karg.serial_number,
   2414							pdata->BoardTracerNumber, 24);
   2415					}
   2416				}
   2417				dma_free_coherent(&ioc->pcidev->dev,
   2418						  hdr.PageLength * 4, pbuf,
   2419						  buf_dma);
   2420				pbuf = NULL;
   2421			}
   2422		}
   2423	}
   2424	rc = mpt_GetIocState(ioc, 1);
   2425	switch (rc) {
   2426	case MPI_IOC_STATE_OPERATIONAL:
   2427		karg.ioc_status =  HP_STATUS_OK;
   2428		break;
   2429
   2430	case MPI_IOC_STATE_FAULT:
   2431		karg.ioc_status =  HP_STATUS_FAILED;
   2432		break;
   2433
   2434	case MPI_IOC_STATE_RESET:
   2435	case MPI_IOC_STATE_READY:
   2436	default:
   2437		karg.ioc_status =  HP_STATUS_OTHER;
   2438		break;
   2439	}
   2440
   2441	karg.base_io_addr = pci_resource_start(pdev, 0);
   2442
   2443	if ((ioc->bus_type == SAS) || (ioc->bus_type == FC))
   2444		karg.bus_phys_width = HP_BUS_WIDTH_UNK;
   2445	else
   2446		karg.bus_phys_width = HP_BUS_WIDTH_16;
   2447
   2448	karg.hard_resets = 0;
   2449	karg.soft_resets = 0;
   2450	karg.timeouts = 0;
   2451	if (ioc->sh != NULL) {
   2452		MPT_SCSI_HOST *hd =  shost_priv(ioc->sh);
   2453
   2454		if (hd && (cim_rev == 1)) {
   2455			karg.hard_resets = ioc->hard_resets;
   2456			karg.soft_resets = ioc->soft_resets;
   2457			karg.timeouts = ioc->timeouts;
   2458		}
   2459	}
   2460
   2461	/* 
   2462	 * Gather ISTWI(Industry Standard Two Wire Interface) Data
   2463	 */
   2464	if ((mf = mpt_get_msg_frame(mptctl_id, ioc)) == NULL) {
   2465		dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
   2466			"%s, no msg frames!!\n", ioc->name, __func__));
   2467		goto out;
   2468	}
   2469
   2470	IstwiRWRequest = (ToolboxIstwiReadWriteRequest_t *)mf;
   2471	msgcontext = IstwiRWRequest->MsgContext;
   2472	memset(IstwiRWRequest,0,sizeof(ToolboxIstwiReadWriteRequest_t));
   2473	IstwiRWRequest->MsgContext = msgcontext;
   2474	IstwiRWRequest->Function = MPI_FUNCTION_TOOLBOX;
   2475	IstwiRWRequest->Tool = MPI_TOOLBOX_ISTWI_READ_WRITE_TOOL;
   2476	IstwiRWRequest->Flags = MPI_TB_ISTWI_FLAGS_READ;
   2477	IstwiRWRequest->NumAddressBytes = 0x01;
   2478	IstwiRWRequest->DataLength = cpu_to_le16(0x04);
   2479	if (pdev->devfn & 1)
   2480		IstwiRWRequest->DeviceAddr = 0xB2;
   2481	else
   2482		IstwiRWRequest->DeviceAddr = 0xB0;
   2483
   2484	pbuf = dma_alloc_coherent(&ioc->pcidev->dev, 4, &buf_dma, GFP_KERNEL);
   2485	if (!pbuf)
   2486		goto out;
   2487	ioc->add_sge((char *)&IstwiRWRequest->SGL,
   2488	    (MPT_SGE_FLAGS_SSIMPLE_READ|4), buf_dma);
   2489
   2490	SET_MGMT_MSG_CONTEXT(ioc->ioctl_cmds.msg_context,
   2491				IstwiRWRequest->MsgContext);
   2492	INITIALIZE_MGMT_STATUS(ioc->ioctl_cmds.status)
   2493	mpt_put_msg_frame(mptctl_id, ioc, mf);
   2494
   2495retry_wait:
   2496	timeleft = wait_for_completion_timeout(&ioc->ioctl_cmds.done,
   2497			HZ*MPT_IOCTL_DEFAULT_TIMEOUT);
   2498	if (!(ioc->ioctl_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
   2499		printk(MYIOC_s_WARN_FMT "%s: failed\n", ioc->name, __func__);
   2500		if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET) {
   2501			mpt_free_msg_frame(ioc, mf);
   2502			goto out;
   2503		}
   2504		if (!timeleft) {
   2505			printk(MYIOC_s_WARN_FMT
   2506			       "HOST INFO command timeout, doorbell=0x%08x\n",
   2507			       ioc->name, mpt_GetIocState(ioc, 0));
   2508			mptctl_timeout_expired(ioc, mf);
   2509		} else
   2510			goto retry_wait;
   2511		goto out;
   2512	}
   2513
   2514	/*
   2515	 *ISTWI Data Definition
   2516	 * pbuf[0] = FW_VERSION = 0x4
   2517	 * pbuf[1] = Bay Count = 6 or 4 or 2, depending on
   2518	 *  the config, you should be seeing one out of these three values
   2519	 * pbuf[2] = Drive Installed Map = bit pattern depend on which
   2520	 *   bays have drives in them
   2521	 * pbuf[3] = Checksum (0x100 = (byte0 + byte2 + byte3)
   2522	 */
   2523	if (ioc->ioctl_cmds.status & MPT_MGMT_STATUS_RF_VALID)
   2524		karg.rsvd = *(u32 *)pbuf;
   2525
   2526 out:
   2527	CLEAR_MGMT_STATUS(ioc->ioctl_cmds.status)
   2528	SET_MGMT_MSG_CONTEXT(ioc->ioctl_cmds.msg_context, 0);
   2529
   2530	if (pbuf)
   2531		dma_free_coherent(&ioc->pcidev->dev, 4, pbuf, buf_dma);
   2532
   2533	/* Copy the data from kernel memory to user memory
   2534	 */
   2535	if (copy_to_user((char __user *)arg, &karg, sizeof(hp_host_info_t))) {
   2536		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_hpgethostinfo - "
   2537			"Unable to write out hp_host_info @ %p\n",
   2538			ioc->name, __FILE__, __LINE__, uarg);
   2539		return -EFAULT;
   2540	}
   2541
   2542	return 0;
   2543
   2544}
   2545
   2546/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2547/* Prototype Routine for the TARGET INFO command.
   2548 *
   2549 * Outputs:	None.
   2550 * Return:	0 if successful
   2551 *		-EFAULT if data unavailable
   2552 *		-EBUSY  if previous command timeout and IOC reset is not complete.
   2553 *		-ENODEV if no such device/adapter
   2554 *		-ETIME	if timer expires
   2555 *		-ENOMEM if memory allocation error
   2556 */
   2557static int
   2558mptctl_hp_targetinfo(MPT_ADAPTER *ioc, unsigned long arg)
   2559{
   2560	hp_target_info_t __user *uarg = (void __user *) arg;
   2561	SCSIDevicePage0_t	*pg0_alloc;
   2562	SCSIDevicePage3_t	*pg3_alloc;
   2563	MPT_SCSI_HOST 		*hd = NULL;
   2564	hp_target_info_t	karg;
   2565	int			data_sz;
   2566	dma_addr_t		page_dma;
   2567	CONFIGPARMS	 	cfg;
   2568	ConfigPageHeader_t	hdr;
   2569	int			tmp, np, rc = 0;
   2570
   2571	if (copy_from_user(&karg, uarg, sizeof(hp_target_info_t))) {
   2572		printk(KERN_ERR MYNAM "%s@%d::mptctl_hp_targetinfo - "
   2573			"Unable to read in hp_host_targetinfo struct @ %p\n",
   2574				__FILE__, __LINE__, uarg);
   2575		return -EFAULT;
   2576	}
   2577
   2578	if (karg.hdr.id >= MPT_MAX_FC_DEVICES)
   2579		return -EINVAL;
   2580	dctlprintk(ioc, printk(MYIOC_s_DEBUG_FMT "mptctl_hp_targetinfo called.\n",
   2581	    ioc->name));
   2582
   2583	/*  There is nothing to do for FCP parts.
   2584	 */
   2585	if ((ioc->bus_type == SAS) || (ioc->bus_type == FC))
   2586		return 0;
   2587
   2588	if ((ioc->spi_data.sdp0length == 0) || (ioc->sh == NULL))
   2589		return 0;
   2590
   2591	if (ioc->sh->host_no != karg.hdr.host)
   2592		return -ENODEV;
   2593
   2594       /* Get the data transfer speeds
   2595        */
   2596	data_sz = ioc->spi_data.sdp0length * 4;
   2597	pg0_alloc = dma_alloc_coherent(&ioc->pcidev->dev, data_sz, &page_dma,
   2598				       GFP_KERNEL);
   2599	if (pg0_alloc) {
   2600		hdr.PageVersion = ioc->spi_data.sdp0version;
   2601		hdr.PageLength = data_sz;
   2602		hdr.PageNumber = 0;
   2603		hdr.PageType = MPI_CONFIG_PAGETYPE_SCSI_DEVICE;
   2604
   2605		cfg.cfghdr.hdr = &hdr;
   2606		cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
   2607		cfg.dir = 0;
   2608		cfg.timeout = 0;
   2609		cfg.physAddr = page_dma;
   2610
   2611		cfg.pageAddr = (karg.hdr.channel << 8) | karg.hdr.id;
   2612
   2613		if ((rc = mpt_config(ioc, &cfg)) == 0) {
   2614			np = le32_to_cpu(pg0_alloc->NegotiatedParameters);
   2615			karg.negotiated_width = np & MPI_SCSIDEVPAGE0_NP_WIDE ?
   2616					HP_BUS_WIDTH_16 : HP_BUS_WIDTH_8;
   2617
   2618			if (np & MPI_SCSIDEVPAGE0_NP_NEG_SYNC_OFFSET_MASK) {
   2619				tmp = (np & MPI_SCSIDEVPAGE0_NP_NEG_SYNC_PERIOD_MASK) >> 8;
   2620				if (tmp < 0x09)
   2621					karg.negotiated_speed = HP_DEV_SPEED_ULTRA320;
   2622				else if (tmp <= 0x09)
   2623					karg.negotiated_speed = HP_DEV_SPEED_ULTRA160;
   2624				else if (tmp <= 0x0A)
   2625					karg.negotiated_speed = HP_DEV_SPEED_ULTRA2;
   2626				else if (tmp <= 0x0C)
   2627					karg.negotiated_speed = HP_DEV_SPEED_ULTRA;
   2628				else if (tmp <= 0x25)
   2629					karg.negotiated_speed = HP_DEV_SPEED_FAST;
   2630				else
   2631					karg.negotiated_speed = HP_DEV_SPEED_ASYNC;
   2632			} else
   2633				karg.negotiated_speed = HP_DEV_SPEED_ASYNC;
   2634		}
   2635
   2636		dma_free_coherent(&ioc->pcidev->dev, data_sz, (u8 *)pg0_alloc,
   2637				  page_dma);
   2638	}
   2639
   2640	/* Set defaults
   2641	 */
   2642	karg.message_rejects = -1;
   2643	karg.phase_errors = -1;
   2644	karg.parity_errors = -1;
   2645	karg.select_timeouts = -1;
   2646
   2647	/* Get the target error parameters
   2648	 */
   2649	hdr.PageVersion = 0;
   2650	hdr.PageLength = 0;
   2651	hdr.PageNumber = 3;
   2652	hdr.PageType = MPI_CONFIG_PAGETYPE_SCSI_DEVICE;
   2653
   2654	cfg.cfghdr.hdr = &hdr;
   2655	cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
   2656	cfg.dir = 0;
   2657	cfg.timeout = 0;
   2658	cfg.physAddr = -1;
   2659	if ((mpt_config(ioc, &cfg) == 0) && (cfg.cfghdr.hdr->PageLength > 0)) {
   2660		/* Issue the second config page request */
   2661		cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
   2662		data_sz = (int) cfg.cfghdr.hdr->PageLength * 4;
   2663		pg3_alloc = dma_alloc_coherent(&ioc->pcidev->dev, data_sz,
   2664					       &page_dma, GFP_KERNEL);
   2665		if (pg3_alloc) {
   2666			cfg.physAddr = page_dma;
   2667			cfg.pageAddr = (karg.hdr.channel << 8) | karg.hdr.id;
   2668			if ((rc = mpt_config(ioc, &cfg)) == 0) {
   2669				karg.message_rejects = (u32) le16_to_cpu(pg3_alloc->MsgRejectCount);
   2670				karg.phase_errors = (u32) le16_to_cpu(pg3_alloc->PhaseErrorCount);
   2671				karg.parity_errors = (u32) le16_to_cpu(pg3_alloc->ParityErrorCount);
   2672			}
   2673			dma_free_coherent(&ioc->pcidev->dev, data_sz,
   2674					  (u8 *)pg3_alloc, page_dma);
   2675		}
   2676	}
   2677	hd = shost_priv(ioc->sh);
   2678	if (hd != NULL)
   2679		karg.select_timeouts = hd->sel_timeout[karg.hdr.id];
   2680
   2681	/* Copy the data from kernel memory to user memory
   2682	 */
   2683	if (copy_to_user((char __user *)arg, &karg, sizeof(hp_target_info_t))) {
   2684		printk(MYIOC_s_ERR_FMT "%s@%d::mptctl_hp_target_info - "
   2685			"Unable to write out mpt_ioctl_targetinfo struct @ %p\n",
   2686			ioc->name, __FILE__, __LINE__, uarg);
   2687		return -EFAULT;
   2688	}
   2689
   2690	return 0;
   2691}
   2692
   2693/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2694
   2695static const struct file_operations mptctl_fops = {
   2696	.owner =	THIS_MODULE,
   2697	.llseek =	no_llseek,
   2698	.fasync = 	mptctl_fasync,
   2699	.unlocked_ioctl = mptctl_ioctl,
   2700#ifdef CONFIG_COMPAT
   2701	.compat_ioctl = compat_mpctl_ioctl,
   2702#endif
   2703};
   2704
   2705static struct miscdevice mptctl_miscdev = {
   2706	MPT_MINOR,
   2707	MYNAM,
   2708	&mptctl_fops
   2709};
   2710
   2711/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2712
   2713#ifdef CONFIG_COMPAT
   2714
   2715static int
   2716compat_mptfwxfer_ioctl(struct file *filp, unsigned int cmd,
   2717			unsigned long arg)
   2718{
   2719	struct mpt_fw_xfer32 kfw32;
   2720	struct mpt_fw_xfer kfw;
   2721	MPT_ADAPTER *iocp = NULL;
   2722	int iocnum, iocnumX;
   2723	int nonblock = (filp->f_flags & O_NONBLOCK);
   2724	int ret;
   2725
   2726
   2727	if (copy_from_user(&kfw32, (char __user *)arg, sizeof(kfw32)))
   2728		return -EFAULT;
   2729
   2730	/* Verify intended MPT adapter */
   2731	iocnumX = kfw32.iocnum & 0xFF;
   2732	if (((iocnum = mpt_verify_adapter(iocnumX, &iocp)) < 0) ||
   2733	    (iocp == NULL)) {
   2734		printk(KERN_DEBUG MYNAM "::compat_mptfwxfer_ioctl @%d - ioc%d not found!\n",
   2735			__LINE__, iocnumX);
   2736		return -ENODEV;
   2737	}
   2738
   2739	if ((ret = mptctl_syscall_down(iocp, nonblock)) != 0)
   2740		return ret;
   2741
   2742	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT "compat_mptfwxfer_ioctl() called\n",
   2743	    iocp->name));
   2744	kfw.iocnum = iocnum;
   2745	kfw.fwlen = kfw32.fwlen;
   2746	kfw.bufp = compat_ptr(kfw32.bufp);
   2747
   2748	ret = mptctl_do_fw_download(iocp, kfw.bufp, kfw.fwlen);
   2749
   2750	mutex_unlock(&iocp->ioctl_cmds.mutex);
   2751
   2752	return ret;
   2753}
   2754
   2755static int
   2756compat_mpt_command(struct file *filp, unsigned int cmd,
   2757			unsigned long arg)
   2758{
   2759	struct mpt_ioctl_command32 karg32;
   2760	struct mpt_ioctl_command32 __user *uarg = (struct mpt_ioctl_command32 __user *) arg;
   2761	struct mpt_ioctl_command karg;
   2762	MPT_ADAPTER *iocp = NULL;
   2763	int iocnum, iocnumX;
   2764	int nonblock = (filp->f_flags & O_NONBLOCK);
   2765	int ret;
   2766
   2767	if (copy_from_user(&karg32, (char __user *)arg, sizeof(karg32)))
   2768		return -EFAULT;
   2769
   2770	/* Verify intended MPT adapter */
   2771	iocnumX = karg32.hdr.iocnum & 0xFF;
   2772	if (((iocnum = mpt_verify_adapter(iocnumX, &iocp)) < 0) ||
   2773	    (iocp == NULL)) {
   2774		printk(KERN_DEBUG MYNAM "::compat_mpt_command @%d - ioc%d not found!\n",
   2775			__LINE__, iocnumX);
   2776		return -ENODEV;
   2777	}
   2778
   2779	if ((ret = mptctl_syscall_down(iocp, nonblock)) != 0)
   2780		return ret;
   2781
   2782	dctlprintk(iocp, printk(MYIOC_s_DEBUG_FMT "compat_mpt_command() called\n",
   2783	    iocp->name));
   2784	/* Copy data to karg */
   2785	karg.hdr.iocnum = karg32.hdr.iocnum;
   2786	karg.hdr.port = karg32.hdr.port;
   2787	karg.timeout = karg32.timeout;
   2788	karg.maxReplyBytes = karg32.maxReplyBytes;
   2789
   2790	karg.dataInSize = karg32.dataInSize;
   2791	karg.dataOutSize = karg32.dataOutSize;
   2792	karg.maxSenseBytes = karg32.maxSenseBytes;
   2793	karg.dataSgeOffset = karg32.dataSgeOffset;
   2794
   2795	karg.replyFrameBufPtr = (char __user *)(unsigned long)karg32.replyFrameBufPtr;
   2796	karg.dataInBufPtr = (char __user *)(unsigned long)karg32.dataInBufPtr;
   2797	karg.dataOutBufPtr = (char __user *)(unsigned long)karg32.dataOutBufPtr;
   2798	karg.senseDataPtr = (char __user *)(unsigned long)karg32.senseDataPtr;
   2799
   2800	/* Pass new structure to do_mpt_command
   2801	 */
   2802	ret = mptctl_do_mpt_command (iocp, karg, &uarg->MF);
   2803
   2804	mutex_unlock(&iocp->ioctl_cmds.mutex);
   2805
   2806	return ret;
   2807}
   2808
   2809static long compat_mpctl_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
   2810{
   2811	long ret;
   2812	mutex_lock(&mpctl_mutex);
   2813	switch (cmd) {
   2814	case MPTIOCINFO:
   2815	case MPTIOCINFO1:
   2816	case MPTIOCINFO2:
   2817	case MPTTARGETINFO:
   2818	case MPTEVENTQUERY:
   2819	case MPTEVENTENABLE:
   2820	case MPTEVENTREPORT:
   2821	case MPTHARDRESET:
   2822	case HP_GETHOSTINFO:
   2823	case HP_GETTARGETINFO:
   2824	case MPTTEST:
   2825		ret = __mptctl_ioctl(f, cmd, arg);
   2826		break;
   2827	case MPTCOMMAND32:
   2828		ret = compat_mpt_command(f, cmd, arg);
   2829		break;
   2830	case MPTFWDOWNLOAD32:
   2831		ret = compat_mptfwxfer_ioctl(f, cmd, arg);
   2832		break;
   2833	default:
   2834		ret = -ENOIOCTLCMD;
   2835		break;
   2836	}
   2837	mutex_unlock(&mpctl_mutex);
   2838	return ret;
   2839}
   2840
   2841#endif
   2842
   2843
   2844/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2845/*
   2846 *	mptctl_probe - Installs ioctl devices per bus.
   2847 *	@pdev: Pointer to pci_dev structure
   2848 *
   2849 *	Returns 0 for success, non-zero for failure.
   2850 *
   2851 */
   2852
   2853static int
   2854mptctl_probe(struct pci_dev *pdev)
   2855{
   2856	MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
   2857
   2858	mutex_init(&ioc->ioctl_cmds.mutex);
   2859	init_completion(&ioc->ioctl_cmds.done);
   2860	return 0;
   2861}
   2862
   2863/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2864/*
   2865 *	mptctl_remove - Removed ioctl devices
   2866 *	@pdev: Pointer to pci_dev structure
   2867 *
   2868 *
   2869 */
   2870static void
   2871mptctl_remove(struct pci_dev *pdev)
   2872{
   2873}
   2874
   2875static struct mpt_pci_driver mptctl_driver = {
   2876  .probe		= mptctl_probe,
   2877  .remove		= mptctl_remove,
   2878};
   2879
   2880/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2881static int __init mptctl_init(void)
   2882{
   2883	int err;
   2884	int where = 1;
   2885
   2886	show_mptmod_ver(my_NAME, my_VERSION);
   2887
   2888	mpt_device_driver_register(&mptctl_driver, MPTCTL_DRIVER);
   2889
   2890	/* Register this device */
   2891	err = misc_register(&mptctl_miscdev);
   2892	if (err < 0) {
   2893		printk(KERN_ERR MYNAM ": Can't register misc device [minor=%d].\n", MPT_MINOR);
   2894		goto out_fail;
   2895	}
   2896	printk(KERN_INFO MYNAM ": Registered with Fusion MPT base driver\n");
   2897	printk(KERN_INFO MYNAM ": /dev/%s @ (major,minor=%d,%d)\n",
   2898			 mptctl_miscdev.name, MISC_MAJOR, mptctl_miscdev.minor);
   2899
   2900	/*
   2901	 *  Install our handler
   2902	 */
   2903	++where;
   2904	mptctl_id = mpt_register(mptctl_reply, MPTCTL_DRIVER,
   2905	    "mptctl_reply");
   2906	if (!mptctl_id || mptctl_id >= MPT_MAX_PROTOCOL_DRIVERS) {
   2907		printk(KERN_ERR MYNAM ": ERROR: Failed to register with Fusion MPT base driver\n");
   2908		misc_deregister(&mptctl_miscdev);
   2909		err = -EBUSY;
   2910		goto out_fail;
   2911	}
   2912
   2913	mptctl_taskmgmt_id = mpt_register(mptctl_taskmgmt_reply, MPTCTL_DRIVER,
   2914	    "mptctl_taskmgmt_reply");
   2915	if (!mptctl_taskmgmt_id || mptctl_taskmgmt_id >= MPT_MAX_PROTOCOL_DRIVERS) {
   2916		printk(KERN_ERR MYNAM ": ERROR: Failed to register with Fusion MPT base driver\n");
   2917		mpt_deregister(mptctl_id);
   2918		misc_deregister(&mptctl_miscdev);
   2919		err = -EBUSY;
   2920		goto out_fail;
   2921	}
   2922
   2923	mpt_reset_register(mptctl_id, mptctl_ioc_reset);
   2924	mpt_event_register(mptctl_id, mptctl_event_process);
   2925
   2926	return 0;
   2927
   2928out_fail:
   2929
   2930	mpt_device_driver_deregister(MPTCTL_DRIVER);
   2931
   2932	return err;
   2933}
   2934
   2935/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2936static void mptctl_exit(void)
   2937{
   2938	misc_deregister(&mptctl_miscdev);
   2939	printk(KERN_INFO MYNAM ": Deregistered /dev/%s @ (major,minor=%d,%d)\n",
   2940			 mptctl_miscdev.name, MISC_MAJOR, mptctl_miscdev.minor);
   2941
   2942	/* De-register event handler from base module */
   2943	mpt_event_deregister(mptctl_id);
   2944
   2945	/* De-register reset handler from base module */
   2946	mpt_reset_deregister(mptctl_id);
   2947
   2948	/* De-register callback handler from base module */
   2949	mpt_deregister(mptctl_taskmgmt_id);
   2950	mpt_deregister(mptctl_id);
   2951
   2952        mpt_device_driver_deregister(MPTCTL_DRIVER);
   2953
   2954}
   2955
   2956/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
   2957
   2958module_init(mptctl_init);
   2959module_exit(mptctl_exit);