1 /*
2  *  Linux MegaRAID driver for SAS based RAID controllers
3  *
4  *  Copyright (c) 2003-2013  LSI Corporation
5  *  Copyright (c) 2013-2014  Avago Technologies
6  *
7  *  This program is free software; you can redistribute it and/or
8  *  modify it under the terms of the GNU General Public License
9  *  as published by the Free Software Foundation; either version 2
10  *  of the License, or (at your option) any later version.
11  *
12  *  This program is distributed in the hope that it will be useful,
13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *  GNU General Public License for more details.
16  *
17  *  You should have received a copy of the GNU General Public License
18  *  along with this program.  If not, see <http://www.gnu.org/licenses/>.
19  *
20  *  Authors: Avago Technologies
21  *           Sreenivas Bagalkote
22  *           Sumant Patro
23  *           Bo Yang
24  *           Adam Radford
25  *           Kashyap Desai <kashyap.desai@avagotech.com>
26  *           Sumit Saxena <sumit.saxena@avagotech.com>
27  *
28  *  Send feedback to: megaraidlinux.pdl@avagotech.com
29  *
30  *  Mail to: Avago Technologies, 350 West Trimble Road, Building 90,
31  *  San Jose, California 95131
32  */
33 
34 #include <linux/kernel.h>
35 #include <linux/types.h>
36 #include <linux/pci.h>
37 #include <linux/list.h>
38 #include <linux/moduleparam.h>
39 #include <linux/module.h>
40 #include <linux/spinlock.h>
41 #include <linux/interrupt.h>
42 #include <linux/delay.h>
43 #include <linux/uio.h>
44 #include <linux/slab.h>
45 #include <asm/uaccess.h>
46 #include <linux/fs.h>
47 #include <linux/compat.h>
48 #include <linux/blkdev.h>
49 #include <linux/mutex.h>
50 #include <linux/poll.h>
51 
52 #include <scsi/scsi.h>
53 #include <scsi/scsi_cmnd.h>
54 #include <scsi/scsi_device.h>
55 #include <scsi/scsi_host.h>
56 #include <scsi/scsi_tcq.h>
57 #include "megaraid_sas_fusion.h"
58 #include "megaraid_sas.h"
59 
60 /*
61  * Number of sectors per IO command
62  * Will be set in megasas_init_mfi if user does not provide
63  */
64 static unsigned int max_sectors;
65 module_param_named(max_sectors, max_sectors, int, 0);
66 MODULE_PARM_DESC(max_sectors,
67 	"Maximum number of sectors per IO command");
68 
69 static int msix_disable;
70 module_param(msix_disable, int, S_IRUGO);
71 MODULE_PARM_DESC(msix_disable, "Disable MSI-X interrupt handling. Default: 0");
72 
73 static unsigned int msix_vectors;
74 module_param(msix_vectors, int, S_IRUGO);
75 MODULE_PARM_DESC(msix_vectors, "MSI-X max vector count. Default: Set by FW");
76 
77 static int allow_vf_ioctls;
78 module_param(allow_vf_ioctls, int, S_IRUGO);
79 MODULE_PARM_DESC(allow_vf_ioctls, "Allow ioctls in SR-IOV VF mode. Default: 0");
80 
81 static unsigned int throttlequeuedepth = MEGASAS_THROTTLE_QUEUE_DEPTH;
82 module_param(throttlequeuedepth, int, S_IRUGO);
83 MODULE_PARM_DESC(throttlequeuedepth,
84 	"Adapter queue depth when throttled due to I/O timeout. Default: 16");
85 
86 int resetwaittime = MEGASAS_RESET_WAIT_TIME;
87 module_param(resetwaittime, int, S_IRUGO);
88 MODULE_PARM_DESC(resetwaittime, "Wait time in seconds after I/O timeout "
89 		 "before resetting adapter. Default: 180");
90 
91 int smp_affinity_enable = 1;
92 module_param(smp_affinity_enable, int, S_IRUGO);
93 MODULE_PARM_DESC(smp_affinity_enable, "SMP affinity feature enable/disbale Default: enable(1)");
94 
95 MODULE_LICENSE("GPL");
96 MODULE_VERSION(MEGASAS_VERSION);
97 MODULE_AUTHOR("megaraidlinux@lsi.com");
98 MODULE_DESCRIPTION("LSI MegaRAID SAS Driver");
99 
100 int megasas_transition_to_ready(struct megasas_instance *instance, int ocr);
101 static int megasas_get_pd_list(struct megasas_instance *instance);
102 static int megasas_ld_list_query(struct megasas_instance *instance,
103 				 u8 query_type);
104 static int megasas_issue_init_mfi(struct megasas_instance *instance);
105 static int megasas_register_aen(struct megasas_instance *instance,
106 				u32 seq_num, u32 class_locale_word);
107 /*
108  * PCI ID table for all supported controllers
109  */
110 static struct pci_device_id megasas_pci_table[] = {
111 
112 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1064R)},
113 	/* xscale IOP */
114 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078R)},
115 	/* ppc IOP */
116 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078DE)},
117 	/* ppc IOP */
118 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078GEN2)},
119 	/* gen2*/
120 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS0079GEN2)},
121 	/* gen2*/
122 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS0073SKINNY)},
123 	/* skinny*/
124 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS0071SKINNY)},
125 	/* skinny*/
126 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_VERDE_ZCR)},
127 	/* xscale IOP, vega */
128 	{PCI_DEVICE(PCI_VENDOR_ID_DELL, PCI_DEVICE_ID_DELL_PERC5)},
129 	/* xscale IOP */
130 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_FUSION)},
131 	/* Fusion */
132 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_PLASMA)},
133 	/* Plasma */
134 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_INVADER)},
135 	/* Invader */
136 	{PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_FURY)},
137 	/* Fury */
138 	{}
139 };
140 
141 MODULE_DEVICE_TABLE(pci, megasas_pci_table);
142 
143 static int megasas_mgmt_majorno;
144 struct megasas_mgmt_info megasas_mgmt_info;
145 static struct fasync_struct *megasas_async_queue;
146 static DEFINE_MUTEX(megasas_async_queue_mutex);
147 
148 static int megasas_poll_wait_aen;
149 static DECLARE_WAIT_QUEUE_HEAD(megasas_poll_wait);
150 static u32 support_poll_for_event;
151 u32 megasas_dbg_lvl;
152 static u32 support_device_change;
153 
154 /* define lock for aen poll */
155 spinlock_t poll_aen_lock;
156 
157 void
158 megasas_complete_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd,
159 		     u8 alt_status);
160 static u32
161 megasas_read_fw_status_reg_gen2(struct megasas_register_set __iomem *regs);
162 static int
163 megasas_adp_reset_gen2(struct megasas_instance *instance,
164 		       struct megasas_register_set __iomem *reg_set);
165 static irqreturn_t megasas_isr(int irq, void *devp);
166 static u32
167 megasas_init_adapter_mfi(struct megasas_instance *instance);
168 u32
169 megasas_build_and_issue_cmd(struct megasas_instance *instance,
170 			    struct scsi_cmnd *scmd);
171 static void megasas_complete_cmd_dpc(unsigned long instance_addr);
172 void
173 megasas_release_fusion(struct megasas_instance *instance);
174 int
175 megasas_ioc_init_fusion(struct megasas_instance *instance);
176 void
177 megasas_free_cmds_fusion(struct megasas_instance *instance);
178 u8
179 megasas_get_map_info(struct megasas_instance *instance);
180 int
181 megasas_sync_map_info(struct megasas_instance *instance);
182 int
183 wait_and_poll(struct megasas_instance *instance, struct megasas_cmd *cmd,
184 	int seconds);
185 void megasas_reset_reply_desc(struct megasas_instance *instance);
186 int megasas_reset_fusion(struct Scsi_Host *shost, int iotimeout);
187 void megasas_fusion_ocr_wq(struct work_struct *work);
188 static int megasas_get_ld_vf_affiliation(struct megasas_instance *instance,
189 					 int initial);
190 int megasas_check_mpio_paths(struct megasas_instance *instance,
191 			     struct scsi_cmnd *scmd);
192 
193 void
194 megasas_issue_dcmd(struct megasas_instance *instance, struct megasas_cmd *cmd)
195 {
196 	instance->instancet->fire_cmd(instance,
197 		cmd->frame_phys_addr, 0, instance->reg_set);
198 }
199 
200 /**
201  * megasas_get_cmd -	Get a command from the free pool
202  * @instance:		Adapter soft state
203  *
204  * Returns a free command from the pool
205  */
206 struct megasas_cmd *megasas_get_cmd(struct megasas_instance
207 						  *instance)
208 {
209 	unsigned long flags;
210 	struct megasas_cmd *cmd = NULL;
211 
212 	spin_lock_irqsave(&instance->mfi_pool_lock, flags);
213 
214 	if (!list_empty(&instance->cmd_pool)) {
215 		cmd = list_entry((&instance->cmd_pool)->next,
216 				 struct megasas_cmd, list);
217 		list_del_init(&cmd->list);
218 		atomic_set(&cmd->mfi_mpt_pthr, MFI_MPT_DETACHED);
219 	} else {
220 		printk(KERN_ERR "megasas: Command pool empty!\n");
221 	}
222 
223 	spin_unlock_irqrestore(&instance->mfi_pool_lock, flags);
224 	return cmd;
225 }
226 
227 /**
228  * __megasas_return_cmd -	Return a cmd to free command pool
229  * @instance:		Adapter soft state
230  * @cmd:		Command packet to be returned to free command pool
231  */
232 inline void
233 __megasas_return_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd)
234 {
235 	/*
236 	 * Don't go ahead and free the MFI frame, if corresponding
237 	 * MPT frame is not freed(valid for only fusion adapters).
238 	 * In case of MFI adapters, anyways for any allocated MFI
239 	 * frame will have cmd->mfi_mpt_mpthr set to MFI_MPT_DETACHED
240 	 */
241 	if (atomic_read(&cmd->mfi_mpt_pthr) != MFI_MPT_DETACHED)
242 		return;
243 
244 	cmd->scmd = NULL;
245 	cmd->frame_count = 0;
246 	cmd->is_wait_event = 0;
247 	cmd->mpt_pthr_cmd_blocked = NULL;
248 
249 	if ((instance->pdev->device != PCI_DEVICE_ID_LSI_FUSION) &&
250 	    (instance->pdev->device != PCI_DEVICE_ID_LSI_INVADER) &&
251 	    (instance->pdev->device != PCI_DEVICE_ID_LSI_FURY) &&
252 	    (reset_devices))
253 		cmd->frame->hdr.cmd = MFI_CMD_INVALID;
254 
255 	atomic_set(&cmd->mfi_mpt_pthr, MFI_LIST_ADDED);
256 	list_add(&cmd->list, (&instance->cmd_pool)->next);
257 }
258 
259 /**
260  * megasas_return_cmd -	Return a cmd to free command pool
261  * @instance:		Adapter soft state
262  * @cmd:		Command packet to be returned to free command pool
263  */
264 inline void
265 megasas_return_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd)
266 {
267 	unsigned long flags;
268 
269 	spin_lock_irqsave(&instance->mfi_pool_lock, flags);
270 	__megasas_return_cmd(instance, cmd);
271 	spin_unlock_irqrestore(&instance->mfi_pool_lock, flags);
272 }
273 
274 
275 /**
276 *	The following functions are defined for xscale
277 *	(deviceid : 1064R, PERC5) controllers
278 */
279 
280 /**
281  * megasas_enable_intr_xscale -	Enables interrupts
282  * @regs:			MFI register set
283  */
284 static inline void
285 megasas_enable_intr_xscale(struct megasas_instance *instance)
286 {
287 	struct megasas_register_set __iomem *regs;
288 	regs = instance->reg_set;
289 	writel(0, &(regs)->outbound_intr_mask);
290 
291 	/* Dummy readl to force pci flush */
292 	readl(&regs->outbound_intr_mask);
293 }
294 
295 /**
296  * megasas_disable_intr_xscale -Disables interrupt
297  * @regs:			MFI register set
298  */
299 static inline void
300 megasas_disable_intr_xscale(struct megasas_instance *instance)
301 {
302 	struct megasas_register_set __iomem *regs;
303 	u32 mask = 0x1f;
304 	regs = instance->reg_set;
305 	writel(mask, &regs->outbound_intr_mask);
306 	/* Dummy readl to force pci flush */
307 	readl(&regs->outbound_intr_mask);
308 }
309 
310 /**
311  * megasas_read_fw_status_reg_xscale - returns the current FW status value
312  * @regs:			MFI register set
313  */
314 static u32
315 megasas_read_fw_status_reg_xscale(struct megasas_register_set __iomem * regs)
316 {
317 	return readl(&(regs)->outbound_msg_0);
318 }
319 /**
320  * megasas_clear_interrupt_xscale -	Check & clear interrupt
321  * @regs:				MFI register set
322  */
323 static int
324 megasas_clear_intr_xscale(struct megasas_register_set __iomem * regs)
325 {
326 	u32 status;
327 	u32 mfiStatus = 0;
328 	/*
329 	 * Check if it is our interrupt
330 	 */
331 	status = readl(&regs->outbound_intr_status);
332 
333 	if (status & MFI_OB_INTR_STATUS_MASK)
334 		mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
335 	if (status & MFI_XSCALE_OMR0_CHANGE_INTERRUPT)
336 		mfiStatus |= MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
337 
338 	/*
339 	 * Clear the interrupt by writing back the same value
340 	 */
341 	if (mfiStatus)
342 		writel(status, &regs->outbound_intr_status);
343 
344 	/* Dummy readl to force pci flush */
345 	readl(&regs->outbound_intr_status);
346 
347 	return mfiStatus;
348 }
349 
350 /**
351  * megasas_fire_cmd_xscale -	Sends command to the FW
352  * @frame_phys_addr :		Physical address of cmd
353  * @frame_count :		Number of frames for the command
354  * @regs :			MFI register set
355  */
356 static inline void
357 megasas_fire_cmd_xscale(struct megasas_instance *instance,
358 		dma_addr_t frame_phys_addr,
359 		u32 frame_count,
360 		struct megasas_register_set __iomem *regs)
361 {
362 	unsigned long flags;
363 	spin_lock_irqsave(&instance->hba_lock, flags);
364 	writel((frame_phys_addr >> 3)|(frame_count),
365 	       &(regs)->inbound_queue_port);
366 	spin_unlock_irqrestore(&instance->hba_lock, flags);
367 }
368 
369 /**
370  * megasas_adp_reset_xscale -  For controller reset
371  * @regs:                              MFI register set
372  */
373 static int
374 megasas_adp_reset_xscale(struct megasas_instance *instance,
375 	struct megasas_register_set __iomem *regs)
376 {
377 	u32 i;
378 	u32 pcidata;
379 	writel(MFI_ADP_RESET, &regs->inbound_doorbell);
380 
381 	for (i = 0; i < 3; i++)
382 		msleep(1000); /* sleep for 3 secs */
383 	pcidata  = 0;
384 	pci_read_config_dword(instance->pdev, MFI_1068_PCSR_OFFSET, &pcidata);
385 	printk(KERN_NOTICE "pcidata = %x\n", pcidata);
386 	if (pcidata & 0x2) {
387 		printk(KERN_NOTICE "mfi 1068 offset read=%x\n", pcidata);
388 		pcidata &= ~0x2;
389 		pci_write_config_dword(instance->pdev,
390 				MFI_1068_PCSR_OFFSET, pcidata);
391 
392 		for (i = 0; i < 2; i++)
393 			msleep(1000); /* need to wait 2 secs again */
394 
395 		pcidata  = 0;
396 		pci_read_config_dword(instance->pdev,
397 				MFI_1068_FW_HANDSHAKE_OFFSET, &pcidata);
398 		printk(KERN_NOTICE "1068 offset handshake read=%x\n", pcidata);
399 		if ((pcidata & 0xffff0000) == MFI_1068_FW_READY) {
400 			printk(KERN_NOTICE "1068 offset pcidt=%x\n", pcidata);
401 			pcidata = 0;
402 			pci_write_config_dword(instance->pdev,
403 				MFI_1068_FW_HANDSHAKE_OFFSET, pcidata);
404 		}
405 	}
406 	return 0;
407 }
408 
409 /**
410  * megasas_check_reset_xscale -	For controller reset check
411  * @regs:				MFI register set
412  */
413 static int
414 megasas_check_reset_xscale(struct megasas_instance *instance,
415 		struct megasas_register_set __iomem *regs)
416 {
417 
418 	if ((instance->adprecovery != MEGASAS_HBA_OPERATIONAL) &&
419 	    (le32_to_cpu(*instance->consumer) ==
420 		MEGASAS_ADPRESET_INPROG_SIGN))
421 		return 1;
422 	return 0;
423 }
424 
425 static struct megasas_instance_template megasas_instance_template_xscale = {
426 
427 	.fire_cmd = megasas_fire_cmd_xscale,
428 	.enable_intr = megasas_enable_intr_xscale,
429 	.disable_intr = megasas_disable_intr_xscale,
430 	.clear_intr = megasas_clear_intr_xscale,
431 	.read_fw_status_reg = megasas_read_fw_status_reg_xscale,
432 	.adp_reset = megasas_adp_reset_xscale,
433 	.check_reset = megasas_check_reset_xscale,
434 	.service_isr = megasas_isr,
435 	.tasklet = megasas_complete_cmd_dpc,
436 	.init_adapter = megasas_init_adapter_mfi,
437 	.build_and_issue_cmd = megasas_build_and_issue_cmd,
438 	.issue_dcmd = megasas_issue_dcmd,
439 };
440 
441 /**
442 *	This is the end of set of functions & definitions specific
443 *	to xscale (deviceid : 1064R, PERC5) controllers
444 */
445 
446 /**
447 *	The following functions are defined for ppc (deviceid : 0x60)
448 * 	controllers
449 */
450 
451 /**
452  * megasas_enable_intr_ppc -	Enables interrupts
453  * @regs:			MFI register set
454  */
455 static inline void
456 megasas_enable_intr_ppc(struct megasas_instance *instance)
457 {
458 	struct megasas_register_set __iomem *regs;
459 	regs = instance->reg_set;
460 	writel(0xFFFFFFFF, &(regs)->outbound_doorbell_clear);
461 
462 	writel(~0x80000000, &(regs)->outbound_intr_mask);
463 
464 	/* Dummy readl to force pci flush */
465 	readl(&regs->outbound_intr_mask);
466 }
467 
468 /**
469  * megasas_disable_intr_ppc -	Disable interrupt
470  * @regs:			MFI register set
471  */
472 static inline void
473 megasas_disable_intr_ppc(struct megasas_instance *instance)
474 {
475 	struct megasas_register_set __iomem *regs;
476 	u32 mask = 0xFFFFFFFF;
477 	regs = instance->reg_set;
478 	writel(mask, &regs->outbound_intr_mask);
479 	/* Dummy readl to force pci flush */
480 	readl(&regs->outbound_intr_mask);
481 }
482 
483 /**
484  * megasas_read_fw_status_reg_ppc - returns the current FW status value
485  * @regs:			MFI register set
486  */
487 static u32
488 megasas_read_fw_status_reg_ppc(struct megasas_register_set __iomem * regs)
489 {
490 	return readl(&(regs)->outbound_scratch_pad);
491 }
492 
493 /**
494  * megasas_clear_interrupt_ppc -	Check & clear interrupt
495  * @regs:				MFI register set
496  */
497 static int
498 megasas_clear_intr_ppc(struct megasas_register_set __iomem * regs)
499 {
500 	u32 status, mfiStatus = 0;
501 
502 	/*
503 	 * Check if it is our interrupt
504 	 */
505 	status = readl(&regs->outbound_intr_status);
506 
507 	if (status & MFI_REPLY_1078_MESSAGE_INTERRUPT)
508 		mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
509 
510 	if (status & MFI_G2_OUTBOUND_DOORBELL_CHANGE_INTERRUPT)
511 		mfiStatus |= MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
512 
513 	/*
514 	 * Clear the interrupt by writing back the same value
515 	 */
516 	writel(status, &regs->outbound_doorbell_clear);
517 
518 	/* Dummy readl to force pci flush */
519 	readl(&regs->outbound_doorbell_clear);
520 
521 	return mfiStatus;
522 }
523 
524 /**
525  * megasas_fire_cmd_ppc -	Sends command to the FW
526  * @frame_phys_addr :		Physical address of cmd
527  * @frame_count :		Number of frames for the command
528  * @regs :			MFI register set
529  */
530 static inline void
531 megasas_fire_cmd_ppc(struct megasas_instance *instance,
532 		dma_addr_t frame_phys_addr,
533 		u32 frame_count,
534 		struct megasas_register_set __iomem *regs)
535 {
536 	unsigned long flags;
537 	spin_lock_irqsave(&instance->hba_lock, flags);
538 	writel((frame_phys_addr | (frame_count<<1))|1,
539 			&(regs)->inbound_queue_port);
540 	spin_unlock_irqrestore(&instance->hba_lock, flags);
541 }
542 
543 /**
544  * megasas_check_reset_ppc -	For controller reset check
545  * @regs:				MFI register set
546  */
547 static int
548 megasas_check_reset_ppc(struct megasas_instance *instance,
549 			struct megasas_register_set __iomem *regs)
550 {
551 	if (instance->adprecovery != MEGASAS_HBA_OPERATIONAL)
552 		return 1;
553 
554 	return 0;
555 }
556 
557 static struct megasas_instance_template megasas_instance_template_ppc = {
558 
559 	.fire_cmd = megasas_fire_cmd_ppc,
560 	.enable_intr = megasas_enable_intr_ppc,
561 	.disable_intr = megasas_disable_intr_ppc,
562 	.clear_intr = megasas_clear_intr_ppc,
563 	.read_fw_status_reg = megasas_read_fw_status_reg_ppc,
564 	.adp_reset = megasas_adp_reset_xscale,
565 	.check_reset = megasas_check_reset_ppc,
566 	.service_isr = megasas_isr,
567 	.tasklet = megasas_complete_cmd_dpc,
568 	.init_adapter = megasas_init_adapter_mfi,
569 	.build_and_issue_cmd = megasas_build_and_issue_cmd,
570 	.issue_dcmd = megasas_issue_dcmd,
571 };
572 
573 /**
574  * megasas_enable_intr_skinny -	Enables interrupts
575  * @regs:			MFI register set
576  */
577 static inline void
578 megasas_enable_intr_skinny(struct megasas_instance *instance)
579 {
580 	struct megasas_register_set __iomem *regs;
581 	regs = instance->reg_set;
582 	writel(0xFFFFFFFF, &(regs)->outbound_intr_mask);
583 
584 	writel(~MFI_SKINNY_ENABLE_INTERRUPT_MASK, &(regs)->outbound_intr_mask);
585 
586 	/* Dummy readl to force pci flush */
587 	readl(&regs->outbound_intr_mask);
588 }
589 
590 /**
591  * megasas_disable_intr_skinny -	Disables interrupt
592  * @regs:			MFI register set
593  */
594 static inline void
595 megasas_disable_intr_skinny(struct megasas_instance *instance)
596 {
597 	struct megasas_register_set __iomem *regs;
598 	u32 mask = 0xFFFFFFFF;
599 	regs = instance->reg_set;
600 	writel(mask, &regs->outbound_intr_mask);
601 	/* Dummy readl to force pci flush */
602 	readl(&regs->outbound_intr_mask);
603 }
604 
605 /**
606  * megasas_read_fw_status_reg_skinny - returns the current FW status value
607  * @regs:			MFI register set
608  */
609 static u32
610 megasas_read_fw_status_reg_skinny(struct megasas_register_set __iomem *regs)
611 {
612 	return readl(&(regs)->outbound_scratch_pad);
613 }
614 
615 /**
616  * megasas_clear_interrupt_skinny -	Check & clear interrupt
617  * @regs:				MFI register set
618  */
619 static int
620 megasas_clear_intr_skinny(struct megasas_register_set __iomem *regs)
621 {
622 	u32 status;
623 	u32 mfiStatus = 0;
624 
625 	/*
626 	 * Check if it is our interrupt
627 	 */
628 	status = readl(&regs->outbound_intr_status);
629 
630 	if (!(status & MFI_SKINNY_ENABLE_INTERRUPT_MASK)) {
631 		return 0;
632 	}
633 
634 	/*
635 	 * Check if it is our interrupt
636 	 */
637 	if ((megasas_read_fw_status_reg_skinny(regs) & MFI_STATE_MASK) ==
638 	    MFI_STATE_FAULT) {
639 		mfiStatus = MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
640 	} else
641 		mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
642 
643 	/*
644 	 * Clear the interrupt by writing back the same value
645 	 */
646 	writel(status, &regs->outbound_intr_status);
647 
648 	/*
649 	* dummy read to flush PCI
650 	*/
651 	readl(&regs->outbound_intr_status);
652 
653 	return mfiStatus;
654 }
655 
656 /**
657  * megasas_fire_cmd_skinny -	Sends command to the FW
658  * @frame_phys_addr :		Physical address of cmd
659  * @frame_count :		Number of frames for the command
660  * @regs :			MFI register set
661  */
662 static inline void
663 megasas_fire_cmd_skinny(struct megasas_instance *instance,
664 			dma_addr_t frame_phys_addr,
665 			u32 frame_count,
666 			struct megasas_register_set __iomem *regs)
667 {
668 	unsigned long flags;
669 	spin_lock_irqsave(&instance->hba_lock, flags);
670 	writel(upper_32_bits(frame_phys_addr),
671 	       &(regs)->inbound_high_queue_port);
672 	writel((lower_32_bits(frame_phys_addr) | (frame_count<<1))|1,
673 	       &(regs)->inbound_low_queue_port);
674 	spin_unlock_irqrestore(&instance->hba_lock, flags);
675 }
676 
677 /**
678  * megasas_check_reset_skinny -	For controller reset check
679  * @regs:				MFI register set
680  */
681 static int
682 megasas_check_reset_skinny(struct megasas_instance *instance,
683 				struct megasas_register_set __iomem *regs)
684 {
685 	if (instance->adprecovery != MEGASAS_HBA_OPERATIONAL)
686 		return 1;
687 
688 	return 0;
689 }
690 
691 static struct megasas_instance_template megasas_instance_template_skinny = {
692 
693 	.fire_cmd = megasas_fire_cmd_skinny,
694 	.enable_intr = megasas_enable_intr_skinny,
695 	.disable_intr = megasas_disable_intr_skinny,
696 	.clear_intr = megasas_clear_intr_skinny,
697 	.read_fw_status_reg = megasas_read_fw_status_reg_skinny,
698 	.adp_reset = megasas_adp_reset_gen2,
699 	.check_reset = megasas_check_reset_skinny,
700 	.service_isr = megasas_isr,
701 	.tasklet = megasas_complete_cmd_dpc,
702 	.init_adapter = megasas_init_adapter_mfi,
703 	.build_and_issue_cmd = megasas_build_and_issue_cmd,
704 	.issue_dcmd = megasas_issue_dcmd,
705 };
706 
707 
708 /**
709 *	The following functions are defined for gen2 (deviceid : 0x78 0x79)
710 *	controllers
711 */
712 
713 /**
714  * megasas_enable_intr_gen2 -  Enables interrupts
715  * @regs:                      MFI register set
716  */
717 static inline void
718 megasas_enable_intr_gen2(struct megasas_instance *instance)
719 {
720 	struct megasas_register_set __iomem *regs;
721 	regs = instance->reg_set;
722 	writel(0xFFFFFFFF, &(regs)->outbound_doorbell_clear);
723 
724 	/* write ~0x00000005 (4 & 1) to the intr mask*/
725 	writel(~MFI_GEN2_ENABLE_INTERRUPT_MASK, &(regs)->outbound_intr_mask);
726 
727 	/* Dummy readl to force pci flush */
728 	readl(&regs->outbound_intr_mask);
729 }
730 
731 /**
732  * megasas_disable_intr_gen2 - Disables interrupt
733  * @regs:                      MFI register set
734  */
735 static inline void
736 megasas_disable_intr_gen2(struct megasas_instance *instance)
737 {
738 	struct megasas_register_set __iomem *regs;
739 	u32 mask = 0xFFFFFFFF;
740 	regs = instance->reg_set;
741 	writel(mask, &regs->outbound_intr_mask);
742 	/* Dummy readl to force pci flush */
743 	readl(&regs->outbound_intr_mask);
744 }
745 
746 /**
747  * megasas_read_fw_status_reg_gen2 - returns the current FW status value
748  * @regs:                      MFI register set
749  */
750 static u32
751 megasas_read_fw_status_reg_gen2(struct megasas_register_set __iomem *regs)
752 {
753 	return readl(&(regs)->outbound_scratch_pad);
754 }
755 
756 /**
757  * megasas_clear_interrupt_gen2 -      Check & clear interrupt
758  * @regs:                              MFI register set
759  */
760 static int
761 megasas_clear_intr_gen2(struct megasas_register_set __iomem *regs)
762 {
763 	u32 status;
764 	u32 mfiStatus = 0;
765 	/*
766 	 * Check if it is our interrupt
767 	 */
768 	status = readl(&regs->outbound_intr_status);
769 
770 	if (status & MFI_INTR_FLAG_REPLY_MESSAGE) {
771 		mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
772 	}
773 	if (status & MFI_G2_OUTBOUND_DOORBELL_CHANGE_INTERRUPT) {
774 		mfiStatus |= MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
775 	}
776 
777 	/*
778 	 * Clear the interrupt by writing back the same value
779 	 */
780 	if (mfiStatus)
781 		writel(status, &regs->outbound_doorbell_clear);
782 
783 	/* Dummy readl to force pci flush */
784 	readl(&regs->outbound_intr_status);
785 
786 	return mfiStatus;
787 }
788 /**
789  * megasas_fire_cmd_gen2 -     Sends command to the FW
790  * @frame_phys_addr :          Physical address of cmd
791  * @frame_count :              Number of frames for the command
792  * @regs :                     MFI register set
793  */
794 static inline void
795 megasas_fire_cmd_gen2(struct megasas_instance *instance,
796 			dma_addr_t frame_phys_addr,
797 			u32 frame_count,
798 			struct megasas_register_set __iomem *regs)
799 {
800 	unsigned long flags;
801 	spin_lock_irqsave(&instance->hba_lock, flags);
802 	writel((frame_phys_addr | (frame_count<<1))|1,
803 			&(regs)->inbound_queue_port);
804 	spin_unlock_irqrestore(&instance->hba_lock, flags);
805 }
806 
807 /**
808  * megasas_adp_reset_gen2 -	For controller reset
809  * @regs:				MFI register set
810  */
811 static int
812 megasas_adp_reset_gen2(struct megasas_instance *instance,
813 			struct megasas_register_set __iomem *reg_set)
814 {
815 	u32			retry = 0 ;
816 	u32			HostDiag;
817 	u32			*seq_offset = &reg_set->seq_offset;
818 	u32			*hostdiag_offset = &reg_set->host_diag;
819 
820 	if (instance->instancet == &megasas_instance_template_skinny) {
821 		seq_offset = &reg_set->fusion_seq_offset;
822 		hostdiag_offset = &reg_set->fusion_host_diag;
823 	}
824 
825 	writel(0, seq_offset);
826 	writel(4, seq_offset);
827 	writel(0xb, seq_offset);
828 	writel(2, seq_offset);
829 	writel(7, seq_offset);
830 	writel(0xd, seq_offset);
831 
832 	msleep(1000);
833 
834 	HostDiag = (u32)readl(hostdiag_offset);
835 
836 	while ( !( HostDiag & DIAG_WRITE_ENABLE) ) {
837 		msleep(100);
838 		HostDiag = (u32)readl(hostdiag_offset);
839 		printk(KERN_NOTICE "RESETGEN2: retry=%x, hostdiag=%x\n",
840 					retry, HostDiag);
841 
842 		if (retry++ >= 100)
843 			return 1;
844 
845 	}
846 
847 	printk(KERN_NOTICE "ADP_RESET_GEN2: HostDiag=%x\n", HostDiag);
848 
849 	writel((HostDiag | DIAG_RESET_ADAPTER), hostdiag_offset);
850 
851 	ssleep(10);
852 
853 	HostDiag = (u32)readl(hostdiag_offset);
854 	while ( ( HostDiag & DIAG_RESET_ADAPTER) ) {
855 		msleep(100);
856 		HostDiag = (u32)readl(hostdiag_offset);
857 		printk(KERN_NOTICE "RESET_GEN2: retry=%x, hostdiag=%x\n",
858 				retry, HostDiag);
859 
860 		if (retry++ >= 1000)
861 			return 1;
862 
863 	}
864 	return 0;
865 }
866 
867 /**
868  * megasas_check_reset_gen2 -	For controller reset check
869  * @regs:				MFI register set
870  */
871 static int
872 megasas_check_reset_gen2(struct megasas_instance *instance,
873 		struct megasas_register_set __iomem *regs)
874 {
875 	if (instance->adprecovery != MEGASAS_HBA_OPERATIONAL) {
876 		return 1;
877 	}
878 
879 	return 0;
880 }
881 
882 static struct megasas_instance_template megasas_instance_template_gen2 = {
883 
884 	.fire_cmd = megasas_fire_cmd_gen2,
885 	.enable_intr = megasas_enable_intr_gen2,
886 	.disable_intr = megasas_disable_intr_gen2,
887 	.clear_intr = megasas_clear_intr_gen2,
888 	.read_fw_status_reg = megasas_read_fw_status_reg_gen2,
889 	.adp_reset = megasas_adp_reset_gen2,
890 	.check_reset = megasas_check_reset_gen2,
891 	.service_isr = megasas_isr,
892 	.tasklet = megasas_complete_cmd_dpc,
893 	.init_adapter = megasas_init_adapter_mfi,
894 	.build_and_issue_cmd = megasas_build_and_issue_cmd,
895 	.issue_dcmd = megasas_issue_dcmd,
896 };
897 
898 /**
899 *	This is the end of set of functions & definitions
900 *       specific to gen2 (deviceid : 0x78, 0x79) controllers
901 */
902 
903 /*
904  * Template added for TB (Fusion)
905  */
906 extern struct megasas_instance_template megasas_instance_template_fusion;
907 
908 /**
909  * megasas_issue_polled -	Issues a polling command
910  * @instance:			Adapter soft state
911  * @cmd:			Command packet to be issued
912  *
913  * For polling, MFI requires the cmd_status to be set to 0xFF before posting.
914  */
915 int
916 megasas_issue_polled(struct megasas_instance *instance, struct megasas_cmd *cmd)
917 {
918 	int seconds;
919 
920 	struct megasas_header *frame_hdr = &cmd->frame->hdr;
921 
922 	frame_hdr->cmd_status = MFI_CMD_STATUS_POLL_MODE;
923 	frame_hdr->flags |= cpu_to_le16(MFI_FRAME_DONT_POST_IN_REPLY_QUEUE);
924 
925 	/*
926 	 * Issue the frame using inbound queue port
927 	 */
928 	instance->instancet->issue_dcmd(instance, cmd);
929 
930 	/*
931 	 * Wait for cmd_status to change
932 	 */
933 	if (instance->requestorId)
934 		seconds = MEGASAS_ROUTINE_WAIT_TIME_VF;
935 	else
936 		seconds = MFI_POLL_TIMEOUT_SECS;
937 	return wait_and_poll(instance, cmd, seconds);
938 }
939 
940 /**
941  * megasas_issue_blocked_cmd -	Synchronous wrapper around regular FW cmds
942  * @instance:			Adapter soft state
943  * @cmd:			Command to be issued
944  * @timeout:			Timeout in seconds
945  *
946  * This function waits on an event for the command to be returned from ISR.
947  * Max wait time is MEGASAS_INTERNAL_CMD_WAIT_TIME secs
948  * Used to issue ioctl commands.
949  */
950 int
951 megasas_issue_blocked_cmd(struct megasas_instance *instance,
952 			  struct megasas_cmd *cmd, int timeout)
953 {
954 	int ret = 0;
955 	cmd->cmd_status = ENODATA;
956 
957 	cmd->is_wait_event = 1;
958 	instance->instancet->issue_dcmd(instance, cmd);
959 	if (timeout) {
960 		ret = wait_event_timeout(instance->int_cmd_wait_q,
961 				cmd->cmd_status != ENODATA, timeout * HZ);
962 		if (!ret)
963 			return 1;
964 	} else
965 		wait_event(instance->int_cmd_wait_q,
966 				cmd->cmd_status != ENODATA);
967 
968 	return 0;
969 }
970 
971 /**
972  * megasas_issue_blocked_abort_cmd -	Aborts previously issued cmd
973  * @instance:				Adapter soft state
974  * @cmd_to_abort:			Previously issued cmd to be aborted
975  * @timeout:				Timeout in seconds
976  *
977  * MFI firmware can abort previously issued AEN comamnd (automatic event
978  * notification). The megasas_issue_blocked_abort_cmd() issues such abort
979  * cmd and waits for return status.
980  * Max wait time is MEGASAS_INTERNAL_CMD_WAIT_TIME secs
981  */
982 static int
983 megasas_issue_blocked_abort_cmd(struct megasas_instance *instance,
984 				struct megasas_cmd *cmd_to_abort, int timeout)
985 {
986 	struct megasas_cmd *cmd;
987 	struct megasas_abort_frame *abort_fr;
988 	int ret = 0;
989 
990 	cmd = megasas_get_cmd(instance);
991 
992 	if (!cmd)
993 		return -1;
994 
995 	abort_fr = &cmd->frame->abort;
996 
997 	/*
998 	 * Prepare and issue the abort frame
999 	 */
1000 	abort_fr->cmd = MFI_CMD_ABORT;
1001 	abort_fr->cmd_status = 0xFF;
1002 	abort_fr->flags = cpu_to_le16(0);
1003 	abort_fr->abort_context = cpu_to_le32(cmd_to_abort->index);
1004 	abort_fr->abort_mfi_phys_addr_lo =
1005 		cpu_to_le32(lower_32_bits(cmd_to_abort->frame_phys_addr));
1006 	abort_fr->abort_mfi_phys_addr_hi =
1007 		cpu_to_le32(upper_32_bits(cmd_to_abort->frame_phys_addr));
1008 
1009 	cmd->sync_cmd = 1;
1010 	cmd->cmd_status = ENODATA;
1011 
1012 	instance->instancet->issue_dcmd(instance, cmd);
1013 
1014 	if (timeout) {
1015 		ret = wait_event_timeout(instance->abort_cmd_wait_q,
1016 				cmd->cmd_status != ENODATA, timeout * HZ);
1017 		if (!ret) {
1018 			dev_err(&instance->pdev->dev, "Command timedout"
1019 				"from %s\n", __func__);
1020 			return 1;
1021 		}
1022 	} else
1023 		wait_event(instance->abort_cmd_wait_q,
1024 				cmd->cmd_status != ENODATA);
1025 
1026 	cmd->sync_cmd = 0;
1027 
1028 	megasas_return_cmd(instance, cmd);
1029 	return 0;
1030 }
1031 
1032 /**
1033  * megasas_make_sgl32 -	Prepares 32-bit SGL
1034  * @instance:		Adapter soft state
1035  * @scp:		SCSI command from the mid-layer
1036  * @mfi_sgl:		SGL to be filled in
1037  *
1038  * If successful, this function returns the number of SG elements. Otherwise,
1039  * it returnes -1.
1040  */
1041 static int
1042 megasas_make_sgl32(struct megasas_instance *instance, struct scsi_cmnd *scp,
1043 		   union megasas_sgl *mfi_sgl)
1044 {
1045 	int i;
1046 	int sge_count;
1047 	struct scatterlist *os_sgl;
1048 
1049 	sge_count = scsi_dma_map(scp);
1050 	BUG_ON(sge_count < 0);
1051 
1052 	if (sge_count) {
1053 		scsi_for_each_sg(scp, os_sgl, sge_count, i) {
1054 			mfi_sgl->sge32[i].length = cpu_to_le32(sg_dma_len(os_sgl));
1055 			mfi_sgl->sge32[i].phys_addr = cpu_to_le32(sg_dma_address(os_sgl));
1056 		}
1057 	}
1058 	return sge_count;
1059 }
1060 
1061 /**
1062  * megasas_make_sgl64 -	Prepares 64-bit SGL
1063  * @instance:		Adapter soft state
1064  * @scp:		SCSI command from the mid-layer
1065  * @mfi_sgl:		SGL to be filled in
1066  *
1067  * If successful, this function returns the number of SG elements. Otherwise,
1068  * it returnes -1.
1069  */
1070 static int
1071 megasas_make_sgl64(struct megasas_instance *instance, struct scsi_cmnd *scp,
1072 		   union megasas_sgl *mfi_sgl)
1073 {
1074 	int i;
1075 	int sge_count;
1076 	struct scatterlist *os_sgl;
1077 
1078 	sge_count = scsi_dma_map(scp);
1079 	BUG_ON(sge_count < 0);
1080 
1081 	if (sge_count) {
1082 		scsi_for_each_sg(scp, os_sgl, sge_count, i) {
1083 			mfi_sgl->sge64[i].length = cpu_to_le32(sg_dma_len(os_sgl));
1084 			mfi_sgl->sge64[i].phys_addr = cpu_to_le64(sg_dma_address(os_sgl));
1085 		}
1086 	}
1087 	return sge_count;
1088 }
1089 
1090 /**
1091  * megasas_make_sgl_skinny - Prepares IEEE SGL
1092  * @instance:           Adapter soft state
1093  * @scp:                SCSI command from the mid-layer
1094  * @mfi_sgl:            SGL to be filled in
1095  *
1096  * If successful, this function returns the number of SG elements. Otherwise,
1097  * it returnes -1.
1098  */
1099 static int
1100 megasas_make_sgl_skinny(struct megasas_instance *instance,
1101 		struct scsi_cmnd *scp, union megasas_sgl *mfi_sgl)
1102 {
1103 	int i;
1104 	int sge_count;
1105 	struct scatterlist *os_sgl;
1106 
1107 	sge_count = scsi_dma_map(scp);
1108 
1109 	if (sge_count) {
1110 		scsi_for_each_sg(scp, os_sgl, sge_count, i) {
1111 			mfi_sgl->sge_skinny[i].length =
1112 				cpu_to_le32(sg_dma_len(os_sgl));
1113 			mfi_sgl->sge_skinny[i].phys_addr =
1114 				cpu_to_le64(sg_dma_address(os_sgl));
1115 			mfi_sgl->sge_skinny[i].flag = cpu_to_le32(0);
1116 		}
1117 	}
1118 	return sge_count;
1119 }
1120 
1121  /**
1122  * megasas_get_frame_count - Computes the number of frames
1123  * @frame_type		: type of frame- io or pthru frame
1124  * @sge_count		: number of sg elements
1125  *
1126  * Returns the number of frames required for numnber of sge's (sge_count)
1127  */
1128 
1129 static u32 megasas_get_frame_count(struct megasas_instance *instance,
1130 			u8 sge_count, u8 frame_type)
1131 {
1132 	int num_cnt;
1133 	int sge_bytes;
1134 	u32 sge_sz;
1135 	u32 frame_count=0;
1136 
1137 	sge_sz = (IS_DMA64) ? sizeof(struct megasas_sge64) :
1138 	    sizeof(struct megasas_sge32);
1139 
1140 	if (instance->flag_ieee) {
1141 		sge_sz = sizeof(struct megasas_sge_skinny);
1142 	}
1143 
1144 	/*
1145 	 * Main frame can contain 2 SGEs for 64-bit SGLs and
1146 	 * 3 SGEs for 32-bit SGLs for ldio &
1147 	 * 1 SGEs for 64-bit SGLs and
1148 	 * 2 SGEs for 32-bit SGLs for pthru frame
1149 	 */
1150 	if (unlikely(frame_type == PTHRU_FRAME)) {
1151 		if (instance->flag_ieee == 1) {
1152 			num_cnt = sge_count - 1;
1153 		} else if (IS_DMA64)
1154 			num_cnt = sge_count - 1;
1155 		else
1156 			num_cnt = sge_count - 2;
1157 	} else {
1158 		if (instance->flag_ieee == 1) {
1159 			num_cnt = sge_count - 1;
1160 		} else if (IS_DMA64)
1161 			num_cnt = sge_count - 2;
1162 		else
1163 			num_cnt = sge_count - 3;
1164 	}
1165 
1166 	if(num_cnt>0){
1167 		sge_bytes = sge_sz * num_cnt;
1168 
1169 		frame_count = (sge_bytes / MEGAMFI_FRAME_SIZE) +
1170 		    ((sge_bytes % MEGAMFI_FRAME_SIZE) ? 1 : 0) ;
1171 	}
1172 	/* Main frame */
1173 	frame_count +=1;
1174 
1175 	if (frame_count > 7)
1176 		frame_count = 8;
1177 	return frame_count;
1178 }
1179 
1180 /**
1181  * megasas_build_dcdb -	Prepares a direct cdb (DCDB) command
1182  * @instance:		Adapter soft state
1183  * @scp:		SCSI command
1184  * @cmd:		Command to be prepared in
1185  *
1186  * This function prepares CDB commands. These are typcially pass-through
1187  * commands to the devices.
1188  */
1189 static int
1190 megasas_build_dcdb(struct megasas_instance *instance, struct scsi_cmnd *scp,
1191 		   struct megasas_cmd *cmd)
1192 {
1193 	u32 is_logical;
1194 	u32 device_id;
1195 	u16 flags = 0;
1196 	struct megasas_pthru_frame *pthru;
1197 
1198 	is_logical = MEGASAS_IS_LOGICAL(scp);
1199 	device_id = MEGASAS_DEV_INDEX(instance, scp);
1200 	pthru = (struct megasas_pthru_frame *)cmd->frame;
1201 
1202 	if (scp->sc_data_direction == PCI_DMA_TODEVICE)
1203 		flags = MFI_FRAME_DIR_WRITE;
1204 	else if (scp->sc_data_direction == PCI_DMA_FROMDEVICE)
1205 		flags = MFI_FRAME_DIR_READ;
1206 	else if (scp->sc_data_direction == PCI_DMA_NONE)
1207 		flags = MFI_FRAME_DIR_NONE;
1208 
1209 	if (instance->flag_ieee == 1) {
1210 		flags |= MFI_FRAME_IEEE;
1211 	}
1212 
1213 	/*
1214 	 * Prepare the DCDB frame
1215 	 */
1216 	pthru->cmd = (is_logical) ? MFI_CMD_LD_SCSI_IO : MFI_CMD_PD_SCSI_IO;
1217 	pthru->cmd_status = 0x0;
1218 	pthru->scsi_status = 0x0;
1219 	pthru->target_id = device_id;
1220 	pthru->lun = scp->device->lun;
1221 	pthru->cdb_len = scp->cmd_len;
1222 	pthru->timeout = 0;
1223 	pthru->pad_0 = 0;
1224 	pthru->flags = cpu_to_le16(flags);
1225 	pthru->data_xfer_len = cpu_to_le32(scsi_bufflen(scp));
1226 
1227 	memcpy(pthru->cdb, scp->cmnd, scp->cmd_len);
1228 
1229 	/*
1230 	* If the command is for the tape device, set the
1231 	* pthru timeout to the os layer timeout value.
1232 	*/
1233 	if (scp->device->type == TYPE_TAPE) {
1234 		if ((scp->request->timeout / HZ) > 0xFFFF)
1235 			pthru->timeout = 0xFFFF;
1236 		else
1237 			pthru->timeout = cpu_to_le16(scp->request->timeout / HZ);
1238 	}
1239 
1240 	/*
1241 	 * Construct SGL
1242 	 */
1243 	if (instance->flag_ieee == 1) {
1244 		pthru->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1245 		pthru->sge_count = megasas_make_sgl_skinny(instance, scp,
1246 						      &pthru->sgl);
1247 	} else if (IS_DMA64) {
1248 		pthru->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1249 		pthru->sge_count = megasas_make_sgl64(instance, scp,
1250 						      &pthru->sgl);
1251 	} else
1252 		pthru->sge_count = megasas_make_sgl32(instance, scp,
1253 						      &pthru->sgl);
1254 
1255 	if (pthru->sge_count > instance->max_num_sge) {
1256 		printk(KERN_ERR "megasas: DCDB two many SGE NUM=%x\n",
1257 			pthru->sge_count);
1258 		return 0;
1259 	}
1260 
1261 	/*
1262 	 * Sense info specific
1263 	 */
1264 	pthru->sense_len = SCSI_SENSE_BUFFERSIZE;
1265 	pthru->sense_buf_phys_addr_hi =
1266 		cpu_to_le32(upper_32_bits(cmd->sense_phys_addr));
1267 	pthru->sense_buf_phys_addr_lo =
1268 		cpu_to_le32(lower_32_bits(cmd->sense_phys_addr));
1269 
1270 	/*
1271 	 * Compute the total number of frames this command consumes. FW uses
1272 	 * this number to pull sufficient number of frames from host memory.
1273 	 */
1274 	cmd->frame_count = megasas_get_frame_count(instance, pthru->sge_count,
1275 							PTHRU_FRAME);
1276 
1277 	return cmd->frame_count;
1278 }
1279 
1280 /**
1281  * megasas_build_ldio -	Prepares IOs to logical devices
1282  * @instance:		Adapter soft state
1283  * @scp:		SCSI command
1284  * @cmd:		Command to be prepared
1285  *
1286  * Frames (and accompanying SGLs) for regular SCSI IOs use this function.
1287  */
1288 static int
1289 megasas_build_ldio(struct megasas_instance *instance, struct scsi_cmnd *scp,
1290 		   struct megasas_cmd *cmd)
1291 {
1292 	u32 device_id;
1293 	u8 sc = scp->cmnd[0];
1294 	u16 flags = 0;
1295 	struct megasas_io_frame *ldio;
1296 
1297 	device_id = MEGASAS_DEV_INDEX(instance, scp);
1298 	ldio = (struct megasas_io_frame *)cmd->frame;
1299 
1300 	if (scp->sc_data_direction == PCI_DMA_TODEVICE)
1301 		flags = MFI_FRAME_DIR_WRITE;
1302 	else if (scp->sc_data_direction == PCI_DMA_FROMDEVICE)
1303 		flags = MFI_FRAME_DIR_READ;
1304 
1305 	if (instance->flag_ieee == 1) {
1306 		flags |= MFI_FRAME_IEEE;
1307 	}
1308 
1309 	/*
1310 	 * Prepare the Logical IO frame: 2nd bit is zero for all read cmds
1311 	 */
1312 	ldio->cmd = (sc & 0x02) ? MFI_CMD_LD_WRITE : MFI_CMD_LD_READ;
1313 	ldio->cmd_status = 0x0;
1314 	ldio->scsi_status = 0x0;
1315 	ldio->target_id = device_id;
1316 	ldio->timeout = 0;
1317 	ldio->reserved_0 = 0;
1318 	ldio->pad_0 = 0;
1319 	ldio->flags = cpu_to_le16(flags);
1320 	ldio->start_lba_hi = 0;
1321 	ldio->access_byte = (scp->cmd_len != 6) ? scp->cmnd[1] : 0;
1322 
1323 	/*
1324 	 * 6-byte READ(0x08) or WRITE(0x0A) cdb
1325 	 */
1326 	if (scp->cmd_len == 6) {
1327 		ldio->lba_count = cpu_to_le32((u32) scp->cmnd[4]);
1328 		ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[1] << 16) |
1329 						 ((u32) scp->cmnd[2] << 8) |
1330 						 (u32) scp->cmnd[3]);
1331 
1332 		ldio->start_lba_lo &= cpu_to_le32(0x1FFFFF);
1333 	}
1334 
1335 	/*
1336 	 * 10-byte READ(0x28) or WRITE(0x2A) cdb
1337 	 */
1338 	else if (scp->cmd_len == 10) {
1339 		ldio->lba_count = cpu_to_le32((u32) scp->cmnd[8] |
1340 					      ((u32) scp->cmnd[7] << 8));
1341 		ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[2] << 24) |
1342 						 ((u32) scp->cmnd[3] << 16) |
1343 						 ((u32) scp->cmnd[4] << 8) |
1344 						 (u32) scp->cmnd[5]);
1345 	}
1346 
1347 	/*
1348 	 * 12-byte READ(0xA8) or WRITE(0xAA) cdb
1349 	 */
1350 	else if (scp->cmd_len == 12) {
1351 		ldio->lba_count = cpu_to_le32(((u32) scp->cmnd[6] << 24) |
1352 					      ((u32) scp->cmnd[7] << 16) |
1353 					      ((u32) scp->cmnd[8] << 8) |
1354 					      (u32) scp->cmnd[9]);
1355 
1356 		ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[2] << 24) |
1357 						 ((u32) scp->cmnd[3] << 16) |
1358 						 ((u32) scp->cmnd[4] << 8) |
1359 						 (u32) scp->cmnd[5]);
1360 	}
1361 
1362 	/*
1363 	 * 16-byte READ(0x88) or WRITE(0x8A) cdb
1364 	 */
1365 	else if (scp->cmd_len == 16) {
1366 		ldio->lba_count = cpu_to_le32(((u32) scp->cmnd[10] << 24) |
1367 					      ((u32) scp->cmnd[11] << 16) |
1368 					      ((u32) scp->cmnd[12] << 8) |
1369 					      (u32) scp->cmnd[13]);
1370 
1371 		ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[6] << 24) |
1372 						 ((u32) scp->cmnd[7] << 16) |
1373 						 ((u32) scp->cmnd[8] << 8) |
1374 						 (u32) scp->cmnd[9]);
1375 
1376 		ldio->start_lba_hi = cpu_to_le32(((u32) scp->cmnd[2] << 24) |
1377 						 ((u32) scp->cmnd[3] << 16) |
1378 						 ((u32) scp->cmnd[4] << 8) |
1379 						 (u32) scp->cmnd[5]);
1380 
1381 	}
1382 
1383 	/*
1384 	 * Construct SGL
1385 	 */
1386 	if (instance->flag_ieee) {
1387 		ldio->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1388 		ldio->sge_count = megasas_make_sgl_skinny(instance, scp,
1389 					      &ldio->sgl);
1390 	} else if (IS_DMA64) {
1391 		ldio->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1392 		ldio->sge_count = megasas_make_sgl64(instance, scp, &ldio->sgl);
1393 	} else
1394 		ldio->sge_count = megasas_make_sgl32(instance, scp, &ldio->sgl);
1395 
1396 	if (ldio->sge_count > instance->max_num_sge) {
1397 		printk(KERN_ERR "megasas: build_ld_io: sge_count = %x\n",
1398 			ldio->sge_count);
1399 		return 0;
1400 	}
1401 
1402 	/*
1403 	 * Sense info specific
1404 	 */
1405 	ldio->sense_len = SCSI_SENSE_BUFFERSIZE;
1406 	ldio->sense_buf_phys_addr_hi = 0;
1407 	ldio->sense_buf_phys_addr_lo = cpu_to_le32(cmd->sense_phys_addr);
1408 
1409 	/*
1410 	 * Compute the total number of frames this command consumes. FW uses
1411 	 * this number to pull sufficient number of frames from host memory.
1412 	 */
1413 	cmd->frame_count = megasas_get_frame_count(instance,
1414 			ldio->sge_count, IO_FRAME);
1415 
1416 	return cmd->frame_count;
1417 }
1418 
1419 /**
1420  * megasas_cmd_type -		Checks if the cmd is for logical drive/sysPD
1421  *				and whether it's RW or non RW
1422  * @scmd:			SCSI command
1423  *
1424  */
1425 inline int megasas_cmd_type(struct scsi_cmnd *cmd)
1426 {
1427 	int ret;
1428 
1429 	switch (cmd->cmnd[0]) {
1430 	case READ_10:
1431 	case WRITE_10:
1432 	case READ_12:
1433 	case WRITE_12:
1434 	case READ_6:
1435 	case WRITE_6:
1436 	case READ_16:
1437 	case WRITE_16:
1438 		ret = (MEGASAS_IS_LOGICAL(cmd)) ?
1439 			READ_WRITE_LDIO : READ_WRITE_SYSPDIO;
1440 		break;
1441 	default:
1442 		ret = (MEGASAS_IS_LOGICAL(cmd)) ?
1443 			NON_READ_WRITE_LDIO : NON_READ_WRITE_SYSPDIO;
1444 	}
1445 	return ret;
1446 }
1447 
1448  /**
1449  * megasas_dump_pending_frames -	Dumps the frame address of all pending cmds
1450  *                              	in FW
1451  * @instance:				Adapter soft state
1452  */
1453 static inline void
1454 megasas_dump_pending_frames(struct megasas_instance *instance)
1455 {
1456 	struct megasas_cmd *cmd;
1457 	int i,n;
1458 	union megasas_sgl *mfi_sgl;
1459 	struct megasas_io_frame *ldio;
1460 	struct megasas_pthru_frame *pthru;
1461 	u32 sgcount;
1462 	u32 max_cmd = instance->max_fw_cmds;
1463 
1464 	printk(KERN_ERR "\nmegasas[%d]: Dumping Frame Phys Address of all pending cmds in FW\n",instance->host->host_no);
1465 	printk(KERN_ERR "megasas[%d]: Total OS Pending cmds : %d\n",instance->host->host_no,atomic_read(&instance->fw_outstanding));
1466 	if (IS_DMA64)
1467 		printk(KERN_ERR "\nmegasas[%d]: 64 bit SGLs were sent to FW\n",instance->host->host_no);
1468 	else
1469 		printk(KERN_ERR "\nmegasas[%d]: 32 bit SGLs were sent to FW\n",instance->host->host_no);
1470 
1471 	printk(KERN_ERR "megasas[%d]: Pending OS cmds in FW : \n",instance->host->host_no);
1472 	for (i = 0; i < max_cmd; i++) {
1473 		cmd = instance->cmd_list[i];
1474 		if(!cmd->scmd)
1475 			continue;
1476 		printk(KERN_ERR "megasas[%d]: Frame addr :0x%08lx : ",instance->host->host_no,(unsigned long)cmd->frame_phys_addr);
1477 		if (megasas_cmd_type(cmd->scmd) == READ_WRITE_LDIO) {
1478 			ldio = (struct megasas_io_frame *)cmd->frame;
1479 			mfi_sgl = &ldio->sgl;
1480 			sgcount = ldio->sge_count;
1481 			printk(KERN_ERR "megasas[%d]: frame count : 0x%x, Cmd : 0x%x, Tgt id : 0x%x,"
1482 			" lba lo : 0x%x, lba_hi : 0x%x, sense_buf addr : 0x%x,sge count : 0x%x\n",
1483 			instance->host->host_no, cmd->frame_count, ldio->cmd, ldio->target_id,
1484 			le32_to_cpu(ldio->start_lba_lo), le32_to_cpu(ldio->start_lba_hi),
1485 			le32_to_cpu(ldio->sense_buf_phys_addr_lo), sgcount);
1486 		}
1487 		else {
1488 			pthru = (struct megasas_pthru_frame *) cmd->frame;
1489 			mfi_sgl = &pthru->sgl;
1490 			sgcount = pthru->sge_count;
1491 			printk(KERN_ERR "megasas[%d]: frame count : 0x%x, Cmd : 0x%x, Tgt id : 0x%x, "
1492 			"lun : 0x%x, cdb_len : 0x%x, data xfer len : 0x%x, sense_buf addr : 0x%x,sge count : 0x%x\n",
1493 			instance->host->host_no, cmd->frame_count, pthru->cmd, pthru->target_id,
1494 			pthru->lun, pthru->cdb_len, le32_to_cpu(pthru->data_xfer_len),
1495 			le32_to_cpu(pthru->sense_buf_phys_addr_lo), sgcount);
1496 		}
1497 	if(megasas_dbg_lvl & MEGASAS_DBG_LVL){
1498 		for (n = 0; n < sgcount; n++){
1499 			if (IS_DMA64)
1500 				printk(KERN_ERR "megasas: sgl len : 0x%x, sgl addr : 0x%llx ",
1501 					le32_to_cpu(mfi_sgl->sge64[n].length),
1502 					le64_to_cpu(mfi_sgl->sge64[n].phys_addr));
1503 			else
1504 				printk(KERN_ERR "megasas: sgl len : 0x%x, sgl addr : 0x%x ",
1505 					le32_to_cpu(mfi_sgl->sge32[n].length),
1506 					le32_to_cpu(mfi_sgl->sge32[n].phys_addr));
1507 			}
1508 		}
1509 		printk(KERN_ERR "\n");
1510 	} /*for max_cmd*/
1511 	printk(KERN_ERR "\nmegasas[%d]: Pending Internal cmds in FW : \n",instance->host->host_no);
1512 	for (i = 0; i < max_cmd; i++) {
1513 
1514 		cmd = instance->cmd_list[i];
1515 
1516 		if(cmd->sync_cmd == 1){
1517 			printk(KERN_ERR "0x%08lx : ", (unsigned long)cmd->frame_phys_addr);
1518 		}
1519 	}
1520 	printk(KERN_ERR "megasas[%d]: Dumping Done.\n\n",instance->host->host_no);
1521 }
1522 
1523 u32
1524 megasas_build_and_issue_cmd(struct megasas_instance *instance,
1525 			    struct scsi_cmnd *scmd)
1526 {
1527 	struct megasas_cmd *cmd;
1528 	u32 frame_count;
1529 
1530 	cmd = megasas_get_cmd(instance);
1531 	if (!cmd)
1532 		return SCSI_MLQUEUE_HOST_BUSY;
1533 
1534 	/*
1535 	 * Logical drive command
1536 	 */
1537 	if (megasas_cmd_type(scmd) == READ_WRITE_LDIO)
1538 		frame_count = megasas_build_ldio(instance, scmd, cmd);
1539 	else
1540 		frame_count = megasas_build_dcdb(instance, scmd, cmd);
1541 
1542 	if (!frame_count)
1543 		goto out_return_cmd;
1544 
1545 	cmd->scmd = scmd;
1546 	scmd->SCp.ptr = (char *)cmd;
1547 
1548 	/*
1549 	 * Issue the command to the FW
1550 	 */
1551 	atomic_inc(&instance->fw_outstanding);
1552 
1553 	instance->instancet->fire_cmd(instance, cmd->frame_phys_addr,
1554 				cmd->frame_count-1, instance->reg_set);
1555 
1556 	return 0;
1557 out_return_cmd:
1558 	megasas_return_cmd(instance, cmd);
1559 	return 1;
1560 }
1561 
1562 
1563 /**
1564  * megasas_queue_command -	Queue entry point
1565  * @scmd:			SCSI command to be queued
1566  * @done:			Callback entry point
1567  */
1568 static int
1569 megasas_queue_command(struct Scsi_Host *shost, struct scsi_cmnd *scmd)
1570 {
1571 	struct megasas_instance *instance;
1572 	unsigned long flags;
1573 
1574 	instance = (struct megasas_instance *)
1575 	    scmd->device->host->hostdata;
1576 
1577 	if (instance->unload == 1) {
1578 		scmd->result = DID_NO_CONNECT << 16;
1579 		scmd->scsi_done(scmd);
1580 		return 0;
1581 	}
1582 
1583 	if (instance->issuepend_done == 0)
1584 		return SCSI_MLQUEUE_HOST_BUSY;
1585 
1586 	spin_lock_irqsave(&instance->hba_lock, flags);
1587 
1588 	/* Check for an mpio path and adjust behavior */
1589 	if (instance->adprecovery == MEGASAS_ADPRESET_SM_INFAULT) {
1590 		if (megasas_check_mpio_paths(instance, scmd) ==
1591 		    (DID_RESET << 16)) {
1592 			spin_unlock_irqrestore(&instance->hba_lock, flags);
1593 			return SCSI_MLQUEUE_HOST_BUSY;
1594 		} else {
1595 			spin_unlock_irqrestore(&instance->hba_lock, flags);
1596 			scmd->result = DID_NO_CONNECT << 16;
1597 			scmd->scsi_done(scmd);
1598 			return 0;
1599 		}
1600 	}
1601 
1602 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR) {
1603 		spin_unlock_irqrestore(&instance->hba_lock, flags);
1604 		scmd->result = DID_NO_CONNECT << 16;
1605 		scmd->scsi_done(scmd);
1606 		return 0;
1607 	}
1608 
1609 	if (instance->adprecovery != MEGASAS_HBA_OPERATIONAL) {
1610 		spin_unlock_irqrestore(&instance->hba_lock, flags);
1611 		return SCSI_MLQUEUE_HOST_BUSY;
1612 	}
1613 
1614 	spin_unlock_irqrestore(&instance->hba_lock, flags);
1615 
1616 	scmd->result = 0;
1617 
1618 	if (MEGASAS_IS_LOGICAL(scmd) &&
1619 	    (scmd->device->id >= instance->fw_supported_vd_count ||
1620 		scmd->device->lun)) {
1621 		scmd->result = DID_BAD_TARGET << 16;
1622 		goto out_done;
1623 	}
1624 
1625 	switch (scmd->cmnd[0]) {
1626 	case SYNCHRONIZE_CACHE:
1627 		/*
1628 		 * FW takes care of flush cache on its own
1629 		 * No need to send it down
1630 		 */
1631 		scmd->result = DID_OK << 16;
1632 		goto out_done;
1633 	default:
1634 		break;
1635 	}
1636 
1637 	if (instance->instancet->build_and_issue_cmd(instance, scmd)) {
1638 		printk(KERN_ERR "megasas: Err returned from build_and_issue_cmd\n");
1639 		return SCSI_MLQUEUE_HOST_BUSY;
1640 	}
1641 
1642 	return 0;
1643 
1644  out_done:
1645 	scmd->scsi_done(scmd);
1646 	return 0;
1647 }
1648 
1649 static struct megasas_instance *megasas_lookup_instance(u16 host_no)
1650 {
1651 	int i;
1652 
1653 	for (i = 0; i < megasas_mgmt_info.max_index; i++) {
1654 
1655 		if ((megasas_mgmt_info.instance[i]) &&
1656 		    (megasas_mgmt_info.instance[i]->host->host_no == host_no))
1657 			return megasas_mgmt_info.instance[i];
1658 	}
1659 
1660 	return NULL;
1661 }
1662 
1663 static int megasas_slave_configure(struct scsi_device *sdev)
1664 {
1665 	/*
1666 	* The RAID firmware may require extended timeouts.
1667 	*/
1668 	blk_queue_rq_timeout(sdev->request_queue,
1669 		MEGASAS_DEFAULT_CMD_TIMEOUT * HZ);
1670 
1671 	return 0;
1672 }
1673 
1674 static int megasas_slave_alloc(struct scsi_device *sdev)
1675 {
1676 	u16             pd_index = 0;
1677 	struct megasas_instance *instance ;
1678 	instance = megasas_lookup_instance(sdev->host->host_no);
1679 	if (sdev->channel < MEGASAS_MAX_PD_CHANNELS) {
1680 		/*
1681 		 * Open the OS scan to the SYSTEM PD
1682 		 */
1683 		pd_index =
1684 			(sdev->channel * MEGASAS_MAX_DEV_PER_CHANNEL) +
1685 			sdev->id;
1686 		if (instance->pd_list[pd_index].driveState ==
1687 					MR_PD_STATE_SYSTEM) {
1688 			return 0;
1689 		}
1690 		return -ENXIO;
1691 	}
1692 	return 0;
1693 }
1694 
1695 /*
1696 * megasas_complete_outstanding_ioctls - Complete outstanding ioctls after a
1697 *                                       kill adapter
1698 * @instance:				Adapter soft state
1699 *
1700 */
1701 void megasas_complete_outstanding_ioctls(struct megasas_instance *instance)
1702 {
1703 	int i;
1704 	struct megasas_cmd *cmd_mfi;
1705 	struct megasas_cmd_fusion *cmd_fusion;
1706 	struct fusion_context *fusion = instance->ctrl_context;
1707 
1708 	/* Find all outstanding ioctls */
1709 	if (fusion) {
1710 		for (i = 0; i < instance->max_fw_cmds; i++) {
1711 			cmd_fusion = fusion->cmd_list[i];
1712 			if (cmd_fusion->sync_cmd_idx != (u32)ULONG_MAX) {
1713 				cmd_mfi = instance->cmd_list[cmd_fusion->sync_cmd_idx];
1714 				if (cmd_mfi->sync_cmd &&
1715 					cmd_mfi->frame->hdr.cmd != MFI_CMD_ABORT)
1716 					megasas_complete_cmd(instance,
1717 							     cmd_mfi, DID_OK);
1718 			}
1719 		}
1720 	} else {
1721 		for (i = 0; i < instance->max_fw_cmds; i++) {
1722 			cmd_mfi = instance->cmd_list[i];
1723 			if (cmd_mfi->sync_cmd && cmd_mfi->frame->hdr.cmd !=
1724 				MFI_CMD_ABORT)
1725 				megasas_complete_cmd(instance, cmd_mfi, DID_OK);
1726 		}
1727 	}
1728 }
1729 
1730 
1731 void megaraid_sas_kill_hba(struct megasas_instance *instance)
1732 {
1733 	/* Set critical error to block I/O & ioctls in case caller didn't */
1734 	instance->adprecovery = MEGASAS_HW_CRITICAL_ERROR;
1735 	/* Wait 1 second to ensure IO or ioctls in build have posted */
1736 	msleep(1000);
1737 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
1738 		(instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0071SKINNY) ||
1739 		(instance->pdev->device == PCI_DEVICE_ID_LSI_FUSION) ||
1740 		(instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA) ||
1741 		(instance->pdev->device == PCI_DEVICE_ID_LSI_INVADER) ||
1742 		(instance->pdev->device == PCI_DEVICE_ID_LSI_FURY)) {
1743 		writel(MFI_STOP_ADP,
1744 			&instance->reg_set->doorbell);
1745 		/* Flush */
1746 		readl(&instance->reg_set->doorbell);
1747 		if (instance->mpio && instance->requestorId)
1748 			memset(instance->ld_ids, 0xff, MEGASAS_MAX_LD_IDS);
1749 	} else {
1750 		writel(MFI_STOP_ADP,
1751 			&instance->reg_set->inbound_doorbell);
1752 	}
1753 	/* Complete outstanding ioctls when adapter is killed */
1754 	megasas_complete_outstanding_ioctls(instance);
1755 }
1756 
1757  /**
1758   * megasas_check_and_restore_queue_depth - Check if queue depth needs to be
1759   *					restored to max value
1760   * @instance:			Adapter soft state
1761   *
1762   */
1763 void
1764 megasas_check_and_restore_queue_depth(struct megasas_instance *instance)
1765 {
1766 	unsigned long flags;
1767 
1768 	if (instance->flag & MEGASAS_FW_BUSY
1769 	    && time_after(jiffies, instance->last_time + 5 * HZ)
1770 	    && atomic_read(&instance->fw_outstanding) <
1771 	    instance->throttlequeuedepth + 1) {
1772 
1773 		spin_lock_irqsave(instance->host->host_lock, flags);
1774 		instance->flag &= ~MEGASAS_FW_BUSY;
1775 
1776 		instance->host->can_queue = instance->max_scsi_cmds;
1777 		spin_unlock_irqrestore(instance->host->host_lock, flags);
1778 	}
1779 }
1780 
1781 /**
1782  * megasas_complete_cmd_dpc	 -	Returns FW's controller structure
1783  * @instance_addr:			Address of adapter soft state
1784  *
1785  * Tasklet to complete cmds
1786  */
1787 static void megasas_complete_cmd_dpc(unsigned long instance_addr)
1788 {
1789 	u32 producer;
1790 	u32 consumer;
1791 	u32 context;
1792 	struct megasas_cmd *cmd;
1793 	struct megasas_instance *instance =
1794 				(struct megasas_instance *)instance_addr;
1795 	unsigned long flags;
1796 
1797 	/* If we have already declared adapter dead, donot complete cmds */
1798 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR )
1799 		return;
1800 
1801 	spin_lock_irqsave(&instance->completion_lock, flags);
1802 
1803 	producer = le32_to_cpu(*instance->producer);
1804 	consumer = le32_to_cpu(*instance->consumer);
1805 
1806 	while (consumer != producer) {
1807 		context = le32_to_cpu(instance->reply_queue[consumer]);
1808 		if (context >= instance->max_fw_cmds) {
1809 			printk(KERN_ERR "Unexpected context value %x\n",
1810 				context);
1811 			BUG();
1812 		}
1813 
1814 		cmd = instance->cmd_list[context];
1815 
1816 		megasas_complete_cmd(instance, cmd, DID_OK);
1817 
1818 		consumer++;
1819 		if (consumer == (instance->max_fw_cmds + 1)) {
1820 			consumer = 0;
1821 		}
1822 	}
1823 
1824 	*instance->consumer = cpu_to_le32(producer);
1825 
1826 	spin_unlock_irqrestore(&instance->completion_lock, flags);
1827 
1828 	/*
1829 	 * Check if we can restore can_queue
1830 	 */
1831 	megasas_check_and_restore_queue_depth(instance);
1832 }
1833 
1834 /**
1835  * megasas_start_timer - Initializes a timer object
1836  * @instance:		Adapter soft state
1837  * @timer:		timer object to be initialized
1838  * @fn:			timer function
1839  * @interval:		time interval between timer function call
1840  *
1841  */
1842 void megasas_start_timer(struct megasas_instance *instance,
1843 			struct timer_list *timer,
1844 			void *fn, unsigned long interval)
1845 {
1846 	init_timer(timer);
1847 	timer->expires = jiffies + interval;
1848 	timer->data = (unsigned long)instance;
1849 	timer->function = fn;
1850 	add_timer(timer);
1851 }
1852 
1853 static void
1854 megasas_internal_reset_defer_cmds(struct megasas_instance *instance);
1855 
1856 static void
1857 process_fw_state_change_wq(struct work_struct *work);
1858 
1859 void megasas_do_ocr(struct megasas_instance *instance)
1860 {
1861 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS1064R) ||
1862 	(instance->pdev->device == PCI_DEVICE_ID_DELL_PERC5) ||
1863 	(instance->pdev->device == PCI_DEVICE_ID_LSI_VERDE_ZCR)) {
1864 		*instance->consumer = cpu_to_le32(MEGASAS_ADPRESET_INPROG_SIGN);
1865 	}
1866 	instance->instancet->disable_intr(instance);
1867 	instance->adprecovery   = MEGASAS_ADPRESET_SM_INFAULT;
1868 	instance->issuepend_done = 0;
1869 
1870 	atomic_set(&instance->fw_outstanding, 0);
1871 	megasas_internal_reset_defer_cmds(instance);
1872 	process_fw_state_change_wq(&instance->work_init);
1873 }
1874 
1875 static int megasas_get_ld_vf_affiliation_111(struct megasas_instance *instance,
1876 					    int initial)
1877 {
1878 	struct megasas_cmd *cmd;
1879 	struct megasas_dcmd_frame *dcmd;
1880 	struct MR_LD_VF_AFFILIATION_111 *new_affiliation_111 = NULL;
1881 	dma_addr_t new_affiliation_111_h;
1882 	int ld, retval = 0;
1883 	u8 thisVf;
1884 
1885 	cmd = megasas_get_cmd(instance);
1886 
1887 	if (!cmd) {
1888 		printk(KERN_DEBUG "megasas: megasas_get_ld_vf_affiliation_111:"
1889 		       "Failed to get cmd for scsi%d.\n",
1890 			instance->host->host_no);
1891 		return -ENOMEM;
1892 	}
1893 
1894 	dcmd = &cmd->frame->dcmd;
1895 
1896 	if (!instance->vf_affiliation_111) {
1897 		printk(KERN_WARNING "megasas: SR-IOV: Couldn't get LD/VF "
1898 		       "affiliation for scsi%d.\n", instance->host->host_no);
1899 		megasas_return_cmd(instance, cmd);
1900 		return -ENOMEM;
1901 	}
1902 
1903 	if (initial)
1904 			memset(instance->vf_affiliation_111, 0,
1905 			       sizeof(struct MR_LD_VF_AFFILIATION_111));
1906 	else {
1907 		new_affiliation_111 =
1908 			pci_alloc_consistent(instance->pdev,
1909 					     sizeof(struct MR_LD_VF_AFFILIATION_111),
1910 					     &new_affiliation_111_h);
1911 		if (!new_affiliation_111) {
1912 			printk(KERN_DEBUG "megasas: SR-IOV: Couldn't allocate "
1913 			       "memory for new affiliation for scsi%d.\n",
1914 			       instance->host->host_no);
1915 			megasas_return_cmd(instance, cmd);
1916 			return -ENOMEM;
1917 		}
1918 		memset(new_affiliation_111, 0,
1919 		       sizeof(struct MR_LD_VF_AFFILIATION_111));
1920 	}
1921 
1922 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
1923 
1924 	dcmd->cmd = MFI_CMD_DCMD;
1925 	dcmd->cmd_status = 0xFF;
1926 	dcmd->sge_count = 1;
1927 	dcmd->flags = MFI_FRAME_DIR_BOTH;
1928 	dcmd->timeout = 0;
1929 	dcmd->pad_0 = 0;
1930 	dcmd->data_xfer_len = sizeof(struct MR_LD_VF_AFFILIATION_111);
1931 	dcmd->opcode = MR_DCMD_LD_VF_MAP_GET_ALL_LDS_111;
1932 
1933 	if (initial)
1934 		dcmd->sgl.sge32[0].phys_addr =
1935 			instance->vf_affiliation_111_h;
1936 	else
1937 		dcmd->sgl.sge32[0].phys_addr = new_affiliation_111_h;
1938 
1939 	dcmd->sgl.sge32[0].length =
1940 		sizeof(struct MR_LD_VF_AFFILIATION_111);
1941 
1942 	printk(KERN_WARNING "megasas: SR-IOV: Getting LD/VF affiliation for "
1943 	       "scsi%d\n", instance->host->host_no);
1944 
1945 	megasas_issue_blocked_cmd(instance, cmd, 0);
1946 
1947 	if (dcmd->cmd_status) {
1948 		printk(KERN_WARNING "megasas: SR-IOV: LD/VF affiliation DCMD"
1949 		       " failed with status 0x%x for scsi%d.\n",
1950 		       dcmd->cmd_status, instance->host->host_no);
1951 		retval = 1; /* Do a scan if we couldn't get affiliation */
1952 		goto out;
1953 	}
1954 
1955 	if (!initial) {
1956 		thisVf = new_affiliation_111->thisVf;
1957 		for (ld = 0 ; ld < new_affiliation_111->vdCount; ld++)
1958 			if (instance->vf_affiliation_111->map[ld].policy[thisVf] !=
1959 			    new_affiliation_111->map[ld].policy[thisVf]) {
1960 				printk(KERN_WARNING "megasas: SR-IOV: "
1961 				       "Got new LD/VF affiliation "
1962 				       "for scsi%d.\n",
1963 				       instance->host->host_no);
1964 				memcpy(instance->vf_affiliation_111,
1965 				       new_affiliation_111,
1966 				       sizeof(struct MR_LD_VF_AFFILIATION_111));
1967 				retval = 1;
1968 				goto out;
1969 			}
1970 	}
1971 out:
1972 	if (new_affiliation_111) {
1973 		pci_free_consistent(instance->pdev,
1974 				    sizeof(struct MR_LD_VF_AFFILIATION_111),
1975 				    new_affiliation_111,
1976 				    new_affiliation_111_h);
1977 	}
1978 
1979 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
1980 		megasas_return_mfi_mpt_pthr(instance, cmd,
1981 			cmd->mpt_pthr_cmd_blocked);
1982 	else
1983 		megasas_return_cmd(instance, cmd);
1984 
1985 	return retval;
1986 }
1987 
1988 static int megasas_get_ld_vf_affiliation_12(struct megasas_instance *instance,
1989 					    int initial)
1990 {
1991 	struct megasas_cmd *cmd;
1992 	struct megasas_dcmd_frame *dcmd;
1993 	struct MR_LD_VF_AFFILIATION *new_affiliation = NULL;
1994 	struct MR_LD_VF_MAP *newmap = NULL, *savedmap = NULL;
1995 	dma_addr_t new_affiliation_h;
1996 	int i, j, retval = 0, found = 0, doscan = 0;
1997 	u8 thisVf;
1998 
1999 	cmd = megasas_get_cmd(instance);
2000 
2001 	if (!cmd) {
2002 		printk(KERN_DEBUG "megasas: megasas_get_ld_vf_affiliation12: "
2003 		       "Failed to get cmd for scsi%d.\n",
2004 		       instance->host->host_no);
2005 		return -ENOMEM;
2006 	}
2007 
2008 	dcmd = &cmd->frame->dcmd;
2009 
2010 	if (!instance->vf_affiliation) {
2011 		printk(KERN_WARNING "megasas: SR-IOV: Couldn't get LD/VF "
2012 		       "affiliation for scsi%d.\n", instance->host->host_no);
2013 		megasas_return_cmd(instance, cmd);
2014 		return -ENOMEM;
2015 	}
2016 
2017 	if (initial)
2018 		memset(instance->vf_affiliation, 0, (MAX_LOGICAL_DRIVES + 1) *
2019 		       sizeof(struct MR_LD_VF_AFFILIATION));
2020 	else {
2021 		new_affiliation =
2022 			pci_alloc_consistent(instance->pdev,
2023 					     (MAX_LOGICAL_DRIVES + 1) *
2024 					     sizeof(struct MR_LD_VF_AFFILIATION),
2025 					     &new_affiliation_h);
2026 		if (!new_affiliation) {
2027 			printk(KERN_DEBUG "megasas: SR-IOV: Couldn't allocate "
2028 			       "memory for new affiliation for scsi%d.\n",
2029 			       instance->host->host_no);
2030 			megasas_return_cmd(instance, cmd);
2031 			return -ENOMEM;
2032 		}
2033 		memset(new_affiliation, 0, (MAX_LOGICAL_DRIVES + 1) *
2034 		       sizeof(struct MR_LD_VF_AFFILIATION));
2035 	}
2036 
2037 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2038 
2039 	dcmd->cmd = MFI_CMD_DCMD;
2040 	dcmd->cmd_status = 0xFF;
2041 	dcmd->sge_count = 1;
2042 	dcmd->flags = MFI_FRAME_DIR_BOTH;
2043 	dcmd->timeout = 0;
2044 	dcmd->pad_0 = 0;
2045 	dcmd->data_xfer_len = (MAX_LOGICAL_DRIVES + 1) *
2046 		sizeof(struct MR_LD_VF_AFFILIATION);
2047 	dcmd->opcode = MR_DCMD_LD_VF_MAP_GET_ALL_LDS;
2048 
2049 	if (initial)
2050 		dcmd->sgl.sge32[0].phys_addr = instance->vf_affiliation_h;
2051 	else
2052 		dcmd->sgl.sge32[0].phys_addr = new_affiliation_h;
2053 
2054 	dcmd->sgl.sge32[0].length = (MAX_LOGICAL_DRIVES + 1) *
2055 		sizeof(struct MR_LD_VF_AFFILIATION);
2056 
2057 	printk(KERN_WARNING "megasas: SR-IOV: Getting LD/VF affiliation for "
2058 	       "scsi%d\n", instance->host->host_no);
2059 
2060 	megasas_issue_blocked_cmd(instance, cmd, 0);
2061 
2062 	if (dcmd->cmd_status) {
2063 		printk(KERN_WARNING "megasas: SR-IOV: LD/VF affiliation DCMD"
2064 		       " failed with status 0x%x for scsi%d.\n",
2065 		       dcmd->cmd_status, instance->host->host_no);
2066 		retval = 1; /* Do a scan if we couldn't get affiliation */
2067 		goto out;
2068 	}
2069 
2070 	if (!initial) {
2071 		if (!new_affiliation->ldCount) {
2072 			printk(KERN_WARNING "megasas: SR-IOV: Got new LD/VF "
2073 			       "affiliation for passive path for scsi%d.\n",
2074 			       instance->host->host_no);
2075 			retval = 1;
2076 			goto out;
2077 		}
2078 		newmap = new_affiliation->map;
2079 		savedmap = instance->vf_affiliation->map;
2080 		thisVf = new_affiliation->thisVf;
2081 		for (i = 0 ; i < new_affiliation->ldCount; i++) {
2082 			found = 0;
2083 			for (j = 0; j < instance->vf_affiliation->ldCount;
2084 			     j++) {
2085 				if (newmap->ref.targetId ==
2086 				    savedmap->ref.targetId) {
2087 					found = 1;
2088 					if (newmap->policy[thisVf] !=
2089 					    savedmap->policy[thisVf]) {
2090 						doscan = 1;
2091 						goto out;
2092 					}
2093 				}
2094 				savedmap = (struct MR_LD_VF_MAP *)
2095 					((unsigned char *)savedmap +
2096 					 savedmap->size);
2097 			}
2098 			if (!found && newmap->policy[thisVf] !=
2099 			    MR_LD_ACCESS_HIDDEN) {
2100 				doscan = 1;
2101 				goto out;
2102 			}
2103 			newmap = (struct MR_LD_VF_MAP *)
2104 				((unsigned char *)newmap + newmap->size);
2105 		}
2106 
2107 		newmap = new_affiliation->map;
2108 		savedmap = instance->vf_affiliation->map;
2109 
2110 		for (i = 0 ; i < instance->vf_affiliation->ldCount; i++) {
2111 			found = 0;
2112 			for (j = 0 ; j < new_affiliation->ldCount; j++) {
2113 				if (savedmap->ref.targetId ==
2114 				    newmap->ref.targetId) {
2115 					found = 1;
2116 					if (savedmap->policy[thisVf] !=
2117 					    newmap->policy[thisVf]) {
2118 						doscan = 1;
2119 						goto out;
2120 					}
2121 				}
2122 				newmap = (struct MR_LD_VF_MAP *)
2123 					((unsigned char *)newmap +
2124 					 newmap->size);
2125 			}
2126 			if (!found && savedmap->policy[thisVf] !=
2127 			    MR_LD_ACCESS_HIDDEN) {
2128 				doscan = 1;
2129 				goto out;
2130 			}
2131 			savedmap = (struct MR_LD_VF_MAP *)
2132 				((unsigned char *)savedmap +
2133 				 savedmap->size);
2134 		}
2135 	}
2136 out:
2137 	if (doscan) {
2138 		printk(KERN_WARNING "megasas: SR-IOV: Got new LD/VF "
2139 		       "affiliation for scsi%d.\n", instance->host->host_no);
2140 		memcpy(instance->vf_affiliation, new_affiliation,
2141 		       new_affiliation->size);
2142 		retval = 1;
2143 	}
2144 
2145 	if (new_affiliation)
2146 		pci_free_consistent(instance->pdev,
2147 				    (MAX_LOGICAL_DRIVES + 1) *
2148 				    sizeof(struct MR_LD_VF_AFFILIATION),
2149 				    new_affiliation, new_affiliation_h);
2150 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
2151 		megasas_return_mfi_mpt_pthr(instance, cmd,
2152 			cmd->mpt_pthr_cmd_blocked);
2153 	else
2154 		megasas_return_cmd(instance, cmd);
2155 
2156 	return retval;
2157 }
2158 
2159 /* This function will get the current SR-IOV LD/VF affiliation */
2160 static int megasas_get_ld_vf_affiliation(struct megasas_instance *instance,
2161 	int initial)
2162 {
2163 	int retval;
2164 
2165 	if (instance->PlasmaFW111)
2166 		retval = megasas_get_ld_vf_affiliation_111(instance, initial);
2167 	else
2168 		retval = megasas_get_ld_vf_affiliation_12(instance, initial);
2169 	return retval;
2170 }
2171 
2172 /* This function will tell FW to start the SR-IOV heartbeat */
2173 int megasas_sriov_start_heartbeat(struct megasas_instance *instance,
2174 					 int initial)
2175 {
2176 	struct megasas_cmd *cmd;
2177 	struct megasas_dcmd_frame *dcmd;
2178 	int retval = 0;
2179 
2180 	cmd = megasas_get_cmd(instance);
2181 
2182 	if (!cmd) {
2183 		printk(KERN_DEBUG "megasas: megasas_sriov_start_heartbeat: "
2184 		       "Failed to get cmd for scsi%d.\n",
2185 		       instance->host->host_no);
2186 		return -ENOMEM;
2187 	}
2188 
2189 	dcmd = &cmd->frame->dcmd;
2190 
2191 	if (initial) {
2192 		instance->hb_host_mem =
2193 			pci_zalloc_consistent(instance->pdev,
2194 					      sizeof(struct MR_CTRL_HB_HOST_MEM),
2195 					      &instance->hb_host_mem_h);
2196 		if (!instance->hb_host_mem) {
2197 			printk(KERN_DEBUG "megasas: SR-IOV: Couldn't allocate"
2198 			       " memory for heartbeat host memory for "
2199 			       "scsi%d.\n", instance->host->host_no);
2200 			retval = -ENOMEM;
2201 			goto out;
2202 		}
2203 	}
2204 
2205 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2206 
2207 	dcmd->mbox.s[0] = sizeof(struct MR_CTRL_HB_HOST_MEM);
2208 	dcmd->cmd = MFI_CMD_DCMD;
2209 	dcmd->cmd_status = 0xFF;
2210 	dcmd->sge_count = 1;
2211 	dcmd->flags = MFI_FRAME_DIR_BOTH;
2212 	dcmd->timeout = 0;
2213 	dcmd->pad_0 = 0;
2214 	dcmd->data_xfer_len = sizeof(struct MR_CTRL_HB_HOST_MEM);
2215 	dcmd->opcode = MR_DCMD_CTRL_SHARED_HOST_MEM_ALLOC;
2216 	dcmd->sgl.sge32[0].phys_addr = instance->hb_host_mem_h;
2217 	dcmd->sgl.sge32[0].length = sizeof(struct MR_CTRL_HB_HOST_MEM);
2218 
2219 	printk(KERN_WARNING "megasas: SR-IOV: Starting heartbeat for scsi%d\n",
2220 	       instance->host->host_no);
2221 
2222 	if (!megasas_issue_polled(instance, cmd)) {
2223 		retval = 0;
2224 	} else {
2225 		printk(KERN_WARNING "megasas: SR-IOV: MR_DCMD_CTRL_SHARED_HOST"
2226 		       "_MEM_ALLOC DCMD timed out for scsi%d\n",
2227 		       instance->host->host_no);
2228 		retval = 1;
2229 		goto out;
2230 	}
2231 
2232 
2233 	if (dcmd->cmd_status) {
2234 		printk(KERN_WARNING "megasas: SR-IOV: MR_DCMD_CTRL_SHARED_HOST"
2235 		       "_MEM_ALLOC DCMD failed with status 0x%x for scsi%d\n",
2236 		       dcmd->cmd_status,
2237 		       instance->host->host_no);
2238 		retval = 1;
2239 		goto out;
2240 	}
2241 
2242 out:
2243 	megasas_return_cmd(instance, cmd);
2244 
2245 	return retval;
2246 }
2247 
2248 /* Handler for SR-IOV heartbeat */
2249 void megasas_sriov_heartbeat_handler(unsigned long instance_addr)
2250 {
2251 	struct megasas_instance *instance =
2252 		(struct megasas_instance *)instance_addr;
2253 
2254 	if (instance->hb_host_mem->HB.fwCounter !=
2255 	    instance->hb_host_mem->HB.driverCounter) {
2256 		instance->hb_host_mem->HB.driverCounter =
2257 			instance->hb_host_mem->HB.fwCounter;
2258 		mod_timer(&instance->sriov_heartbeat_timer,
2259 			  jiffies + MEGASAS_SRIOV_HEARTBEAT_INTERVAL_VF);
2260 	} else {
2261 		printk(KERN_WARNING "megasas: SR-IOV: Heartbeat never "
2262 		       "completed for scsi%d\n", instance->host->host_no);
2263 		schedule_work(&instance->work_init);
2264 	}
2265 }
2266 
2267 /**
2268  * megasas_wait_for_outstanding -	Wait for all outstanding cmds
2269  * @instance:				Adapter soft state
2270  *
2271  * This function waits for up to MEGASAS_RESET_WAIT_TIME seconds for FW to
2272  * complete all its outstanding commands. Returns error if one or more IOs
2273  * are pending after this time period. It also marks the controller dead.
2274  */
2275 static int megasas_wait_for_outstanding(struct megasas_instance *instance)
2276 {
2277 	int i;
2278 	u32 reset_index;
2279 	u32 wait_time = MEGASAS_RESET_WAIT_TIME;
2280 	u8 adprecovery;
2281 	unsigned long flags;
2282 	struct list_head clist_local;
2283 	struct megasas_cmd *reset_cmd;
2284 	u32 fw_state;
2285 	u8 kill_adapter_flag;
2286 
2287 	spin_lock_irqsave(&instance->hba_lock, flags);
2288 	adprecovery = instance->adprecovery;
2289 	spin_unlock_irqrestore(&instance->hba_lock, flags);
2290 
2291 	if (adprecovery != MEGASAS_HBA_OPERATIONAL) {
2292 
2293 		INIT_LIST_HEAD(&clist_local);
2294 		spin_lock_irqsave(&instance->hba_lock, flags);
2295 		list_splice_init(&instance->internal_reset_pending_q,
2296 				&clist_local);
2297 		spin_unlock_irqrestore(&instance->hba_lock, flags);
2298 
2299 		printk(KERN_NOTICE "megasas: HBA reset wait ...\n");
2300 		for (i = 0; i < wait_time; i++) {
2301 			msleep(1000);
2302 			spin_lock_irqsave(&instance->hba_lock, flags);
2303 			adprecovery = instance->adprecovery;
2304 			spin_unlock_irqrestore(&instance->hba_lock, flags);
2305 			if (adprecovery == MEGASAS_HBA_OPERATIONAL)
2306 				break;
2307 		}
2308 
2309 		if (adprecovery != MEGASAS_HBA_OPERATIONAL) {
2310 			printk(KERN_NOTICE "megasas: reset: Stopping HBA.\n");
2311 			spin_lock_irqsave(&instance->hba_lock, flags);
2312 			instance->adprecovery	= MEGASAS_HW_CRITICAL_ERROR;
2313 			spin_unlock_irqrestore(&instance->hba_lock, flags);
2314 			return FAILED;
2315 		}
2316 
2317 		reset_index	= 0;
2318 		while (!list_empty(&clist_local)) {
2319 			reset_cmd	= list_entry((&clist_local)->next,
2320 						struct megasas_cmd, list);
2321 			list_del_init(&reset_cmd->list);
2322 			if (reset_cmd->scmd) {
2323 				reset_cmd->scmd->result = DID_RESET << 16;
2324 				printk(KERN_NOTICE "%d:%p reset [%02x]\n",
2325 					reset_index, reset_cmd,
2326 					reset_cmd->scmd->cmnd[0]);
2327 
2328 				reset_cmd->scmd->scsi_done(reset_cmd->scmd);
2329 				megasas_return_cmd(instance, reset_cmd);
2330 			} else if (reset_cmd->sync_cmd) {
2331 				printk(KERN_NOTICE "megasas:%p synch cmds"
2332 						"reset queue\n",
2333 						reset_cmd);
2334 
2335 				reset_cmd->cmd_status = ENODATA;
2336 				instance->instancet->fire_cmd(instance,
2337 						reset_cmd->frame_phys_addr,
2338 						0, instance->reg_set);
2339 			} else {
2340 				printk(KERN_NOTICE "megasas: %p unexpected"
2341 					"cmds lst\n",
2342 					reset_cmd);
2343 			}
2344 			reset_index++;
2345 		}
2346 
2347 		return SUCCESS;
2348 	}
2349 
2350 	for (i = 0; i < resetwaittime; i++) {
2351 
2352 		int outstanding = atomic_read(&instance->fw_outstanding);
2353 
2354 		if (!outstanding)
2355 			break;
2356 
2357 		if (!(i % MEGASAS_RESET_NOTICE_INTERVAL)) {
2358 			printk(KERN_NOTICE "megasas: [%2d]waiting for %d "
2359 			       "commands to complete\n",i,outstanding);
2360 			/*
2361 			 * Call cmd completion routine. Cmd to be
2362 			 * be completed directly without depending on isr.
2363 			 */
2364 			megasas_complete_cmd_dpc((unsigned long)instance);
2365 		}
2366 
2367 		msleep(1000);
2368 	}
2369 
2370 	i = 0;
2371 	kill_adapter_flag = 0;
2372 	do {
2373 		fw_state = instance->instancet->read_fw_status_reg(
2374 					instance->reg_set) & MFI_STATE_MASK;
2375 		if ((fw_state == MFI_STATE_FAULT) &&
2376 			(instance->disableOnlineCtrlReset == 0)) {
2377 			if (i == 3) {
2378 				kill_adapter_flag = 2;
2379 				break;
2380 			}
2381 			megasas_do_ocr(instance);
2382 			kill_adapter_flag = 1;
2383 
2384 			/* wait for 1 secs to let FW finish the pending cmds */
2385 			msleep(1000);
2386 		}
2387 		i++;
2388 	} while (i <= 3);
2389 
2390 	if (atomic_read(&instance->fw_outstanding) &&
2391 					!kill_adapter_flag) {
2392 		if (instance->disableOnlineCtrlReset == 0) {
2393 
2394 			megasas_do_ocr(instance);
2395 
2396 			/* wait for 5 secs to let FW finish the pending cmds */
2397 			for (i = 0; i < wait_time; i++) {
2398 				int outstanding =
2399 					atomic_read(&instance->fw_outstanding);
2400 				if (!outstanding)
2401 					return SUCCESS;
2402 				msleep(1000);
2403 			}
2404 		}
2405 	}
2406 
2407 	if (atomic_read(&instance->fw_outstanding) ||
2408 					(kill_adapter_flag == 2)) {
2409 		printk(KERN_NOTICE "megaraid_sas: pending cmds after reset\n");
2410 		/*
2411 		* Send signal to FW to stop processing any pending cmds.
2412 		* The controller will be taken offline by the OS now.
2413 		*/
2414 		if ((instance->pdev->device ==
2415 			PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
2416 			(instance->pdev->device ==
2417 			PCI_DEVICE_ID_LSI_SAS0071SKINNY)) {
2418 			writel(MFI_STOP_ADP,
2419 				&instance->reg_set->doorbell);
2420 		} else {
2421 			writel(MFI_STOP_ADP,
2422 				&instance->reg_set->inbound_doorbell);
2423 		}
2424 		megasas_dump_pending_frames(instance);
2425 		spin_lock_irqsave(&instance->hba_lock, flags);
2426 		instance->adprecovery	= MEGASAS_HW_CRITICAL_ERROR;
2427 		spin_unlock_irqrestore(&instance->hba_lock, flags);
2428 		return FAILED;
2429 	}
2430 
2431 	printk(KERN_NOTICE "megaraid_sas: no pending cmds after reset\n");
2432 
2433 	return SUCCESS;
2434 }
2435 
2436 /**
2437  * megasas_generic_reset -	Generic reset routine
2438  * @scmd:			Mid-layer SCSI command
2439  *
2440  * This routine implements a generic reset handler for device, bus and host
2441  * reset requests. Device, bus and host specific reset handlers can use this
2442  * function after they do their specific tasks.
2443  */
2444 static int megasas_generic_reset(struct scsi_cmnd *scmd)
2445 {
2446 	int ret_val;
2447 	struct megasas_instance *instance;
2448 
2449 	instance = (struct megasas_instance *)scmd->device->host->hostdata;
2450 
2451 	scmd_printk(KERN_NOTICE, scmd, "megasas: RESET cmd=%x retries=%x\n",
2452 		 scmd->cmnd[0], scmd->retries);
2453 
2454 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR) {
2455 		printk(KERN_ERR "megasas: cannot recover from previous reset "
2456 		       "failures\n");
2457 		return FAILED;
2458 	}
2459 
2460 	ret_val = megasas_wait_for_outstanding(instance);
2461 	if (ret_val == SUCCESS)
2462 		printk(KERN_NOTICE "megasas: reset successful \n");
2463 	else
2464 		printk(KERN_ERR "megasas: failed to do reset\n");
2465 
2466 	return ret_val;
2467 }
2468 
2469 /**
2470  * megasas_reset_timer - quiesce the adapter if required
2471  * @scmd:		scsi cmnd
2472  *
2473  * Sets the FW busy flag and reduces the host->can_queue if the
2474  * cmd has not been completed within the timeout period.
2475  */
2476 static enum
2477 blk_eh_timer_return megasas_reset_timer(struct scsi_cmnd *scmd)
2478 {
2479 	struct megasas_instance *instance;
2480 	unsigned long flags;
2481 
2482 	if (time_after(jiffies, scmd->jiffies_at_alloc +
2483 				(MEGASAS_DEFAULT_CMD_TIMEOUT * 2) * HZ)) {
2484 		return BLK_EH_NOT_HANDLED;
2485 	}
2486 
2487 	instance = (struct megasas_instance *)scmd->device->host->hostdata;
2488 	if (!(instance->flag & MEGASAS_FW_BUSY)) {
2489 		/* FW is busy, throttle IO */
2490 		spin_lock_irqsave(instance->host->host_lock, flags);
2491 
2492 		instance->host->can_queue = instance->throttlequeuedepth;
2493 		instance->last_time = jiffies;
2494 		instance->flag |= MEGASAS_FW_BUSY;
2495 
2496 		spin_unlock_irqrestore(instance->host->host_lock, flags);
2497 	}
2498 	return BLK_EH_RESET_TIMER;
2499 }
2500 
2501 /**
2502  * megasas_reset_device -	Device reset handler entry point
2503  */
2504 static int megasas_reset_device(struct scsi_cmnd *scmd)
2505 {
2506 	int ret;
2507 
2508 	/*
2509 	 * First wait for all commands to complete
2510 	 */
2511 	ret = megasas_generic_reset(scmd);
2512 
2513 	return ret;
2514 }
2515 
2516 /**
2517  * megasas_reset_bus_host -	Bus & host reset handler entry point
2518  */
2519 static int megasas_reset_bus_host(struct scsi_cmnd *scmd)
2520 {
2521 	int ret;
2522 	struct megasas_instance *instance;
2523 	instance = (struct megasas_instance *)scmd->device->host->hostdata;
2524 
2525 	/*
2526 	 * First wait for all commands to complete
2527 	 */
2528 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_FUSION) ||
2529 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA) ||
2530 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_INVADER) ||
2531 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_FURY))
2532 		ret = megasas_reset_fusion(scmd->device->host, 1);
2533 	else
2534 		ret = megasas_generic_reset(scmd);
2535 
2536 	return ret;
2537 }
2538 
2539 /**
2540  * megasas_bios_param - Returns disk geometry for a disk
2541  * @sdev: 		device handle
2542  * @bdev:		block device
2543  * @capacity:		drive capacity
2544  * @geom:		geometry parameters
2545  */
2546 static int
2547 megasas_bios_param(struct scsi_device *sdev, struct block_device *bdev,
2548 		 sector_t capacity, int geom[])
2549 {
2550 	int heads;
2551 	int sectors;
2552 	sector_t cylinders;
2553 	unsigned long tmp;
2554 	/* Default heads (64) & sectors (32) */
2555 	heads = 64;
2556 	sectors = 32;
2557 
2558 	tmp = heads * sectors;
2559 	cylinders = capacity;
2560 
2561 	sector_div(cylinders, tmp);
2562 
2563 	/*
2564 	 * Handle extended translation size for logical drives > 1Gb
2565 	 */
2566 
2567 	if (capacity >= 0x200000) {
2568 		heads = 255;
2569 		sectors = 63;
2570 		tmp = heads*sectors;
2571 		cylinders = capacity;
2572 		sector_div(cylinders, tmp);
2573 	}
2574 
2575 	geom[0] = heads;
2576 	geom[1] = sectors;
2577 	geom[2] = cylinders;
2578 
2579 	return 0;
2580 }
2581 
2582 static void megasas_aen_polling(struct work_struct *work);
2583 
2584 /**
2585  * megasas_service_aen -	Processes an event notification
2586  * @instance:			Adapter soft state
2587  * @cmd:			AEN command completed by the ISR
2588  *
2589  * For AEN, driver sends a command down to FW that is held by the FW till an
2590  * event occurs. When an event of interest occurs, FW completes the command
2591  * that it was previously holding.
2592  *
2593  * This routines sends SIGIO signal to processes that have registered with the
2594  * driver for AEN.
2595  */
2596 static void
2597 megasas_service_aen(struct megasas_instance *instance, struct megasas_cmd *cmd)
2598 {
2599 	unsigned long flags;
2600 	/*
2601 	 * Don't signal app if it is just an aborted previously registered aen
2602 	 */
2603 	if ((!cmd->abort_aen) && (instance->unload == 0)) {
2604 		spin_lock_irqsave(&poll_aen_lock, flags);
2605 		megasas_poll_wait_aen = 1;
2606 		spin_unlock_irqrestore(&poll_aen_lock, flags);
2607 		wake_up(&megasas_poll_wait);
2608 		kill_fasync(&megasas_async_queue, SIGIO, POLL_IN);
2609 	}
2610 	else
2611 		cmd->abort_aen = 0;
2612 
2613 	instance->aen_cmd = NULL;
2614 
2615 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
2616 		megasas_return_mfi_mpt_pthr(instance, cmd,
2617 			cmd->mpt_pthr_cmd_blocked);
2618 	else
2619 		megasas_return_cmd(instance, cmd);
2620 
2621 	if ((instance->unload == 0) &&
2622 		((instance->issuepend_done == 1))) {
2623 		struct megasas_aen_event *ev;
2624 		ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
2625 		if (!ev) {
2626 			printk(KERN_ERR "megasas_service_aen: out of memory\n");
2627 		} else {
2628 			ev->instance = instance;
2629 			instance->ev = ev;
2630 			INIT_DELAYED_WORK(&ev->hotplug_work,
2631 					  megasas_aen_polling);
2632 			schedule_delayed_work(&ev->hotplug_work, 0);
2633 		}
2634 	}
2635 }
2636 
2637 static ssize_t
2638 megasas_fw_crash_buffer_store(struct device *cdev,
2639 	struct device_attribute *attr, const char *buf, size_t count)
2640 {
2641 	struct Scsi_Host *shost = class_to_shost(cdev);
2642 	struct megasas_instance *instance =
2643 		(struct megasas_instance *) shost->hostdata;
2644 	int val = 0;
2645 	unsigned long flags;
2646 
2647 	if (kstrtoint(buf, 0, &val) != 0)
2648 		return -EINVAL;
2649 
2650 	spin_lock_irqsave(&instance->crashdump_lock, flags);
2651 	instance->fw_crash_buffer_offset = val;
2652 	spin_unlock_irqrestore(&instance->crashdump_lock, flags);
2653 	return strlen(buf);
2654 }
2655 
2656 static ssize_t
2657 megasas_fw_crash_buffer_show(struct device *cdev,
2658 	struct device_attribute *attr, char *buf)
2659 {
2660 	struct Scsi_Host *shost = class_to_shost(cdev);
2661 	struct megasas_instance *instance =
2662 		(struct megasas_instance *) shost->hostdata;
2663 	u32 size;
2664 	unsigned long buff_addr;
2665 	unsigned long dmachunk = CRASH_DMA_BUF_SIZE;
2666 	unsigned long src_addr;
2667 	unsigned long flags;
2668 	u32 buff_offset;
2669 
2670 	spin_lock_irqsave(&instance->crashdump_lock, flags);
2671 	buff_offset = instance->fw_crash_buffer_offset;
2672 	if (!instance->crash_dump_buf &&
2673 		!((instance->fw_crash_state == AVAILABLE) ||
2674 		(instance->fw_crash_state == COPYING))) {
2675 		dev_err(&instance->pdev->dev,
2676 			"Firmware crash dump is not available\n");
2677 		spin_unlock_irqrestore(&instance->crashdump_lock, flags);
2678 		return -EINVAL;
2679 	}
2680 
2681 	buff_addr = (unsigned long) buf;
2682 
2683 	if (buff_offset >
2684 		(instance->fw_crash_buffer_size * dmachunk)) {
2685 		dev_err(&instance->pdev->dev,
2686 			"Firmware crash dump offset is out of range\n");
2687 		spin_unlock_irqrestore(&instance->crashdump_lock, flags);
2688 		return 0;
2689 	}
2690 
2691 	size = (instance->fw_crash_buffer_size * dmachunk) - buff_offset;
2692 	size = (size >= PAGE_SIZE) ? (PAGE_SIZE - 1) : size;
2693 
2694 	src_addr = (unsigned long)instance->crash_buf[buff_offset / dmachunk] +
2695 		(buff_offset % dmachunk);
2696 	memcpy(buf, (void *)src_addr,  size);
2697 	spin_unlock_irqrestore(&instance->crashdump_lock, flags);
2698 
2699 	return size;
2700 }
2701 
2702 static ssize_t
2703 megasas_fw_crash_buffer_size_show(struct device *cdev,
2704 	struct device_attribute *attr, char *buf)
2705 {
2706 	struct Scsi_Host *shost = class_to_shost(cdev);
2707 	struct megasas_instance *instance =
2708 		(struct megasas_instance *) shost->hostdata;
2709 
2710 	return snprintf(buf, PAGE_SIZE, "%ld\n", (unsigned long)
2711 		((instance->fw_crash_buffer_size) * 1024 * 1024)/PAGE_SIZE);
2712 }
2713 
2714 static ssize_t
2715 megasas_fw_crash_state_store(struct device *cdev,
2716 	struct device_attribute *attr, const char *buf, size_t count)
2717 {
2718 	struct Scsi_Host *shost = class_to_shost(cdev);
2719 	struct megasas_instance *instance =
2720 		(struct megasas_instance *) shost->hostdata;
2721 	int val = 0;
2722 	unsigned long flags;
2723 
2724 	if (kstrtoint(buf, 0, &val) != 0)
2725 		return -EINVAL;
2726 
2727 	if ((val <= AVAILABLE || val > COPY_ERROR)) {
2728 		dev_err(&instance->pdev->dev, "application updates invalid "
2729 			"firmware crash state\n");
2730 		return -EINVAL;
2731 	}
2732 
2733 	instance->fw_crash_state = val;
2734 
2735 	if ((val == COPIED) || (val == COPY_ERROR)) {
2736 		spin_lock_irqsave(&instance->crashdump_lock, flags);
2737 		megasas_free_host_crash_buffer(instance);
2738 		spin_unlock_irqrestore(&instance->crashdump_lock, flags);
2739 		if (val == COPY_ERROR)
2740 			dev_info(&instance->pdev->dev, "application failed to "
2741 				"copy Firmware crash dump\n");
2742 		else
2743 			dev_info(&instance->pdev->dev, "Firmware crash dump "
2744 				"copied successfully\n");
2745 	}
2746 	return strlen(buf);
2747 }
2748 
2749 static ssize_t
2750 megasas_fw_crash_state_show(struct device *cdev,
2751 	struct device_attribute *attr, char *buf)
2752 {
2753 	struct Scsi_Host *shost = class_to_shost(cdev);
2754 	struct megasas_instance *instance =
2755 		(struct megasas_instance *) shost->hostdata;
2756 	return snprintf(buf, PAGE_SIZE, "%d\n", instance->fw_crash_state);
2757 }
2758 
2759 static ssize_t
2760 megasas_page_size_show(struct device *cdev,
2761 	struct device_attribute *attr, char *buf)
2762 {
2763 	return snprintf(buf, PAGE_SIZE, "%ld\n", (unsigned long)PAGE_SIZE - 1);
2764 }
2765 
2766 static DEVICE_ATTR(fw_crash_buffer, S_IRUGO | S_IWUSR,
2767 	megasas_fw_crash_buffer_show, megasas_fw_crash_buffer_store);
2768 static DEVICE_ATTR(fw_crash_buffer_size, S_IRUGO,
2769 	megasas_fw_crash_buffer_size_show, NULL);
2770 static DEVICE_ATTR(fw_crash_state, S_IRUGO | S_IWUSR,
2771 	megasas_fw_crash_state_show, megasas_fw_crash_state_store);
2772 static DEVICE_ATTR(page_size, S_IRUGO,
2773 	megasas_page_size_show, NULL);
2774 
2775 struct device_attribute *megaraid_host_attrs[] = {
2776 	&dev_attr_fw_crash_buffer_size,
2777 	&dev_attr_fw_crash_buffer,
2778 	&dev_attr_fw_crash_state,
2779 	&dev_attr_page_size,
2780 	NULL,
2781 };
2782 
2783 /*
2784  * Scsi host template for megaraid_sas driver
2785  */
2786 static struct scsi_host_template megasas_template = {
2787 
2788 	.module = THIS_MODULE,
2789 	.name = "LSI SAS based MegaRAID driver",
2790 	.proc_name = "megaraid_sas",
2791 	.slave_configure = megasas_slave_configure,
2792 	.slave_alloc = megasas_slave_alloc,
2793 	.queuecommand = megasas_queue_command,
2794 	.eh_device_reset_handler = megasas_reset_device,
2795 	.eh_bus_reset_handler = megasas_reset_bus_host,
2796 	.eh_host_reset_handler = megasas_reset_bus_host,
2797 	.eh_timed_out = megasas_reset_timer,
2798 	.shost_attrs = megaraid_host_attrs,
2799 	.bios_param = megasas_bios_param,
2800 	.use_clustering = ENABLE_CLUSTERING,
2801 	.change_queue_depth = scsi_change_queue_depth,
2802 	.no_write_same = 1,
2803 };
2804 
2805 /**
2806  * megasas_complete_int_cmd -	Completes an internal command
2807  * @instance:			Adapter soft state
2808  * @cmd:			Command to be completed
2809  *
2810  * The megasas_issue_blocked_cmd() function waits for a command to complete
2811  * after it issues a command. This function wakes up that waiting routine by
2812  * calling wake_up() on the wait queue.
2813  */
2814 static void
2815 megasas_complete_int_cmd(struct megasas_instance *instance,
2816 			 struct megasas_cmd *cmd)
2817 {
2818 	cmd->cmd_status = cmd->frame->io.cmd_status;
2819 
2820 	if (cmd->cmd_status == ENODATA) {
2821 		cmd->cmd_status = 0;
2822 	}
2823 	wake_up(&instance->int_cmd_wait_q);
2824 }
2825 
2826 /**
2827  * megasas_complete_abort -	Completes aborting a command
2828  * @instance:			Adapter soft state
2829  * @cmd:			Cmd that was issued to abort another cmd
2830  *
2831  * The megasas_issue_blocked_abort_cmd() function waits on abort_cmd_wait_q
2832  * after it issues an abort on a previously issued command. This function
2833  * wakes up all functions waiting on the same wait queue.
2834  */
2835 static void
2836 megasas_complete_abort(struct megasas_instance *instance,
2837 		       struct megasas_cmd *cmd)
2838 {
2839 	if (cmd->sync_cmd) {
2840 		cmd->sync_cmd = 0;
2841 		cmd->cmd_status = 0;
2842 		wake_up(&instance->abort_cmd_wait_q);
2843 	}
2844 
2845 	return;
2846 }
2847 
2848 /**
2849  * megasas_complete_cmd -	Completes a command
2850  * @instance:			Adapter soft state
2851  * @cmd:			Command to be completed
2852  * @alt_status:			If non-zero, use this value as status to
2853  * 				SCSI mid-layer instead of the value returned
2854  * 				by the FW. This should be used if caller wants
2855  * 				an alternate status (as in the case of aborted
2856  * 				commands)
2857  */
2858 void
2859 megasas_complete_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd,
2860 		     u8 alt_status)
2861 {
2862 	int exception = 0;
2863 	struct megasas_header *hdr = &cmd->frame->hdr;
2864 	unsigned long flags;
2865 	struct fusion_context *fusion = instance->ctrl_context;
2866 	u32 opcode;
2867 
2868 	/* flag for the retry reset */
2869 	cmd->retry_for_fw_reset = 0;
2870 
2871 	if (cmd->scmd)
2872 		cmd->scmd->SCp.ptr = NULL;
2873 
2874 	switch (hdr->cmd) {
2875 	case MFI_CMD_INVALID:
2876 		/* Some older 1068 controller FW may keep a pended
2877 		   MR_DCMD_CTRL_EVENT_GET_INFO left over from the main kernel
2878 		   when booting the kdump kernel.  Ignore this command to
2879 		   prevent a kernel panic on shutdown of the kdump kernel. */
2880 		printk(KERN_WARNING "megaraid_sas: MFI_CMD_INVALID command "
2881 		       "completed.\n");
2882 		printk(KERN_WARNING "megaraid_sas: If you have a controller "
2883 		       "other than PERC5, please upgrade your firmware.\n");
2884 		break;
2885 	case MFI_CMD_PD_SCSI_IO:
2886 	case MFI_CMD_LD_SCSI_IO:
2887 
2888 		/*
2889 		 * MFI_CMD_PD_SCSI_IO and MFI_CMD_LD_SCSI_IO could have been
2890 		 * issued either through an IO path or an IOCTL path. If it
2891 		 * was via IOCTL, we will send it to internal completion.
2892 		 */
2893 		if (cmd->sync_cmd) {
2894 			cmd->sync_cmd = 0;
2895 			megasas_complete_int_cmd(instance, cmd);
2896 			break;
2897 		}
2898 
2899 	case MFI_CMD_LD_READ:
2900 	case MFI_CMD_LD_WRITE:
2901 
2902 		if (alt_status) {
2903 			cmd->scmd->result = alt_status << 16;
2904 			exception = 1;
2905 		}
2906 
2907 		if (exception) {
2908 
2909 			atomic_dec(&instance->fw_outstanding);
2910 
2911 			scsi_dma_unmap(cmd->scmd);
2912 			cmd->scmd->scsi_done(cmd->scmd);
2913 			megasas_return_cmd(instance, cmd);
2914 
2915 			break;
2916 		}
2917 
2918 		switch (hdr->cmd_status) {
2919 
2920 		case MFI_STAT_OK:
2921 			cmd->scmd->result = DID_OK << 16;
2922 			break;
2923 
2924 		case MFI_STAT_SCSI_IO_FAILED:
2925 		case MFI_STAT_LD_INIT_IN_PROGRESS:
2926 			cmd->scmd->result =
2927 			    (DID_ERROR << 16) | hdr->scsi_status;
2928 			break;
2929 
2930 		case MFI_STAT_SCSI_DONE_WITH_ERROR:
2931 
2932 			cmd->scmd->result = (DID_OK << 16) | hdr->scsi_status;
2933 
2934 			if (hdr->scsi_status == SAM_STAT_CHECK_CONDITION) {
2935 				memset(cmd->scmd->sense_buffer, 0,
2936 				       SCSI_SENSE_BUFFERSIZE);
2937 				memcpy(cmd->scmd->sense_buffer, cmd->sense,
2938 				       hdr->sense_len);
2939 
2940 				cmd->scmd->result |= DRIVER_SENSE << 24;
2941 			}
2942 
2943 			break;
2944 
2945 		case MFI_STAT_LD_OFFLINE:
2946 		case MFI_STAT_DEVICE_NOT_FOUND:
2947 			cmd->scmd->result = DID_BAD_TARGET << 16;
2948 			break;
2949 
2950 		default:
2951 			printk(KERN_DEBUG "megasas: MFI FW status %#x\n",
2952 			       hdr->cmd_status);
2953 			cmd->scmd->result = DID_ERROR << 16;
2954 			break;
2955 		}
2956 
2957 		atomic_dec(&instance->fw_outstanding);
2958 
2959 		scsi_dma_unmap(cmd->scmd);
2960 		cmd->scmd->scsi_done(cmd->scmd);
2961 		megasas_return_cmd(instance, cmd);
2962 
2963 		break;
2964 
2965 	case MFI_CMD_SMP:
2966 	case MFI_CMD_STP:
2967 	case MFI_CMD_DCMD:
2968 		opcode = le32_to_cpu(cmd->frame->dcmd.opcode);
2969 		/* Check for LD map update */
2970 		if ((opcode == MR_DCMD_LD_MAP_GET_INFO)
2971 			&& (cmd->frame->dcmd.mbox.b[1] == 1)) {
2972 			fusion->fast_path_io = 0;
2973 			spin_lock_irqsave(instance->host->host_lock, flags);
2974 			if (cmd->frame->hdr.cmd_status != 0) {
2975 				if (cmd->frame->hdr.cmd_status !=
2976 				    MFI_STAT_NOT_FOUND)
2977 					printk(KERN_WARNING "megasas: map sync"
2978 					       "failed, status = 0x%x.\n",
2979 					       cmd->frame->hdr.cmd_status);
2980 				else {
2981 					megasas_return_mfi_mpt_pthr(instance,
2982 						cmd, cmd->mpt_pthr_cmd_blocked);
2983 					spin_unlock_irqrestore(
2984 						instance->host->host_lock,
2985 						flags);
2986 					break;
2987 				}
2988 			} else
2989 				instance->map_id++;
2990 			megasas_return_mfi_mpt_pthr(instance, cmd,
2991 				cmd->mpt_pthr_cmd_blocked);
2992 
2993 			/*
2994 			 * Set fast path IO to ZERO.
2995 			 * Validate Map will set proper value.
2996 			 * Meanwhile all IOs will go as LD IO.
2997 			 */
2998 			if (MR_ValidateMapInfo(instance))
2999 				fusion->fast_path_io = 1;
3000 			else
3001 				fusion->fast_path_io = 0;
3002 			megasas_sync_map_info(instance);
3003 			spin_unlock_irqrestore(instance->host->host_lock,
3004 					       flags);
3005 			break;
3006 		}
3007 		if (opcode == MR_DCMD_CTRL_EVENT_GET_INFO ||
3008 		    opcode == MR_DCMD_CTRL_EVENT_GET) {
3009 			spin_lock_irqsave(&poll_aen_lock, flags);
3010 			megasas_poll_wait_aen = 0;
3011 			spin_unlock_irqrestore(&poll_aen_lock, flags);
3012 		}
3013 
3014 		/*
3015 		 * See if got an event notification
3016 		 */
3017 		if (opcode == MR_DCMD_CTRL_EVENT_WAIT)
3018 			megasas_service_aen(instance, cmd);
3019 		else
3020 			megasas_complete_int_cmd(instance, cmd);
3021 
3022 		break;
3023 
3024 	case MFI_CMD_ABORT:
3025 		/*
3026 		 * Cmd issued to abort another cmd returned
3027 		 */
3028 		megasas_complete_abort(instance, cmd);
3029 		break;
3030 
3031 	default:
3032 		printk("megasas: Unknown command completed! [0x%X]\n",
3033 		       hdr->cmd);
3034 		break;
3035 	}
3036 }
3037 
3038 /**
3039  * megasas_issue_pending_cmds_again -	issue all pending cmds
3040  *                              	in FW again because of the fw reset
3041  * @instance:				Adapter soft state
3042  */
3043 static inline void
3044 megasas_issue_pending_cmds_again(struct megasas_instance *instance)
3045 {
3046 	struct megasas_cmd *cmd;
3047 	struct list_head clist_local;
3048 	union megasas_evt_class_locale class_locale;
3049 	unsigned long flags;
3050 	u32 seq_num;
3051 
3052 	INIT_LIST_HEAD(&clist_local);
3053 	spin_lock_irqsave(&instance->hba_lock, flags);
3054 	list_splice_init(&instance->internal_reset_pending_q, &clist_local);
3055 	spin_unlock_irqrestore(&instance->hba_lock, flags);
3056 
3057 	while (!list_empty(&clist_local)) {
3058 		cmd	= list_entry((&clist_local)->next,
3059 					struct megasas_cmd, list);
3060 		list_del_init(&cmd->list);
3061 
3062 		if (cmd->sync_cmd || cmd->scmd) {
3063 			printk(KERN_NOTICE "megaraid_sas: command %p, %p:%d"
3064 				"detected to be pending while HBA reset.\n",
3065 					cmd, cmd->scmd, cmd->sync_cmd);
3066 
3067 			cmd->retry_for_fw_reset++;
3068 
3069 			if (cmd->retry_for_fw_reset == 3) {
3070 				printk(KERN_NOTICE "megaraid_sas: cmd %p, %p:%d"
3071 					"was tried multiple times during reset."
3072 					"Shutting down the HBA\n",
3073 					cmd, cmd->scmd, cmd->sync_cmd);
3074 				instance->instancet->disable_intr(instance);
3075 				atomic_set(&instance->fw_reset_no_pci_access, 1);
3076 				megaraid_sas_kill_hba(instance);
3077 				return;
3078 			}
3079 		}
3080 
3081 		if (cmd->sync_cmd == 1) {
3082 			if (cmd->scmd) {
3083 				printk(KERN_NOTICE "megaraid_sas: unexpected"
3084 					"cmd attached to internal command!\n");
3085 			}
3086 			printk(KERN_NOTICE "megasas: %p synchronous cmd"
3087 						"on the internal reset queue,"
3088 						"issue it again.\n", cmd);
3089 			cmd->cmd_status = ENODATA;
3090 			instance->instancet->fire_cmd(instance,
3091 							cmd->frame_phys_addr ,
3092 							0, instance->reg_set);
3093 		} else if (cmd->scmd) {
3094 			printk(KERN_NOTICE "megasas: %p scsi cmd [%02x]"
3095 			"detected on the internal queue, issue again.\n",
3096 			cmd, cmd->scmd->cmnd[0]);
3097 
3098 			atomic_inc(&instance->fw_outstanding);
3099 			instance->instancet->fire_cmd(instance,
3100 					cmd->frame_phys_addr,
3101 					cmd->frame_count-1, instance->reg_set);
3102 		} else {
3103 			printk(KERN_NOTICE "megasas: %p unexpected cmd on the"
3104 				"internal reset defer list while re-issue!!\n",
3105 				cmd);
3106 		}
3107 	}
3108 
3109 	if (instance->aen_cmd) {
3110 		printk(KERN_NOTICE "megaraid_sas: aen_cmd in def process\n");
3111 		megasas_return_cmd(instance, instance->aen_cmd);
3112 
3113 		instance->aen_cmd	= NULL;
3114 	}
3115 
3116 	/*
3117 	* Initiate AEN (Asynchronous Event Notification)
3118 	*/
3119 	seq_num = instance->last_seq_num;
3120 	class_locale.members.reserved = 0;
3121 	class_locale.members.locale = MR_EVT_LOCALE_ALL;
3122 	class_locale.members.class = MR_EVT_CLASS_DEBUG;
3123 
3124 	megasas_register_aen(instance, seq_num, class_locale.word);
3125 }
3126 
3127 /**
3128  * Move the internal reset pending commands to a deferred queue.
3129  *
3130  * We move the commands pending at internal reset time to a
3131  * pending queue. This queue would be flushed after successful
3132  * completion of the internal reset sequence. if the internal reset
3133  * did not complete in time, the kernel reset handler would flush
3134  * these commands.
3135  **/
3136 static void
3137 megasas_internal_reset_defer_cmds(struct megasas_instance *instance)
3138 {
3139 	struct megasas_cmd *cmd;
3140 	int i;
3141 	u32 max_cmd = instance->max_fw_cmds;
3142 	u32 defer_index;
3143 	unsigned long flags;
3144 
3145 	defer_index     = 0;
3146 	spin_lock_irqsave(&instance->mfi_pool_lock, flags);
3147 	for (i = 0; i < max_cmd; i++) {
3148 		cmd = instance->cmd_list[i];
3149 		if (cmd->sync_cmd == 1 || cmd->scmd) {
3150 			printk(KERN_NOTICE "megasas: moving cmd[%d]:%p:%d:%p"
3151 					"on the defer queue as internal\n",
3152 				defer_index, cmd, cmd->sync_cmd, cmd->scmd);
3153 
3154 			if (!list_empty(&cmd->list)) {
3155 				printk(KERN_NOTICE "megaraid_sas: ERROR while"
3156 					" moving this cmd:%p, %d %p, it was"
3157 					"discovered on some list?\n",
3158 					cmd, cmd->sync_cmd, cmd->scmd);
3159 
3160 				list_del_init(&cmd->list);
3161 			}
3162 			defer_index++;
3163 			list_add_tail(&cmd->list,
3164 				&instance->internal_reset_pending_q);
3165 		}
3166 	}
3167 	spin_unlock_irqrestore(&instance->mfi_pool_lock, flags);
3168 }
3169 
3170 
3171 static void
3172 process_fw_state_change_wq(struct work_struct *work)
3173 {
3174 	struct megasas_instance *instance =
3175 		container_of(work, struct megasas_instance, work_init);
3176 	u32 wait;
3177 	unsigned long flags;
3178 
3179 	if (instance->adprecovery != MEGASAS_ADPRESET_SM_INFAULT) {
3180 		printk(KERN_NOTICE "megaraid_sas: error, recovery st %x \n",
3181 				instance->adprecovery);
3182 		return ;
3183 	}
3184 
3185 	if (instance->adprecovery == MEGASAS_ADPRESET_SM_INFAULT) {
3186 		printk(KERN_NOTICE "megaraid_sas: FW detected to be in fault"
3187 					"state, restarting it...\n");
3188 
3189 		instance->instancet->disable_intr(instance);
3190 		atomic_set(&instance->fw_outstanding, 0);
3191 
3192 		atomic_set(&instance->fw_reset_no_pci_access, 1);
3193 		instance->instancet->adp_reset(instance, instance->reg_set);
3194 		atomic_set(&instance->fw_reset_no_pci_access, 0 );
3195 
3196 		printk(KERN_NOTICE "megaraid_sas: FW restarted successfully,"
3197 					"initiating next stage...\n");
3198 
3199 		printk(KERN_NOTICE "megaraid_sas: HBA recovery state machine,"
3200 					"state 2 starting...\n");
3201 
3202 		/*waitting for about 20 second before start the second init*/
3203 		for (wait = 0; wait < 30; wait++) {
3204 			msleep(1000);
3205 		}
3206 
3207 		if (megasas_transition_to_ready(instance, 1)) {
3208 			printk(KERN_NOTICE "megaraid_sas:adapter not ready\n");
3209 
3210 			atomic_set(&instance->fw_reset_no_pci_access, 1);
3211 			megaraid_sas_kill_hba(instance);
3212 			return ;
3213 		}
3214 
3215 		if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS1064R) ||
3216 			(instance->pdev->device == PCI_DEVICE_ID_DELL_PERC5) ||
3217 			(instance->pdev->device == PCI_DEVICE_ID_LSI_VERDE_ZCR)
3218 			) {
3219 			*instance->consumer = *instance->producer;
3220 		} else {
3221 			*instance->consumer = 0;
3222 			*instance->producer = 0;
3223 		}
3224 
3225 		megasas_issue_init_mfi(instance);
3226 
3227 		spin_lock_irqsave(&instance->hba_lock, flags);
3228 		instance->adprecovery	= MEGASAS_HBA_OPERATIONAL;
3229 		spin_unlock_irqrestore(&instance->hba_lock, flags);
3230 		instance->instancet->enable_intr(instance);
3231 
3232 		megasas_issue_pending_cmds_again(instance);
3233 		instance->issuepend_done = 1;
3234 	}
3235 	return ;
3236 }
3237 
3238 /**
3239  * megasas_deplete_reply_queue -	Processes all completed commands
3240  * @instance:				Adapter soft state
3241  * @alt_status:				Alternate status to be returned to
3242  * 					SCSI mid-layer instead of the status
3243  * 					returned by the FW
3244  * Note: this must be called with hba lock held
3245  */
3246 static int
3247 megasas_deplete_reply_queue(struct megasas_instance *instance,
3248 					u8 alt_status)
3249 {
3250 	u32 mfiStatus;
3251 	u32 fw_state;
3252 
3253 	if ((mfiStatus = instance->instancet->check_reset(instance,
3254 					instance->reg_set)) == 1) {
3255 		return IRQ_HANDLED;
3256 	}
3257 
3258 	if ((mfiStatus = instance->instancet->clear_intr(
3259 						instance->reg_set)
3260 						) == 0) {
3261 		/* Hardware may not set outbound_intr_status in MSI-X mode */
3262 		if (!instance->msix_vectors)
3263 			return IRQ_NONE;
3264 	}
3265 
3266 	instance->mfiStatus = mfiStatus;
3267 
3268 	if ((mfiStatus & MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE)) {
3269 		fw_state = instance->instancet->read_fw_status_reg(
3270 				instance->reg_set) & MFI_STATE_MASK;
3271 
3272 		if (fw_state != MFI_STATE_FAULT) {
3273 			printk(KERN_NOTICE "megaraid_sas: fw state:%x\n",
3274 						fw_state);
3275 		}
3276 
3277 		if ((fw_state == MFI_STATE_FAULT) &&
3278 				(instance->disableOnlineCtrlReset == 0)) {
3279 			printk(KERN_NOTICE "megaraid_sas: wait adp restart\n");
3280 
3281 			if ((instance->pdev->device ==
3282 					PCI_DEVICE_ID_LSI_SAS1064R) ||
3283 				(instance->pdev->device ==
3284 					PCI_DEVICE_ID_DELL_PERC5) ||
3285 				(instance->pdev->device ==
3286 					PCI_DEVICE_ID_LSI_VERDE_ZCR)) {
3287 
3288 				*instance->consumer =
3289 					cpu_to_le32(MEGASAS_ADPRESET_INPROG_SIGN);
3290 			}
3291 
3292 
3293 			instance->instancet->disable_intr(instance);
3294 			instance->adprecovery	= MEGASAS_ADPRESET_SM_INFAULT;
3295 			instance->issuepend_done = 0;
3296 
3297 			atomic_set(&instance->fw_outstanding, 0);
3298 			megasas_internal_reset_defer_cmds(instance);
3299 
3300 			printk(KERN_NOTICE "megasas: fwState=%x, stage:%d\n",
3301 					fw_state, instance->adprecovery);
3302 
3303 			schedule_work(&instance->work_init);
3304 			return IRQ_HANDLED;
3305 
3306 		} else {
3307 			printk(KERN_NOTICE "megasas: fwstate:%x, dis_OCR=%x\n",
3308 				fw_state, instance->disableOnlineCtrlReset);
3309 		}
3310 	}
3311 
3312 	tasklet_schedule(&instance->isr_tasklet);
3313 	return IRQ_HANDLED;
3314 }
3315 /**
3316  * megasas_isr - isr entry point
3317  */
3318 static irqreturn_t megasas_isr(int irq, void *devp)
3319 {
3320 	struct megasas_irq_context *irq_context = devp;
3321 	struct megasas_instance *instance = irq_context->instance;
3322 	unsigned long flags;
3323 	irqreturn_t	rc;
3324 
3325 	if (atomic_read(&instance->fw_reset_no_pci_access))
3326 		return IRQ_HANDLED;
3327 
3328 	spin_lock_irqsave(&instance->hba_lock, flags);
3329 	rc =  megasas_deplete_reply_queue(instance, DID_OK);
3330 	spin_unlock_irqrestore(&instance->hba_lock, flags);
3331 
3332 	return rc;
3333 }
3334 
3335 /**
3336  * megasas_transition_to_ready -	Move the FW to READY state
3337  * @instance:				Adapter soft state
3338  *
3339  * During the initialization, FW passes can potentially be in any one of
3340  * several possible states. If the FW in operational, waiting-for-handshake
3341  * states, driver must take steps to bring it to ready state. Otherwise, it
3342  * has to wait for the ready state.
3343  */
3344 int
3345 megasas_transition_to_ready(struct megasas_instance *instance, int ocr)
3346 {
3347 	int i;
3348 	u8 max_wait;
3349 	u32 fw_state;
3350 	u32 cur_state;
3351 	u32 abs_state, curr_abs_state;
3352 
3353 	abs_state = instance->instancet->read_fw_status_reg(instance->reg_set);
3354 	fw_state = abs_state & MFI_STATE_MASK;
3355 
3356 	if (fw_state != MFI_STATE_READY)
3357 		printk(KERN_INFO "megasas: Waiting for FW to come to ready"
3358 		       " state\n");
3359 
3360 	while (fw_state != MFI_STATE_READY) {
3361 
3362 		switch (fw_state) {
3363 
3364 		case MFI_STATE_FAULT:
3365 			printk(KERN_DEBUG "megasas: FW in FAULT state!!\n");
3366 			if (ocr) {
3367 				max_wait = MEGASAS_RESET_WAIT_TIME;
3368 				cur_state = MFI_STATE_FAULT;
3369 				break;
3370 			} else
3371 				return -ENODEV;
3372 
3373 		case MFI_STATE_WAIT_HANDSHAKE:
3374 			/*
3375 			 * Set the CLR bit in inbound doorbell
3376 			 */
3377 			if ((instance->pdev->device ==
3378 				PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
3379 				(instance->pdev->device ==
3380 				 PCI_DEVICE_ID_LSI_SAS0071SKINNY) ||
3381 				(instance->pdev->device ==
3382 				PCI_DEVICE_ID_LSI_FUSION) ||
3383 				(instance->pdev->device ==
3384 				PCI_DEVICE_ID_LSI_PLASMA) ||
3385 				(instance->pdev->device ==
3386 				PCI_DEVICE_ID_LSI_INVADER) ||
3387 				(instance->pdev->device ==
3388 				PCI_DEVICE_ID_LSI_FURY)) {
3389 				writel(
3390 				  MFI_INIT_CLEAR_HANDSHAKE|MFI_INIT_HOTPLUG,
3391 				  &instance->reg_set->doorbell);
3392 			} else {
3393 				writel(
3394 				    MFI_INIT_CLEAR_HANDSHAKE|MFI_INIT_HOTPLUG,
3395 					&instance->reg_set->inbound_doorbell);
3396 			}
3397 
3398 			max_wait = MEGASAS_RESET_WAIT_TIME;
3399 			cur_state = MFI_STATE_WAIT_HANDSHAKE;
3400 			break;
3401 
3402 		case MFI_STATE_BOOT_MESSAGE_PENDING:
3403 			if ((instance->pdev->device ==
3404 			     PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
3405 				(instance->pdev->device ==
3406 				 PCI_DEVICE_ID_LSI_SAS0071SKINNY) ||
3407 			    (instance->pdev->device ==
3408 			     PCI_DEVICE_ID_LSI_FUSION) ||
3409 			    (instance->pdev->device ==
3410 			     PCI_DEVICE_ID_LSI_PLASMA) ||
3411 			    (instance->pdev->device ==
3412 			     PCI_DEVICE_ID_LSI_INVADER) ||
3413 			    (instance->pdev->device ==
3414 			     PCI_DEVICE_ID_LSI_FURY)) {
3415 				writel(MFI_INIT_HOTPLUG,
3416 				       &instance->reg_set->doorbell);
3417 			} else
3418 				writel(MFI_INIT_HOTPLUG,
3419 					&instance->reg_set->inbound_doorbell);
3420 
3421 			max_wait = MEGASAS_RESET_WAIT_TIME;
3422 			cur_state = MFI_STATE_BOOT_MESSAGE_PENDING;
3423 			break;
3424 
3425 		case MFI_STATE_OPERATIONAL:
3426 			/*
3427 			 * Bring it to READY state; assuming max wait 10 secs
3428 			 */
3429 			instance->instancet->disable_intr(instance);
3430 			if ((instance->pdev->device ==
3431 				PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
3432 				(instance->pdev->device ==
3433 				PCI_DEVICE_ID_LSI_SAS0071SKINNY)  ||
3434 				(instance->pdev->device
3435 					== PCI_DEVICE_ID_LSI_FUSION) ||
3436 				(instance->pdev->device
3437 					== PCI_DEVICE_ID_LSI_PLASMA) ||
3438 				(instance->pdev->device
3439 					== PCI_DEVICE_ID_LSI_INVADER) ||
3440 				(instance->pdev->device
3441 					== PCI_DEVICE_ID_LSI_FURY)) {
3442 				writel(MFI_RESET_FLAGS,
3443 					&instance->reg_set->doorbell);
3444 				if ((instance->pdev->device ==
3445 					PCI_DEVICE_ID_LSI_FUSION) ||
3446 					(instance->pdev->device ==
3447 					PCI_DEVICE_ID_LSI_PLASMA) ||
3448 					(instance->pdev->device ==
3449 					PCI_DEVICE_ID_LSI_INVADER) ||
3450 					(instance->pdev->device ==
3451 					PCI_DEVICE_ID_LSI_FURY)) {
3452 					for (i = 0; i < (10 * 1000); i += 20) {
3453 						if (readl(
3454 							    &instance->
3455 							    reg_set->
3456 							    doorbell) & 1)
3457 							msleep(20);
3458 						else
3459 							break;
3460 					}
3461 				}
3462 			} else
3463 				writel(MFI_RESET_FLAGS,
3464 					&instance->reg_set->inbound_doorbell);
3465 
3466 			max_wait = MEGASAS_RESET_WAIT_TIME;
3467 			cur_state = MFI_STATE_OPERATIONAL;
3468 			break;
3469 
3470 		case MFI_STATE_UNDEFINED:
3471 			/*
3472 			 * This state should not last for more than 2 seconds
3473 			 */
3474 			max_wait = MEGASAS_RESET_WAIT_TIME;
3475 			cur_state = MFI_STATE_UNDEFINED;
3476 			break;
3477 
3478 		case MFI_STATE_BB_INIT:
3479 			max_wait = MEGASAS_RESET_WAIT_TIME;
3480 			cur_state = MFI_STATE_BB_INIT;
3481 			break;
3482 
3483 		case MFI_STATE_FW_INIT:
3484 			max_wait = MEGASAS_RESET_WAIT_TIME;
3485 			cur_state = MFI_STATE_FW_INIT;
3486 			break;
3487 
3488 		case MFI_STATE_FW_INIT_2:
3489 			max_wait = MEGASAS_RESET_WAIT_TIME;
3490 			cur_state = MFI_STATE_FW_INIT_2;
3491 			break;
3492 
3493 		case MFI_STATE_DEVICE_SCAN:
3494 			max_wait = MEGASAS_RESET_WAIT_TIME;
3495 			cur_state = MFI_STATE_DEVICE_SCAN;
3496 			break;
3497 
3498 		case MFI_STATE_FLUSH_CACHE:
3499 			max_wait = MEGASAS_RESET_WAIT_TIME;
3500 			cur_state = MFI_STATE_FLUSH_CACHE;
3501 			break;
3502 
3503 		default:
3504 			printk(KERN_DEBUG "megasas: Unknown state 0x%x\n",
3505 			       fw_state);
3506 			return -ENODEV;
3507 		}
3508 
3509 		/*
3510 		 * The cur_state should not last for more than max_wait secs
3511 		 */
3512 		for (i = 0; i < (max_wait * 1000); i++) {
3513 			curr_abs_state = instance->instancet->
3514 				read_fw_status_reg(instance->reg_set);
3515 
3516 			if (abs_state == curr_abs_state) {
3517 				msleep(1);
3518 			} else
3519 				break;
3520 		}
3521 
3522 		/*
3523 		 * Return error if fw_state hasn't changed after max_wait
3524 		 */
3525 		if (curr_abs_state == abs_state) {
3526 			printk(KERN_DEBUG "FW state [%d] hasn't changed "
3527 			       "in %d secs\n", fw_state, max_wait);
3528 			return -ENODEV;
3529 		}
3530 
3531 		abs_state = curr_abs_state;
3532 		fw_state = curr_abs_state & MFI_STATE_MASK;
3533 	}
3534 	printk(KERN_INFO "megasas: FW now in Ready state\n");
3535 
3536 	return 0;
3537 }
3538 
3539 /**
3540  * megasas_teardown_frame_pool -	Destroy the cmd frame DMA pool
3541  * @instance:				Adapter soft state
3542  */
3543 static void megasas_teardown_frame_pool(struct megasas_instance *instance)
3544 {
3545 	int i;
3546 	u32 max_cmd = instance->max_mfi_cmds;
3547 	struct megasas_cmd *cmd;
3548 
3549 	if (!instance->frame_dma_pool)
3550 		return;
3551 
3552 	/*
3553 	 * Return all frames to pool
3554 	 */
3555 	for (i = 0; i < max_cmd; i++) {
3556 
3557 		cmd = instance->cmd_list[i];
3558 
3559 		if (cmd->frame)
3560 			pci_pool_free(instance->frame_dma_pool, cmd->frame,
3561 				      cmd->frame_phys_addr);
3562 
3563 		if (cmd->sense)
3564 			pci_pool_free(instance->sense_dma_pool, cmd->sense,
3565 				      cmd->sense_phys_addr);
3566 	}
3567 
3568 	/*
3569 	 * Now destroy the pool itself
3570 	 */
3571 	pci_pool_destroy(instance->frame_dma_pool);
3572 	pci_pool_destroy(instance->sense_dma_pool);
3573 
3574 	instance->frame_dma_pool = NULL;
3575 	instance->sense_dma_pool = NULL;
3576 }
3577 
3578 /**
3579  * megasas_create_frame_pool -	Creates DMA pool for cmd frames
3580  * @instance:			Adapter soft state
3581  *
3582  * Each command packet has an embedded DMA memory buffer that is used for
3583  * filling MFI frame and the SG list that immediately follows the frame. This
3584  * function creates those DMA memory buffers for each command packet by using
3585  * PCI pool facility.
3586  */
3587 static int megasas_create_frame_pool(struct megasas_instance *instance)
3588 {
3589 	int i;
3590 	u32 max_cmd;
3591 	u32 sge_sz;
3592 	u32 total_sz;
3593 	u32 frame_count;
3594 	struct megasas_cmd *cmd;
3595 
3596 	max_cmd = instance->max_mfi_cmds;
3597 
3598 	/*
3599 	 * Size of our frame is 64 bytes for MFI frame, followed by max SG
3600 	 * elements and finally SCSI_SENSE_BUFFERSIZE bytes for sense buffer
3601 	 */
3602 	sge_sz = (IS_DMA64) ? sizeof(struct megasas_sge64) :
3603 	    sizeof(struct megasas_sge32);
3604 
3605 	if (instance->flag_ieee) {
3606 		sge_sz = sizeof(struct megasas_sge_skinny);
3607 	}
3608 
3609 	/*
3610 	 * For MFI controllers.
3611 	 * max_num_sge = 60
3612 	 * max_sge_sz  = 16 byte (sizeof megasas_sge_skinny)
3613 	 * Total 960 byte (15 MFI frame of 64 byte)
3614 	 *
3615 	 * Fusion adapter require only 3 extra frame.
3616 	 * max_num_sge = 16 (defined as MAX_IOCTL_SGE)
3617 	 * max_sge_sz  = 12 byte (sizeof  megasas_sge64)
3618 	 * Total 192 byte (3 MFI frame of 64 byte)
3619 	 */
3620 	frame_count = instance->ctrl_context ? (3 + 1) : (15 + 1);
3621 	total_sz = MEGAMFI_FRAME_SIZE * frame_count;
3622 	/*
3623 	 * Use DMA pool facility provided by PCI layer
3624 	 */
3625 	instance->frame_dma_pool = pci_pool_create("megasas frame pool",
3626 					instance->pdev, total_sz, 256, 0);
3627 
3628 	if (!instance->frame_dma_pool) {
3629 		printk(KERN_DEBUG "megasas: failed to setup frame pool\n");
3630 		return -ENOMEM;
3631 	}
3632 
3633 	instance->sense_dma_pool = pci_pool_create("megasas sense pool",
3634 						   instance->pdev, 128, 4, 0);
3635 
3636 	if (!instance->sense_dma_pool) {
3637 		printk(KERN_DEBUG "megasas: failed to setup sense pool\n");
3638 
3639 		pci_pool_destroy(instance->frame_dma_pool);
3640 		instance->frame_dma_pool = NULL;
3641 
3642 		return -ENOMEM;
3643 	}
3644 
3645 	/*
3646 	 * Allocate and attach a frame to each of the commands in cmd_list.
3647 	 * By making cmd->index as the context instead of the &cmd, we can
3648 	 * always use 32bit context regardless of the architecture
3649 	 */
3650 	for (i = 0; i < max_cmd; i++) {
3651 
3652 		cmd = instance->cmd_list[i];
3653 
3654 		cmd->frame = pci_pool_alloc(instance->frame_dma_pool,
3655 					    GFP_KERNEL, &cmd->frame_phys_addr);
3656 
3657 		cmd->sense = pci_pool_alloc(instance->sense_dma_pool,
3658 					    GFP_KERNEL, &cmd->sense_phys_addr);
3659 
3660 		/*
3661 		 * megasas_teardown_frame_pool() takes care of freeing
3662 		 * whatever has been allocated
3663 		 */
3664 		if (!cmd->frame || !cmd->sense) {
3665 			printk(KERN_DEBUG "megasas: pci_pool_alloc failed \n");
3666 			megasas_teardown_frame_pool(instance);
3667 			return -ENOMEM;
3668 		}
3669 
3670 		memset(cmd->frame, 0, total_sz);
3671 		cmd->frame->io.context = cpu_to_le32(cmd->index);
3672 		cmd->frame->io.pad_0 = 0;
3673 		if ((instance->pdev->device != PCI_DEVICE_ID_LSI_FUSION) &&
3674 		    (instance->pdev->device != PCI_DEVICE_ID_LSI_PLASMA) &&
3675 		    (instance->pdev->device != PCI_DEVICE_ID_LSI_INVADER) &&
3676 			(instance->pdev->device != PCI_DEVICE_ID_LSI_FURY) &&
3677 		    (reset_devices))
3678 			cmd->frame->hdr.cmd = MFI_CMD_INVALID;
3679 	}
3680 
3681 	return 0;
3682 }
3683 
3684 /**
3685  * megasas_free_cmds -	Free all the cmds in the free cmd pool
3686  * @instance:		Adapter soft state
3687  */
3688 void megasas_free_cmds(struct megasas_instance *instance)
3689 {
3690 	int i;
3691 	/* First free the MFI frame pool */
3692 	megasas_teardown_frame_pool(instance);
3693 
3694 	/* Free all the commands in the cmd_list */
3695 	for (i = 0; i < instance->max_mfi_cmds; i++)
3696 
3697 		kfree(instance->cmd_list[i]);
3698 
3699 	/* Free the cmd_list buffer itself */
3700 	kfree(instance->cmd_list);
3701 	instance->cmd_list = NULL;
3702 
3703 	INIT_LIST_HEAD(&instance->cmd_pool);
3704 }
3705 
3706 /**
3707  * megasas_alloc_cmds -	Allocates the command packets
3708  * @instance:		Adapter soft state
3709  *
3710  * Each command that is issued to the FW, whether IO commands from the OS or
3711  * internal commands like IOCTLs, are wrapped in local data structure called
3712  * megasas_cmd. The frame embedded in this megasas_cmd is actually issued to
3713  * the FW.
3714  *
3715  * Each frame has a 32-bit field called context (tag). This context is used
3716  * to get back the megasas_cmd from the frame when a frame gets completed in
3717  * the ISR. Typically the address of the megasas_cmd itself would be used as
3718  * the context. But we wanted to keep the differences between 32 and 64 bit
3719  * systems to the mininum. We always use 32 bit integers for the context. In
3720  * this driver, the 32 bit values are the indices into an array cmd_list.
3721  * This array is used only to look up the megasas_cmd given the context. The
3722  * free commands themselves are maintained in a linked list called cmd_pool.
3723  */
3724 int megasas_alloc_cmds(struct megasas_instance *instance)
3725 {
3726 	int i;
3727 	int j;
3728 	u32 max_cmd;
3729 	struct megasas_cmd *cmd;
3730 	struct fusion_context *fusion;
3731 
3732 	fusion = instance->ctrl_context;
3733 	max_cmd = instance->max_mfi_cmds;
3734 
3735 	/*
3736 	 * instance->cmd_list is an array of struct megasas_cmd pointers.
3737 	 * Allocate the dynamic array first and then allocate individual
3738 	 * commands.
3739 	 */
3740 	instance->cmd_list = kcalloc(max_cmd, sizeof(struct megasas_cmd*), GFP_KERNEL);
3741 
3742 	if (!instance->cmd_list) {
3743 		printk(KERN_DEBUG "megasas: out of memory\n");
3744 		return -ENOMEM;
3745 	}
3746 
3747 	memset(instance->cmd_list, 0, sizeof(struct megasas_cmd *) *max_cmd);
3748 
3749 	for (i = 0; i < max_cmd; i++) {
3750 		instance->cmd_list[i] = kmalloc(sizeof(struct megasas_cmd),
3751 						GFP_KERNEL);
3752 
3753 		if (!instance->cmd_list[i]) {
3754 
3755 			for (j = 0; j < i; j++)
3756 				kfree(instance->cmd_list[j]);
3757 
3758 			kfree(instance->cmd_list);
3759 			instance->cmd_list = NULL;
3760 
3761 			return -ENOMEM;
3762 		}
3763 	}
3764 
3765 	for (i = 0; i < max_cmd; i++) {
3766 		cmd = instance->cmd_list[i];
3767 		memset(cmd, 0, sizeof(struct megasas_cmd));
3768 		cmd->index = i;
3769 		atomic_set(&cmd->mfi_mpt_pthr, MFI_LIST_ADDED);
3770 		cmd->scmd = NULL;
3771 		cmd->instance = instance;
3772 
3773 		list_add_tail(&cmd->list, &instance->cmd_pool);
3774 	}
3775 
3776 	/*
3777 	 * Create a frame pool and assign one frame to each cmd
3778 	 */
3779 	if (megasas_create_frame_pool(instance)) {
3780 		printk(KERN_DEBUG "megasas: Error creating frame DMA pool\n");
3781 		megasas_free_cmds(instance);
3782 	}
3783 
3784 	return 0;
3785 }
3786 
3787 /*
3788  * megasas_get_pd_list_info -	Returns FW's pd_list structure
3789  * @instance:				Adapter soft state
3790  * @pd_list:				pd_list structure
3791  *
3792  * Issues an internal command (DCMD) to get the FW's controller PD
3793  * list structure.  This information is mainly used to find out SYSTEM
3794  * supported by the FW.
3795  */
3796 static int
3797 megasas_get_pd_list(struct megasas_instance *instance)
3798 {
3799 	int ret = 0, pd_index = 0;
3800 	struct megasas_cmd *cmd;
3801 	struct megasas_dcmd_frame *dcmd;
3802 	struct MR_PD_LIST *ci;
3803 	struct MR_PD_ADDRESS *pd_addr;
3804 	dma_addr_t ci_h = 0;
3805 
3806 	cmd = megasas_get_cmd(instance);
3807 
3808 	if (!cmd) {
3809 		printk(KERN_DEBUG "megasas (get_pd_list): Failed to get cmd\n");
3810 		return -ENOMEM;
3811 	}
3812 
3813 	dcmd = &cmd->frame->dcmd;
3814 
3815 	ci = pci_alloc_consistent(instance->pdev,
3816 		  MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST), &ci_h);
3817 
3818 	if (!ci) {
3819 		printk(KERN_DEBUG "Failed to alloc mem for pd_list\n");
3820 		megasas_return_cmd(instance, cmd);
3821 		return -ENOMEM;
3822 	}
3823 
3824 	memset(ci, 0, sizeof(*ci));
3825 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
3826 
3827 	dcmd->mbox.b[0] = MR_PD_QUERY_TYPE_EXPOSED_TO_HOST;
3828 	dcmd->mbox.b[1] = 0;
3829 	dcmd->cmd = MFI_CMD_DCMD;
3830 	dcmd->cmd_status = 0xFF;
3831 	dcmd->sge_count = 1;
3832 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_READ);
3833 	dcmd->timeout = 0;
3834 	dcmd->pad_0 = 0;
3835 	dcmd->data_xfer_len = cpu_to_le32(MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST));
3836 	dcmd->opcode = cpu_to_le32(MR_DCMD_PD_LIST_QUERY);
3837 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(ci_h);
3838 	dcmd->sgl.sge32[0].length = cpu_to_le32(MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST));
3839 
3840 	if (instance->ctrl_context && !instance->mask_interrupts)
3841 		ret = megasas_issue_blocked_cmd(instance, cmd,
3842 			MEGASAS_BLOCKED_CMD_TIMEOUT);
3843 	else
3844 		ret = megasas_issue_polled(instance, cmd);
3845 
3846 	/*
3847 	* the following function will get the instance PD LIST.
3848 	*/
3849 
3850 	pd_addr = ci->addr;
3851 
3852 	if ( ret == 0 &&
3853 	     (le32_to_cpu(ci->count) <
3854 		  (MEGASAS_MAX_PD_CHANNELS * MEGASAS_MAX_DEV_PER_CHANNEL))) {
3855 
3856 		memset(instance->local_pd_list, 0,
3857 			MEGASAS_MAX_PD * sizeof(struct megasas_pd_list));
3858 
3859 		for (pd_index = 0; pd_index < le32_to_cpu(ci->count); pd_index++) {
3860 
3861 			instance->local_pd_list[le16_to_cpu(pd_addr->deviceId)].tid	=
3862 				le16_to_cpu(pd_addr->deviceId);
3863 			instance->local_pd_list[le16_to_cpu(pd_addr->deviceId)].driveType	=
3864 							pd_addr->scsiDevType;
3865 			instance->local_pd_list[le16_to_cpu(pd_addr->deviceId)].driveState	=
3866 							MR_PD_STATE_SYSTEM;
3867 			pd_addr++;
3868 		}
3869 		memcpy(instance->pd_list, instance->local_pd_list,
3870 			sizeof(instance->pd_list));
3871 	}
3872 
3873 	pci_free_consistent(instance->pdev,
3874 				MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST),
3875 				ci, ci_h);
3876 
3877 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
3878 		megasas_return_mfi_mpt_pthr(instance, cmd,
3879 			cmd->mpt_pthr_cmd_blocked);
3880 	else
3881 		megasas_return_cmd(instance, cmd);
3882 
3883 	return ret;
3884 }
3885 
3886 /*
3887  * megasas_get_ld_list_info -	Returns FW's ld_list structure
3888  * @instance:				Adapter soft state
3889  * @ld_list:				ld_list structure
3890  *
3891  * Issues an internal command (DCMD) to get the FW's controller PD
3892  * list structure.  This information is mainly used to find out SYSTEM
3893  * supported by the FW.
3894  */
3895 static int
3896 megasas_get_ld_list(struct megasas_instance *instance)
3897 {
3898 	int ret = 0, ld_index = 0, ids = 0;
3899 	struct megasas_cmd *cmd;
3900 	struct megasas_dcmd_frame *dcmd;
3901 	struct MR_LD_LIST *ci;
3902 	dma_addr_t ci_h = 0;
3903 	u32 ld_count;
3904 
3905 	cmd = megasas_get_cmd(instance);
3906 
3907 	if (!cmd) {
3908 		printk(KERN_DEBUG "megasas_get_ld_list: Failed to get cmd\n");
3909 		return -ENOMEM;
3910 	}
3911 
3912 	dcmd = &cmd->frame->dcmd;
3913 
3914 	ci = pci_alloc_consistent(instance->pdev,
3915 				sizeof(struct MR_LD_LIST),
3916 				&ci_h);
3917 
3918 	if (!ci) {
3919 		printk(KERN_DEBUG "Failed to alloc mem in get_ld_list\n");
3920 		megasas_return_cmd(instance, cmd);
3921 		return -ENOMEM;
3922 	}
3923 
3924 	memset(ci, 0, sizeof(*ci));
3925 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
3926 
3927 	if (instance->supportmax256vd)
3928 		dcmd->mbox.b[0] = 1;
3929 	dcmd->cmd = MFI_CMD_DCMD;
3930 	dcmd->cmd_status = 0xFF;
3931 	dcmd->sge_count = 1;
3932 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_READ);
3933 	dcmd->timeout = 0;
3934 	dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_LD_LIST));
3935 	dcmd->opcode = cpu_to_le32(MR_DCMD_LD_GET_LIST);
3936 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(ci_h);
3937 	dcmd->sgl.sge32[0].length = cpu_to_le32(sizeof(struct MR_LD_LIST));
3938 	dcmd->pad_0  = 0;
3939 
3940 	if (instance->ctrl_context && !instance->mask_interrupts)
3941 		ret = megasas_issue_blocked_cmd(instance, cmd,
3942 			MEGASAS_BLOCKED_CMD_TIMEOUT);
3943 	else
3944 		ret = megasas_issue_polled(instance, cmd);
3945 
3946 
3947 	ld_count = le32_to_cpu(ci->ldCount);
3948 
3949 	/* the following function will get the instance PD LIST */
3950 
3951 	if ((ret == 0) && (ld_count <= instance->fw_supported_vd_count)) {
3952 		memset(instance->ld_ids, 0xff, MAX_LOGICAL_DRIVES_EXT);
3953 
3954 		for (ld_index = 0; ld_index < ld_count; ld_index++) {
3955 			if (ci->ldList[ld_index].state != 0) {
3956 				ids = ci->ldList[ld_index].ref.targetId;
3957 				instance->ld_ids[ids] =
3958 					ci->ldList[ld_index].ref.targetId;
3959 			}
3960 		}
3961 	}
3962 
3963 	pci_free_consistent(instance->pdev,
3964 				sizeof(struct MR_LD_LIST),
3965 				ci,
3966 				ci_h);
3967 
3968 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
3969 		megasas_return_mfi_mpt_pthr(instance, cmd,
3970 			cmd->mpt_pthr_cmd_blocked);
3971 	else
3972 		megasas_return_cmd(instance, cmd);
3973 	return ret;
3974 }
3975 
3976 /**
3977  * megasas_ld_list_query -	Returns FW's ld_list structure
3978  * @instance:				Adapter soft state
3979  * @ld_list:				ld_list structure
3980  *
3981  * Issues an internal command (DCMD) to get the FW's controller PD
3982  * list structure.  This information is mainly used to find out SYSTEM
3983  * supported by the FW.
3984  */
3985 static int
3986 megasas_ld_list_query(struct megasas_instance *instance, u8 query_type)
3987 {
3988 	int ret = 0, ld_index = 0, ids = 0;
3989 	struct megasas_cmd *cmd;
3990 	struct megasas_dcmd_frame *dcmd;
3991 	struct MR_LD_TARGETID_LIST *ci;
3992 	dma_addr_t ci_h = 0;
3993 	u32 tgtid_count;
3994 
3995 	cmd = megasas_get_cmd(instance);
3996 
3997 	if (!cmd) {
3998 		printk(KERN_WARNING
3999 		       "megasas:(megasas_ld_list_query): Failed to get cmd\n");
4000 		return -ENOMEM;
4001 	}
4002 
4003 	dcmd = &cmd->frame->dcmd;
4004 
4005 	ci = pci_alloc_consistent(instance->pdev,
4006 				  sizeof(struct MR_LD_TARGETID_LIST), &ci_h);
4007 
4008 	if (!ci) {
4009 		printk(KERN_WARNING
4010 		       "megasas: Failed to alloc mem for ld_list_query\n");
4011 		megasas_return_cmd(instance, cmd);
4012 		return -ENOMEM;
4013 	}
4014 
4015 	memset(ci, 0, sizeof(*ci));
4016 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4017 
4018 	dcmd->mbox.b[0] = query_type;
4019 	if (instance->supportmax256vd)
4020 		dcmd->mbox.b[2] = 1;
4021 
4022 	dcmd->cmd = MFI_CMD_DCMD;
4023 	dcmd->cmd_status = 0xFF;
4024 	dcmd->sge_count = 1;
4025 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_READ);
4026 	dcmd->timeout = 0;
4027 	dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_LD_TARGETID_LIST));
4028 	dcmd->opcode = cpu_to_le32(MR_DCMD_LD_LIST_QUERY);
4029 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(ci_h);
4030 	dcmd->sgl.sge32[0].length = cpu_to_le32(sizeof(struct MR_LD_TARGETID_LIST));
4031 	dcmd->pad_0  = 0;
4032 
4033 	if (instance->ctrl_context && !instance->mask_interrupts)
4034 		ret = megasas_issue_blocked_cmd(instance, cmd,
4035 			MEGASAS_BLOCKED_CMD_TIMEOUT);
4036 	else
4037 		ret = megasas_issue_polled(instance, cmd);
4038 
4039 	tgtid_count = le32_to_cpu(ci->count);
4040 
4041 	if ((ret == 0) && (tgtid_count <= (instance->fw_supported_vd_count))) {
4042 		memset(instance->ld_ids, 0xff, MEGASAS_MAX_LD_IDS);
4043 		for (ld_index = 0; ld_index < tgtid_count; ld_index++) {
4044 			ids = ci->targetId[ld_index];
4045 			instance->ld_ids[ids] = ci->targetId[ld_index];
4046 		}
4047 
4048 	}
4049 
4050 	pci_free_consistent(instance->pdev, sizeof(struct MR_LD_TARGETID_LIST),
4051 			    ci, ci_h);
4052 
4053 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
4054 		megasas_return_mfi_mpt_pthr(instance, cmd,
4055 			cmd->mpt_pthr_cmd_blocked);
4056 	else
4057 		megasas_return_cmd(instance, cmd);
4058 
4059 	return ret;
4060 }
4061 
4062 /*
4063  * megasas_update_ext_vd_details : Update details w.r.t Extended VD
4064  * instance			 : Controller's instance
4065 */
4066 static void megasas_update_ext_vd_details(struct megasas_instance *instance)
4067 {
4068 	struct fusion_context *fusion;
4069 	u32 old_map_sz;
4070 	u32 new_map_sz;
4071 
4072 	fusion = instance->ctrl_context;
4073 	/* For MFI based controllers return dummy success */
4074 	if (!fusion)
4075 		return;
4076 
4077 	instance->supportmax256vd =
4078 		instance->ctrl_info->adapterOperations3.supportMaxExtLDs;
4079 	/* Below is additional check to address future FW enhancement */
4080 	if (instance->ctrl_info->max_lds > 64)
4081 		instance->supportmax256vd = 1;
4082 
4083 	instance->drv_supported_vd_count = MEGASAS_MAX_LD_CHANNELS
4084 					* MEGASAS_MAX_DEV_PER_CHANNEL;
4085 	instance->drv_supported_pd_count = MEGASAS_MAX_PD_CHANNELS
4086 					* MEGASAS_MAX_DEV_PER_CHANNEL;
4087 	if (instance->supportmax256vd) {
4088 		instance->fw_supported_vd_count = MAX_LOGICAL_DRIVES_EXT;
4089 		instance->fw_supported_pd_count = MAX_PHYSICAL_DEVICES;
4090 	} else {
4091 		instance->fw_supported_vd_count = MAX_LOGICAL_DRIVES;
4092 		instance->fw_supported_pd_count = MAX_PHYSICAL_DEVICES;
4093 	}
4094 	dev_info(&instance->pdev->dev, "Firmware supports %d VD %d PD\n",
4095 		instance->fw_supported_vd_count,
4096 		instance->fw_supported_pd_count);
4097 	dev_info(&instance->pdev->dev, "Driver supports %d VD  %d PD\n",
4098 		instance->drv_supported_vd_count,
4099 		instance->drv_supported_pd_count);
4100 
4101 	old_map_sz =  sizeof(struct MR_FW_RAID_MAP) +
4102 				(sizeof(struct MR_LD_SPAN_MAP) *
4103 				(instance->fw_supported_vd_count - 1));
4104 	new_map_sz =  sizeof(struct MR_FW_RAID_MAP_EXT);
4105 	fusion->drv_map_sz =  sizeof(struct MR_DRV_RAID_MAP) +
4106 				(sizeof(struct MR_LD_SPAN_MAP) *
4107 				(instance->drv_supported_vd_count - 1));
4108 
4109 	fusion->max_map_sz = max(old_map_sz, new_map_sz);
4110 
4111 
4112 	if (instance->supportmax256vd)
4113 		fusion->current_map_sz = new_map_sz;
4114 	else
4115 		fusion->current_map_sz = old_map_sz;
4116 
4117 }
4118 
4119 /**
4120  * megasas_get_controller_info -	Returns FW's controller structure
4121  * @instance:				Adapter soft state
4122  *
4123  * Issues an internal command (DCMD) to get the FW's controller structure.
4124  * This information is mainly used to find out the maximum IO transfer per
4125  * command supported by the FW.
4126  */
4127 int
4128 megasas_get_ctrl_info(struct megasas_instance *instance)
4129 {
4130 	int ret = 0;
4131 	struct megasas_cmd *cmd;
4132 	struct megasas_dcmd_frame *dcmd;
4133 	struct megasas_ctrl_info *ci;
4134 	struct megasas_ctrl_info *ctrl_info;
4135 	dma_addr_t ci_h = 0;
4136 
4137 	ctrl_info = instance->ctrl_info;
4138 
4139 	cmd = megasas_get_cmd(instance);
4140 
4141 	if (!cmd) {
4142 		printk(KERN_DEBUG "megasas: Failed to get a free cmd\n");
4143 		return -ENOMEM;
4144 	}
4145 
4146 	dcmd = &cmd->frame->dcmd;
4147 
4148 	ci = pci_alloc_consistent(instance->pdev,
4149 				  sizeof(struct megasas_ctrl_info), &ci_h);
4150 
4151 	if (!ci) {
4152 		printk(KERN_DEBUG "Failed to alloc mem for ctrl info\n");
4153 		megasas_return_cmd(instance, cmd);
4154 		return -ENOMEM;
4155 	}
4156 
4157 	memset(ci, 0, sizeof(*ci));
4158 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4159 
4160 	dcmd->cmd = MFI_CMD_DCMD;
4161 	dcmd->cmd_status = 0xFF;
4162 	dcmd->sge_count = 1;
4163 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_READ);
4164 	dcmd->timeout = 0;
4165 	dcmd->pad_0 = 0;
4166 	dcmd->data_xfer_len = cpu_to_le32(sizeof(struct megasas_ctrl_info));
4167 	dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_GET_INFO);
4168 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(ci_h);
4169 	dcmd->sgl.sge32[0].length = cpu_to_le32(sizeof(struct megasas_ctrl_info));
4170 	dcmd->mbox.b[0] = 1;
4171 
4172 	if (instance->ctrl_context && !instance->mask_interrupts)
4173 		ret = megasas_issue_blocked_cmd(instance, cmd,
4174 			MEGASAS_BLOCKED_CMD_TIMEOUT);
4175 	else
4176 		ret = megasas_issue_polled(instance, cmd);
4177 
4178 	if (!ret) {
4179 		memcpy(ctrl_info, ci, sizeof(struct megasas_ctrl_info));
4180 		le32_to_cpus((u32 *)&ctrl_info->properties.OnOffProperties);
4181 		le32_to_cpus((u32 *)&ctrl_info->adapterOperations2);
4182 		le32_to_cpus((u32 *)&ctrl_info->adapterOperations3);
4183 		megasas_update_ext_vd_details(instance);
4184 	}
4185 
4186 	pci_free_consistent(instance->pdev, sizeof(struct megasas_ctrl_info),
4187 			    ci, ci_h);
4188 
4189 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
4190 		megasas_return_mfi_mpt_pthr(instance, cmd,
4191 			cmd->mpt_pthr_cmd_blocked);
4192 	else
4193 		megasas_return_cmd(instance, cmd);
4194 	return ret;
4195 }
4196 
4197 /*
4198  * megasas_set_crash_dump_params -	Sends address of crash dump DMA buffer
4199  *					to firmware
4200  *
4201  * @instance:				Adapter soft state
4202  * @crash_buf_state		-	tell FW to turn ON/OFF crash dump feature
4203 					MR_CRASH_BUF_TURN_OFF = 0
4204 					MR_CRASH_BUF_TURN_ON = 1
4205  * @return 0 on success non-zero on failure.
4206  * Issues an internal command (DCMD) to set parameters for crash dump feature.
4207  * Driver will send address of crash dump DMA buffer and set mbox to tell FW
4208  * that driver supports crash dump feature. This DCMD will be sent only if
4209  * crash dump feature is supported by the FW.
4210  *
4211  */
4212 int megasas_set_crash_dump_params(struct megasas_instance *instance,
4213 	u8 crash_buf_state)
4214 {
4215 	int ret = 0;
4216 	struct megasas_cmd *cmd;
4217 	struct megasas_dcmd_frame *dcmd;
4218 
4219 	cmd = megasas_get_cmd(instance);
4220 
4221 	if (!cmd) {
4222 		dev_err(&instance->pdev->dev, "Failed to get a free cmd\n");
4223 		return -ENOMEM;
4224 	}
4225 
4226 
4227 	dcmd = &cmd->frame->dcmd;
4228 
4229 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4230 	dcmd->mbox.b[0] = crash_buf_state;
4231 	dcmd->cmd = MFI_CMD_DCMD;
4232 	dcmd->cmd_status = 0xFF;
4233 	dcmd->sge_count = 1;
4234 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_NONE);
4235 	dcmd->timeout = 0;
4236 	dcmd->pad_0 = 0;
4237 	dcmd->data_xfer_len = cpu_to_le32(CRASH_DMA_BUF_SIZE);
4238 	dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_SET_CRASH_DUMP_PARAMS);
4239 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(instance->crash_dump_h);
4240 	dcmd->sgl.sge32[0].length = cpu_to_le32(CRASH_DMA_BUF_SIZE);
4241 
4242 	if (instance->ctrl_context && !instance->mask_interrupts)
4243 		ret = megasas_issue_blocked_cmd(instance, cmd,
4244 			MEGASAS_BLOCKED_CMD_TIMEOUT);
4245 	else
4246 		ret = megasas_issue_polled(instance, cmd);
4247 
4248 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
4249 		megasas_return_mfi_mpt_pthr(instance, cmd,
4250 			cmd->mpt_pthr_cmd_blocked);
4251 	else
4252 		megasas_return_cmd(instance, cmd);
4253 	return ret;
4254 }
4255 
4256 /**
4257  * megasas_issue_init_mfi -	Initializes the FW
4258  * @instance:		Adapter soft state
4259  *
4260  * Issues the INIT MFI cmd
4261  */
4262 static int
4263 megasas_issue_init_mfi(struct megasas_instance *instance)
4264 {
4265 	u32 context;
4266 
4267 	struct megasas_cmd *cmd;
4268 
4269 	struct megasas_init_frame *init_frame;
4270 	struct megasas_init_queue_info *initq_info;
4271 	dma_addr_t init_frame_h;
4272 	dma_addr_t initq_info_h;
4273 
4274 	/*
4275 	 * Prepare a init frame. Note the init frame points to queue info
4276 	 * structure. Each frame has SGL allocated after first 64 bytes. For
4277 	 * this frame - since we don't need any SGL - we use SGL's space as
4278 	 * queue info structure
4279 	 *
4280 	 * We will not get a NULL command below. We just created the pool.
4281 	 */
4282 	cmd = megasas_get_cmd(instance);
4283 
4284 	init_frame = (struct megasas_init_frame *)cmd->frame;
4285 	initq_info = (struct megasas_init_queue_info *)
4286 		((unsigned long)init_frame + 64);
4287 
4288 	init_frame_h = cmd->frame_phys_addr;
4289 	initq_info_h = init_frame_h + 64;
4290 
4291 	context = init_frame->context;
4292 	memset(init_frame, 0, MEGAMFI_FRAME_SIZE);
4293 	memset(initq_info, 0, sizeof(struct megasas_init_queue_info));
4294 	init_frame->context = context;
4295 
4296 	initq_info->reply_queue_entries = cpu_to_le32(instance->max_fw_cmds + 1);
4297 	initq_info->reply_queue_start_phys_addr_lo = cpu_to_le32(instance->reply_queue_h);
4298 
4299 	initq_info->producer_index_phys_addr_lo = cpu_to_le32(instance->producer_h);
4300 	initq_info->consumer_index_phys_addr_lo = cpu_to_le32(instance->consumer_h);
4301 
4302 	init_frame->cmd = MFI_CMD_INIT;
4303 	init_frame->cmd_status = 0xFF;
4304 	init_frame->queue_info_new_phys_addr_lo =
4305 		cpu_to_le32(lower_32_bits(initq_info_h));
4306 	init_frame->queue_info_new_phys_addr_hi =
4307 		cpu_to_le32(upper_32_bits(initq_info_h));
4308 
4309 	init_frame->data_xfer_len = cpu_to_le32(sizeof(struct megasas_init_queue_info));
4310 
4311 	/*
4312 	 * disable the intr before firing the init frame to FW
4313 	 */
4314 	instance->instancet->disable_intr(instance);
4315 
4316 	/*
4317 	 * Issue the init frame in polled mode
4318 	 */
4319 
4320 	if (megasas_issue_polled(instance, cmd)) {
4321 		printk(KERN_ERR "megasas: Failed to init firmware\n");
4322 		megasas_return_cmd(instance, cmd);
4323 		goto fail_fw_init;
4324 	}
4325 
4326 	megasas_return_cmd(instance, cmd);
4327 
4328 	return 0;
4329 
4330 fail_fw_init:
4331 	return -EINVAL;
4332 }
4333 
4334 static u32
4335 megasas_init_adapter_mfi(struct megasas_instance *instance)
4336 {
4337 	struct megasas_register_set __iomem *reg_set;
4338 	u32 context_sz;
4339 	u32 reply_q_sz;
4340 
4341 	reg_set = instance->reg_set;
4342 
4343 	/*
4344 	 * Get various operational parameters from status register
4345 	 */
4346 	instance->max_fw_cmds = instance->instancet->read_fw_status_reg(reg_set) & 0x00FFFF;
4347 	/*
4348 	 * Reduce the max supported cmds by 1. This is to ensure that the
4349 	 * reply_q_sz (1 more than the max cmd that driver may send)
4350 	 * does not exceed max cmds that the FW can support
4351 	 */
4352 	instance->max_fw_cmds = instance->max_fw_cmds-1;
4353 	instance->max_mfi_cmds = instance->max_fw_cmds;
4354 	instance->max_num_sge = (instance->instancet->read_fw_status_reg(reg_set) & 0xFF0000) >>
4355 					0x10;
4356 	/*
4357 	 * Create a pool of commands
4358 	 */
4359 	if (megasas_alloc_cmds(instance))
4360 		goto fail_alloc_cmds;
4361 
4362 	/*
4363 	 * Allocate memory for reply queue. Length of reply queue should
4364 	 * be _one_ more than the maximum commands handled by the firmware.
4365 	 *
4366 	 * Note: When FW completes commands, it places corresponding contex
4367 	 * values in this circular reply queue. This circular queue is a fairly
4368 	 * typical producer-consumer queue. FW is the producer (of completed
4369 	 * commands) and the driver is the consumer.
4370 	 */
4371 	context_sz = sizeof(u32);
4372 	reply_q_sz = context_sz * (instance->max_fw_cmds + 1);
4373 
4374 	instance->reply_queue = pci_alloc_consistent(instance->pdev,
4375 						     reply_q_sz,
4376 						     &instance->reply_queue_h);
4377 
4378 	if (!instance->reply_queue) {
4379 		printk(KERN_DEBUG "megasas: Out of DMA mem for reply queue\n");
4380 		goto fail_reply_queue;
4381 	}
4382 
4383 	if (megasas_issue_init_mfi(instance))
4384 		goto fail_fw_init;
4385 
4386 	if (megasas_get_ctrl_info(instance)) {
4387 		dev_err(&instance->pdev->dev, "(%d): Could get controller info "
4388 			"Fail from %s %d\n", instance->unique_id,
4389 			__func__, __LINE__);
4390 		goto fail_fw_init;
4391 	}
4392 
4393 	instance->fw_support_ieee = 0;
4394 	instance->fw_support_ieee =
4395 		(instance->instancet->read_fw_status_reg(reg_set) &
4396 		0x04000000);
4397 
4398 	printk(KERN_NOTICE "megasas_init_mfi: fw_support_ieee=%d",
4399 			instance->fw_support_ieee);
4400 
4401 	if (instance->fw_support_ieee)
4402 		instance->flag_ieee = 1;
4403 
4404 	return 0;
4405 
4406 fail_fw_init:
4407 
4408 	pci_free_consistent(instance->pdev, reply_q_sz,
4409 			    instance->reply_queue, instance->reply_queue_h);
4410 fail_reply_queue:
4411 	megasas_free_cmds(instance);
4412 
4413 fail_alloc_cmds:
4414 	return 1;
4415 }
4416 
4417 /**
4418  * megasas_init_fw -	Initializes the FW
4419  * @instance:		Adapter soft state
4420  *
4421  * This is the main function for initializing firmware
4422  */
4423 
4424 static int megasas_init_fw(struct megasas_instance *instance)
4425 {
4426 	u32 max_sectors_1;
4427 	u32 max_sectors_2;
4428 	u32 tmp_sectors, msix_enable, scratch_pad_2;
4429 	resource_size_t base_addr;
4430 	struct megasas_register_set __iomem *reg_set;
4431 	struct megasas_ctrl_info *ctrl_info = NULL;
4432 	unsigned long bar_list;
4433 	int i, loop, fw_msix_count = 0;
4434 	struct IOV_111 *iovPtr;
4435 
4436 	/* Find first memory bar */
4437 	bar_list = pci_select_bars(instance->pdev, IORESOURCE_MEM);
4438 	instance->bar = find_first_bit(&bar_list, sizeof(unsigned long));
4439 	if (pci_request_selected_regions(instance->pdev, instance->bar,
4440 					 "megasas: LSI")) {
4441 		printk(KERN_DEBUG "megasas: IO memory region busy!\n");
4442 		return -EBUSY;
4443 	}
4444 
4445 	base_addr = pci_resource_start(instance->pdev, instance->bar);
4446 	instance->reg_set = ioremap_nocache(base_addr, 8192);
4447 
4448 	if (!instance->reg_set) {
4449 		printk(KERN_DEBUG "megasas: Failed to map IO mem\n");
4450 		goto fail_ioremap;
4451 	}
4452 
4453 	reg_set = instance->reg_set;
4454 
4455 	switch (instance->pdev->device) {
4456 	case PCI_DEVICE_ID_LSI_FUSION:
4457 	case PCI_DEVICE_ID_LSI_PLASMA:
4458 	case PCI_DEVICE_ID_LSI_INVADER:
4459 	case PCI_DEVICE_ID_LSI_FURY:
4460 		instance->instancet = &megasas_instance_template_fusion;
4461 		break;
4462 	case PCI_DEVICE_ID_LSI_SAS1078R:
4463 	case PCI_DEVICE_ID_LSI_SAS1078DE:
4464 		instance->instancet = &megasas_instance_template_ppc;
4465 		break;
4466 	case PCI_DEVICE_ID_LSI_SAS1078GEN2:
4467 	case PCI_DEVICE_ID_LSI_SAS0079GEN2:
4468 		instance->instancet = &megasas_instance_template_gen2;
4469 		break;
4470 	case PCI_DEVICE_ID_LSI_SAS0073SKINNY:
4471 	case PCI_DEVICE_ID_LSI_SAS0071SKINNY:
4472 		instance->instancet = &megasas_instance_template_skinny;
4473 		break;
4474 	case PCI_DEVICE_ID_LSI_SAS1064R:
4475 	case PCI_DEVICE_ID_DELL_PERC5:
4476 	default:
4477 		instance->instancet = &megasas_instance_template_xscale;
4478 		break;
4479 	}
4480 
4481 	if (megasas_transition_to_ready(instance, 0)) {
4482 		atomic_set(&instance->fw_reset_no_pci_access, 1);
4483 		instance->instancet->adp_reset
4484 			(instance, instance->reg_set);
4485 		atomic_set(&instance->fw_reset_no_pci_access, 0);
4486 		dev_info(&instance->pdev->dev,
4487 			"megasas: FW restarted successfully from %s!\n",
4488 			__func__);
4489 
4490 		/*waitting for about 30 second before retry*/
4491 		ssleep(30);
4492 
4493 		if (megasas_transition_to_ready(instance, 0))
4494 			goto fail_ready_state;
4495 	}
4496 
4497 	/*
4498 	 * MSI-X host index 0 is common for all adapter.
4499 	 * It is used for all MPT based Adapters.
4500 	 */
4501 	instance->reply_post_host_index_addr[0] =
4502 		(u32 *)((u8 *)instance->reg_set +
4503 		MPI2_REPLY_POST_HOST_INDEX_OFFSET);
4504 
4505 	/* Check if MSI-X is supported while in ready state */
4506 	msix_enable = (instance->instancet->read_fw_status_reg(reg_set) &
4507 		       0x4000000) >> 0x1a;
4508 	if (msix_enable && !msix_disable) {
4509 		scratch_pad_2 = readl
4510 			(&instance->reg_set->outbound_scratch_pad_2);
4511 		/* Check max MSI-X vectors */
4512 		if ((instance->pdev->device == PCI_DEVICE_ID_LSI_FUSION) ||
4513 		    (instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA)) {
4514 			instance->msix_vectors = (scratch_pad_2
4515 				& MR_MAX_REPLY_QUEUES_OFFSET) + 1;
4516 			fw_msix_count = instance->msix_vectors;
4517 			if (msix_vectors)
4518 				instance->msix_vectors =
4519 					min(msix_vectors,
4520 					    instance->msix_vectors);
4521 		} else if ((instance->pdev->device == PCI_DEVICE_ID_LSI_INVADER)
4522 			|| (instance->pdev->device == PCI_DEVICE_ID_LSI_FURY)) {
4523 			/* Invader/Fury supports more than 8 MSI-X */
4524 			instance->msix_vectors = ((scratch_pad_2
4525 				& MR_MAX_REPLY_QUEUES_EXT_OFFSET)
4526 				>> MR_MAX_REPLY_QUEUES_EXT_OFFSET_SHIFT) + 1;
4527 			fw_msix_count = instance->msix_vectors;
4528 			/* Save 1-15 reply post index address to local memory
4529 			 * Index 0 is already saved from reg offset
4530 			 * MPI2_REPLY_POST_HOST_INDEX_OFFSET
4531 			 */
4532 			for (loop = 1; loop < MR_MAX_MSIX_REG_ARRAY; loop++) {
4533 				instance->reply_post_host_index_addr[loop] =
4534 					(u32 *)((u8 *)instance->reg_set +
4535 					MPI2_SUP_REPLY_POST_HOST_INDEX_OFFSET
4536 					+ (loop * 0x10));
4537 			}
4538 			if (msix_vectors)
4539 				instance->msix_vectors = min(msix_vectors,
4540 					instance->msix_vectors);
4541 		} else
4542 			instance->msix_vectors = 1;
4543 		/* Don't bother allocating more MSI-X vectors than cpus */
4544 		instance->msix_vectors = min(instance->msix_vectors,
4545 					     (unsigned int)num_online_cpus());
4546 		for (i = 0; i < instance->msix_vectors; i++)
4547 			instance->msixentry[i].entry = i;
4548 		i = pci_enable_msix_range(instance->pdev, instance->msixentry,
4549 					  1, instance->msix_vectors);
4550 		if (i > 0)
4551 			instance->msix_vectors = i;
4552 		else
4553 			instance->msix_vectors = 0;
4554 
4555 		dev_info(&instance->pdev->dev, "[scsi%d]: FW supports"
4556 			"<%d> MSIX vector,Online CPUs: <%d>,"
4557 			"Current MSIX <%d>\n", instance->host->host_no,
4558 			fw_msix_count, (unsigned int)num_online_cpus(),
4559 			instance->msix_vectors);
4560 	}
4561 
4562 	instance->ctrl_info = kzalloc(sizeof(struct megasas_ctrl_info),
4563 				GFP_KERNEL);
4564 	if (instance->ctrl_info == NULL)
4565 		goto fail_init_adapter;
4566 
4567 	/*
4568 	 * Below are default value for legacy Firmware.
4569 	 * non-fusion based controllers
4570 	 */
4571 	instance->fw_supported_vd_count = MAX_LOGICAL_DRIVES;
4572 	instance->fw_supported_pd_count = MAX_PHYSICAL_DEVICES;
4573 	/* Get operational params, sge flags, send init cmd to controller */
4574 	if (instance->instancet->init_adapter(instance))
4575 		goto fail_init_adapter;
4576 
4577 	printk(KERN_ERR "megasas: INIT adapter done\n");
4578 
4579 	/** for passthrough
4580 	* the following function will get the PD LIST.
4581 	*/
4582 
4583 	memset(instance->pd_list, 0 ,
4584 		(MEGASAS_MAX_PD * sizeof(struct megasas_pd_list)));
4585 	if (megasas_get_pd_list(instance) < 0) {
4586 		printk(KERN_ERR "megasas: failed to get PD list\n");
4587 		goto fail_init_adapter;
4588 	}
4589 
4590 	memset(instance->ld_ids, 0xff, MEGASAS_MAX_LD_IDS);
4591 	if (megasas_ld_list_query(instance,
4592 				  MR_LD_QUERY_TYPE_EXPOSED_TO_HOST))
4593 		megasas_get_ld_list(instance);
4594 
4595 	/*
4596 	 * Compute the max allowed sectors per IO: The controller info has two
4597 	 * limits on max sectors. Driver should use the minimum of these two.
4598 	 *
4599 	 * 1 << stripe_sz_ops.min = max sectors per strip
4600 	 *
4601 	 * Note that older firmwares ( < FW ver 30) didn't report information
4602 	 * to calculate max_sectors_1. So the number ended up as zero always.
4603 	 */
4604 	tmp_sectors = 0;
4605 	ctrl_info = instance->ctrl_info;
4606 
4607 	max_sectors_1 = (1 << ctrl_info->stripe_sz_ops.min) *
4608 		le16_to_cpu(ctrl_info->max_strips_per_io);
4609 	max_sectors_2 = le32_to_cpu(ctrl_info->max_request_size);
4610 
4611 	tmp_sectors = min_t(u32, max_sectors_1 , max_sectors_2);
4612 
4613 	/*Check whether controller is iMR or MR */
4614 	if (ctrl_info->memory_size) {
4615 		instance->is_imr = 0;
4616 		dev_info(&instance->pdev->dev, "Controller type: MR,"
4617 			"Memory size is: %dMB\n",
4618 			le16_to_cpu(ctrl_info->memory_size));
4619 	} else {
4620 		instance->is_imr = 1;
4621 		dev_info(&instance->pdev->dev,
4622 			"Controller type: iMR\n");
4623 	}
4624 	instance->disableOnlineCtrlReset =
4625 	ctrl_info->properties.OnOffProperties.disableOnlineCtrlReset;
4626 	instance->mpio = ctrl_info->adapterOperations2.mpio;
4627 	instance->UnevenSpanSupport =
4628 		ctrl_info->adapterOperations2.supportUnevenSpans;
4629 	if (instance->UnevenSpanSupport) {
4630 		struct fusion_context *fusion = instance->ctrl_context;
4631 
4632 		dev_info(&instance->pdev->dev, "FW supports: "
4633 		"UnevenSpanSupport=%x\n", instance->UnevenSpanSupport);
4634 		if (MR_ValidateMapInfo(instance))
4635 			fusion->fast_path_io = 1;
4636 		else
4637 			fusion->fast_path_io = 0;
4638 
4639 	}
4640 	if (ctrl_info->host_interface.SRIOV) {
4641 		if (!ctrl_info->adapterOperations2.activePassive)
4642 			instance->PlasmaFW111 = 1;
4643 
4644 		if (!instance->PlasmaFW111)
4645 			instance->requestorId =
4646 				ctrl_info->iov.requestorId;
4647 		else {
4648 			iovPtr = (struct IOV_111 *)((unsigned char *)ctrl_info + IOV_111_OFFSET);
4649 			instance->requestorId = iovPtr->requestorId;
4650 		}
4651 		dev_warn(&instance->pdev->dev, "I am VF "
4652 		       "requestorId %d\n", instance->requestorId);
4653 	}
4654 
4655 	instance->crash_dump_fw_support =
4656 		ctrl_info->adapterOperations3.supportCrashDump;
4657 	instance->crash_dump_drv_support =
4658 		(instance->crash_dump_fw_support &&
4659 		instance->crash_dump_buf);
4660 	if (instance->crash_dump_drv_support) {
4661 		dev_info(&instance->pdev->dev, "Firmware Crash dump "
4662 			"feature is supported\n");
4663 		megasas_set_crash_dump_params(instance,
4664 			MR_CRASH_BUF_TURN_OFF);
4665 
4666 	} else {
4667 		if (instance->crash_dump_buf)
4668 			pci_free_consistent(instance->pdev,
4669 				CRASH_DMA_BUF_SIZE,
4670 				instance->crash_dump_buf,
4671 				instance->crash_dump_h);
4672 		instance->crash_dump_buf = NULL;
4673 	}
4674 
4675 	instance->secure_jbod_support =
4676 		ctrl_info->adapterOperations3.supportSecurityonJBOD;
4677 	if (instance->secure_jbod_support)
4678 		dev_info(&instance->pdev->dev, "Firmware supports Secure JBOD\n");
4679 	instance->max_sectors_per_req = instance->max_num_sge *
4680 						PAGE_SIZE / 512;
4681 	if (tmp_sectors && (instance->max_sectors_per_req > tmp_sectors))
4682 		instance->max_sectors_per_req = tmp_sectors;
4683 
4684 	/*
4685 	 * 1. For fusion adapters, 3 commands for IOCTL and 5 commands
4686 	 *    for driver's internal DCMDs.
4687 	 * 2. For MFI skinny adapters, 5 commands for IOCTL + driver's
4688 	 *    internal DCMDs.
4689 	 * 3. For rest of MFI adapters, 27 commands reserved for IOCTLs
4690 	 *    and 5 commands for drivers's internal DCMD.
4691 	 */
4692 	if (instance->ctrl_context) {
4693 		instance->max_scsi_cmds = instance->max_fw_cmds -
4694 					(MEGASAS_FUSION_INTERNAL_CMDS +
4695 					MEGASAS_FUSION_IOCTL_CMDS);
4696 		sema_init(&instance->ioctl_sem, MEGASAS_FUSION_IOCTL_CMDS);
4697 	} else if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
4698 		(instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0071SKINNY)) {
4699 		instance->max_scsi_cmds = instance->max_fw_cmds -
4700 						MEGASAS_SKINNY_INT_CMDS;
4701 		sema_init(&instance->ioctl_sem, MEGASAS_SKINNY_INT_CMDS);
4702 	} else {
4703 		instance->max_scsi_cmds = instance->max_fw_cmds -
4704 						MEGASAS_INT_CMDS;
4705 		sema_init(&instance->ioctl_sem, (MEGASAS_INT_CMDS - 5));
4706 	}
4707 
4708 	/* Check for valid throttlequeuedepth module parameter */
4709 	if (throttlequeuedepth &&
4710 			throttlequeuedepth <= instance->max_scsi_cmds)
4711 		instance->throttlequeuedepth = throttlequeuedepth;
4712 	else
4713 		instance->throttlequeuedepth =
4714 				MEGASAS_THROTTLE_QUEUE_DEPTH;
4715 
4716         /*
4717 	* Setup tasklet for cmd completion
4718 	*/
4719 
4720 	tasklet_init(&instance->isr_tasklet, instance->instancet->tasklet,
4721 		(unsigned long)instance);
4722 
4723 	/* Launch SR-IOV heartbeat timer */
4724 	if (instance->requestorId) {
4725 		if (!megasas_sriov_start_heartbeat(instance, 1))
4726 			megasas_start_timer(instance,
4727 					    &instance->sriov_heartbeat_timer,
4728 					    megasas_sriov_heartbeat_handler,
4729 					    MEGASAS_SRIOV_HEARTBEAT_INTERVAL_VF);
4730 		else
4731 			instance->skip_heartbeat_timer_del = 1;
4732 	}
4733 
4734 	return 0;
4735 
4736 fail_init_adapter:
4737 fail_ready_state:
4738 	kfree(instance->ctrl_info);
4739 	instance->ctrl_info = NULL;
4740 	iounmap(instance->reg_set);
4741 
4742       fail_ioremap:
4743 	pci_release_selected_regions(instance->pdev, instance->bar);
4744 
4745 	return -EINVAL;
4746 }
4747 
4748 /**
4749  * megasas_release_mfi -	Reverses the FW initialization
4750  * @intance:			Adapter soft state
4751  */
4752 static void megasas_release_mfi(struct megasas_instance *instance)
4753 {
4754 	u32 reply_q_sz = sizeof(u32) *(instance->max_mfi_cmds + 1);
4755 
4756 	if (instance->reply_queue)
4757 		pci_free_consistent(instance->pdev, reply_q_sz,
4758 			    instance->reply_queue, instance->reply_queue_h);
4759 
4760 	megasas_free_cmds(instance);
4761 
4762 	iounmap(instance->reg_set);
4763 
4764 	pci_release_selected_regions(instance->pdev, instance->bar);
4765 }
4766 
4767 /**
4768  * megasas_get_seq_num -	Gets latest event sequence numbers
4769  * @instance:			Adapter soft state
4770  * @eli:			FW event log sequence numbers information
4771  *
4772  * FW maintains a log of all events in a non-volatile area. Upper layers would
4773  * usually find out the latest sequence number of the events, the seq number at
4774  * the boot etc. They would "read" all the events below the latest seq number
4775  * by issuing a direct fw cmd (DCMD). For the future events (beyond latest seq
4776  * number), they would subsribe to AEN (asynchronous event notification) and
4777  * wait for the events to happen.
4778  */
4779 static int
4780 megasas_get_seq_num(struct megasas_instance *instance,
4781 		    struct megasas_evt_log_info *eli)
4782 {
4783 	struct megasas_cmd *cmd;
4784 	struct megasas_dcmd_frame *dcmd;
4785 	struct megasas_evt_log_info *el_info;
4786 	dma_addr_t el_info_h = 0;
4787 
4788 	cmd = megasas_get_cmd(instance);
4789 
4790 	if (!cmd) {
4791 		return -ENOMEM;
4792 	}
4793 
4794 	dcmd = &cmd->frame->dcmd;
4795 	el_info = pci_alloc_consistent(instance->pdev,
4796 				       sizeof(struct megasas_evt_log_info),
4797 				       &el_info_h);
4798 
4799 	if (!el_info) {
4800 		megasas_return_cmd(instance, cmd);
4801 		return -ENOMEM;
4802 	}
4803 
4804 	memset(el_info, 0, sizeof(*el_info));
4805 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4806 
4807 	dcmd->cmd = MFI_CMD_DCMD;
4808 	dcmd->cmd_status = 0x0;
4809 	dcmd->sge_count = 1;
4810 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_READ);
4811 	dcmd->timeout = 0;
4812 	dcmd->pad_0 = 0;
4813 	dcmd->data_xfer_len = cpu_to_le32(sizeof(struct megasas_evt_log_info));
4814 	dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_EVENT_GET_INFO);
4815 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(el_info_h);
4816 	dcmd->sgl.sge32[0].length = cpu_to_le32(sizeof(struct megasas_evt_log_info));
4817 
4818 	if (megasas_issue_blocked_cmd(instance, cmd, 30))
4819 		dev_err(&instance->pdev->dev, "Command timedout"
4820 			"from %s\n", __func__);
4821 	else {
4822 		/*
4823 		 * Copy the data back into callers buffer
4824 		 */
4825 		eli->newest_seq_num = le32_to_cpu(el_info->newest_seq_num);
4826 		eli->oldest_seq_num = le32_to_cpu(el_info->oldest_seq_num);
4827 		eli->clear_seq_num = le32_to_cpu(el_info->clear_seq_num);
4828 		eli->shutdown_seq_num = le32_to_cpu(el_info->shutdown_seq_num);
4829 		eli->boot_seq_num = le32_to_cpu(el_info->boot_seq_num);
4830 	}
4831 
4832 	pci_free_consistent(instance->pdev, sizeof(struct megasas_evt_log_info),
4833 			    el_info, el_info_h);
4834 
4835 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
4836 		megasas_return_mfi_mpt_pthr(instance, cmd,
4837 			cmd->mpt_pthr_cmd_blocked);
4838 	else
4839 		megasas_return_cmd(instance, cmd);
4840 
4841 	return 0;
4842 }
4843 
4844 /**
4845  * megasas_register_aen -	Registers for asynchronous event notification
4846  * @instance:			Adapter soft state
4847  * @seq_num:			The starting sequence number
4848  * @class_locale:		Class of the event
4849  *
4850  * This function subscribes for AEN for events beyond the @seq_num. It requests
4851  * to be notified if and only if the event is of type @class_locale
4852  */
4853 static int
4854 megasas_register_aen(struct megasas_instance *instance, u32 seq_num,
4855 		     u32 class_locale_word)
4856 {
4857 	int ret_val;
4858 	struct megasas_cmd *cmd;
4859 	struct megasas_dcmd_frame *dcmd;
4860 	union megasas_evt_class_locale curr_aen;
4861 	union megasas_evt_class_locale prev_aen;
4862 
4863 	/*
4864 	 * If there an AEN pending already (aen_cmd), check if the
4865 	 * class_locale of that pending AEN is inclusive of the new
4866 	 * AEN request we currently have. If it is, then we don't have
4867 	 * to do anything. In other words, whichever events the current
4868 	 * AEN request is subscribing to, have already been subscribed
4869 	 * to.
4870 	 *
4871 	 * If the old_cmd is _not_ inclusive, then we have to abort
4872 	 * that command, form a class_locale that is superset of both
4873 	 * old and current and re-issue to the FW
4874 	 */
4875 
4876 	curr_aen.word = class_locale_word;
4877 
4878 	if (instance->aen_cmd) {
4879 
4880 		prev_aen.word = instance->aen_cmd->frame->dcmd.mbox.w[1];
4881 		prev_aen.members.locale = le16_to_cpu(prev_aen.members.locale);
4882 
4883 		/*
4884 		 * A class whose enum value is smaller is inclusive of all
4885 		 * higher values. If a PROGRESS (= -1) was previously
4886 		 * registered, then a new registration requests for higher
4887 		 * classes need not be sent to FW. They are automatically
4888 		 * included.
4889 		 *
4890 		 * Locale numbers don't have such hierarchy. They are bitmap
4891 		 * values
4892 		 */
4893 		if ((prev_aen.members.class <= curr_aen.members.class) &&
4894 		    !((prev_aen.members.locale & curr_aen.members.locale) ^
4895 		      curr_aen.members.locale)) {
4896 			/*
4897 			 * Previously issued event registration includes
4898 			 * current request. Nothing to do.
4899 			 */
4900 			return 0;
4901 		} else {
4902 			curr_aen.members.locale |= prev_aen.members.locale;
4903 
4904 			if (prev_aen.members.class < curr_aen.members.class)
4905 				curr_aen.members.class = prev_aen.members.class;
4906 
4907 			instance->aen_cmd->abort_aen = 1;
4908 			ret_val = megasas_issue_blocked_abort_cmd(instance,
4909 								  instance->
4910 								  aen_cmd, 30);
4911 
4912 			if (ret_val) {
4913 				printk(KERN_DEBUG "megasas: Failed to abort "
4914 				       "previous AEN command\n");
4915 				return ret_val;
4916 			}
4917 		}
4918 	}
4919 
4920 	cmd = megasas_get_cmd(instance);
4921 
4922 	if (!cmd)
4923 		return -ENOMEM;
4924 
4925 	dcmd = &cmd->frame->dcmd;
4926 
4927 	memset(instance->evt_detail, 0, sizeof(struct megasas_evt_detail));
4928 
4929 	/*
4930 	 * Prepare DCMD for aen registration
4931 	 */
4932 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4933 
4934 	dcmd->cmd = MFI_CMD_DCMD;
4935 	dcmd->cmd_status = 0x0;
4936 	dcmd->sge_count = 1;
4937 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_READ);
4938 	dcmd->timeout = 0;
4939 	dcmd->pad_0 = 0;
4940 	dcmd->data_xfer_len = cpu_to_le32(sizeof(struct megasas_evt_detail));
4941 	dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_EVENT_WAIT);
4942 	dcmd->mbox.w[0] = cpu_to_le32(seq_num);
4943 	instance->last_seq_num = seq_num;
4944 	dcmd->mbox.w[1] = cpu_to_le32(curr_aen.word);
4945 	dcmd->sgl.sge32[0].phys_addr = cpu_to_le32(instance->evt_detail_h);
4946 	dcmd->sgl.sge32[0].length = cpu_to_le32(sizeof(struct megasas_evt_detail));
4947 
4948 	if (instance->aen_cmd != NULL) {
4949 		megasas_return_cmd(instance, cmd);
4950 		return 0;
4951 	}
4952 
4953 	/*
4954 	 * Store reference to the cmd used to register for AEN. When an
4955 	 * application wants us to register for AEN, we have to abort this
4956 	 * cmd and re-register with a new EVENT LOCALE supplied by that app
4957 	 */
4958 	instance->aen_cmd = cmd;
4959 
4960 	/*
4961 	 * Issue the aen registration frame
4962 	 */
4963 	instance->instancet->issue_dcmd(instance, cmd);
4964 
4965 	return 0;
4966 }
4967 
4968 /**
4969  * megasas_start_aen -	Subscribes to AEN during driver load time
4970  * @instance:		Adapter soft state
4971  */
4972 static int megasas_start_aen(struct megasas_instance *instance)
4973 {
4974 	struct megasas_evt_log_info eli;
4975 	union megasas_evt_class_locale class_locale;
4976 
4977 	/*
4978 	 * Get the latest sequence number from FW
4979 	 */
4980 	memset(&eli, 0, sizeof(eli));
4981 
4982 	if (megasas_get_seq_num(instance, &eli))
4983 		return -1;
4984 
4985 	/*
4986 	 * Register AEN with FW for latest sequence number plus 1
4987 	 */
4988 	class_locale.members.reserved = 0;
4989 	class_locale.members.locale = MR_EVT_LOCALE_ALL;
4990 	class_locale.members.class = MR_EVT_CLASS_DEBUG;
4991 
4992 	return megasas_register_aen(instance,
4993 			eli.newest_seq_num + 1,
4994 			class_locale.word);
4995 }
4996 
4997 /**
4998  * megasas_io_attach -	Attaches this driver to SCSI mid-layer
4999  * @instance:		Adapter soft state
5000  */
5001 static int megasas_io_attach(struct megasas_instance *instance)
5002 {
5003 	struct Scsi_Host *host = instance->host;
5004 
5005 	/*
5006 	 * Export parameters required by SCSI mid-layer
5007 	 */
5008 	host->irq = instance->pdev->irq;
5009 	host->unique_id = instance->unique_id;
5010 	host->can_queue = instance->max_scsi_cmds;
5011 	host->this_id = instance->init_id;
5012 	host->sg_tablesize = instance->max_num_sge;
5013 
5014 	if (instance->fw_support_ieee)
5015 		instance->max_sectors_per_req = MEGASAS_MAX_SECTORS_IEEE;
5016 
5017 	/*
5018 	 * Check if the module parameter value for max_sectors can be used
5019 	 */
5020 	if (max_sectors && max_sectors < instance->max_sectors_per_req)
5021 		instance->max_sectors_per_req = max_sectors;
5022 	else {
5023 		if (max_sectors) {
5024 			if (((instance->pdev->device ==
5025 				PCI_DEVICE_ID_LSI_SAS1078GEN2) ||
5026 				(instance->pdev->device ==
5027 				PCI_DEVICE_ID_LSI_SAS0079GEN2)) &&
5028 				(max_sectors <= MEGASAS_MAX_SECTORS)) {
5029 				instance->max_sectors_per_req = max_sectors;
5030 			} else {
5031 			printk(KERN_INFO "megasas: max_sectors should be > 0"
5032 				"and <= %d (or < 1MB for GEN2 controller)\n",
5033 				instance->max_sectors_per_req);
5034 			}
5035 		}
5036 	}
5037 
5038 	host->max_sectors = instance->max_sectors_per_req;
5039 	host->cmd_per_lun = MEGASAS_DEFAULT_CMD_PER_LUN;
5040 	host->max_channel = MEGASAS_MAX_CHANNELS - 1;
5041 	host->max_id = MEGASAS_MAX_DEV_PER_CHANNEL;
5042 	host->max_lun = MEGASAS_MAX_LUN;
5043 	host->max_cmd_len = 16;
5044 
5045 	/* Fusion only supports host reset */
5046 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_FUSION) ||
5047 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA) ||
5048 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_INVADER) ||
5049 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_FURY)) {
5050 		host->hostt->eh_device_reset_handler = NULL;
5051 		host->hostt->eh_bus_reset_handler = NULL;
5052 	}
5053 
5054 	/*
5055 	 * Notify the mid-layer about the new controller
5056 	 */
5057 	if (scsi_add_host(host, &instance->pdev->dev)) {
5058 		printk(KERN_DEBUG "megasas: scsi_add_host failed\n");
5059 		return -ENODEV;
5060 	}
5061 
5062 	return 0;
5063 }
5064 
5065 static int
5066 megasas_set_dma_mask(struct pci_dev *pdev)
5067 {
5068 	/*
5069 	 * All our contollers are capable of performing 64-bit DMA
5070 	 */
5071 	if (IS_DMA64) {
5072 		if (pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) != 0) {
5073 
5074 			if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0)
5075 				goto fail_set_dma_mask;
5076 		}
5077 	} else {
5078 		if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0)
5079 			goto fail_set_dma_mask;
5080 	}
5081 	/*
5082 	 * Ensure that all data structures are allocated in 32-bit
5083 	 * memory.
5084 	 */
5085 	if (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)) != 0) {
5086 		/* Try 32bit DMA mask and 32 bit Consistent dma mask */
5087 		if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))
5088 			&& !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
5089 			dev_info(&pdev->dev, "set 32bit DMA mask"
5090 				"and 32 bit consistent mask\n");
5091 		else
5092 			goto fail_set_dma_mask;
5093 	}
5094 
5095 	return 0;
5096 
5097 fail_set_dma_mask:
5098 	return 1;
5099 }
5100 
5101 /**
5102  * megasas_probe_one -	PCI hotplug entry point
5103  * @pdev:		PCI device structure
5104  * @id:			PCI ids of supported hotplugged adapter
5105  */
5106 static int megasas_probe_one(struct pci_dev *pdev,
5107 			     const struct pci_device_id *id)
5108 {
5109 	int rval, pos, i, j, cpu;
5110 	struct Scsi_Host *host;
5111 	struct megasas_instance *instance;
5112 	u16 control = 0;
5113 	struct fusion_context *fusion = NULL;
5114 
5115 	/* Reset MSI-X in the kdump kernel */
5116 	if (reset_devices) {
5117 		pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
5118 		if (pos) {
5119 			pci_read_config_word(pdev, pos + PCI_MSIX_FLAGS,
5120 					     &control);
5121 			if (control & PCI_MSIX_FLAGS_ENABLE) {
5122 				dev_info(&pdev->dev, "resetting MSI-X\n");
5123 				pci_write_config_word(pdev,
5124 						      pos + PCI_MSIX_FLAGS,
5125 						      control &
5126 						      ~PCI_MSIX_FLAGS_ENABLE);
5127 			}
5128 		}
5129 	}
5130 
5131 	/*
5132 	 * Announce PCI information
5133 	 */
5134 	printk(KERN_INFO "megasas: %#4.04x:%#4.04x:%#4.04x:%#4.04x: ",
5135 	       pdev->vendor, pdev->device, pdev->subsystem_vendor,
5136 	       pdev->subsystem_device);
5137 
5138 	printk("bus %d:slot %d:func %d\n",
5139 	       pdev->bus->number, PCI_SLOT(pdev->devfn), PCI_FUNC(pdev->devfn));
5140 
5141 	/*
5142 	 * PCI prepping: enable device set bus mastering and dma mask
5143 	 */
5144 	rval = pci_enable_device_mem(pdev);
5145 
5146 	if (rval) {
5147 		return rval;
5148 	}
5149 
5150 	pci_set_master(pdev);
5151 
5152 	if (megasas_set_dma_mask(pdev))
5153 		goto fail_set_dma_mask;
5154 
5155 	host = scsi_host_alloc(&megasas_template,
5156 			       sizeof(struct megasas_instance));
5157 
5158 	if (!host) {
5159 		printk(KERN_DEBUG "megasas: scsi_host_alloc failed\n");
5160 		goto fail_alloc_instance;
5161 	}
5162 
5163 	instance = (struct megasas_instance *)host->hostdata;
5164 	memset(instance, 0, sizeof(*instance));
5165 	atomic_set( &instance->fw_reset_no_pci_access, 0 );
5166 	instance->pdev = pdev;
5167 
5168 	switch (instance->pdev->device) {
5169 	case PCI_DEVICE_ID_LSI_FUSION:
5170 	case PCI_DEVICE_ID_LSI_PLASMA:
5171 	case PCI_DEVICE_ID_LSI_INVADER:
5172 	case PCI_DEVICE_ID_LSI_FURY:
5173 	{
5174 		instance->ctrl_context_pages =
5175 			get_order(sizeof(struct fusion_context));
5176 		instance->ctrl_context = (void *)__get_free_pages(GFP_KERNEL,
5177 				instance->ctrl_context_pages);
5178 		if (!instance->ctrl_context) {
5179 			printk(KERN_DEBUG "megasas: Failed to allocate "
5180 			       "memory for Fusion context info\n");
5181 			goto fail_alloc_dma_buf;
5182 		}
5183 		fusion = instance->ctrl_context;
5184 		memset(fusion, 0,
5185 			((1 << PAGE_SHIFT) << instance->ctrl_context_pages));
5186 		INIT_LIST_HEAD(&fusion->cmd_pool);
5187 		spin_lock_init(&fusion->mpt_pool_lock);
5188 	}
5189 	break;
5190 	default: /* For all other supported controllers */
5191 
5192 		instance->producer =
5193 			pci_alloc_consistent(pdev, sizeof(u32),
5194 					     &instance->producer_h);
5195 		instance->consumer =
5196 			pci_alloc_consistent(pdev, sizeof(u32),
5197 					     &instance->consumer_h);
5198 
5199 		if (!instance->producer || !instance->consumer) {
5200 			printk(KERN_DEBUG "megasas: Failed to allocate"
5201 			       "memory for producer, consumer\n");
5202 			goto fail_alloc_dma_buf;
5203 		}
5204 
5205 		*instance->producer = 0;
5206 		*instance->consumer = 0;
5207 		break;
5208 	}
5209 
5210 	/* Crash dump feature related initialisation*/
5211 	instance->drv_buf_index = 0;
5212 	instance->drv_buf_alloc = 0;
5213 	instance->crash_dump_fw_support = 0;
5214 	instance->crash_dump_app_support = 0;
5215 	instance->fw_crash_state = UNAVAILABLE;
5216 	spin_lock_init(&instance->crashdump_lock);
5217 	instance->crash_dump_buf = NULL;
5218 
5219 	if (!reset_devices)
5220 		instance->crash_dump_buf = pci_alloc_consistent(pdev,
5221 						CRASH_DMA_BUF_SIZE,
5222 						&instance->crash_dump_h);
5223 	if (!instance->crash_dump_buf)
5224 		dev_err(&instance->pdev->dev, "Can't allocate Firmware "
5225 			"crash dump DMA buffer\n");
5226 
5227 	megasas_poll_wait_aen = 0;
5228 	instance->flag_ieee = 0;
5229 	instance->ev = NULL;
5230 	instance->issuepend_done = 1;
5231 	instance->adprecovery = MEGASAS_HBA_OPERATIONAL;
5232 	instance->is_imr = 0;
5233 
5234 	instance->evt_detail = pci_alloc_consistent(pdev,
5235 						    sizeof(struct
5236 							   megasas_evt_detail),
5237 						    &instance->evt_detail_h);
5238 
5239 	if (!instance->evt_detail) {
5240 		printk(KERN_DEBUG "megasas: Failed to allocate memory for "
5241 		       "event detail structure\n");
5242 		goto fail_alloc_dma_buf;
5243 	}
5244 
5245 	/*
5246 	 * Initialize locks and queues
5247 	 */
5248 	INIT_LIST_HEAD(&instance->cmd_pool);
5249 	INIT_LIST_HEAD(&instance->internal_reset_pending_q);
5250 
5251 	atomic_set(&instance->fw_outstanding,0);
5252 
5253 	init_waitqueue_head(&instance->int_cmd_wait_q);
5254 	init_waitqueue_head(&instance->abort_cmd_wait_q);
5255 
5256 	spin_lock_init(&instance->mfi_pool_lock);
5257 	spin_lock_init(&instance->hba_lock);
5258 	spin_lock_init(&instance->completion_lock);
5259 
5260 	mutex_init(&instance->aen_mutex);
5261 	mutex_init(&instance->reset_mutex);
5262 
5263 	/*
5264 	 * Initialize PCI related and misc parameters
5265 	 */
5266 	instance->host = host;
5267 	instance->unique_id = pdev->bus->number << 8 | pdev->devfn;
5268 	instance->init_id = MEGASAS_DEFAULT_INIT_ID;
5269 	instance->ctrl_info = NULL;
5270 
5271 
5272 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
5273 		(instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0071SKINNY))
5274 		instance->flag_ieee = 1;
5275 
5276 	megasas_dbg_lvl = 0;
5277 	instance->flag = 0;
5278 	instance->unload = 1;
5279 	instance->last_time = 0;
5280 	instance->disableOnlineCtrlReset = 1;
5281 	instance->UnevenSpanSupport = 0;
5282 
5283 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_FUSION) ||
5284 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA) ||
5285 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_INVADER) ||
5286 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_FURY)) {
5287 		INIT_WORK(&instance->work_init, megasas_fusion_ocr_wq);
5288 		INIT_WORK(&instance->crash_init, megasas_fusion_crash_dump_wq);
5289 	} else
5290 		INIT_WORK(&instance->work_init, process_fw_state_change_wq);
5291 
5292 	/*
5293 	 * Initialize MFI Firmware
5294 	 */
5295 	if (megasas_init_fw(instance))
5296 		goto fail_init_mfi;
5297 
5298 	if (instance->requestorId) {
5299 		if (instance->PlasmaFW111) {
5300 			instance->vf_affiliation_111 =
5301 				pci_alloc_consistent(pdev, sizeof(struct MR_LD_VF_AFFILIATION_111),
5302 						     &instance->vf_affiliation_111_h);
5303 			if (!instance->vf_affiliation_111)
5304 				printk(KERN_WARNING "megasas: Can't allocate "
5305 				       "memory for VF affiliation buffer\n");
5306 		} else {
5307 			instance->vf_affiliation =
5308 				pci_alloc_consistent(pdev,
5309 						     (MAX_LOGICAL_DRIVES + 1) *
5310 						     sizeof(struct MR_LD_VF_AFFILIATION),
5311 						     &instance->vf_affiliation_h);
5312 			if (!instance->vf_affiliation)
5313 				printk(KERN_WARNING "megasas: Can't allocate "
5314 				       "memory for VF affiliation buffer\n");
5315 		}
5316 	}
5317 
5318 retry_irq_register:
5319 	/*
5320 	 * Register IRQ
5321 	 */
5322 	if (instance->msix_vectors) {
5323 		cpu = cpumask_first(cpu_online_mask);
5324 		for (i = 0; i < instance->msix_vectors; i++) {
5325 			instance->irq_context[i].instance = instance;
5326 			instance->irq_context[i].MSIxIndex = i;
5327 			if (request_irq(instance->msixentry[i].vector,
5328 					instance->instancet->service_isr, 0,
5329 					"megasas",
5330 					&instance->irq_context[i])) {
5331 				printk(KERN_DEBUG "megasas: Failed to "
5332 				       "register IRQ for vector %d.\n", i);
5333 				for (j = 0; j < i; j++) {
5334 					if (smp_affinity_enable)
5335 						irq_set_affinity_hint(
5336 							instance->msixentry[j].vector, NULL);
5337 					free_irq(
5338 						instance->msixentry[j].vector,
5339 						&instance->irq_context[j]);
5340 				}
5341 				/* Retry irq register for IO_APIC */
5342 				instance->msix_vectors = 0;
5343 				goto retry_irq_register;
5344 			}
5345 			if (smp_affinity_enable) {
5346 				if (irq_set_affinity_hint(instance->msixentry[i].vector,
5347 					get_cpu_mask(cpu)))
5348 					dev_err(&instance->pdev->dev,
5349 						"Error setting affinity hint "
5350 						"for cpu %d\n", cpu);
5351 				cpu = cpumask_next(cpu, cpu_online_mask);
5352 			}
5353 		}
5354 	} else {
5355 		instance->irq_context[0].instance = instance;
5356 		instance->irq_context[0].MSIxIndex = 0;
5357 		if (request_irq(pdev->irq, instance->instancet->service_isr,
5358 				IRQF_SHARED, "megasas",
5359 				&instance->irq_context[0])) {
5360 			printk(KERN_DEBUG "megasas: Failed to register IRQ\n");
5361 			goto fail_irq;
5362 		}
5363 	}
5364 
5365 	instance->instancet->enable_intr(instance);
5366 
5367 	/*
5368 	 * Store instance in PCI softstate
5369 	 */
5370 	pci_set_drvdata(pdev, instance);
5371 
5372 	/*
5373 	 * Add this controller to megasas_mgmt_info structure so that it
5374 	 * can be exported to management applications
5375 	 */
5376 	megasas_mgmt_info.count++;
5377 	megasas_mgmt_info.instance[megasas_mgmt_info.max_index] = instance;
5378 	megasas_mgmt_info.max_index++;
5379 
5380 	/*
5381 	 * Register with SCSI mid-layer
5382 	 */
5383 	if (megasas_io_attach(instance))
5384 		goto fail_io_attach;
5385 
5386 	instance->unload = 0;
5387 	/*
5388 	 * Trigger SCSI to scan our drives
5389 	 */
5390 	scsi_scan_host(host);
5391 
5392 	/*
5393 	 * Initiate AEN (Asynchronous Event Notification)
5394 	 */
5395 	if (megasas_start_aen(instance)) {
5396 		printk(KERN_DEBUG "megasas: start aen failed\n");
5397 		goto fail_start_aen;
5398 	}
5399 
5400 	/* Get current SR-IOV LD/VF affiliation */
5401 	if (instance->requestorId)
5402 		megasas_get_ld_vf_affiliation(instance, 1);
5403 
5404 	return 0;
5405 
5406       fail_start_aen:
5407       fail_io_attach:
5408 	megasas_mgmt_info.count--;
5409 	megasas_mgmt_info.instance[megasas_mgmt_info.max_index] = NULL;
5410 	megasas_mgmt_info.max_index--;
5411 
5412 	instance->instancet->disable_intr(instance);
5413 	if (instance->msix_vectors)
5414 		for (i = 0; i < instance->msix_vectors; i++) {
5415 			if (smp_affinity_enable)
5416 				irq_set_affinity_hint(
5417 					instance->msixentry[i].vector, NULL);
5418 			free_irq(instance->msixentry[i].vector,
5419 				 &instance->irq_context[i]);
5420 		}
5421 	else
5422 		free_irq(instance->pdev->irq, &instance->irq_context[0]);
5423 fail_irq:
5424 	if ((instance->pdev->device == PCI_DEVICE_ID_LSI_FUSION) ||
5425 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA) ||
5426 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_INVADER) ||
5427 	    (instance->pdev->device == PCI_DEVICE_ID_LSI_FURY))
5428 		megasas_release_fusion(instance);
5429 	else
5430 		megasas_release_mfi(instance);
5431       fail_init_mfi:
5432 	if (instance->msix_vectors)
5433 		pci_disable_msix(instance->pdev);
5434       fail_alloc_dma_buf:
5435 	if (instance->evt_detail)
5436 		pci_free_consistent(pdev, sizeof(struct megasas_evt_detail),
5437 				    instance->evt_detail,
5438 				    instance->evt_detail_h);
5439 
5440 	if (instance->producer)
5441 		pci_free_consistent(pdev, sizeof(u32), instance->producer,
5442 				    instance->producer_h);
5443 	if (instance->consumer)
5444 		pci_free_consistent(pdev, sizeof(u32), instance->consumer,
5445 				    instance->consumer_h);
5446 	scsi_host_put(host);
5447 
5448       fail_alloc_instance:
5449       fail_set_dma_mask:
5450 	pci_disable_device(pdev);
5451 
5452 	return -ENODEV;
5453 }
5454 
5455 /**
5456  * megasas_flush_cache -	Requests FW to flush all its caches
5457  * @instance:			Adapter soft state
5458  */
5459 static void megasas_flush_cache(struct megasas_instance *instance)
5460 {
5461 	struct megasas_cmd *cmd;
5462 	struct megasas_dcmd_frame *dcmd;
5463 
5464 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR)
5465 		return;
5466 
5467 	cmd = megasas_get_cmd(instance);
5468 
5469 	if (!cmd)
5470 		return;
5471 
5472 	dcmd = &cmd->frame->dcmd;
5473 
5474 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
5475 
5476 	dcmd->cmd = MFI_CMD_DCMD;
5477 	dcmd->cmd_status = 0x0;
5478 	dcmd->sge_count = 0;
5479 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_NONE);
5480 	dcmd->timeout = 0;
5481 	dcmd->pad_0 = 0;
5482 	dcmd->data_xfer_len = 0;
5483 	dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_CACHE_FLUSH);
5484 	dcmd->mbox.b[0] = MR_FLUSH_CTRL_CACHE | MR_FLUSH_DISK_CACHE;
5485 
5486 	if (megasas_issue_blocked_cmd(instance, cmd, 30))
5487 		dev_err(&instance->pdev->dev, "Command timedout"
5488 			" from %s\n", __func__);
5489 
5490 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
5491 		megasas_return_mfi_mpt_pthr(instance, cmd,
5492 			cmd->mpt_pthr_cmd_blocked);
5493 	else
5494 		megasas_return_cmd(instance, cmd);
5495 
5496 	return;
5497 }
5498 
5499 /**
5500  * megasas_shutdown_controller -	Instructs FW to shutdown the controller
5501  * @instance:				Adapter soft state
5502  * @opcode:				Shutdown/Hibernate
5503  */
5504 static void megasas_shutdown_controller(struct megasas_instance *instance,
5505 					u32 opcode)
5506 {
5507 	struct megasas_cmd *cmd;
5508 	struct megasas_dcmd_frame *dcmd;
5509 
5510 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR)
5511 		return;
5512 
5513 	cmd = megasas_get_cmd(instance);
5514 
5515 	if (!cmd)
5516 		return;
5517 
5518 	if (instance->aen_cmd)
5519 		megasas_issue_blocked_abort_cmd(instance,
5520 			instance->aen_cmd, 30);
5521 	if (instance->map_update_cmd)
5522 		megasas_issue_blocked_abort_cmd(instance,
5523 			instance->map_update_cmd, 30);
5524 	dcmd = &cmd->frame->dcmd;
5525 
5526 	memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
5527 
5528 	dcmd->cmd = MFI_CMD_DCMD;
5529 	dcmd->cmd_status = 0x0;
5530 	dcmd->sge_count = 0;
5531 	dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_NONE);
5532 	dcmd->timeout = 0;
5533 	dcmd->pad_0 = 0;
5534 	dcmd->data_xfer_len = 0;
5535 	dcmd->opcode = cpu_to_le32(opcode);
5536 
5537 	if (megasas_issue_blocked_cmd(instance, cmd, 30))
5538 		dev_err(&instance->pdev->dev, "Command timedout"
5539 			"from %s\n", __func__);
5540 
5541 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
5542 		megasas_return_mfi_mpt_pthr(instance, cmd,
5543 			cmd->mpt_pthr_cmd_blocked);
5544 	else
5545 		megasas_return_cmd(instance, cmd);
5546 
5547 	return;
5548 }
5549 
5550 #ifdef CONFIG_PM
5551 /**
5552  * megasas_suspend -	driver suspend entry point
5553  * @pdev:		PCI device structure
5554  * @state:		PCI power state to suspend routine
5555  */
5556 static int
5557 megasas_suspend(struct pci_dev *pdev, pm_message_t state)
5558 {
5559 	struct Scsi_Host *host;
5560 	struct megasas_instance *instance;
5561 	int i;
5562 
5563 	instance = pci_get_drvdata(pdev);
5564 	host = instance->host;
5565 	instance->unload = 1;
5566 
5567 	/* Shutdown SR-IOV heartbeat timer */
5568 	if (instance->requestorId && !instance->skip_heartbeat_timer_del)
5569 		del_timer_sync(&instance->sriov_heartbeat_timer);
5570 
5571 	megasas_flush_cache(instance);
5572 	megasas_shutdown_controller(instance, MR_DCMD_HIBERNATE_SHUTDOWN);
5573 
5574 	/* cancel the delayed work if this work still in queue */
5575 	if (instance->ev != NULL) {
5576 		struct megasas_aen_event *ev = instance->ev;
5577 		cancel_delayed_work_sync(&ev->hotplug_work);
5578 		instance->ev = NULL;
5579 	}
5580 
5581 	tasklet_kill(&instance->isr_tasklet);
5582 
5583 	pci_set_drvdata(instance->pdev, instance);
5584 	instance->instancet->disable_intr(instance);
5585 
5586 	if (instance->msix_vectors)
5587 		for (i = 0; i < instance->msix_vectors; i++) {
5588 			if (smp_affinity_enable)
5589 				irq_set_affinity_hint(
5590 					instance->msixentry[i].vector, NULL);
5591 			free_irq(instance->msixentry[i].vector,
5592 				 &instance->irq_context[i]);
5593 		}
5594 	else
5595 		free_irq(instance->pdev->irq, &instance->irq_context[0]);
5596 	if (instance->msix_vectors)
5597 		pci_disable_msix(instance->pdev);
5598 
5599 	pci_save_state(pdev);
5600 	pci_disable_device(pdev);
5601 
5602 	pci_set_power_state(pdev, pci_choose_state(pdev, state));
5603 
5604 	return 0;
5605 }
5606 
5607 /**
5608  * megasas_resume-      driver resume entry point
5609  * @pdev:               PCI device structure
5610  */
5611 static int
5612 megasas_resume(struct pci_dev *pdev)
5613 {
5614 	int rval, i, j, cpu;
5615 	struct Scsi_Host *host;
5616 	struct megasas_instance *instance;
5617 
5618 	instance = pci_get_drvdata(pdev);
5619 	host = instance->host;
5620 	pci_set_power_state(pdev, PCI_D0);
5621 	pci_enable_wake(pdev, PCI_D0, 0);
5622 	pci_restore_state(pdev);
5623 
5624 	/*
5625 	 * PCI prepping: enable device set bus mastering and dma mask
5626 	 */
5627 	rval = pci_enable_device_mem(pdev);
5628 
5629 	if (rval) {
5630 		printk(KERN_ERR "megasas: Enable device failed\n");
5631 		return rval;
5632 	}
5633 
5634 	pci_set_master(pdev);
5635 
5636 	if (megasas_set_dma_mask(pdev))
5637 		goto fail_set_dma_mask;
5638 
5639 	/*
5640 	 * Initialize MFI Firmware
5641 	 */
5642 
5643 	atomic_set(&instance->fw_outstanding, 0);
5644 
5645 	/*
5646 	 * We expect the FW state to be READY
5647 	 */
5648 	if (megasas_transition_to_ready(instance, 0))
5649 		goto fail_ready_state;
5650 
5651 	/* Now re-enable MSI-X */
5652 	if (instance->msix_vectors &&
5653 	    pci_enable_msix_exact(instance->pdev, instance->msixentry,
5654 				  instance->msix_vectors))
5655 		goto fail_reenable_msix;
5656 
5657 	switch (instance->pdev->device) {
5658 	case PCI_DEVICE_ID_LSI_FUSION:
5659 	case PCI_DEVICE_ID_LSI_PLASMA:
5660 	case PCI_DEVICE_ID_LSI_INVADER:
5661 	case PCI_DEVICE_ID_LSI_FURY:
5662 	{
5663 		megasas_reset_reply_desc(instance);
5664 		if (megasas_ioc_init_fusion(instance)) {
5665 			megasas_free_cmds(instance);
5666 			megasas_free_cmds_fusion(instance);
5667 			goto fail_init_mfi;
5668 		}
5669 		if (!megasas_get_map_info(instance))
5670 			megasas_sync_map_info(instance);
5671 	}
5672 	break;
5673 	default:
5674 		*instance->producer = 0;
5675 		*instance->consumer = 0;
5676 		if (megasas_issue_init_mfi(instance))
5677 			goto fail_init_mfi;
5678 		break;
5679 	}
5680 
5681 	tasklet_init(&instance->isr_tasklet, instance->instancet->tasklet,
5682 		     (unsigned long)instance);
5683 
5684 	/*
5685 	 * Register IRQ
5686 	 */
5687 	if (instance->msix_vectors) {
5688 		cpu = cpumask_first(cpu_online_mask);
5689 		for (i = 0 ; i < instance->msix_vectors; i++) {
5690 			instance->irq_context[i].instance = instance;
5691 			instance->irq_context[i].MSIxIndex = i;
5692 			if (request_irq(instance->msixentry[i].vector,
5693 					instance->instancet->service_isr, 0,
5694 					"megasas",
5695 					&instance->irq_context[i])) {
5696 				printk(KERN_DEBUG "megasas: Failed to "
5697 				       "register IRQ for vector %d.\n", i);
5698 				for (j = 0; j < i; j++) {
5699 					if (smp_affinity_enable)
5700 						irq_set_affinity_hint(
5701 							instance->msixentry[j].vector, NULL);
5702 					free_irq(
5703 						instance->msixentry[j].vector,
5704 						&instance->irq_context[j]);
5705 				}
5706 				goto fail_irq;
5707 			}
5708 
5709 			if (smp_affinity_enable) {
5710 				if (irq_set_affinity_hint(instance->msixentry[i].vector,
5711 					get_cpu_mask(cpu)))
5712 					dev_err(&instance->pdev->dev, "Error "
5713 						"setting affinity hint for cpu "
5714 						"%d\n", cpu);
5715 				cpu = cpumask_next(cpu, cpu_online_mask);
5716 			}
5717 		}
5718 	} else {
5719 		instance->irq_context[0].instance = instance;
5720 		instance->irq_context[0].MSIxIndex = 0;
5721 		if (request_irq(pdev->irq, instance->instancet->service_isr,
5722 				IRQF_SHARED, "megasas",
5723 				&instance->irq_context[0])) {
5724 			printk(KERN_DEBUG "megasas: Failed to register IRQ\n");
5725 			goto fail_irq;
5726 		}
5727 	}
5728 
5729 	/* Re-launch SR-IOV heartbeat timer */
5730 	if (instance->requestorId) {
5731 		if (!megasas_sriov_start_heartbeat(instance, 0))
5732 			megasas_start_timer(instance,
5733 					    &instance->sriov_heartbeat_timer,
5734 					    megasas_sriov_heartbeat_handler,
5735 					    MEGASAS_SRIOV_HEARTBEAT_INTERVAL_VF);
5736 		else
5737 			instance->skip_heartbeat_timer_del = 1;
5738 	}
5739 
5740 	instance->instancet->enable_intr(instance);
5741 	instance->unload = 0;
5742 
5743 	/*
5744 	 * Initiate AEN (Asynchronous Event Notification)
5745 	 */
5746 	if (megasas_start_aen(instance))
5747 		printk(KERN_ERR "megasas: Start AEN failed\n");
5748 
5749 	return 0;
5750 
5751 fail_irq:
5752 fail_init_mfi:
5753 	if (instance->evt_detail)
5754 		pci_free_consistent(pdev, sizeof(struct megasas_evt_detail),
5755 				instance->evt_detail,
5756 				instance->evt_detail_h);
5757 
5758 	if (instance->producer)
5759 		pci_free_consistent(pdev, sizeof(u32), instance->producer,
5760 				instance->producer_h);
5761 	if (instance->consumer)
5762 		pci_free_consistent(pdev, sizeof(u32), instance->consumer,
5763 				instance->consumer_h);
5764 	scsi_host_put(host);
5765 
5766 fail_set_dma_mask:
5767 fail_ready_state:
5768 fail_reenable_msix:
5769 
5770 	pci_disable_device(pdev);
5771 
5772 	return -ENODEV;
5773 }
5774 #else
5775 #define megasas_suspend	NULL
5776 #define megasas_resume	NULL
5777 #endif
5778 
5779 /**
5780  * megasas_detach_one -	PCI hot"un"plug entry point
5781  * @pdev:		PCI device structure
5782  */
5783 static void megasas_detach_one(struct pci_dev *pdev)
5784 {
5785 	int i;
5786 	struct Scsi_Host *host;
5787 	struct megasas_instance *instance;
5788 	struct fusion_context *fusion;
5789 
5790 	instance = pci_get_drvdata(pdev);
5791 	instance->unload = 1;
5792 	host = instance->host;
5793 	fusion = instance->ctrl_context;
5794 
5795 	/* Shutdown SR-IOV heartbeat timer */
5796 	if (instance->requestorId && !instance->skip_heartbeat_timer_del)
5797 		del_timer_sync(&instance->sriov_heartbeat_timer);
5798 
5799 	if (instance->fw_crash_state != UNAVAILABLE)
5800 		megasas_free_host_crash_buffer(instance);
5801 	scsi_remove_host(instance->host);
5802 	megasas_flush_cache(instance);
5803 	megasas_shutdown_controller(instance, MR_DCMD_CTRL_SHUTDOWN);
5804 
5805 	/* cancel the delayed work if this work still in queue*/
5806 	if (instance->ev != NULL) {
5807 		struct megasas_aen_event *ev = instance->ev;
5808 		cancel_delayed_work_sync(&ev->hotplug_work);
5809 		instance->ev = NULL;
5810 	}
5811 
5812 	/* cancel all wait events */
5813 	wake_up_all(&instance->int_cmd_wait_q);
5814 
5815 	tasklet_kill(&instance->isr_tasklet);
5816 
5817 	/*
5818 	 * Take the instance off the instance array. Note that we will not
5819 	 * decrement the max_index. We let this array be sparse array
5820 	 */
5821 	for (i = 0; i < megasas_mgmt_info.max_index; i++) {
5822 		if (megasas_mgmt_info.instance[i] == instance) {
5823 			megasas_mgmt_info.count--;
5824 			megasas_mgmt_info.instance[i] = NULL;
5825 
5826 			break;
5827 		}
5828 	}
5829 
5830 	instance->instancet->disable_intr(instance);
5831 
5832 	if (instance->msix_vectors)
5833 		for (i = 0; i < instance->msix_vectors; i++) {
5834 			if (smp_affinity_enable)
5835 				irq_set_affinity_hint(
5836 					instance->msixentry[i].vector, NULL);
5837 			free_irq(instance->msixentry[i].vector,
5838 				 &instance->irq_context[i]);
5839 		}
5840 	else
5841 		free_irq(instance->pdev->irq, &instance->irq_context[0]);
5842 	if (instance->msix_vectors)
5843 		pci_disable_msix(instance->pdev);
5844 
5845 	switch (instance->pdev->device) {
5846 	case PCI_DEVICE_ID_LSI_FUSION:
5847 	case PCI_DEVICE_ID_LSI_PLASMA:
5848 	case PCI_DEVICE_ID_LSI_INVADER:
5849 	case PCI_DEVICE_ID_LSI_FURY:
5850 		megasas_release_fusion(instance);
5851 		for (i = 0; i < 2 ; i++) {
5852 			if (fusion->ld_map[i])
5853 				dma_free_coherent(&instance->pdev->dev,
5854 						  fusion->max_map_sz,
5855 						  fusion->ld_map[i],
5856 						  fusion->ld_map_phys[i]);
5857 			if (fusion->ld_drv_map[i])
5858 				free_pages((ulong)fusion->ld_drv_map[i],
5859 					fusion->drv_map_pages);
5860 		}
5861 		free_pages((ulong)instance->ctrl_context,
5862 			instance->ctrl_context_pages);
5863 		break;
5864 	default:
5865 		megasas_release_mfi(instance);
5866 		pci_free_consistent(pdev, sizeof(u32),
5867 				    instance->producer,
5868 				    instance->producer_h);
5869 		pci_free_consistent(pdev, sizeof(u32),
5870 				    instance->consumer,
5871 				    instance->consumer_h);
5872 		break;
5873 	}
5874 
5875 	kfree(instance->ctrl_info);
5876 
5877 	if (instance->evt_detail)
5878 		pci_free_consistent(pdev, sizeof(struct megasas_evt_detail),
5879 				instance->evt_detail, instance->evt_detail_h);
5880 
5881 	if (instance->vf_affiliation)
5882 		pci_free_consistent(pdev, (MAX_LOGICAL_DRIVES + 1) *
5883 				    sizeof(struct MR_LD_VF_AFFILIATION),
5884 				    instance->vf_affiliation,
5885 				    instance->vf_affiliation_h);
5886 
5887 	if (instance->vf_affiliation_111)
5888 		pci_free_consistent(pdev,
5889 				    sizeof(struct MR_LD_VF_AFFILIATION_111),
5890 				    instance->vf_affiliation_111,
5891 				    instance->vf_affiliation_111_h);
5892 
5893 	if (instance->hb_host_mem)
5894 		pci_free_consistent(pdev, sizeof(struct MR_CTRL_HB_HOST_MEM),
5895 				    instance->hb_host_mem,
5896 				    instance->hb_host_mem_h);
5897 
5898 	if (instance->crash_dump_buf)
5899 		pci_free_consistent(pdev, CRASH_DMA_BUF_SIZE,
5900 			    instance->crash_dump_buf, instance->crash_dump_h);
5901 
5902 	scsi_host_put(host);
5903 
5904 	pci_disable_device(pdev);
5905 
5906 	return;
5907 }
5908 
5909 /**
5910  * megasas_shutdown -	Shutdown entry point
5911  * @device:		Generic device structure
5912  */
5913 static void megasas_shutdown(struct pci_dev *pdev)
5914 {
5915 	int i;
5916 	struct megasas_instance *instance = pci_get_drvdata(pdev);
5917 
5918 	instance->unload = 1;
5919 	megasas_flush_cache(instance);
5920 	megasas_shutdown_controller(instance, MR_DCMD_CTRL_SHUTDOWN);
5921 	instance->instancet->disable_intr(instance);
5922 	if (instance->msix_vectors)
5923 		for (i = 0; i < instance->msix_vectors; i++) {
5924 			if (smp_affinity_enable)
5925 				irq_set_affinity_hint(
5926 					instance->msixentry[i].vector, NULL);
5927 			free_irq(instance->msixentry[i].vector,
5928 				 &instance->irq_context[i]);
5929 		}
5930 	else
5931 		free_irq(instance->pdev->irq, &instance->irq_context[0]);
5932 	if (instance->msix_vectors)
5933 		pci_disable_msix(instance->pdev);
5934 }
5935 
5936 /**
5937  * megasas_mgmt_open -	char node "open" entry point
5938  */
5939 static int megasas_mgmt_open(struct inode *inode, struct file *filep)
5940 {
5941 	/*
5942 	 * Allow only those users with admin rights
5943 	 */
5944 	if (!capable(CAP_SYS_ADMIN))
5945 		return -EACCES;
5946 
5947 	return 0;
5948 }
5949 
5950 /**
5951  * megasas_mgmt_fasync -	Async notifier registration from applications
5952  *
5953  * This function adds the calling process to a driver global queue. When an
5954  * event occurs, SIGIO will be sent to all processes in this queue.
5955  */
5956 static int megasas_mgmt_fasync(int fd, struct file *filep, int mode)
5957 {
5958 	int rc;
5959 
5960 	mutex_lock(&megasas_async_queue_mutex);
5961 
5962 	rc = fasync_helper(fd, filep, mode, &megasas_async_queue);
5963 
5964 	mutex_unlock(&megasas_async_queue_mutex);
5965 
5966 	if (rc >= 0) {
5967 		/* For sanity check when we get ioctl */
5968 		filep->private_data = filep;
5969 		return 0;
5970 	}
5971 
5972 	printk(KERN_DEBUG "megasas: fasync_helper failed [%d]\n", rc);
5973 
5974 	return rc;
5975 }
5976 
5977 /**
5978  * megasas_mgmt_poll -  char node "poll" entry point
5979  * */
5980 static unsigned int megasas_mgmt_poll(struct file *file, poll_table *wait)
5981 {
5982 	unsigned int mask;
5983 	unsigned long flags;
5984 	poll_wait(file, &megasas_poll_wait, wait);
5985 	spin_lock_irqsave(&poll_aen_lock, flags);
5986 	if (megasas_poll_wait_aen)
5987 		mask =   (POLLIN | POLLRDNORM);
5988 
5989 	else
5990 		mask = 0;
5991 	megasas_poll_wait_aen = 0;
5992 	spin_unlock_irqrestore(&poll_aen_lock, flags);
5993 	return mask;
5994 }
5995 
5996 /*
5997  * megasas_set_crash_dump_params_ioctl:
5998  *		Send CRASH_DUMP_MODE DCMD to all controllers
5999  * @cmd:	MFI command frame
6000  */
6001 
6002 static int megasas_set_crash_dump_params_ioctl(
6003 	struct megasas_cmd *cmd)
6004 {
6005 	struct megasas_instance *local_instance;
6006 	int i, error = 0;
6007 	int crash_support;
6008 
6009 	crash_support = cmd->frame->dcmd.mbox.w[0];
6010 
6011 	for (i = 0; i < megasas_mgmt_info.max_index; i++) {
6012 		local_instance = megasas_mgmt_info.instance[i];
6013 		if (local_instance && local_instance->crash_dump_drv_support) {
6014 			if ((local_instance->adprecovery ==
6015 				MEGASAS_HBA_OPERATIONAL) &&
6016 				!megasas_set_crash_dump_params(local_instance,
6017 					crash_support)) {
6018 				local_instance->crash_dump_app_support =
6019 					crash_support;
6020 				dev_info(&local_instance->pdev->dev,
6021 					"Application firmware crash "
6022 					"dump mode set success\n");
6023 				error = 0;
6024 			} else {
6025 				dev_info(&local_instance->pdev->dev,
6026 					"Application firmware crash "
6027 					"dump mode set failed\n");
6028 				error = -1;
6029 			}
6030 		}
6031 	}
6032 	return error;
6033 }
6034 
6035 /**
6036  * megasas_mgmt_fw_ioctl -	Issues management ioctls to FW
6037  * @instance:			Adapter soft state
6038  * @argp:			User's ioctl packet
6039  */
6040 static int
6041 megasas_mgmt_fw_ioctl(struct megasas_instance *instance,
6042 		      struct megasas_iocpacket __user * user_ioc,
6043 		      struct megasas_iocpacket *ioc)
6044 {
6045 	struct megasas_sge32 *kern_sge32;
6046 	struct megasas_cmd *cmd;
6047 	void *kbuff_arr[MAX_IOCTL_SGE];
6048 	dma_addr_t buf_handle = 0;
6049 	int error = 0, i;
6050 	void *sense = NULL;
6051 	dma_addr_t sense_handle;
6052 	unsigned long *sense_ptr;
6053 
6054 	memset(kbuff_arr, 0, sizeof(kbuff_arr));
6055 
6056 	if (ioc->sge_count > MAX_IOCTL_SGE) {
6057 		printk(KERN_DEBUG "megasas: SGE count [%d] >  max limit [%d]\n",
6058 		       ioc->sge_count, MAX_IOCTL_SGE);
6059 		return -EINVAL;
6060 	}
6061 
6062 	cmd = megasas_get_cmd(instance);
6063 	if (!cmd) {
6064 		printk(KERN_DEBUG "megasas: Failed to get a cmd packet\n");
6065 		return -ENOMEM;
6066 	}
6067 
6068 	/*
6069 	 * User's IOCTL packet has 2 frames (maximum). Copy those two
6070 	 * frames into our cmd's frames. cmd->frame's context will get
6071 	 * overwritten when we copy from user's frames. So set that value
6072 	 * alone separately
6073 	 */
6074 	memcpy(cmd->frame, ioc->frame.raw, 2 * MEGAMFI_FRAME_SIZE);
6075 	cmd->frame->hdr.context = cpu_to_le32(cmd->index);
6076 	cmd->frame->hdr.pad_0 = 0;
6077 	cmd->frame->hdr.flags &= cpu_to_le16(~(MFI_FRAME_IEEE |
6078 					       MFI_FRAME_SGL64 |
6079 					       MFI_FRAME_SENSE64));
6080 
6081 	if (cmd->frame->dcmd.opcode == MR_DRIVER_SET_APP_CRASHDUMP_MODE) {
6082 		error = megasas_set_crash_dump_params_ioctl(cmd);
6083 		megasas_return_cmd(instance, cmd);
6084 		return error;
6085 	}
6086 
6087 	/*
6088 	 * The management interface between applications and the fw uses
6089 	 * MFI frames. E.g, RAID configuration changes, LD property changes
6090 	 * etc are accomplishes through different kinds of MFI frames. The
6091 	 * driver needs to care only about substituting user buffers with
6092 	 * kernel buffers in SGLs. The location of SGL is embedded in the
6093 	 * struct iocpacket itself.
6094 	 */
6095 	kern_sge32 = (struct megasas_sge32 *)
6096 	    ((unsigned long)cmd->frame + ioc->sgl_off);
6097 
6098 	/*
6099 	 * For each user buffer, create a mirror buffer and copy in
6100 	 */
6101 	for (i = 0; i < ioc->sge_count; i++) {
6102 		if (!ioc->sgl[i].iov_len)
6103 			continue;
6104 
6105 		kbuff_arr[i] = dma_alloc_coherent(&instance->pdev->dev,
6106 						    ioc->sgl[i].iov_len,
6107 						    &buf_handle, GFP_KERNEL);
6108 		if (!kbuff_arr[i]) {
6109 			printk(KERN_DEBUG "megasas: Failed to alloc "
6110 			       "kernel SGL buffer for IOCTL \n");
6111 			error = -ENOMEM;
6112 			goto out;
6113 		}
6114 
6115 		/*
6116 		 * We don't change the dma_coherent_mask, so
6117 		 * pci_alloc_consistent only returns 32bit addresses
6118 		 */
6119 		kern_sge32[i].phys_addr = cpu_to_le32(buf_handle);
6120 		kern_sge32[i].length = cpu_to_le32(ioc->sgl[i].iov_len);
6121 
6122 		/*
6123 		 * We created a kernel buffer corresponding to the
6124 		 * user buffer. Now copy in from the user buffer
6125 		 */
6126 		if (copy_from_user(kbuff_arr[i], ioc->sgl[i].iov_base,
6127 				   (u32) (ioc->sgl[i].iov_len))) {
6128 			error = -EFAULT;
6129 			goto out;
6130 		}
6131 	}
6132 
6133 	if (ioc->sense_len) {
6134 		sense = dma_alloc_coherent(&instance->pdev->dev, ioc->sense_len,
6135 					     &sense_handle, GFP_KERNEL);
6136 		if (!sense) {
6137 			error = -ENOMEM;
6138 			goto out;
6139 		}
6140 
6141 		sense_ptr =
6142 		(unsigned long *) ((unsigned long)cmd->frame + ioc->sense_off);
6143 		*sense_ptr = cpu_to_le32(sense_handle);
6144 	}
6145 
6146 	/*
6147 	 * Set the sync_cmd flag so that the ISR knows not to complete this
6148 	 * cmd to the SCSI mid-layer
6149 	 */
6150 	cmd->sync_cmd = 1;
6151 	megasas_issue_blocked_cmd(instance, cmd, 0);
6152 	cmd->sync_cmd = 0;
6153 
6154 	if (instance->unload == 1) {
6155 		dev_info(&instance->pdev->dev, "Driver unload is in progress "
6156 			"don't submit data to application\n");
6157 		goto out;
6158 	}
6159 	/*
6160 	 * copy out the kernel buffers to user buffers
6161 	 */
6162 	for (i = 0; i < ioc->sge_count; i++) {
6163 		if (copy_to_user(ioc->sgl[i].iov_base, kbuff_arr[i],
6164 				 ioc->sgl[i].iov_len)) {
6165 			error = -EFAULT;
6166 			goto out;
6167 		}
6168 	}
6169 
6170 	/*
6171 	 * copy out the sense
6172 	 */
6173 	if (ioc->sense_len) {
6174 		/*
6175 		 * sense_ptr points to the location that has the user
6176 		 * sense buffer address
6177 		 */
6178 		sense_ptr = (unsigned long *) ((unsigned long)ioc->frame.raw +
6179 				ioc->sense_off);
6180 
6181 		if (copy_to_user((void __user *)((unsigned long)(*sense_ptr)),
6182 				 sense, ioc->sense_len)) {
6183 			printk(KERN_ERR "megasas: Failed to copy out to user "
6184 					"sense data\n");
6185 			error = -EFAULT;
6186 			goto out;
6187 		}
6188 	}
6189 
6190 	/*
6191 	 * copy the status codes returned by the fw
6192 	 */
6193 	if (copy_to_user(&user_ioc->frame.hdr.cmd_status,
6194 			 &cmd->frame->hdr.cmd_status, sizeof(u8))) {
6195 		printk(KERN_DEBUG "megasas: Error copying out cmd_status\n");
6196 		error = -EFAULT;
6197 	}
6198 
6199       out:
6200 	if (sense) {
6201 		dma_free_coherent(&instance->pdev->dev, ioc->sense_len,
6202 				    sense, sense_handle);
6203 	}
6204 
6205 	for (i = 0; i < ioc->sge_count; i++) {
6206 		if (kbuff_arr[i])
6207 			dma_free_coherent(&instance->pdev->dev,
6208 					  le32_to_cpu(kern_sge32[i].length),
6209 					  kbuff_arr[i],
6210 					  le32_to_cpu(kern_sge32[i].phys_addr));
6211 			kbuff_arr[i] = NULL;
6212 	}
6213 
6214 	if (instance->ctrl_context && cmd->mpt_pthr_cmd_blocked)
6215 		megasas_return_mfi_mpt_pthr(instance, cmd,
6216 			cmd->mpt_pthr_cmd_blocked);
6217 	else
6218 		megasas_return_cmd(instance, cmd);
6219 	return error;
6220 }
6221 
6222 static int megasas_mgmt_ioctl_fw(struct file *file, unsigned long arg)
6223 {
6224 	struct megasas_iocpacket __user *user_ioc =
6225 	    (struct megasas_iocpacket __user *)arg;
6226 	struct megasas_iocpacket *ioc;
6227 	struct megasas_instance *instance;
6228 	int error;
6229 	int i;
6230 	unsigned long flags;
6231 	u32 wait_time = MEGASAS_RESET_WAIT_TIME;
6232 
6233 	ioc = kmalloc(sizeof(*ioc), GFP_KERNEL);
6234 	if (!ioc)
6235 		return -ENOMEM;
6236 
6237 	if (copy_from_user(ioc, user_ioc, sizeof(*ioc))) {
6238 		error = -EFAULT;
6239 		goto out_kfree_ioc;
6240 	}
6241 
6242 	instance = megasas_lookup_instance(ioc->host_no);
6243 	if (!instance) {
6244 		error = -ENODEV;
6245 		goto out_kfree_ioc;
6246 	}
6247 
6248 	/* Adjust ioctl wait time for VF mode */
6249 	if (instance->requestorId)
6250 		wait_time = MEGASAS_ROUTINE_WAIT_TIME_VF;
6251 
6252 	/* Block ioctls in VF mode */
6253 	if (instance->requestorId && !allow_vf_ioctls) {
6254 		error = -ENODEV;
6255 		goto out_kfree_ioc;
6256 	}
6257 
6258 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR) {
6259 		printk(KERN_ERR "Controller in crit error\n");
6260 		error = -ENODEV;
6261 		goto out_kfree_ioc;
6262 	}
6263 
6264 	if (instance->unload == 1) {
6265 		error = -ENODEV;
6266 		goto out_kfree_ioc;
6267 	}
6268 
6269 	if (down_interruptible(&instance->ioctl_sem)) {
6270 		error = -ERESTARTSYS;
6271 		goto out_kfree_ioc;
6272 	}
6273 
6274 	for (i = 0; i < wait_time; i++) {
6275 
6276 		spin_lock_irqsave(&instance->hba_lock, flags);
6277 		if (instance->adprecovery == MEGASAS_HBA_OPERATIONAL) {
6278 			spin_unlock_irqrestore(&instance->hba_lock, flags);
6279 			break;
6280 		}
6281 		spin_unlock_irqrestore(&instance->hba_lock, flags);
6282 
6283 		if (!(i % MEGASAS_RESET_NOTICE_INTERVAL)) {
6284 			printk(KERN_NOTICE "megasas: waiting"
6285 				"for controller reset to finish\n");
6286 		}
6287 
6288 		msleep(1000);
6289 	}
6290 
6291 	spin_lock_irqsave(&instance->hba_lock, flags);
6292 	if (instance->adprecovery != MEGASAS_HBA_OPERATIONAL) {
6293 		spin_unlock_irqrestore(&instance->hba_lock, flags);
6294 
6295 		printk(KERN_ERR "megaraid_sas: timed out while"
6296 			"waiting for HBA to recover\n");
6297 		error = -ENODEV;
6298 		goto out_up;
6299 	}
6300 	spin_unlock_irqrestore(&instance->hba_lock, flags);
6301 
6302 	error = megasas_mgmt_fw_ioctl(instance, user_ioc, ioc);
6303       out_up:
6304 	up(&instance->ioctl_sem);
6305 
6306       out_kfree_ioc:
6307 	kfree(ioc);
6308 	return error;
6309 }
6310 
6311 static int megasas_mgmt_ioctl_aen(struct file *file, unsigned long arg)
6312 {
6313 	struct megasas_instance *instance;
6314 	struct megasas_aen aen;
6315 	int error;
6316 	int i;
6317 	unsigned long flags;
6318 	u32 wait_time = MEGASAS_RESET_WAIT_TIME;
6319 
6320 	if (file->private_data != file) {
6321 		printk(KERN_DEBUG "megasas: fasync_helper was not "
6322 		       "called first\n");
6323 		return -EINVAL;
6324 	}
6325 
6326 	if (copy_from_user(&aen, (void __user *)arg, sizeof(aen)))
6327 		return -EFAULT;
6328 
6329 	instance = megasas_lookup_instance(aen.host_no);
6330 
6331 	if (!instance)
6332 		return -ENODEV;
6333 
6334 	if (instance->adprecovery == MEGASAS_HW_CRITICAL_ERROR) {
6335 		return -ENODEV;
6336 	}
6337 
6338 	if (instance->unload == 1) {
6339 		return -ENODEV;
6340 	}
6341 
6342 	for (i = 0; i < wait_time; i++) {
6343 
6344 		spin_lock_irqsave(&instance->hba_lock, flags);
6345 		if (instance->adprecovery == MEGASAS_HBA_OPERATIONAL) {
6346 			spin_unlock_irqrestore(&instance->hba_lock,
6347 						flags);
6348 			break;
6349 		}
6350 
6351 		spin_unlock_irqrestore(&instance->hba_lock, flags);
6352 
6353 		if (!(i % MEGASAS_RESET_NOTICE_INTERVAL)) {
6354 			printk(KERN_NOTICE "megasas: waiting for"
6355 				"controller reset to finish\n");
6356 		}
6357 
6358 		msleep(1000);
6359 	}
6360 
6361 	spin_lock_irqsave(&instance->hba_lock, flags);
6362 	if (instance->adprecovery != MEGASAS_HBA_OPERATIONAL) {
6363 		spin_unlock_irqrestore(&instance->hba_lock, flags);
6364 		printk(KERN_ERR "megaraid_sas: timed out while waiting"
6365 				"for HBA to recover.\n");
6366 		return -ENODEV;
6367 	}
6368 	spin_unlock_irqrestore(&instance->hba_lock, flags);
6369 
6370 	mutex_lock(&instance->aen_mutex);
6371 	error = megasas_register_aen(instance, aen.seq_num,
6372 				     aen.class_locale_word);
6373 	mutex_unlock(&instance->aen_mutex);
6374 	return error;
6375 }
6376 
6377 /**
6378  * megasas_mgmt_ioctl -	char node ioctl entry point
6379  */
6380 static long
6381 megasas_mgmt_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
6382 {
6383 	switch (cmd) {
6384 	case MEGASAS_IOC_FIRMWARE:
6385 		return megasas_mgmt_ioctl_fw(file, arg);
6386 
6387 	case MEGASAS_IOC_GET_AEN:
6388 		return megasas_mgmt_ioctl_aen(file, arg);
6389 	}
6390 
6391 	return -ENOTTY;
6392 }
6393 
6394 #ifdef CONFIG_COMPAT
6395 static int megasas_mgmt_compat_ioctl_fw(struct file *file, unsigned long arg)
6396 {
6397 	struct compat_megasas_iocpacket __user *cioc =
6398 	    (struct compat_megasas_iocpacket __user *)arg;
6399 	struct megasas_iocpacket __user *ioc =
6400 	    compat_alloc_user_space(sizeof(struct megasas_iocpacket));
6401 	int i;
6402 	int error = 0;
6403 	compat_uptr_t ptr;
6404 
6405 	if (clear_user(ioc, sizeof(*ioc)))
6406 		return -EFAULT;
6407 
6408 	if (copy_in_user(&ioc->host_no, &cioc->host_no, sizeof(u16)) ||
6409 	    copy_in_user(&ioc->sgl_off, &cioc->sgl_off, sizeof(u32)) ||
6410 	    copy_in_user(&ioc->sense_off, &cioc->sense_off, sizeof(u32)) ||
6411 	    copy_in_user(&ioc->sense_len, &cioc->sense_len, sizeof(u32)) ||
6412 	    copy_in_user(ioc->frame.raw, cioc->frame.raw, 128) ||
6413 	    copy_in_user(&ioc->sge_count, &cioc->sge_count, sizeof(u32)))
6414 		return -EFAULT;
6415 
6416 	/*
6417 	 * The sense_ptr is used in megasas_mgmt_fw_ioctl only when
6418 	 * sense_len is not null, so prepare the 64bit value under
6419 	 * the same condition.
6420 	 */
6421 	if (ioc->sense_len) {
6422 		void __user **sense_ioc_ptr =
6423 			(void __user **)(ioc->frame.raw + ioc->sense_off);
6424 		compat_uptr_t *sense_cioc_ptr =
6425 			(compat_uptr_t *)(cioc->frame.raw + cioc->sense_off);
6426 		if (get_user(ptr, sense_cioc_ptr) ||
6427 		    put_user(compat_ptr(ptr), sense_ioc_ptr))
6428 			return -EFAULT;
6429 	}
6430 
6431 	for (i = 0; i < MAX_IOCTL_SGE; i++) {
6432 		if (get_user(ptr, &cioc->sgl[i].iov_base) ||
6433 		    put_user(compat_ptr(ptr), &ioc->sgl[i].iov_base) ||
6434 		    copy_in_user(&ioc->sgl[i].iov_len,
6435 				 &cioc->sgl[i].iov_len, sizeof(compat_size_t)))
6436 			return -EFAULT;
6437 	}
6438 
6439 	error = megasas_mgmt_ioctl_fw(file, (unsigned long)ioc);
6440 
6441 	if (copy_in_user(&cioc->frame.hdr.cmd_status,
6442 			 &ioc->frame.hdr.cmd_status, sizeof(u8))) {
6443 		printk(KERN_DEBUG "megasas: error copy_in_user cmd_status\n");
6444 		return -EFAULT;
6445 	}
6446 	return error;
6447 }
6448 
6449 static long
6450 megasas_mgmt_compat_ioctl(struct file *file, unsigned int cmd,
6451 			  unsigned long arg)
6452 {
6453 	switch (cmd) {
6454 	case MEGASAS_IOC_FIRMWARE32:
6455 		return megasas_mgmt_compat_ioctl_fw(file, arg);
6456 	case MEGASAS_IOC_GET_AEN:
6457 		return megasas_mgmt_ioctl_aen(file, arg);
6458 	}
6459 
6460 	return -ENOTTY;
6461 }
6462 #endif
6463 
6464 /*
6465  * File operations structure for management interface
6466  */
6467 static const struct file_operations megasas_mgmt_fops = {
6468 	.owner = THIS_MODULE,
6469 	.open = megasas_mgmt_open,
6470 	.fasync = megasas_mgmt_fasync,
6471 	.unlocked_ioctl = megasas_mgmt_ioctl,
6472 	.poll = megasas_mgmt_poll,
6473 #ifdef CONFIG_COMPAT
6474 	.compat_ioctl = megasas_mgmt_compat_ioctl,
6475 #endif
6476 	.llseek = noop_llseek,
6477 };
6478 
6479 /*
6480  * PCI hotplug support registration structure
6481  */
6482 static struct pci_driver megasas_pci_driver = {
6483 
6484 	.name = "megaraid_sas",
6485 	.id_table = megasas_pci_table,
6486 	.probe = megasas_probe_one,
6487 	.remove = megasas_detach_one,
6488 	.suspend = megasas_suspend,
6489 	.resume = megasas_resume,
6490 	.shutdown = megasas_shutdown,
6491 };
6492 
6493 /*
6494  * Sysfs driver attributes
6495  */
6496 static ssize_t megasas_sysfs_show_version(struct device_driver *dd, char *buf)
6497 {
6498 	return snprintf(buf, strlen(MEGASAS_VERSION) + 2, "%s\n",
6499 			MEGASAS_VERSION);
6500 }
6501 
6502 static DRIVER_ATTR(version, S_IRUGO, megasas_sysfs_show_version, NULL);
6503 
6504 static ssize_t
6505 megasas_sysfs_show_support_poll_for_event(struct device_driver *dd, char *buf)
6506 {
6507 	return sprintf(buf, "%u\n", support_poll_for_event);
6508 }
6509 
6510 static DRIVER_ATTR(support_poll_for_event, S_IRUGO,
6511 			megasas_sysfs_show_support_poll_for_event, NULL);
6512 
6513  static ssize_t
6514 megasas_sysfs_show_support_device_change(struct device_driver *dd, char *buf)
6515 {
6516 	return sprintf(buf, "%u\n", support_device_change);
6517 }
6518 
6519 static DRIVER_ATTR(support_device_change, S_IRUGO,
6520 			megasas_sysfs_show_support_device_change, NULL);
6521 
6522 static ssize_t
6523 megasas_sysfs_show_dbg_lvl(struct device_driver *dd, char *buf)
6524 {
6525 	return sprintf(buf, "%u\n", megasas_dbg_lvl);
6526 }
6527 
6528 static ssize_t
6529 megasas_sysfs_set_dbg_lvl(struct device_driver *dd, const char *buf, size_t count)
6530 {
6531 	int retval = count;
6532 	if(sscanf(buf,"%u",&megasas_dbg_lvl)<1){
6533 		printk(KERN_ERR "megasas: could not set dbg_lvl\n");
6534 		retval = -EINVAL;
6535 	}
6536 	return retval;
6537 }
6538 
6539 static DRIVER_ATTR(dbg_lvl, S_IRUGO|S_IWUSR, megasas_sysfs_show_dbg_lvl,
6540 		megasas_sysfs_set_dbg_lvl);
6541 
6542 static void
6543 megasas_aen_polling(struct work_struct *work)
6544 {
6545 	struct megasas_aen_event *ev =
6546 		container_of(work, struct megasas_aen_event, hotplug_work.work);
6547 	struct megasas_instance *instance = ev->instance;
6548 	union megasas_evt_class_locale class_locale;
6549 	struct  Scsi_Host *host;
6550 	struct  scsi_device *sdev1;
6551 	u16     pd_index = 0;
6552 	u16	ld_index = 0;
6553 	int     i, j, doscan = 0;
6554 	u32 seq_num, wait_time = MEGASAS_RESET_WAIT_TIME;
6555 	int error;
6556 
6557 	if (!instance) {
6558 		printk(KERN_ERR "invalid instance!\n");
6559 		kfree(ev);
6560 		return;
6561 	}
6562 
6563 	/* Adjust event workqueue thread wait time for VF mode */
6564 	if (instance->requestorId)
6565 		wait_time = MEGASAS_ROUTINE_WAIT_TIME_VF;
6566 
6567 	/* Don't run the event workqueue thread if OCR is running */
6568 	for (i = 0; i < wait_time; i++) {
6569 		if (instance->adprecovery == MEGASAS_HBA_OPERATIONAL)
6570 			break;
6571 		if (!(i % MEGASAS_RESET_NOTICE_INTERVAL)) {
6572 			printk(KERN_NOTICE "megasas: %s waiting for "
6573 			       "controller reset to finish for scsi%d\n",
6574 			       __func__, instance->host->host_no);
6575 		}
6576 		msleep(1000);
6577 	}
6578 
6579 	instance->ev = NULL;
6580 	host = instance->host;
6581 	if (instance->evt_detail) {
6582 
6583 		switch (le32_to_cpu(instance->evt_detail->code)) {
6584 		case MR_EVT_PD_INSERTED:
6585 			if (megasas_get_pd_list(instance) == 0) {
6586 			for (i = 0; i < MEGASAS_MAX_PD_CHANNELS; i++) {
6587 				for (j = 0;
6588 				j < MEGASAS_MAX_DEV_PER_CHANNEL;
6589 				j++) {
6590 
6591 				pd_index =
6592 				(i * MEGASAS_MAX_DEV_PER_CHANNEL) + j;
6593 
6594 				sdev1 =
6595 				scsi_device_lookup(host, i, j, 0);
6596 
6597 				if (instance->pd_list[pd_index].driveState
6598 						== MR_PD_STATE_SYSTEM) {
6599 						if (!sdev1) {
6600 						scsi_add_device(host, i, j, 0);
6601 						}
6602 
6603 					if (sdev1)
6604 						scsi_device_put(sdev1);
6605 					}
6606 				}
6607 			}
6608 			}
6609 			doscan = 0;
6610 			break;
6611 
6612 		case MR_EVT_PD_REMOVED:
6613 			if (megasas_get_pd_list(instance) == 0) {
6614 			for (i = 0; i < MEGASAS_MAX_PD_CHANNELS; i++) {
6615 				for (j = 0;
6616 				j < MEGASAS_MAX_DEV_PER_CHANNEL;
6617 				j++) {
6618 
6619 				pd_index =
6620 				(i * MEGASAS_MAX_DEV_PER_CHANNEL) + j;
6621 
6622 				sdev1 =
6623 				scsi_device_lookup(host, i, j, 0);
6624 
6625 				if (instance->pd_list[pd_index].driveState
6626 					== MR_PD_STATE_SYSTEM) {
6627 					if (sdev1) {
6628 						scsi_device_put(sdev1);
6629 					}
6630 				} else {
6631 					if (sdev1) {
6632 						scsi_remove_device(sdev1);
6633 						scsi_device_put(sdev1);
6634 					}
6635 				}
6636 				}
6637 			}
6638 			}
6639 			doscan = 0;
6640 			break;
6641 
6642 		case MR_EVT_LD_OFFLINE:
6643 		case MR_EVT_CFG_CLEARED:
6644 		case MR_EVT_LD_DELETED:
6645 			if (!instance->requestorId ||
6646 			    (instance->requestorId &&
6647 			     megasas_get_ld_vf_affiliation(instance, 0))) {
6648 				if (megasas_ld_list_query(instance,
6649 							  MR_LD_QUERY_TYPE_EXPOSED_TO_HOST))
6650 					megasas_get_ld_list(instance);
6651 				for (i = 0; i < MEGASAS_MAX_LD_CHANNELS; i++) {
6652 					for (j = 0;
6653 					     j < MEGASAS_MAX_DEV_PER_CHANNEL;
6654 					     j++) {
6655 
6656 						ld_index =
6657 							(i * MEGASAS_MAX_DEV_PER_CHANNEL) + j;
6658 
6659 						sdev1 = scsi_device_lookup(host, MEGASAS_MAX_PD_CHANNELS + i, j, 0);
6660 
6661 						if (instance->ld_ids[ld_index]
6662 						    != 0xff) {
6663 							if (sdev1)
6664 								scsi_device_put(sdev1);
6665 						} else {
6666 							if (sdev1) {
6667 								scsi_remove_device(sdev1);
6668 								scsi_device_put(sdev1);
6669 							}
6670 						}
6671 					}
6672 				}
6673 				doscan = 0;
6674 			}
6675 			break;
6676 		case MR_EVT_LD_CREATED:
6677 			if (!instance->requestorId ||
6678 			    (instance->requestorId &&
6679 			     megasas_get_ld_vf_affiliation(instance, 0))) {
6680 				if (megasas_ld_list_query(instance,
6681 							  MR_LD_QUERY_TYPE_EXPOSED_TO_HOST))
6682 					megasas_get_ld_list(instance);
6683 				for (i = 0; i < MEGASAS_MAX_LD_CHANNELS; i++) {
6684 					for (j = 0;
6685 					     j < MEGASAS_MAX_DEV_PER_CHANNEL;
6686 					     j++) {
6687 						ld_index =
6688 							(i * MEGASAS_MAX_DEV_PER_CHANNEL) + j;
6689 
6690 						sdev1 = scsi_device_lookup(host, MEGASAS_MAX_PD_CHANNELS + i, j, 0);
6691 
6692 						if (instance->ld_ids[ld_index]
6693 						    != 0xff) {
6694 							if (!sdev1)
6695 								scsi_add_device(host, MEGASAS_MAX_PD_CHANNELS + i, j, 0);
6696 						}
6697 						if (sdev1)
6698 							scsi_device_put(sdev1);
6699 					}
6700 				}
6701 				doscan = 0;
6702 			}
6703 			break;
6704 		case MR_EVT_CTRL_HOST_BUS_SCAN_REQUESTED:
6705 		case MR_EVT_FOREIGN_CFG_IMPORTED:
6706 		case MR_EVT_LD_STATE_CHANGE:
6707 			doscan = 1;
6708 			break;
6709 		default:
6710 			doscan = 0;
6711 			break;
6712 		}
6713 	} else {
6714 		printk(KERN_ERR "invalid evt_detail!\n");
6715 		kfree(ev);
6716 		return;
6717 	}
6718 
6719 	if (doscan) {
6720 		printk(KERN_INFO "megaraid_sas: scanning for scsi%d...\n",
6721 		       instance->host->host_no);
6722 		if (megasas_get_pd_list(instance) == 0) {
6723 			for (i = 0; i < MEGASAS_MAX_PD_CHANNELS; i++) {
6724 				for (j = 0; j < MEGASAS_MAX_DEV_PER_CHANNEL; j++) {
6725 					pd_index = i*MEGASAS_MAX_DEV_PER_CHANNEL + j;
6726 					sdev1 = scsi_device_lookup(host, i, j, 0);
6727 					if (instance->pd_list[pd_index].driveState ==
6728 					    MR_PD_STATE_SYSTEM) {
6729 						if (!sdev1) {
6730 							scsi_add_device(host, i, j, 0);
6731 						}
6732 						if (sdev1)
6733 							scsi_device_put(sdev1);
6734 					} else {
6735 						if (sdev1) {
6736 							scsi_remove_device(sdev1);
6737 							scsi_device_put(sdev1);
6738 						}
6739 					}
6740 				}
6741 			}
6742 		}
6743 
6744 		if (!instance->requestorId ||
6745 		    (instance->requestorId &&
6746 		     megasas_get_ld_vf_affiliation(instance, 0))) {
6747 			if (megasas_ld_list_query(instance,
6748 						  MR_LD_QUERY_TYPE_EXPOSED_TO_HOST))
6749 				megasas_get_ld_list(instance);
6750 			for (i = 0; i < MEGASAS_MAX_LD_CHANNELS; i++) {
6751 				for (j = 0; j < MEGASAS_MAX_DEV_PER_CHANNEL;
6752 				     j++) {
6753 					ld_index =
6754 						(i * MEGASAS_MAX_DEV_PER_CHANNEL) + j;
6755 
6756 					sdev1 = scsi_device_lookup(host,
6757 								   MEGASAS_MAX_PD_CHANNELS + i, j, 0);
6758 					if (instance->ld_ids[ld_index]
6759 					    != 0xff) {
6760 						if (!sdev1)
6761 							scsi_add_device(host, MEGASAS_MAX_PD_CHANNELS + i, j, 0);
6762 						else
6763 							scsi_device_put(sdev1);
6764 					} else {
6765 						if (sdev1) {
6766 							scsi_remove_device(sdev1);
6767 							scsi_device_put(sdev1);
6768 						}
6769 					}
6770 				}
6771 			}
6772 		}
6773 	}
6774 
6775 	if ( instance->aen_cmd != NULL ) {
6776 		kfree(ev);
6777 		return ;
6778 	}
6779 
6780 	seq_num = le32_to_cpu(instance->evt_detail->seq_num) + 1;
6781 
6782 	/* Register AEN with FW for latest sequence number plus 1 */
6783 	class_locale.members.reserved = 0;
6784 	class_locale.members.locale = MR_EVT_LOCALE_ALL;
6785 	class_locale.members.class = MR_EVT_CLASS_DEBUG;
6786 	mutex_lock(&instance->aen_mutex);
6787 	error = megasas_register_aen(instance, seq_num,
6788 					class_locale.word);
6789 	mutex_unlock(&instance->aen_mutex);
6790 
6791 	if (error)
6792 		printk(KERN_ERR "register aen failed error %x\n", error);
6793 
6794 	kfree(ev);
6795 }
6796 
6797 /**
6798  * megasas_init - Driver load entry point
6799  */
6800 static int __init megasas_init(void)
6801 {
6802 	int rval;
6803 
6804 	/*
6805 	 * Announce driver version and other information
6806 	 */
6807 	pr_info("megasas: %s\n", MEGASAS_VERSION);
6808 
6809 	spin_lock_init(&poll_aen_lock);
6810 
6811 	support_poll_for_event = 2;
6812 	support_device_change = 1;
6813 
6814 	memset(&megasas_mgmt_info, 0, sizeof(megasas_mgmt_info));
6815 
6816 	/*
6817 	 * Register character device node
6818 	 */
6819 	rval = register_chrdev(0, "megaraid_sas_ioctl", &megasas_mgmt_fops);
6820 
6821 	if (rval < 0) {
6822 		printk(KERN_DEBUG "megasas: failed to open device node\n");
6823 		return rval;
6824 	}
6825 
6826 	megasas_mgmt_majorno = rval;
6827 
6828 	/*
6829 	 * Register ourselves as PCI hotplug module
6830 	 */
6831 	rval = pci_register_driver(&megasas_pci_driver);
6832 
6833 	if (rval) {
6834 		printk(KERN_DEBUG "megasas: PCI hotplug registration failed \n");
6835 		goto err_pcidrv;
6836 	}
6837 
6838 	rval = driver_create_file(&megasas_pci_driver.driver,
6839 				  &driver_attr_version);
6840 	if (rval)
6841 		goto err_dcf_attr_ver;
6842 
6843 	rval = driver_create_file(&megasas_pci_driver.driver,
6844 				&driver_attr_support_poll_for_event);
6845 	if (rval)
6846 		goto err_dcf_support_poll_for_event;
6847 
6848 	rval = driver_create_file(&megasas_pci_driver.driver,
6849 				  &driver_attr_dbg_lvl);
6850 	if (rval)
6851 		goto err_dcf_dbg_lvl;
6852 	rval = driver_create_file(&megasas_pci_driver.driver,
6853 				&driver_attr_support_device_change);
6854 	if (rval)
6855 		goto err_dcf_support_device_change;
6856 
6857 	return rval;
6858 
6859 err_dcf_support_device_change:
6860 	driver_remove_file(&megasas_pci_driver.driver,
6861 			   &driver_attr_dbg_lvl);
6862 err_dcf_dbg_lvl:
6863 	driver_remove_file(&megasas_pci_driver.driver,
6864 			&driver_attr_support_poll_for_event);
6865 err_dcf_support_poll_for_event:
6866 	driver_remove_file(&megasas_pci_driver.driver, &driver_attr_version);
6867 err_dcf_attr_ver:
6868 	pci_unregister_driver(&megasas_pci_driver);
6869 err_pcidrv:
6870 	unregister_chrdev(megasas_mgmt_majorno, "megaraid_sas_ioctl");
6871 	return rval;
6872 }
6873 
6874 /**
6875  * megasas_exit - Driver unload entry point
6876  */
6877 static void __exit megasas_exit(void)
6878 {
6879 	driver_remove_file(&megasas_pci_driver.driver,
6880 			   &driver_attr_dbg_lvl);
6881 	driver_remove_file(&megasas_pci_driver.driver,
6882 			&driver_attr_support_poll_for_event);
6883 	driver_remove_file(&megasas_pci_driver.driver,
6884 			&driver_attr_support_device_change);
6885 	driver_remove_file(&megasas_pci_driver.driver, &driver_attr_version);
6886 
6887 	pci_unregister_driver(&megasas_pci_driver);
6888 	unregister_chrdev(megasas_mgmt_majorno, "megaraid_sas_ioctl");
6889 }
6890 
6891 module_init(megasas_init);
6892 module_exit(megasas_exit);
6893