mpt2sas_base.c revision 4be929be34f9bdeffa40d815d32d7d60d2c7f03b
1/*
2 * This is the Fusion MPT base driver providing common API layer interface
3 * for access to MPT (Message Passing Technology) firmware.
4 *
5 * This code is based on drivers/scsi/mpt2sas/mpt2_base.c
6 * Copyright (C) 2007-2010  LSI Corporation
7 *  (mailto:DL-MPTFusionLinux@lsi.com)
8 *
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License
11 * as published by the Free Software Foundation; either version 2
12 * of the License, or (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17 * GNU General Public License for more details.
18 *
19 * NO WARRANTY
20 * THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
21 * CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
22 * LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
23 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
24 * solely responsible for determining the appropriateness of using and
25 * distributing the Program and assumes all risks associated with its
26 * exercise of rights under this Agreement, including but not limited to
27 * the risks and costs of program errors, damage to or loss of data,
28 * programs or equipment, and unavailability or interruption of operations.
29
30 * DISCLAIMER OF LIABILITY
31 * NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
32 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
33 * DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
34 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
35 * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
36 * USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
37 * HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
38
39 * You should have received a copy of the GNU General Public License
40 * along with this program; if not, write to the Free Software
41 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301,
42 * USA.
43 */
44
45#include <linux/version.h>
46#include <linux/kernel.h>
47#include <linux/module.h>
48#include <linux/errno.h>
49#include <linux/init.h>
50#include <linux/slab.h>
51#include <linux/types.h>
52#include <linux/pci.h>
53#include <linux/kdev_t.h>
54#include <linux/blkdev.h>
55#include <linux/delay.h>
56#include <linux/interrupt.h>
57#include <linux/dma-mapping.h>
58#include <linux/sort.h>
59#include <linux/io.h>
60#include <linux/time.h>
61#include <linux/aer.h>
62
63#include "mpt2sas_base.h"
64
65static MPT_CALLBACK	mpt_callbacks[MPT_MAX_CALLBACKS];
66
67#define FAULT_POLLING_INTERVAL 1000 /* in milliseconds */
68#define MPT2SAS_MAX_REQUEST_QUEUE 600 /* maximum controller queue depth */
69
70static int max_queue_depth = -1;
71module_param(max_queue_depth, int, 0);
72MODULE_PARM_DESC(max_queue_depth, " max controller queue depth ");
73
74static int max_sgl_entries = -1;
75module_param(max_sgl_entries, int, 0);
76MODULE_PARM_DESC(max_sgl_entries, " max sg entries ");
77
78static int msix_disable = -1;
79module_param(msix_disable, int, 0);
80MODULE_PARM_DESC(msix_disable, " disable msix routed interrupts (default=0)");
81
82/* diag_buffer_enable is bitwise
83 * bit 0 set = TRACE
84 * bit 1 set = SNAPSHOT
85 * bit 2 set = EXTENDED
86 *
87 * Either bit can be set, or both
88 */
89static int diag_buffer_enable;
90module_param(diag_buffer_enable, int, 0);
91MODULE_PARM_DESC(diag_buffer_enable, " post diag buffers "
92    "(TRACE=1/SNAPSHOT=2/EXTENDED=4/default=0)");
93
94int mpt2sas_fwfault_debug;
95MODULE_PARM_DESC(mpt2sas_fwfault_debug, " enable detection of firmware fault "
96    "and halt firmware - (default=0)");
97
98/**
99 * _scsih_set_fwfault_debug - global setting of ioc->fwfault_debug.
100 *
101 */
102static int
103_scsih_set_fwfault_debug(const char *val, struct kernel_param *kp)
104{
105	int ret = param_set_int(val, kp);
106	struct MPT2SAS_ADAPTER *ioc;
107
108	if (ret)
109		return ret;
110
111	printk(KERN_INFO "setting fwfault_debug(%d)\n", mpt2sas_fwfault_debug);
112	list_for_each_entry(ioc, &mpt2sas_ioc_list, list)
113		ioc->fwfault_debug = mpt2sas_fwfault_debug;
114	return 0;
115}
116module_param_call(mpt2sas_fwfault_debug, _scsih_set_fwfault_debug,
117    param_get_int, &mpt2sas_fwfault_debug, 0644);
118
119/**
120 * _base_fault_reset_work - workq handling ioc fault conditions
121 * @work: input argument, used to derive ioc
122 * Context: sleep.
123 *
124 * Return nothing.
125 */
126static void
127_base_fault_reset_work(struct work_struct *work)
128{
129	struct MPT2SAS_ADAPTER *ioc =
130	    container_of(work, struct MPT2SAS_ADAPTER, fault_reset_work.work);
131	unsigned long	 flags;
132	u32 doorbell;
133	int rc;
134
135	spin_lock_irqsave(&ioc->ioc_reset_in_progress_lock, flags);
136	if (ioc->shost_recovery)
137		goto rearm_timer;
138	spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
139
140	doorbell = mpt2sas_base_get_iocstate(ioc, 0);
141	if ((doorbell & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_FAULT) {
142		rc = mpt2sas_base_hard_reset_handler(ioc, CAN_SLEEP,
143		    FORCE_BIG_HAMMER);
144		printk(MPT2SAS_WARN_FMT "%s: hard reset: %s\n", ioc->name,
145		    __func__, (rc == 0) ? "success" : "failed");
146		doorbell = mpt2sas_base_get_iocstate(ioc, 0);
147		if ((doorbell & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_FAULT)
148			mpt2sas_base_fault_info(ioc, doorbell &
149			    MPI2_DOORBELL_DATA_MASK);
150	}
151
152	spin_lock_irqsave(&ioc->ioc_reset_in_progress_lock, flags);
153 rearm_timer:
154	if (ioc->fault_reset_work_q)
155		queue_delayed_work(ioc->fault_reset_work_q,
156		    &ioc->fault_reset_work,
157		    msecs_to_jiffies(FAULT_POLLING_INTERVAL));
158	spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
159}
160
161/**
162 * mpt2sas_base_start_watchdog - start the fault_reset_work_q
163 * @ioc: per adapter object
164 * Context: sleep.
165 *
166 * Return nothing.
167 */
168void
169mpt2sas_base_start_watchdog(struct MPT2SAS_ADAPTER *ioc)
170{
171	unsigned long	 flags;
172
173	if (ioc->fault_reset_work_q)
174		return;
175
176	/* initialize fault polling */
177	INIT_DELAYED_WORK(&ioc->fault_reset_work, _base_fault_reset_work);
178	snprintf(ioc->fault_reset_work_q_name,
179	    sizeof(ioc->fault_reset_work_q_name), "poll_%d_status", ioc->id);
180	ioc->fault_reset_work_q =
181		create_singlethread_workqueue(ioc->fault_reset_work_q_name);
182	if (!ioc->fault_reset_work_q) {
183		printk(MPT2SAS_ERR_FMT "%s: failed (line=%d)\n",
184		    ioc->name, __func__, __LINE__);
185			return;
186	}
187	spin_lock_irqsave(&ioc->ioc_reset_in_progress_lock, flags);
188	if (ioc->fault_reset_work_q)
189		queue_delayed_work(ioc->fault_reset_work_q,
190		    &ioc->fault_reset_work,
191		    msecs_to_jiffies(FAULT_POLLING_INTERVAL));
192	spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
193}
194
195/**
196 * mpt2sas_base_stop_watchdog - stop the fault_reset_work_q
197 * @ioc: per adapter object
198 * Context: sleep.
199 *
200 * Return nothing.
201 */
202void
203mpt2sas_base_stop_watchdog(struct MPT2SAS_ADAPTER *ioc)
204{
205	unsigned long	 flags;
206	struct workqueue_struct *wq;
207
208	spin_lock_irqsave(&ioc->ioc_reset_in_progress_lock, flags);
209	wq = ioc->fault_reset_work_q;
210	ioc->fault_reset_work_q = NULL;
211	spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
212	if (wq) {
213		if (!cancel_delayed_work(&ioc->fault_reset_work))
214			flush_workqueue(wq);
215		destroy_workqueue(wq);
216	}
217}
218
219/**
220 * mpt2sas_base_fault_info - verbose translation of firmware FAULT code
221 * @ioc: per adapter object
222 * @fault_code: fault code
223 *
224 * Return nothing.
225 */
226void
227mpt2sas_base_fault_info(struct MPT2SAS_ADAPTER *ioc , u16 fault_code)
228{
229	printk(MPT2SAS_ERR_FMT "fault_state(0x%04x)!\n",
230	    ioc->name, fault_code);
231}
232
233/**
234 * mpt2sas_halt_firmware - halt's mpt controller firmware
235 * @ioc: per adapter object
236 *
237 * For debugging timeout related issues.  Writing 0xCOFFEE00
238 * to the doorbell register will halt controller firmware. With
239 * the purpose to stop both driver and firmware, the enduser can
240 * obtain a ring buffer from controller UART.
241 */
242void
243mpt2sas_halt_firmware(struct MPT2SAS_ADAPTER *ioc)
244{
245	u32 doorbell;
246
247	if (!ioc->fwfault_debug)
248		return;
249
250	dump_stack();
251
252	doorbell = readl(&ioc->chip->Doorbell);
253	if ((doorbell & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_FAULT)
254		mpt2sas_base_fault_info(ioc , doorbell);
255	else {
256		writel(0xC0FFEE00, &ioc->chip->Doorbell);
257		printk(MPT2SAS_ERR_FMT "Firmware is halted due to command "
258		    "timeout\n", ioc->name);
259	}
260
261	panic("panic in %s\n", __func__);
262}
263
264#ifdef CONFIG_SCSI_MPT2SAS_LOGGING
265/**
266 * _base_sas_ioc_info - verbose translation of the ioc status
267 * @ioc: per adapter object
268 * @mpi_reply: reply mf payload returned from firmware
269 * @request_hdr: request mf
270 *
271 * Return nothing.
272 */
273static void
274_base_sas_ioc_info(struct MPT2SAS_ADAPTER *ioc, MPI2DefaultReply_t *mpi_reply,
275     MPI2RequestHeader_t *request_hdr)
276{
277	u16 ioc_status = le16_to_cpu(mpi_reply->IOCStatus) &
278	    MPI2_IOCSTATUS_MASK;
279	char *desc = NULL;
280	u16 frame_sz;
281	char *func_str = NULL;
282
283	/* SCSI_IO, RAID_PASS are handled from _scsih_scsi_ioc_info */
284	if (request_hdr->Function == MPI2_FUNCTION_SCSI_IO_REQUEST ||
285	    request_hdr->Function == MPI2_FUNCTION_RAID_SCSI_IO_PASSTHROUGH ||
286	    request_hdr->Function == MPI2_FUNCTION_EVENT_NOTIFICATION)
287		return;
288
289	if (ioc_status == MPI2_IOCSTATUS_CONFIG_INVALID_PAGE)
290		return;
291
292	switch (ioc_status) {
293
294/****************************************************************************
295*  Common IOCStatus values for all replies
296****************************************************************************/
297
298	case MPI2_IOCSTATUS_INVALID_FUNCTION:
299		desc = "invalid function";
300		break;
301	case MPI2_IOCSTATUS_BUSY:
302		desc = "busy";
303		break;
304	case MPI2_IOCSTATUS_INVALID_SGL:
305		desc = "invalid sgl";
306		break;
307	case MPI2_IOCSTATUS_INTERNAL_ERROR:
308		desc = "internal error";
309		break;
310	case MPI2_IOCSTATUS_INVALID_VPID:
311		desc = "invalid vpid";
312		break;
313	case MPI2_IOCSTATUS_INSUFFICIENT_RESOURCES:
314		desc = "insufficient resources";
315		break;
316	case MPI2_IOCSTATUS_INVALID_FIELD:
317		desc = "invalid field";
318		break;
319	case MPI2_IOCSTATUS_INVALID_STATE:
320		desc = "invalid state";
321		break;
322	case MPI2_IOCSTATUS_OP_STATE_NOT_SUPPORTED:
323		desc = "op state not supported";
324		break;
325
326/****************************************************************************
327*  Config IOCStatus values
328****************************************************************************/
329
330	case MPI2_IOCSTATUS_CONFIG_INVALID_ACTION:
331		desc = "config invalid action";
332		break;
333	case MPI2_IOCSTATUS_CONFIG_INVALID_TYPE:
334		desc = "config invalid type";
335		break;
336	case MPI2_IOCSTATUS_CONFIG_INVALID_PAGE:
337		desc = "config invalid page";
338		break;
339	case MPI2_IOCSTATUS_CONFIG_INVALID_DATA:
340		desc = "config invalid data";
341		break;
342	case MPI2_IOCSTATUS_CONFIG_NO_DEFAULTS:
343		desc = "config no defaults";
344		break;
345	case MPI2_IOCSTATUS_CONFIG_CANT_COMMIT:
346		desc = "config cant commit";
347		break;
348
349/****************************************************************************
350*  SCSI IO Reply
351****************************************************************************/
352
353	case MPI2_IOCSTATUS_SCSI_RECOVERED_ERROR:
354	case MPI2_IOCSTATUS_SCSI_INVALID_DEVHANDLE:
355	case MPI2_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
356	case MPI2_IOCSTATUS_SCSI_DATA_OVERRUN:
357	case MPI2_IOCSTATUS_SCSI_DATA_UNDERRUN:
358	case MPI2_IOCSTATUS_SCSI_IO_DATA_ERROR:
359	case MPI2_IOCSTATUS_SCSI_PROTOCOL_ERROR:
360	case MPI2_IOCSTATUS_SCSI_TASK_TERMINATED:
361	case MPI2_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
362	case MPI2_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
363	case MPI2_IOCSTATUS_SCSI_IOC_TERMINATED:
364	case MPI2_IOCSTATUS_SCSI_EXT_TERMINATED:
365		break;
366
367/****************************************************************************
368*  For use by SCSI Initiator and SCSI Target end-to-end data protection
369****************************************************************************/
370
371	case MPI2_IOCSTATUS_EEDP_GUARD_ERROR:
372		desc = "eedp guard error";
373		break;
374	case MPI2_IOCSTATUS_EEDP_REF_TAG_ERROR:
375		desc = "eedp ref tag error";
376		break;
377	case MPI2_IOCSTATUS_EEDP_APP_TAG_ERROR:
378		desc = "eedp app tag error";
379		break;
380
381/****************************************************************************
382*  SCSI Target values
383****************************************************************************/
384
385	case MPI2_IOCSTATUS_TARGET_INVALID_IO_INDEX:
386		desc = "target invalid io index";
387		break;
388	case MPI2_IOCSTATUS_TARGET_ABORTED:
389		desc = "target aborted";
390		break;
391	case MPI2_IOCSTATUS_TARGET_NO_CONN_RETRYABLE:
392		desc = "target no conn retryable";
393		break;
394	case MPI2_IOCSTATUS_TARGET_NO_CONNECTION:
395		desc = "target no connection";
396		break;
397	case MPI2_IOCSTATUS_TARGET_XFER_COUNT_MISMATCH:
398		desc = "target xfer count mismatch";
399		break;
400	case MPI2_IOCSTATUS_TARGET_DATA_OFFSET_ERROR:
401		desc = "target data offset error";
402		break;
403	case MPI2_IOCSTATUS_TARGET_TOO_MUCH_WRITE_DATA:
404		desc = "target too much write data";
405		break;
406	case MPI2_IOCSTATUS_TARGET_IU_TOO_SHORT:
407		desc = "target iu too short";
408		break;
409	case MPI2_IOCSTATUS_TARGET_ACK_NAK_TIMEOUT:
410		desc = "target ack nak timeout";
411		break;
412	case MPI2_IOCSTATUS_TARGET_NAK_RECEIVED:
413		desc = "target nak received";
414		break;
415
416/****************************************************************************
417*  Serial Attached SCSI values
418****************************************************************************/
419
420	case MPI2_IOCSTATUS_SAS_SMP_REQUEST_FAILED:
421		desc = "smp request failed";
422		break;
423	case MPI2_IOCSTATUS_SAS_SMP_DATA_OVERRUN:
424		desc = "smp data overrun";
425		break;
426
427/****************************************************************************
428*  Diagnostic Buffer Post / Diagnostic Release values
429****************************************************************************/
430
431	case MPI2_IOCSTATUS_DIAGNOSTIC_RELEASED:
432		desc = "diagnostic released";
433		break;
434	default:
435		break;
436	}
437
438	if (!desc)
439		return;
440
441	switch (request_hdr->Function) {
442	case MPI2_FUNCTION_CONFIG:
443		frame_sz = sizeof(Mpi2ConfigRequest_t) + ioc->sge_size;
444		func_str = "config_page";
445		break;
446	case MPI2_FUNCTION_SCSI_TASK_MGMT:
447		frame_sz = sizeof(Mpi2SCSITaskManagementRequest_t);
448		func_str = "task_mgmt";
449		break;
450	case MPI2_FUNCTION_SAS_IO_UNIT_CONTROL:
451		frame_sz = sizeof(Mpi2SasIoUnitControlRequest_t);
452		func_str = "sas_iounit_ctl";
453		break;
454	case MPI2_FUNCTION_SCSI_ENCLOSURE_PROCESSOR:
455		frame_sz = sizeof(Mpi2SepRequest_t);
456		func_str = "enclosure";
457		break;
458	case MPI2_FUNCTION_IOC_INIT:
459		frame_sz = sizeof(Mpi2IOCInitRequest_t);
460		func_str = "ioc_init";
461		break;
462	case MPI2_FUNCTION_PORT_ENABLE:
463		frame_sz = sizeof(Mpi2PortEnableRequest_t);
464		func_str = "port_enable";
465		break;
466	case MPI2_FUNCTION_SMP_PASSTHROUGH:
467		frame_sz = sizeof(Mpi2SmpPassthroughRequest_t) + ioc->sge_size;
468		func_str = "smp_passthru";
469		break;
470	default:
471		frame_sz = 32;
472		func_str = "unknown";
473		break;
474	}
475
476	printk(MPT2SAS_WARN_FMT "ioc_status: %s(0x%04x), request(0x%p),"
477	    " (%s)\n", ioc->name, desc, ioc_status, request_hdr, func_str);
478
479	_debug_dump_mf(request_hdr, frame_sz/4);
480}
481
482/**
483 * _base_display_event_data - verbose translation of firmware asyn events
484 * @ioc: per adapter object
485 * @mpi_reply: reply mf payload returned from firmware
486 *
487 * Return nothing.
488 */
489static void
490_base_display_event_data(struct MPT2SAS_ADAPTER *ioc,
491    Mpi2EventNotificationReply_t *mpi_reply)
492{
493	char *desc = NULL;
494	u16 event;
495
496	if (!(ioc->logging_level & MPT_DEBUG_EVENTS))
497		return;
498
499	event = le16_to_cpu(mpi_reply->Event);
500
501	switch (event) {
502	case MPI2_EVENT_LOG_DATA:
503		desc = "Log Data";
504		break;
505	case MPI2_EVENT_STATE_CHANGE:
506		desc = "Status Change";
507		break;
508	case MPI2_EVENT_HARD_RESET_RECEIVED:
509		desc = "Hard Reset Received";
510		break;
511	case MPI2_EVENT_EVENT_CHANGE:
512		desc = "Event Change";
513		break;
514	case MPI2_EVENT_TASK_SET_FULL:
515		desc = "Task Set Full";
516		break;
517	case MPI2_EVENT_SAS_DEVICE_STATUS_CHANGE:
518		desc = "Device Status Change";
519		break;
520	case MPI2_EVENT_IR_OPERATION_STATUS:
521		desc = "IR Operation Status";
522		break;
523	case MPI2_EVENT_SAS_DISCOVERY:
524	{
525		Mpi2EventDataSasDiscovery_t *event_data =
526		    (Mpi2EventDataSasDiscovery_t *)mpi_reply->EventData;
527		printk(MPT2SAS_INFO_FMT "Discovery: (%s)", ioc->name,
528		    (event_data->ReasonCode == MPI2_EVENT_SAS_DISC_RC_STARTED) ?
529		    "start" : "stop");
530		if (event_data->DiscoveryStatus)
531			printk("discovery_status(0x%08x)",
532			    le32_to_cpu(event_data->DiscoveryStatus));
533			printk("\n");
534		return;
535	}
536	case MPI2_EVENT_SAS_BROADCAST_PRIMITIVE:
537		desc = "SAS Broadcast Primitive";
538		break;
539	case MPI2_EVENT_SAS_INIT_DEVICE_STATUS_CHANGE:
540		desc = "SAS Init Device Status Change";
541		break;
542	case MPI2_EVENT_SAS_INIT_TABLE_OVERFLOW:
543		desc = "SAS Init Table Overflow";
544		break;
545	case MPI2_EVENT_SAS_TOPOLOGY_CHANGE_LIST:
546		desc = "SAS Topology Change List";
547		break;
548	case MPI2_EVENT_SAS_ENCL_DEVICE_STATUS_CHANGE:
549		desc = "SAS Enclosure Device Status Change";
550		break;
551	case MPI2_EVENT_IR_VOLUME:
552		desc = "IR Volume";
553		break;
554	case MPI2_EVENT_IR_PHYSICAL_DISK:
555		desc = "IR Physical Disk";
556		break;
557	case MPI2_EVENT_IR_CONFIGURATION_CHANGE_LIST:
558		desc = "IR Configuration Change List";
559		break;
560	case MPI2_EVENT_LOG_ENTRY_ADDED:
561		desc = "Log Entry Added";
562		break;
563	}
564
565	if (!desc)
566		return;
567
568	printk(MPT2SAS_INFO_FMT "%s\n", ioc->name, desc);
569}
570#endif
571
572/**
573 * _base_sas_log_info - verbose translation of firmware log info
574 * @ioc: per adapter object
575 * @log_info: log info
576 *
577 * Return nothing.
578 */
579static void
580_base_sas_log_info(struct MPT2SAS_ADAPTER *ioc , u32 log_info)
581{
582	union loginfo_type {
583		u32	loginfo;
584		struct {
585			u32	subcode:16;
586			u32	code:8;
587			u32	originator:4;
588			u32	bus_type:4;
589		} dw;
590	};
591	union loginfo_type sas_loginfo;
592	char *originator_str = NULL;
593
594	sas_loginfo.loginfo = log_info;
595	if (sas_loginfo.dw.bus_type != 3 /*SAS*/)
596		return;
597
598	/* each nexus loss loginfo */
599	if (log_info == 0x31170000)
600		return;
601
602	/* eat the loginfos associated with task aborts */
603	if (ioc->ignore_loginfos && (log_info == 30050000 || log_info ==
604	    0x31140000 || log_info == 0x31130000))
605		return;
606
607	switch (sas_loginfo.dw.originator) {
608	case 0:
609		originator_str = "IOP";
610		break;
611	case 1:
612		originator_str = "PL";
613		break;
614	case 2:
615		originator_str = "IR";
616		break;
617	}
618
619	printk(MPT2SAS_WARN_FMT "log_info(0x%08x): originator(%s), "
620	    "code(0x%02x), sub_code(0x%04x)\n", ioc->name, log_info,
621	     originator_str, sas_loginfo.dw.code,
622	     sas_loginfo.dw.subcode);
623}
624
625/**
626 * _base_display_reply_info -
627 * @ioc: per adapter object
628 * @smid: system request message index
629 * @msix_index: MSIX table index supplied by the OS
630 * @reply: reply message frame(lower 32bit addr)
631 *
632 * Return nothing.
633 */
634static void
635_base_display_reply_info(struct MPT2SAS_ADAPTER *ioc, u16 smid, u8 msix_index,
636    u32 reply)
637{
638	MPI2DefaultReply_t *mpi_reply;
639	u16 ioc_status;
640
641	mpi_reply = mpt2sas_base_get_reply_virt_addr(ioc, reply);
642	ioc_status = le16_to_cpu(mpi_reply->IOCStatus);
643#ifdef CONFIG_SCSI_MPT2SAS_LOGGING
644	if ((ioc_status & MPI2_IOCSTATUS_MASK) &&
645	    (ioc->logging_level & MPT_DEBUG_REPLY)) {
646		_base_sas_ioc_info(ioc , mpi_reply,
647		   mpt2sas_base_get_msg_frame(ioc, smid));
648	}
649#endif
650	if (ioc_status & MPI2_IOCSTATUS_FLAG_LOG_INFO_AVAILABLE)
651		_base_sas_log_info(ioc, le32_to_cpu(mpi_reply->IOCLogInfo));
652}
653
654/**
655 * mpt2sas_base_done - base internal command completion routine
656 * @ioc: per adapter object
657 * @smid: system request message index
658 * @msix_index: MSIX table index supplied by the OS
659 * @reply: reply message frame(lower 32bit addr)
660 *
661 * Return 1 meaning mf should be freed from _base_interrupt
662 *        0 means the mf is freed from this function.
663 */
664u8
665mpt2sas_base_done(struct MPT2SAS_ADAPTER *ioc, u16 smid, u8 msix_index,
666    u32 reply)
667{
668	MPI2DefaultReply_t *mpi_reply;
669
670	mpi_reply = mpt2sas_base_get_reply_virt_addr(ioc, reply);
671	if (mpi_reply && mpi_reply->Function == MPI2_FUNCTION_EVENT_ACK)
672		return 1;
673
674	if (ioc->base_cmds.status == MPT2_CMD_NOT_USED)
675		return 1;
676
677	ioc->base_cmds.status |= MPT2_CMD_COMPLETE;
678	if (mpi_reply) {
679		ioc->base_cmds.status |= MPT2_CMD_REPLY_VALID;
680		memcpy(ioc->base_cmds.reply, mpi_reply, mpi_reply->MsgLength*4);
681	}
682	ioc->base_cmds.status &= ~MPT2_CMD_PENDING;
683	complete(&ioc->base_cmds.done);
684	return 1;
685}
686
687/**
688 * _base_async_event - main callback handler for firmware asyn events
689 * @ioc: per adapter object
690 * @msix_index: MSIX table index supplied by the OS
691 * @reply: reply message frame(lower 32bit addr)
692 *
693 * Return 1 meaning mf should be freed from _base_interrupt
694 *        0 means the mf is freed from this function.
695 */
696static u8
697_base_async_event(struct MPT2SAS_ADAPTER *ioc, u8 msix_index, u32 reply)
698{
699	Mpi2EventNotificationReply_t *mpi_reply;
700	Mpi2EventAckRequest_t *ack_request;
701	u16 smid;
702
703	mpi_reply = mpt2sas_base_get_reply_virt_addr(ioc, reply);
704	if (!mpi_reply)
705		return 1;
706	if (mpi_reply->Function != MPI2_FUNCTION_EVENT_NOTIFICATION)
707		return 1;
708#ifdef CONFIG_SCSI_MPT2SAS_LOGGING
709	_base_display_event_data(ioc, mpi_reply);
710#endif
711	if (!(mpi_reply->AckRequired & MPI2_EVENT_NOTIFICATION_ACK_REQUIRED))
712		goto out;
713	smid = mpt2sas_base_get_smid(ioc, ioc->base_cb_idx);
714	if (!smid) {
715		printk(MPT2SAS_ERR_FMT "%s: failed obtaining a smid\n",
716		    ioc->name, __func__);
717		goto out;
718	}
719
720	ack_request = mpt2sas_base_get_msg_frame(ioc, smid);
721	memset(ack_request, 0, sizeof(Mpi2EventAckRequest_t));
722	ack_request->Function = MPI2_FUNCTION_EVENT_ACK;
723	ack_request->Event = mpi_reply->Event;
724	ack_request->EventContext = mpi_reply->EventContext;
725	ack_request->VF_ID = 0;  /* TODO */
726	ack_request->VP_ID = 0;
727	mpt2sas_base_put_smid_default(ioc, smid);
728
729 out:
730
731	/* scsih callback handler */
732	mpt2sas_scsih_event_callback(ioc, msix_index, reply);
733
734	/* ctl callback handler */
735	mpt2sas_ctl_event_callback(ioc, msix_index, reply);
736
737	return 1;
738}
739
740/**
741 * _base_get_cb_idx - obtain the callback index
742 * @ioc: per adapter object
743 * @smid: system request message index
744 *
745 * Return callback index.
746 */
747static u8
748_base_get_cb_idx(struct MPT2SAS_ADAPTER *ioc, u16 smid)
749{
750	int i;
751	u8 cb_idx = 0xFF;
752
753	if (smid >= ioc->hi_priority_smid) {
754		if (smid < ioc->internal_smid) {
755			i = smid - ioc->hi_priority_smid;
756			cb_idx = ioc->hpr_lookup[i].cb_idx;
757		} else {
758			i = smid - ioc->internal_smid;
759			cb_idx = ioc->internal_lookup[i].cb_idx;
760		}
761	} else {
762		i = smid - 1;
763		cb_idx = ioc->scsi_lookup[i].cb_idx;
764	}
765	return cb_idx;
766}
767
768/**
769 * _base_mask_interrupts - disable interrupts
770 * @ioc: per adapter object
771 *
772 * Disabling ResetIRQ, Reply and Doorbell Interrupts
773 *
774 * Return nothing.
775 */
776static void
777_base_mask_interrupts(struct MPT2SAS_ADAPTER *ioc)
778{
779	u32 him_register;
780
781	ioc->mask_interrupts = 1;
782	him_register = readl(&ioc->chip->HostInterruptMask);
783	him_register |= MPI2_HIM_DIM + MPI2_HIM_RIM + MPI2_HIM_RESET_IRQ_MASK;
784	writel(him_register, &ioc->chip->HostInterruptMask);
785	readl(&ioc->chip->HostInterruptMask);
786}
787
788/**
789 * _base_unmask_interrupts - enable interrupts
790 * @ioc: per adapter object
791 *
792 * Enabling only Reply Interrupts
793 *
794 * Return nothing.
795 */
796static void
797_base_unmask_interrupts(struct MPT2SAS_ADAPTER *ioc)
798{
799	u32 him_register;
800
801	him_register = readl(&ioc->chip->HostInterruptMask);
802	him_register &= ~MPI2_HIM_RIM;
803	writel(him_register, &ioc->chip->HostInterruptMask);
804	ioc->mask_interrupts = 0;
805}
806
807union reply_descriptor {
808	u64 word;
809	struct {
810		u32 low;
811		u32 high;
812	} u;
813};
814
815/**
816 * _base_interrupt - MPT adapter (IOC) specific interrupt handler.
817 * @irq: irq number (not used)
818 * @bus_id: bus identifier cookie == pointer to MPT_ADAPTER structure
819 * @r: pt_regs pointer (not used)
820 *
821 * Return IRQ_HANDLE if processed, else IRQ_NONE.
822 */
823static irqreturn_t
824_base_interrupt(int irq, void *bus_id)
825{
826	union reply_descriptor rd;
827	u32 completed_cmds;
828	u8 request_desript_type;
829	u16 smid;
830	u8 cb_idx;
831	u32 reply;
832	u8 msix_index;
833	struct MPT2SAS_ADAPTER *ioc = bus_id;
834	Mpi2ReplyDescriptorsUnion_t *rpf;
835	u8 rc;
836
837	if (ioc->mask_interrupts)
838		return IRQ_NONE;
839
840	rpf = &ioc->reply_post_free[ioc->reply_post_host_index];
841	request_desript_type = rpf->Default.ReplyFlags
842	     & MPI2_RPY_DESCRIPT_FLAGS_TYPE_MASK;
843	if (request_desript_type == MPI2_RPY_DESCRIPT_FLAGS_UNUSED)
844		return IRQ_NONE;
845
846	completed_cmds = 0;
847	do {
848		rd.word = rpf->Words;
849		if (rd.u.low == UINT_MAX || rd.u.high == UINT_MAX)
850			goto out;
851		reply = 0;
852		cb_idx = 0xFF;
853		smid = le16_to_cpu(rpf->Default.DescriptorTypeDependent1);
854		msix_index = rpf->Default.MSIxIndex;
855		if (request_desript_type ==
856		    MPI2_RPY_DESCRIPT_FLAGS_ADDRESS_REPLY) {
857			reply = le32_to_cpu
858				(rpf->AddressReply.ReplyFrameAddress);
859		} else if (request_desript_type ==
860		    MPI2_RPY_DESCRIPT_FLAGS_TARGET_COMMAND_BUFFER)
861			goto next;
862		else if (request_desript_type ==
863		    MPI2_RPY_DESCRIPT_FLAGS_TARGETASSIST_SUCCESS)
864			goto next;
865		if (smid)
866			cb_idx = _base_get_cb_idx(ioc, smid);
867		if (smid && cb_idx != 0xFF) {
868			rc = mpt_callbacks[cb_idx](ioc, smid, msix_index,
869			    reply);
870			if (reply)
871				_base_display_reply_info(ioc, smid, msix_index,
872				    reply);
873			if (rc)
874				mpt2sas_base_free_smid(ioc, smid);
875		}
876		if (!smid)
877			_base_async_event(ioc, msix_index, reply);
878
879		/* reply free queue handling */
880		if (reply) {
881			ioc->reply_free_host_index =
882			    (ioc->reply_free_host_index ==
883			    (ioc->reply_free_queue_depth - 1)) ?
884			    0 : ioc->reply_free_host_index + 1;
885			ioc->reply_free[ioc->reply_free_host_index] =
886			    cpu_to_le32(reply);
887			wmb();
888			writel(ioc->reply_free_host_index,
889			    &ioc->chip->ReplyFreeHostIndex);
890		}
891
892 next:
893
894		rpf->Words = ULLONG_MAX;
895		ioc->reply_post_host_index = (ioc->reply_post_host_index ==
896		    (ioc->reply_post_queue_depth - 1)) ? 0 :
897		    ioc->reply_post_host_index + 1;
898		request_desript_type =
899		    ioc->reply_post_free[ioc->reply_post_host_index].Default.
900		    ReplyFlags & MPI2_RPY_DESCRIPT_FLAGS_TYPE_MASK;
901		completed_cmds++;
902		if (request_desript_type == MPI2_RPY_DESCRIPT_FLAGS_UNUSED)
903			goto out;
904		if (!ioc->reply_post_host_index)
905			rpf = ioc->reply_post_free;
906		else
907			rpf++;
908	} while (1);
909
910 out:
911
912	if (!completed_cmds)
913		return IRQ_NONE;
914
915	wmb();
916	writel(ioc->reply_post_host_index, &ioc->chip->ReplyPostHostIndex);
917	return IRQ_HANDLED;
918}
919
920/**
921 * mpt2sas_base_release_callback_handler - clear interupt callback handler
922 * @cb_idx: callback index
923 *
924 * Return nothing.
925 */
926void
927mpt2sas_base_release_callback_handler(u8 cb_idx)
928{
929	mpt_callbacks[cb_idx] = NULL;
930}
931
932/**
933 * mpt2sas_base_register_callback_handler - obtain index for the interrupt callback handler
934 * @cb_func: callback function
935 *
936 * Returns cb_func.
937 */
938u8
939mpt2sas_base_register_callback_handler(MPT_CALLBACK cb_func)
940{
941	u8 cb_idx;
942
943	for (cb_idx = MPT_MAX_CALLBACKS-1; cb_idx; cb_idx--)
944		if (mpt_callbacks[cb_idx] == NULL)
945			break;
946
947	mpt_callbacks[cb_idx] = cb_func;
948	return cb_idx;
949}
950
951/**
952 * mpt2sas_base_initialize_callback_handler - initialize the interrupt callback handler
953 *
954 * Return nothing.
955 */
956void
957mpt2sas_base_initialize_callback_handler(void)
958{
959	u8 cb_idx;
960
961	for (cb_idx = 0; cb_idx < MPT_MAX_CALLBACKS; cb_idx++)
962		mpt2sas_base_release_callback_handler(cb_idx);
963}
964
965/**
966 * mpt2sas_base_build_zero_len_sge - build zero length sg entry
967 * @ioc: per adapter object
968 * @paddr: virtual address for SGE
969 *
970 * Create a zero length scatter gather entry to insure the IOCs hardware has
971 * something to use if the target device goes brain dead and tries
972 * to send data even when none is asked for.
973 *
974 * Return nothing.
975 */
976void
977mpt2sas_base_build_zero_len_sge(struct MPT2SAS_ADAPTER *ioc, void *paddr)
978{
979	u32 flags_length = (u32)((MPI2_SGE_FLAGS_LAST_ELEMENT |
980	    MPI2_SGE_FLAGS_END_OF_BUFFER | MPI2_SGE_FLAGS_END_OF_LIST |
981	    MPI2_SGE_FLAGS_SIMPLE_ELEMENT) <<
982	    MPI2_SGE_FLAGS_SHIFT);
983	ioc->base_add_sg_single(paddr, flags_length, -1);
984}
985
986/**
987 * _base_add_sg_single_32 - Place a simple 32 bit SGE at address pAddr.
988 * @paddr: virtual address for SGE
989 * @flags_length: SGE flags and data transfer length
990 * @dma_addr: Physical address
991 *
992 * Return nothing.
993 */
994static void
995_base_add_sg_single_32(void *paddr, u32 flags_length, dma_addr_t dma_addr)
996{
997	Mpi2SGESimple32_t *sgel = paddr;
998
999	flags_length |= (MPI2_SGE_FLAGS_32_BIT_ADDRESSING |
1000	    MPI2_SGE_FLAGS_SYSTEM_ADDRESS) << MPI2_SGE_FLAGS_SHIFT;
1001	sgel->FlagsLength = cpu_to_le32(flags_length);
1002	sgel->Address = cpu_to_le32(dma_addr);
1003}
1004
1005
1006/**
1007 * _base_add_sg_single_64 - Place a simple 64 bit SGE at address pAddr.
1008 * @paddr: virtual address for SGE
1009 * @flags_length: SGE flags and data transfer length
1010 * @dma_addr: Physical address
1011 *
1012 * Return nothing.
1013 */
1014static void
1015_base_add_sg_single_64(void *paddr, u32 flags_length, dma_addr_t dma_addr)
1016{
1017	Mpi2SGESimple64_t *sgel = paddr;
1018
1019	flags_length |= (MPI2_SGE_FLAGS_64_BIT_ADDRESSING |
1020	    MPI2_SGE_FLAGS_SYSTEM_ADDRESS) << MPI2_SGE_FLAGS_SHIFT;
1021	sgel->FlagsLength = cpu_to_le32(flags_length);
1022	sgel->Address = cpu_to_le64(dma_addr);
1023}
1024
1025#define convert_to_kb(x) ((x) << (PAGE_SHIFT - 10))
1026
1027/**
1028 * _base_config_dma_addressing - set dma addressing
1029 * @ioc: per adapter object
1030 * @pdev: PCI device struct
1031 *
1032 * Returns 0 for success, non-zero for failure.
1033 */
1034static int
1035_base_config_dma_addressing(struct MPT2SAS_ADAPTER *ioc, struct pci_dev *pdev)
1036{
1037	struct sysinfo s;
1038	char *desc = NULL;
1039
1040	if (sizeof(dma_addr_t) > 4) {
1041		const uint64_t required_mask =
1042		    dma_get_required_mask(&pdev->dev);
1043		if ((required_mask > DMA_BIT_MASK(32)) && !pci_set_dma_mask(pdev,
1044		    DMA_BIT_MASK(64)) && !pci_set_consistent_dma_mask(pdev,
1045		    DMA_BIT_MASK(64))) {
1046			ioc->base_add_sg_single = &_base_add_sg_single_64;
1047			ioc->sge_size = sizeof(Mpi2SGESimple64_t);
1048			desc = "64";
1049			goto out;
1050		}
1051	}
1052
1053	if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))
1054	    && !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) {
1055		ioc->base_add_sg_single = &_base_add_sg_single_32;
1056		ioc->sge_size = sizeof(Mpi2SGESimple32_t);
1057		desc = "32";
1058	} else
1059		return -ENODEV;
1060
1061 out:
1062	si_meminfo(&s);
1063	printk(MPT2SAS_INFO_FMT "%s BIT PCI BUS DMA ADDRESSING SUPPORTED, "
1064	    "total mem (%ld kB)\n", ioc->name, desc, convert_to_kb(s.totalram));
1065
1066	return 0;
1067}
1068
1069/**
1070 * _base_save_msix_table - backup msix vector table
1071 * @ioc: per adapter object
1072 *
1073 * This address an errata where diag reset clears out the table
1074 */
1075static void
1076_base_save_msix_table(struct MPT2SAS_ADAPTER *ioc)
1077{
1078	int i;
1079
1080	if (!ioc->msix_enable || ioc->msix_table_backup == NULL)
1081		return;
1082
1083	for (i = 0; i < ioc->msix_vector_count; i++)
1084		ioc->msix_table_backup[i] = ioc->msix_table[i];
1085}
1086
1087/**
1088 * _base_restore_msix_table - this restores the msix vector table
1089 * @ioc: per adapter object
1090 *
1091 */
1092static void
1093_base_restore_msix_table(struct MPT2SAS_ADAPTER *ioc)
1094{
1095	int i;
1096
1097	if (!ioc->msix_enable || ioc->msix_table_backup == NULL)
1098		return;
1099
1100	for (i = 0; i < ioc->msix_vector_count; i++)
1101		ioc->msix_table[i] = ioc->msix_table_backup[i];
1102}
1103
1104/**
1105 * _base_check_enable_msix - checks MSIX capabable.
1106 * @ioc: per adapter object
1107 *
1108 * Check to see if card is capable of MSIX, and set number
1109 * of avaliable msix vectors
1110 */
1111static int
1112_base_check_enable_msix(struct MPT2SAS_ADAPTER *ioc)
1113{
1114	int base;
1115	u16 message_control;
1116	u32 msix_table_offset;
1117
1118	base = pci_find_capability(ioc->pdev, PCI_CAP_ID_MSIX);
1119	if (!base) {
1120		dfailprintk(ioc, printk(MPT2SAS_INFO_FMT "msix not "
1121		    "supported\n", ioc->name));
1122		return -EINVAL;
1123	}
1124
1125	/* get msix vector count */
1126	pci_read_config_word(ioc->pdev, base + 2, &message_control);
1127	ioc->msix_vector_count = (message_control & 0x3FF) + 1;
1128
1129	/* get msix table  */
1130	pci_read_config_dword(ioc->pdev, base + 4, &msix_table_offset);
1131	msix_table_offset &= 0xFFFFFFF8;
1132	ioc->msix_table = (u32 *)((void *)ioc->chip + msix_table_offset);
1133
1134	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "msix is supported, "
1135	    "vector_count(%d), table_offset(0x%08x), table(%p)\n", ioc->name,
1136	    ioc->msix_vector_count, msix_table_offset, ioc->msix_table));
1137	return 0;
1138}
1139
1140/**
1141 * _base_disable_msix - disables msix
1142 * @ioc: per adapter object
1143 *
1144 */
1145static void
1146_base_disable_msix(struct MPT2SAS_ADAPTER *ioc)
1147{
1148	if (ioc->msix_enable) {
1149		pci_disable_msix(ioc->pdev);
1150		kfree(ioc->msix_table_backup);
1151		ioc->msix_table_backup = NULL;
1152		ioc->msix_enable = 0;
1153	}
1154}
1155
1156/**
1157 * _base_enable_msix - enables msix, failback to io_apic
1158 * @ioc: per adapter object
1159 *
1160 */
1161static int
1162_base_enable_msix(struct MPT2SAS_ADAPTER *ioc)
1163{
1164	struct msix_entry entries;
1165	int r;
1166	u8 try_msix = 0;
1167
1168	if (msix_disable == -1 || msix_disable == 0)
1169		try_msix = 1;
1170
1171	if (!try_msix)
1172		goto try_ioapic;
1173
1174	if (_base_check_enable_msix(ioc) != 0)
1175		goto try_ioapic;
1176
1177	ioc->msix_table_backup = kcalloc(ioc->msix_vector_count,
1178	    sizeof(u32), GFP_KERNEL);
1179	if (!ioc->msix_table_backup) {
1180		dfailprintk(ioc, printk(MPT2SAS_INFO_FMT "allocation for "
1181		    "msix_table_backup failed!!!\n", ioc->name));
1182		goto try_ioapic;
1183	}
1184
1185	memset(&entries, 0, sizeof(struct msix_entry));
1186	r = pci_enable_msix(ioc->pdev, &entries, 1);
1187	if (r) {
1188		dfailprintk(ioc, printk(MPT2SAS_INFO_FMT "pci_enable_msix "
1189		    "failed (r=%d) !!!\n", ioc->name, r));
1190		goto try_ioapic;
1191	}
1192
1193	r = request_irq(entries.vector, _base_interrupt, IRQF_SHARED,
1194	    ioc->name, ioc);
1195	if (r) {
1196		dfailprintk(ioc, printk(MPT2SAS_INFO_FMT "unable to allocate "
1197		    "interrupt %d !!!\n", ioc->name, entries.vector));
1198		pci_disable_msix(ioc->pdev);
1199		goto try_ioapic;
1200	}
1201
1202	ioc->pci_irq = entries.vector;
1203	ioc->msix_enable = 1;
1204	return 0;
1205
1206/* failback to io_apic interrupt routing */
1207 try_ioapic:
1208
1209	r = request_irq(ioc->pdev->irq, _base_interrupt, IRQF_SHARED,
1210	    ioc->name, ioc);
1211	if (r) {
1212		printk(MPT2SAS_ERR_FMT "unable to allocate interrupt %d!\n",
1213		    ioc->name, ioc->pdev->irq);
1214		r = -EBUSY;
1215		goto out_fail;
1216	}
1217
1218	ioc->pci_irq = ioc->pdev->irq;
1219	return 0;
1220
1221 out_fail:
1222	return r;
1223}
1224
1225/**
1226 * mpt2sas_base_map_resources - map in controller resources (io/irq/memap)
1227 * @ioc: per adapter object
1228 *
1229 * Returns 0 for success, non-zero for failure.
1230 */
1231int
1232mpt2sas_base_map_resources(struct MPT2SAS_ADAPTER *ioc)
1233{
1234	struct pci_dev *pdev = ioc->pdev;
1235	u32 memap_sz;
1236	u32 pio_sz;
1237	int i, r = 0;
1238	u64 pio_chip = 0;
1239	u64 chip_phys = 0;
1240
1241	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n",
1242	    ioc->name, __func__));
1243
1244	ioc->bars = pci_select_bars(pdev, IORESOURCE_MEM);
1245	if (pci_enable_device_mem(pdev)) {
1246		printk(MPT2SAS_WARN_FMT "pci_enable_device_mem: "
1247		    "failed\n", ioc->name);
1248		return -ENODEV;
1249	}
1250
1251
1252	if (pci_request_selected_regions(pdev, ioc->bars,
1253	    MPT2SAS_DRIVER_NAME)) {
1254		printk(MPT2SAS_WARN_FMT "pci_request_selected_regions: "
1255		    "failed\n", ioc->name);
1256		r = -ENODEV;
1257		goto out_fail;
1258	}
1259
1260	/* AER (Advanced Error Reporting) hooks */
1261	pci_enable_pcie_error_reporting(pdev);
1262
1263	pci_set_master(pdev);
1264
1265	if (_base_config_dma_addressing(ioc, pdev) != 0) {
1266		printk(MPT2SAS_WARN_FMT "no suitable DMA mask for %s\n",
1267		    ioc->name, pci_name(pdev));
1268		r = -ENODEV;
1269		goto out_fail;
1270	}
1271
1272	for (i = 0, memap_sz = 0, pio_sz = 0 ; i < DEVICE_COUNT_RESOURCE; i++) {
1273		if (pci_resource_flags(pdev, i) & IORESOURCE_IO) {
1274			if (pio_sz)
1275				continue;
1276			pio_chip = (u64)pci_resource_start(pdev, i);
1277			pio_sz = pci_resource_len(pdev, i);
1278		} else {
1279			if (memap_sz)
1280				continue;
1281			/* verify memory resource is valid before using */
1282			if (pci_resource_flags(pdev, i) & IORESOURCE_MEM) {
1283				ioc->chip_phys = pci_resource_start(pdev, i);
1284				chip_phys = (u64)ioc->chip_phys;
1285				memap_sz = pci_resource_len(pdev, i);
1286				ioc->chip = ioremap(ioc->chip_phys, memap_sz);
1287				if (ioc->chip == NULL) {
1288					printk(MPT2SAS_ERR_FMT "unable to map "
1289					    "adapter memory!\n", ioc->name);
1290					r = -EINVAL;
1291					goto out_fail;
1292				}
1293			}
1294		}
1295	}
1296
1297	_base_mask_interrupts(ioc);
1298	r = _base_enable_msix(ioc);
1299	if (r)
1300		goto out_fail;
1301
1302	printk(MPT2SAS_INFO_FMT "%s: IRQ %d\n",
1303	    ioc->name,  ((ioc->msix_enable) ? "PCI-MSI-X enabled" :
1304	    "IO-APIC enabled"), ioc->pci_irq);
1305	printk(MPT2SAS_INFO_FMT "iomem(0x%016llx), mapped(0x%p), size(%d)\n",
1306	    ioc->name, (unsigned long long)chip_phys, ioc->chip, memap_sz);
1307	printk(MPT2SAS_INFO_FMT "ioport(0x%016llx), size(%d)\n",
1308	    ioc->name, (unsigned long long)pio_chip, pio_sz);
1309
1310	return 0;
1311
1312 out_fail:
1313	if (ioc->chip_phys)
1314		iounmap(ioc->chip);
1315	ioc->chip_phys = 0;
1316	ioc->pci_irq = -1;
1317	pci_release_selected_regions(ioc->pdev, ioc->bars);
1318	pci_disable_pcie_error_reporting(pdev);
1319	pci_disable_device(pdev);
1320	return r;
1321}
1322
1323/**
1324 * mpt2sas_base_get_msg_frame - obtain request mf pointer
1325 * @ioc: per adapter object
1326 * @smid: system request message index(smid zero is invalid)
1327 *
1328 * Returns virt pointer to message frame.
1329 */
1330void *
1331mpt2sas_base_get_msg_frame(struct MPT2SAS_ADAPTER *ioc, u16 smid)
1332{
1333	return (void *)(ioc->request + (smid * ioc->request_sz));
1334}
1335
1336/**
1337 * mpt2sas_base_get_sense_buffer - obtain a sense buffer assigned to a mf request
1338 * @ioc: per adapter object
1339 * @smid: system request message index
1340 *
1341 * Returns virt pointer to sense buffer.
1342 */
1343void *
1344mpt2sas_base_get_sense_buffer(struct MPT2SAS_ADAPTER *ioc, u16 smid)
1345{
1346	return (void *)(ioc->sense + ((smid - 1) * SCSI_SENSE_BUFFERSIZE));
1347}
1348
1349/**
1350 * mpt2sas_base_get_sense_buffer_dma - obtain a sense buffer assigned to a mf request
1351 * @ioc: per adapter object
1352 * @smid: system request message index
1353 *
1354 * Returns phys pointer to the low 32bit address of the sense buffer.
1355 */
1356__le32
1357mpt2sas_base_get_sense_buffer_dma(struct MPT2SAS_ADAPTER *ioc, u16 smid)
1358{
1359	return cpu_to_le32(ioc->sense_dma +
1360			((smid - 1) * SCSI_SENSE_BUFFERSIZE));
1361}
1362
1363/**
1364 * mpt2sas_base_get_reply_virt_addr - obtain reply frames virt address
1365 * @ioc: per adapter object
1366 * @phys_addr: lower 32 physical addr of the reply
1367 *
1368 * Converts 32bit lower physical addr into a virt address.
1369 */
1370void *
1371mpt2sas_base_get_reply_virt_addr(struct MPT2SAS_ADAPTER *ioc, u32 phys_addr)
1372{
1373	if (!phys_addr)
1374		return NULL;
1375	return ioc->reply + (phys_addr - (u32)ioc->reply_dma);
1376}
1377
1378/**
1379 * mpt2sas_base_get_smid - obtain a free smid from internal queue
1380 * @ioc: per adapter object
1381 * @cb_idx: callback index
1382 *
1383 * Returns smid (zero is invalid)
1384 */
1385u16
1386mpt2sas_base_get_smid(struct MPT2SAS_ADAPTER *ioc, u8 cb_idx)
1387{
1388	unsigned long flags;
1389	struct request_tracker *request;
1390	u16 smid;
1391
1392	spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1393	if (list_empty(&ioc->internal_free_list)) {
1394		spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1395		printk(MPT2SAS_ERR_FMT "%s: smid not available\n",
1396		    ioc->name, __func__);
1397		return 0;
1398	}
1399
1400	request = list_entry(ioc->internal_free_list.next,
1401	    struct request_tracker, tracker_list);
1402	request->cb_idx = cb_idx;
1403	smid = request->smid;
1404	list_del(&request->tracker_list);
1405	spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1406	return smid;
1407}
1408
1409/**
1410 * mpt2sas_base_get_smid_scsiio - obtain a free smid from scsiio queue
1411 * @ioc: per adapter object
1412 * @cb_idx: callback index
1413 * @scmd: pointer to scsi command object
1414 *
1415 * Returns smid (zero is invalid)
1416 */
1417u16
1418mpt2sas_base_get_smid_scsiio(struct MPT2SAS_ADAPTER *ioc, u8 cb_idx,
1419    struct scsi_cmnd *scmd)
1420{
1421	unsigned long flags;
1422	struct request_tracker *request;
1423	u16 smid;
1424
1425	spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1426	if (list_empty(&ioc->free_list)) {
1427		spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1428		printk(MPT2SAS_ERR_FMT "%s: smid not available\n",
1429		    ioc->name, __func__);
1430		return 0;
1431	}
1432
1433	request = list_entry(ioc->free_list.next,
1434	    struct request_tracker, tracker_list);
1435	request->scmd = scmd;
1436	request->cb_idx = cb_idx;
1437	smid = request->smid;
1438	list_del(&request->tracker_list);
1439	spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1440	return smid;
1441}
1442
1443/**
1444 * mpt2sas_base_get_smid_hpr - obtain a free smid from hi-priority queue
1445 * @ioc: per adapter object
1446 * @cb_idx: callback index
1447 *
1448 * Returns smid (zero is invalid)
1449 */
1450u16
1451mpt2sas_base_get_smid_hpr(struct MPT2SAS_ADAPTER *ioc, u8 cb_idx)
1452{
1453	unsigned long flags;
1454	struct request_tracker *request;
1455	u16 smid;
1456
1457	spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1458	if (list_empty(&ioc->hpr_free_list)) {
1459		spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1460		return 0;
1461	}
1462
1463	request = list_entry(ioc->hpr_free_list.next,
1464	    struct request_tracker, tracker_list);
1465	request->cb_idx = cb_idx;
1466	smid = request->smid;
1467	list_del(&request->tracker_list);
1468	spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1469	return smid;
1470}
1471
1472
1473/**
1474 * mpt2sas_base_free_smid - put smid back on free_list
1475 * @ioc: per adapter object
1476 * @smid: system request message index
1477 *
1478 * Return nothing.
1479 */
1480void
1481mpt2sas_base_free_smid(struct MPT2SAS_ADAPTER *ioc, u16 smid)
1482{
1483	unsigned long flags;
1484	int i;
1485
1486	spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1487	if (smid >= ioc->hi_priority_smid) {
1488		if (smid < ioc->internal_smid) {
1489			/* hi-priority */
1490			i = smid - ioc->hi_priority_smid;
1491			ioc->hpr_lookup[i].cb_idx = 0xFF;
1492			list_add_tail(&ioc->hpr_lookup[i].tracker_list,
1493			    &ioc->hpr_free_list);
1494		} else {
1495			/* internal queue */
1496			i = smid - ioc->internal_smid;
1497			ioc->internal_lookup[i].cb_idx = 0xFF;
1498			list_add_tail(&ioc->internal_lookup[i].tracker_list,
1499			    &ioc->internal_free_list);
1500		}
1501		spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1502		return;
1503	}
1504
1505	/* scsiio queue */
1506	i = smid - 1;
1507	ioc->scsi_lookup[i].cb_idx = 0xFF;
1508	ioc->scsi_lookup[i].scmd = NULL;
1509	list_add_tail(&ioc->scsi_lookup[i].tracker_list,
1510	    &ioc->free_list);
1511	spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1512
1513	/*
1514	 * See _wait_for_commands_to_complete() call with regards to this code.
1515	 */
1516	if (ioc->shost_recovery && ioc->pending_io_count) {
1517		if (ioc->pending_io_count == 1)
1518			wake_up(&ioc->reset_wq);
1519		ioc->pending_io_count--;
1520	}
1521}
1522
1523/**
1524 * _base_writeq - 64 bit write to MMIO
1525 * @ioc: per adapter object
1526 * @b: data payload
1527 * @addr: address in MMIO space
1528 * @writeq_lock: spin lock
1529 *
1530 * Glue for handling an atomic 64 bit word to MMIO. This special handling takes
1531 * care of 32 bit environment where its not quarenteed to send the entire word
1532 * in one transfer.
1533 */
1534#ifndef writeq
1535static inline void _base_writeq(__u64 b, volatile void __iomem *addr,
1536    spinlock_t *writeq_lock)
1537{
1538	unsigned long flags;
1539	__u64 data_out = cpu_to_le64(b);
1540
1541	spin_lock_irqsave(writeq_lock, flags);
1542	writel((u32)(data_out), addr);
1543	writel((u32)(data_out >> 32), (addr + 4));
1544	spin_unlock_irqrestore(writeq_lock, flags);
1545}
1546#else
1547static inline void _base_writeq(__u64 b, volatile void __iomem *addr,
1548    spinlock_t *writeq_lock)
1549{
1550	writeq(cpu_to_le64(b), addr);
1551}
1552#endif
1553
1554/**
1555 * mpt2sas_base_put_smid_scsi_io - send SCSI_IO request to firmware
1556 * @ioc: per adapter object
1557 * @smid: system request message index
1558 * @handle: device handle
1559 *
1560 * Return nothing.
1561 */
1562void
1563mpt2sas_base_put_smid_scsi_io(struct MPT2SAS_ADAPTER *ioc, u16 smid, u16 handle)
1564{
1565	Mpi2RequestDescriptorUnion_t descriptor;
1566	u64 *request = (u64 *)&descriptor;
1567
1568
1569	descriptor.SCSIIO.RequestFlags = MPI2_REQ_DESCRIPT_FLAGS_SCSI_IO;
1570	descriptor.SCSIIO.MSIxIndex = 0; /* TODO */
1571	descriptor.SCSIIO.SMID = cpu_to_le16(smid);
1572	descriptor.SCSIIO.DevHandle = cpu_to_le16(handle);
1573	descriptor.SCSIIO.LMID = 0;
1574	_base_writeq(*request, &ioc->chip->RequestDescriptorPostLow,
1575	    &ioc->scsi_lookup_lock);
1576}
1577
1578
1579/**
1580 * mpt2sas_base_put_smid_hi_priority - send Task Managment request to firmware
1581 * @ioc: per adapter object
1582 * @smid: system request message index
1583 *
1584 * Return nothing.
1585 */
1586void
1587mpt2sas_base_put_smid_hi_priority(struct MPT2SAS_ADAPTER *ioc, u16 smid)
1588{
1589	Mpi2RequestDescriptorUnion_t descriptor;
1590	u64 *request = (u64 *)&descriptor;
1591
1592	descriptor.HighPriority.RequestFlags =
1593	    MPI2_REQ_DESCRIPT_FLAGS_HIGH_PRIORITY;
1594	descriptor.HighPriority.MSIxIndex = 0; /* TODO */
1595	descriptor.HighPriority.SMID = cpu_to_le16(smid);
1596	descriptor.HighPriority.LMID = 0;
1597	descriptor.HighPriority.Reserved1 = 0;
1598	_base_writeq(*request, &ioc->chip->RequestDescriptorPostLow,
1599	    &ioc->scsi_lookup_lock);
1600}
1601
1602/**
1603 * mpt2sas_base_put_smid_default - Default, primarily used for config pages
1604 * @ioc: per adapter object
1605 * @smid: system request message index
1606 *
1607 * Return nothing.
1608 */
1609void
1610mpt2sas_base_put_smid_default(struct MPT2SAS_ADAPTER *ioc, u16 smid)
1611{
1612	Mpi2RequestDescriptorUnion_t descriptor;
1613	u64 *request = (u64 *)&descriptor;
1614
1615	descriptor.Default.RequestFlags = MPI2_REQ_DESCRIPT_FLAGS_DEFAULT_TYPE;
1616	descriptor.Default.MSIxIndex = 0; /* TODO */
1617	descriptor.Default.SMID = cpu_to_le16(smid);
1618	descriptor.Default.LMID = 0;
1619	descriptor.Default.DescriptorTypeDependent = 0;
1620	_base_writeq(*request, &ioc->chip->RequestDescriptorPostLow,
1621	    &ioc->scsi_lookup_lock);
1622}
1623
1624/**
1625 * mpt2sas_base_put_smid_target_assist - send Target Assist/Status to firmware
1626 * @ioc: per adapter object
1627 * @smid: system request message index
1628 * @io_index: value used to track the IO
1629 *
1630 * Return nothing.
1631 */
1632void
1633mpt2sas_base_put_smid_target_assist(struct MPT2SAS_ADAPTER *ioc, u16 smid,
1634    u16 io_index)
1635{
1636	Mpi2RequestDescriptorUnion_t descriptor;
1637	u64 *request = (u64 *)&descriptor;
1638
1639	descriptor.SCSITarget.RequestFlags =
1640	    MPI2_REQ_DESCRIPT_FLAGS_SCSI_TARGET;
1641	descriptor.SCSITarget.MSIxIndex = 0; /* TODO */
1642	descriptor.SCSITarget.SMID = cpu_to_le16(smid);
1643	descriptor.SCSITarget.LMID = 0;
1644	descriptor.SCSITarget.IoIndex = cpu_to_le16(io_index);
1645	_base_writeq(*request, &ioc->chip->RequestDescriptorPostLow,
1646	    &ioc->scsi_lookup_lock);
1647}
1648
1649/**
1650 * _base_display_dell_branding - Disply branding string
1651 * @ioc: per adapter object
1652 *
1653 * Return nothing.
1654 */
1655static void
1656_base_display_dell_branding(struct MPT2SAS_ADAPTER *ioc)
1657{
1658	char dell_branding[MPT2SAS_DELL_BRANDING_SIZE];
1659
1660	if (ioc->pdev->subsystem_vendor != PCI_VENDOR_ID_DELL)
1661		return;
1662
1663	memset(dell_branding, 0, MPT2SAS_DELL_BRANDING_SIZE);
1664	switch (ioc->pdev->subsystem_device) {
1665	case MPT2SAS_DELL_6GBPS_SAS_HBA_SSDID:
1666		strncpy(dell_branding, MPT2SAS_DELL_6GBPS_SAS_HBA_BRANDING,
1667		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1668		break;
1669	case MPT2SAS_DELL_PERC_H200_ADAPTER_SSDID:
1670		strncpy(dell_branding, MPT2SAS_DELL_PERC_H200_ADAPTER_BRANDING,
1671		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1672		break;
1673	case MPT2SAS_DELL_PERC_H200_INTEGRATED_SSDID:
1674		strncpy(dell_branding,
1675		    MPT2SAS_DELL_PERC_H200_INTEGRATED_BRANDING,
1676		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1677		break;
1678	case MPT2SAS_DELL_PERC_H200_MODULAR_SSDID:
1679		strncpy(dell_branding,
1680		    MPT2SAS_DELL_PERC_H200_MODULAR_BRANDING,
1681		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1682		break;
1683	case MPT2SAS_DELL_PERC_H200_EMBEDDED_SSDID:
1684		strncpy(dell_branding,
1685		    MPT2SAS_DELL_PERC_H200_EMBEDDED_BRANDING,
1686		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1687		break;
1688	case MPT2SAS_DELL_PERC_H200_SSDID:
1689		strncpy(dell_branding, MPT2SAS_DELL_PERC_H200_BRANDING,
1690		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1691		break;
1692	case MPT2SAS_DELL_6GBPS_SAS_SSDID:
1693		strncpy(dell_branding, MPT2SAS_DELL_6GBPS_SAS_BRANDING,
1694		    MPT2SAS_DELL_BRANDING_SIZE - 1);
1695		break;
1696	default:
1697		sprintf(dell_branding, "0x%4X", ioc->pdev->subsystem_device);
1698		break;
1699	}
1700
1701	printk(MPT2SAS_INFO_FMT "%s: Vendor(0x%04X), Device(0x%04X),"
1702	    " SSVID(0x%04X), SSDID(0x%04X)\n", ioc->name, dell_branding,
1703	    ioc->pdev->vendor, ioc->pdev->device, ioc->pdev->subsystem_vendor,
1704	    ioc->pdev->subsystem_device);
1705}
1706
1707/**
1708 * _base_display_ioc_capabilities - Disply IOC's capabilities.
1709 * @ioc: per adapter object
1710 *
1711 * Return nothing.
1712 */
1713static void
1714_base_display_ioc_capabilities(struct MPT2SAS_ADAPTER *ioc)
1715{
1716	int i = 0;
1717	char desc[16];
1718	u8 revision;
1719	u32 iounit_pg1_flags;
1720
1721	pci_read_config_byte(ioc->pdev, PCI_CLASS_REVISION, &revision);
1722	strncpy(desc, ioc->manu_pg0.ChipName, 16);
1723	printk(MPT2SAS_INFO_FMT "%s: FWVersion(%02d.%02d.%02d.%02d), "
1724	   "ChipRevision(0x%02x), BiosVersion(%02d.%02d.%02d.%02d)\n",
1725	    ioc->name, desc,
1726	   (ioc->facts.FWVersion.Word & 0xFF000000) >> 24,
1727	   (ioc->facts.FWVersion.Word & 0x00FF0000) >> 16,
1728	   (ioc->facts.FWVersion.Word & 0x0000FF00) >> 8,
1729	   ioc->facts.FWVersion.Word & 0x000000FF,
1730	   revision,
1731	   (ioc->bios_pg3.BiosVersion & 0xFF000000) >> 24,
1732	   (ioc->bios_pg3.BiosVersion & 0x00FF0000) >> 16,
1733	   (ioc->bios_pg3.BiosVersion & 0x0000FF00) >> 8,
1734	    ioc->bios_pg3.BiosVersion & 0x000000FF);
1735
1736	_base_display_dell_branding(ioc);
1737
1738	printk(MPT2SAS_INFO_FMT "Protocol=(", ioc->name);
1739
1740	if (ioc->facts.ProtocolFlags & MPI2_IOCFACTS_PROTOCOL_SCSI_INITIATOR) {
1741		printk("Initiator");
1742		i++;
1743	}
1744
1745	if (ioc->facts.ProtocolFlags & MPI2_IOCFACTS_PROTOCOL_SCSI_TARGET) {
1746		printk("%sTarget", i ? "," : "");
1747		i++;
1748	}
1749
1750	i = 0;
1751	printk("), ");
1752	printk("Capabilities=(");
1753
1754	if (ioc->facts.IOCCapabilities &
1755	    MPI2_IOCFACTS_CAPABILITY_INTEGRATED_RAID) {
1756		printk("Raid");
1757		i++;
1758	}
1759
1760	if (ioc->facts.IOCCapabilities & MPI2_IOCFACTS_CAPABILITY_TLR) {
1761		printk("%sTLR", i ? "," : "");
1762		i++;
1763	}
1764
1765	if (ioc->facts.IOCCapabilities & MPI2_IOCFACTS_CAPABILITY_MULTICAST) {
1766		printk("%sMulticast", i ? "," : "");
1767		i++;
1768	}
1769
1770	if (ioc->facts.IOCCapabilities &
1771	    MPI2_IOCFACTS_CAPABILITY_BIDIRECTIONAL_TARGET) {
1772		printk("%sBIDI Target", i ? "," : "");
1773		i++;
1774	}
1775
1776	if (ioc->facts.IOCCapabilities & MPI2_IOCFACTS_CAPABILITY_EEDP) {
1777		printk("%sEEDP", i ? "," : "");
1778		i++;
1779	}
1780
1781	if (ioc->facts.IOCCapabilities &
1782	    MPI2_IOCFACTS_CAPABILITY_SNAPSHOT_BUFFER) {
1783		printk("%sSnapshot Buffer", i ? "," : "");
1784		i++;
1785	}
1786
1787	if (ioc->facts.IOCCapabilities &
1788	    MPI2_IOCFACTS_CAPABILITY_DIAG_TRACE_BUFFER) {
1789		printk("%sDiag Trace Buffer", i ? "," : "");
1790		i++;
1791	}
1792
1793	if (ioc->facts.IOCCapabilities &
1794	    MPI2_IOCFACTS_CAPABILITY_EXTENDED_BUFFER) {
1795		printk(KERN_INFO "%sDiag Extended Buffer", i ? "," : "");
1796		i++;
1797	}
1798
1799	if (ioc->facts.IOCCapabilities &
1800	    MPI2_IOCFACTS_CAPABILITY_TASK_SET_FULL_HANDLING) {
1801		printk("%sTask Set Full", i ? "," : "");
1802		i++;
1803	}
1804
1805	iounit_pg1_flags = le32_to_cpu(ioc->iounit_pg1.Flags);
1806	if (!(iounit_pg1_flags & MPI2_IOUNITPAGE1_NATIVE_COMMAND_Q_DISABLE)) {
1807		printk("%sNCQ", i ? "," : "");
1808		i++;
1809	}
1810
1811	printk(")\n");
1812}
1813
1814/**
1815 * _base_static_config_pages - static start of day config pages
1816 * @ioc: per adapter object
1817 *
1818 * Return nothing.
1819 */
1820static void
1821_base_static_config_pages(struct MPT2SAS_ADAPTER *ioc)
1822{
1823	Mpi2ConfigReply_t mpi_reply;
1824	u32 iounit_pg1_flags;
1825
1826	mpt2sas_config_get_manufacturing_pg0(ioc, &mpi_reply, &ioc->manu_pg0);
1827	if (ioc->ir_firmware)
1828		mpt2sas_config_get_manufacturing_pg10(ioc, &mpi_reply,
1829		    &ioc->manu_pg10);
1830	mpt2sas_config_get_bios_pg2(ioc, &mpi_reply, &ioc->bios_pg2);
1831	mpt2sas_config_get_bios_pg3(ioc, &mpi_reply, &ioc->bios_pg3);
1832	mpt2sas_config_get_ioc_pg8(ioc, &mpi_reply, &ioc->ioc_pg8);
1833	mpt2sas_config_get_iounit_pg0(ioc, &mpi_reply, &ioc->iounit_pg0);
1834	mpt2sas_config_get_iounit_pg1(ioc, &mpi_reply, &ioc->iounit_pg1);
1835	_base_display_ioc_capabilities(ioc);
1836
1837	/*
1838	 * Enable task_set_full handling in iounit_pg1 when the
1839	 * facts capabilities indicate that its supported.
1840	 */
1841	iounit_pg1_flags = le32_to_cpu(ioc->iounit_pg1.Flags);
1842	if ((ioc->facts.IOCCapabilities &
1843	    MPI2_IOCFACTS_CAPABILITY_TASK_SET_FULL_HANDLING))
1844		iounit_pg1_flags &=
1845		    ~MPI2_IOUNITPAGE1_DISABLE_TASK_SET_FULL_HANDLING;
1846	else
1847		iounit_pg1_flags |=
1848		    MPI2_IOUNITPAGE1_DISABLE_TASK_SET_FULL_HANDLING;
1849	ioc->iounit_pg1.Flags = cpu_to_le32(iounit_pg1_flags);
1850	mpt2sas_config_set_iounit_pg1(ioc, &mpi_reply, &ioc->iounit_pg1);
1851}
1852
1853/**
1854 * _base_release_memory_pools - release memory
1855 * @ioc: per adapter object
1856 *
1857 * Free memory allocated from _base_allocate_memory_pools.
1858 *
1859 * Return nothing.
1860 */
1861static void
1862_base_release_memory_pools(struct MPT2SAS_ADAPTER *ioc)
1863{
1864	dexitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
1865	    __func__));
1866
1867	if (ioc->request) {
1868		pci_free_consistent(ioc->pdev, ioc->request_dma_sz,
1869		    ioc->request,  ioc->request_dma);
1870		dexitprintk(ioc, printk(MPT2SAS_INFO_FMT "request_pool(0x%p)"
1871		    ": free\n", ioc->name, ioc->request));
1872		ioc->request = NULL;
1873	}
1874
1875	if (ioc->sense) {
1876		pci_pool_free(ioc->sense_dma_pool, ioc->sense, ioc->sense_dma);
1877		if (ioc->sense_dma_pool)
1878			pci_pool_destroy(ioc->sense_dma_pool);
1879		dexitprintk(ioc, printk(MPT2SAS_INFO_FMT "sense_pool(0x%p)"
1880		    ": free\n", ioc->name, ioc->sense));
1881		ioc->sense = NULL;
1882	}
1883
1884	if (ioc->reply) {
1885		pci_pool_free(ioc->reply_dma_pool, ioc->reply, ioc->reply_dma);
1886		if (ioc->reply_dma_pool)
1887			pci_pool_destroy(ioc->reply_dma_pool);
1888		dexitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply_pool(0x%p)"
1889		     ": free\n", ioc->name, ioc->reply));
1890		ioc->reply = NULL;
1891	}
1892
1893	if (ioc->reply_free) {
1894		pci_pool_free(ioc->reply_free_dma_pool, ioc->reply_free,
1895		    ioc->reply_free_dma);
1896		if (ioc->reply_free_dma_pool)
1897			pci_pool_destroy(ioc->reply_free_dma_pool);
1898		dexitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply_free_pool"
1899		    "(0x%p): free\n", ioc->name, ioc->reply_free));
1900		ioc->reply_free = NULL;
1901	}
1902
1903	if (ioc->reply_post_free) {
1904		pci_pool_free(ioc->reply_post_free_dma_pool,
1905		    ioc->reply_post_free, ioc->reply_post_free_dma);
1906		if (ioc->reply_post_free_dma_pool)
1907			pci_pool_destroy(ioc->reply_post_free_dma_pool);
1908		dexitprintk(ioc, printk(MPT2SAS_INFO_FMT
1909		    "reply_post_free_pool(0x%p): free\n", ioc->name,
1910		    ioc->reply_post_free));
1911		ioc->reply_post_free = NULL;
1912	}
1913
1914	if (ioc->config_page) {
1915		dexitprintk(ioc, printk(MPT2SAS_INFO_FMT
1916		    "config_page(0x%p): free\n", ioc->name,
1917		    ioc->config_page));
1918		pci_free_consistent(ioc->pdev, ioc->config_page_sz,
1919		    ioc->config_page, ioc->config_page_dma);
1920	}
1921
1922	if (ioc->scsi_lookup) {
1923		free_pages((ulong)ioc->scsi_lookup, ioc->scsi_lookup_pages);
1924		ioc->scsi_lookup = NULL;
1925	}
1926	kfree(ioc->hpr_lookup);
1927	kfree(ioc->internal_lookup);
1928}
1929
1930
1931/**
1932 * _base_allocate_memory_pools - allocate start of day memory pools
1933 * @ioc: per adapter object
1934 * @sleep_flag: CAN_SLEEP or NO_SLEEP
1935 *
1936 * Returns 0 success, anything else error
1937 */
1938static int
1939_base_allocate_memory_pools(struct MPT2SAS_ADAPTER *ioc,  int sleep_flag)
1940{
1941	Mpi2IOCFactsReply_t *facts;
1942	u32 queue_size, queue_diff;
1943	u16 max_sge_elements;
1944	u16 num_of_reply_frames;
1945	u16 chains_needed_per_io;
1946	u32 sz, total_sz;
1947	u32 retry_sz;
1948	u16 max_request_credit;
1949
1950	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
1951	    __func__));
1952
1953	retry_sz = 0;
1954	facts = &ioc->facts;
1955
1956	/* command line tunables  for max sgl entries */
1957	if (max_sgl_entries != -1) {
1958		ioc->shost->sg_tablesize = (max_sgl_entries <
1959		    MPT2SAS_SG_DEPTH) ? max_sgl_entries :
1960		    MPT2SAS_SG_DEPTH;
1961	} else {
1962		ioc->shost->sg_tablesize = MPT2SAS_SG_DEPTH;
1963	}
1964
1965	/* command line tunables  for max controller queue depth */
1966	if (max_queue_depth != -1) {
1967		max_request_credit = (max_queue_depth < facts->RequestCredit)
1968		    ? max_queue_depth : facts->RequestCredit;
1969	} else {
1970		max_request_credit = (facts->RequestCredit >
1971		    MPT2SAS_MAX_REQUEST_QUEUE) ? MPT2SAS_MAX_REQUEST_QUEUE :
1972		    facts->RequestCredit;
1973	}
1974
1975	ioc->hba_queue_depth = max_request_credit;
1976	ioc->hi_priority_depth = facts->HighPriorityCredit;
1977	ioc->internal_depth = ioc->hi_priority_depth + 5;
1978
1979	/* request frame size */
1980	ioc->request_sz = facts->IOCRequestFrameSize * 4;
1981
1982	/* reply frame size */
1983	ioc->reply_sz = facts->ReplyFrameSize * 4;
1984
1985 retry_allocation:
1986	total_sz = 0;
1987	/* calculate number of sg elements left over in the 1st frame */
1988	max_sge_elements = ioc->request_sz - ((sizeof(Mpi2SCSIIORequest_t) -
1989	    sizeof(Mpi2SGEIOUnion_t)) + ioc->sge_size);
1990	ioc->max_sges_in_main_message = max_sge_elements/ioc->sge_size;
1991
1992	/* now do the same for a chain buffer */
1993	max_sge_elements = ioc->request_sz - ioc->sge_size;
1994	ioc->max_sges_in_chain_message = max_sge_elements/ioc->sge_size;
1995
1996	ioc->chain_offset_value_for_main_message =
1997	    ((sizeof(Mpi2SCSIIORequest_t) - sizeof(Mpi2SGEIOUnion_t)) +
1998	     (ioc->max_sges_in_chain_message * ioc->sge_size)) / 4;
1999
2000	/*
2001	 *  MPT2SAS_SG_DEPTH = CONFIG_FUSION_MAX_SGE
2002	 */
2003	chains_needed_per_io = ((ioc->shost->sg_tablesize -
2004	   ioc->max_sges_in_main_message)/ioc->max_sges_in_chain_message)
2005	    + 1;
2006	if (chains_needed_per_io > facts->MaxChainDepth) {
2007		chains_needed_per_io = facts->MaxChainDepth;
2008		ioc->shost->sg_tablesize = min_t(u16,
2009		ioc->max_sges_in_main_message + (ioc->max_sges_in_chain_message
2010		* chains_needed_per_io), ioc->shost->sg_tablesize);
2011	}
2012	ioc->chains_needed_per_io = chains_needed_per_io;
2013
2014	/* reply free queue sizing - taking into account for events */
2015	num_of_reply_frames = ioc->hba_queue_depth + 32;
2016
2017	/* number of replies frames can't be a multiple of 16 */
2018	/* decrease number of reply frames by 1 */
2019	if (!(num_of_reply_frames % 16))
2020		num_of_reply_frames--;
2021
2022	/* calculate number of reply free queue entries
2023	 *  (must be multiple of 16)
2024	 */
2025
2026	/* (we know reply_free_queue_depth is not a multiple of 16) */
2027	queue_size = num_of_reply_frames;
2028	queue_size += 16 - (queue_size % 16);
2029	ioc->reply_free_queue_depth = queue_size;
2030
2031	/* reply descriptor post queue sizing */
2032	/* this size should be the number of request frames + number of reply
2033	 * frames
2034	 */
2035
2036	queue_size = ioc->hba_queue_depth + num_of_reply_frames + 1;
2037	/* round up to 16 byte boundary */
2038	if (queue_size % 16)
2039		queue_size += 16 - (queue_size % 16);
2040
2041	/* check against IOC maximum reply post queue depth */
2042	if (queue_size > facts->MaxReplyDescriptorPostQueueDepth) {
2043		queue_diff = queue_size -
2044		    facts->MaxReplyDescriptorPostQueueDepth;
2045
2046		/* round queue_diff up to multiple of 16 */
2047		if (queue_diff % 16)
2048			queue_diff += 16 - (queue_diff % 16);
2049
2050		/* adjust hba_queue_depth, reply_free_queue_depth,
2051		 * and queue_size
2052		 */
2053		ioc->hba_queue_depth -= queue_diff;
2054		ioc->reply_free_queue_depth -= queue_diff;
2055		queue_size -= queue_diff;
2056	}
2057	ioc->reply_post_queue_depth = queue_size;
2058
2059	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "scatter gather: "
2060	    "sge_in_main_msg(%d), sge_per_chain(%d), sge_per_io(%d), "
2061	    "chains_per_io(%d)\n", ioc->name, ioc->max_sges_in_main_message,
2062	    ioc->max_sges_in_chain_message, ioc->shost->sg_tablesize,
2063	    ioc->chains_needed_per_io));
2064
2065	ioc->scsiio_depth = ioc->hba_queue_depth -
2066	    ioc->hi_priority_depth - ioc->internal_depth;
2067
2068	/* set the scsi host can_queue depth
2069	 * with some internal commands that could be outstanding
2070	 */
2071	ioc->shost->can_queue = ioc->scsiio_depth - (2);
2072	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "scsi host: "
2073	    "can_queue depth (%d)\n", ioc->name, ioc->shost->can_queue));
2074
2075	/* contiguous pool for request and chains, 16 byte align, one extra "
2076	 * "frame for smid=0
2077	 */
2078	ioc->chain_depth = ioc->chains_needed_per_io * ioc->scsiio_depth;
2079	sz = ((ioc->scsiio_depth + 1 + ioc->chain_depth) * ioc->request_sz);
2080
2081	/* hi-priority queue */
2082	sz += (ioc->hi_priority_depth * ioc->request_sz);
2083
2084	/* internal queue */
2085	sz += (ioc->internal_depth * ioc->request_sz);
2086
2087	ioc->request_dma_sz = sz;
2088	ioc->request = pci_alloc_consistent(ioc->pdev, sz, &ioc->request_dma);
2089	if (!ioc->request) {
2090		printk(MPT2SAS_ERR_FMT "request pool: pci_alloc_consistent "
2091		    "failed: hba_depth(%d), chains_per_io(%d), frame_sz(%d), "
2092		    "total(%d kB)\n", ioc->name, ioc->hba_queue_depth,
2093		    ioc->chains_needed_per_io, ioc->request_sz, sz/1024);
2094		if (ioc->scsiio_depth < MPT2SAS_SAS_QUEUE_DEPTH)
2095			goto out;
2096		retry_sz += 64;
2097		ioc->hba_queue_depth = max_request_credit - retry_sz;
2098		goto retry_allocation;
2099	}
2100
2101	if (retry_sz)
2102		printk(MPT2SAS_ERR_FMT "request pool: pci_alloc_consistent "
2103		    "succeed: hba_depth(%d), chains_per_io(%d), frame_sz(%d), "
2104		    "total(%d kb)\n", ioc->name, ioc->hba_queue_depth,
2105		    ioc->chains_needed_per_io, ioc->request_sz, sz/1024);
2106
2107
2108	/* hi-priority queue */
2109	ioc->hi_priority = ioc->request + ((ioc->scsiio_depth + 1) *
2110	    ioc->request_sz);
2111	ioc->hi_priority_dma = ioc->request_dma + ((ioc->scsiio_depth + 1) *
2112	    ioc->request_sz);
2113
2114	/* internal queue */
2115	ioc->internal = ioc->hi_priority + (ioc->hi_priority_depth *
2116	    ioc->request_sz);
2117	ioc->internal_dma = ioc->hi_priority_dma + (ioc->hi_priority_depth *
2118	    ioc->request_sz);
2119
2120	ioc->chain = ioc->internal + (ioc->internal_depth *
2121	    ioc->request_sz);
2122	ioc->chain_dma = ioc->internal_dma + (ioc->internal_depth *
2123	    ioc->request_sz);
2124
2125	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "request pool(0x%p): "
2126	    "depth(%d), frame_size(%d), pool_size(%d kB)\n", ioc->name,
2127	    ioc->request, ioc->hba_queue_depth, ioc->request_sz,
2128	    (ioc->hba_queue_depth * ioc->request_sz)/1024));
2129	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "chain pool(0x%p): depth"
2130	    "(%d), frame_size(%d), pool_size(%d kB)\n", ioc->name, ioc->chain,
2131	    ioc->chain_depth, ioc->request_sz, ((ioc->chain_depth *
2132	    ioc->request_sz))/1024));
2133	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "request pool: dma(0x%llx)\n",
2134	    ioc->name, (unsigned long long) ioc->request_dma));
2135	total_sz += sz;
2136
2137	sz = ioc->scsiio_depth * sizeof(struct request_tracker);
2138	ioc->scsi_lookup_pages = get_order(sz);
2139	ioc->scsi_lookup = (struct request_tracker *)__get_free_pages(
2140	    GFP_KERNEL, ioc->scsi_lookup_pages);
2141	if (!ioc->scsi_lookup) {
2142		printk(MPT2SAS_ERR_FMT "scsi_lookup: get_free_pages failed, "
2143		    "sz(%d)\n", ioc->name, (int)sz);
2144		goto out;
2145	}
2146
2147	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "scsiio(0x%p): "
2148	    "depth(%d)\n", ioc->name, ioc->request,
2149	    ioc->scsiio_depth));
2150
2151	/* initialize hi-priority queue smid's */
2152	ioc->hpr_lookup = kcalloc(ioc->hi_priority_depth,
2153	    sizeof(struct request_tracker), GFP_KERNEL);
2154	if (!ioc->hpr_lookup) {
2155		printk(MPT2SAS_ERR_FMT "hpr_lookup: kcalloc failed\n",
2156		    ioc->name);
2157		goto out;
2158	}
2159	ioc->hi_priority_smid = ioc->scsiio_depth + 1;
2160	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "hi_priority(0x%p): "
2161	    "depth(%d), start smid(%d)\n", ioc->name, ioc->hi_priority,
2162	    ioc->hi_priority_depth, ioc->hi_priority_smid));
2163
2164	/* initialize internal queue smid's */
2165	ioc->internal_lookup = kcalloc(ioc->internal_depth,
2166	    sizeof(struct request_tracker), GFP_KERNEL);
2167	if (!ioc->internal_lookup) {
2168		printk(MPT2SAS_ERR_FMT "internal_lookup: kcalloc failed\n",
2169		    ioc->name);
2170		goto out;
2171	}
2172	ioc->internal_smid = ioc->hi_priority_smid + ioc->hi_priority_depth;
2173	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "internal(0x%p): "
2174	    "depth(%d), start smid(%d)\n", ioc->name, ioc->internal,
2175	     ioc->internal_depth, ioc->internal_smid));
2176
2177	/* sense buffers, 4 byte align */
2178	sz = ioc->scsiio_depth * SCSI_SENSE_BUFFERSIZE;
2179	ioc->sense_dma_pool = pci_pool_create("sense pool", ioc->pdev, sz, 4,
2180	    0);
2181	if (!ioc->sense_dma_pool) {
2182		printk(MPT2SAS_ERR_FMT "sense pool: pci_pool_create failed\n",
2183		    ioc->name);
2184		goto out;
2185	}
2186	ioc->sense = pci_pool_alloc(ioc->sense_dma_pool , GFP_KERNEL,
2187	    &ioc->sense_dma);
2188	if (!ioc->sense) {
2189		printk(MPT2SAS_ERR_FMT "sense pool: pci_pool_alloc failed\n",
2190		    ioc->name);
2191		goto out;
2192	}
2193	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT
2194	    "sense pool(0x%p): depth(%d), element_size(%d), pool_size"
2195	    "(%d kB)\n", ioc->name, ioc->sense, ioc->scsiio_depth,
2196	    SCSI_SENSE_BUFFERSIZE, sz/1024));
2197	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "sense_dma(0x%llx)\n",
2198	    ioc->name, (unsigned long long)ioc->sense_dma));
2199	total_sz += sz;
2200
2201	/* reply pool, 4 byte align */
2202	sz = ioc->reply_free_queue_depth * ioc->reply_sz;
2203	ioc->reply_dma_pool = pci_pool_create("reply pool", ioc->pdev, sz, 4,
2204	    0);
2205	if (!ioc->reply_dma_pool) {
2206		printk(MPT2SAS_ERR_FMT "reply pool: pci_pool_create failed\n",
2207		    ioc->name);
2208		goto out;
2209	}
2210	ioc->reply = pci_pool_alloc(ioc->reply_dma_pool , GFP_KERNEL,
2211	    &ioc->reply_dma);
2212	if (!ioc->reply) {
2213		printk(MPT2SAS_ERR_FMT "reply pool: pci_pool_alloc failed\n",
2214		    ioc->name);
2215		goto out;
2216	}
2217	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply pool(0x%p): depth"
2218	    "(%d), frame_size(%d), pool_size(%d kB)\n", ioc->name, ioc->reply,
2219	    ioc->reply_free_queue_depth, ioc->reply_sz, sz/1024));
2220	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply_dma(0x%llx)\n",
2221	    ioc->name, (unsigned long long)ioc->reply_dma));
2222	total_sz += sz;
2223
2224	/* reply free queue, 16 byte align */
2225	sz = ioc->reply_free_queue_depth * 4;
2226	ioc->reply_free_dma_pool = pci_pool_create("reply_free pool",
2227	    ioc->pdev, sz, 16, 0);
2228	if (!ioc->reply_free_dma_pool) {
2229		printk(MPT2SAS_ERR_FMT "reply_free pool: pci_pool_create "
2230		    "failed\n", ioc->name);
2231		goto out;
2232	}
2233	ioc->reply_free = pci_pool_alloc(ioc->reply_free_dma_pool , GFP_KERNEL,
2234	    &ioc->reply_free_dma);
2235	if (!ioc->reply_free) {
2236		printk(MPT2SAS_ERR_FMT "reply_free pool: pci_pool_alloc "
2237		    "failed\n", ioc->name);
2238		goto out;
2239	}
2240	memset(ioc->reply_free, 0, sz);
2241	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply_free pool(0x%p): "
2242	    "depth(%d), element_size(%d), pool_size(%d kB)\n", ioc->name,
2243	    ioc->reply_free, ioc->reply_free_queue_depth, 4, sz/1024));
2244	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply_free_dma"
2245	    "(0x%llx)\n", ioc->name, (unsigned long long)ioc->reply_free_dma));
2246	total_sz += sz;
2247
2248	/* reply post queue, 16 byte align */
2249	sz = ioc->reply_post_queue_depth * sizeof(Mpi2DefaultReplyDescriptor_t);
2250	ioc->reply_post_free_dma_pool = pci_pool_create("reply_post_free pool",
2251	    ioc->pdev, sz, 16, 0);
2252	if (!ioc->reply_post_free_dma_pool) {
2253		printk(MPT2SAS_ERR_FMT "reply_post_free pool: pci_pool_create "
2254		    "failed\n", ioc->name);
2255		goto out;
2256	}
2257	ioc->reply_post_free = pci_pool_alloc(ioc->reply_post_free_dma_pool ,
2258	    GFP_KERNEL, &ioc->reply_post_free_dma);
2259	if (!ioc->reply_post_free) {
2260		printk(MPT2SAS_ERR_FMT "reply_post_free pool: pci_pool_alloc "
2261		    "failed\n", ioc->name);
2262		goto out;
2263	}
2264	memset(ioc->reply_post_free, 0, sz);
2265	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply post free pool"
2266	    "(0x%p): depth(%d), element_size(%d), pool_size(%d kB)\n",
2267	    ioc->name, ioc->reply_post_free, ioc->reply_post_queue_depth, 8,
2268	    sz/1024));
2269	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "reply_post_free_dma = "
2270	    "(0x%llx)\n", ioc->name, (unsigned long long)
2271	    ioc->reply_post_free_dma));
2272	total_sz += sz;
2273
2274	ioc->config_page_sz = 512;
2275	ioc->config_page = pci_alloc_consistent(ioc->pdev,
2276	    ioc->config_page_sz, &ioc->config_page_dma);
2277	if (!ioc->config_page) {
2278		printk(MPT2SAS_ERR_FMT "config page: pci_pool_alloc "
2279		    "failed\n", ioc->name);
2280		goto out;
2281	}
2282	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "config page(0x%p): size"
2283	    "(%d)\n", ioc->name, ioc->config_page, ioc->config_page_sz));
2284	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "config_page_dma"
2285	    "(0x%llx)\n", ioc->name, (unsigned long long)ioc->config_page_dma));
2286	total_sz += ioc->config_page_sz;
2287
2288	printk(MPT2SAS_INFO_FMT "Allocated physical memory: size(%d kB)\n",
2289	    ioc->name, total_sz/1024);
2290	printk(MPT2SAS_INFO_FMT "Current Controller Queue Depth(%d), "
2291	    "Max Controller Queue Depth(%d)\n",
2292	    ioc->name, ioc->shost->can_queue, facts->RequestCredit);
2293	printk(MPT2SAS_INFO_FMT "Scatter Gather Elements per IO(%d)\n",
2294	    ioc->name, ioc->shost->sg_tablesize);
2295	return 0;
2296
2297 out:
2298	_base_release_memory_pools(ioc);
2299	return -ENOMEM;
2300}
2301
2302
2303/**
2304 * mpt2sas_base_get_iocstate - Get the current state of a MPT adapter.
2305 * @ioc: Pointer to MPT_ADAPTER structure
2306 * @cooked: Request raw or cooked IOC state
2307 *
2308 * Returns all IOC Doorbell register bits if cooked==0, else just the
2309 * Doorbell bits in MPI_IOC_STATE_MASK.
2310 */
2311u32
2312mpt2sas_base_get_iocstate(struct MPT2SAS_ADAPTER *ioc, int cooked)
2313{
2314	u32 s, sc;
2315
2316	s = readl(&ioc->chip->Doorbell);
2317	sc = s & MPI2_IOC_STATE_MASK;
2318	return cooked ? sc : s;
2319}
2320
2321/**
2322 * _base_wait_on_iocstate - waiting on a particular ioc state
2323 * @ioc_state: controller state { READY, OPERATIONAL, or RESET }
2324 * @timeout: timeout in second
2325 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2326 *
2327 * Returns 0 for success, non-zero for failure.
2328 */
2329static int
2330_base_wait_on_iocstate(struct MPT2SAS_ADAPTER *ioc, u32 ioc_state, int timeout,
2331    int sleep_flag)
2332{
2333	u32 count, cntdn;
2334	u32 current_state;
2335
2336	count = 0;
2337	cntdn = (sleep_flag == CAN_SLEEP) ? 1000*timeout : 2000*timeout;
2338	do {
2339		current_state = mpt2sas_base_get_iocstate(ioc, 1);
2340		if (current_state == ioc_state)
2341			return 0;
2342		if (count && current_state == MPI2_IOC_STATE_FAULT)
2343			break;
2344		if (sleep_flag == CAN_SLEEP)
2345			msleep(1);
2346		else
2347			udelay(500);
2348		count++;
2349	} while (--cntdn);
2350
2351	return current_state;
2352}
2353
2354/**
2355 * _base_wait_for_doorbell_int - waiting for controller interrupt(generated by
2356 * a write to the doorbell)
2357 * @ioc: per adapter object
2358 * @timeout: timeout in second
2359 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2360 *
2361 * Returns 0 for success, non-zero for failure.
2362 *
2363 * Notes: MPI2_HIS_IOC2SYS_DB_STATUS - set to one when IOC writes to doorbell.
2364 */
2365static int
2366_base_wait_for_doorbell_int(struct MPT2SAS_ADAPTER *ioc, int timeout,
2367    int sleep_flag)
2368{
2369	u32 cntdn, count;
2370	u32 int_status;
2371
2372	count = 0;
2373	cntdn = (sleep_flag == CAN_SLEEP) ? 1000*timeout : 2000*timeout;
2374	do {
2375		int_status = readl(&ioc->chip->HostInterruptStatus);
2376		if (int_status & MPI2_HIS_IOC2SYS_DB_STATUS) {
2377			dhsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: "
2378			    "successfull count(%d), timeout(%d)\n", ioc->name,
2379			    __func__, count, timeout));
2380			return 0;
2381		}
2382		if (sleep_flag == CAN_SLEEP)
2383			msleep(1);
2384		else
2385			udelay(500);
2386		count++;
2387	} while (--cntdn);
2388
2389	printk(MPT2SAS_ERR_FMT "%s: failed due to timeout count(%d), "
2390	    "int_status(%x)!\n", ioc->name, __func__, count, int_status);
2391	return -EFAULT;
2392}
2393
2394/**
2395 * _base_wait_for_doorbell_ack - waiting for controller to read the doorbell.
2396 * @ioc: per adapter object
2397 * @timeout: timeout in second
2398 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2399 *
2400 * Returns 0 for success, non-zero for failure.
2401 *
2402 * Notes: MPI2_HIS_SYS2IOC_DB_STATUS - set to one when host writes to
2403 * doorbell.
2404 */
2405static int
2406_base_wait_for_doorbell_ack(struct MPT2SAS_ADAPTER *ioc, int timeout,
2407    int sleep_flag)
2408{
2409	u32 cntdn, count;
2410	u32 int_status;
2411	u32 doorbell;
2412
2413	count = 0;
2414	cntdn = (sleep_flag == CAN_SLEEP) ? 1000*timeout : 2000*timeout;
2415	do {
2416		int_status = readl(&ioc->chip->HostInterruptStatus);
2417		if (!(int_status & MPI2_HIS_SYS2IOC_DB_STATUS)) {
2418			dhsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: "
2419			    "successfull count(%d), timeout(%d)\n", ioc->name,
2420			    __func__, count, timeout));
2421			return 0;
2422		} else if (int_status & MPI2_HIS_IOC2SYS_DB_STATUS) {
2423			doorbell = readl(&ioc->chip->Doorbell);
2424			if ((doorbell & MPI2_IOC_STATE_MASK) ==
2425			    MPI2_IOC_STATE_FAULT) {
2426				mpt2sas_base_fault_info(ioc , doorbell);
2427				return -EFAULT;
2428			}
2429		} else if (int_status == 0xFFFFFFFF)
2430			goto out;
2431
2432		if (sleep_flag == CAN_SLEEP)
2433			msleep(1);
2434		else
2435			udelay(500);
2436		count++;
2437	} while (--cntdn);
2438
2439 out:
2440	printk(MPT2SAS_ERR_FMT "%s: failed due to timeout count(%d), "
2441	    "int_status(%x)!\n", ioc->name, __func__, count, int_status);
2442	return -EFAULT;
2443}
2444
2445/**
2446 * _base_wait_for_doorbell_not_used - waiting for doorbell to not be in use
2447 * @ioc: per adapter object
2448 * @timeout: timeout in second
2449 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2450 *
2451 * Returns 0 for success, non-zero for failure.
2452 *
2453 */
2454static int
2455_base_wait_for_doorbell_not_used(struct MPT2SAS_ADAPTER *ioc, int timeout,
2456    int sleep_flag)
2457{
2458	u32 cntdn, count;
2459	u32 doorbell_reg;
2460
2461	count = 0;
2462	cntdn = (sleep_flag == CAN_SLEEP) ? 1000*timeout : 2000*timeout;
2463	do {
2464		doorbell_reg = readl(&ioc->chip->Doorbell);
2465		if (!(doorbell_reg & MPI2_DOORBELL_USED)) {
2466			dhsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: "
2467			    "successfull count(%d), timeout(%d)\n", ioc->name,
2468			    __func__, count, timeout));
2469			return 0;
2470		}
2471		if (sleep_flag == CAN_SLEEP)
2472			msleep(1);
2473		else
2474			udelay(500);
2475		count++;
2476	} while (--cntdn);
2477
2478	printk(MPT2SAS_ERR_FMT "%s: failed due to timeout count(%d), "
2479	    "doorbell_reg(%x)!\n", ioc->name, __func__, count, doorbell_reg);
2480	return -EFAULT;
2481}
2482
2483/**
2484 * _base_send_ioc_reset - send doorbell reset
2485 * @ioc: per adapter object
2486 * @reset_type: currently only supports: MPI2_FUNCTION_IOC_MESSAGE_UNIT_RESET
2487 * @timeout: timeout in second
2488 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2489 *
2490 * Returns 0 for success, non-zero for failure.
2491 */
2492static int
2493_base_send_ioc_reset(struct MPT2SAS_ADAPTER *ioc, u8 reset_type, int timeout,
2494    int sleep_flag)
2495{
2496	u32 ioc_state;
2497	int r = 0;
2498
2499	if (reset_type != MPI2_FUNCTION_IOC_MESSAGE_UNIT_RESET) {
2500		printk(MPT2SAS_ERR_FMT "%s: unknown reset_type\n",
2501		    ioc->name, __func__);
2502		return -EFAULT;
2503	}
2504
2505	if (!(ioc->facts.IOCCapabilities &
2506	   MPI2_IOCFACTS_CAPABILITY_EVENT_REPLAY))
2507		return -EFAULT;
2508
2509	printk(MPT2SAS_INFO_FMT "sending message unit reset !!\n", ioc->name);
2510
2511	writel(reset_type << MPI2_DOORBELL_FUNCTION_SHIFT,
2512	    &ioc->chip->Doorbell);
2513	if ((_base_wait_for_doorbell_ack(ioc, 15, sleep_flag))) {
2514		r = -EFAULT;
2515		goto out;
2516	}
2517	ioc_state = _base_wait_on_iocstate(ioc, MPI2_IOC_STATE_READY,
2518	    timeout, sleep_flag);
2519	if (ioc_state) {
2520		printk(MPT2SAS_ERR_FMT "%s: failed going to ready state "
2521		    " (ioc_state=0x%x)\n", ioc->name, __func__, ioc_state);
2522		r = -EFAULT;
2523		goto out;
2524	}
2525 out:
2526	printk(MPT2SAS_INFO_FMT "message unit reset: %s\n",
2527	    ioc->name, ((r == 0) ? "SUCCESS" : "FAILED"));
2528	return r;
2529}
2530
2531/**
2532 * _base_handshake_req_reply_wait - send request thru doorbell interface
2533 * @ioc: per adapter object
2534 * @request_bytes: request length
2535 * @request: pointer having request payload
2536 * @reply_bytes: reply length
2537 * @reply: pointer to reply payload
2538 * @timeout: timeout in second
2539 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2540 *
2541 * Returns 0 for success, non-zero for failure.
2542 */
2543static int
2544_base_handshake_req_reply_wait(struct MPT2SAS_ADAPTER *ioc, int request_bytes,
2545    u32 *request, int reply_bytes, u16 *reply, int timeout, int sleep_flag)
2546{
2547	MPI2DefaultReply_t *default_reply = (MPI2DefaultReply_t *)reply;
2548	int i;
2549	u8 failed;
2550	u16 dummy;
2551	u32 *mfp;
2552
2553	/* make sure doorbell is not in use */
2554	if ((readl(&ioc->chip->Doorbell) & MPI2_DOORBELL_USED)) {
2555		printk(MPT2SAS_ERR_FMT "doorbell is in use "
2556		    " (line=%d)\n", ioc->name, __LINE__);
2557		return -EFAULT;
2558	}
2559
2560	/* clear pending doorbell interrupts from previous state changes */
2561	if (readl(&ioc->chip->HostInterruptStatus) &
2562	    MPI2_HIS_IOC2SYS_DB_STATUS)
2563		writel(0, &ioc->chip->HostInterruptStatus);
2564
2565	/* send message to ioc */
2566	writel(((MPI2_FUNCTION_HANDSHAKE<<MPI2_DOORBELL_FUNCTION_SHIFT) |
2567	    ((request_bytes/4)<<MPI2_DOORBELL_ADD_DWORDS_SHIFT)),
2568	    &ioc->chip->Doorbell);
2569
2570	if ((_base_wait_for_doorbell_int(ioc, 5, NO_SLEEP))) {
2571		printk(MPT2SAS_ERR_FMT "doorbell handshake "
2572		   "int failed (line=%d)\n", ioc->name, __LINE__);
2573		return -EFAULT;
2574	}
2575	writel(0, &ioc->chip->HostInterruptStatus);
2576
2577	if ((_base_wait_for_doorbell_ack(ioc, 5, sleep_flag))) {
2578		printk(MPT2SAS_ERR_FMT "doorbell handshake "
2579		    "ack failed (line=%d)\n", ioc->name, __LINE__);
2580		return -EFAULT;
2581	}
2582
2583	/* send message 32-bits at a time */
2584	for (i = 0, failed = 0; i < request_bytes/4 && !failed; i++) {
2585		writel(cpu_to_le32(request[i]), &ioc->chip->Doorbell);
2586		if ((_base_wait_for_doorbell_ack(ioc, 5, sleep_flag)))
2587			failed = 1;
2588	}
2589
2590	if (failed) {
2591		printk(MPT2SAS_ERR_FMT "doorbell handshake "
2592		    "sending request failed (line=%d)\n", ioc->name, __LINE__);
2593		return -EFAULT;
2594	}
2595
2596	/* now wait for the reply */
2597	if ((_base_wait_for_doorbell_int(ioc, timeout, sleep_flag))) {
2598		printk(MPT2SAS_ERR_FMT "doorbell handshake "
2599		   "int failed (line=%d)\n", ioc->name, __LINE__);
2600		return -EFAULT;
2601	}
2602
2603	/* read the first two 16-bits, it gives the total length of the reply */
2604	reply[0] = le16_to_cpu(readl(&ioc->chip->Doorbell)
2605	    & MPI2_DOORBELL_DATA_MASK);
2606	writel(0, &ioc->chip->HostInterruptStatus);
2607	if ((_base_wait_for_doorbell_int(ioc, 5, sleep_flag))) {
2608		printk(MPT2SAS_ERR_FMT "doorbell handshake "
2609		   "int failed (line=%d)\n", ioc->name, __LINE__);
2610		return -EFAULT;
2611	}
2612	reply[1] = le16_to_cpu(readl(&ioc->chip->Doorbell)
2613	    & MPI2_DOORBELL_DATA_MASK);
2614	writel(0, &ioc->chip->HostInterruptStatus);
2615
2616	for (i = 2; i < default_reply->MsgLength * 2; i++)  {
2617		if ((_base_wait_for_doorbell_int(ioc, 5, sleep_flag))) {
2618			printk(MPT2SAS_ERR_FMT "doorbell "
2619			    "handshake int failed (line=%d)\n", ioc->name,
2620			    __LINE__);
2621			return -EFAULT;
2622		}
2623		if (i >=  reply_bytes/2) /* overflow case */
2624			dummy = readl(&ioc->chip->Doorbell);
2625		else
2626			reply[i] = le16_to_cpu(readl(&ioc->chip->Doorbell)
2627			    & MPI2_DOORBELL_DATA_MASK);
2628		writel(0, &ioc->chip->HostInterruptStatus);
2629	}
2630
2631	_base_wait_for_doorbell_int(ioc, 5, sleep_flag);
2632	if (_base_wait_for_doorbell_not_used(ioc, 5, sleep_flag) != 0) {
2633		dhsprintk(ioc, printk(MPT2SAS_INFO_FMT "doorbell is in use "
2634		    " (line=%d)\n", ioc->name, __LINE__));
2635	}
2636	writel(0, &ioc->chip->HostInterruptStatus);
2637
2638	if (ioc->logging_level & MPT_DEBUG_INIT) {
2639		mfp = (u32 *)reply;
2640		printk(KERN_DEBUG "\toffset:data\n");
2641		for (i = 0; i < reply_bytes/4; i++)
2642			printk(KERN_DEBUG "\t[0x%02x]:%08x\n", i*4,
2643			    le32_to_cpu(mfp[i]));
2644	}
2645	return 0;
2646}
2647
2648/**
2649 * mpt2sas_base_sas_iounit_control - send sas iounit control to FW
2650 * @ioc: per adapter object
2651 * @mpi_reply: the reply payload from FW
2652 * @mpi_request: the request payload sent to FW
2653 *
2654 * The SAS IO Unit Control Request message allows the host to perform low-level
2655 * operations, such as resets on the PHYs of the IO Unit, also allows the host
2656 * to obtain the IOC assigned device handles for a device if it has other
2657 * identifying information about the device, in addition allows the host to
2658 * remove IOC resources associated with the device.
2659 *
2660 * Returns 0 for success, non-zero for failure.
2661 */
2662int
2663mpt2sas_base_sas_iounit_control(struct MPT2SAS_ADAPTER *ioc,
2664    Mpi2SasIoUnitControlReply_t *mpi_reply,
2665    Mpi2SasIoUnitControlRequest_t *mpi_request)
2666{
2667	u16 smid;
2668	u32 ioc_state;
2669	unsigned long timeleft;
2670	u8 issue_reset;
2671	int rc;
2672	void *request;
2673	u16 wait_state_count;
2674
2675	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
2676	    __func__));
2677
2678	mutex_lock(&ioc->base_cmds.mutex);
2679
2680	if (ioc->base_cmds.status != MPT2_CMD_NOT_USED) {
2681		printk(MPT2SAS_ERR_FMT "%s: base_cmd in use\n",
2682		    ioc->name, __func__);
2683		rc = -EAGAIN;
2684		goto out;
2685	}
2686
2687	wait_state_count = 0;
2688	ioc_state = mpt2sas_base_get_iocstate(ioc, 1);
2689	while (ioc_state != MPI2_IOC_STATE_OPERATIONAL) {
2690		if (wait_state_count++ == 10) {
2691			printk(MPT2SAS_ERR_FMT
2692			    "%s: failed due to ioc not operational\n",
2693			    ioc->name, __func__);
2694			rc = -EFAULT;
2695			goto out;
2696		}
2697		ssleep(1);
2698		ioc_state = mpt2sas_base_get_iocstate(ioc, 1);
2699		printk(MPT2SAS_INFO_FMT "%s: waiting for "
2700		    "operational state(count=%d)\n", ioc->name,
2701		    __func__, wait_state_count);
2702	}
2703
2704	smid = mpt2sas_base_get_smid(ioc, ioc->base_cb_idx);
2705	if (!smid) {
2706		printk(MPT2SAS_ERR_FMT "%s: failed obtaining a smid\n",
2707		    ioc->name, __func__);
2708		rc = -EAGAIN;
2709		goto out;
2710	}
2711
2712	rc = 0;
2713	ioc->base_cmds.status = MPT2_CMD_PENDING;
2714	request = mpt2sas_base_get_msg_frame(ioc, smid);
2715	ioc->base_cmds.smid = smid;
2716	memcpy(request, mpi_request, sizeof(Mpi2SasIoUnitControlRequest_t));
2717	if (mpi_request->Operation == MPI2_SAS_OP_PHY_HARD_RESET ||
2718	    mpi_request->Operation == MPI2_SAS_OP_PHY_LINK_RESET)
2719		ioc->ioc_link_reset_in_progress = 1;
2720	mpt2sas_base_put_smid_default(ioc, smid);
2721	init_completion(&ioc->base_cmds.done);
2722	timeleft = wait_for_completion_timeout(&ioc->base_cmds.done,
2723	    msecs_to_jiffies(10000));
2724	if ((mpi_request->Operation == MPI2_SAS_OP_PHY_HARD_RESET ||
2725	    mpi_request->Operation == MPI2_SAS_OP_PHY_LINK_RESET) &&
2726	    ioc->ioc_link_reset_in_progress)
2727		ioc->ioc_link_reset_in_progress = 0;
2728	if (!(ioc->base_cmds.status & MPT2_CMD_COMPLETE)) {
2729		printk(MPT2SAS_ERR_FMT "%s: timeout\n",
2730		    ioc->name, __func__);
2731		_debug_dump_mf(mpi_request,
2732		    sizeof(Mpi2SasIoUnitControlRequest_t)/4);
2733		if (!(ioc->base_cmds.status & MPT2_CMD_RESET))
2734			issue_reset = 1;
2735		goto issue_host_reset;
2736	}
2737	if (ioc->base_cmds.status & MPT2_CMD_REPLY_VALID)
2738		memcpy(mpi_reply, ioc->base_cmds.reply,
2739		    sizeof(Mpi2SasIoUnitControlReply_t));
2740	else
2741		memset(mpi_reply, 0, sizeof(Mpi2SasIoUnitControlReply_t));
2742	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
2743	goto out;
2744
2745 issue_host_reset:
2746	if (issue_reset)
2747		mpt2sas_base_hard_reset_handler(ioc, CAN_SLEEP,
2748		    FORCE_BIG_HAMMER);
2749	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
2750	rc = -EFAULT;
2751 out:
2752	mutex_unlock(&ioc->base_cmds.mutex);
2753	return rc;
2754}
2755
2756
2757/**
2758 * mpt2sas_base_scsi_enclosure_processor - sending request to sep device
2759 * @ioc: per adapter object
2760 * @mpi_reply: the reply payload from FW
2761 * @mpi_request: the request payload sent to FW
2762 *
2763 * The SCSI Enclosure Processor request message causes the IOC to
2764 * communicate with SES devices to control LED status signals.
2765 *
2766 * Returns 0 for success, non-zero for failure.
2767 */
2768int
2769mpt2sas_base_scsi_enclosure_processor(struct MPT2SAS_ADAPTER *ioc,
2770    Mpi2SepReply_t *mpi_reply, Mpi2SepRequest_t *mpi_request)
2771{
2772	u16 smid;
2773	u32 ioc_state;
2774	unsigned long timeleft;
2775	u8 issue_reset;
2776	int rc;
2777	void *request;
2778	u16 wait_state_count;
2779
2780	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
2781	    __func__));
2782
2783	mutex_lock(&ioc->base_cmds.mutex);
2784
2785	if (ioc->base_cmds.status != MPT2_CMD_NOT_USED) {
2786		printk(MPT2SAS_ERR_FMT "%s: base_cmd in use\n",
2787		    ioc->name, __func__);
2788		rc = -EAGAIN;
2789		goto out;
2790	}
2791
2792	wait_state_count = 0;
2793	ioc_state = mpt2sas_base_get_iocstate(ioc, 1);
2794	while (ioc_state != MPI2_IOC_STATE_OPERATIONAL) {
2795		if (wait_state_count++ == 10) {
2796			printk(MPT2SAS_ERR_FMT
2797			    "%s: failed due to ioc not operational\n",
2798			    ioc->name, __func__);
2799			rc = -EFAULT;
2800			goto out;
2801		}
2802		ssleep(1);
2803		ioc_state = mpt2sas_base_get_iocstate(ioc, 1);
2804		printk(MPT2SAS_INFO_FMT "%s: waiting for "
2805		    "operational state(count=%d)\n", ioc->name,
2806		    __func__, wait_state_count);
2807	}
2808
2809	smid = mpt2sas_base_get_smid(ioc, ioc->base_cb_idx);
2810	if (!smid) {
2811		printk(MPT2SAS_ERR_FMT "%s: failed obtaining a smid\n",
2812		    ioc->name, __func__);
2813		rc = -EAGAIN;
2814		goto out;
2815	}
2816
2817	rc = 0;
2818	ioc->base_cmds.status = MPT2_CMD_PENDING;
2819	request = mpt2sas_base_get_msg_frame(ioc, smid);
2820	ioc->base_cmds.smid = smid;
2821	memcpy(request, mpi_request, sizeof(Mpi2SepReply_t));
2822	mpt2sas_base_put_smid_default(ioc, smid);
2823	init_completion(&ioc->base_cmds.done);
2824	timeleft = wait_for_completion_timeout(&ioc->base_cmds.done,
2825	    msecs_to_jiffies(10000));
2826	if (!(ioc->base_cmds.status & MPT2_CMD_COMPLETE)) {
2827		printk(MPT2SAS_ERR_FMT "%s: timeout\n",
2828		    ioc->name, __func__);
2829		_debug_dump_mf(mpi_request,
2830		    sizeof(Mpi2SepRequest_t)/4);
2831		if (!(ioc->base_cmds.status & MPT2_CMD_RESET))
2832			issue_reset = 1;
2833		goto issue_host_reset;
2834	}
2835	if (ioc->base_cmds.status & MPT2_CMD_REPLY_VALID)
2836		memcpy(mpi_reply, ioc->base_cmds.reply,
2837		    sizeof(Mpi2SepReply_t));
2838	else
2839		memset(mpi_reply, 0, sizeof(Mpi2SepReply_t));
2840	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
2841	goto out;
2842
2843 issue_host_reset:
2844	if (issue_reset)
2845		mpt2sas_base_hard_reset_handler(ioc, CAN_SLEEP,
2846		    FORCE_BIG_HAMMER);
2847	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
2848	rc = -EFAULT;
2849 out:
2850	mutex_unlock(&ioc->base_cmds.mutex);
2851	return rc;
2852}
2853
2854/**
2855 * _base_get_port_facts - obtain port facts reply and save in ioc
2856 * @ioc: per adapter object
2857 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2858 *
2859 * Returns 0 for success, non-zero for failure.
2860 */
2861static int
2862_base_get_port_facts(struct MPT2SAS_ADAPTER *ioc, int port, int sleep_flag)
2863{
2864	Mpi2PortFactsRequest_t mpi_request;
2865	Mpi2PortFactsReply_t mpi_reply, *pfacts;
2866	int mpi_reply_sz, mpi_request_sz, r;
2867
2868	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
2869	    __func__));
2870
2871	mpi_reply_sz = sizeof(Mpi2PortFactsReply_t);
2872	mpi_request_sz = sizeof(Mpi2PortFactsRequest_t);
2873	memset(&mpi_request, 0, mpi_request_sz);
2874	mpi_request.Function = MPI2_FUNCTION_PORT_FACTS;
2875	mpi_request.PortNumber = port;
2876	r = _base_handshake_req_reply_wait(ioc, mpi_request_sz,
2877	    (u32 *)&mpi_request, mpi_reply_sz, (u16 *)&mpi_reply, 5, CAN_SLEEP);
2878
2879	if (r != 0) {
2880		printk(MPT2SAS_ERR_FMT "%s: handshake failed (r=%d)\n",
2881		    ioc->name, __func__, r);
2882		return r;
2883	}
2884
2885	pfacts = &ioc->pfacts[port];
2886	memset(pfacts, 0, sizeof(Mpi2PortFactsReply_t));
2887	pfacts->PortNumber = mpi_reply.PortNumber;
2888	pfacts->VP_ID = mpi_reply.VP_ID;
2889	pfacts->VF_ID = mpi_reply.VF_ID;
2890	pfacts->MaxPostedCmdBuffers =
2891	    le16_to_cpu(mpi_reply.MaxPostedCmdBuffers);
2892
2893	return 0;
2894}
2895
2896/**
2897 * _base_get_ioc_facts - obtain ioc facts reply and save in ioc
2898 * @ioc: per adapter object
2899 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2900 *
2901 * Returns 0 for success, non-zero for failure.
2902 */
2903static int
2904_base_get_ioc_facts(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
2905{
2906	Mpi2IOCFactsRequest_t mpi_request;
2907	Mpi2IOCFactsReply_t mpi_reply, *facts;
2908	int mpi_reply_sz, mpi_request_sz, r;
2909
2910	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
2911	    __func__));
2912
2913	mpi_reply_sz = sizeof(Mpi2IOCFactsReply_t);
2914	mpi_request_sz = sizeof(Mpi2IOCFactsRequest_t);
2915	memset(&mpi_request, 0, mpi_request_sz);
2916	mpi_request.Function = MPI2_FUNCTION_IOC_FACTS;
2917	r = _base_handshake_req_reply_wait(ioc, mpi_request_sz,
2918	    (u32 *)&mpi_request, mpi_reply_sz, (u16 *)&mpi_reply, 5, CAN_SLEEP);
2919
2920	if (r != 0) {
2921		printk(MPT2SAS_ERR_FMT "%s: handshake failed (r=%d)\n",
2922		    ioc->name, __func__, r);
2923		return r;
2924	}
2925
2926	facts = &ioc->facts;
2927	memset(facts, 0, sizeof(Mpi2IOCFactsReply_t));
2928	facts->MsgVersion = le16_to_cpu(mpi_reply.MsgVersion);
2929	facts->HeaderVersion = le16_to_cpu(mpi_reply.HeaderVersion);
2930	facts->VP_ID = mpi_reply.VP_ID;
2931	facts->VF_ID = mpi_reply.VF_ID;
2932	facts->IOCExceptions = le16_to_cpu(mpi_reply.IOCExceptions);
2933	facts->MaxChainDepth = mpi_reply.MaxChainDepth;
2934	facts->WhoInit = mpi_reply.WhoInit;
2935	facts->NumberOfPorts = mpi_reply.NumberOfPorts;
2936	facts->RequestCredit = le16_to_cpu(mpi_reply.RequestCredit);
2937	facts->MaxReplyDescriptorPostQueueDepth =
2938	    le16_to_cpu(mpi_reply.MaxReplyDescriptorPostQueueDepth);
2939	facts->ProductID = le16_to_cpu(mpi_reply.ProductID);
2940	facts->IOCCapabilities = le32_to_cpu(mpi_reply.IOCCapabilities);
2941	if ((facts->IOCCapabilities & MPI2_IOCFACTS_CAPABILITY_INTEGRATED_RAID))
2942		ioc->ir_firmware = 1;
2943	facts->FWVersion.Word = le32_to_cpu(mpi_reply.FWVersion.Word);
2944	facts->IOCRequestFrameSize =
2945	    le16_to_cpu(mpi_reply.IOCRequestFrameSize);
2946	facts->MaxInitiators = le16_to_cpu(mpi_reply.MaxInitiators);
2947	facts->MaxTargets = le16_to_cpu(mpi_reply.MaxTargets);
2948	ioc->shost->max_id = -1;
2949	facts->MaxSasExpanders = le16_to_cpu(mpi_reply.MaxSasExpanders);
2950	facts->MaxEnclosures = le16_to_cpu(mpi_reply.MaxEnclosures);
2951	facts->ProtocolFlags = le16_to_cpu(mpi_reply.ProtocolFlags);
2952	facts->HighPriorityCredit =
2953	    le16_to_cpu(mpi_reply.HighPriorityCredit);
2954	facts->ReplyFrameSize = mpi_reply.ReplyFrameSize;
2955	facts->MaxDevHandle = le16_to_cpu(mpi_reply.MaxDevHandle);
2956
2957	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "hba queue depth(%d), "
2958	    "max chains per io(%d)\n", ioc->name, facts->RequestCredit,
2959	    facts->MaxChainDepth));
2960	dinitprintk(ioc, printk(MPT2SAS_INFO_FMT "request frame size(%d), "
2961	    "reply frame size(%d)\n", ioc->name,
2962	    facts->IOCRequestFrameSize * 4, facts->ReplyFrameSize * 4));
2963	return 0;
2964}
2965
2966/**
2967 * _base_send_ioc_init - send ioc_init to firmware
2968 * @ioc: per adapter object
2969 * @sleep_flag: CAN_SLEEP or NO_SLEEP
2970 *
2971 * Returns 0 for success, non-zero for failure.
2972 */
2973static int
2974_base_send_ioc_init(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
2975{
2976	Mpi2IOCInitRequest_t mpi_request;
2977	Mpi2IOCInitReply_t mpi_reply;
2978	int r;
2979	struct timeval current_time;
2980	u16 ioc_status;
2981
2982	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
2983	    __func__));
2984
2985	memset(&mpi_request, 0, sizeof(Mpi2IOCInitRequest_t));
2986	mpi_request.Function = MPI2_FUNCTION_IOC_INIT;
2987	mpi_request.WhoInit = MPI2_WHOINIT_HOST_DRIVER;
2988	mpi_request.VF_ID = 0; /* TODO */
2989	mpi_request.VP_ID = 0;
2990	mpi_request.MsgVersion = cpu_to_le16(MPI2_VERSION);
2991	mpi_request.HeaderVersion = cpu_to_le16(MPI2_HEADER_VERSION);
2992
2993	/* In MPI Revision I (0xA), the SystemReplyFrameSize(offset 0x18) was
2994	 * removed and made reserved.  For those with older firmware will need
2995	 * this fix. It was decided that the Reply and Request frame sizes are
2996	 * the same.
2997	 */
2998	if ((ioc->facts.HeaderVersion >> 8) < 0xA) {
2999		mpi_request.Reserved7 = cpu_to_le16(ioc->reply_sz);
3000/*		mpi_request.SystemReplyFrameSize =
3001 *		 cpu_to_le16(ioc->reply_sz);
3002 */
3003	}
3004
3005	mpi_request.SystemRequestFrameSize = cpu_to_le16(ioc->request_sz/4);
3006	mpi_request.ReplyDescriptorPostQueueDepth =
3007	    cpu_to_le16(ioc->reply_post_queue_depth);
3008	mpi_request.ReplyFreeQueueDepth =
3009	    cpu_to_le16(ioc->reply_free_queue_depth);
3010
3011#if BITS_PER_LONG > 32
3012	mpi_request.SenseBufferAddressHigh =
3013	    cpu_to_le32(ioc->sense_dma >> 32);
3014	mpi_request.SystemReplyAddressHigh =
3015	    cpu_to_le32(ioc->reply_dma >> 32);
3016	mpi_request.SystemRequestFrameBaseAddress =
3017	    cpu_to_le64(ioc->request_dma);
3018	mpi_request.ReplyFreeQueueAddress =
3019	    cpu_to_le64(ioc->reply_free_dma);
3020	mpi_request.ReplyDescriptorPostQueueAddress =
3021	    cpu_to_le64(ioc->reply_post_free_dma);
3022#else
3023	mpi_request.SystemRequestFrameBaseAddress =
3024	    cpu_to_le32(ioc->request_dma);
3025	mpi_request.ReplyFreeQueueAddress =
3026	    cpu_to_le32(ioc->reply_free_dma);
3027	mpi_request.ReplyDescriptorPostQueueAddress =
3028	    cpu_to_le32(ioc->reply_post_free_dma);
3029#endif
3030
3031	/* This time stamp specifies number of milliseconds
3032	 * since epoch ~ midnight January 1, 1970.
3033	 */
3034	do_gettimeofday(&current_time);
3035	mpi_request.TimeStamp = cpu_to_le64((u64)current_time.tv_sec * 1000 +
3036	    (current_time.tv_usec / 1000));
3037
3038	if (ioc->logging_level & MPT_DEBUG_INIT) {
3039		u32 *mfp;
3040		int i;
3041
3042		mfp = (u32 *)&mpi_request;
3043		printk(KERN_DEBUG "\toffset:data\n");
3044		for (i = 0; i < sizeof(Mpi2IOCInitRequest_t)/4; i++)
3045			printk(KERN_DEBUG "\t[0x%02x]:%08x\n", i*4,
3046			    le32_to_cpu(mfp[i]));
3047	}
3048
3049	r = _base_handshake_req_reply_wait(ioc,
3050	    sizeof(Mpi2IOCInitRequest_t), (u32 *)&mpi_request,
3051	    sizeof(Mpi2IOCInitReply_t), (u16 *)&mpi_reply, 10,
3052	    sleep_flag);
3053
3054	if (r != 0) {
3055		printk(MPT2SAS_ERR_FMT "%s: handshake failed (r=%d)\n",
3056		    ioc->name, __func__, r);
3057		return r;
3058	}
3059
3060	ioc_status = le16_to_cpu(mpi_reply.IOCStatus) & MPI2_IOCSTATUS_MASK;
3061	if (ioc_status != MPI2_IOCSTATUS_SUCCESS ||
3062	    mpi_reply.IOCLogInfo) {
3063		printk(MPT2SAS_ERR_FMT "%s: failed\n", ioc->name, __func__);
3064		r = -EIO;
3065	}
3066
3067	return 0;
3068}
3069
3070/**
3071 * _base_send_port_enable - send port_enable(discovery stuff) to firmware
3072 * @ioc: per adapter object
3073 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3074 *
3075 * Returns 0 for success, non-zero for failure.
3076 */
3077static int
3078_base_send_port_enable(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
3079{
3080	Mpi2PortEnableRequest_t *mpi_request;
3081	u32 ioc_state;
3082	unsigned long timeleft;
3083	int r = 0;
3084	u16 smid;
3085
3086	printk(MPT2SAS_INFO_FMT "sending port enable !!\n", ioc->name);
3087
3088	if (ioc->base_cmds.status & MPT2_CMD_PENDING) {
3089		printk(MPT2SAS_ERR_FMT "%s: internal command already in use\n",
3090		    ioc->name, __func__);
3091		return -EAGAIN;
3092	}
3093
3094	smid = mpt2sas_base_get_smid(ioc, ioc->base_cb_idx);
3095	if (!smid) {
3096		printk(MPT2SAS_ERR_FMT "%s: failed obtaining a smid\n",
3097		    ioc->name, __func__);
3098		return -EAGAIN;
3099	}
3100
3101	ioc->base_cmds.status = MPT2_CMD_PENDING;
3102	mpi_request = mpt2sas_base_get_msg_frame(ioc, smid);
3103	ioc->base_cmds.smid = smid;
3104	memset(mpi_request, 0, sizeof(Mpi2PortEnableRequest_t));
3105	mpi_request->Function = MPI2_FUNCTION_PORT_ENABLE;
3106	mpi_request->VF_ID = 0; /* TODO */
3107	mpi_request->VP_ID = 0;
3108
3109	mpt2sas_base_put_smid_default(ioc, smid);
3110	init_completion(&ioc->base_cmds.done);
3111	timeleft = wait_for_completion_timeout(&ioc->base_cmds.done,
3112	    300*HZ);
3113	if (!(ioc->base_cmds.status & MPT2_CMD_COMPLETE)) {
3114		printk(MPT2SAS_ERR_FMT "%s: timeout\n",
3115		    ioc->name, __func__);
3116		_debug_dump_mf(mpi_request,
3117		    sizeof(Mpi2PortEnableRequest_t)/4);
3118		if (ioc->base_cmds.status & MPT2_CMD_RESET)
3119			r = -EFAULT;
3120		else
3121			r = -ETIME;
3122		goto out;
3123	} else
3124		dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: complete\n",
3125		    ioc->name, __func__));
3126
3127	ioc_state = _base_wait_on_iocstate(ioc, MPI2_IOC_STATE_OPERATIONAL,
3128	    60, sleep_flag);
3129	if (ioc_state) {
3130		printk(MPT2SAS_ERR_FMT "%s: failed going to operational state "
3131		    " (ioc_state=0x%x)\n", ioc->name, __func__, ioc_state);
3132		r = -EFAULT;
3133	}
3134 out:
3135	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
3136	printk(MPT2SAS_INFO_FMT "port enable: %s\n",
3137	    ioc->name, ((r == 0) ? "SUCCESS" : "FAILED"));
3138	return r;
3139}
3140
3141/**
3142 * _base_unmask_events - turn on notification for this event
3143 * @ioc: per adapter object
3144 * @event: firmware event
3145 *
3146 * The mask is stored in ioc->event_masks.
3147 */
3148static void
3149_base_unmask_events(struct MPT2SAS_ADAPTER *ioc, u16 event)
3150{
3151	u32 desired_event;
3152
3153	if (event >= 128)
3154		return;
3155
3156	desired_event = (1 << (event % 32));
3157
3158	if (event < 32)
3159		ioc->event_masks[0] &= ~desired_event;
3160	else if (event < 64)
3161		ioc->event_masks[1] &= ~desired_event;
3162	else if (event < 96)
3163		ioc->event_masks[2] &= ~desired_event;
3164	else if (event < 128)
3165		ioc->event_masks[3] &= ~desired_event;
3166}
3167
3168/**
3169 * _base_event_notification - send event notification
3170 * @ioc: per adapter object
3171 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3172 *
3173 * Returns 0 for success, non-zero for failure.
3174 */
3175static int
3176_base_event_notification(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
3177{
3178	Mpi2EventNotificationRequest_t *mpi_request;
3179	unsigned long timeleft;
3180	u16 smid;
3181	int r = 0;
3182	int i;
3183
3184	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
3185	    __func__));
3186
3187	if (ioc->base_cmds.status & MPT2_CMD_PENDING) {
3188		printk(MPT2SAS_ERR_FMT "%s: internal command already in use\n",
3189		    ioc->name, __func__);
3190		return -EAGAIN;
3191	}
3192
3193	smid = mpt2sas_base_get_smid(ioc, ioc->base_cb_idx);
3194	if (!smid) {
3195		printk(MPT2SAS_ERR_FMT "%s: failed obtaining a smid\n",
3196		    ioc->name, __func__);
3197		return -EAGAIN;
3198	}
3199	ioc->base_cmds.status = MPT2_CMD_PENDING;
3200	mpi_request = mpt2sas_base_get_msg_frame(ioc, smid);
3201	ioc->base_cmds.smid = smid;
3202	memset(mpi_request, 0, sizeof(Mpi2EventNotificationRequest_t));
3203	mpi_request->Function = MPI2_FUNCTION_EVENT_NOTIFICATION;
3204	mpi_request->VF_ID = 0; /* TODO */
3205	mpi_request->VP_ID = 0;
3206	for (i = 0; i < MPI2_EVENT_NOTIFY_EVENTMASK_WORDS; i++)
3207		mpi_request->EventMasks[i] =
3208		    cpu_to_le32(ioc->event_masks[i]);
3209	mpt2sas_base_put_smid_default(ioc, smid);
3210	init_completion(&ioc->base_cmds.done);
3211	timeleft = wait_for_completion_timeout(&ioc->base_cmds.done, 30*HZ);
3212	if (!(ioc->base_cmds.status & MPT2_CMD_COMPLETE)) {
3213		printk(MPT2SAS_ERR_FMT "%s: timeout\n",
3214		    ioc->name, __func__);
3215		_debug_dump_mf(mpi_request,
3216		    sizeof(Mpi2EventNotificationRequest_t)/4);
3217		if (ioc->base_cmds.status & MPT2_CMD_RESET)
3218			r = -EFAULT;
3219		else
3220			r = -ETIME;
3221	} else
3222		dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: complete\n",
3223		    ioc->name, __func__));
3224	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
3225	return r;
3226}
3227
3228/**
3229 * mpt2sas_base_validate_event_type - validating event types
3230 * @ioc: per adapter object
3231 * @event: firmware event
3232 *
3233 * This will turn on firmware event notification when application
3234 * ask for that event. We don't mask events that are already enabled.
3235 */
3236void
3237mpt2sas_base_validate_event_type(struct MPT2SAS_ADAPTER *ioc, u32 *event_type)
3238{
3239	int i, j;
3240	u32 event_mask, desired_event;
3241	u8 send_update_to_fw;
3242
3243	for (i = 0, send_update_to_fw = 0; i <
3244	    MPI2_EVENT_NOTIFY_EVENTMASK_WORDS; i++) {
3245		event_mask = ~event_type[i];
3246		desired_event = 1;
3247		for (j = 0; j < 32; j++) {
3248			if (!(event_mask & desired_event) &&
3249			    (ioc->event_masks[i] & desired_event)) {
3250				ioc->event_masks[i] &= ~desired_event;
3251				send_update_to_fw = 1;
3252			}
3253			desired_event = (desired_event << 1);
3254		}
3255	}
3256
3257	if (!send_update_to_fw)
3258		return;
3259
3260	mutex_lock(&ioc->base_cmds.mutex);
3261	_base_event_notification(ioc, CAN_SLEEP);
3262	mutex_unlock(&ioc->base_cmds.mutex);
3263}
3264
3265/**
3266 * _base_diag_reset - the "big hammer" start of day reset
3267 * @ioc: per adapter object
3268 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3269 *
3270 * Returns 0 for success, non-zero for failure.
3271 */
3272static int
3273_base_diag_reset(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
3274{
3275	u32 host_diagnostic;
3276	u32 ioc_state;
3277	u32 count;
3278	u32 hcb_size;
3279
3280	printk(MPT2SAS_INFO_FMT "sending diag reset !!\n", ioc->name);
3281
3282	_base_save_msix_table(ioc);
3283
3284	drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "clear interrupts\n",
3285	    ioc->name));
3286
3287	count = 0;
3288	do {
3289		/* Write magic sequence to WriteSequence register
3290		 * Loop until in diagnostic mode
3291		 */
3292		drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "write magic "
3293		    "sequence\n", ioc->name));
3294		writel(MPI2_WRSEQ_FLUSH_KEY_VALUE, &ioc->chip->WriteSequence);
3295		writel(MPI2_WRSEQ_1ST_KEY_VALUE, &ioc->chip->WriteSequence);
3296		writel(MPI2_WRSEQ_2ND_KEY_VALUE, &ioc->chip->WriteSequence);
3297		writel(MPI2_WRSEQ_3RD_KEY_VALUE, &ioc->chip->WriteSequence);
3298		writel(MPI2_WRSEQ_4TH_KEY_VALUE, &ioc->chip->WriteSequence);
3299		writel(MPI2_WRSEQ_5TH_KEY_VALUE, &ioc->chip->WriteSequence);
3300		writel(MPI2_WRSEQ_6TH_KEY_VALUE, &ioc->chip->WriteSequence);
3301
3302		/* wait 100 msec */
3303		if (sleep_flag == CAN_SLEEP)
3304			msleep(100);
3305		else
3306			mdelay(100);
3307
3308		if (count++ > 20)
3309			goto out;
3310
3311		host_diagnostic = readl(&ioc->chip->HostDiagnostic);
3312		drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "wrote magic "
3313		    "sequence: count(%d), host_diagnostic(0x%08x)\n",
3314		    ioc->name, count, host_diagnostic));
3315
3316	} while ((host_diagnostic & MPI2_DIAG_DIAG_WRITE_ENABLE) == 0);
3317
3318	hcb_size = readl(&ioc->chip->HCBSize);
3319
3320	drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "diag reset: issued\n",
3321	    ioc->name));
3322	writel(host_diagnostic | MPI2_DIAG_RESET_ADAPTER,
3323	     &ioc->chip->HostDiagnostic);
3324
3325	/* don't access any registers for 50 milliseconds */
3326	msleep(50);
3327
3328	/* 300 second max wait */
3329	for (count = 0; count < 3000000 ; count++) {
3330
3331		host_diagnostic = readl(&ioc->chip->HostDiagnostic);
3332
3333		if (host_diagnostic == 0xFFFFFFFF)
3334			goto out;
3335		if (!(host_diagnostic & MPI2_DIAG_RESET_ADAPTER))
3336			break;
3337
3338		/* wait 100 msec */
3339		if (sleep_flag == CAN_SLEEP)
3340			msleep(1);
3341		else
3342			mdelay(1);
3343	}
3344
3345	if (host_diagnostic & MPI2_DIAG_HCB_MODE) {
3346
3347		drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "restart the adapter "
3348		    "assuming the HCB Address points to good F/W\n",
3349		    ioc->name));
3350		host_diagnostic &= ~MPI2_DIAG_BOOT_DEVICE_SELECT_MASK;
3351		host_diagnostic |= MPI2_DIAG_BOOT_DEVICE_SELECT_HCDW;
3352		writel(host_diagnostic, &ioc->chip->HostDiagnostic);
3353
3354		drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT
3355		    "re-enable the HCDW\n", ioc->name));
3356		writel(hcb_size | MPI2_HCB_SIZE_HCB_ENABLE,
3357		    &ioc->chip->HCBSize);
3358	}
3359
3360	drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "restart the adapter\n",
3361	    ioc->name));
3362	writel(host_diagnostic & ~MPI2_DIAG_HOLD_IOC_RESET,
3363	    &ioc->chip->HostDiagnostic);
3364
3365	drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "disable writes to the "
3366	    "diagnostic register\n", ioc->name));
3367	writel(MPI2_WRSEQ_FLUSH_KEY_VALUE, &ioc->chip->WriteSequence);
3368
3369	drsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "Wait for FW to go to the "
3370	    "READY state\n", ioc->name));
3371	ioc_state = _base_wait_on_iocstate(ioc, MPI2_IOC_STATE_READY, 20,
3372	    sleep_flag);
3373	if (ioc_state) {
3374		printk(MPT2SAS_ERR_FMT "%s: failed going to ready state "
3375		    " (ioc_state=0x%x)\n", ioc->name, __func__, ioc_state);
3376		goto out;
3377	}
3378
3379	_base_restore_msix_table(ioc);
3380	printk(MPT2SAS_INFO_FMT "diag reset: SUCCESS\n", ioc->name);
3381	return 0;
3382
3383 out:
3384	printk(MPT2SAS_ERR_FMT "diag reset: FAILED\n", ioc->name);
3385	return -EFAULT;
3386}
3387
3388/**
3389 * _base_make_ioc_ready - put controller in READY state
3390 * @ioc: per adapter object
3391 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3392 * @type: FORCE_BIG_HAMMER or SOFT_RESET
3393 *
3394 * Returns 0 for success, non-zero for failure.
3395 */
3396static int
3397_base_make_ioc_ready(struct MPT2SAS_ADAPTER *ioc, int sleep_flag,
3398    enum reset_type type)
3399{
3400	u32 ioc_state;
3401
3402	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
3403	    __func__));
3404
3405	ioc_state = mpt2sas_base_get_iocstate(ioc, 0);
3406	dhsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: ioc_state(0x%08x)\n",
3407	    ioc->name, __func__, ioc_state));
3408
3409	if ((ioc_state & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_READY)
3410		return 0;
3411
3412	if (ioc_state & MPI2_DOORBELL_USED) {
3413		dhsprintk(ioc, printk(MPT2SAS_DEBUG_FMT "unexpected doorbell "
3414		    "active!\n", ioc->name));
3415		goto issue_diag_reset;
3416	}
3417
3418	if ((ioc_state & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_FAULT) {
3419		mpt2sas_base_fault_info(ioc, ioc_state &
3420		    MPI2_DOORBELL_DATA_MASK);
3421		goto issue_diag_reset;
3422	}
3423
3424	if (type == FORCE_BIG_HAMMER)
3425		goto issue_diag_reset;
3426
3427	if ((ioc_state & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_OPERATIONAL)
3428		if (!(_base_send_ioc_reset(ioc,
3429		    MPI2_FUNCTION_IOC_MESSAGE_UNIT_RESET, 15, CAN_SLEEP)))
3430			return 0;
3431
3432 issue_diag_reset:
3433	return _base_diag_reset(ioc, CAN_SLEEP);
3434}
3435
3436/**
3437 * _base_make_ioc_operational - put controller in OPERATIONAL state
3438 * @ioc: per adapter object
3439 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3440 *
3441 * Returns 0 for success, non-zero for failure.
3442 */
3443static int
3444_base_make_ioc_operational(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
3445{
3446	int r, i;
3447	unsigned long	flags;
3448	u32 reply_address;
3449	u16 smid;
3450	struct _tr_list *delayed_tr, *delayed_tr_next;
3451
3452	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
3453	    __func__));
3454
3455	/* clean the delayed target reset list */
3456	list_for_each_entry_safe(delayed_tr, delayed_tr_next,
3457	    &ioc->delayed_tr_list, list) {
3458		list_del(&delayed_tr->list);
3459		kfree(delayed_tr);
3460	}
3461
3462	/* initialize the scsi lookup free list */
3463	spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
3464	INIT_LIST_HEAD(&ioc->free_list);
3465	smid = 1;
3466	for (i = 0; i < ioc->scsiio_depth; i++, smid++) {
3467		ioc->scsi_lookup[i].cb_idx = 0xFF;
3468		ioc->scsi_lookup[i].smid = smid;
3469		ioc->scsi_lookup[i].scmd = NULL;
3470		list_add_tail(&ioc->scsi_lookup[i].tracker_list,
3471		    &ioc->free_list);
3472	}
3473
3474	/* hi-priority queue */
3475	INIT_LIST_HEAD(&ioc->hpr_free_list);
3476	smid = ioc->hi_priority_smid;
3477	for (i = 0; i < ioc->hi_priority_depth; i++, smid++) {
3478		ioc->hpr_lookup[i].cb_idx = 0xFF;
3479		ioc->hpr_lookup[i].smid = smid;
3480		list_add_tail(&ioc->hpr_lookup[i].tracker_list,
3481		    &ioc->hpr_free_list);
3482	}
3483
3484	/* internal queue */
3485	INIT_LIST_HEAD(&ioc->internal_free_list);
3486	smid = ioc->internal_smid;
3487	for (i = 0; i < ioc->internal_depth; i++, smid++) {
3488		ioc->internal_lookup[i].cb_idx = 0xFF;
3489		ioc->internal_lookup[i].smid = smid;
3490		list_add_tail(&ioc->internal_lookup[i].tracker_list,
3491		    &ioc->internal_free_list);
3492	}
3493	spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
3494
3495	/* initialize Reply Free Queue */
3496	for (i = 0, reply_address = (u32)ioc->reply_dma ;
3497	    i < ioc->reply_free_queue_depth ; i++, reply_address +=
3498	    ioc->reply_sz)
3499		ioc->reply_free[i] = cpu_to_le32(reply_address);
3500
3501	/* initialize Reply Post Free Queue */
3502	for (i = 0; i < ioc->reply_post_queue_depth; i++)
3503		ioc->reply_post_free[i].Words = ULLONG_MAX;
3504
3505	r = _base_send_ioc_init(ioc, sleep_flag);
3506	if (r)
3507		return r;
3508
3509	/* initialize the index's */
3510	ioc->reply_free_host_index = ioc->reply_free_queue_depth - 1;
3511	ioc->reply_post_host_index = 0;
3512	writel(ioc->reply_free_host_index, &ioc->chip->ReplyFreeHostIndex);
3513	writel(0, &ioc->chip->ReplyPostHostIndex);
3514
3515	_base_unmask_interrupts(ioc);
3516	r = _base_event_notification(ioc, sleep_flag);
3517	if (r)
3518		return r;
3519
3520	if (sleep_flag == CAN_SLEEP)
3521		_base_static_config_pages(ioc);
3522
3523	r = _base_send_port_enable(ioc, sleep_flag);
3524	if (r)
3525		return r;
3526
3527	return r;
3528}
3529
3530/**
3531 * mpt2sas_base_free_resources - free resources controller resources (io/irq/memap)
3532 * @ioc: per adapter object
3533 *
3534 * Return nothing.
3535 */
3536void
3537mpt2sas_base_free_resources(struct MPT2SAS_ADAPTER *ioc)
3538{
3539	struct pci_dev *pdev = ioc->pdev;
3540
3541	dexitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
3542	    __func__));
3543
3544	_base_mask_interrupts(ioc);
3545	ioc->shost_recovery = 1;
3546	_base_make_ioc_ready(ioc, CAN_SLEEP, SOFT_RESET);
3547	ioc->shost_recovery = 0;
3548	if (ioc->pci_irq) {
3549		synchronize_irq(pdev->irq);
3550		free_irq(ioc->pci_irq, ioc);
3551	}
3552	_base_disable_msix(ioc);
3553	if (ioc->chip_phys)
3554		iounmap(ioc->chip);
3555	ioc->pci_irq = -1;
3556	ioc->chip_phys = 0;
3557	pci_release_selected_regions(ioc->pdev, ioc->bars);
3558	pci_disable_pcie_error_reporting(pdev);
3559	pci_disable_device(pdev);
3560	return;
3561}
3562
3563/**
3564 * mpt2sas_base_attach - attach controller instance
3565 * @ioc: per adapter object
3566 *
3567 * Returns 0 for success, non-zero for failure.
3568 */
3569int
3570mpt2sas_base_attach(struct MPT2SAS_ADAPTER *ioc)
3571{
3572	int r, i;
3573
3574	dinitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
3575	    __func__));
3576
3577	r = mpt2sas_base_map_resources(ioc);
3578	if (r)
3579		return r;
3580
3581	pci_set_drvdata(ioc->pdev, ioc->shost);
3582	r = _base_get_ioc_facts(ioc, CAN_SLEEP);
3583	if (r)
3584		goto out_free_resources;
3585
3586	r = _base_make_ioc_ready(ioc, CAN_SLEEP, SOFT_RESET);
3587	if (r)
3588		goto out_free_resources;
3589
3590	ioc->pfacts = kcalloc(ioc->facts.NumberOfPorts,
3591	    sizeof(Mpi2PortFactsReply_t), GFP_KERNEL);
3592	if (!ioc->pfacts) {
3593		r = -ENOMEM;
3594		goto out_free_resources;
3595	}
3596
3597	for (i = 0 ; i < ioc->facts.NumberOfPorts; i++) {
3598		r = _base_get_port_facts(ioc, i, CAN_SLEEP);
3599		if (r)
3600			goto out_free_resources;
3601	}
3602
3603	r = _base_allocate_memory_pools(ioc, CAN_SLEEP);
3604	if (r)
3605		goto out_free_resources;
3606
3607	init_waitqueue_head(&ioc->reset_wq);
3608
3609	ioc->fwfault_debug = mpt2sas_fwfault_debug;
3610
3611	/* base internal command bits */
3612	mutex_init(&ioc->base_cmds.mutex);
3613	ioc->base_cmds.reply = kzalloc(ioc->reply_sz, GFP_KERNEL);
3614	ioc->base_cmds.status = MPT2_CMD_NOT_USED;
3615
3616	/* transport internal command bits */
3617	ioc->transport_cmds.reply = kzalloc(ioc->reply_sz, GFP_KERNEL);
3618	ioc->transport_cmds.status = MPT2_CMD_NOT_USED;
3619	mutex_init(&ioc->transport_cmds.mutex);
3620
3621	/* scsih internal command bits */
3622	ioc->scsih_cmds.reply = kzalloc(ioc->reply_sz, GFP_KERNEL);
3623	ioc->scsih_cmds.status = MPT2_CMD_NOT_USED;
3624	mutex_init(&ioc->scsih_cmds.mutex);
3625
3626	/* task management internal command bits */
3627	ioc->tm_cmds.reply = kzalloc(ioc->reply_sz, GFP_KERNEL);
3628	ioc->tm_cmds.status = MPT2_CMD_NOT_USED;
3629	mutex_init(&ioc->tm_cmds.mutex);
3630
3631	/* config page internal command bits */
3632	ioc->config_cmds.reply = kzalloc(ioc->reply_sz, GFP_KERNEL);
3633	ioc->config_cmds.status = MPT2_CMD_NOT_USED;
3634	mutex_init(&ioc->config_cmds.mutex);
3635
3636	/* ctl module internal command bits */
3637	ioc->ctl_cmds.reply = kzalloc(ioc->reply_sz, GFP_KERNEL);
3638	ioc->ctl_cmds.status = MPT2_CMD_NOT_USED;
3639	mutex_init(&ioc->ctl_cmds.mutex);
3640
3641	if (!ioc->base_cmds.reply || !ioc->transport_cmds.reply ||
3642	    !ioc->scsih_cmds.reply || !ioc->tm_cmds.reply ||
3643	    !ioc->config_cmds.reply || !ioc->ctl_cmds.reply) {
3644		r = -ENOMEM;
3645		goto out_free_resources;
3646	}
3647
3648	init_completion(&ioc->shost_recovery_done);
3649
3650	for (i = 0; i < MPI2_EVENT_NOTIFY_EVENTMASK_WORDS; i++)
3651		ioc->event_masks[i] = -1;
3652
3653	/* here we enable the events we care about */
3654	_base_unmask_events(ioc, MPI2_EVENT_SAS_DISCOVERY);
3655	_base_unmask_events(ioc, MPI2_EVENT_SAS_BROADCAST_PRIMITIVE);
3656	_base_unmask_events(ioc, MPI2_EVENT_SAS_TOPOLOGY_CHANGE_LIST);
3657	_base_unmask_events(ioc, MPI2_EVENT_SAS_DEVICE_STATUS_CHANGE);
3658	_base_unmask_events(ioc, MPI2_EVENT_SAS_ENCL_DEVICE_STATUS_CHANGE);
3659	_base_unmask_events(ioc, MPI2_EVENT_IR_CONFIGURATION_CHANGE_LIST);
3660	_base_unmask_events(ioc, MPI2_EVENT_IR_VOLUME);
3661	_base_unmask_events(ioc, MPI2_EVENT_IR_PHYSICAL_DISK);
3662	_base_unmask_events(ioc, MPI2_EVENT_IR_OPERATION_STATUS);
3663	_base_unmask_events(ioc, MPI2_EVENT_TASK_SET_FULL);
3664	_base_unmask_events(ioc, MPI2_EVENT_LOG_ENTRY_ADDED);
3665	r = _base_make_ioc_operational(ioc, CAN_SLEEP);
3666	if (r)
3667		goto out_free_resources;
3668
3669	mpt2sas_base_start_watchdog(ioc);
3670	if (diag_buffer_enable != 0)
3671		mpt2sas_enable_diag_buffer(ioc, diag_buffer_enable);
3672	return 0;
3673
3674 out_free_resources:
3675
3676	ioc->remove_host = 1;
3677	mpt2sas_base_free_resources(ioc);
3678	_base_release_memory_pools(ioc);
3679	pci_set_drvdata(ioc->pdev, NULL);
3680	kfree(ioc->tm_cmds.reply);
3681	kfree(ioc->transport_cmds.reply);
3682	kfree(ioc->scsih_cmds.reply);
3683	kfree(ioc->config_cmds.reply);
3684	kfree(ioc->base_cmds.reply);
3685	kfree(ioc->ctl_cmds.reply);
3686	kfree(ioc->pfacts);
3687	ioc->ctl_cmds.reply = NULL;
3688	ioc->base_cmds.reply = NULL;
3689	ioc->tm_cmds.reply = NULL;
3690	ioc->scsih_cmds.reply = NULL;
3691	ioc->transport_cmds.reply = NULL;
3692	ioc->config_cmds.reply = NULL;
3693	ioc->pfacts = NULL;
3694	return r;
3695}
3696
3697
3698/**
3699 * mpt2sas_base_detach - remove controller instance
3700 * @ioc: per adapter object
3701 *
3702 * Return nothing.
3703 */
3704void
3705mpt2sas_base_detach(struct MPT2SAS_ADAPTER *ioc)
3706{
3707
3708	dexitprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s\n", ioc->name,
3709	    __func__));
3710
3711	mpt2sas_base_stop_watchdog(ioc);
3712	mpt2sas_base_free_resources(ioc);
3713	_base_release_memory_pools(ioc);
3714	pci_set_drvdata(ioc->pdev, NULL);
3715	kfree(ioc->pfacts);
3716	kfree(ioc->ctl_cmds.reply);
3717	kfree(ioc->base_cmds.reply);
3718	kfree(ioc->tm_cmds.reply);
3719	kfree(ioc->transport_cmds.reply);
3720	kfree(ioc->scsih_cmds.reply);
3721	kfree(ioc->config_cmds.reply);
3722}
3723
3724/**
3725 * _base_reset_handler - reset callback handler (for base)
3726 * @ioc: per adapter object
3727 * @reset_phase: phase
3728 *
3729 * The handler for doing any required cleanup or initialization.
3730 *
3731 * The reset phase can be MPT2_IOC_PRE_RESET, MPT2_IOC_AFTER_RESET,
3732 * MPT2_IOC_DONE_RESET
3733 *
3734 * Return nothing.
3735 */
3736static void
3737_base_reset_handler(struct MPT2SAS_ADAPTER *ioc, int reset_phase)
3738{
3739	switch (reset_phase) {
3740	case MPT2_IOC_PRE_RESET:
3741		dtmprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: "
3742		    "MPT2_IOC_PRE_RESET\n", ioc->name, __func__));
3743		break;
3744	case MPT2_IOC_AFTER_RESET:
3745		dtmprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: "
3746		    "MPT2_IOC_AFTER_RESET\n", ioc->name, __func__));
3747		if (ioc->transport_cmds.status & MPT2_CMD_PENDING) {
3748			ioc->transport_cmds.status |= MPT2_CMD_RESET;
3749			mpt2sas_base_free_smid(ioc, ioc->transport_cmds.smid);
3750			complete(&ioc->transport_cmds.done);
3751		}
3752		if (ioc->base_cmds.status & MPT2_CMD_PENDING) {
3753			ioc->base_cmds.status |= MPT2_CMD_RESET;
3754			mpt2sas_base_free_smid(ioc, ioc->base_cmds.smid);
3755			complete(&ioc->base_cmds.done);
3756		}
3757		if (ioc->config_cmds.status & MPT2_CMD_PENDING) {
3758			ioc->config_cmds.status |= MPT2_CMD_RESET;
3759			mpt2sas_base_free_smid(ioc, ioc->config_cmds.smid);
3760			ioc->config_cmds.smid = USHRT_MAX;
3761			complete(&ioc->config_cmds.done);
3762		}
3763		break;
3764	case MPT2_IOC_DONE_RESET:
3765		dtmprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: "
3766		    "MPT2_IOC_DONE_RESET\n", ioc->name, __func__));
3767		break;
3768	}
3769	mpt2sas_scsih_reset_handler(ioc, reset_phase);
3770	mpt2sas_ctl_reset_handler(ioc, reset_phase);
3771}
3772
3773/**
3774 * _wait_for_commands_to_complete - reset controller
3775 * @ioc: Pointer to MPT_ADAPTER structure
3776 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3777 *
3778 * This function waiting(3s) for all pending commands to complete
3779 * prior to putting controller in reset.
3780 */
3781static void
3782_wait_for_commands_to_complete(struct MPT2SAS_ADAPTER *ioc, int sleep_flag)
3783{
3784	u32 ioc_state;
3785	unsigned long flags;
3786	u16 i;
3787
3788	ioc->pending_io_count = 0;
3789	if (sleep_flag != CAN_SLEEP)
3790		return;
3791
3792	ioc_state = mpt2sas_base_get_iocstate(ioc, 0);
3793	if ((ioc_state & MPI2_IOC_STATE_MASK) != MPI2_IOC_STATE_OPERATIONAL)
3794		return;
3795
3796	/* pending command count */
3797	spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
3798	for (i = 0; i < ioc->scsiio_depth; i++)
3799		if (ioc->scsi_lookup[i].cb_idx != 0xFF)
3800			ioc->pending_io_count++;
3801	spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
3802
3803	if (!ioc->pending_io_count)
3804		return;
3805
3806	/* wait for pending commands to complete */
3807	wait_event_timeout(ioc->reset_wq, ioc->pending_io_count == 0, 3 * HZ);
3808}
3809
3810/**
3811 * mpt2sas_base_hard_reset_handler - reset controller
3812 * @ioc: Pointer to MPT_ADAPTER structure
3813 * @sleep_flag: CAN_SLEEP or NO_SLEEP
3814 * @type: FORCE_BIG_HAMMER or SOFT_RESET
3815 *
3816 * Returns 0 for success, non-zero for failure.
3817 */
3818int
3819mpt2sas_base_hard_reset_handler(struct MPT2SAS_ADAPTER *ioc, int sleep_flag,
3820    enum reset_type type)
3821{
3822	int r;
3823	unsigned long flags;
3824
3825	dtmprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: enter\n", ioc->name,
3826	    __func__));
3827
3828	if (mpt2sas_fwfault_debug)
3829		mpt2sas_halt_firmware(ioc);
3830
3831	spin_lock_irqsave(&ioc->ioc_reset_in_progress_lock, flags);
3832	if (ioc->shost_recovery) {
3833		spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
3834		printk(MPT2SAS_ERR_FMT "%s: busy\n",
3835		    ioc->name, __func__);
3836		return -EBUSY;
3837	}
3838	ioc->shost_recovery = 1;
3839	spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
3840
3841	_base_reset_handler(ioc, MPT2_IOC_PRE_RESET);
3842	_wait_for_commands_to_complete(ioc, sleep_flag);
3843	_base_mask_interrupts(ioc);
3844	r = _base_make_ioc_ready(ioc, sleep_flag, type);
3845	if (r)
3846		goto out;
3847	_base_reset_handler(ioc, MPT2_IOC_AFTER_RESET);
3848	r = _base_make_ioc_operational(ioc, sleep_flag);
3849	if (!r)
3850		_base_reset_handler(ioc, MPT2_IOC_DONE_RESET);
3851 out:
3852	dtmprintk(ioc, printk(MPT2SAS_DEBUG_FMT "%s: %s\n",
3853	    ioc->name, __func__, ((r == 0) ? "SUCCESS" : "FAILED")));
3854
3855	spin_lock_irqsave(&ioc->ioc_reset_in_progress_lock, flags);
3856	ioc->shost_recovery = 0;
3857	complete(&ioc->shost_recovery_done);
3858	spin_unlock_irqrestore(&ioc->ioc_reset_in_progress_lock, flags);
3859
3860	return r;
3861}
3862